An official website of the United States government
This paper presents a navigation system for autonomous rendezvous, proximity operations, and docking (RPOD) with respect to non-cooperative space objects using a novel velocimeter light detection and ranging (LIDAR) sensor. Given only raw position and Doppler velocity measurements, the proposed methodology is capable of estimating the six degree-of-freedom (DOF) relative velocity without any a priori information regarding the body of interest. Further, the raw Doppler velocity measurement field directly exposes the body of interest’s center of rotation (i.e. center of mass) enabling precise 6-DOF pose estimation if the rate estimates are fused within a Kalman filter architecture. These innovative techniques are computationally inexpensive and do not require information from peripheral sensors (i.e. gyroscope, magnetometer, accelerometer etc.). The efficacy of the proposed algorithms were evaluated via emulation robotics experiments at the Land, Air and Space Robotics (LASR) laboratory at Texas A&M University. Although testing was completed with a single body of interest, this approach can be used to online estimate the 6-DOF relative velocity of any amount of non-cooperative bodies within the field-of-view.
more »
« less
Velocimeter LIDAR-Based Multiplicative Extended Kalman Filter for Terrain Relative Navigation Applications
This paper presents a Multiplicative Extended Kalman Filter (MEKF) framework using a state-of-the-art velocimeter Light Detection and Ranging (LIDAR) sensor for Terrain Relative Navigation (TRN) applications. The newly developed velocimeter LIDAR is capable of providing simultaneous position, Doppler velocity, and reflectivity measurements for every point in the point cloud. This information, along with pseudo-measurements from point cloud registration techniques, a novel bulk velocity batch state estimation process and inertial measurement data, is fused within a traditional Kalman filter architecture. Results from extensive emulation robotics experiments performed at Texas A&M’s Land, Air, and Space Robotics (LASR) laboratory and Monte Carlo simulations are presented to evaluate the efficacy of the proposed algorithms.
more »
« less
- Award ID(s):
- 1946890
- PAR ID:
- 10318613
- Date Published:
- Journal Name:
- AIAA SCITECH 2022 Forum
- Format(s):
- Medium: X
- Sponsoring Org:
- National Science Foundation
More Like this
-
-
Legged robots require knowledge of pose and velocity in order to maintain stability and execute walking paths. Current solutions either rely on vision data, which is susceptible to environmental and lighting conditions, or fusion of kinematic and contact data with measurements from an inertial measurement unit (IMU). In this work, we develop a contact-aided invariant extended Kalman filter (InEKF) using the theory of Lie groups and invariant observer design. This filter combines contact-inertial dynamics with forward kinematic corrections to estimate pose and velocity along with all current contact points. We show that the error dynamics follows a log-linear autonomous differential equation with several important consequences: (a) the observable state variables can be rendered convergent with a domain of attraction that is independent of the system’s trajectory; (b) unlike the standard EKF, neither the linearized error dynamics nor the linearized observation model depend on the current state estimate, which (c) leads to improved convergence properties and (d) a local observability matrix that is consistent with the underlying nonlinear system. Furthermore, we demonstrate how to include IMU biases, add/remove contacts, and formulate both world-centric and robo-centric versions. We compare the convergence of the proposed InEKF with the commonly used quaternion-based extended Kalman filter (EKF) through both simulations and experiments on a Cassie-series bipedal robot. Filter accuracy is analyzed using motion capture, while a LiDAR mapping experiment provides a practical use case. Overall, the developed contact-aided InEKF provides better performance in comparison with the quaternion-based EKF as a result of exploiting symmetries present in system.more » « less
-
null (Ed.)Continuous advancements in LiDAR technology have enabled compelling wind turbulence measurements within the atmospheric boundary layer with range gates shorter than 20 m and sampling frequency of the order of 10 Hz. However, estimates of the radial velocity from the back-scattered laser beam are inevitably affected by an averaging process within each range gate, generally modeled as a convolution between the actual velocity projected along the LiDAR line-of-sight and a weighting function representing the energy distribution of the laser pulse along the range gate. As a result, the spectral energy of the turbulent velocity fluctuations is damped within the inertial sub-range with respective reduction of the velocity variance, and, thus, not allowing to take advantage of the achieved spatio-temporal resolution of the LiDAR technology. In this article, we propose to correct this turbulent energy damping on the LiDAR measurements by reversing the effect of a low-pass filter, which can be estimated directly from the LiDAR measurements. LiDAR data acquired from three different field campaigns are analyzed to describe the proposed technique, investigate the variability of the filter parameters and, for one dataset, assess the procedure for spectral LiDAR correction against sonic anemometer data. It is found that the order of the low-pass filter used for modeling the energy damping on the LiDAR velocity measurements has negligible effects on the correction of the second-order statistics of the wind velocity. In contrast, its cutoff frequency plays a significant role in the spectral correction encompassing the smoothing effects connected with the LiDAR gate length.more » « less
-
In this paper, a constrained cooperative Kalman filter is developed to estimate field values and gradients along trajectories of mobile robots collecting measurements. We assume the underlying field is generated by a polynomial partial differential equation with unknown time-varying parameters. A long short-term memory (LSTM) based Kalman filter, is applied for the parameter estimation leveraging the updated state estimates from the constrained cooperative Kalman filter. Convergence for the constrained cooperative Kalman filter has been justified. Simulation results in a 2-dimensional field are provided to validate the proposed method.more » « less
-
To perform power system monitoring and control using synchrophasor measurements, various dynamic state estimators have been proposed in the literature, including the extended Kalman filter (EKF) and the unscented Kalman filter (UKF). However, they are unable to handle system model parameter errors and any type of outliers, precluding them from being adopted for power system real-time applications. In this paper, we develop a robust iterated extended Kalman filter based on the generalized maximum likelihood approach (termed GM-IEKF) for dynamic state estimation. The proposed GM-IEKF can effectively suppress observation and innovation outliers, which may be induced by model parameter gross errors and cyber attacks. We assess its robustness by carrying out extensive simulations on the IEEE 39-bus test system. From the results, we find that the GM-IEKF is able to cope with at least 25% outliers, including in position of leverage.more » « less
- Free Publicly Accessible Full Text
-
Accepted Manuscript1.0
- Conference Paper:
- https://doi.org/10.2514/6.2022-1711
