Added ahrs_update_gps to main.c