一种结合关节和笛卡尔空间六轴工业机器人路径规划方法技术

本发明专利技术属于工业机器人技术领域，一种结合关节和笛卡尔空间六轴工业机器人路径规划方法，步骤如下：(1)六轴工业机器人建模；(2)六轴工业机器人工作空间约束；(3)六轴工业机器人关节空间路径规划；(4)六轴工业机器人笛卡尔空间路径规划。本发明专利技术首先基于关节空间进行六轴工业机器人的路径规划，可以实现人为设定的路径进行运动，而且运动的速度、加速度都可以进行控制。最重要的一点，十分安全，可以通过整条路径规划多次测试，得到一条既安全又高效的路径。本发明专利技术设计的方法，适用度高，能对大多数机器人都适用。所以对于开发人员而言，可以对不同的厂家的工业机器人进行路径规划控制。

【技术实现步骤摘要】
一种结合关节和笛卡尔空间六轴工业机器人路径规划方法
本专利技术属于工业机器人
，特别涉及到一种结合关节和笛卡尔空间六轴工业机器人路径规划方法。
技术介绍
工业机器人是一种主要用于工业生产自动化的机电一体化设备，被广泛用于汽车制造、机械加工、电气电子等诸多领域，是衡量一个国家科技制造水平的重要标志之一。我国是制造业大国，制造业是我国经济发展的重要支柱，随着工业4.0时代的到来，国内对机器人的需求相应地也不断增加。自20世纪50年代，工业机器人诞生及发展至今，以美国为代表的国外工业机器人技术一直处于世界领先水平。我国的工业机器人研究事业起步比较晚，随着十多年国人在机器人技术研究上的不断努力，虽然已经逐步开始缩短差距，但是现阶段我国工业机器人的发展水平与发达国家相比还存在着很大的差距。因此，不断加深对工业机器人领域的研究，对推动我国经济的发展和科学技术的进步有着至关重要的作用。对于各个生产领域而言，工业机器人是新一代的工具，可以扩展人们的身体和智力。当工业机器人运动时，它需要一个合适的轨迹来避免与其他物体的碰撞，并通过空间坐标中的预定点，从而实现快速准确的运动。机器人轨迹规划是研究基于运动学的机器人轨迹生成算法。在工业机器人轨迹规划过程中，首先，我们需要考虑工业机器人末端执行器的一些运动状态变量，如：空间位置、姿态、空间移动速度和加速度等。其次，我们需要考虑算法的安全性、效率和准确性。一个完美的轨迹规划算法应该能够满足少量计算、各种轨迹规划曲线、安全等特点。目前，轨迹规划算法可分为关节空间轨迹规划和笛卡尔空间轨迹规划。关节空间轨迹规划算法，是分别控制工业机器人每个关节的运动。关节空间轨迹算法可以分为三次样条、B样条曲线等方法，通过这些方法可以使关节角度变化平滑，而无需求解逆运动学并且减少计算量。但是关节空间轨迹规划也有不足之处，无法在笛卡尔坐标空间中显示出机器人末端执行器的清晰轨迹。笛卡尔空间轨迹规划都是在笛卡尔坐标空间中进行的，因此人们可以直观地看到工业机器人末端执行器的运动轨迹。该算法可以实现各种空间轨迹曲线，如：线性、圆形、抛物线、螺旋线等。我们可以根据已知的初始位姿、目标位姿、空间速度或总运行时间来计算末端执行器的运动轨迹，然后通过逆向运动学计算各个关节角度。但是笛卡尔空间轨迹规划也有不足之处，初始位置和目标位置距离过远时，规划成功率低，且存在安全问题，因为笛卡尔坐标系中末端执行器的位姿转换为关节角度时，存在多个逆运动学解，会陷入最优解的选择，规划失败。工业机器人的路径规划一直是工业机器人
研究的热点。文献(XXLuo,SHLi,SBLiu,GQLiu.Anoptimaltrajectoryplanningmethodforpathtrackingofindustrialrobots[J].Robotica,2019,37(3):502-520.)提出一种新的基于笛卡尔空间机器人路径规划方法，首先在不违反运动学约束的情况下，以最小时间和能量消耗为重点的最优路径跟踪制定策略；然后使用一种新颖的遗传算法GA(GeneticAlgorithm)优化方法，该方法将目标路径转换为具有相对于世界笛卡尔坐标系的最佳平移和方向的曲线；最后通过区间分析，克服了解决特殊轨迹规划优化问题的难题。该文献提出的方法也存在着缺陷，首先用指定的几何路径规划轨迹，对于不同位置和姿态的目标物体的拾取不适用；其次，对于将该方法应用于六轴以下及六轴以上工业机器人时，该方法的性能有待商榷；最后该方法仅进行了仿真验证，在实体工业机器人上进行应用还缺少实验验证。文献(StilmanM.GlobalManipulationPlanninginRobotJointSpaceWithTaskConstraints[J].IEEETransactionsonRobotics,2010,26(3):576-584.)提出一种受空间约束的工业机器人关节空间路径规划方法，给出了关节空间规划器的约束运动表示，并开发了两种简单有效的关节配置约束采样方法：切线空间采样和一阶收缩，从而进行关节空间路径规划。该文献提出的方法也存在着缺陷，对于一些软约束条件，运动计划不能偏向期望的机器人姿态，使工业机器人运动到未知的姿态，存在安全的问题。
技术实现思路
为解决现有技术的不足，本专利技术提供一种结合关节和笛卡尔空间六轴工业机器人路径规划方法，实现六轴工业机器人路径规划方法的系统包括UR3六轴工业机器人(UniversalRobots)、工业机器人控制器、夹爪、Kinect摄像头、PC机。本系统的核心部分是设计一种既安全又高效的六轴工业机器人路径规划方法。由于UR3六轴工业机器人起始位姿与目标位姿的距离较远，本专利技术路径规划分为两步：通过关节空间路径规划，到达一个固定的位姿，并且以该位姿作为笛卡尔空间路径规划的起始位姿；通过笛卡尔空间路径规划，从关节空间路径规划得到的起始位姿开始，运动到目标物体的位姿，进而实现对目标物体进行拾取。此系统，搭载了Kinect摄像头，是为了识别目标物体，并给出目标物体的位姿，同时也可以识别出该环境中是否有障碍物，从而使六轴工业机器人能够避障进行路径规划。本专利技术是基于14.04版本Linux系统，使用ROS开源系统进行路径规划代码编写。ROS是一款主要应用于机器人开发的开源操作系统,具有多种编程语言兼容、免费开源、跨平台等优点。本专利技术的技术方案：一种结合关节和笛卡尔空间六轴工业机器人路径规划方法，步骤如下：(1)六轴工业机器人建模以UR3六轴工业机器人为研究对象，是6自由度串联工业机器人，建立UR3六轴工业机器人模型；(2)六轴工业机器人工作空间约束基于UR3六轴工业机器人的尺寸以及所处的工作环境，建立约束空间；通过添加六个不同位姿的长方体障碍物，建立封闭的工作空间；建立完封闭的工作空间后，将工作空间添加到UR3六轴工业机器人建模所在的世界坐标系中；(3)六轴工业机器人关节空间路径规划将目标物体放置到边缘适合位置以及设置不同的姿态，通过笛卡尔路径规划，使UR3六轴工业机器人从一个固定位姿到达目标物体对应的所有位姿，从而得到固定位姿，该固定位姿作为笛卡尔路径规划的起始位姿，确保笛卡尔路径规划到达所有的目标位姿；从UR3六轴工业机器人运动的起始位姿到固定位姿，中间选取五个位姿点，每一个位姿点是六个轴的转角的整体表示；选取的五个位姿点加上固定位姿点共六个位姿点，组成整条运动轨迹；通过关节空间规划算法，计算出带时间戳的整条运动轨迹，从而使UR3六轴工业机器人运动到固定位姿，为接下来的笛卡尔空间路径规划做准备；(4)六轴工业机器人笛卡尔空间路径规划关节空间路径规划过程，UR3六轴工业机器人运动到的固定位姿，即为当前UR3六轴工业机器人所在的起始位姿，对存放笛卡尔空间路径规划需要经过的位姿点的对象进行初始化；通过ICP算法得到目标物体的位姿，在该目标物体的位姿上方3cm处，为另一个位姿点，共两个位姿点；从当前UR3六轴工业机器人所在的起始位姿到目标物体的位姿，整条路径需要经过上述所述的两个位姿点，先到达目标物体的上方3cm处，再到达目标物体的位姿；通过笛卡尔空间规划算法，计算出带时间戳的整条运动轨迹，从而到达目标物体的位姿，拾取目标物体。本专利技术本文档来自技高网...

