一种机器人关节空间平滑轨迹规划方法技术

本发明专利技术公开了一种机器人关节空间平滑轨迹规划方法，包括步骤：首先，由机器人运动学逆解算法，实现机器人笛卡尔空间运动轨迹向关节空间运动轨迹的映射，获得关节空间关键插补点；然后，依据机器人各个关节的最大速度约束，调整笛卡尔插补周期；接着，借助三次多项式曲线进行关节空间关键插补点的角速度和角加速度估计，为下一步的五次样条曲线拟合提供条件；最后，从第一个关节空间关键插补点开始，依次使用相邻两个关节空间关键插补点构造五次样条曲线，作为关节空间的运动轨迹，再进行关节空间插补。本发明专利技术解决机器人关节空间运动轨迹不平滑的问题。

A smooth trajectory planning method for robot joint space

The invention discloses a robot joint space smooth trajectory planning method, which comprises the following steps: firstly, the robot inverse kinematics algorithm, mapping robot Descartes space trajectory to joint space trajectory, obtaining key interpolation points of joint space; then, based on the maximum velocity constraint of each joint robot, then adjust the Descartes interpolation cycle; that estimate the angular velocity and angular acceleration of the key point of interpolation in joint space with the three polynomial curve, provide the conditions for the next five cubic spline curve fitting; finally, from the beginning of the first joint space key interpolation points, followed by the use of two adjacent key points to construct the joint space interpolation of five spline curve, as trajectory, then joint space interpolation. The invention solves the problem that the motion path of the joint space of the robot is not smooth.

