一种垃圾分选机器人高精度手眼标定方法技术

本发明专利技术公开了一种垃圾分选机器人高精度手眼标定方法，适用并联机器人的eye

【技术实现步骤摘要】
一种垃圾分选机器人高精度手眼标定方法


[0001]本专利技术涉及机器人手眼标定方法
，具体涉及一种垃圾分选机器人高精度手眼标定方法。

技术介绍

[0002]随着生活垃圾中以PET、PE等塑料为主的可回收物比例逐年上升，传统的焚烧、填埋等方法处置成本高、对环境造成负担重；目前针对生活垃圾的再生处理方式多为人工分选，工人工作环境恶劣，且人工分选效率低、错误率高。因此，基于人工智能及机器人技术实现对生活垃圾中可回收物的自动分拣对再生资源产业有着革命性的意义。
[0003]既有的自动化分拣一般采用六轴工业机器人代替人工进行作业，但其重复定位精度较低，无法应用在高精度要求的场合。而并联机器人由于其刚度高、结构稳定、精度高、运动惯量小、控制简单、速度快等优点，在垃圾分选领域具有极高的应用价值，尤其适用于需要进行快速抓取操作且定位精度要求较高的可再生资源分选场合使用。通过结合视觉算法与并联机器人技术，可以解决传统机器人分选作业高度结构化、机器人对环境变化的适应能力低、生产线的柔性差等问题。
[0004]为避免由视觉系统、机器人参数、控制系统因素等造成的误差，实现并联机器人准确、快速、无损抓取控制，高精度的手眼标定是必要前提。手眼标定是统一视觉系统和机器人的坐标系统，从而使视觉系统所确定的物体位姿转换到机器人坐标系下，由机器人完成对相关特征的处理过程。但是，并联机器人发展起步晚，目前普遍存在因相机镜头畸变及相机内部参数导致的并联机器人手眼标定精度低、手眼标定操作复杂的问题，因而研发出一种易操作的高精度手眼标定方法用于实现并联机器人的精准高效抓取是当前亟需解决的问题。

技术实现思路