【技术保护点】
1.一种结合关节和笛卡尔空间六轴工业机器人路径规划方法，其特征在于，步骤如下：(1)六轴工业机器人建模以UR3六轴工业机器人为研究对象，是6自由度串联工业机器人，建立UR3六轴工业机器人模型；(2)六轴工业机器人工作空间约束基于UR3六轴工业机器人的尺寸以及所处的工作环境，建立约束空间；通过添加六个不同位姿的长方体障碍物，建立封闭的工作空间；建立完封闭的工作空间后，将工作空间添加到UR3六轴工业机器人建模所在的世界坐标系中；(3)六轴工业机器人关节空间路径规划将目标物体放置到边缘适合位置以及设置不同的姿态，通过笛卡尔路径规划，使UR3六轴工业机器人从一个固定位姿到达目标物体对应的所有位姿，从而得到固定位姿，该固定位姿作为笛卡尔路径规划的起始位姿，确保笛卡尔路径规划到达所有的目标位姿；从UR3六轴工业机器人运动的起始位姿到固定位姿，中间选取五个位姿点，每一个位姿点是六个轴的转角的整体表示；选取的五个位姿点加上固定位姿点共六个位姿点，组成整条运动轨迹；通过关节空间规划算法，计算出带时间戳的整条运动轨迹，从而使UR3六轴工业机器人运动到固定位姿，为接下来的笛卡尔空间路径规划做准备；(4)六轴工业机器人笛卡尔空间路径规划关节空间路径规划过程，UR3六轴工业机器人运动到的固定位姿，即为当前UR3六轴工业机器人所在的起始位姿，对存放笛卡尔空间路径规划需要经过的位姿点的对象进行初始化；通过ICP算法得到目标物体的位姿，在该目标物体的位姿上方3cm处，为另一个位姿点，共两个位姿点；从当前UR3六轴工业机器人所在的起始位姿到目标物体的位姿，整条路径需要经过上述所述的两个位姿点，先到达目标物体的上方3cm处，再到达目标物体的位姿；通过笛卡尔空间规划算法，计算出带时间戳的整条运动轨迹，从而到达目标物体的位姿，拾取目标物体。...

【技术特征摘要】
1.一种结合关节和笛卡尔空间六轴工业机器人路径规划方法，其特征在于，步骤如下：(1)六轴工业机器人建模以UR3六轴工业机器人为研究对象，是6自由度串联工业机器人，建立UR3六轴工业机器人模型；(2)六轴工业机器人工作空间约束基于UR3六轴工业机器人的尺寸以及所处的工作环境，建立约束空间；通过添加六个不同位姿的长方体障碍物，建立封闭的工作空间；建立完封闭的工作空间后，将工作空间添加到UR3六轴工业机器人建模所在的世界坐标系中；(3)六轴工业机器人关节空间路径规划将目标物体放置到边缘适合位置以及设置不同的姿态，通过笛卡尔路径规划，使UR3六轴工业机器人从一个固定位姿到达目标物体对应的所有位姿，从而得到固定位姿，该固定位姿作为笛卡尔路径规划的起始位姿，确保笛卡尔路径规划到达所有的目标位姿；从UR3六轴工业机器人运动的起始位姿到固定位姿，中间选取五个位姿点，每...

【专利技术属性】
技术研发人员：李卓函，徐特，庄严，高雅楠，
申请(专利权)人：大连理工大学，
类型：发明
国别省市：辽宁,21