一种基于混合测量的群机器人仿射编队控制方法

本发明公开了一种基于混合测量的群机器人编队控制方法，步骤如下：步骤1：选择一个主领导者和两个从领导者，构建以主领导者为根节点的通信拓扑图；步骤2：以主领导者的坐标作为原点建立全局坐标系，并获取环境地图；步骤3：基于环境地图获取从领导者的在全局坐标系中的坐标；步骤4：获取主领导者和从领导者各自的期望位置；步骤5：主领导者和从领导者基于优化后的领导者的控制律实时跟踪各自的期望位置；步骤6：计算当前跟随者与相邻机器人的理想距离；步骤7：基于跟随者编队控制率调节当前跟随者与相邻机器人之间的实时距离，实现队形控制。本发明不需要依赖GPS/GNSS获取全局坐标，可以采用不同的测量方式，提高系统构建的灵活性，成本降低。