Re-added velocity fault. Still works.
Tried changing GPS offset away from origin.. Works better
Call to axis square in the movie plotting, just for fun