二级倒立摆的建模、线性化S函数的PID控制以及非线性化S函数的PID控制

该博客详细介绍了二级倒立摆的非线性建模,通过线性化得到状态方程并构建S-Function。接着,利用极点配置设计了PD控制器,进行了闭环系统仿真。此外,还探讨了非线性方程的S函数建模,并进行了有扰动和无扰动情况的仿真。
摘要由CSDN通过智能技术生成

1 二级倒立摆的非线性建模

首先对于下面这种二级倒立摆,对其进行建模:在这里插入图片描述进行以下参数假设:在这里插入图片描述可以通过参考论文,使用牛顿运动定律和拉格朗日方程,结合θ1和θ2无外力作用,列出方程:在这里插入图片描述即可得到如下的对于二级倒立摆模型的非线性方程建模:在这里插入图片描述

2 线性化模型、使用极点配置的PD控制

通过在平衡位置进行线性化可以得到如下的状态方程:在这里插入图片描述把状态方程写进S-Function函数:Inverted_Pendulum_model_linear,是一个单输入三输出,6个连续状变量态的状态方程组,即可以根据这些信息和状态方程写出S函数。
分析状态方程,可以得知:二级倒立摆的线性化模型是能控,能观&#

matlab有关二级倒立摆PID控制-shuang_pd.mdl 直线二级倒立摆是一个单输入三输出的系统.为了使倒立摆稳定竖立,必须对小车的位置、摆杆1的偏角、摆杆2的偏角这3个输出同时进行闭环控制.若采用PID控制器,则因为一个PID控制器只能控制一个被调量,所以在此提出三回 路PID控制方案,在上图中:Pos表示小车的位移;Anglel表示摆杆l的偏角;Angle2表示摆杆2的偏角.根据文献理论“积分控制不适用于倒立摆控制”,所以这里采用PD控制策略。即采用PDPDPD三回路控制方案. 6个PD参数与6个状态变量一一对应.将图所示的PDPDPD控制结构与状态反馈控制系统的结构相比较,发现它们的结构是一样的.因此,可利用状态反馈控制系统的极点配置方法来确定PID控制器的6个参数值. 当取点为P=[-2 5i -2-5i -5 4i -5-4i -8 6i -8-6i],利用MATLAB中的极点配置函数place,可求出个K值,程序如下: A=[ 0 0 0 1 0 0; 0 0 0 0 1 0; 0 0 0 0 0 1; 0 0 0 0 0 0; 0 86.69 -21.62 0 0 0 0 -40.31 39.45 0 0 0]; B=[ 0 0 0 1 6.64 -0.088]'; P=[-2 5*i,-2-5*i,-5 4*i,-5-4*i,-8 6*i,-8-6*i]; K=place 结果:K = 46.6564 75.1740 -162.8217 25.2800 0.3594 -26.5211 6个PD参数与6个状态变量一一对应.将图所示的PDPDPD控制结构与状态反馈控制系统的结构相比较,发现它们的结构是一样的.因此,可利用状态反馈控制系统的极点配置方法来确定PID控制器的6个参数值. 当取点为P=[-2 5i -2-5i -5 4i -5-4i -8 6i -8-6i],利用MATLAB中的极点配置函数place,可求出个K值,程序如下: A=[ 0 0 0 1 0 0; 0 0 0 0 1 0; 0 0 0 0 0 1; 0 0 0 0 0 0; 0 86.69 -21.62 0 0 0 0 -40.31 39.45 0 0 0]; B=[ 0 0 0 1 6.64 -0.088]'; P=[-2 5*i,-2-5*i,-5 4*i,-5-4*i,-8 6*i,-8-6*i]; K=place 结果:K = 46.6564 75.1740 -162.8217 25.2800 0.3594 -26.5211
评论 4
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值