Abstract:Bearing measurements,as the most common modality in nature, have recently gained traction in multi-robot systems to enhance mutual localization and swarm collaboration. Despite their advantages, challenges such as sensory noise, obstacle occlusion, and uncoordinated swarm motion persist in real-world scenarios, potentially leading to erroneous state estimation and undermining the system's flexibility, practicality, and
What problem does this paper attempt to address?
This paper attempts to solve several key problems in multi - robot systems for mutual localization and trajectory planning based on azimuth measurements:
1. **Authenticity and Robustness**: Incorrect relative pose estimates may lead to coordinate misalignment and system crashes. Therefore, it is crucial for an estimator to provide a guarantee of the correctness of its solution. In addition, inevitable and uncontrollable sensor noise can significantly affect the estimation accuracy. The estimator must be able to authenticate the incorrectness of its solution and reject these solutions when detecting noise - corrupted estimates. However, existing local optimization methods (such as the work of Nguyen et al. (2020), Jang et al. (2021)) rely heavily on initial values and lack the ability to authenticate the optimal solution.
2. **Stability and Reliability**: To promote cooperation, swarm robots need to maintain the consistency of the reference frame at all times. This requires robots to continuously produce stable measurement results and perform reliable relative localization even in complex environments. These problems usually cause estimator failures when robots miss critical data due to obstacle occlusion or are in positions insufficient to recover relative poses, thereby compromising the reliability of the system.
3. **Estimation - Aware Planning**: Incorporating estimation considerations into swarm motion planning can further unbind the estimation. Current estimation - aware planning methods mainly focus on reducing estimation uncertainty, avoiding unobservable positions, or increasing observation information. Although these methods improve the performance of the estimator to some extent, they cannot strictly guarantee that the improved estimator can stably provide correct solutions in unknown environments. This is because these methods still follow the traditional modular system framework, under which the mutual localization module and the motion planning module are isolated and separated, without targeted theoretical analysis and algorithm design for specific estimators, resulting in limited performance of the entire system in complex environments.
To solve the above problems, the paper proposes a certifiable mutual localization algorithm and a certifiable swarm planning method. Specifically:
- **Certifiable Mutual Localization Algorithm**: By formulating the relative pose estimation problem as a non - convex maximum - likelihood estimation problem and converting it into a semidefinite programming problem through convex relaxation, this method can be solved in polynomial time without initial values and can provide a global optimal solution. In addition, it establishes an easily verifiable condition to certify the global optimality of the solution, thereby being able to reject incorrect relative poses and prevent coordinate confusion.
- **Certifiable Swarm Planning**: First, the deep relationship between mutual localization and swarm motion is theoretically explored, and a certificate matrix is introduced to verify the global optimality of candidate solutions. The minimum non - zero eigenvalue (called the certificate eigenvalue) is used as an indicator of estimation optimality. Through noise analysis, the influence of detection noise on estimation optimality is studied, and it is proved that the amount of noise required for different swarm motions to destroy optimality varies, and this measure is positively correlated with the certificate eigenvalue. When the certificate eigenvalue is zero, indicating no noise resistance (called the degenerate state), the paper provides specific robot motion conditions to identify these situations.
In summary, this paper aims to improve the stability and robustness of azimuth - measurement - based robot swarms in unknown and complex environments by proposing a certifiable mutual localization algorithm and a certifiable swarm planning method.