PID控制算法：8、Arduino PID 库讲解

已于 2023-08-31 09:02:32 修改
阅读量1.7k 收藏 17
点赞数
分类专栏： PID控制 文章标签： PID
于 2023-06-21 14:02:30 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-NC-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/m0_49968063/article/details/131326465
版权

Arduino PID 库讲解

First Pass – Initial Input and Proportional-Mode selection

/*working variables*/
unsigned long lastTime;
double Input, Output, Setpoint;
double ITerm, lastInput;
double kp, ki, kd;
int SampleTime = 1000; //1 sec
double outMin, outMax;
bool inAuto = false;

#define MANUAL 0
#define AUTOMATIC 1

#define DIRECT 0
#define REVERSE 1
int controllerDirection = DIRECT;

#define P_ON_M 0
#define P_ON_E 1
bool pOnE = true;
double initInput;

void Compute()
{
   if(!inAuto) return;
   unsigned long now = millis();
   int timeChange = (now - lastTime);
   if(timeChange>=SampleTime)
   {
      /*Compute all the working error variables*/
      double error = Setpoint - Input;
      ITerm+= (ki * error);
      if(ITerm > outMax) ITerm= outMax;
      else if(ITerm < outMin) ITerm= outMin;
      double dInput = (Input - lastInput);

      /*Compute P-Term*/
      if(pOnE) Output = kp * error;
      else Output = -kp * (Input-initInput);

      /*Compute Rest of PID Output*/
      Output += ITerm - kd * dInput;
      if(Output > outMax) Output = outMax;
      else if(Output < outMin) Output = outMin;

      /*Remember some variables for next time*/
      lastInput = Input;
      lastTime = now;
   }
}

void SetTunings(double Kp, double Ki, double Kd, int pOn)
{
   if (Kp<0 || Ki<0|| Kd<0) return;

   pOnE = pOn == P_ON_E;

   double SampleTimeInSec = ((double)SampleTime)/1000;
   kp = Kp;
   ki = Ki * SampleTimeInSec;
   kd = Kd / SampleTimeInSec;

  if(controllerDirection ==REVERSE)
   {
      kp = (0 - kp);
      ki = (0 - ki);
      kd = (0 - kd);
   }
}

void SetSampleTime(int NewSampleTime)
{
   if (NewSampleTime > 0)
   {
      double ratio  = (double)NewSampleTime
                      / (double)SampleTime;
      ki *= ratio;
      kd /= ratio;
      SampleTime = (unsigned long)NewSampleTime;
   }
}

void SetOutputLimits(double Min, double Max)
{
   if(Min > Max) return;
   outMin = Min;
   outMax = Max;

   if(Output > outMax) Output = outMax;
   else if(Output < outMin) Output = outMin;

   if(ITerm > outMax) ITerm= outMax;
   else if(ITerm < outMin) ITerm= outMin;
}

void SetMode(int Mode)
{
    bool newAuto = (Mode == AUTOMATIC);
    if(newAuto == !inAuto)
    {  /*we just went from manual to auto*/
        Initialize();
    }
    inAuto = newAuto;
}

void Initialize()
{
   lastInput = Input;
   initInput = Input;
   ITerm = Output;
   if(ITerm > outMax) ITerm= outMax;
   else if(ITerm < outMin) ITerm= outMin;
}

void SetControllerDirection(int Direction)
{
   controllerDirection = Direction;
}

随着输入的变化，“测量比例”会提供越来越大的阻碍，但是如果没有参考系，我们的性能会有些不稳定。 如果第一次打开控制器时PID输入为10000，我们真的要开始以Kp * 10000进行抵抗吗？ 否。我们希望将初始输入用作参考点（第108行），随着输入从此处更改（第38行），增加或减少阻力。
我们需要做的另一件事是允许用户选择是否要按比例进行误差或测量。 在上一篇文章之后，PonE似乎毫无用处，但重要的是要记住，对于许多循环来说，它运作良好。 因此，我们需要让用户选择他们想要的模式（第51和55行），然后在计算中采取相应的行动（第37和38行）。

