Simple GCode interpreter for STM32