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

• New State Estimation Algorithm with Equality Constraints