Second Pass – On-the-fly tuning changes动态调整

尽管上面的代码确实可以工作，但是它有一个我们之前已经看到的问题。 在运行时更改调整参数时，会出现不希望出现的现象

为什么会这样呢?

我们上次看到此结果的原因是，积分是通过新的Ki重新缩放的。 这次是（Input – initInput）由Kp重新缩放。 我选择的解决方案类似于我对Ki所做的解决方案：我没有将Input – initInput视为一个整体单元乘以当前Kp的方法，而是将其分解为各个步骤，然后分别乘以Kp：

/*working variables*/
unsigned long lastTime;
double Input, Output, Setpoint;
double ITerm, lastInput;
double kp, ki, kd;
int SampleTime = 1000; //1 sec
double outMin, outMax;
bool inAuto = false;

#define MANUAL 0
#define AUTOMATIC 1

#define DIRECT 0
#define REVERSE 1
int controllerDirection = DIRECT;

#define P_ON_M 0
#define P_ON_E 1
bool pOnE = true;
double PTerm;

void Compute()
{
   if(!inAuto) return;
   unsigned long now = millis();
   int timeChange = (now - lastTime);
   if(timeChange>=SampleTime)
   {

      /*Compute all the working error variables*/
      double error = Setpoint - Input;
      ITerm+= (ki * error);
      if(ITerm > outMax) ITerm= outMax;
      else if(ITerm < outMin) ITerm= outMin;
      double dInput = (Input - lastInput);

      /*Compute P-Term*/
      if(pOnE) Output = kp * error;
      else
      {
         PTerm -= kp * dInput;
         Output = PTerm;
      }

      /*Compute Rest of PID Output*/
      Output += ITerm - kd * dInput;

      if(Output > outMax) Output = outMax;
      else if(Output < outMin) Output = outMin;

      /*Remember some variables for next time*/
      lastInput = Input;
      lastTime = now;
   }
}

void SetTunings(double Kp, double Ki, double Kd, int pOn)
{
   if (Kp<0 || Ki<0|| Kd<0) return;

   pOnE = pOn == P_ON_E;

   double SampleTimeInSec = ((double)SampleTime)/1000;
   kp = Kp;
   ki = Ki * SampleTimeInSec;
   kd = Kd / SampleTimeInSec;

  if(controllerDirection ==REVERSE)
   {
      kp = (0 - kp);
      ki = (0 - ki);
      kd = (0 - kd);
   }
}

void SetSampleTime(int NewSampleTime)
{
   if (NewSampleTime > 0)
   {
      double ratio  = (double)NewSampleTime
                      / (double)SampleTime;
      ki *= ratio;
      kd /= ratio;
      SampleTime = (unsigned long)NewSampleTime;
   }
}

void SetOutputLimits(double Min, double Max)
{
   if(Min > Max) return;
   outMin = Min;
   outMax = Max;

   if(Output > outMax) Output = outMax;
   else if(Output < outMin) Output = outMin;

   if(ITerm > outMax) ITerm= outMax;
   else if(ITerm < outMin) ITerm= outMin;
}

void SetMode(int Mode)
{
    bool newAuto = (Mode == AUTOMATIC);
    if(newAuto == !inAuto)
    {  /*we just went from manual to auto*/
        Initialize();
    }
    inAuto = newAuto;
}

void Initialize()
{
   lastInput = Input;
   PTerm = 0;
   ITerm = Output;
   if(ITerm > outMax) ITerm= outMax;
   else if(ITerm < outMin) ITerm= outMin;
}

void SetControllerDirection(int Direction)
{
   controllerDirection = Direction;
}

注:20,39-43,114为改动行

现在，我们保留一个有效的总和PTerm，而不是将Input-initInput的全部乘以Kp。 在每一步中，我们仅将当前输入更改乘以Kp并从PTerm中减去（第41行。）在这里，我们可以看到更改的影响：

