Modeling and State Estimation for Dynamic Systems With Linear Equality Constraints

摘要

The problem of modeling and estimation for linear equality constrained (LEC) systems is considered. The exact constrained dynamic model usually is not readily available or is too complicated, and hence in many studies an auxiliary dynamic model is employed in which the state does not necessarily obey the constraint strictly. Based on the understanding that the constraints, as prior information about the state, should be incorporated into the dynamics modeling, an LEC dynamic model (LECDM) is constructed first. The model optimally fuses the linear equality constraint (LEC) and the auxiliary dynamics. Some of its superior properties are presented. Next, the linear minimum mean squared error (LMMSE) estimate of the LEC state is proved to satisfy the constraint. The LMMSE estimator for linear systems, called the LEC Kalman filter (LECKF), and two approximate LMMSE estimators for nonlinear systems are presented. The LECKF is compared with other constrained estimators, and a sufficient condition is also provided under which the estimate projection method mathematically equals the LECKF. Furthermore, extensions of the LECDM for the LEC systems with uncertain or unknown constraint parameters are discussed. Finally, illustrative examples are provided to show the effectiveness and efficiency of the LECKF and to verify the theoretical results given in the paper.