Cleanups of INDI attitude control