一种基于多个控制点的空间机器人避撞方法
摘要:
本发明提供一种基于多个控制点的空间机器人避撞方法,轨迹规划时机械臂关节角速度平滑,避免其发生不连续,能够抑制由单个控制点跳变引起的振动问题。上述方法包括:(1)将障碍物处理成由三角面构成的非凸多面体,将机械臂处理成线段,确定描述线段与三角形之间的碰撞检测算法,得到机械臂和障碍物之间距离最近的一对控制点;(2)建立空间机器人考虑避撞任务的多任务运动学方程;(3)建立空间机器人的避撞约束条件,结合(2)的运动学方程进行避撞求解;(4)根据多个控制点的参数设计调整新控制点参数,结合(2)的运动学方程进行避撞求解;(5)根据多个控制点对一个障碍物的避撞求解,对空间机器人的机械臂进行多障碍物的避撞控制。
公开/授权文献
0/0