基于危险场的关节机器人实时避障控制

改进危险场计算公式,求得机器人工作空间动态危险场的积分解析解。计算中考虑机器人与障碍物之间的相对速度,建立障碍物连体坐标系,简化计算过程。针对关节机器人提出一种基于速度控制的避障算法,该方法将危险场得到的期望规避角速度反馈至基于转置雅可比矩阵逆运动学算法,并通过危险场的值对控制策略的标志位进行修改,使得机械臂具有任务终止与恢复能力。最后,通过数值仿真及与经典危险场方法进行对比表明了提出方法的有效性。