AP_InertialSensor: fixed SITL with new HIL code