位置式PID控制算法模型（数字）

最新推荐文章于 2024-07-12 16:47:29 发布

_NJZY_

最新推荐文章于 2024-07-12 16:47:29 发布

阅读量5.4k

点赞数

分类专栏： 51单片机 Arduino AVR单片机

本文链接：https://blog.csdn.net/qq_21411985/article/details/44131757

版权

51单片机同时被 3 个专栏收录

68 篇文章 2 订阅

订阅专栏

Arduino

20 篇文章 0 订阅

订阅专栏

AVR单片机

20 篇文章 0 订阅

订阅专栏

float T, Kp, Ti, Td;    //const
float A, B, C;

void calcConst()
{
    A = Kp * (1 + T / Ti + Td / T);
    B = -Kp * (1 + 2 * Td / T);
    C = Kp * Td / T;
}

float PID(float rt, float yt)
{
    static float e1 = 0.0f, e0 = 0.0f, uk_pre;
    float e2, deltaUk;

    e2 = rt - yt;
    deltaUk = A * e2 + B * e1 + C * e0;
    e0 = e1;
    e1 = e2;
    uk_pre += deltaUk;

    return uk_pre;
}