Fix tests
Remove incorrect test cases
Fix rotations for CelestialBody, CelestialBodySurface and Vessel reference frames
Use double precision vessel positions
Update test case
Output origin angle in error message