PID公式的推导过程及实现代码
来源:互联网 发布:神马小说软件下载 编辑:程序博客网 时间:2024/05/17 04:29
一、PID框图:
n0(t)是要稳定的值
n(t)是当前输出值
e(t) = n0(t) - n(t)
一、模拟PID控制原理
这个公式网络上很好找:
二、数字PID控制
由于模拟的微积分运算对应计算机来说是不太好写代码的,所以要利用采样将数据离散化
于是公式就可以转换为:
其中T为采样时间,由于T之类的参数是常量,所以将Kp乘入公式中可以转换成另一种写法
这个公式叫位置式算法
由于要不断的累加ej,增加了计算量,所以这个公式又可以转换为增量式算法:
然后u(k) = u(k-1) + u
三、参数的整定
先将Ti设置为无穷大,Td设置为0,调节Kp
然后再调节Ti,最后是Td
四、实现代码
typedef struct PID
{
int SetPoint; //设定目标 Desired Value
long SumError; //误差累计
double Proportion; //比例常数 Proportional Cons
double Integral; //积分常数 Integral Const
double Derivative; //微分常数 Derivative Const
double Integral; //积分常数 Integral Const
double Derivative; //微分常数 Derivative Const
int LastError; //Error[-1]
int PrevError; //Error[-2]
} PID;
/*******************************************************************************
* 函数名称 : IncPIDCalc
* 函数描述 : 增量式 PID 控制计算
* 函数输入 : int 当前位置
* 函数输出 : 无
* 函数返回 : 增量式PID结果
*******************************************************************************/
int IncPIDCalc(int NextPoint)
{
int iError, iIncpid;
//当前误差
iError = sptr->SetPoint - NextPoint;
//增量计算
iIncpid = sptr->Proportion * iError //E[k]项
- sptr->Integral * sptr->LastError //E[k-1]项
+ sptr->Derivative * sptr->PrevError; //E[k-2]项
//存储误差,用于下次计算
sptr->PrevError = sptr->LastError;
sptr->LastError = iError;
//返回增量值
return(iIncpid);
}
int PrevError; //Error[-2]
} PID;
/*******************************************************************************
* 函数名称 : IncPIDCalc
* 函数描述 : 增量式 PID 控制计算
* 函数输入 : int 当前位置
* 函数输出 : 无
* 函数返回 : 增量式PID结果
*******************************************************************************/
int IncPIDCalc(int NextPoint)
{
int iError, iIncpid;
//当前误差
iError = sptr->SetPoint - NextPoint;
//增量计算
iIncpid = sptr->Proportion * iError //E[k]项
- sptr->Integral * sptr->LastError //E[k-1]项
+ sptr->Derivative * sptr->PrevError; //E[k-2]项
//存储误差,用于下次计算
sptr->PrevError = sptr->LastError;
sptr->LastError = iError;
//返回增量值
return(iIncpid);
}
/*******************************************************************************
* 函数名称 : LocPIDCalc
* 函数描述 : 位置式 PID 控制计算
* 函数输入 : int 当前位置
* 函数输出 : 无
* 函数返回 : 位置式PID结果
*******************************************************************************/
int LocPIDCalc(int NextPoint)
{
int iError,dError;
* 函数名称 : LocPIDCalc
* 函数描述 : 位置式 PID 控制计算
* 函数输入 : int 当前位置
* 函数输出 : 无
* 函数返回 : 位置式PID结果
*******************************************************************************/
int LocPIDCalc(int NextPoint)
{
int iError,dError;
iError = sptr->SetPoint - NextPoint; //偏差
sptr->SumError += iError; //积分
dError = iError - sptr->LastError; //微分
sptr->LastError = iError;
sptr->SumError += iError; //积分
dError = iError - sptr->LastError; //微分
sptr->LastError = iError;
return(sptr->Proportion * iError //比例项
+ sptr->Integral * sptr->SumError //积分项
+ sptr->Derivative * dError); //微分项
}
+ sptr->Integral * sptr->SumError //积分项
+ sptr->Derivative * dError); //微分项
}
阅读全文
0 0
- PID公式的推导过程及实现代码
- 不同平面直角坐标系之间的转换公式的推导及C#代码实现
- BP神经网络公式推导及实现(MNIST)
- Backpropagation 算法公式推导及矩阵实现
- 蔡勒公式的推导过程
- 蔡勒公式的推导过程
- 蔡勒公式的推导过程
- 蔡勒公式的推导过程
- 单应性(homography)变换的公式推导过程
- LSTM公式推导过程
- DPMM的理解、公式推导及抽样
- MCMC公式及推导
- 椭圆部分面积计算公式及微积分推导过程
- 反向传播算法(过程及公式推导)
- 反向传播算法(过程及公式推导)
- 反向传播算法(过程及公式推导)
- 反向传播算法(过程及公式推导)
- 反向传播算法(过程及公式推导)
- TensorFlow的reshape操作 tf.reshape
- 配置网络接口地址
- webapck 学习指南
- Android-Dialog根据listview的数据量动态改变高度,并且有一个最大的高度
- 2017-7-30
- PID公式的推导过程及实现代码
- 1149
- jQuery-easyui实现关闭全部tabs
- Spring 顾问 自动代理
- 一个日志实时处理方案
- 在线拖拽云建站-不花钱不写代码5分钟智能建站
- http笔记之php与cgi
- 1042: 数列求和3
- struts2中jsp页面传值到action的两种方式