[发明专利]一种机器人关节空间平滑轨迹规划方法

说明书

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

技术领域

本发明涉及串联机器人平滑轨迹规划方法，特别涉及一种机器人关节空间平滑轨迹规划方法。

背景技术

串联机器人在制造业、农业、娱乐业等行业得到越来越广泛的应用。机器人运动最终依靠关节运动实现，关节空间运动轨迹不平滑会造成机器人关节的冲击振动，不仅影响机器人作业质量，而且加快零部件磨损，影响机器人寿命。

目前机器人关节空间平滑运动轨迹规划的研究多以离线的形式进行，需要先进行笛卡尔空间轨迹规划和机器人运动学逆解得到全部关节角时间-节点序列，再进行曲线拟合或者轨迹优化得到平滑关节空间运动轨迹。但是在实际应用中，由于成本等因素限制，机器人控制器的内存资源非常有限，无法一次性储存和运算大量的轨迹点数据。另外，由于机器人运动控制实时性的要求，普遍控制器的笛卡尔空间插补周期在1ms左右，在如此短时间内无法完成复杂的曲线拟合和优化计算。

发明内容

本发明的目的是提供种机器人关节空间平滑轨迹规划方法，旨在解决在最短时间和最小内存消耗下实现实时在线机器人关节空间平滑运动轨迹规划。

本发明的目的通过下述技术方案来实现：

一种机器人关节空间平滑轨迹规划方法，包括如下步骤：

S1、由机器人运动学逆解算法，实现机器人笛卡尔空间运动轨迹向关节空间运动轨迹的映射，获得关节空间关键插补点；

S2、依据机器人各个关节的最大速度约束，调整笛卡尔空间插补周期；

S3、借助三次多项式曲线进行关节空间关键插补点的角速度和角加速度估计，为下一步的五次样条曲线拟合提供条件；

S4、从第一个关节空间关键插补点开始，依次使用相邻两个关节空间关键插补点构造五次样条曲线，作为关节空间的运动轨迹，再进行关节空间插补。

进一步地，所述步骤S2包含如下步骤：

S2.1、第j个笛卡尔空间插补周期机器人6个关节电机的计算转速估计如式(1)所示：

式中，和分别为关节i第j+1个和第j个关节空间关键插补点，T_D为笛卡尔空间插补周期，rⁱ为关节i的减速比；

S2.2、第j个笛卡尔空间插补周期机器人各关节电机的最大转速与计算转速之比的最小值

如果Q小于1，则说明为完成此插补段运动，机器人6个关节中存在关节电机转速超出最大转速；由于插补运动需要保证各轴在约定笛卡尔空间插补周期内同时完成运动，机器人6个关节完成此插补段运动所需的笛卡尔空间插补周期均需要增加；

S2.3、重新计算第j个笛卡尔空间插补周期

式中，int为取整函数；Q为各关节电机的最大转速与计算转速之比的最小值；T_D为笛卡尔空间插补周期，T_D＝10ms。

进一步地，所述步骤S3包含如下步骤：