Add disturbance observer for rigid rotor