New State Estimation Algorithm with Equality Constraints

• 一种带有等式约束的状态估计新算法