PID--位置型--001

首页 > 代码库 > PID--位置型--001

2024-08-21 16:13:48 221人阅读

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

typedef struct
{
    float SetSpeed;    //定义设定值
    float ActualSpeed; //定义实际值
    float err;         //定义偏差值
    float err_last;    //定义上一个偏差值
    float Kp,Ki,Kd;    //定义比例、 积分、 微分系数
    float voltage;     //定义电压值（控制执行器的变量）
    float integral;    //定义积分值
} PID ;

void PID_Init();
float PID_realize(float speed);

PID pid ;
FILE* out ;

int main()
{
    out = fopen("C:\\Users\\Administrator\\Desktop\\log.txt","w");
    if(out)
    {
        printf("File open err...\n");
    }

    printf("System begin \n");
    PID_Init();

    unsigned long  count=0;
    while(count<2000)
    {
        float speed=PID_realize(200.0);

        printf("%f\n",speed);
        fprintf(out,"%f\n",speed);
        fflush(out);

        count++;
    }

    fclose(out);

    return 0;
}



void PID_Init()
{
    printf("PID_init begin \n");
    pid.SetSpeed=0.0;
    pid.ActualSpeed=0.0;
    pid.err=0.0;
    pid.err_last=0.0;
    pid.voltage=0.0;
    pid.integral=0.0;
    pid.Kp=0.2;
    pid.Ki=0.015;
    pid.Kd=0.2;
    printf("PID_init end \n");
}

/******************************************************************

这里用了最基本的算法实现形式， 没有考虑死区问题， 没有设定上下限，
只是对公式的一种直接的实现， 后面的介绍当中还会逐渐的对此改进。

*******************************************************************/

float PID_realize(float speed)
{
    pid.SetSpeed=speed;
    pid.err=pid.SetSpeed-pid.ActualSpeed;
    pid.integral+=pid.err;
    pid.voltage=pid.Kp*pid.err+pid.Ki*pid.integral+pid.Kd*(pid.err-pid.err_last);
    pid.err_last=pid.err;
    pid.ActualSpeed=pid.voltage*1.0;
    return pid.ActualSpeed;
}

PID--位置型--001

声明：以上内容来自用户投稿及互联网公开渠道收集整理发布，本网站不拥有所有权，未作人工编辑处理，也不承担相关法律责任，若内容有误或涉及侵权可进行投诉：投诉/举报工作人员会在5个工作日内联系你，一经查实，本站将立刻删除涉嫌侵权内容。

联系
我们

首页 > 代码库 > PID--位置型--001

PID--位置型--001

看完仍有疑问？有类似问题直接问程序猿