【技术实现步骤摘要】
一种采用反演滑模PID混合切换的倒立摆控制方法
[0001]本专利技术涉及倒立摆控制领域,具体而言,涉及一种采用反演滑模
PID
混合切换的倒立摆控制方法
。
技术介绍
[0002]倒立摆系统是研究控制理论的一种典型实验装置,具有成本低
、
结构简单
、
物理参数和结构易于调整的优点
。
它是一个具有高阶次
、
不稳定
、
多变量
、
非线性和强耦合特性的不稳定系统
。
在控制过程中,它能有效地反映比如可镇定型
、
鲁棒性
、
随动性以及跟踪等许多控制中的关键问题,因此它在我国以及世界工业应用中具有重要的研究意义
。
目前采用反演控制的倒立摆优点在于其在中等误差时,具有较理想的稳定性与响应速度;而采用
PID
控制的倒立摆在小误差时具有较好的快速性与稳定性,但误差变大时,其快速性会下降,如果通过调节参数增大增益,又会导致其不稳定
。
滑模控制的倒立摆在大误差时具有很好的稳定性与响应速度;但当误差变小时,其稳态精度并不高
。
基于上述背景原因,本专利技术提出了一种能够结合反演
、
滑模与改进
PID
三者优点,并根据误差大小自由切换的倒立摆控制规律,最终实现了较好的控制效果,也使得本倒立摆装置具有很高的实验推广价值
。
[0003]需要说明的是 ...
【技术保护点】
【技术特征摘要】
1.
一种采用反演滑模
PID
混合切换的倒立摆控制方法,其特征在于,包括以下步骤:步骤
S10
,在倒立摆上安装微型陀螺仪,测量倒立摆的摆角;然后设定期望摆角,并进行比较,得到摆角误差信号;再对摆角误差信号进行非线性变换后积分得到摆角误差非线性积分信号;再将期望摆角信号通过二阶延迟器,得到摆角期望二阶延迟信号;然后采用摆角期望二阶延迟信号与摆角信号进行比较解算摆角期望微分信号如下:
e1=
θ
‑
θ
d
;;;其中
θ
为倒立摆的摆角信号;
θ
d
为期望摆角信号,
e1为摆角误差信号;
T
为常值积分时间参数,
ε0为常值非线性变换参数,
θ
a1
为常值积分抗饱和参数,
e
s1
为摆角误差非线性积分信号;
T1、T2为二阶延迟器的常值时间参数,
q
为传递函数的微分算子;
θ
d1
为摆角期望二阶延迟信号;
θ
dd
为摆角期望微分信号;步骤
S20
,将摆角误差信号通过二阶延迟器,得到摆角误差二阶延迟信号;然后采用摆角误差二阶延迟信号与摆角误差信号进行比较解算摆角误差微分信号;根据所述的摆角期望微分信号叠加摆角误差信号
、
摆角误差非线性积分信号
、
摆角误差微分信号构成摆角速度期望信号;然后倒立摆上安装微型速率陀螺仪,测量倒立摆的摆角速度,再采用摆角速度与摆角速度期望信号进行比较得到摆角速度误差信号;再采用摆角速度误差信号进行非线性变换并积分,得到摆角速度误差非线性积分信号如下:性变换并积分,得到摆角速度误差非线性积分信号如下:
ω
d
=
‑
k1e1‑
k2e
1d
‑
k0e
s1
+
θ
dd
;
e2=
ω
‑
ω
d
;其中
e
11
为摆角误差二阶延迟信号;
e
1d
为摆角误差微分信号;
k1、k2、k0为常值参数,
ω
d
为摆角速度期望信号;
ω
为倒立摆的摆角速度信号,
e2为摆角速度误差信号;
θ
a2
为常值积分抗
饱和参数,
e
s2
为摆角速度误差非线性积分信号;步骤
S30
,将摆角速度误差信号通过二阶延迟器,得到摆角速度误差二阶延迟信号;然后采用摆角速度误差二阶延迟信号与摆角速度误差信号进行比较解算摆角速度误差微分信号;根据摆角速度误差信号与摆角速度信号采用自适应方法设计角速度系数估计律信号,再进行积分得到角速度系数估计信号;根据摆角速度误差信号与摆角信号采用自适应方法设计角度系数估计律信号,再进行积分得到角度系数估计信号;最后叠加摆角速度误差信号
、
摆角速度误差微分信号
、
摆角速度误差非线性积分信号得到倒立摆反演控制信号如下:如下:如下:如下:如下:如下:如下:其中
e
21
为摆角速度误差二阶延迟信号;
e
2d
为摆角速度误差微分信号;
k
b1
为常值参数,用于控制角速度系数估计值收敛快慢;为角速度系数估计律信号,为角速度系数估计信号;
k
b2
为常值参数,用于控制角度系数估计值收敛快慢;为角度系数估计律信号,为角度系数估计信号;
k3、k4、k5为常值参数,
a1为倒立摆反演控制信号;步骤
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。