  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 robustness.In response to these
challenges, in this paper we address theoretical and practical problem related
to both mutual localization and swarm planning.Firstly, we propose a
certifiable mutual localization algorithm.It features a concise problem
formulation coupled with lossless convex relaxation, enabling independence from
initial values and globally optimal relative pose recovery.Then, to explore how
detection noise and swarm motion influence estimation optimality, we conduct a
comprehensive analysis on the interplay between robots' mutual spatial
relationship and mutual localization. We develop a differentiable metric
correlated with swarm trajectories to explicitly evaluate the noise resistance
of optimal estimation.By establishing a finite and pre-computable threshold for
this metric and accordingly generating swarm trajectories, the estimation
optimality can be strictly guaranteed under arbitrary noise. Based on these
findings, an optimization-based swarm planner is proposed to generate safe and
smooth trajectories, with consideration of both inter-robot visibility and
estimation optimality.Through numerical simulations, we evaluate the optimality
and certifiablity of our estimator, and underscore the significance of our
planner in enhancing estimation performance.The results exhibit considerable
potential of our methods to pave the way for advanced closed-loop intelligence
in swarm systems.
