Velocimeter light-detection-and-ranging (LIDAR)–informed batch and sequential estimation approaches for terrain relative navigation applications are developed in this paper. State-of-the-art velocimeter LIDAR sensors are capable of delivering simultaneous three-dimensional relative position, relative Doppler velocity, and reflectivity measurements for every point in the field of view. The proposed batch estimation algorithm yields accurate and statistically consistent vehicle velocity estimates in unknown (uncooperative) environments. This work presents novel pointwise relative position and Doppler velocity measurement models that can be utilized in the presence of known (cooperative) environments. Rate estimates obtained by the batch estimator are fused with the pointwise measurement models and classical inertial measurement unit formulations in the form of a multiplicative extended Kalman filter. This Doppler LIDAR-based sensor fusion approach yields informative terrain relative navigation solutions suitable for both cooperative and uncooperative environments. Results from extensive emulation robotics testing performed at NASA Johnson Space Center and Texas A&M’s Land, Air, and Space Robotics laboratory are presented to validate the proposed methodologies.

No abstract

No abstract

A sensor fusion approach to terrain relative navigation is proposed in this paper. Sensor data from Global Position System (GPS), Inertial Navigation System (INS), and Doppler light detection and ranging (LIDAR) provide a relative state estimate through a novel multiplicative extended Kalman filter. The measurement model of the Doppler LIDAR is derived from first principals and employed by the filter to update the estimates propagated by the GPS/INS data stream. The line-of-sight Doppler velocity measurement provides direct feedback to the velocity states and improves sensitivity to these state estimates. A novel Rauch–Tung–Striebel smoother framework is derived that is compatible with states exhibiting multiplicative error that enables seamless postprocessing of state estimates filtered with a multiplicative extended Kalman filter. This new filter and smoother framework is tested with suborbital flight data from Blue Origin’s New Sheppard ascent and landing missions.