---
title: Distributed Bearing-Pose Estimation
url: https://www.emergentmind.com/topics/distributed-bearing-based-pose-estimator
type: topic
---

# Distributed Bearing-Pose Estimation

to=arxiv_search.search  大发时时彩计划 code :
{"query":"distributed bearing-based pose estimation multi-agent network localization bearing rigidity distributed observer arXiv", "max_results": 10}
to=arxiv_search.search  天天中彩票网站 code :
{"query":"1503.08473 OR 2304.01884 OR 2304.14455 OR 2606.03931 OR 1311.1044 OR 2401.07784 OR 2306.10749", "max_results": 10}
to=arxiv_search.search  ചികിത code :
{"query":"Bearing-Based Distributed Control and Estimation of Multi-Agent Systems", "max_results": 5}
A distributed bearing-based pose estimator is a networked observer that reconstructs the positions, or the positions and orientations, of agents from local bearing measurements and neighbor-to-neighbor communication. In the canonical anchor-based formulation, each follower maintains a position estimate, a subset of anchors knows its true absolute position, and the update law uses orthogonal projections of inter-agent estimate differences onto subspaces orthogonal to measured bearings; under infinitesimal bearing rigidity and sufficiently many anchors, the estimator converges exponentially to the true configuration and removes the translation-and-scale ambiguity inherent to bearing-only sensing [1503.08473]. Subsequent work extends the same basic idea to directed acyclic graphs with time-varying orientations, randomized gossip updates, \(SE(2)\) body-frame formulations, angle-rigid directed sensing graphs, certifiable convex relaxations, and hybrid bearing–distance–inertial localization architectures [2304.01884].

## 1. State, measurement, and graph models

In the anchor-based network-localization model, each agent \(i\) has a true constant position \(p_i\in\mathbb R^d\) and maintains an estimate \(\hat p_i(t)\in\mathbb R^d\). The estimator is written as a continuous-time single integrator,
\[
\dot{\hat p}_i(t)=u_i(t),
\]
on a fixed, undirected, connected graph \(\mathcal G=(\mathcal V,\mathcal E)\). If \((i,j)\in\mathcal E\), agents \(i\) and \(j\) can measure the bearing
\[
g_{ij}=\frac{p_j-p_i}{\|p_j-p_i\|}\in\mathbb R^d,\qquad g_{ji}=-g_{ij},
\]
and the basic projection operator is
\[
P_g\triangleq I_d-g g^T,
\]
which projects onto the subspace orthogonal to \(g\) [1503.08473].

The same family of estimators appears in dynamic pose problems. In one \(SO(3)\) formulation, the positions \(p_i\in\mathbb R^3\) are fixed but the orientations \(R_i(t)\in SO(3)\) evolve according to
\[
\dot R_i = R_i[\omega_i]_\times,
\]
where \(\omega_i(t)\in\mathbb R^3\) is the body-measured angular velocity. Agent \(i\) measures only the local time-varying bearing
\[
b_{ij}^i = R_i^T\,\frac{p_j-p_i}{\|p_j-p_i\|}\in\mathbb S^2,
\]
and exchanges \((\hat R_j,\hat p_j)\) with its neighbors over a directed graph [2304.01884].

A body-frame formulation in \(SE(2)\) uses local bearing angles
\[
\beta_{ij}= \operatorname{atan2}\!\bigl((T(\psi_i)^T(p_j-p_i))_y,\,(T(\psi_i)^T(p_j-p_i))_x\bigr)
\]
or, equivalently, unit vectors
\[
r_{ij}:=T(\psi_i)^T\frac{p_j-p_i}{\|p_j-p_i\|},
\]
with \(T(\psi)\) rotating a global vector into the agent’s body frame [1311.1044]. A more recent orientation-free formulation does not estimate bearings themselves but angles \(\alpha_{ijk}=\beta_{ij}^\top\beta_{ik}\) computed from pairs of body-frame bearings, and then recovers orientations afterward from estimated positions, bearings, and bearing derivatives [2606.03931].

These models differ in state dimension and graph orientation, but they share a common structure: geometric information enters through direction constraints, while distributed estimation is achieved through local exchanges of estimates and local projection or gradient terms.

## 2. Rigidity, gauge freedoms, and observability