【技术实现步骤摘要】
一种机器人关节空间平滑轨迹规划方法
本专利技术涉及串联机器人平滑轨迹规划方法，特别涉及一种机器人关节空间平滑轨迹规划方法。
技术介绍
串联机器人在制造业、农业、娱乐业等行业得到越来越广泛的应用。机器人运动最终依靠关节运动实现，关节空间运动轨迹不平滑会造成机器人关节的冲击振动，不仅影响机器人作业质量，而且加快零部件磨损，影响机器人寿命。目前机器人关节空间平滑运动轨迹规划的研究多以离线的形式进行，需要先进行笛卡尔空间轨迹规划和机器人运动学逆解得到全部关节角时间-节点序列，再进行曲线拟合或者轨迹优化得到平滑关节空间运动轨迹。但是在实际应用中，由于成本等因素限制，机器人控制器的内存资源非常有限，无法一次性储存和运算大量的轨迹点数据。另外，由于机器人运动控制实时性的要求，普遍控制器的插补周期在1ms左右，在如此短时间内无法完成复杂的曲线拟合和优化计算。
技术实现思路
本专利技术的目的是提供种机器人关节空间平滑轨迹规划方法，旨在解决在最短时间和最小内存消耗下实现实时在线机器人关节空间平滑运动轨迹规划。本专利技术的目的通过下述技术方案来实现：一种机器人关节空间平滑轨迹规划方法，包括如下步骤：S1、由机器人运动学逆解算法，实现机器人笛卡尔空间运动轨迹向关节空间运动轨迹的映射，获得关节空间关键插补点；S2、依据机器人各个关节的最大速度约束，调整笛卡尔插补周期；S3、借助三次多项式曲线进行关节空间关键插补点的角速度和角加速度估计，为下一步的五次样条曲线拟合提供条件；S4、从第一个关节空间关键插补点开始，依次使用相邻两个关节空间关键插补点构造五次样条曲线，作为关节空间的运动轨迹，再进行关节空间插补。进一步地，所述步骤S2包含如下步骤：S2.1、第j个笛卡尔插补周期机器人6个关节电机的最大转速估计如式(1)所示：式中，和分别为关节i第j+1个和第j个插补点，TD为笛卡尔空间插补时间，ri为关节i的减速比；S2.2、第j个笛卡尔插补周期机器人各关节伺服电机计算转速与最大转速之比为如果Q小于1，则说明为完成此插补段运动，机器人6个关节中存在电机转速超出最大转速；由于插补运动需要保证各轴在约定插补周期内同时完成运动，机器人6个关节完成此插补段运动所需的插补周期均需要增加；S2.3、重新计算第j个笛卡尔空间插补周期式中，int为取整函数；Q为转速比；TD为默认笛卡尔空间插补周期，TD＝10ms。进一步地，所述步骤S3包含如下步骤：S3.1、令为笛卡尔空间插补和进行机器人运动学逆解之后得到机器人i关节tj时刻转角值为θj的关节空间关键插补点；插补点的角速度和角加速度的估计通过构造三次多项式曲线进行估计；取插补点前一点和后两个点和构造三次多项式曲线；S3.2、三次多项式曲线表达式如式(4)所示：θ(t)＝at3+bt2+ct+d(4)将四个插补点的时间和位置数值代入式(4)可得将式(5)写成矩阵形式得则可以解得S3.3、则插补点的角速度估计为插补点的角加速度估计为进一步地，所述步骤S4包含如下步骤：S4.1、五次样条曲线表达式如式(10)所示θ(t)＝At5+Bt4+Ct3+Dt2+Et+F(10)且满足边界条件写成矩阵的形式则可以解得S4.2、按照1毫秒的关节空间插补周期，依次将t代入式(13)计算得到的关节空间五次样条运动曲线，即可得到关节空间的插补点，完成关节空间插补。本专利技术相对于现有技术具有如下的优点及效果：本专利技术与离线的关节空间平滑轨迹规划和优化方法相比，每次只需要存储4个关键插补点，占用系统资源少，每个笛卡尔插补周期只需分别求解1次三次多项式曲线参数和1次五次多项式曲线参数，计算负担小，可以满足实时计算的要求，能够实现实时在线规划，更具广泛适用性。附图说明图1是本专利技术实施例的机器人关节空间平滑轨迹规划方法流程示意图。具体实施方式下面结合实施例及附图对本专利技术作进一步的详细描述，但本专利技术的实施方式不限于此。如图1所示，现以某六自由度垂直关节串联机器人为对象，按照以下步骤进行机器人关节空间平滑轨迹规划：一种机器人关节空间平滑轨迹规划方法，包括步骤:S1、由机器人运动学逆解算法，实现机器人笛卡尔空间运动轨迹向关节空间运动轨迹的映射，获得关节空间关键插补点；S2、依据机器人各个关节的最大速度约束，调整笛卡尔插补周期；S3、借助三次多项式曲线进行关节空间关键插补点的角速度和角加速度估计，为下一步的五次样条曲线拟合提供条件；S4、从第一个关节空间关键插补点开始，依次使用相邻两个关节空间关键插补点构造五次样条曲线，作为关节空间的运动轨迹，再进行关节空间插补。具体而言，所述步骤S2包含如下步骤：S2.1、第j个笛卡尔插补周期机器人6个关节电机的最大转速估计如式(1)所示式中，和分别为关节i第j+1个和第j个插补点，TD为笛卡尔空间插补时间，ri为关节i的减速比。S2.2、第j个笛卡尔插补周期机器人各关节伺服电机计算转速与最大转速之比为如果Q小于1，则说明为完成此插补段运动，机器人6个关节中存在电机转速超出最大转速。由于插补运动需要保证各轴在约定插补周期内同时完成运动，机器人6个关节完成此插补段运动所需的插补周期均需要增加。S2.3、重新计算第j个笛卡尔空间插补周期式中，int为取整函数；Q为转速比；TD为默认笛卡尔空间插补周期，TD＝10ms。具体而言，所述步骤S3包含如下步骤：S3.1、令为笛卡尔空间插补和进行机器人运动学逆解之后得到机器人i关节tj时刻转角值为θj的关节空间关键插补点。插补点的角速度和角加速度的估计通过构造三次多项式曲线进行估计。取插补点前一点和后两个点和构造三次多项式曲线。S3.2、三次多项式曲线表达式如式(4)所示θ(t)＝at3+bt2+ct+d(4)将四个插补点的时间和位置数值代入式(4)可得将式(5)写成矩阵形式得则可以解得S3.3、则插补点的角速度估计为插补点的角加速度估计为具体而言，所述步骤S4包含如下步骤：S4.1、五次样条曲线表达式如式(10)所示θ(t)＝At5+Bt4+Ct3+Dt2+Et+F(10)且满足边界条件写成矩阵的形式则可以解得S4.2、按照1毫秒的关节空间插补周期，依次将t代入式(13)计算得到的关节空间五次样条运动曲线，即可得到关节空间的插补点，完成关节空间插补。上述实施例为本方面较佳的实施方式，但本方明的实施方式并不受上述实施例的限制，其他的任何背离本专利技术的精神实质与原理下所作的改变、修饰、替代、组合、简化，均应为等效的置换方式，都包含在本专利技术的保护范围之内。本文档来自技高网...

