多路径段平滑过渡的自适应前瞻位姿插补算法

任务空间多路径段平滑过渡可提高工业机器人的运动速度.在非对称S曲线加减速控制的路径长度约束下,以给定速度不为零的路径衔接点和半径调节参数为基准,根据路径段的长度变化,自适应前瞻规划出路径段间最优衔接速度,并在相邻路径段间采用圆弧进行平滑过渡,路径段全程采用非对称S曲线加减速控制.为提高算法的通用性,根据S曲线加减速区段函数的特点,对加速和减速区段函数进行优化.在6自由度工业机器人实时控制系统平台上进行实验验证,结果表明,与传统加减速控制算法相比,该前瞻算法的作业执行效率可提高22.03%以上,并可实现多路径段间速度的平滑过渡和轨迹的修形.

An adaptive look-ahead position and orientation interpolation algorithm for multi-path segments smooth transition

The velocity of industrial robots can be improved by multi-path smooth transition of task space. Under the path length constraint of the asymmetric S-curve acceleration/deceleration control, known path tansition points with non-zero velocity and the adjustable radius parameters are used as a reference to obtain optimized transition velocity between multi-path segments according to the changes of adjacent trajectory segments length, and arc smooth transition is used between adjacent path segments. The asymmetric S-curve acceleration/deceleration control is adopted for complete path segments. In order to improve the versatility of the algorithm, the velocity functions are simplified according to the characteristics of the S-curve acceleration/deceleration zone function. Experiments are carried out on the real-time control system platform of 6 degrees of freedom industrial robots. The results show that the efficiency of the algorithm can be improved by more than 22.03% compared with the traditional acceleration/deceleration control algorithm, and smooth transition of velocity and modification of trajectory between the multi-path segments can be realize.