经典算法matlab代码实现，经过测试，完全可用，用于计算机视觉的图像标定。