Bearing-only sensing does not determine an absolute configuration without additional structure. In the static anchor-based problem, infinitesimal bearing rigidity is the key identifiability condition. If the bearing-rigidity matrix is
\[
R_B(p)=\operatorname{diag}\!\bigl(\tfrac1{\|e_k\|}P_{g_k}\bigr)(H\otimes I_d),
\]
then infinitesimal bearing rigidity is equivalent to
\[
\rank R_B(p)=dn-d-1,\qquad \Null R_B(p)=\operatorname{span}\{\,1\otimes I_d,\;p\}.
\]
The nullspace shows that all bearings are preserved by global translations and uniform scaling. Accordingly, once all inter-neighbor bearings match the true ones, the configuration is unique only up to translation and scale; anchors pin down those remaining degrees of freedom [1503.08473].

In \(SE(2)\), the corresponding infinitesimal-rigidity criterion is
\[
\rank B_G(\chi)=3n-4,
\]
where \(B_G(\chi)\) is the directed bearing-rigidity matrix. Its four trivial infinitesimal motions are two global translations in \(\mathbb R^2\), a uniform dilation, and a coordinated rotation in which each agent spins in place while the whole configuration rotates in \(\mathbb R^2\) so that all local bearings remain constant [1311.1044].

Angle-rigidity theory introduces a different observability notion. For the angle-rigidity matrix \(A_G(q)\), the nullspace always contains the seven-dimensional space of infinitesimal similarities,
\[
\mathcal T(q)=\{\,\kappa q+S(1_N\otimes\omega)\circ q+1_N\otimes x:\kappa\in\mathbb R,\;\omega,x\in\mathbb R^3\}.
\]
A framework is infinitesimally angle-rigid if
\[
\Null A_G(q)=\mathcal T(q)
\quad\Longleftrightarrow\quad
\lambda_8\!\bigl(A_G(q)^T A_G(q)\bigr)>0.
\]
The method based on angle rigidity states explicitly that this is a weaker condition than bearing rigidity and that fewer edges, and no reciprocity, are required to attain full infinitesimal rank [2606.03931].

A common misconception is that bearing measurements alone identify absolute pose. The rigidity results show the opposite: bearings determine a formation only modulo gauge freedoms, and each formulation must remove those freedoms explicitly through anchors, penalties, range pins, leader states, or additional geometric constraints.

## 3. Canonical anchor-based distributed estimator

The anchor-based estimator for static positions is the prototype of the distributed bearing-based pose estimator. The node set is partitioned into anchors \(\mathcal V_a\) and followers \(\mathcal V_f\). For anchors, \(\hat p_i(t)\equiv p_i\). For each follower \(i\in\mathcal V_f\), the local update law is
\[
\dot{\hat p}_i(t)
=
-\sum_{j\in\mathcal N_i}
P_{g_{ij}}\bigl(\hat p_i(t)-\hat p_j(t)\bigr),
\]
while \(\dot{\hat p}_i(t)=0\) for anchors [1503.08473].

Stacking the anchor and follower estimates as \(\hat p=[\hat p_a^T,\hat p_f^T]^T\), one defines the bearing-Laplacian \(L(G,g)\in\mathbb R^{dn\times dn}\) and partitions it as
\[
L=
\begin{bmatrix}
L_{aa} & L_{af}\\
L_{fa} & L_{ff}
\end{bmatrix}.
\]
The estimator then becomes
\[
\dot{\hat p}_a=0,\qquad
\dot{\hat p}_f=-L_{ff}\hat p_f-L_{fa}p_a.
\]
This is a linear consensus-type protocol with matrix weights \(P_{g_{ij}}\). Each agent needs only its neighbors’ estimates and the fixed true bearings \(g_{ij}\) [1503.08473].

Its convergence analysis is entirely spectral. Under an undirected, fixed, connected graph, infinitesimal bearing rigidity, and \(n_a\ge2\), the bearing-Laplacian satisfies
\[
\rank L = dn-d-1,\qquad
\Null L = \operatorname{span}\{1\otimes I_d,\;p\},
\]
and the principal submatrix \(L_{ff}\) is positive definite if and only if \(n_a\ge2\). The resulting theorem states that, for any initial \(\hat p_f(0)\),
\[
\hat p_f(t)\longrightarrow -L_{ff}^{-1}L_{fa}p_a = p_f
\]
exponentially fast. The proof uses the unique equilibrium of the linear system and the identity \(L_{fa}p_a+L_{ff}p_f=0\), which follows from \(p\in\Null L\) [1503.08473].

