一种机器人手臂抓取控制方法及系统与流程

1.本发明涉及机械控制技术领域，尤其涉及一种机器人手臂抓取控制方法及系统。


背景技术：

2.近两年，机器人协作方式广泛应用于模具设计、模具制造、模具热处理等一系列完整的模具制造生产线中，由于生产厂家采用高精密的加工设备和进口的模具材料，并且掌握铝合金挤压、压铸、深加工以及铝合金表面处理等工艺，特别需要在生产线中采用高精度的机器人控制。
3.协作机器人发展迅速，因协作机器人的应用可降低生产成本、提高劳动效率和生产系统整体柔性，已逐步应用于汽车、3c、it电子行业等诸多精密行业领域，尤其是小型零部件的装配应用。
4.例如，大规模生产是汽车相关技术的主流，但是近来，车辆的类型已经变得多样化，并且型号变化频繁。在这种情况下，作为用于在汽车内部部件中模制由塑料材料形成的较大形状的模具，例如，诸如汽车座椅的聚氨酯填充物(座垫)，成本，交货日期，所需的精度等。从这个角度来看，许多模具是通过铸造制成的。
5.作为制造这种模具的方法，通常采用以下方法。
6.(1)模型切割工艺：使用合成树脂材料(例如氨基甲酸酯或苯乙烯)，通过手工切割或nc加工来制造模型(通常称为主模型)。
7.(2)表面处理步骤：处理模型表面以提高所创建模型的表面精度。
8.(3)母模制造工艺：通过提供凸缘，辅助肋，用于提供模子壁厚的壁厚薄板等来制备主模，以便通过铸造制造原型。
9.(4)制模步骤：在上述主模中填充沙子以制模。
10.(5)原型铸造步骤：将熔融的原型材料(例如铝合金)注入模具中以铸造原型。
11.(6)精加工工序：通过放电加工等对通过铸造而制作的原型进行精加工。
12.通过协作机器人作为人工的替代以达到更高的精度是现有技术发展的趋势，协作机器人手臂在高速动作过程中不能产生晃动，是实现了高速而且平滑的动作性能关键，同时协作机器人手臂很苗条但是承载载荷很大，所以即使被安装在狭小的空间进行使用，同时可以让机器人手臂与周围设备发生碰撞的可能性控制在最低限度。随着智能化和人机协同工作，传感器电缆、附加轴电缆、电磁阀、空气导管和用来控制工具的i/o电缆都内置于狭小的手臂中。所以轻量化、高刚性、内腔高精度、外表面美观精致的手臂是协作机器人未来核心竞争的关键。
13.机器人手臂抓取产品大量运用于工业生产，大大提高了产业效率，节约了资源。仿人服务机器人也在特殊行业得到很大发展，对于服务机器人的运用来说，其抓取识别系统是主要关键。基本原理是通过视觉识别产品轮廓获得物体位置与抓取位置控制机械手臂内的伺服电机去完成抓取动作。
14.然而，现在的机器人视觉抓取通常对视觉要求很好，其摄像设备经常需要进行校
准，同时，如果更换更高精度的摄像头则需要重新标定，标定的方式也不够灵活，需要管理者根据情况人工处理。


技术实现要素：

15.本发明旨在至少解决现有技术中存在的技术问题之一。为此，本发明公开一种机器人手臂抓取控制方法，方法包括：步骤1，机器人对自身状态进行初始化，获得当前机器人状态对应的重要参数是否在线，根据所述重要参数选择所述机器视觉的标定方式；步骤2，首先检测所述重要参数是否包括实现机器视觉的设备的具体参数，若存在着执行步骤3，若不包含所述具体参数，则检测是否存在确定大小参数的标定模板，若存在则执行步骤4；若所述重要参数既不包括所述具体参数也不包含所述标定模板，则确定所述实现机器视觉的设备的移动轨迹，并执行步骤5；
16.步骤3，通过所述实现机器视觉的设备的具体参数之间的关系进行标定；步骤4，若所述重要参数包括确定大小参数的标定模板可以作为当前所述机器视觉设备的基础参照物，则根据所述的标定模板构建图像点与标定模板已知坐标信息的关系，建立出几何关系模型，再根据预设算法得到机器视觉的内外参数进行标定；步骤5，根据所述移动轨迹上的不同坐标点上攫取的图像，通过对比不同点坐标攫取的图像确定所述实现机器视觉的设备的参数，并根据确定的参数实现标定；步骤6，在完成视觉标定后，对带抓取的目标物体进行图像攫取，并对获得的图像进行预处理，所述图像预处理包括图像滤波、图像增强和特征提取；步骤7，获取处理后的目标物体的图像的轮廓信息，并对所述轮廓进行坐标转换计算抓取的三维空间坐标和角度以完成目标物体的抓取。
17.更进一步地，所述获得当前机器人状态对应的重要参数是否在线进一步包括：检测第三方的视觉获取的设备与机器人的连接状态，并确定该设备的参数是否进行校准更新，若该设备处于离线状态，则调用机器人本技术的摄像装置获取视觉；若第三方的视觉获取的设备在线且参数并未校准更新或者校准更新的时间超过预设时间长度，判定该设备的重要参数需要进行标定。
18.更进一步地，所述步骤3进一步包括通过单应性矩阵计算所述实现机器视觉的设备的参数值。
19.更进一步地，所述步骤7进一步包括：在进行物体的抓取时，确定所述目标物体上的两个及两个以上的抓取点，机器人根据抓取点的确定模拟的抓取动作。
20.更进一步地，当确定抓取点的数量为二时，将所述抓取点设置为所述目标体的边缘位置。
21.更进一步地，所述步骤6进一步包括所述图像滤波的滤波器函数的输出灰度值为：
[0022][0023]
其中，a，b为在像素点中心建立的矩形窗口大小的一半，k(s，t)为滤波器核函数，f(x-s，y-t)为所述矩形窗口内像素点的灰度值。
[0024]
更进一步地，机器人根据抓取点的确定模拟的抓取动作进一步包括：在确定了模拟结果后，调用matlab仿真中的robotics toolbox中的正解函数和逆解函数可以对机器人的运动学正逆解进行仿真教研确定模拟结果的可行性。
[0025]
更进一步地，所述模拟结果包括：二指抓取、三指抓取、多指抓取。
[0026]
本发明进一步公开了一种电子系统，包括存储器和处理器，所述存储器上存储有计算机程序，该计算机程序被所述处理器执行时，执行上述的机器人手臂抓取控制方法。
[0027]
本发明进一步公开了一种计算机可读存储介质，所述计算机可读存储介质中包括实时风险控制程序，该实时风险控制程序被处理器执行时实现上述的机器人手臂抓取控制方法的步骤。
[0028]
本发明与现有技术相比，本发明的有益效果是：
①
标定完全自动化，对所有的标定情况都可以自动进行标定；
②
机器人抓取的方式可以根据抓取物体的不同自动选择多个抓取方式，并在选择后进行验证，实现人工的完全自由，管理者在进行管理时不需要浪费过多的关注。
附图说明
[0029]
从以下结合附图的描述可以进一步理解本发明。图中的部件不一定按比例绘制，而是将重点放在示出实施例的原理上。在图中，在不同的视图中，相同的附图标记指定对应的部分。
[0030]
图1是本发明的一种机器人手臂抓取控制好方法的流程图。
具体实施方式
[0031]
下面将结合附图及实施例对本发明的技术方案进行更详细的说明。
[0032]
现在将参考附图描述实现本发明各个实施例的移动终端。在后续的描述中，使用用于表示元件的诸如“模块”、“部件”或“单元”的后缀仅为了有利于本发明的说明，其本身并没有特定的意义。因此，"模块"与"部件"可以混合地使用。
[0033]
移动终端可以以各种形式来实施。例如，本发明中描述的终端可以包括诸如移动电话、智能电话、笔记本电脑、数字广播接收器、pda(个人数字助理)、pad(平板电脑)、pmp(便携式多媒体播放器)、导航装置等等的移动终端以及诸如数字tv、台式计算机等等的固定终端。下面，假设终端是移动终端。然而，本领域技术人员将理解的是，除了特别用于移动目的的元件之外，根据本发明的实施方式的构造也能够应用于固定类型的终端。
[0034]
如图1所示的一种机器人手臂抓取控制方法，方法包括：步骤1，机器人对自身状态进行初始化，获得当前机器人状态对应的重要参数是否在线的结果，根据所述重要参数选择所述机器视觉的标定方式；
[0035]
在该实施例中，机器人对应的重要参数为可以标定机器人视觉的参数，例如具体摄像模组的参数，或者是在机器人视觉范围内的确定大小的模板，例如已知长宽高的长方体参照物；
[0036]
在执行机器人视觉的手臂抓取控制时，需要检测当前机器人的视觉标定参数是否在线，若在线执行在线参数的标定，若离线，则采用离线标定方法进行标定。
[0037]
步骤2，首先检测所述重要参数是否包括实现机器视觉的设备的具体参数，若存
在，则执行步骤3，若不包含所述具体参数，则检测是否存在确定大小参数的标定模板，若存在则执行步骤4；若所述重要参数既不包括所述具体参数也不包含所述标定模板，则确定所述实现机器视觉的设备的移动轨迹，并执行步骤5；
[0038]
在该步骤中，重要参数包括机器视觉装置的内容参数和外部参数，摄像机的内参数由摄像机本身决定，只与摄像机本身有关。其参数有：参数矩阵(fx,fy,cx,cy)和畸变系数(三个径向k1,k2,k3；两个切向p1,p2)，摄像机的外参数是摄像机在世界坐标系中的位姿，由摄像机与世界坐标系的相对位姿关系决定。其参数有：旋转向量r(大小为1x3的矢量或旋转矩阵3x3)和平移向量t(tx,ty,tz)，标定模板也是重要参数的一部分，具体参数就是摄像机本身的可以直接标定摄像机的参数，确定大小参数标定模板为已知长宽高大小的明确具体空间大小的标定模板，一般为正方体或者其他矩形结构体。所述检测是否存在确定大小参数的标定模板为在机器视觉范围内是否存在上述的标定模板，通过标定模板完成对机器视觉的标定。即如果不能直接通过内外参数标定，再通过标定模板进行标定。
[0039]
步骤3，通过所述实现机器视觉的设备的具体参数之间的关系进行标定；步骤4，若所述重要参数包括明确确定大小参数的标定模板可以作为当前所述机器视觉设备的基础参照物，则根据所述的标定模板构建图像点与标定模板已知坐标信息的关系，建立出几何关系模型，再根据预设算法得到机器视觉的内外参数进行标定；步骤5，根据所述移动轨迹上的不同坐标点上攫取的图像，通过对比不同点坐标攫取的图像确定所述实现机器视觉的设备的参数，并根据确定的参数实现标定；步骤6，在完成视觉标定后，对带抓取的目标物体进行图像攫取，并对获得的图像进行预处理，所述图像预处理包括图像滤波、图像增强和特征提取；步骤7，获取处理后的目标物体的图像的轮廓信息，并对所述轮廓进行坐标转换计算抓取的三维空间坐标和角度以完成目标物体的抓取。
[0040]
在本实施例中，机器人初始化，对计算器视觉标定之后，对待抓取的部件进行图像采集，然后对采集的图像进行图像处理操作，通过对处理后的图像与标准部件的图像进行对比，初步判断待抓取部件的外观是否完整，也就是判断外观缺陷，采用surf(speeded up robust features)算法对处理后的图像进行部件图像的特征提取，这里选择该算法进行特征提取的目的，在于可以快速的获取目标特征。
[0041]
同时，以摄像机的坐标系和图像坐标系转换为例，摄像机坐标系与图像坐标系之间的关系可以用中心投影来表示。其转换关系如下所示：
[0042][0043]
其中，摄像机的坐标系通过ocxcyczc表示，而图像坐标系为x0y，f表示摄像机的焦距，大小为0到0c的距离。对采集的视觉图像需要进行坐标转换才可以进一步确定空间位置。
[0044]
在实施例中，对提取的图像进行坐标转换可以包括转换为世界坐标系，转换为像素坐标系等，这是现有技术中具有的技术，这里不做过度赘述。
[0045]
在转换坐标系后，计算三维空间上的坐标点和抓取的角度，控制机器人执行按照计算得到的抓取参数执行抓取动作。
[0046]
本实施例可以应用于汽车生产的环节中，具有视觉引导功能的汽车部件抓手，该
抓手设置有两个抓取部和多个视觉定位装置，实现了视觉引导下的机器人准确抓取，可以准确定位并抓取不同汽车部件。
[0047]
更进一步地，所述获得当前机器人状态对应的重要参数是否在线进一步包括：检测第三方的视觉获取的设备与机器人的连接状态，并确定该设备的参数是否进行校准更新，若该设备处于离线状态，则调用机器人本技术的摄像装置获取视觉；若第三方的视觉获取的设备在线且参数并未校准更新或者校准更新的时间超过预设时间长度，判定该设备的重要参数需要进行标定。
[0048]
更进一步地，所述步骤3进一步包括通过单应性矩阵计算所述实现机器视觉的设备的参数值。
[0049]
更进一步地，所述步骤7进一步包括：在进行物体的抓取时，确定所述目标物体上的两个及两个以上的抓取点，机器人根据抓取点的确定模拟的抓取动作。
[0050]
更进一步地，当确定抓取点的数量为二时，将所述抓取点设置为所述目标体的边缘位置。
[0051]
更进一步地，所述步骤6进一步包括所述图像滤波的滤波器函数的输出灰度值为：
[0052][0053]
其中，a，b为在像素点中心建立的矩形窗口大小的一半，k(s，t)为滤波器核函数，f(x-s，y-t)为所述矩形窗口内像素点的灰度值。
[0054]
在本实施例中，对采集的图像进行处理，这里选择设置滤波函数去除机器人视觉采集装置的噪声，例如图像中的噪点，光影影响等，因此，通过设置的滤波函数进行图像滤波得到去除干扰的灰度图像。
[0055]
图像信号在形成、传输和记录的过程中，不可避免地产生各种类型的噪声，降低了图像的质量，影响图像识别的效果或准确性，通过采用该滤波函数很好的解决了特定的机器人抓取控制中采集图像的质量问题。
[0056]
更进一步地，机器人根据抓取点的确定模拟的抓取动作进一步包括：在确定了模拟结果后，调用matlab仿真中的robotics toolbox中的正解函数和逆解函数可以对机器人的运动学正逆解进行仿真教研确定模拟结果的可行性。
[0057]
在该步骤中，通过matlab的函数对之前决定的模拟动作进行分解，并相应的函数实现执行动作的可行性分析。
[0058]
更进一步地，所述模拟结果包括：二指抓取、三指抓取、多指抓取。
[0059]
控制机器人靠近目标物体位置并确认好目标物体类型后，通过激光位移传感器对目标物体进行测量，测量信息发送到控制中心，经运算得出目标物体的倾斜旋转偏差量，控制中心控制机器人根据偏倾斜旋转差量进行姿态调整，使抓手抓取平面平行于目标物体面，然后通过相机摄取目标物体平面图像，找到目标物体上定位孔中心位置并将位置信息发送到控制中心，控制中心进行水平偏差运算，再控制机器人根据水平偏差量水平位移，同时，通过机械定位模块进行目标物体的机械定位，将定位销置入目标物体定位孔内，并通过目标物体抓取模块将目标物体固定于固定夹指和活动夹指间，可选择决定活动夹指的数量
以完成目标物体抓取。
[0060]
本发明进一步公开了一种电子系统，包括存储器和处理器，所述存储器上存储有计算机程序，该计算机程序被所述处理器执行时，执行上述的机器人手臂抓取控制方法。
[0061]
本发明进一步公开了一种计算机可读存储介质，所述计算机可读存储介质中包括实时风险控制程序，该实时风险控制程序被处理器执行时实现上述的机器人手臂抓取控制方法的步骤。
[0062]
还需要说明的是，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、商品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、商品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个
……”
限定的要素，并不排除在包括所述要素的过程、方法、商品或者设备中还存在另外的相同要素。
[0063]
本领域技术人员应明白，本技术的实施例可提供为方法、系统或计算机程序产品。因此，本技术可采用完全硬件实施例、完全软件实施例或结合软件和硬件方面的实施例的形式。而且，本技术可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、cd-rom、光学存储器等)上实施的计算机程序产品的形式。
[0064]
虽然上面已经参考各种实施例描述了本发明，但是应当理解，在不脱离本发明的范围的情况下，可以进行许多改变和修改。因此，其旨在上述详细描述被认为是例示性的而非限制性的，并且应当理解，以下权利要求(包括所有等同物)旨在限定本发明的精神和范围。以上这些实施例应理解为仅用于说明本发明而不用于限制本发明的保护范围。在阅读了本发明的记载的内容之后，技术人员可以对本发明作各种改动或修改，这些等效变化和修饰同样落入本发明权利要求所限定的范围。