STM32 optimisation