Observability properties of relative position and heading estimation with bearing-only measurements

We consider the problem of relative position and heading estimation between two vehicles modeled as Dubins cars. We assume that one vehicle, say vehicle 2, is equipped with a monocular camera sensor to obtain bearing measurements of vehicle 1. We investigate global observability properties of this problem when the linear speeds and the angular velocities of both vehicles are constant. We establish observability conditions when the velocity information of vehicle 1 is communicated to vehicle 2. We also illustrate unobservable scenarios when both vehicles are cruising or orbiting. We further prove that the relative state is observable without communication between the vehicles, if vehicle 1 and 2 are orbiting and cruising, respectively. When both vehicles are orbiting, we develop conditions on the angular velocities of the vehicles to ensure observability.

[1]  Randal W. Beard,et al.  Relative heading estimation for target handoff in GPS-denied environments , 2016, 2016 American Control Conference (ACC).

[2]  Ehud Rivlin,et al.  Graph-based distributed cooperative navigation for a general multi-robot measurement model , 2012, Int. J. Robotics Res..

[3]  James J. Spilker,et al.  GPS Signal Structure and Performance Characteristics , 1978 .

[4]  He Bai,et al.  Relative heading estimation under constant disturbances , 2017, 2017 American Control Conference (ACC).

[5]  Roland Siegwart,et al.  Observability analysis for mobile robot localization , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Giuseppe Oriolo,et al.  Mutual localization using anonymous bearing measurements , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[7]  C. I. Byrnes,et al.  Global observability and detectability: an overview , 1988 .

[8]  Michael J. Allen,et al.  Autonomous Airborne Refueling Demonstration, Phase I Flight-Test Results , 2007 .

[9]  Randal W. Beard,et al.  Graph-Based Observability Analysis of Bearing-Only Cooperative Localization , 2012, IEEE Transactions on Robotics.

[10]  Andrea Cristofaro,et al.  3D cooperative localization and mapping: Observability analysis , 2011, Proceedings of the 2011 American Control Conference.

[11]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

[12]  V. Aidala,et al.  Observability Criteria for Bearings-Only Target Motion Analysis , 1981, IEEE Transactions on Aerospace and Electronic Systems.