A Fast State Estimation Method With Equality Constraints

• 带有等式约束的状态估计快速算法