Method for real-time nonlinear system state estimation and control
First Claim
1. A method for estimation of state variables of a physical nonlinear system with physical exogenous inputs that can be modeled by a set of continuous-time nonlinear differential equations, including input signals representing the physical exogenous inputs to the system, and measurement signals representing accessible measurements that are indicative of the state variables to be estimated, the method comprising:
- a) creating a nonlinear differential equation model of a nonlinear system using initial estimated state variables;
b) obtaining the nonlinear system measurement signals in response to the nonlinear system input signals;
c) creating an updated nonlinear differential equation model using the nonlinear differential equation model, the nonlinear system input and measurement signals, and a state variable estimation method for refining the initial estimated state variables, the state variable estimation method for producing updated estimated state variables using integration methods for state variable estimation of the nonlinear system with exogenous inputs;
d) using a discrete-time covariance matrix update; and
e) using a common linear perturbation signal model for estimating the updated state variables and a corresponding updated covariance matrix, wherein the linear perturbation model is a discrete-time time-varying linear system model.
1 Assignment
0 Petitions
Accused Products
Abstract
A method for the estimation of the state variables of nonlinear systems with exogenous inputs is based on improved extended Kalman filtering (EKF) type techniques. The method uses a discrete-time model, based on a set of nonlinear differential equations describing the system, that is linearized about the current operating point. The time update for the state estimates is performed using integration methods. Integration, which is accomplished through the use of matrix exponential techniques, avoids the inaccuracies of approximate numerical integration techniques. The updated state estimates and corresponding covariance estimates use a common time-varying system model for ensuring stability of both estimates. Other improvements include the use of QR factorization for both time and measurement updating of square-root covariance and Kalman gain matrices and the use of simulated annealing for ensuring that globally optimal estimates are produced.
-
Citations
25 Claims
-
1. A method for estimation of state variables of a physical nonlinear system with physical exogenous inputs that can be modeled by a set of continuous-time nonlinear differential equations, including input signals representing the physical exogenous inputs to the system, and measurement signals representing accessible measurements that are indicative of the state variables to be estimated, the method comprising:
-
a) creating a nonlinear differential equation model of a nonlinear system using initial estimated state variables;
b) obtaining the nonlinear system measurement signals in response to the nonlinear system input signals;
c) creating an updated nonlinear differential equation model using the nonlinear differential equation model, the nonlinear system input and measurement signals, and a state variable estimation method for refining the initial estimated state variables, the state variable estimation method for producing updated estimated state variables using integration methods for state variable estimation of the nonlinear system with exogenous inputs;
d) using a discrete-time covariance matrix update; and
e) using a common linear perturbation signal model for estimating the updated state variables and a corresponding updated covariance matrix, wherein the linear perturbation model is a discrete-time time-varying linear system model. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14)
where fk=f({circumflex over (x)}k|k, uk) evaluated at time t=(kT), and Ak is a discrete state feedback matrix, evaluated at time t=kT, from a linearized approximation to f(x,u).
-
-
7. The method of claim 6 wherein integrating is performed by evaluating a matrix exponential as follows:
-
so that a time propagated state vector is obtained as follows,
-
-
8. The method of claim 7 further comprising a step for simulated annealing by running multiple estimators and choosing a best estimate based on an error metric.
-
9. The method of claim 8 wherein each estimator is initialized by a different random initial state vector.
-
10. The method of claim 8 wherein the error metric is a scalar value, ck, computed as ck=trace(Sk|kSk|kT).
-
11. The method of claim 8 wherein an increased process noise covariance is used in the state variable estimation method, the increased process noise covariance generated in accordance with a prescribed schedule that begins by amplifying the initial process noise covariance.
-
12. The method of claim 11 wherein the prescribed schedule comprises:
-
a) computing a temperature schedule, ξ
k, that decreases as a function of time index k;
b) computing a gain multiplier as (1+ξ
k); and
c) multiplying the initial process noise covariance, Q0, by the gain multiplier for producing a process noise covariance at time index k as Qk=Q0(1+ξ
k).
-
-
13. The method of claim 12 wherein ξ
-
k is computed as ξ
k={square root over (2+L c /ln(2+L +kT))}, where c is a prescribed constant, and ln(.) is a natural logarithm function.
-
k is computed as ξ
-
14. The method of claim 1 further comprising:
-
estimating an updated covariance of the updated estimated state variables using a common state transition matrix for estimating the updated estimated state variables and the updated covariance for improved estimation quality; and
computing a controller which uses the set of current-step system state variable estimates produce a set of system input control signals for controlling the physical inputs to the system, the controller is obtained by use of a performance index that specifies an objective performance criterion for the system.
-
-
15. A state vector estimation method for a real-time nonlinear system with exogenous inputs, the system represented by a set of continuous-time nonlinear differential state equations that include a state vector representing the system state vector that are to be estimated, and a nonlinear system matrix that defines the functional relationship between the input vector, the state vector, and the time-derivative of the state vector, the state vector being estimated from a set of accessible measurements that are representative of the state variables, the set of measurements, labeled as a measurement vector, taken at prescribed times and represented by a measurement vector, both the state vector and the measurement vector respectively contaminated by a state noise vector and a measurement noise vector, the method comprising the following steps:
-
(a) constructing a set of state equations representing the nonlinear system with exogenous inputs;
(b) establishing a set of state variable values for a current-time state vector, and a set of matrix element values for one each covariance matrix for a current-time state vector, for a current-time state noise vector, for a current-time input noise vector, and for a current-time output measurement noise vector;
(c) acquiring a current-time measurement vector;
(d) updating the state covariance matrices using the current-time measurement noise covariance vector;
(e) estimating an updated current-time state vector from the current time measurement vector by use of a state vector estimating filter that operates on the current-time state vector using the current-time measurement vector, the covariance matrices for the current time state vector, for the current time state, and for the current-time measurement noise vector, the estimated updated state vector representing the state vector at the measurement current-time;
(f) projecting the estimated updated state vector by integrating the system state equations over the prescribed time interval between the prescribed measurement current-time and the next prescribed measurement current-time for obtaining a current state vector using a discrete-time covariance matrix update;
(g) projecting the updated state vector covariance matrix using the results of the system equation integration of step (f) using a linear perturbation signal model for estimating the updated state variables and a corresponding updated covariance matrix, wherein the linear perturbation model is a discrete-time time-varying linear system model; and
(h) at the next measurement time, iterating steps (c)-(g). - View Dependent Claims (16, 17, 18, 19, 20, 21, 22)
-
-
23. A method for estimation of state variables of a physical nonlinear system, the method being applicable to systems that can be modeled by a set of continuous-time nonlinear differential equations and to systems that can be modeled by discrete-time nonlinear difference equations, the method using measurement signals representing accessible measurements that are indicative of the state variables to be estimated, the method comprising:
-
a) creating an extended Kalman filter (EKF) for estimating system state variables from the measurement signals in a dynamic system; and
b) applying simulated annealing by running multiple EKFs and choosing the best estimate based on an error metric, wherein simulated annealing is initiated by a random perturbation. - View Dependent Claims (24, 25)
-
Specification