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

本发明专利技术涉及位姿检测技术领域，尤其涉及一种基于单目视觉的线缆盘轴位姿确定方法，包括S1、将相机安装至机器人工具末端，离线完成相机标定和eyein hand手眼标定；S2、利用相机采集图像，完成装配轴底盘目标位置的检测，调整机器臂使相机运动至装配轴底盘；S3、再次拍照获取装配轴端面圆心和底盘圆心几何信息，计算线盘轴所在柜体的偏转角度；S4、调整机械臂末端手爪位姿与柜体的偏转角度平行，将线盘装配至目标轴。本发明专利技术利用单目视觉进行线缆盘轴位姿的检测，可以引导机器人完成自主装配任务。可以引导机器人完成自主装配任务。可以引导机器人完成自主装配任务。

A method to determine the axis position and orientation of cable tray based on monocular vision

【技术实现步骤摘要】
一种基于单目视觉的线缆盘轴位姿确定方法


[0001]本专利技术涉及位姿检测
，尤其涉及一种基于单目视觉的线缆盘轴位姿确定方法。

技术介绍

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

技术实现思路

[0003]针对现有算法的不足，本专利技术利用单目视觉进行线缆盘轴位姿的检测，可以引导机器人完成自主装配任务。
[0004]本专利技术所采用的技术方案是：一种基于单目视觉的线缆盘轴位姿确定方法包括以下步骤：
[0005]S1、将相机安装至机器人工具末端，离线完成相机标定和eye in hand手眼标定；
[0006]通过相机标定将相机的像素坐标转换到世界坐标系中；
[0007]通过eye in hand手眼标定实现校准对象(CalObjInBasePose)的坐标系中机器人基座的姿态，以及相机在工具中心点坐标系中的姿态；
[0008]进一步的，保持相机位姿固定，移动标定板使得其出现在图像平面的各个位置，采集标定板图像，灰度化处理后进行相机标定，获取相机标定参数；保持标定板固定，操作末端执行器运动，采集不同位姿下标定板图像并记录末端执行器位姿信息，并进行手眼标定，获取相机和末端执行器的位姿变换矩阵；
[0009]S2、利用相机采集图像，完成装配轴底盘目标位置的检测，调整机器臂使相机运动至装配轴底盘；
[0010]进一步的，根据装配轴底盘轮廓信息采用halcon中create_shape_model算子构建形状模型，记此时模板中心坐标，利用halcon中image_points_to_world_plane算子将模板中心像素坐标转换至实际世界中物理坐标，记为装配标准位置P0；机械臂定点抓取线缆盘后运动至装配标准位置，启动相机获取当前装配轴所在柜体图像并灰度化处理；利用形状
模板匹配方法检测当前图像中装配轴底盘目标，根据find_shape_model算子获取装配轴底盘的中心像素坐标，利用image_points_to_world_plane算子将装配轴底盘的中心像素坐标转换至实际世界中物理坐标P1；通过公式计算得到当前位置与标准位置在水平方向的实际偏差距离，其中，P0
x
,P0
y
,P1
x
,P1
y
分别表示P0和P1的横纵坐标；
[0011]S3、再次拍照获取装配轴端面圆心和底盘圆心几何信息，计算线盘轴所在柜体的偏转角度；
[0012]进一步的，启动相机获取装配轴图像并灰度化处理，根据装配轴所在高度信息，建立ROI区域；运用Canny算子提取目标边缘后，根据轮廓的长度信息筛选去除噪声信息，再利用圆拟合fit_circle_contour_xld算子检测装配轴端面圆和底盘圆特征，获取轴端面圆像素半径R，计算轴端面圆心和底盘圆心像素偏差
△
d，其中，坐标(p0
′
x
,p0
′
y
)为轴端面圆心像素坐标，坐标(p1
′
x
,p1
′
y
)为底盘圆心像素坐标；根据端面圆实际物理半径r及装配轴实际物理尺寸L，计算所在柜体的偏转角度，记根据像素偏差
△
d的符号判断旋转方向；
[0013]S4、调整机械臂末端手爪位姿与柜体的偏转θ后平行，将线盘装配至目标轴。
[0014]本专利技术的有益效果是：
[0015]通过建立eye in hand手眼模型，利用视觉完成装配轴底盘目标位置的检测，根据装配轴端面和底盘几何信息获取线盘轴所在柜体的偏转角度，引导机器人完成线缆盘的装配；
[0016]利用单目视觉完成目标位姿的检测，有利于机器人实现自动化和柔性装配，降低人工及硬件成本，本专利技术的位姿确定算法适用于视觉引导机器人完成其它工件的装配任务。
附图说明
[0017]图1是本专利技术的基于单目视觉的线缆盘轴位姿确定方法流程图；
[0018]图2是本专利技术装配轴所在柜体偏转角度检测示意图；
[0019]图2中1、柜体；2、底盘；3、装配轴。
具体实施方式
[0020]下面结合附图和实施例对本专利技术作进一步说明，此图为简化的示意图，仅以示意方式说明本专利技术的基本结构，因此其仅显示与本专利技术有关的构成。
[0021]如图1所示，一种基于单目视觉的线缆盘轴位姿确定方法，包括以下步骤：
[0022]S1、将相机安装至机器人工具末端，离线完成相机标定和eye in hand手眼标定；
[0023]保持相机位姿固定，移动标定板使得其出现在图像平面的各个位置，采集标定板图像，灰度化处理后进行相机标定，获取相机参数模型['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、调整机械臂末端手爪使得相机与柜体的偏转角度θ后平行，根据手眼标定矩阵中的位置和旋转角度信息操作末端执行本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于单目视觉的线缆盘轴位姿确定方法，其特征在于，包括以下步骤：S1、将相机安装至机器人工具末端，离线完成相机标定和eye in hand手眼标定；S2、利用相机采集图像，完成装配轴底盘目标位置的检测，调整机器臂使相机运动至装配轴底盘；S3、再次拍照获取装配轴端面圆心和底盘圆心几何信息，以此计算线盘轴所在柜体的偏转角度；S4、调整机械臂末端手爪位姿与柜体的偏转角度平行，将线盘装配至目标轴。2.根据权利要求1所述的基于单目视觉的线缆盘轴位姿确定方法，其特征在于，所述步骤S2包括：根据装配轴底盘轮廓采用create_shape_model算子构建形状模型，获得模板中心坐标，利用image_points_to_world_plane算子将模板中心像素坐标转换至实际世界中物理坐标P0；机械臂定点抓取线缆盘后运动至装配标准位置，启动相机获取当前装配轴所在柜体图像并灰度化处理；利用形状模板匹配方法检测当前图像中装配轴底盘目标，根据find_shape_model算子获取装配轴底盘的中心像素坐标，利用image_points_to_world_plane算子将装配轴底盘的中心像素坐标转换至实际世...

【专利技术属性】
技术研发人员：谢小敏，蒋庆斌，周斌，王斌，许文稼，王风光，刘凯，吴梅，吴玲玲，马永骋，
申请(专利权)人：常州机电职业技术学院，
类型：发明
国别省市：