增量型PID的C语言实现

[复制链接]

451|0

手机看帖

扫描二维码
随时随地手机跟帖

电梯直达

楼主

plsbackup| 技术达人

楼主 | 2022-11-24 12:00 | 只看该作者回帖奖励

|倒序浏览 |阅读模式

pi, pid, C语言, 控制, 控制算法

增量型PID的C语言实现，这里直接给出代码了。

复制

#include<stdio.h>

#include<stdlib.h>



struct _pid{

    float SetSpeed;            //定义设定值

    float ActualSpeed;        //定义实际值

    float err;                //定义偏差值

    float err_next;            //定义上一个偏差值

    float err_last;            //定义最上前的偏差值

    float Kp,Ki,Kd;            //定义比例、积分、微分系数

}pid;



void PID_init(){

    pid.SetSpeed=0.0;

    pid.ActualSpeed=0.0;

    pid.err=0.0;

    pid.err_last=0.0;

    pid.err_next=0.0;

    pid.Kp=0.2;

    pid.Ki=0.015;

    pid.Kd=0.2;

}



float PID_realize(float speed){

    pid.SetSpeed=speed;

    pid.err=pid.SetSpeed-pid.ActualSpeed;

    float incrementSpeed=pid.Kp*(pid.err-pid.err_next)+pid.Ki*pid.err+pid.Kd*(pid.err-2*pid.err_next+pid.err_last);

    pid.ActualSpeed+=incrementSpeed;

    pid.err_last=pid.err_next;

    pid.err_next=pid.err;

    return pid.ActualSpeed;

}



int main(){

    PID_init();

    int count=0;

    while(count<1000)

    {

        float speed=PID_realize(200.0);

        printf("%f\n",speed);

        count++;

    }

    return 0;

}