一种基于随机采样的双臂空间机器人协调路径规划方法技术

本发明专利技术涉及一种基于随机采样的双臂空间机器人协调路径规划方法，借助RRT*算法分别规划双臂末端执行器在笛卡尔空间中的初始可行路径，并利用四次样条曲线对RRT*算法生成的初始路径进行平滑处理，通过满足样条曲线的一阶、二阶及三阶微分连续约束和机械臂末端执行器的初末速度、加速度约束，得到适合于机器人执行的平滑路径。有益效果：利用RRT*算法在非结构化环境中快速生成末端的安全可行的初始路径，并利用四次样条曲线，平滑了RRT*生成的初始路径，保证机器人以良好的状态执行规划的路径，且考虑了机械臂的物理极限约束。仿真结果说明了所提协调路径规划方法的有效性。对于机械臂运动规划具有重要意义，特别是针对失效卫星的抓捕路径规划。

A coordinated path planning method for dual arm space robot based on random sampling

【技术实现步骤摘要】
一种基于随机采样的双臂空间机器人协调路径规划方法
本专利技术属于空间机器人协调路径规划方法，涉及一种基于随机采样的双臂空间机器人协调路径规划方法。
技术介绍
随着在轨维修、空间装配等任务需求的与日俱增，空间机器人技术被验证是执行特殊恶劣空间环境下任务最有效的手段之一。典型实例有“工程试验卫星(EngineeringTestSatelliteVII,ETS-VII)”和“轨道快车(OrbitExpress,OE)”。空间机器人在轨服务中最具挑战性的工作之一是其抓捕过程中的运动规划问题。过去的文献中已提出过多种空间机器人运动规划方法。基于零作用空间，Yoshida等人提出了无反作用机械臂，解决了运动学非冗余臂和冗余臂时间损失和机械臂速度限制的问题。基于零反作用空间的概念，Wang等提出了一种考虑任务优先级的运动学冗余机械臂路径规划方法，并基于Bézier曲线提出抓捕自旋卫星后的最优消旋与路径规划策略。Luo等提出了一种利用傅里叶级数对空间机械臂关节运动轨迹进行参数化的规划方法。Xu等利用自由漂浮空间机器人非完整特性提出了一种点到点的路径规划方法，同时调节基座姿态和末端的位姿。Nakamura最早在机器人学中引入了任务优先级的概念，基于二次规划框架，仅考虑两个优先级水平，解决了冗余机械臂关节轨迹优化问题。随着越来越多的操作任务需要在非结构化环境下进行，因此非结构化环境下的机器人自主导航控制技术成为亟需。近年来，基于随机采样的规划方法在机器人领域中兴起，它适合于解决高自由度机器人在复杂环境中的规划问题，而且对带有微分约束的规划问题也具有较强的解决能力。例如，RRT算法，其本质上是单一查询的规划方法，其基本算法的主要思想是：由起始位形点出发构造搜索树，而后再从整个位形空间中随机选择一个位形点，找出与该点在搜索树中最近的位形点，以此不断的产生新位形状态，直到到达目标，搜索树构造结束。由于在搜索树构造过程中可以充分考虑了多种微分约束(如非完整约束、运动动力学约束等)，因而获得的规划结果合理性较强。
技术实现思路
要解决的技术问题为了避免现有技术的不足之处，本专利技术提出一种基于随机采样的双臂空间机器人协调路径规划方法，基于RRT*算法提出一种复杂空间环境下双臂空间机器人的协调路径规划方法。技术方案一种基于随机采样的双臂空间机器人协调路径规划方法，包括了双臂空间机器人的运动学模型建立；通过改进RRT*算法，设计双臂空间机器人的初始路径；利用四次样条曲线拟合由改进RRT*算法生成的初始路径，得到适合于机器人执行的可行平滑路径；其特征在于步骤如下：步骤1、建立双臂空间机器人的运动学模型：双臂空间机器人系统由基座和2个n自由度的机械臂构成，共计2n+1个刚体，且系统不受任何外力作用；根据泊松原理，双臂空间机器人的运动学模型为：其中，上标a和b分别表示变量属于机械臂a和b，下标b和e分别表示变量属于基座base和末端执行器end-effector；分别为各末端执行器的线/角速度，为各机械臂关节角速度；Hb,Hm为基座和机械臂惯量矩阵，Hbm为末端执行器和机械臂之间的耦合惯量矩阵，Jb,Je分别是基座和末端执行器的雅克比矩阵；Jg称之为系统的广义雅克比矩阵，Jd表示由于系统初始动量M0引起的耦合矩阵；系统初始线/角动量M0＝[P0L0]T为：其中，为基座的线/角速度，为各连杆质心在惯性坐标系下的速度。mb为基座的质量，mi为各连杆的质量，Ib为基座的惯量；步骤2、利用RRT*算法设计双臂空间机器人的初始路径：为避免两机械臂在操作过程中发生相互碰撞，对RRT*算法进行改进，在不同的采样空间中分别进行各末端执行器的快速搜索路径规划，得到其初始路径的时间序列路径点(t0,xe,0),(t1,xe,1),…,(tn,xe,n)，具体步骤为：1.Fork＝1toKdo2.随机在不同的任务空间中对双末端分别采样3.在原树结构中搜索新生采样点附近的点4.进行碰撞检测，生成新的树节点5.判断是否有更少代价的航迹，若有则替代原航迹6.ReturnPath；在原始RRT*算法基础上，对双臂各自采样空间预留0.1m宽度的欧氏距离，通过在不同的任务空间中分别进行各末端执行器的路径搜索，即对双末端施加具有边界范围的笛卡尔空间约束；注意，此空间约束不固定，其随末端执行器的运动而连续变化，进而保证整个规划执行过程中双臂空间机器人不发生自身碰撞，包括两个末端执行器不发生碰撞，以及双臂各连杆不发生自身碰撞；步骤3、采用四次样条曲线平滑双臂空间机器人的初始路径：由RRT*算法得到的初始路径十分不平滑，不能直接施加于空间机器人，为保证机器人路径的三阶导数连续，采用四次样条曲线对得到的RRT*算法得到的初始路径进行平滑处理：首先，给定由RRT*算法规划得到的初始时间序列路径点如下(t0,xe,0),(t1,xe,1),…,(tn,xe,n)其中，xe,i表示机器人末端执行器在时间ti的期望位置；然后，利用四次样条曲线平滑地拟合这些路径点，其基本形式表达如下xe,i(t)＝ai+bi(t-ti)+ci(t-ti)2+di(t-ti)3+ei(t-ti)4其中，ai,bi,ci,di,ei分别是四次样条曲线的参数，存在唯一的样条参数集合，使得拟合的路径通过各个路径点，且在各个路径点处满足速度连续，加速度连续等条件。针对机器人运动而言，还需要保持加加速度连续，以防机械臂产生抖振现象；因此，至少满足以下度、加速度、加加速度微分约束条件：通过上述微分约束条件，构建关于四次样条参数的线性方程组，进而求解样条参数ai,bi,ci,di,ei，得到各时间段内的连续路径；最后，机器人的路径由各段四次样条曲线级联而成，表达如下根据步骤1中的机器人运动学模型，通过逆运动学求解，即得到机械臂各关节运动轨迹有益效果本专利技术提出的一种基于随机采样的双臂空间机器人协调路径规划方法，借助RRT*算法分别规划双臂末端执行器在笛卡尔空间中的初始可行路径，并利用四次样条曲线对RRT*算法生成的初始路径进行平滑处理，通过满足样条曲线的一阶、二阶及三阶微分连续约束和机械臂末端执行器的初末速度、加速度约束，得到适合于机器人执行的平滑路径。最后以实例验证本专利技术提出的路径规划方法的有效性。本专利技术的有益效果是：提出了一种空间环境下利用RRT*进行双臂空间机器人协调路径规划的框架。利用RRT*算法在非结构化环境中快速生成末端的安全可行的初始路径，并利用四次样条曲线，平滑了RRT*生成的初始路径，保证机器人以良好的状态执行规划的路径，且考虑了机械臂的物理极限约束。仿真结果说明了所提协调路径规划方法的有效性。所提算法对于机械臂运动规划具有重要意义，特别是针对失效卫星的抓捕路径规划。附图说明图1：自由漂浮双本文档来自技高网...