[0005]本专利技术要解决的技术问题是提供一种垃圾分选机器人高精度手眼标定方法，解决了现有eye
‑
to
‑
hand并联机器人的标定方法由于相机镜头畸变导致标定精度低，进而物料抓取不良的问题；通过将消除相机畸变与相机内外参标定和机器人标定有机结合，大大降低了标定误差，从而实现了标定精度控制在0.1mm。
[0006]为解决上述技术问题，本专利技术采取如下技术方案：本专利技术的一种垃圾分选机器人高精度手眼标定方法，适用并联机器人的eye
‑
to
‑
hand系统，且该系统由视觉模块、机器人模块、传送模块三部分构成；其创新点在于包括以下步骤：
[0007](1)求解相机参数与姿态矩阵；
[0008](2)求解相机内参矩阵与畸变矩阵，完成像素坐标系与相机坐标系转换；
[0009](3)利用map_image算子进行映射变换来消除畸变，并得到修正后的参考平面图像；
[0010](4)求解相机外参，完成相机坐标系与对应的世界坐标系之间的转换；
[0011](5)采用九点标定法进行世界坐标系到机器人坐标系的转换。
[0012]优选的，在上述步骤(1)中，消除相机镜头畸变的具体流程为：
[0013](1.1)将halcon圆点标定板置于传送带表面任意位置，确保圆点标定板完全暴露于相机视野范围内，并通过相机采集多张圆点标定板图片；
[0014](1.2)将采集到的图片导入halcon软件，并通过halcon标定助手求解出相机的参数与姿态矩阵。
[0015]优选的，在上述步骤(2)中，像素坐标系与相机坐标系转换的具体流程为：
[0016](2.1)求解相机内参；将每一个棋盘格标定板分别放置在传送带上的不同位置，在同一相机视野范围下，确保圆点标定板完全暴露于相机视野范围内；采集多张不同角度及位置的棋盘格标定板照片，并将图片导入matlab；
[0017](2.2)通过matlab对棋盘格标定板的角点进行识别，并对相机进行标定，得到相机的3*3上三角内参矩阵与相机畸变参数矩阵。
[0018]优选的，在上述步骤(2.1)中，每一个棋盘格标定板分别放置在传送带上的不同位置。
[0019]优选的，在上述步骤(3)中，得到修正后的参考平面图像的具体流程为：
[0020](3.1)将棋盘格标定板平放于传送带一固定位置，作为世界坐标系参考平面；
[0021](3.2)通过相机获取参考平面图像并导入halcon，再根据步骤(1.2)中得到的相机参数与姿态矩阵，通过halcon算子gen_image_to_world_plane_map生成图像平面和世界坐标系的平面之间的映射的投影图；
[0022](3.3)利用map_image算子进行映射变换来消除畸变，并得到修正后的参考平面图像。
[0023]优选的，在上述步骤(3.2)中，世界坐标系的平面即为z＝0状态下的平面。
[0024]优选的，在上述步骤(4)中，相机坐标系与世界坐标系转换的具体流程为：
[0025](4.1)在修正后的参考平面图像中任意选取一个角点作为世界坐标系的坐标原点，以棋盘格相互垂直的两边方向分别作为x轴、y轴方向；
[0026](4.2)随机选取4个角点提取其像素坐标，并通过棋盘格标定板参数计算对应的世界坐标(x
w
，y
w
，z
w
)；其中，
[0027]x
w
＝n*d
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)
[0028]y
w
＝n*d
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(2)
[0029]z
w
＝0
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(3)
[0030]式中，n为角点距坐标原点棋盘格数量，d为每一小格边长；
[0031](4.3)求解相机外参；在OpenCV中分别输入通过步骤(2.2)获得的相机内参矩阵、畸变参数矩阵以及(4.2)获得的四点像素坐标与对应世界坐标；
[0032](4.4)通过OpenCV中的solvePNP算子求解出相机外参，即旋转矩阵R和平移矩阵T；
[0033]优选的，根据上述步骤(2)～(4)，可将像素坐标系到世界坐标系的转换通过如下公式进行概括：
[0034]将像素坐标、对应的位置信息以及内外参数带入相机参数公式中确定相机参数，且相机参数的确定公式为：
[0035][0036]其中，u和v分别为像素坐标系中的像素横坐标和像素纵坐标；x
w
、y
w
、z
w
分别为世界坐标系中的横坐标、纵坐标和竖坐标；R为旋转矩阵；T为平移矩阵；u0、v0、f
x
、f
y
为相机内参，即u0和v0分别为图像中心横坐标和图像中心纵坐标，f
x
和f
y
分别为横向等效焦距和纵向等效焦距；s为相机坐标系中的相机坐标；
[0037]其求解过程为：
[0038][0039][0040]s＝f/c本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种垃圾分选机器人高精度手眼标定方法，适用并联机器人的eye
‑
to
‑
hand系统，且该系统由视觉模块、机器人模块、传送模块三部分构成；其特征在于包括以下步骤：(1)求解相机参数与姿态矩阵；(2)求解相机内参矩阵与畸变矩阵，完成像素坐标系与相机坐标系转换；(3)利用map_image算子进行映射变换来消除畸变，并得到修正后的参考平面图像；(4)求解相机外参，完成相机坐标系与对应的世界坐标系之间的转换；(5)采用九点标定法进行世界坐标系到机器人坐标系的转换。2.根据权利要求1所述的一种垃圾分选机器人高精度手眼标定方法，其特征在于：在上述步骤(1)中，消除相机镜头畸变的具体流程为：(1.1)将halcon圆点标定板置于传送带表面任意位置，确保圆点标定板完全暴露于相机视野范围内，并通过相机采集多张圆点标定板图片；(1.2)将采集到的图片导入halcon软件，并通过halcon标定助手求解出相机的参数与姿态矩阵。3.根据权利要求2所述的一种垃圾分选机器人高精度手眼标定方法，其特征在于：在上述步骤(2)中，像素坐标系与相机坐标系转换的具体流程为：(2.1)求解相机内参；将每一个棋盘格标定板分别放置在传送带上的不同位置，在同一相机视野范围下，确保圆点标定板完全暴露于相机视野范围内；采集多张不同角度及位置的棋盘格标定板照片，并将图片导入matlab；(2.2)通过matlab对棋盘格标定板的角点进行识别，并对相机进行标定，得到相机的3*3上三角内参矩阵与相机畸变参数矩阵。4.根据权利要求3所述的一种垃圾分选机器人高精度手眼标定方法，其特征在于：在上述步骤(2.1)中，每一个棋盘格标定板分别放置在传送带上的不同位置。5.根据权利要求3所述的一种垃圾分选机器人高精度手眼标定方法，其特征在于：在上述步骤(3)中，得到修正后的参考平面图像的具体流程为：(3.1)将棋盘格标定板平放于传送带一固定位置，作为世界坐标系参考平面；(3.2)通过相机获取参考平面图像并导入halcon，再根据步骤(1.2)中得到的相机参数与姿态矩阵，通过halcon算子gen_image_to_world_plane_map生成图像平面和世界坐标系的平面之间的映射的投影图；(3.3)利用map_image算子进行映射变换来消除畸变，并得到修正后的参考平面图像。6.根据权利要求5所述的一种垃圾分选机器人高精度手眼标定方法，其特征在于：在上述步骤(3.2)中，世界坐标系的平面即为z＝0状态下的平面。7.根据权利要求5所述的一种垃圾分选机器人高精度手眼标定方法，其特征在于：在上述步骤(4)中，相机坐标系与世界坐标系转换的具体流程为：(4.1)在修正后的参考平面图像中任意选取一个角点作为世界坐标系的坐标原点，以棋盘格相互垂直的两边方向分别作为x轴、y轴方向；(4.2)随机选取4个角点提取其像素坐标，并通过棋盘格标定板参数计算对应的世界坐标(x
w
，y
w

【专利技术属性】
技术研发人员：严圣军，刘德峰，梅文豪，王思雨，
申请(专利权)人：上海智楹机器人科技有限公司中国天楹股份有限公司江苏天楹环保能源成套设备有限公司，
类型：发明
国别省市：