【技术保护点】
一种机器人关节空间平滑轨迹规划方法，其特征在于，包括如下步骤：S1、由机器人运动学逆解算法，实现机器人笛卡尔空间运动轨迹向关节空间运动轨迹的映射，获得关节空间关键插补点；S2、依据机器人各个关节的最大速度约束，调整笛卡尔插补周期；S3、借助三次多项式曲线进行关节空间关键插补点的角速度和角加速度估计，为下一步的五次样条曲线拟合提供条件；S4、从第一个关节空间关键插补点开始，依次使用相邻两个关节空间关键插补点构造五次样条曲线，作为关节空间的运动轨迹，再进行关节空间插补。

【技术特征摘要】
1.一种机器人关节空间平滑轨迹规划方法，其特征在于，包括如下步骤：S1、由机器人运动学逆解算法，实现机器人笛卡尔空间运动轨迹向关节空间运动轨迹的映射，获得关节空间关键插补点；S2、依据机器人各个关节的最大速度约束，调整笛卡尔插补周期；S3、借助三次多项式曲线进行关节空间关键插补点的角速度和角加速度估计，为下一步的五次样条曲线拟合提供条件；S4、从第一个关节空间关键插补点开始，依次使用相邻两个关节空间关键插补点构造五次样条曲线，作为关节空间的运动轨迹，再进行关节空间插补。2.根据权利要求1所述的一种机器人关节空间平滑轨迹规划方法，其特征在于，所述步骤S2包含如下步骤：S2.1、第j个笛卡尔插补周期机器人6个关节电机的最大转速估计如式(1)所示：式中，和分别为关节i第j+1个和第j个插补点，TD为笛卡尔空间插补时间，ri为关节i的减速比；S2.2、第j个笛卡尔插补周期机器人各关节伺服电机计算转速与最大转速之比为如果Q小于1，则说明为完成此插补段运动，机器人6个关节中存在电机转速超出最大转速；由于插补运动需要保证各轴在约定插补周期内同时完成运动，机器人6个关节完成此插补段运动所需的插补周期均需要增加；S2.3、重新计算第j个笛卡尔空间插补周期式中，int为取整函数；Q为转速比；TD为默认笛卡尔空间插补周期，TD＝10ms。3.根据权利要求1所述的一种机器人关节空间平滑轨迹规划方法，其特征在于，所述步骤S3包含如下步骤：S3.1、令为笛卡尔空间插补和进行机器人运动学逆解之后得到机器人i关节tj时刻转角值为θj的关节空间关键插补点；插补点的角速度和角加速度的估计通过构造三次多项式曲线进行估计；取插补点前一点和后两个点和构造三次多项式曲线；S3.2、三次多项式曲线表达式如式(4)所示：θ(t)＝at3+bt2+ct+d(4)将四个插补点的时间和位置数值代入式(4)可得将式(5)写成矩阵形式得

【专利技术属性】
技术研发人员：张铁，罗欣，邹焱飚，
申请(专利权)人：华南理工大学，
类型：发明
国别省市：广东,44