1、为什么要用手眼标定
参考手眼标定特别是眼在手上在网上的文章很多,但很多在实际中调试不通。在定位时候,往往希望相机能返回的是机械的世界坐标,而不是相机的的图像坐标。从而间接计算出相机坐标系与机械坐标世界坐标转换矩阵,以镜头中心为参考点。
2、手眼标定的实现
stp1:移动模组3*3 ,3行3列,分别模组走一个点(Bx,By),相机拍照获取一张图片Mark的坐标(Ax,Ay)的坐标。
*已知相机的9个点
Ax:=[825.505,1116.06,1405.89,830.793,1121.89,1412.44,836.321,1127.35,1417.95]
Ay:=[1413.87,1419.22,1423.91,1122.52,1128.24,1133.46,830.913,836.734,842.063]
*分别对应相机Mark点的模组获取的坐标
Bx:=[-152.7289,-153.7289,-154.7289,-152.7289,-153.7289,-154.7289,-152.7289,-153.7289,-154.7289]
By:=[-92.8409,-92.8409,-92.8409,-93.8409,-93.8409,-93.8409,-94.8409,-94.8409,-94.8409]
stp2:仿射变换求出仿射矩阵HomMat2D
vector_to_hom_mat2d ( Ax, Ay, Bx, By,HomMat2D)
stp3:求世界坐标
手眼标定,以相机中心
1、求出base,以图像dqx1, dqy1(0,0)为参考点
affine_trans_point_2d (HomMat2D, 0, 0, dqx1, dqy1)
2、求出图像Mark坐标(pixx:=1417.95,pixy:=842.063)到图像中心点坐标的世界坐标(标定时候的)中心点(1024,1224)
dpix:=1024-pixx
dpiy:=1224-pixy
affine_trans_point_2d (HomMat2D, dpix, dpiy, dqx, dqy)
3、求出偏差Offset dqx2,dqy2
dqx2:=dqx-dqx1
dqy2:=dqy-dqy1
4、模组获取反馈的运动控制的坐标realx,raaly,求出镜头中心实际坐标realx3,realy3文章来源:https://www.toymoban.com/news/detail-634147.html
realx3:=realx+dqx2
realy3:=raaly+dqy2文章来源地址https://www.toymoban.com/news/detail-634147.html
read_image(Image, 'printer_chip/printer_chip_01')
*已知A坐标系的9个点
Ax:=[825.505,1116.06,1405.89,830.793,1121.89,1412.44,836.321,1127.35,1417.95]
Ay:=[1413.87,1419.22,1423.91,1122.52,1128.24,1133.46,830.913,836.734,842.063]
*待识别的B坐标点,和上面的A坐标系点一一对应
Bx:=[-152.7289,-153.7289,-154.7289,-152.7289,-153.7289,-154.7289,-152.7289,-153.7289,-154.7289]
By:=[-92.8409,-92.8409,-92.8409,-93.8409,-93.8409,-93.8409,-94.8409,-94.8409,-94.8409]
* for Index := 1 to 9 by 1
* dev_display (Image)
* 以下过程为在B坐标系找A中的9个点
* draw_rectangle1 (200000, Row1, Column1, Row2, Column2)
* gen_rectangle1 (Rectangle, Row1, Column1, Row2, Column2)
* reduce_domain (Image, Rectangle, ImageReduced)
* binary_threshold (ImageReduced, Region, 'max_separability', 'light', UsedThreshold)
* connection (Region, ConnectedRegions)
* select_shape (ConnectedRegions, SelectedRegions, 'roundness', 'and', 0.7, 1)
* select_shape (SelectedRegions, SelectedRegion2, 'rb', 'and', 32, 100)
* fill_up (SelectedRegions, RegionFillUp)
*找到了B坐标系的点(Row,Column)
* area_center (RegionFillUp, Area, Row, Column)
* Bx:=[Bx,Column]
* By:=[By,Row]
* endfor
*得到目标变换矩阵HomMat2D
vector_to_hom_mat2d ( Ax, Ay, Bx, By,HomMat2D)
vector_to_hom_mat2d ( Bx, By, Ax, Ay,HomMat2DINV)
********new realx raaly机械反馈的坐标
realx:=-154.7289
raaly:=-94.8409
pixx:=1417.95
pixy:=842.063
dpix:=1024-pixx
dpiy:=1224-pixy
affine_trans_point_2d (HomMat2D, dpix, dpiy, dqx, dqy)
affine_trans_point_2d (HomMat2D, 0, 0, dqx1, dqy1)
dqx2:=dqx-dqx1
dqy2:=dqy-dqy1
realx3:=realx+dqx2
realy3:=raaly+dqy2
到了这里,关于手眼标定眼在手上的文章就介绍完了。如果您还想了解更多内容,请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章,希望大家以后多多支持TOY模板网!