一种基于单目视觉的线缆盘轴位姿确定方法

1.本发明涉及位姿检测技术领域，尤其涉及一种基于单目视觉的线缆盘轴位姿确定方法。


背景技术：

2.线缆盘的装配任务主要是由车间工作人员手动将线缆盘抬起，装配至装有轴的控制柜上，进而完成后续的工作任务；线缆盘重可达几十公斤，长时间高强度的工作易引起操作人员的疲劳，进而影响工厂的运行效率。利用机器人完成线缆盘的装配可以有效的节省人力，提高工厂的自动化程度。典型的机器人装配工作大多服务于批量任务，现场操作人员利用示教方法通过设定的轨迹来实现工件的装配任务。此类方法需要预先设定待装配工件的位姿且固定不变，但线缆盘轴所在的柜体容易出现水平方向的偏移及绕竖直方向的偏转，因而相关产线缺乏柔性和通用性，难以满足现代工业定制化的需求。近年来，运用视觉技术进行目标检测识别和空间位姿的获取，进而引导机器人自主装配已经成为工业生产中的一大趋势。机器视觉技术使得机器人更好地适应多变的装配环境，生产线变得更加智能化。本发明利用单目视觉技术进行线缆盘轴位姿的检测，进而引导机器人完成装配任务，提高生产效率。


技术实现要素：

3.针对现有算法的不足，本发明利用单目视觉进行线缆盘轴位姿的检测，可以引导机器人完成自主装配任务。
4.本发明所采用的技术方案是：一种基于单目视觉的线缆盘轴位姿确定方法包括以下步骤：
5.s1、将相机安装至机器人工具末端，离线完成相机标定和eye in hand手眼标定；
6.通过相机标定将相机的像素坐标转换到世界坐标系中；
7.通过eye in hand手眼标定实现校准对象(calobjinbasepose)的坐标系中机器人基座的姿态，以及相机在工具中心点坐标系中的姿态；
8.进一步的，保持相机位姿固定，移动标定板使得其出现在图像平面的各个位置，采集标定板图像，灰度化处理后进行相机标定，获取相机标定参数；保持标定板固定，操作末端执行器运动，采集不同位姿下标定板图像并记录末端执行器位姿信息，并进行手眼标定，获取相机和末端执行器的位姿变换矩阵；
9.s2、利用相机采集图像，完成装配轴底盘目标位置的检测，调整机器臂使相机运动至装配轴底盘；
10.进一步的，根据装配轴底盘轮廓信息采用halcon中create_shape_model算子构建形状模型，记此时模板中心坐标，利用halcon中image_points_to_world_plane算子将模板中心像素坐标转换至实际世界中物理坐标，记为装配标准位置p0；机械臂定点抓取线缆盘后运动至装配标准位置，启动相机获取当前装配轴所在柜体图像并灰度化处理；利用形状
模板匹配方法检测当前图像中装配轴底盘目标，根据find_shape_model算子获取装配轴底盘的中心像素坐标，利用image_points_to_world_plane算子将装配轴底盘的中心像素坐标转换至实际世界中物理坐标p1；通过公式计算得到当前位置与标准位置在水平方向的实际偏差距离，其中，p0
x
,p0y,p1
x
,p1y分别表示p0和p1的横纵坐标；
11.s3、再次拍照获取装配轴端面圆心和底盘圆心几何信息，计算线盘轴所在柜体的偏转角度；
12.进一步的，启动相机获取装配轴图像并灰度化处理，根据装配轴所在高度信息，建立roi区域；运用canny算子提取目标边缘后，根据轮廓的长度信息筛选去除噪声信息，再利用圆拟合fit_circle_contour_xld算子检测装配轴端面圆和底盘圆特征，获取轴端面圆像素半径r，计算轴端面圆心和底盘圆心像素偏差
△
d，其中，坐标(p0
′
x
,p0
′y)为轴端面圆心像素坐标，坐标(p1
′
x
,p1
′y)为底盘圆心像素坐标；根据端面圆实际物理半径r及装配轴实际物理尺寸l，计算所在柜体的偏转角度，记根据像素偏差
△
d的符号判断旋转方向；
13.s4、调整机械臂末端手爪位姿与柜体的偏转θ后平行，将线盘装配至目标轴。
14.本发明的有益效果是：
15.通过建立eye in hand手眼模型，利用视觉完成装配轴底盘目标位置的检测，根据装配轴端面和底盘几何信息获取线盘轴所在柜体的偏转角度，引导机器人完成线缆盘的装配；
16.利用单目视觉完成目标位姿的检测，有利于机器人实现自动化和柔性装配，降低人工及硬件成本，本发明的位姿确定算法适用于视觉引导机器人完成其它工件的装配任务。
附图说明
17.图1是本发明的基于单目视觉的线缆盘轴位姿确定方法流程图；
18.图2是本发明装配轴所在柜体偏转角度检测示意图；
19.图2中1、柜体；2、底盘；3、装配轴。
具体实施方式
20.下面结合附图和实施例对本发明作进一步说明，此图为简化的示意图，仅以示意方式说明本发明的基本结构，因此其仅显示与本发明有关的构成。
21.如图1所示，一种基于单目视觉的线缆盘轴位姿确定方法，包括以下步骤：
22.s1、将相机安装至机器人工具末端，离线完成相机标定和eye in hand手眼标定；
23.保持相机位姿固定，移动标定板使得其出现在图像平面的各个位置，采集标定板图像，灰度化处理后进行相机标定，获取相机参数模型['area_scan_division',
0.00402935,-4690.98,4.79754e-006,4.8e-006,642.842,507.017,1280,1024]；保持标定板固定，操作末端执行器运动，采集不同位姿下标定板图像并记录末端执行器位姿信息，进行手眼标定，获取相机及末端执行器的位姿变换矩阵toolincampose＝[0.108737,-0.0374802,-0.0642094,359.643,359.465,179.725,0]；
[0024]
s2、使用时利用相机采集图像，利用装配轴底盘轮廓信息及相机标定参数计算获取水平位置偏差信息-47mm，调整机器臂末端水平方向移动47mm使相机对准装配轴底盘；
[0025]
如图2所示，s3、已知装配轴端面半径物理尺寸r＝17mm，物理尺寸轴长l＝400mm，再次拍照获取装配轴端面圆心和底盘圆心几何信息，以此计算线盘轴所在柜体的偏转弧度θ
′
，转换为角度信息：θ＝θ
′
*180/3.14；
[0026]
s4、调整机械臂末端手爪使得相机与柜体的偏转角度θ后平行，根据手眼标定矩阵中的位置和旋转角度信息操作末端执行器使得线盘装配至目标轴。
[0027]
本发明通过建立eye in hand手眼模型，利用视觉完成装配轴底盘目标位置的检测，根据装配轴端面和底盘几何信息获取线盘轴所在柜体的偏转角度，引导机器人完成线缆盘的装配；利用单目视觉完成目标位姿的检测，有利于机器人实现自动化和柔性装配，降低人工及硬件成本，本发明的位姿确定算法适用于视觉引导机器人完成其它工件的装配任务。
[0028]
以上述依据本发明的理想实施例为启示，通过上述的说明内容，相关工作人员完全可以在不偏离本项发明技术思想的范围内，进行多样的变更以及修改。本项发明的技术性范围并不局限于说明书上的内容，必须要根据权利要求范围来确定其技术性范围。