一阶倒立摆系统

前言

倒立摆系统(Inverted Pendulum System, IPS)是一个典型的复杂、不稳定、非线性、多输入多输出(MIMO)系统,是进行控制理论研究的理想实验平台。

对倒立摆系统的研究能有效地反映控制中的许多基本问题:如非线性问题、鲁棒性问题、稳定化系统的镇定问题、随动问题以及跟踪问题。

通过对倒立摆系统的控制可以检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。同时倒立摆模型在军工、航空航天、机器人领域都有广泛应用,如火箭发射时的垂直控制,导弹飞行中的姿态控制等,足式机器人(humanoid)行走平衡控制。

控制目标

一阶倒立摆系统的控制问题就是通过计算给定直流电机电流大小,即小车运动所需力的大小(控制作用)使摆杆偏角和小车位置(系统输出)能够尽快达到一个平衡点(注意这里有多个控制目标),并使之没有大的振荡和超调。进一步,当系统达到稳定后能克服各种随机扰动(例如人为拨动摆杆使之突然偏离平衡点)而仍能保持稳定运行。

建模分析

分别对小车和摆杆进行受力分析,建立动力学方程。注意,这里的建模我们忽略空气流动阻力和其他次要摩擦力作用。

Cart-pendulum

小车运动

小车水平方向的运动:
F - H{\text{ = }}M\frac{{{d^2}}}{{d{t^2}}}x

H为摆杆对小车的作用力,F为可控的对小车的外部输入,x是小车位置也是系统的一个输出。

摆杆运动

对摆杆的动力学建模分解为水平方向,垂直方向及摆杆的转动。

水平方向受力分析:
H = m\frac{{{d^2}}}{{d{t^2}}}(x + l\sin \theta )

H = m \ddot x + ml \ddot \theta \cos \theta - ml \dot \theta ^2 \sin \theta

注:这里的\thetax都是关于时间t的函数,是动态变量。特别的,\theta也是系统的一个输出。

垂直方向受力分析:
V =mg + m\frac{{{d^2}}}{{d{t^2}}}( l\cos \theta )

V = mg - ml \ddot \theta \sin \theta - ml \dot \theta ^2 \cos\theta

摆杆绕其重心的力矩平衡方程:
J\ddot \theta = Vl \sin \theta - Hl \cos \theta

J为摆杆转动惯量。

模型简化

到目前为止倒立摆系统建模已经完成,我们可以清楚的看到倒立摆系统是一个复杂的、关于状态变量非线性的、多变量耦合的、多输出系统。

需要注意的是,我们期望摆杆的运动属于小倾角运动,因此我们可以在期望位置(平衡点)对系统作线性化处理从而简化模型:\dot \theta ^2 \approx 0, \sin \theta \approx \theta, \cos \theta \approx 1。此外,\theta + \phi = \pi,则有\cos \theta = -\cos \phi, \sin \phi = \sin \theta。代入简化,得:

H = m \ddot x + ml \ddot \theta

V = mg - ml \ddot \theta \theta

J \ddot \phi = Vl \theta - Hl

联立以上几式,且有J = \frac{4}{3} m l ^2,我们可得:
(M + m) \ddot x + ml \ddot \theta = F

\frac{7}{3}l \ddot \theta + \ddot x = g \theta

到目前为止,倒立摆动态模型简化完毕,我们可以运用古典控制理论或现代控制理论对系统进行分析和设计,分别建立传递函数模型或状态空间模型。

基于传递函数模型的古典控制理论,更适合于单输入单输出(SISO)系统的分析和设计,由于倒立摆系统有两个控制目标,因此我们选择基于状态空间模型的现代控制理论分析方法。当然,要是不嫌麻烦完全可以建立两个输入输出传递函数进行分析。

状态空间模型

\begin{aligned} \dot x&= Ax+ Bu \\ y &= Cx + Du\\ \end{aligned}

我们取M=0.5, m=0.2, g = 9.8, l = 0.3,代入:
A = \left[ {\begin{array}{*{20}{c}} 0&1&0&0 \\ 0&0&{ - 1.367}&0 \\ 0&0&0&1 \\ 0&0&{15.95}&0 \end{array}} \right]

B = \left[ {\begin{array}{*{20}{c}} 0 \\ {1.628} \\ 0 \\ { - 2.3256} \end{array}} \right]C = \left[ {\begin{array}{*{20}{c}} 1&0&0&0 \\ 0&0&1&0 \end{array}} \right]D = \left[ {\begin{array}{*{20}{c}} 0 \\ 0 \end{array}} \right]x = \left[ {\begin{array}{*{20}{c}} x \\ {\dot x} \\ \theta \\ {\dot \theta } \end{array}} \right]

建立了状态空间模型,接下来就是系统分析和控制器设计了,等下回再更。

©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 218,122评论 6 505
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 93,070评论 3 395
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 164,491评论 0 354
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 58,636评论 1 293
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 67,676评论 6 392
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,541评论 1 305
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 40,292评论 3 418
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 39,211评论 0 276
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,655评论 1 314
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 37,846评论 3 336
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 39,965评论 1 348
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,684评论 5 347
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 41,295评论 3 329
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,894评论 0 22
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 33,012评论 1 269
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 48,126评论 3 370
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,914评论 2 355

推荐阅读更多精彩内容

  • 文/执笔成书 最近我们的现代控制理论给我们留了一个课下作业:一级倒立摆的分析与建模。 在百度上查了一下,解释如下:...
    执笔成书阅读 2,265评论 0 2
  • 选择题部分 1.(),只有在发生短路事故时或者在负荷电流较大时,变流器中才会有足够的二次电流作为继电保护跳闸之用。...
    skystarwuwei阅读 12,917评论 0 7
  • 前言 前面一篇博客介绍了基于状态空间模型的系统分析。本篇博客将针对线性时不变系统,基于状态空间模型并根据系统的性能...
    TonnyYan阅读 10,099评论 5 19
  • 为何行动对于我那么难?今晚第一天开始锻炼腹部,仰卧起坐20个就不行了,一心想逃避,可是看见肚子上的肉肉,就开始抱怨...
    小伟小伟小伟阅读 160评论 0 0
  • 1.搭建项目 创建resource/application.xml 创建webapp/spring-servlet...
    简书超级会员阅读 1,716评论 0 2