Finished GPS lat,lon,alt code. Still need velocity and error setting.