[发明专利]一种机器人连续点位运动规划方法

说明书

技术领域

本发明涉及自动控制技术领域，尤其涉及一种机器人连续点位运动规划方法。

背景技术

目前，随着自动化技术的不断发展和应用的广泛普及，工业机器人已在搬运、焊接、包装、喷绘等领域替代了传统的人力。工业机器人的运动过程需要在满足各种工作条件下给出一个高效合理的规划。传统上工业机器人的运动规划分为PTP运动(point-to-point)和CP运动(continuous path)，其中PTP控制最为简单，没有插补运算，各轴同时独立地走完自己的规划即可，其常用于快速定位和搬运作业。

基本的PTP运动从静止开始，到达目标点位置时速度减为零，相应加速度也为零。在实际作业中，为了避开可能的障碍，或者在不同的阶段采用不同的运动速度，往往需要用若干中间点来对整个PTP运动轨迹进行约束，即此时机器人需要连续进行多点的PTP运动规划。如果简单地逐段应用基本的PTP规划，那么在每一个中间点都有一个减速、停顿、加速的过程，这对于搬运等实际作业时不合理的，不仅大大降低了工作效率，而且还增加了能耗。

一般的工业机器人产品都提供了连续点位运动规划，典型的做法是当机器人以给定的范围“接近”目标点时，立即以此当前位姿作为起点，下一点作为目标点，当前速度和加速度作为初始条件，进行下一段的规划。在该做法中，“接近”范围一般是以总行程的百分比表示，例如一旦完成该段行程的90％，即距离目标点不足10％的时候，立即规划并向下一个目标点进发。其优点是：计算简单，能够实现连续的点位运动。缺点是：1，示教或计算得到的中间点不会准确到达，只是“接近”该点；2、整个轨迹的速度可能仍然不连续，比如，当“接近”的范围过小时，其速度连续的效果不明显，仍然会有明显的减速过程，只是不会减速至零；而“接近”范围过大则距离中间目标点的误差较大时就会开始下一目标点的运动。

仅采用传统三次样条曲线进行连续点位运动规划，具有以下不足之处：

1.由于该方式下只能指定2个边界条件，通常选择指定速度，那么起点和终点加速度不为零，有一定的跳变，这会使得在实际应用中产生震动(可以参考图1中所示的采用传统三次样条曲线下的角位移曲线和角加速度曲线的示意图中，在t＝0和t＝10时刻的曲线)；

2.不能保形，即会产生过冲回调问题。样条的光滑性会导致不期望的运动，例如某关节在特定时段内是不参与运动的，但是由于样条对曲线进行光滑会使其产生不必要的运动。

发明内容

本发明所要解决的一个技术问题是采用三次样条函数进行连续点位运动规划时，无法限制起点和终点加速度，产生跳变从而造成运动过程中产生震动；本发明所要解决的另一个技术问题是采用三次样条函数进行连续点位运动规划时运动过程中过冲回调问题。

本发明公开了一种基于样条函数的机器人连续点位运动规划方法，能够指定更多的边界条件，从而实现了整个运动过程光滑、平稳、无冲击；同时还能够解决过冲回调问题。

本发明提供的机器人连续点位运动规划方法，在运动指令所给定的数据点之间增加辅助点，在相邻的数据点之间插入n个中间辅助点，将一段运动曲线分为n+1段，这样就可以进一步地约束所规划的运动轨迹，从而满足更多的边界条件和其他条件。根据多项式的数学原理，每增加1个辅助点，可以增加一个约束条件与之对应。通过满足更多的边界条件和其他条件，使得整个运动过程光滑、平稳、无冲击。

本发明提供的机器人连续点位运动规划方法，通过各个相邻数据点之间的运动位移确定机器人经过中间每一个数据点处的运动速度，从而实现运动轨迹保形性，即保证在每一段相邻数据点之间的运动轨迹是单向的，不存在过冲回调的现象。

本发明提供的机器人连续点位运动规划方法，包括如下步骤：

(1)确定至少两个数据点的运动信息，机器人依次经过数据点，机器人经过的第一个数据点为起点，机器人经过的最后一个数据点为终点；

(2)在相邻两个数据点所形成的运动曲线上增加至少两个辅助点，以将运动曲线按时间等分为至少三个曲线段；

(3)根据相邻两个数据点的运动信息以及辅助点的约束条件，确定边界条件；

(4)基于三次样条函数与边界条件，确定运动曲线上各个曲线段的待定参数，以实现机器人连续点位运动规划。

本发明提供的机器人连续点位运动规划方法，约束规划运动轨迹以满足更多的边界条件，精确地经过每一个给定的数据点(运动指令中给出的途径点，一般由示教或者离线计算获得)。