how to control servo motor with STM32