Enable to watch the PID output
Change the order of printf
Clean some dead or useless code
Change the control input design and add mid value of each channel
Dislay MOTOR1~4 vaule(PWM9~12 CCR)