Adaptive planning horizon based on information velocity for vision-based navigation

Eric W. Frew, Jack W. Langelaan, Maciej Stachura

Research output: Chapter in Book/Report/Conference proceedingConference contribution

9 Scopus citations


This paper presents a receding horizon planning algorithm for vision-based navigation using bearings-only SLAM that adapts the planning horizon to the velocity of the information gained about the environment. Bearings-only SLAM has an inherent dynamic observability property such that specific motion is needed in order to determine the relative positions between the camera and obstacles. Thus, the estimates of new obstacles are always highly uncertain and information about the obstacles is dependent on the relative motion between the camera and objects. Receding horizon planners are typically used in conjunction with SLAM algorithms because they continually adjust to new information about the world. We present a receding horizon planner that incorporates information metrics explicitly into the receding optimization cost function. Furthermore, an adaptive horizon is used based on the intuition that when the information about the world is rapidly changing, planning does not need to be too long. Control and planning horizons are computed based on the sensor range and the effective speed of the UAV, which is computed as a weighted sum of estimated vehicle speed and time rate of change of the uncertainty of the obstacle position estimates. Simulation results demonstrate the integrated receding horizon system for vision-based SLAM; illustrate the value of integrating information-theoretic costs into the objective function and the adaptive approach; and extension of the planning approach to other applications such as exploration, target intercept, and cooperative active sensing.

Original languageEnglish (US)
Title of host publicationCollection of Technical Papers - AIAA Guidance, Navigation, and Control Conference 2007
PublisherAmerican Institute of Aeronautics and Astronautics Inc.
Number of pages20
ISBN (Print)1563479044, 9781563479045
StatePublished - 2007
EventAIAA Guidance, Navigation, and Control Conference 2007 - Hilton Head, SC, United States
Duration: Aug 20 2007Aug 23 2007

Publication series

NameCollection of Technical Papers - AIAA Guidance, Navigation, and Control Conference 2007


OtherAIAA Guidance, Navigation, and Control Conference 2007
Country/TerritoryUnited States
CityHilton Head, SC

All Science Journal Classification (ASJC) codes

  • Aerospace Engineering
  • Control and Systems Engineering
  • Electrical and Electronic Engineering


Dive into the research topics of 'Adaptive planning horizon based on information velocity for vision-based navigation'. Together they form a unique fingerprint.

Cite this