AP_InertialSensor: fixed _dump_registers() for MPU6000

need to take the semaphore to prevent bus errors