The discrete-time forward-Euler implementation is
\[
\hat p_i(k+1)
=
\hat p_i(k)
-\alpha\sum_{j\in\mathcal N_i}
P_{g_{ij}}\bigl[\hat p_i(k)-\hat p_j(k)\bigr],
\]
with stability condition
\[
\alpha<\frac{2}{\lambda_{\max}(L_{ff})}.
\]
Followers may start from any \(\hat p_i(0)\); the stated implementation remark is that there is no special requirement other than not exactly collocated with anchors in a degenerate configuration. Each update costs \(O(d^2|\mathcal N_i|)\) flops, and the memory cost is \(O(d+|\mathcal N_i|d^2)\) [1503.08473].

The simulation example in \(\mathbb R^3\) uses 50 agents, 269 edges, and 4 anchors, with \(\rank R_B=3\cdot 50-4=146\). The initial follower estimates are chosen uniformly at random, the performance metric is
\[
e_i(t)=\|\hat p_i(t)-p_i\|,
\]
and all \(e_i(t)\) converge exponentially to zero. The reported interpretation is that the example demonstrates global convergence, robustness to large initial errors, and correctness of the protocol [1503.08473].

## 4. Kinematic, asynchronous, and large-scale variants

For mobile agents with known velocity inputs, the projection structure can be embedded into a kinematic observer. In the simultaneous localization and affine formation tracking setting, agent \(i\) evolves according to \(\dot p_i=v_i h_i\), with heading \(h_i=[\cos\theta_i;\sin\theta_i]\). The distributed position-estimate dynamics are
\[
\dot{\hat p}_i
=
-\,k_p\sum_{j\in N_i}\pi_{g_{ij}}(\hat p_i-\hat p_j)
-k_p f_i+v_i h_i,
\]
where \(f_i=\hat p_i-p_i\) for anchors and \(f_i=0\) otherwise. For the estimation error \(\delta_i=\hat p_i-p_i\), the stacked dynamics are
\[
\dot\delta=-k_p(L_B+A)\delta.
\]
With the Lyapunov function \(W(\delta)=\tfrac12\delta^T\delta\), the paper states
\[
\dot W\le -k_p\lambda_{\min}(L_B+A)\|\delta\|^2,
\]
so \(\delta(t)\to0\) exponentially fast at rate \(\ge k_p\lambda_{\min}(L_B+A)\) [2306.10749].

The same work isolates estimator performance in a 7-agent example with anchors \(\{1,7\}\) under two scenarios: translation along a sinusoid with constant desired bearings, and circular rotation with time-varying desired bearings. In both cases \(\|\delta(t)\|\) falls from an \(O(1)\) initial value to below \(10^{-2}\) in \(20\)–\(30\,\mathrm s\) with \(k_p=1\), and the log-scale plots confirm essentially exponential decay [2306.10749].

Asynchronous operation is addressed by randomized gossip localization. At each discrete time, a node wakes up uniformly at random, selects a neighbor with positive probability, and exactly that pair interacts. If both are followers, the pairwise update is
\[
\hat p_i(k+1)=\hat p_i(k)-\alpha A_{ij}\bigl(\hat p_i(k)-\hat p_j(k)\bigr),
\]
\[
\hat p_j(k+1)=\hat p_j(k)-\alpha A_{ji}\bigl(\hat p_j(k)-\hat p_i(k)\bigr),
\]
while if one node is a beacon, only the follower updates. In expectation the follower error satisfies
\[
E[\tilde p_f(k+1)]
=
\bigl(I_{dn_f}-\alpha L^M_{ff}\bigr)E[\tilde p_f(k)].
\]
The basic step-size requirement is
\[
\alpha<\frac{2}{\lambda_{\max}(L^M_{ff})},
\]
and a stronger condition gives geometric mean-square decay and almost-sure convergence of every follower estimate to its true position [2304.14455].

The large-scale simulation for this gossip scheme uses \(n=1089\) nodes in \(\mathbb R^3\), two beacons, and \(25\times10^3\) gossip updates. The total bearing error
\[
\sum_{(i,j)\in E}\bigl\|A_{ij}\bigl(\hat p_j(k)-\hat p_i(k)\bigr)\bigr\|^2
\]
decays exponentially to zero. The communication cost per interaction is \(2d\) scalars, and the computation cost per agent is \(O(d^2)\) flops [2304.14455].

