Angular velocity implementation in motor.c
some code improvment in full_step_ctrl
USART done
USART Done
USART Done
fix some bugs on timer1