AP_InertialSensor_MPU6000: uses new semaphores

* some refactoring to fix differences between timerprocess
  and non-timerprocess usage