由于旧的Kps位于“银行”中，因此调整参数的变化只会影响我们向前迈进

Final Pass – Sum problems.

关于上述代码的错误，我不会详细介绍（流行趋势等）。很好，但是仍然存在重大问题。例如：

  1. 结束时间：虽然最终输出限制在outMin和outMax之间，但PTerm可能会在不希望的时候增加。它不会像完整的缠绕那样糟糕，但是仍然不能被接受
  2. 即时更改：如果用户在运行时从P_ON_M更改为P_ON_E，则一段时间后返回，则不会对PTerm进行属性初始化，这会导致输出颠簸

还有更多，但仅这些就足以了解真正的问题是什么。在创建ITerm之前，我们已经处理了所有这些问题。我决定不为PTerm重新执行相同的解决方案，而是决定使用一种更美观的解决方案。
通过将PTerm和ITerm合并到一个称为“ outputSum”的变量中，P_ON_M代码将从已存在的所有ITerm修复中受益，并且由于代码中没有两个和，因此没有不必要的冗余。

/*working variables*/
unsigned long lastTime;
double Input, Output, Setpoint;
double outputSum, lastInput;
double kp, ki, kd;
int SampleTime = 1000; //1 sec
double outMin, outMax;
bool inAuto = false;

#define MANUAL 0
#define AUTOMATIC 1

#define DIRECT 0
#define REVERSE 1
int controllerDirection = DIRECT;

#define P_ON_M 0
#define P_ON_E 1
bool pOnE = true;


void Compute()
{
   if(!inAuto) return;
   unsigned long now = millis();
   int timeChange = (now - lastTime);
   if(timeChange>=SampleTime)
   {

      /*Compute all the working error variables*/
      double error = Setpoint - Input;
      double dInput = (Input - lastInput);
      outputSum+= (ki * error);

      /*Add Proportional on Measurement, if P_ON_M is specified*/
      if(!pOnE) outputSum-= kp * dInput

      if(outputSum > outMax) outputSum= outMax;
      else if(outputSum < outMin) outputSum= outMin;

      /*Add Proportional on Error, if P_ON_E is specified*/
      if(pOnE) Output = kp * error;
      else Output = 0;

      /*Compute Rest of PID Output*/
      Output += outputSum - kd * dInput;

      if(Output > outMax) Output = outMax;
      else if(Output < outMin) Output = outMin;

      /*Remember some variables for next time*/
      lastInput = Input;
      lastTime = now;
   }
}

void SetTunings(double Kp, double Ki, double Kd, int pOn)
{
   if (Kp<0 || Ki<0|| Kd<0) return;

   pOnE = pOn == P_ON_E;

   double SampleTimeInSec = ((double)SampleTime)/1000;
   kp = Kp;
   ki = Ki * SampleTimeInSec;
   kd = Kd / SampleTimeInSec;

  if(controllerDirection ==REVERSE)
   {
      kp = (0 - kp);
      ki = (0 - ki);
      kd = (0 - kd);
   }
}

void SetSampleTime(int NewSampleTime)
{
   if (NewSampleTime > 0)
   {
      double ratio  = (double)NewSampleTime
                      / (double)SampleTime;
      ki *= ratio;
      kd /= ratio;
      SampleTime = (unsigned long)NewSampleTime;
   }
}

void SetOutputLimits(double Min, double Max)
{
   if(Min > Max) return;
   outMin = Min;
   outMax = Max;

   if(Output > outMax) Output = outMax;
   else if(Output < outMin) Output = outMin;

   if(outputSum > outMax) outputSum= outMax;
   else if(outputSum < outMin) outputSum= outMin;
}

void SetMode(int Mode)
{
    bool newAuto = (Mode == AUTOMATIC);
    if(newAuto == !inAuto)
    {  /*we just went from manual to auto*/
        Initialize();
    }
    inAuto = newAuto;
}

