ChibiOS/RT HAL code