Minor change to drv_telemetry.c and drv_gps.c