modified tracing routines in qgcsend and imu