added code for two servo motor on TIM3