视觉系统引入闭环控制系统
基于USB摄像头的单目视觉测距技术的研究
在距离上乘以一个系数补偿，该系数由测距函数和实际距离函数
https://github.com/donghaiyu233/solvepnp/blob/master/PNPsolver.cpp