【技术保护点】
1.一种基于随机采样的双臂空间机器人协调路径规划方法，包括了双臂空间机器人的运动学模型建立；通过改进RRT*算法，设计双臂空间机器人的初始路径；利用四次样条曲线拟合由改进RRT*算法生成的初始路径，得到适合于机器人执行的可行平滑路径；其特征在于步骤如下：/n步骤1、建立双臂空间机器人的运动学模型：/n双臂空间机器人系统由基座和2个n自由度的机械臂构成，共计2n+1个刚体，且系统不受任何外力作用；/n根据泊松原理，双臂空间机器人的运动学模型为：/n

【技术特征摘要】
1.一种基于随机采样的双臂空间机器人协调路径规划方法，包括了双臂空间机器人的运动学模型建立；通过改进RRT*算法，设计双臂空间机器人的初始路径；利用四次样条曲线拟合由改进RRT*算法生成的初始路径，得到适合于机器人执行的可行平滑路径；其特征在于步骤如下：
步骤1、建立双臂空间机器人的运动学模型：
双臂空间机器人系统由基座和2个n自由度的机械臂构成，共计2n+1个刚体，且系统不受任何外力作用；
根据泊松原理，双臂空间机器人的运动学模型为：



其中，上标a和b分别表示变量属于机械臂a和b，下标b和e分别表示变量属于基座base和末端执行器end-effector；分别为各末端执行器的线/角速度，为各机械臂关节角速度；Hb,Hm为基座和机械臂惯量矩阵，Hbm为末端执行器和机械臂之间的耦合惯量矩阵，Jb,Je分别是基座和末端执行器的雅克比矩阵；Jg称之为系统的广义雅克比矩阵，Jd表示由于系统初始动量M0引起的耦合矩阵；
系统初始线/角动量M0＝[P0L0]T为：



其中，为基座的线/角速度，为各连杆质心在惯性坐标系下的速度。mb为基座的质量，mi为各连杆的质量，Ib为基座的惯量；
步骤2、利用RRT*算法设计双臂空间机器人的初始路径：
对RRT*算法进行改进，在不同的采样空间中分别进行各末端执行器的快速搜索路径规划，得到其初始路径的时间序列路径点(t0,xe,0),(t1,xe,1),…,(tn,xe,n)，具体步骤为：
1.Fork＝1to...

【专利技术属性】
技术研发人员：王明明，余敏，罗建军，马卫华，朱战霞，袁建平，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西;61