三阶多机器人协同编队动态避障控制

Dynamic Obstacle Avoidance Control of Three-order Multi-robot Cooperative Formation

针对智能水下机器人编队在三维复杂环境中的避障和一致性控制问题,提出了协同编队动态避障控制算法。建立了基于动态障碍物运动速度的自适应斥力增益项,并将其引入斥力势场函数中,使机器人安全规避静态及动态障碍物,定义了基于机间势场增益项和机间通信权重的机间势场函数,解决机器人易自撞、脱离编队的问题;将机器人在势场作用下的合加速度引入一致性协议中,结合改进势场与一致性理论设计编队协同避障控制器;通过Lyapunov函数方法证明了稳定性。仿真结果表明:多机器人在该算法下能安全避障并实现位置、速度的一致性。

Aiming at the obstacle avoidance and consensus control of underwater vehicles formation in a3D complex environment,a cooperative formation dynamic obstacle avoidance control algorithm is proposed.An adaptive repulsion gain term based on the speed of dynamic obstacles is established and it is introduced into the repulsion potential field function to enable the robot to safely avoid static and dynamic obstacles.The potential field function based on the gain term of the potential field and the communication weight between the AUVs are defined to solve the robots of easy self collision and leaving the formation.The total acceleration of the AUVs under the action of the potential field is introduced into the consensus protocol,and the formation cooperative obstacle avoidance controller is designed by combining the improved artificial potential field and the consensus theory.The Lyapunov function is used to prove the stable convergence.The simulation results show that multi-AUV can safely avoid obstacles and achieve the consensus of position and speed with the algorithm.