《卡尔曼滤波器在PID控制器中的应用.docx》由会员分享，可在线阅读，更多相关《卡尔曼滤波器在PID控制器中的应用.docx（7页珍藏版）》请在三一文库上搜索。
1、卡尔曼滤波器在PID限制器中的应用学生： 潘培哲专 业：限制工程指导教师：李鹏云南大学信息学院引言传统的倒立摆系统采用单纯的PID限制模式,这种限制模式虽然可以在一定 程度上满足系统的要求,但是具有精度差,响应时间长,稳定性不高等缺乏之 处.造成这种情况的一个原因是限制信号中含有噪声干扰,噪声干扰会在很大程度上影响系统的性能.另外,除了以上提到的外界干扰外,系统内部也存在干扰, 主要包括建模时因抽象和简化而引入的结构干扰以及实际系统中因参数变化而 引入的参数干扰.因此,为了提升系统的稳定性,使之具有较短的响应时间和控 制精度,本文设计了一种基于卡尔曼滤波器的PID限制系统,通过卡尔曼滤波器 对
2、系统的一些噪声进行滤波处理之后,对系统的随机误差进行了比普通PID更进 一步的补偿,获得了更为精确的系统模型,从而使系统的稳定性和精度以及响应 时间都得到了有效的提升.本文以直线小车倒立摆为例,研究了卡尔曼滤波器在倒立摆限制系统中的应用.卡尔曼滤波器原理在现代随机最优限制和随机信号处理技术中,信号和噪声往往是多维非平稳 随机过程,因其时变性,功率谱不固定.在196叶卡尔曼提出了卡尔曼滤波理论, 该理论采用时域上的递推算法在电脑上进行数据滤波处理.对于离散域系统：x(k) = Ax(k 1) +1y(fe) = Cx(k + 廿(k)离散卡尔曼滤波器递推算法为:x(kk - 1) = Ax(k
3、lk - 1) + Bu(k)P(kk - 1) = APk - 1|A - 1)j4t + Qx(kk) = x(kk -1) + /(k)(y(k) - Cx(kk - 1)Kg(k) = P(kk - )Cr/(CP(kk 1)C/+ R)P(kk = (7 - KMC)P(kk - 1)图i卡尔曼滤波器结构图三、基于卡尔曼滤波器的 PID限制器工作过程下面便以直线小车倒立摆为被控对象,来进一步研究卡尔曼滤波技术在倒立 摆系统中的应用.倒立摆系统的数学模型对直线小车的倒立摆系统的数学建模.对于倒立摆系统,由于其本身是自不 稳定的非线性系统,实验建模存在一定的困难.但经过小心的假设忽略掉一
4、些次 要的因素后,倒立摆系统就是一个典型的运动的刚体系统, 可以在惯性坐标系内 应用经典力学理论建立系统的动力学方程.对一级倒立摆线性化后得到系统的近似模型如下( f + 成产)$ rngltf) = mix(A/ + )x + hx m近 -u对方程组进行拉普拉斯变换,得到(/ +,*/-)()$- - niglP(s) = ms)茁I ( M + m)X( f)+ bX(s)s -) J = )整理消去Xs后得到传递函数：假设初始条件为 0ml、工.s见力_ 3(害) 4 h (+ ml ) 3( M + nt) nisi 、 bmgls +$s.sq7D取小车倒立摆系统各个参数如下：摆杆
5、质量m =,长度l =,摆杆惯量2,小车的质量M =,重力加速度9= 10m /s 2,小车摩擦系数.进而得到倒立才i系统输入力F到输出摆杆角度8的开环传递函数 Gs为8. 968+25本文仅对G s进行分析.3.2带有卡尔曼滤波器的PID限制系统结构图采用卡尔曼滤波器的PID限制系统的结构图所示.与传统的PID限制系统的 结构图相比拟,在被控对象输出值之后附加了一个卡尔曼滤波器,通过该滤波器将系统的量测噪声和限制干扰量进行消减,消减过程主要表达在经过滤波后的输 出值经过反应之后又回到了系统中,从而使得系统的性能得以提升.对G(S忒取采 样时间为1ms,将对象离散化,并描述为离散状态方程的形式
6、,A + 1) = Ax( k) + 也(A) +,y(A) =k).其中1 It - 3 1 i4*484(, - 61A =kC = 1 0 4 =J) = 0I - 0.025 I0.0090与传统的PID限制系统的结构图相比拟,在被控对象输出值之后图2采用卡尔曼滤波器的PID限制系统的结构图四、系统仿真根据所示的限制系统,在Matlab /Simulink环境下建立仿真模型平台,并在Matlab/Simulink环境下编程仿真.测量干扰信号均为方差为0.01的白噪声信号,输入阶跃信号幅值为1, Q=1,R=1.仿真时间为4s.将PID参数设置为Kp=20, Ki=70, Kd=2 ,仿
7、真结果如图3, 4所示：图3滤波后的曲线图4未滤波曲线图3是采用卡尔曼滤波器结果,图4是未采用卡尔曼滤波器的结果.通过图 3可知：采用卡尔曼滤波器后,噪声显著减小, 稳定时间T s为2s,系统能够迅 速的到达稳定,而未采用卡尔曼滤波器的系统,噪声含量多,限制输出不稳定.由 图4可见,使用传统PID进行限制,系统的品质较差,特别是在平衡位置附近有 较大的震荡,这大大影响系统的稳定精度.五、结论本文简要介绍了卡尔曼滤波器波理论及其算法,在对一级倒立摆建模的根底 之上,对基于卡尔曼滤波器的PID限制进行了仿真,仿真结果证实了该方法的有 效性.通过比照可以看出,采用卡尔曼波器后,只要合理选用 PID限
8、制器参数, 可以得到稳定的系统输出,显著减小噪声的影响同时,能够有效减少系统的峰值 时间,减小震荡次数,快速的使系统到达稳定.附录：卡尔曼滤波程序function xhatOut, yhatOut = KALMAN(u,meas)%卡尔曼滤波器persistent P xhat A B C Q R%定义持久性变量if isempty(P)%赋初始值xhat = 0;0;P = 0.2021 0.4036;0.4036 0.81;A = 1 0.001; -0.025 1;B = 0.000004484;0.009;C = 1 0;Q = 1*eye(1);R = 1*eye(1);end%计算状态预测值和其协方差矩阵xhat = A*xhat + B*u;P = A*P*A + B*Q*B;%计算卡尔曼增益K = P*C/(C*P*C + R);%计算测量残差resid = meas - C*xhat;%更新最优估计值以及协方差矩阵xhat = xhat + K*resid;P = (eye(2)-K*C)*P;%输出结果xhatOut = xhat;yhatOut = C*xhatOut;