指定初始关节速度的冗余度机械臂运动规划方案设计

设计了一种指定初始关节速度的冗余度机械臂运动规划方案.首先,根据机械臂关节角状态和末端执行器运动状态,在速度层上对机械臂建立伪逆算法求解模型;其次,为实现关节速度从指定初始速度连续趋近于执行任务所期望的速度解而在关节速度上加约束函数进行调整;再次,为减少机械臂执行任务期间末端执行器的位置误差而采用误差补偿方法以保证轨迹跟踪的精度;最后,将运动规划方案在MATLAB软件上对平面四连杆机械臂进行了仿真实验.仿真结果表明,该运动规划方案能消除机械臂在任务切换过程中的速度跳变,且末端执行器跟踪路径能达到较高的精度.