We modified the suspension model to have a new control topology that resembles a classical PID control without proportional control. We installed the displacement sensing mechanism for the suspended optic and have diagonalized the signal to a satisfying level.