Includes higher gain and better quaternion reference