基于独立虚拟中心点的机器人分散式协同避障方法

本发明涉及一种基于独立虚拟中心点的机器人分散式协同避障方法，包括如下步骤：步骤1：利用扩展卡尔曼滤波融合惯性测量单元与里程计数据，获得机器人的当前位姿信息；步骤2：通过网络通信，机器人之间共享速度和位置信息，计算出每个机器人的虚拟中心点，虚拟中心点随机器人运动而运动；步骤3：根据每个机器人的当前位置与其目标点位置、其虚拟中心点的位置，得到机器人的目标矢量和排斥矢量；步骤4：定义一个切换信号判断机器人的运动模式为避障模式或者为无障碍模式；步骤5：利用矢量微分法得到机器人的期望速度与期望角度，根据控制法则得到机器人的实时速度和角速度，指导机器人运动。避障方法采用绕虚拟中心点，垂直于排斥矢量方向旋转运动；无障碍模式即机器人始终朝着目标矢量运动，从而引导机器人进行有序地避障。