Four-axis STM32 program