PID代码开源

Quixote

RT




补充内容 (2014-7-7 21:58):
检查了下代码。。memset(S->in_e, 0, 3u * sizeof(unsigned short int));改成这样更好些。。

补充内容 (2014-7-7 21:59):
void *
memset (void *s, int c, unsigned n)
{
    /* Not optimized, but very portable */
    unsigned char *sp = (unsigned char *)s;

    if ((s != NULL) && (n > 0))
    {
        while (n--)
        {

补充内容 (2014-7-7 21:59):
*sp++ = (unsigned char)c;
        }
    }
    return s;
}

补充内容 (2014-7-7 22:04):
我上传错版本了……正确文件在七楼

补充内容 (2014-7-7 22:24):
    speed = lptmr_get();
    lptmr_clean();
    __push_pid_para_(&PID_change,need_speed - speed);
    PWM = __s16_GetPluse_(&PID_change);
    if( PWM > 0 )
    {
        PWMisZheng = 1;
        vMoto

补充内容 (2014-7-7 22:25):
rBackChange(0);
        vMotorForChange(__ABS(PWM));
    }
    else
    {
        PWMisZheng = 2;
        vMotorForChange(0);
        vMotorBackChange(__ABS(PWM));
    }

万川集海

学习学习

L无奈

顺暗的？学习学习

sTilL_7.度

void PID_Motor(int Set,int Current){
  float Kp = (float)(KpMotor)/100;
  float Ki = (float)(KiMotor)/100;
  float Kd = (float)(KdMotor)/100;
  
  Error = Set - Current;
  if(abs(Error) > 10){         
    if(abs(Error) > 60) {
      P_Ratio = 2;
      I_Ratio = 0;
    }
    else if(abs(Error) > 30){
      P_Ratio = 1;
      I_Ratio = 1;
    }
    else if(abs(Error) < 30){
      P_Ratio = 0.5;
      I_Ratio = 1.5;
    }
   
    if(Error < 0) I_Ratio *= 2;
    Proportional = Kp * Error * P_Ratio;
    Integral    += Ki * Error * I_Ratio;
    Derivative   = Kd * (Error - Error_Last);
  
    if(Integral > MotorDutyLimit) Integral = MotorDutyLimit;
    else if(Integral <  -MotorDutyLimit) Integral = -MotorDutyLimit;
  
    Motor1Duty = Proportional + Integral + Derivative;
  
    if(Motor1Duty > MotorDutyLimit) Motor1Duty = MotorDutyLimit;
    else if(Motor1Duty < -MotorDutyLimit) Motor1Duty = -MotorDutyLimit;
  
    Error_Last = Error;
  }
}

Quixote

7426笨蛋 发表于 2014-7-10 20:24
感谢楼主~

不客气

7426笨蛋

感谢楼主~

idao

Quixote

迷路在未来 发表于 2014-7-10 09:59
先I后P么

我一般先调P到振荡，类似于齐格勒尼克尔斯第二方法。

迷路在未来

Quixote 发表于 2014-7-10 09:52
PID整定的方法是一样的

先I后P么

Quixote

迷路在未来 发表于 2014-7-10 01:16
请问用这个方法调的话应该具体怎么调呢  谢谢

PID整定的方法是一样的