DataFlash: print FMT messages for wrapped logs

this ensures we have FMT messages in every log, even if the log was
wrapped and the FMT messages were overwritten
AP_InertialSensor: fixed semaphore error on startup for MPU6000