PID adjustment based on STM32