Restructure state passing
Use attitude delta for reference angular velocity