这个PID怎么调节?

2019-07-14 19:28发布

#include<stdio.h>
#include<stdlib.h>

float incrementSpeed;
float speed;
int set_shu,fb_shu;//设置数,反馈数
int pwm;

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=1;
    pid.Kd=0.2;
}

float PID_realize(float speed){
    pid.SetSpeed=speed;
    pid.err=pid.SetSpeed-pid.ActualSpeed;
    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;
}

void DAC(int pwm)
{
;//更新占空比函数,占空比为1-1023/1024
}

int main()
{
    PID_init();//PID初始化
                set_shu=10;//上电设置数为10,调试中输入设置值0-1024。
                fb_shu=0;//上电默认反馈为0,调试中输入反馈值0-1024。
    while(1)
    {
      pid.SetSpeed=set_shu;//读取设置值
                        pid.ActualSpeed=fb_shu;//读取反馈值  
                        speed=PID_realize(set_shu);//PID计算
                        DAC(speed);//更新占空比输出
    }
}
/*现况:做了个恒流电源,设置电流10A,上电未接负载,所以反馈值为0,DAC(speed)值为0或很小,DAC基本无输出,过很久时间后,电流可以慢慢达到设定值,达到设定值后就很稳定了,
想要的结果是:设置值>反馈值很多,DAC输出1024最大,一但检测到反馈信号,DAC迅速减到很小值再慢慢累加到反馈值和设置值一致,
请问大侠怎么实现?
*/


0条回答

一周热门 更多>