Receding Horizon Trajectory Optimization for Simultaneous Signal Landscape Mapping and Receiver Localization

A receiver with no a priori knowledge about its own states is dropped in an unknown environment comprising multiple signals of opportunity (SOPs) transmitters. Assuming that the receiver could control its maneuvers in the form of acceleration commands, two problems are considered. First, the minimal conditions under which such environment is completely observable are established. It is shown that receiver-controlled maneuvers reduce the minimal required a priori information about the environment for complete observability. Second, the trajectories that the receiver should traverse in order to build a highfidelity signal landscape map of the environment, while simultaneously localizing itself within this map in space and time with high accuracy are prescribed. To this end, the one-step look-ahead (greedy) strategy is compared to the multi-step look-ahead (receding horizon) strategy. The limitations and achieved improvements in the map quality and localization accuracy due to the receding horizon strategy are quantified, and the associated computational burden is discussed.

[1]  G. Swenson,et al.  Interferometry and Synthesis in Radio Astronomy , 1986 .

[2]  Todd E. Humphreys,et al.  Motion planning for optimal information gathering in opportunistic navigation systems , 2013 .

[3]  Kenneth M. Pesyna,et al.  Constructing a continuous phase time history from TDMA signals for opportunistic navigation , 2012, Proceedings of the 2012 IEEE/ION Position, Location and Navigation Symposium.

[4]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

[5]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[6]  Y. Oshman,et al.  Optimization of observer trajectories for bearings-only target localization , 1999 .

[7]  Sameera S. Ponda,et al.  Trajectory Optimization for Target Localization Using Small Unmanned Aerial Vehicles , 2009 .

[8]  Gamini Dissanayake,et al.  Multi-Step Look-Ahead Trajectory Planning in SLAM: Possibility and Necessity , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[9]  M. Anguelova Observability and identifiability of nonlinear systems with applications in biology , 2007 .

[10]  Martin Buss,et al.  Combined Trajectory Planning and Gaze Direction Control for Robotic Exploration , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[11]  Todd E. Humphreys,et al.  Observability Analysis of Collaborative Opportunistic Navigation With Pseudorange Measurements , 2014, IEEE Transactions on Intelligent Transportation Systems.

[12]  Todd E. Humphreys,et al.  The price of anarchy in active signal landscape map building , 2013, 2013 IEEE Global Conference on Signal and Information Processing.

[13]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[14]  G. Swenson,et al.  Interferometry and Synthesis in Radio Astronomy, 2nd Edition , 2001 .

[15]  John J. Leonard,et al.  Adaptive Mobile Robot Navigation and Mapping , 1999, Int. J. Robotics Res..

[16]  Todd E. Humphreys,et al.  Observability Analysis of Opportunistic Navigation with Pseudorange Measurements , 2012 .

[17]  Todd E. Humphreys,et al.  Collaborative Opportunistic Navigation , 2012 .

[18]  Mark L. Psiaki,et al.  Modeling, Analysis, and Simulation of GPS Carrier Phase for Spacecraft Relative Navigation , 2005 .

[19]  Gamini Dissanayake,et al.  Planning under uncertainty using model predictive control for information gathering , 2006, Robotics Auton. Syst..

[20]  John L. Casti,et al.  Recent Developments and Future Perspectives in Nonlinear System Theory , 1982 .

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

[22]  Erik Blasch,et al.  Assessing Terrestrial Wireless Communications and Broadcast Signals as Signals of Opportunity for Positioning and Navigation , 2012 .

[23]  Todd E. Humphreys,et al.  Observability and Estimability of Collaborative Opportunistic Navigation with Pseudorange Measurements , 2012 .

[24]  Kenneth M. Pesyna,et al.  Tightly-Coupled Opportunistic Navigation for Deep Urban and Indoor Positioning , 2011 .

[25]  Todd E. Humphreys,et al.  Greedy Motion Planning for Simultaneous Signal Landscape Mapping and Receiver Localization , 2015, IEEE Journal of Selected Topics in Signal Processing.