基于PSO算法的双臂机器人时间最优轨迹规划

依据双臂机器人运动学约束条件,将已完成无碰撞路径规划的由两个5自由度机械臂构成的双臂机器人作为一个具有10自由度的单臂机器人,采用多段样条多项式插值对其一般时间最优轨迹规划问题进行研究,并以4-3-3-4次多项式插值为例,运用PSO算法对双臂机器人各段插值时间进行优化,得到满足速度约束条件下的最优插值时间,并由此得到双臂机器人各个关节的运动位置、速度和加速度曲线,仿真结果表明,该方法能够有效实现指定速度约束下已完成无碰撞路径规划的双臂机器人时间最优轨迹规划。