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
Observability and detectability analyses for dynamic state estimation of the marginally observable model of a synchronous machine
Observability and detectability analyses are often used to guide the measurement setup and select the estimation models used in dynamic state estimation (DSE). Yet, marginally observable states of a synchronous machine prevent the direct application of conventional observability and detectability analyses in determining the existence of a DSE observer. To address this issue, the authors propose to identify the marginally observable states and their associate eigenvalues by finding the smallest perturbation matrices that make the system unobservable. The proposed method extends the observability and detectability analyses to marginally observable estimation models, often encountered in the DSE of a synchronous machine. The effectiveness and application of the proposed method are illustrated on the IEEE 10-machine 39-bus system, verified using the unscented Kalman filter and the extended Kalman filter, and compared with conventional methods. The proposed analysis method can be applied to guide the selection of estimation models and measurements to determine the existence of a DSE observer in power-system planning.
more »
« less
- Award ID(s):
- 1845523
- NSF-PAR ID:
- 10316659
- Date Published:
- Journal Name:
- IET Generation, Transmission & Distribution
- ISSN:
- 1751-8687
- Format(s):
- Medium: X
- Sponsoring Org:
- National Science Foundation
More Like this
-
-
more » « less
Abstract Roll-to-Roll (R2R) printing techniques are promising for high-volume continuous production of substrate-based products, as opposed to sheet-to-sheet (S2S) approach suited for low-volume work. However, meeting the tight alignment tolerance requirements of additive multi-layer printed electronics specified by device resolution that is usually at micrometer scale has become a major challenge in R2R flexible electronics printing, preventing the fabrication technology from being transferred from conventional S2S to high-speed R2R production. Print registration in a R2R process is to align successive print patterns on the flexible substrate and to ensure quality printed devices through effective control of various process variables. Conventional model-based control methods require an accurate web-handling dynamic model and real-time tension measurements to ensure control laws can be faithfully derived. For complex multistage R2R systems, physics-based state-space models are difficult to derive, and real-time tension measurements are not always acquirable. In this paper, we present a novel data-driven model predictive control (DD-MPC) method to minimize the multistage register errors effectively. We show that the DD-MPC can handle multi-input and multi-output systems and obtain the plant model from sensor data via an Eigensystem Realization Algorithm (ERA) and Observer Kalman filter identification (OKID) system identification method. In addition, the proposed control scheme works for systems with partially measurable system states.
-
This article addresses the problem of dynamic online estimation and compensation of hard-iron and soft-iron biases of three-axis magnetometers under dynamic motion in field robotics, utilizing only biased measurements from a three-axis magnetometer and a three-axis angular rate sensor. The proposed magnetometer and angular velocity bias estimator (MAVBE) utilizes a 15-state process model encoding the nonlinear process dynamics for the magnetometer signal subject to angular velocity excursions, while simultaneously estimating nine magnetometer bias parameters and three angular rate sensor bias parameters, within an extended Kalman filter framework. Bias parameter local observability is numerically evaluated. The bias-compensated signals, together with three-axis accelerometer signals, are utilized to estimate bias-compensated magnetic geodetic heading. Performance of the proposed MAVBE method is evaluated in comparison to the widely cited magnetometer-only TWOSTEP method in numerical simulations, laboratory experiments, and full-scale field trials of an instrumented autonomous underwater vehicle in the Chesapeake Bay, Maryland, USA. For the proposed MAVBE, (i) instrument attitude is not required to estimate biases, and the results show that (ii) the biases are locally observable, (iii) the bias estimates converge rapidly to true bias parameters, (iv) only modest instrument excitation is required for bias estimate convergence, and (v) compensation for magnetometer hard-iron and soft-iron biases dramatically improves dynamic heading estimation accuracy.more » « less
-
The lithium iron phosphate (LFP) battery has more nonlinear characteristic than other battery type. For this reason, when we use electrical equivalent circuit model and the extended Kalman filter (EKF) for estimating the SOC, the estimation performance can be decreased in the nonlinear region. This paper proposes an advance estimation method of state of charge (SOC) for lithium iron phosphate (LFP) batteries. To improve the model accuracy, this paper utilizes the nonlinear observer for identifying the internal parameters of batteries. Furthermore, to reduce the nonlinear effect of the LFP batteries, this paper recast the Kalman process. Therefore, through the proposed method, the performance of SOC estimation can be more accurate and the computational burden is decreased when we apply the embedded system.more » « less
-
null (Ed.)Structural health monitoring of complex structures is often limited by restricted accessibility to locations of interest within the structure and availability of operational loads. In this work, a novel output-only virtual sensing scheme is proposed. This scheme involves the implementation of the modal expansion in an augmented Kalman filter. Performance of the proposed scheme is compared with two existing methods. Method 1 relies on a finite element model updating, batch data processing, and modal expansion (MUME) procedure. Method 2 employs a recursive sequential estimation algorithm, which feeds a substructure model of the instrumented system into an Augmented Kalman Filter (AKF). The new scheme referred to as Method 3 (ME-AKF), implements strain estimates generated via Modal Expansion into an AKF as virtual measurements. To demonstrate the applicability of the aforementioned methods, a rollercoaster connection was instrumented with accelerometers, strain rosettes, and an optical sensor. A comparison of estimated dynamic strain response at unmeasured locations using three alternative schemes is presented. Although acceleration measurements are used indirectly for model updating, the response-only methods presented in this research use only measurements from strain rosettes for strain history predictions and require no prior knowledge of input forces. Predicted strains using all methods are shown to sufficiently predict the measured strain time histories from a control location and lie within a 95% confidence interval calculated based on modal expansion equations. In addition, the proposed ME-AKF method shows improvement in strain predictions at unmeasured locations without the necessity of batch data processing. The proposed scheme shows high potential for real-time dynamic estimation of the strain and stress state of complex structures at unmeasured locations.more » « less
- Free Publicly Accessible Full Text
-
Accepted Manuscript1.0
- Journal Article:
- https://doi.org/10.1049/gtd2.12373
