验真标定结果
通过上一步,我们已经获得标定矩阵和旋转中心。那肯定需要验证这两个参数是否准确。
验真方法就是计算将图像点和标定矩阵转换过的坐标点,和标定时的参数差距多大。
将对理论值-实际值求平均值就能得到RMS
计算机器人实际坐标
如果是共轴机构,那么采用九点标定就足够了。如果不是共轴机构或者要求高精度,尽量选择12/15点标定,因为旋转会带来误差,计算出旋转中心和手心是必要的。
现在已知旋转中心物理坐标,示教物理姿态,目标物理姿态,在分离轴的情况下,如何计算机器人坐标,使工具对准目标。
先旋转,后平移
1. 计算角度偏差。目标-示教得出,然后将目标姿态旋转偏差角度得出一个虚拟位置。
2.计算平移偏差。目标-虚拟得出,这相当于将角度对好的虚拟物料,平移至目标位置。
偏差位姿=(平移偏差,角度偏差)
机器人位姿=示教位姿+平移位姿
注意点
手眼关系:手在眼上和手在眼外会影响平移时给到机器人的偏差位姿的正负号。
手性:会影响旋转时给到机器人的位姿偏差的正负号