Finished first working version of GPS sync