二级倒立摆系统的模糊控制

  • 格式:pdf
  • 大小:520.28 KB
  • 文档页数:4

摆 掣
图 1 二 级 倒 立 摆 示 意 图
Fi .1 T —t g n u u s h mai ig a g wo sa e pe d l m c e tc d a r m
表 1 倒 立 摆 参 数 定 义
Ta . Pa a e e e ne ft nv r e e u u b1 r m trd f so i he i e t d p nd l m
c n r l fd u l v  ̄ d p n uu r a- mec nr l r b e ,d sg z y c n rle o to e s b l y o e iv  ̄e o to o b e i e e e d l m e l i o t o lm o n t op e in af z o tolrt c n r l h t i t f h n e d u o t a i t
+ + + () 2
合 误 差 变 化 率 ( 车 的 速 度 、 摆 的角 速 度 、 摆 的 角 速 度 ) 小 上 下
E C作 为 输 入变 量 , 电机 的控 制 力 u 为输 出变 量1 作 3 1 。
利 用命 令 K l ( B, R)得 到 反 馈 矩 阵 : =q A, Q, , r
9 9-
作 者 简 介 : 灵侠 ( 9 3 ) 女 , 西 西安 人 , 士 , 教 。研 究方 向 : 制 理 论 与 控 制 工程 。 焦 18 一 , 陕 硕 助 控

《 电子设计 工程  ̄ 0 2年 第 1 21 6期
坐标 上 的外 力 。系 统 的广 义 坐 标 有 3个 , 别 为 ,。0。 分 o,2 系统 的动 能 :
u s b 、 l-a al、 r g o pi n O n I rcue s i i r s ot lbetn n ier g ntipp r a uz nt l mutvr bes o - u l gadS .ts utr ml nr jc g e n. s a e, zy ae i i tn c n o st i s a a c oo ie n i I h f
ll([ 一3品 】 ) E= 一 一 一6 c ) 吕 = ( 9
一 2) 一 u隶属 度 函数 的设 计 d出 E、 EC、


1  ̄ 2 1 " m

m ・
( )d))m ( 2 d) + ̄ 1砰 (P \ + r 1
盟 一 一 舰 硼 哦

 ̄2() ) m/2 ‘1 (x2 ) ( )m d + +

m 3

(( 2 t3 ) d x

) )
( 3 )
() 4

系统 的势 能 为 :
V=V + + =, Yl l +m2 2 y m +, 3 3
图 2 E和 E C隶 属 度 函 数 曲线

3 模 糊 推 理 )
0,

0 0

采 用 Ma d n 最 小 运算 规 则 。 m ai
4) 糊 控 制 规 则 模



