一种机器人笛卡尔空间轨迹的规划方法技术

本发明专利技术公开了一种机器人笛卡尔空间轨迹的规划方法，其过程如下：建立连杆坐标系，由运动学建模分析方法得正运动学方程；通过机器人所具有的向量几何性质和轨迹规划的形位要求，求解主控关节和中间关节的转动角度；利用运动学建模分析方法，利用已求解的关节转动角度，寻求含有已引入变量的关系算式，求解相应关节的转动角度；当任务空间存在障碍时进行轨迹规划，通过向量几何法判定其是否为可达位姿；规划耦合位置信息的可连续时变姿态，进而完成规划任务。本发明专利技术避免了产生增根、筛选匹配有效解；可以有效规避奇异路径，同时可以避免和优化由关节空间规划出的末端轨迹复杂的缺陷等。

【技术实现步骤摘要】

本专利技术设及，设及逆运动学和姿态规划。
技术介绍
工业机器人应用的深度与广度已成为衡量一个国家制造业水平和科技水平的重 要标志。自从第一台工业机器人于1962年应用于GeneralMotor公司生产线，机器人技术 获得快速的发展，尤其，目前在人工成本不断提高和"工业4. 0"概念提出的背景下，机器人 革命有望成为"第=次工业革命"的重要切入点和增长点，而目前我国已经成为全球最大的 机器人市场，2015年5月国务院印发《中国制造2025》，明确提出要重点支持机器人技术的 发展和应用，将其列为十大重点领域之一。 运动学和轨迹规划是机器人技术实际应用的基础，其中轨迹规划包括位置和姿 态两方面，尤其在笛卡尔空间的轨迹规划。工业实际应用中，当前在笛卡尔空间下进行轨迹 规划多是在关节空间中进行，末端实际运动轨迹复杂，同时，实际应用中常要求末端W不同 的姿态进行，而当前的规划方法存在易导致奇异性等弊端。其中，运动学问题是机器人运动 控制和轨迹规划的基础，解析形式的机器人逆运动学问题是机器人研究中的难题，也是机 器人研究领域的热点问题。 位置逆解问题是机器人运动规划和轨迹规划的基础，只有通过逆运动学把空间位 姿转换为关节变量，才能实现对机械臂末端执行器的控制；而且机器人逆运动学求解的效 率直接影响运动轨迹控制效果和作业效率。由于机器人正运动学是在已知各个关节角度求 解末端的位置和姿态，相对简单且解唯一；逆运动学是是正运动学问题的逆过程，是已知机 械臂末端的位置和姿态，计算各个关节转过的角度值，串联机器人逆向运动学的求解过程 相对复杂，一般会出现多解或者甚至无解的情况。目前逆运动学求解算法分为两大类；封闭 解/解析法和数值解法，其中，数值解法中的迭代过程会降低求解速度，不利于现代工业机 械臂的实时控制；目前常用的数值法有如基于雅克比矩阵的牛顿-拉普松迭代法，根据建 立的正运动模型进行迭代计算，得出机器人逆运动学结果，但是在计算时间和结果的精确 性上很难同时保证，W及拟牛顿共辆梯度法，其存在雅克比矩阵奇异性，且算法初始状态的 取值直接将影响算法的收敛度和求解精度，在计算时间和精确上很难同时保证；神经网络 法是通过学习网络权、阔值参数建立笛卡尔空间下连杆构型同各个关节角度映射关系，而 网络学习需要大量样本数据，在实际中却较难获取，同时，网络学习所需要时间较长，不适 宜实时控制；另外，遗传算法是利用全局并行捜索特性，常规遗传算法在解决优化问题存在 早熟即收敛速度慢等缺陷，降低优化性能，影响求解精度；神经网络、遗传算法和专家系统、 模糊逻辑联合起来进行混合求解，在解决多自由度机器人逆运动学是需要复杂的算法程序 和高性能的配置，所W，数值法计算耗时长，求解精度不高，不适宜高精度和实时性作业任 务；遗传算法和神经网络方法可对求解进行优化，避免局部收敛，得出逆运动学结果，但与 迭代方法一样，在计算时间和计算精度上存在制约性。 封闭解是实际应用中需要的，可W直接计算各关节角度理论值，不需要迭 代捜索寻优，具有计算速度快，精度高，包含几何法和代数法，其中几何法被视为仅 适用于结构简单的少自由度机械臂；代数法包括通过D-H建模结合逆矩阵方式和 利用旋量结合指数积通过转化为化den-K址an子问题求解等。前者是最常用的方 法，即先将机器人各关节转动角度设为01，0 2, 0 3... 0。，然后代入正运动学方程 巧=巧倘）*巧㈱*巧裤)*…*巧''''1供.)，推导出 方程左边的数据已知，采取逆矩阵的方式分离变量，寻找其中姿态和位置间存在 的等量关系，如；（巧(0!)) -，*巧=巧(&) *巧倘）*…巧-1供,.)，之后进行逐级分离变量， 从而求得有关角度，但任意构造的方程可能导致其中的求解过程异常复杂W及后续需要进 行有效解的寻值和匹配，需要更复杂的算法，所W要得到其中的有效解析解表达式，求解过 程复杂，解算效率不高。欠自由度机械臂不能实现任意姿态和位置，当任意给定时，往往无 解；国内外学者曾使用螺旋理论推导5R解析解的框架，几何法或代数法也曾分别被用来求 解5R机械臂逆运动学解析解，一般无法或很难在执行具体任务前预先判定操作点是否在 工作空间内，需要采用查表法等，而且，传统的求解算法通常存在解算范围小，需要匹配或 通过其他算法选择最优解、特殊位置处需单独讨论、最优解不易直观确定等问题，严重影响 机器人的响应速度。因此，位置逆解问题作为机器人运动学中最基础、最重要的研究问题之 一，直接关系到运动分析、轨迹规划和实时控制等，甚至后续的速度和加速度分析。而且，逆 运动学的求解速度和准确度直接影响工业机器人的实时控制的难W程度，也将直接决定机 械臂执行复杂任务的能力。 而轨迹规划是逆运动学的实际应用，工业应用中运动轨迹规划的好坏直接影响机 器人作业质量。机器人末端运动是由关节变量直接决定的，由于关节坐标空间和直角坐标 空间转换关系复杂，同时在关节空间进行路径规划，计算比较简单，且不会产生机构奇异问 题，即可W避免雅克比矩阵奇异时形成的速度失控现象，所W除了示教再现法W外，目前轨 迹规划多数采取关节空间的规划方案，但其在直角坐标空间的最终轨迹，路径点之间的轨 迹形状往往是十分复杂的，因此只有对初始点和最终期望点的位姿有要求时而对中间路径 无要求的任务，才可W在关节空间直接进行路径规划。当末端轨迹形状有一定要求，在关 节空间规划则很难或无法达到要求，比如，当需要进行连续轨迹的作业任务，则必须在直角 坐标空间中规划出需要的轨迹。目前存在的直角坐标空间规划方法计算工作量大，W及姿 态规划问题复杂，导致所规划的轨迹有可能接近或通过奇异点，造成无法解算的后果。尤其 针对少自由度机械臂，当姿态规划不成功时，往往通过牺牲末端位姿精度来达到回避奇异 位置的目标，然而当进行目标捕获、精细操作等时，末端位姿精度的牺牲影响任务的成功执 行。 因此，在路径要求不高的抓取操作时在关节空间中进行规划尚可，但当有严格轨 迹要求时，如焊接等，需要复杂的算法来保证精度，而在笛卡尔空间进行轨迹规划的精确性 是基于关节空间规划的该种方法所无法比拟的。但在姿态规划方面，由于其所具有的非线 性和禪合性，目前存在的算法多数采取插补方案进行，灵活性差，尤其在五自由度等少自由 度机器人中，存在诸多重大缺陷，容易造成规划路径的奇异性，甚至无法求解的局面。
技术实现思路
针对现有技术中存在的技术问题，本专利技术的目的是；提供一种机器人空间轨迹的 规划方法。 本专利技术通过W下步骤实现： 步骤1 ;建立连杆坐标系；将机器人连杆中基坐标系固连于基座，依次建立坐标 系，并命名各个关节轴的转动角度分别为0 1、0 2、0 0 1;工业中各个厂家生产的机器人 的初始状态及关节运动范围有所不同，但其理论模型一致；[001引步骤2 ;由运动学建模分析方法得正运动学方程；巧=巧*巧*巧...巧^1;W下为各个关节转动角度的求解过程： 步骤3;主控关节C转动角度日。的求解令底部靠近基座的竖直关节为主控关节（controllingjoint)，一般为靠近基座 的第一个关节位置，距离末端执行器最近的具有水平关节轴关节th，其位置记为Pth，由末 端执行器（endeffector)位置通过接本文档来自技高网...

【技术保护点】
一种机器人笛卡尔空间轨迹的规划方法，其特征在于包括以下步骤：步骤1：建立连杆坐标系：设机器人连杆中基坐标系固连于基座，依次建立坐标系，并设各关节轴的转动角度分别为θ1、θ2、θ3…θi；步骤2：由运动学建模分析方法得正运动学方程，然后通过逆运动学的求解得到机器人各个关节的转动角度；步骤3：通过末端执行器位置和姿态的数学表述方式，将末端执行器的接近矢量所在平面规划为以基坐标系z轴为母线，以末端执行器位置在基坐标系中的投影与基坐标系原点的连线为准线所形成的柱面及其相交面，将末端执行器的姿态规划为位置P(Px，Py，Pz)的函数f(P，t)；当机器人存在沿或绕基坐标系x、y、z方向移动或转动时，将末端执行器的接近矢量平移至基坐标系原点处理；步骤4：通过步骤3规划出位置及耦合位置信息的可连续时变姿态，由步骤2逆运动学得出各个关节的转动角度，完成笛卡尔空间轨迹的规划任务。

【技术特征摘要】

【专利技术属性】
技术研发人员：张耀伦，
申请(专利权)人：张耀伦，
类型：发明
国别省市：山东;37