增量式PID控制算法的C++代码实现

最新推荐文章于 2024-05-06 14:18:59 发布

竹天九日

最新推荐文章于 2024-05-06 14:18:59 发布

阅读量1.4k

点赞数 2

分类专栏：算法的代码实现文章标签： C++ 增量式PID控制算法油缸试验 cmake

本文链接：https://blog.csdn.net/smile001isme/article/details/83956908

版权

算法的代码实现专栏收录该内容

15 篇文章 1 订阅

订阅专栏

void prpvtest::PID_Init(){
    cout << "PID_Init begin!" << endl;
    pid.SetSpeed = 0;
    pid.ActualSpeed = 0;
    pid.Err = 0;
    pid.Err_last = 0;
    pid.Err_Next = 0;
    pid.Kp = _Kpid[0];
    pid.Ki = _Kpid[1];
    pid.Kd = _Kpid[2];
    cout << pid.Kp << pid.Ki << pid.Kd << endl;
    cout << "PID_Init end!" << endl;
}

double prpvtest::PID_Calc(float speed,float realv){
    double u;
    double incrementSpeed;
    pid.SetSpeed = speed;
    pid.ActualSpeed = realv;
    pid.Err = pid.SetSpeed - pid.ActualSpeed;  
    u = pid.Kp*pid.Err;
    incrementSpeed = pid.Kp*(pid.Err - pid.Err_Next) + pid.Ki*pid.Err
        +pid.Kd * (pid.Err - 2 * pid.Err_Next + pid.Err_last);
    pid.Err_last = pid.Err_Next;
    pid.Err_Next = pid.Err;
    
    return incrementSpeed;
}

以上用C++代码实现了增量式PID控制（控制对象是动态油缸）