根 据 输 入 , 出 论域 上 的模 糊 语 言 变 量 划 分 N ( 大 ) 输 B 负 , N 负 中 )N ( 小 ) Z 零 ) P ( 小 ) P 正 中 ) P 正 M( ,S 负 , O( , S 正 , M( , B(
证控 制 理论 . 且 与 工 程 中的 控 制 对 象具 有 类 似 的 结 构 。 中采 用模 糊控 制研 究 二 级倒 立摆 系统 的 实 时控 制 问题 , 并 文 设
计模 糊 控 制 器控 制倒 立摆 系统 的稳 定 。 实践 证 明 . 糊 控 制 方 法 控 制 二 级 倒 立摆 系统 的 稳 定 是 可行 的 。 模 关 键 词 :倒 立 摆 ;模 型 ;模 糊 ;实时 控 制 ;稳 定
中 图分 类 号 : P 7 T 23
文献标识码 : A
文 章 编 号 :1 7 — 2 6 2 1 ) 6 0 9 — 3 6 4 6 3 (02 1— 09 0
Fuz y c n r lo o bl n e t d e du um y t m z o t o fd u e i v r e p n l s se
带人 参 数 值 . 系统 的状 态 方 程 为
O 0 0 l 0 0 0 0 0 1 0 0 0 0 1 O 0 0 0 O 0 8 69 6. 2162 0 . 0 0 40. 3 45 0 0 31 9. 0
将 其 在 平 衡 位ห้องสมุดไป่ตู้置 附 近进 行 泰 勒 级 数 展 开 , 线 性 化 , : 并 有
OUt ut V abI “” D arl e”
『 上=
( 6)
图 3 “的 隶 属 度 函数 曲线
F g 3 Me e s i u c in c r e fM i. mb rh p f n to u v so
( 7)

66 .4


008 . 8
大 ) 设 计 模 糊 推 理 规 则如 表 2所 示 。 ,
表 2 模 糊 控 制 规 则
Ta .2 Ru e f f z y c n r l b lso z o to u
. . ¨ : = 一
其中 , , , 分 别 为 小 车 的动 能 ,摆 杆 1的 动 能 , 摆 杆 2的动 能 和 质 量 块 的 动 能 。 系统 的动 能 为 :
+ + +


K [2 6 1. 8— 2 . 2 4 .7 3 . l( ) =2 . 1l8 2 2 36 2 . 72196— 65 l8 3 0 2 9 6 综 合误 差 E和 综 合误 差 变 化 率 E 。 C
Ab t a t Asatp c l x e me t e ie n e e e d l m y t m a n h r c e it s u h a ih o d r n n i e r s r c : ia p r n vc ,i v  ̄ d p n u u s se h sma y c a a t r i ,s c sh g -r e 、 o l a 、 y e i d sc n
JAO i g xa ,RE Ha - o ,GUO Mi I L n — i N ib n
( . i伽 Tc nl i lU i r t N A ntue fI om t nE gne n 1X ’ eh o gc nv sy o hIstt o n r ai nier gXi 7 0 3 , hn ; o a e i i f o i ’ 10 2 C i 帆 a 2 N a w sI tu Mehncl Eetcl n neigXi y g7 2 9 , hn ; . o h et n i t o s t ef ca i & l r a E g er , a a 10 9 C i a ci i n nn a 3 C lg E r n neig Y l nvrt, ui 10 0 C i ) . o ee l o n g E ge r , u nU ie i Y l 7 9 0 , n f e y i n i sy n h a
6期 第 2 0卷 第 1
V0 .0 1 2 No 1 .6
电 子 设 计 工 程
Elc r n c De in En i e ig e to i sg gne rn
21 0 2年 8月
Au . 01 g2 2
二 级倒 立摆 系统 的模 糊 控 制
焦灵侠 ,任 海波 ,郭 敏
d t 一6
qI
J i

其 中 为 拉 格 朗 日算 子 , q为 系 统 的广 义 坐 标 , 为 系 统 7 1
的动 能 , 为 系 统 的势 能 , 12 3 : 系 统 在 第 i 广 义 i , ,…n ,为 = 个
收 稿 日期 : 0 2 0 — 5 2 1 — 5 1 稿 件 编 号 :0 2 5 8 2 10 09
摆 杆2 \
质量块

使其稳定 , 同时 它 也 是 检 验各 种 控 制 理 论 的实 验 平 台 。倒 立 摆 系 统 涉 及 控 制 理论 、 算 机 控 制 、 器 人 技 术 等 多 个 领 域 . 计 机
并 且 结 合 了 多种 技 术 , 此 可 以 看 作 是 典 型 的被 控 对 象 供 科 因 研 人 员 研 究 。 立 摆 系 统 被 广 泛 应 用 于 双 足 机 器 人 行 走 及 火 倒 箭 稳 定 发 射 及 飞 行 方 面 , 于 多级 倒 立 摆 和 复 杂 结 构 的 倒 立 对 摆 进 行 控 制 更 是 近年 来 各 科 学 领 域 不 断 研 究 , 新 的 问 题 之 创

所 以对 于 倒 立 摆 系 统 的研 究 具 有 深 远 的 意 义 Ⅲ 。
1 二 级 倒 立 摆 系 统 数 学模 型 的 建 立
在 忽 略 了空 气 阻 力 和 各 种 摩擦 , 认 为 摆 杆 为 刚体 。二 并 级 倒 立 摆 示 意 图 如 图 1所示 利用 拉格 朗 日方程 推导 运 动学 方 程 : 拉 格 朗 日方 程 为 : ( , ) g q 一 ( , £ q q = ( , ) V q )
倒 立 摆 是 一 种 典 型 的 高 阶 非 线 性 、 变 量 、 耦 合 、 对 多 强 绝 不稳定 的实验装置 , 它具 有 结 构 简 单 、 本 低 廉 、 于 调 整 等 成 易
特 点 , 为 这 样 一 个 被 控 对 象 , 有 有 效 的 控 制 策 略 才 能 够 作 只
(. 安 工 业 大 学 北 方信 息 工 程 学 院 陕 西 西安 7 0 3 ; . 北 机 电工 程 研 究所 陕 西 成 阳 7 2 9 1西 10 2 2 西 10 9 3 榆 林 学 院 能 源 工程 学 院 ,陕 西 榆 林 7 90 ) . 10 0 摘 要 : 立摆 系 统 作 为 一 种 典 型 的 实验 装 置 , 具有 高 阶 次 、 线 性 、 稳 定 、 变量 、 耦 合 等 特 点 , 以很 好 的 验 倒 它 非 不 多 强 可