一种六自由度机械臂考虑力约束的轨迹规划方法

摘要

本发明属于机械臂考虑力约束的轨迹规划领域，具体涉及一种六自由度机械臂考虑力约束的轨迹规划方法。本发明包括：(1)将力约束转化为接触形变和接触运动速度的约束；(2)优化动态接触冲击的机械臂运动速度；(3)基于力约束进行轨迹规划。本发明将机械臂力约束转化为接触形变和接触运动速度的约束，再根据接触运动学，研究考虑动态接触冲击的机械臂运动速度优化方法和考虑接触形变的基于不同接触边缘的连续轨迹规划方法，此方法为考虑力约束的机械臂轨迹规划提供了新方法。此方法避免了机械臂末端与外界环境的接触碰撞过程在极短时间内完成，产生极大瞬间冲击，导致接触力超出安全范围。