These variants preserve the same geometric core—projection onto subspaces orthogonal to measured bearings—while changing the activation model, the kinematics, or the scale of the network.

## 5. Distributed full-pose estimation

When orientations are unknown and time-varying, distributed bearing-based pose estimation becomes a cascaded nonlinear observer problem. In one \(SO(3)\) formulation, the graph is directed and acyclic, agents \(1\) and \(2\) are leaders, and each follower has at least two non-collinear bearings. The follower attitude observer is
\[
\dot{\hat R}_i
=
\hat R_i\Bigl[
\omega_i
-
k_R\,\hat R_i^T
\sum_{j\in\mathcal N_i}k_{ij}\bigl(\hat R_j b_{ij}^j\times \hat R_i b_{ij}^i\bigr)
\Bigr]_\times,
\]
with leaders setting \(\hat R_\ell=R_\ell\). The attitude error is \(\tilde R_i=R_i\hat R_i^T\), and the unforced subsystem is shown to be almost-globally asymptotically stable, while the forced system satisfies an ISS inequality of the form
\[
\frac{d}{dt}|\tilde R_i|_I^2
\le
-\alpha_i(|\tilde R_i|_I)
+
\gamma_i\Bigl(\sum_{j\in\mathcal N_i}|\tilde R_j|_I\Bigr).
\]
Induction along the acyclic ordering yields network-wide AGAS of the attitude observer [2304.01884].

The position observer in the same paper is
\[
\dot{\hat p}_i
=
-\,k_R\Bigl[\sum_{j\in\mathcal N_i}k_{ij}(\hat R_j b_{ij}^j\times \hat R_i b_{ij}^i)\Bigr]_\times \hat p_i
-k_p\sum_{j\in\mathcal N_i}\hat R_i P_{b_{ij}^i}\hat R_i^T(\hat p_i-\hat p_j),
\]
with error \(\tilde p_i=p_i-\tilde R_i\hat p_i\). The unforced position subsystem is globally exponentially stable, and the ISS estimate
\[
\dot V_i
\le
-\lambda_i\|\tilde p_i\|^2
+
\sum_{j\in\mathcal N_i}
\Bigl(
\beta_1\|\tilde p_j\|^2
+\beta_2|\tilde R_j|_I^2
+\beta_3|\tilde R_i|_I^2
\Bigr)
\]
leads to the overall AGAS result for \((\tilde R_i,\tilde p_i)\to(I_3,0)\). The simulation places eight agents at the corners of the cube \(\{0,2\}^3\), chooses bounded sinusoidal angular velocities, and shows the average attitude and position errors decaying smoothly to zero [2304.01884].

A different route to full-pose estimation is the distributed \(SE(2)\) estimator based on a directed bearing-rigidity matrix and gradient descent on an augmented cost
\[
J(e)=\tfrac12\bigl[k_e\|e\|^2+k_1\|\hat\xi_{\iota\iota}\|^2+k_2(\|\hat\xi_{\iota\kappa}\|^2-1)^2+k_3(1-\cos\hat\theta_\iota)\bigr].
\]
A root agent \(\iota\) and a reference neighbor \(\kappa\) are chosen so that \(d(p_\iota,p_\kappa)>0\) is known, or set to \(1\) w.l.o.g. The update depends only on each agent’s own estimate and the current estimates of its outgoing neighbors, so the scheme is fully distributed. Under \(\rank B_G=3n-4\), the added penalty terms remove the trivial motions and standard gradient-descent arguments give local asymptotic convergence [1311.1044].

More recently, a time-varying \(3\)-D observer has been proposed that estimates positions from angles computed from body-frame bearings without using orientations in the position subsystem. Its position observer is
\[
\dot{\hat q}_i
=
\eta_i(\hat q,\hat Q^s)-\kappa_q\,\zeta_i(\hat q),
\]
and orientations are then recovered on \(SO(3)\) by gradient flows derived from local fitting costs. The stated graph condition is infinitesimal angle rigidity rather than bearing rigidity, and the overall result is local uniform exponential stability under persistently exciting motions for a subset of robots [2606.03931].

Taken together, these formulations show that orientation need not be handled in a single way: it may be estimated jointly with position in a cascade, fixed by a rooted \(SE(2)\) gauge choice, or recovered after an orientation-free position step.

