1. add a define for USART1 , #define COM_PORT USART1
2. Servo stuffs.

Signed-off-by: stevenyen898 <stevenyen898@gmail.com>