void Initialize()
{
   lastInput = Input;

   outputSum = Output;
   if(outputSum > outMax) outputSum= outMax;
   else if(outputSum < outMin) outputSum= outMin;
}

void SetControllerDirection(int Direction)
{
   controllerDirection = Direction;
}

那里有。 以上功能是Arduino PID v1.2.0中提供的功能。

But wait, there’s more: Setpoint Weighting.

我没有在Arduino库代码中添加以下内容，但这是一项功能，如果您想自己动手，可能会感兴趣。 设定点加权是其核心，是同时拥有PonE和PonM的一种方法。 通过指定0到1之间的比率，您可以分别具有100％PonM，100％PonE或两者之间的某个比率。 如果您的流程集成度不理想（例如回流炉），并且对此有所考虑，这可能会有所帮助。
最终，我决定此时不将其添加到库中，因为它最终成为要调整/解释的另一个参数，而且我认为由此带来的好处是不值得的。 无论如何，这是代码，如果您想修改代码以具有设定值权重，而不仅仅是选择PonM / PonE：

/*working variables*/
unsigned long lastTime;
double Input, Output, Setpoint;
double outputSum, lastInput;
double kp, ki, kd;
int SampleTime = 1000; //1 sec
double outMin, outMax;
bool inAuto = false;

#define MANUAL 0
#define AUTOMATIC 1

#define DIRECT 0
#define REVERSE 1
int controllerDirection = DIRECT;

#define P_ON_M 0
#define P_ON_E 1
bool pOnE = true, pOnM = false;
double pOnEKp, pOnMKp;


void Compute()
{
   if(!inAuto) return;
   unsigned long now = millis();
   int timeChange = (now - lastTime);
   if(timeChange>=SampleTime)
   {

      /*Compute all the working error variables*/
      double error = Setpoint - Input;
      double dInput = (Input - lastInput);
      outputSum+= (ki * error);

      /*Add Proportional on Measurement, if P_ON_M is specified*/
      if(pOnM) outputSum-= pOnMKp * dInput

      if(outputSum > outMax) outputSum= outMax;
      else if(outputSum < outMin) outputSum= outMin;

      /*Add Proportional on Error, if P_ON_E is specified*/
      if(pOnE) Output = pOnEKp * error;
      else Output = 0;

      /*Compute Rest of PID Output*/
      Output += outputSum - kd * dInput;

      if(Output > outMax) Output = outMax;
      else if(Output < outMin) Output = outMin;

      /*Remember some variables for next time*/
      lastInput = Input;
      lastTime = now;
   }
}

void SetTunings(double Kp, double Ki, double Kd, double pOn)
{
   if (Kp<0 || Ki<0|| Kd<0 || pOn<0 || pOn>1) return;

   pOnE = pOn>0; //some p on error is desired;
   pOnM = pOn<1; //some p on measurement is desired;

   double SampleTimeInSec = ((double)SampleTime)/1000;
   kp = Kp;
   ki = Ki * SampleTimeInSec;
   kd = Kd / SampleTimeInSec;

  if(controllerDirection ==REVERSE)
   {
      kp = (0 - kp);
      ki = (0 - ki);
      kd = (0 - kd);
   }

   pOnEKp = pOn * kp;
   pOnMKp = (1 - pOn) * kp;
}

void SetSampleTime(int NewSampleTime)
{
   if (NewSampleTime > 0)
   {
      double ratio  = (double)NewSampleTime
                      / (double)SampleTime;
      ki *= ratio;
      kd /= ratio;
      SampleTime = (unsigned long)NewSampleTime;
   }
}

void SetOutputLimits(double Min, double Max)
{
   if(Min > Max) return;
   outMin = Min;
   outMax = Max;

   if(Output > outMax) Output = outMax;
   else if(Output < outMin) Output = outMin;

   if(outputSum > outMax) outputSum= outMax;
   else if(outputSum < outMin) outputSum= outMin;
}

