![f686e14ac86e76e4b7ffabd2e8632c63.png](https://img-blog.csdnimg.cn/img_convert/f686e14ac86e76e4b7ffabd2e8632c63.png)
1.确定坐标系,图中RGB分别对应XYZ。
1.1 双目坐标系原点位于左摄像机光心,注意'左'是沿着摄像头采集图像的方向看哦,光心射出的方向为Z+,另外光心这东西无法精准定位,本demo中为臆测,。
1.2 云台坐标系原点为基座舵机旋转轴中心,沿着激光射出的方向为X+。
![e315233aaae61cd5a4256548236eee02.png](https://img-blog.csdnimg.cn/img_convert/e315233aaae61cd5a4256548236eee02.png)
2.如何确定变换矩阵
坐标点变换的思路为: 双目获区坐标位置CamPos -> 矩阵变换 ->云台坐标系ServoPos。
servoPos = camFrame2ServoFrame*camPos
我们要求相机坐标系到云台坐标系的变换,按照下面的规则: