[发明专利]一种基于双目立体视觉的SCARA机器人轨迹规划方法

说明书

技术领域

本发明涉及双目立体视觉系统技术领域，特别涉及一种基于双目立体视觉的SCARA机器人轨迹规划方法。

背景技术

工业机器人是机电一体化高度集成的产物，作为《中国制造2025》重点发展的十大领域之一，是工业自动化水平和工业4.0的重要标志。工业机器人具有重复精度高、可靠性好、适用性强等优点，广泛应用于汽车、机械、电子、物流等行业，已被证明是当前最高效的生产工具，需求量不断攀升。自上世纪60年代初以来，工业机器人经历了三个阶段的发展。第一代是示教再现型工业机器人，只能将操作者告诉它的轨迹、顺序、要求等把知识记忆下来，然后根据再现指令读取这些知识，完成规定任务。第二代工业机器人是感知型工业机器人，通过给工业机器人安装相关传感器使其有所感知，对外部信息能进行反馈。第三代工业机器人是智能工业机器人，可对周围环境、作业条件等做出判断然后再执行任务。一般由机器视觉作为反馈，通过图像处理信息引导工业机器人执行任务。

机器视觉是工业机器人的重要研究领域，而目前生产线上多数工业机器人都通过预先示教或者离线编程的方式来控制机器人执行预定的指令动作，一旦工作环境或目标对象发生变化，机器人不能及时适应这些变化，从而导致任务失败，而且这种工作方式在很大程度上限制了工业机器人的灵活性和工作效率。

发明内容

为了克服上述现有技术的不足，本发明的目的在于提供一种基于双目立体视觉的SCARA机器人轨迹规划方法，利用双目立体视觉的方法，对障碍物和工件进行自动识别及定位，对传统的机器人固定点抓取方法进行改进，提高机器人对环境的适应能力和生产效率，通过机器人关节空间的五次多项式插值算法完成对机器人轨迹的规划，能够改善定位精度和轨迹跟踪精度，减少冲击和振动，提高生产线的自动化水平。

为了实现上述目的，本发明采用的技术方案是：

一种基于双目立体视觉的SCARA机器人轨迹规划方法，包括以下步骤；

Step1、安装工业相机，获取工作区域图片

将两个相机安装在机器人工作区域的正上方，调整相机的焦距使整个工作区域处在两个相机的视野范围内；

Step 2、进行双目立体相机的标定

通过两个相机对不同方位的标定板进行同时拍照，并将每一次的标定板的位置与标定板的状态都记录下来，然后寻找一个公共的平面，使得两个相机的光轴平行,确定了此平面后，每次采集到的左右相机的图像都要先变换到此平面，然后利用三角定位法根据相同物体在左右相机中的视差来计算物体的高度H₁和障碍物的高度H₂；

Step 3、障碍物和工件的位置的确定

第一步，对工作区域进行拍照，利用背景相减法，用左相机的图像与背景图像相减得到只含有工件和障碍物的图像；

第二步，利用模板匹配的方法确定工件的位置，在背景相减后的图像中搜索模板图像，即将制作好的模板在当前图像上进行滑动和转动，用相似性度量来算出每块图像与模板图像的相似度，最终当相似值大于0.75时，认为匹配到模板，同时记录下当前坐标为匹配到工件的坐标，图片中去掉工件的图像，就可以确定障碍物的位置；

Step 4、确定轨迹插值点，轨迹的起点为工件坐标位置(X₀，Y₀)，终点为装配位置(X_f，Y_f)，为了绕开障碍物增加插值点(X_c，Y_c)，如图1所示；

Step 5、对SCARA机器人进行建模。

计算机器人末端执行器与各个关节角度的转换关系，利用DH方法对机器人进行建模，机器人末端执行器的坐标为(Px,Py,Pz)，机器人第一和第二关节转过的角度分别为θ₁与θ₂，第一关节与第二关节的长度分别为L₁和L₂，第三个关节上下移动的距离为d₃；如图2所示，⁰T₄表示O₃坐标系相对于O₀坐标系的转换关系可由坐标系的转换公式得到公式1，最后一列与机器人坐标系的对应关系如公式2所示，即已知一点的机器人坐标(Px,Py,Pz)就可得到对应各个关节旋转的角度；

Step 6、对机器人进行关节空间的轨迹规划