基于伪距离的冗余机器人避障算法

针对冗余机器人避障问题,提出一种基于伪距离且无需主从任务转换的冗余机器人避障算法。采用具有解析式的伪距离算法计算机器人与障碍物之间的接近程度,通过分析伪距离与欧式距离换算关系求取机器人与障碍物之间最小欧式距离,从而提高冗余机器人与障碍物之间的最小欧式距离求解效率。基于最小伪距离判别指标,在机器人末端轨迹上赋予末端沿最小距离方向避障速度实现末端避障。在零空间避障问题求解中提出一种自适应阻尼控制方法,产生虚拟排斥力使机器人连杆远离障碍物,并自适应调整阻尼增益参数响应避障速度。通过七自由度冗余机器人的仿真和试验验证了该算法的高效性和有效性。仿真结果表明,该算法提出的末端避障方法避免了传统的主从任务转换避障算法在任务切换时所引起的末端振荡且缩短了避障时间,同时该算法提出的零空间避障方法能够在低误差跟踪末端期望轨迹下避免机器人连杆与障碍物相碰撞。试验结果表明,该算法能够完成多障碍物避障,验证了该算法的末端避障方法和零空间避障方法的正确性。