Fixed zeroPitchRoll issues, added maintainHeading action.