void SetMode(int Mode)
{
    bool newAuto = (Mode == AUTOMATIC);
    if(newAuto == !inAuto)
    {  /*we just went from manual to auto*/
        Initialize();
    }
    inAuto = newAuto;
}

void Initialize()
{
   lastInput = Input;
   outputSum = Output;
   if(outputSum > outMax) outputSum= outMax;
   else if(outputSum < outMin) outputSum= outMin;
}

void SetControllerDirection(int Direction)
{
   controllerDirection = Direction;
}

现在，pOn不再是将pOn设置为整数，而是以允许允许比率的双精度形式出现（第58行）。除了一些标志（第62和63行）以外，还在第77-78行计算了加权Kp项。 然后，在第37和43行上，将加权的PonM和PonE贡献添加到总体PID输出中。

资深流水灯工程师
关注
  • 0
    点赞
  • 踩
  • 17
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
专栏目录
使用 Simulink 和 Arduino 进行 PID 控制：在 Arduino Due 硬件上使用 Simulink 进行反馈 PID 控制。-matlab开发
05-29
恒定的循环时间对于数字反馈控制至关重要。 通常使用中断例程对微控制器进行编程。 我们为 Arduino 硬件应用了 Simulink 支持包，并实现了具有高达 1 kHz 的恒定控制回路频率的反馈控制系统。 我们可以在真实的磁悬浮系统上实现和测试不同的控制算法，而无需编写任何 C 代码。 循环的采样时间来自两个来源：Step Function 模块和模拟输入模块，您必须为这两个模块选择相同的采样时间。 通过使用 Arduino Due 硬件，最短采样时间为 0.001 秒，以实现稳定的控制循环而不会出现故障。 观看带有工作控制循环的视频www.levball.com 。 另请观看我们的 Maker 项目： https://www.hackster.io/matlab-makers/magnetically-levitated-ball-with-matlab-and-arduino-e3a
Arduino的PID库
11-04
解压到arduino-1.6.5-windows\arduino-1.6.5\libraries里面
Arduino PID 控制教程
My_Communication的博客
08-23 1万+
在控制系统中，控制器在出现错误和干扰时将特定系统的输出校正为所需的输入。最流行的控制器类型是PID，它是P运动、异构和D的缩写。在这个阿杜伊诺PID控制教程中，我将告诉你如何在你的项目中使用这样的控制器。 代码 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 //PID constants double kp = 2 double ki = 5 double k
探索 Arduino PID 库：智能控制的利器
最新发布
gitblog_00070的博客
03-24 535
探索 Arduino PID 库：智能控制的利器 项目地址:https://gitcode.com/br3ttb/Arduino-PID-Library 在电子制作和自动化领域，Arduino 平台因其简单易用而广受欢迎。然而，要实现精确的温度、速度或其他参数控制，PID（比例-积分-微分）算法是必不可少的工具。这就是为什么 Arduino PID Library 如此重要的原因。这个开源项目为...
【Arduino小车实践】PID算法应用之倒立摆
weixin_62403234的博客
07-11 1139
【Arduino小车实践】PID算法应用之倒立摆：本文主要介绍了PID库以及PID库在倒立摆中的应用
Arduino-PID库（使用简单带例程）
09-11
用于Arduino的位置式PID库，自带使用例程，使用简单，上手方便
Arduino PID库简介
acktomas的博客
04-04 2682
原文地址随着新的Arduino PID库的发布，我决定发布这一系列的文章。最后一个库虽然很可靠，但并没有真正附带任何代码解释。这一次的计划是详细解释为什么代码是这样的。对Arduino PID库内部发生的事情直接感兴趣的人将获得详细的解释。任何编写自己的PID算法的人都可以看看我是如何做事的，并借用他们喜欢的任何东西。这将是一个艰难的过程，但我想我找到了一种不太痛苦的方式来解释我的代码。我将从我所谓的“初学者的PID”开始。然后，我将逐步改进它，直到我们得到一个高效、健壮的 pid 算法。
PID库（Arduino PID Library）使用说明
10-23
Arduino PID Library - Version 1.2.1 by Brett Beauregard brettbeauregard.com This Library is licensed under the MIT License
pid算法-arduino
08-03
很全面地介绍了pid算法，适用于正在苦苦寻找如何让小车走直线的朋友们
基于LabVIEW和Arduino的PID算法控制直流电机速度
04-06
硬件环境： 1、Arduino UNO 2、H桥L298N 3、直流减速电机与编码器JGA25-371 LabVIEW作为上位机，Arduino作为核心控制器。 资源包括LabVIEW程序和Arduino程序。 项目代码可直接编译运行~
PID-Library-master_arduino_PID算法_
09-30
arduino的PID算法扩展库，支持模块化调用pid
Arduino PID库
12-28
ArduinoPIDLibrary Arduino PID库
arduino PID库.rar
09-14
arduino PID库.rar
基于Arduino的PID测距控制-综合文档
05-22
基于Arduino的PID测距控制
Arduino mega2560 pid闭环控制控制电机
05-22
本资源是一个可用的Arduino mega2560 pid控制电机，如果想实现四轮控制，仅需要把程序复制修改三次即可。 内容结构： 1.引用<FlexiTimer2.h> 定时中断库； 2.定义引脚、变量； 3.setup函数、loop函数； 4.中断控制...
PID算法（基于arduino开发板）
NicholasYTZ的博客
02-14 2550
本文为作者学习笔记 欢迎交流讨论，喜欢的话点个赞吧 PID PID方程 PID标准方程： P： 计算目标值与当前值的差值 Term P is proportional to the current value of the SP − PV error {\displaystyle e(t)}e(t). For example, if the error is large and positive, the control output will be proportionately large
ArduinoPID库说明
半个仙儿
12-13 4250
arduino PID库详细说明 https://blog.csdn.net/ie_Jeton/article/details/76913229
Arduino PID 库函数指南
热门推荐
冲啊梅勒斯
08-08 4万+
虽然PID的原理并不难，但是实现起来未免会给Arduino的许多创客玩家带来些许困难。本文将不对PID的具体实现细节Arduino的PID库函数使用方法分享给大家，以供参考。
手把手教你看懂并理解Arduino PID控制库——引子
weixin_34406796的博客
12-21 3325
2019独角兽企业重金招聘Python工程师标准>>> ...
arduino实现pid算法控制磁悬浮
10-20
Arduino是一款非常灵活和强大的微控制器平台，可以用于实现PID算法控制磁悬浮系统。 PID控制算法是一种常用的控制方法，通过结合比例、积分和微分三个方面的控制，可以使系统快速而稳定地达到期望状态。在磁悬浮系统中，通过改变电磁场的强度和方向，可以控制磁悬浮装置的位置和稳定性。 在Arduino上实现PID控制算法，首先需要测量磁悬浮装置的位置。可以使用旋转编码器或者光电传感器等传感器来获取位置信息。然后，根据设定的目标位置和当前位置的差异，计算出控制量（比如电流或电压）。这个过程可以通过编写相应的代码实现。 随后，通过PID算法计算出控制量的调整量。PID算法可以根据设定的比例、积分和微分系数来调整系统的稳定性和响应速度。调整量可以通过对差分值进行加权求和来计算。 最后，将调整量传递给磁悬浮装置的控制器，通过改变电磁场的参数实现位置的调整。这个过程可以通过使用PWM信号或者其他控制方式来实现精确的控制。 通过使用Arduino实现PID算法控制磁悬浮系统，可以快速而精确地控制装置的位置和稳定性。同时，Arduino平台具有独立操作性和简单的编程方式，使得控制算法的开发和优化变得更加方便和灵活。因此，Arduino是很适合用来实现PID算法控制磁悬浮系统的工具。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值