Ardupilot HAL implementation!