sync code from gimbal.

fix servo.

add summary of debug by comtool.

fix timer init function.

fix uart2 interupt.

using a ok example