freescale 电机pid算法

/*======================================================================= 电机控制程序 ========================================================================*/ void Motor_con(void) { if (Abs(Error)>E0) Pulse = Pulse_His + MOTOR_TURN_P*(Error - Error_His) + MOTOR