Fix bug on gps_time, has to be tested yet.