Update drv_gps.c