Add SpaceCenter.GetPitchHeading
Add test for pitch and heading
Fix reference frame velocities
Clamp angles returned by QuaternionD.PitchHeadingRoll