一种串联机械臂位置级的自平行运动规划方法

本发明公开了一种串联机械臂位置级的自平行运动规划方法，首先构建作业坐标系与台车坐标系；其次求解串联机械臂末端相对于台车坐标系的位姿矩阵，确认末端初始朝向和末端初始位置，根据作业目标确认自平行运动模式；最后根据自平行运动模式规划串联机械臂转动关节和伸缩关节的关节位置，以实现控制串联机械臂末端在移动过程中朝向和位置。本发明根据各自运动模式的不同设计约束条件，基于位置级规划机械臂关节位置，易于控制，更适用于电磁比例阀控制的重型机械臂。