Integrating STM32 further (untested / tested with bugs)