张正友标定算法理论及算法实现