## 6. Closed-form, certifiable, and hybrid directions

A related development is the closed-form \(4\)-DoF inter-robot pose estimator that assumes roll and pitch are known from VIO and estimates only yaw and translation. Its state is
\[
q_i=(t_i,\theta_i),\qquad
q=[t_1,\dots,t_n,\theta_1,\dots,\theta_n]^\top\in\mathbb R^{4n}.
\]
Yaw is obtained from a relaxed homogeneous linear system \(Go=0\), followed by projection of each \(\mathbf o_i^*=[x_i,y_i]^T\) onto the unit circle via
\[
\theta_i^*=\operatorname{atan2}(y_i,x_i),
\]
and translation is recovered by tangent-plane projection
\[
P_{g_{ij}}=I_3-g_{ij}g_{ij}^\top
\]
and a Total Least Squares solve. The observability analysis states that \(\operatorname{rank}(O)\le 4n-4\), so global translation and global yaw shift are always unobservable, and identifies two additional degeneracies: collinear formations and shape-preserving formations. The autonomous observability test monitors \(\sigma_4(A)\) and \(\kappa(A)=\sigma_{\max}(A)/\sigma_4(A)\) and triggers the solution only when geometry has stabilized and excitation is sufficient [2606.26616].

The same work reports simulations with \(2\)–\(10\) robots and real-world experiments with \(3\) quadrotors. In the real experiments, Ours-OT achieves approximately \(2^\circ\) rotation error, approximately \(0.1\,\mathrm m\) translation error, runtime approximately \(0.15\,\mathrm{ms}\), and estimation latency as early as \(6\)–\(8\,\mathrm s\), while the observability test eliminates reliance on a predefined fixed-length sliding window [2606.26616].

Certifiable mutual localization formulates bearing-only pose recovery as a maximum-likelihood problem over \(SE(3)\), relaxes it to an SDP,
\[
\min_{Z\in\mathrm{Sym}_+^{3N}} \mathrm{Tr}(MZ)
\quad\text{s.t.}\quad
Z_{ii}=I_3,\ \operatorname{rank}(Z)=3,
\]
and then drops the rank constraint to obtain a convex program. The paper also gives a distributed ADMM sketch and a certificate matrix \(K\) such that global optimality is certified by
\[
K\succeq 0,
\]
with \(\lambda_4(K)\ge0\) reflecting the world-frame gauge. Under bounded noise, the condition
\[
\lambda_4(\hat K)\ge B
\]
strictly guarantees estimation optimality [2401.07784].

A broader hybrid direction is CREPES-X, which combines bearing, distance, and inertial sensing in a two-stage hierarchy. Its single-frame closed-form estimator uses MDS, Wahba alignment, yaw estimation from horizontal projections, and a graph-based bearing outlier rejector; its multi-frame stage uses IMU pre-integration, robocentric relative kinematics, a loosely coupled initialization, and a tightly coupled sliding-window optimization. On a 10-robot benchmark with window 10, the reported accuracies are \(0.12\,\mathrm m,\,3.1^\circ\) for SFC, \(0.03\,\mathrm m,\,0.34^\circ\) for SFO, \(0.012\,\mathrm m,\,0.22^\circ\) for MFLO, and \(0.006\,\mathrm m,\,0.14^\circ\) for MFTO; the real-world indoor result for 5 robots is \(0.073\,\mathrm m\) and \(1.817^\circ\) RMSE, with stability up to \(90\%\) bearing outliers and real-time operation up to approximately 20 robots on desktop [2512.24688].

Across these lines of work, the phrase “distributed bearing-based pose estimator” no longer denotes a single algorithmic template. It now includes projection-based linear localization, nonlinear cascaded observers on \(SO(3)\), gradient systems on \(SE(2)\), angle-rigidity observers on directed graphs, pairwise gossip schemes, closed-form partial-pose solvers with observability tests, and certifiable convex programs. What remains invariant is the geometric premise: relative direction information is sufficient for pose recovery only when the sensing graph and the agent motions satisfy the appropriate rigidity or observability conditions, and distributed estimation succeeds only when those geometric conditions are matched by a gauge-fixing mechanism and a stability proof suited to the chosen state space.

Source: https://www.emergentmind.com/topics/distributed-bearing-based-pose-estimator