CN112180735A - 自抗扰微分跟踪变结构控制方法 - Google Patents
自抗扰微分跟踪变结构控制方法 Download PDFInfo
- Publication number
- CN112180735A CN112180735A CN202011114598.9A CN202011114598A CN112180735A CN 112180735 A CN112180735 A CN 112180735A CN 202011114598 A CN202011114598 A CN 202011114598A CN 112180735 A CN112180735 A CN 112180735A
- Authority
- CN
- China
- Prior art keywords
- controller
- controlled object
- signal
- variable structure
- value
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 230000002452 interceptive effect Effects 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000004069 differentiation Effects 0.000 description 3
- 101710163391 ADP-ribosyl cyclase/cyclic ADP-ribose hydrolase Proteins 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种自抗扰微分跟踪变结构控制方法,它包括采用跟踪微分器、扩张状态观测器的控制器,受到干扰信号干扰的被控对象,其特征是所述控制器中还包括变结构控制器,并包括如下步骤:a.向控制器输入输入值v;b.跟踪微分器TD跟踪该输入值v;c.所述扩张状态观测器对被控对象的当前状态进行观测,取得对被控对象输出值y的状态变量估计值及干扰信号的实时作用量的估计值;d.所述变结构控制器计算出控制信号u;e.所述被控对象输出在干扰信号干扰下的实际输出值y;重复步骤c‑步骤e。本发明得到的自抗扰微分跟踪变结构控制方法,可以***地减小干扰信号对未建模被控对象的输出的影响,控制器设计有迹可循,不依赖工程师的经验。
Description
技术领域
本发明涉及一种控制方法,特别是一种自抗扰微分跟踪变结构控制方法。
背景技术
现有控制***中,PID控制器作为一种经典的控制技术被大规模运用,然而PID控制器在受到强干扰或被控对象模型难以确定的***中,无法达到所需的控制精度,且PID控制器对于非线性***的控制存在局限性,因此自抗扰控制器ADRC作为一种不依赖被控对象模型、鲁棒性强的控制技术,在伺服***中得到了应用和研究,常用的包括二阶自抗扰控制器,主要包括,然而自抗扰控制器在实际使用中,其中的非线性状态误差反馈控制器需要通过根据经验选择对应的控制函数,调参时间长,控制效果的不确定性较大,限制了自抗扰控制器的有效运用。
发明内容
本发明的目的是为了解决上述现有技术的不足而提供一种能依照一定规律快速调参的自抗扰微分跟踪变结构控制方法。
为了实现上述目的,本发明所设计的自抗扰微分跟踪变结构控制方法,它包括采用跟踪微分器、扩张状态观测器的控制器,受到干扰信号干扰的被控对象,所述控制器中还包括变结构控制器,并包括如下步骤:
a.向控制器输入输入值v;
b.跟踪微分器TD跟踪该输入值v,并得到其跟踪信号v1及其微分v2,所述跟踪微分器TD的公式为:
c.所述扩张状态观测器对被控对象的当前状态进行观测,取得对被控对象输出值y的状态变量估计值z1、z2及干扰信号的实时作用量的估计值z3;
d.所述变结构控制器接收跟踪信号v1及其微分v2、状态变量估计值z1及其微分z2后,计算出控制信号u,其计算公式为:
u(t)
=[εsgn(s)+λs+c1(v2-z2+β1eESO)+c2(k2(v-v1)-2c2k·v2-z3+β1eESO]/c2b0
(1.2);
e.所述被控对象接收控制信号u后,输出在干扰信号干扰下的实际输出值y;
f.重复步骤c-步骤e,直至控制器控制的被控对象输出与在无干扰信号状态下接收输入值v后被控对象的输出值近似一致或相等的值。
所述近似一致,可以指对于被控对象的输出值,根据实际使用要求,设定位于在无干扰信号状态下接收输入值v后被控对象的输出值两侧的误差带,当控制器控制的被控对象的输出值y不超出误差带范围后,即认为输出值y与在无干扰信号状态下接收输入值v后被控对象的输出值近似一致。
式(1.1)中,k为跟踪微分器TD的调节参数,通过调节该参数,可以改变跟踪微分器的相应速度。
对于步骤c中所述的扩张观测器,有公式:
eESO(t)=z1-y;
其中t为时间,b0为与被控对象相关的补偿因子,β1、β2、β3为观测器参数,且满足β1>0、β2>0、β3>0并有β1β2>β3;在实际操作中,β1越大,则扩张状态观测器跟踪信号的速度越快,β2越大,则扩张状态观测器跟踪信号的微分速度也越快;β3主要影响***的精度,其值越小,***精度越高,但对扰动的估计滞后就会增大,β3增大则可能产生振荡,造成精度降,所以需要合理配置ESO的三个参数。
对于变结构控制器的设计,本发明中变结构控制器的切换函数为:
s=c1e1+c2e2;
上式中ε及λ为变结构控制器采用指数趋近方法时的系数,这两个参数均大于0。
根据切换函数和指数切换趋近率的公式,可以得到步骤d中变结构控制器所用的公式(1.2)。
本发明得到的自抗扰微分跟踪变结构控制方法,利用非线性变结构控制器替代非线性状态误差经验反馈控制器,可以通过调节变结构控制器中的控制系数,***地减小干扰信号对未建模被控对象的输出的影响,调参速度和控制器设计有迹可循,不依赖工程师的经验。
附图说明
图1是本发明自抗扰微分跟踪变结构控制方法的控制原理图;
图2是本发明自抗扰微分跟踪变结构控制方法实施例1的控制原理图;
图3是实施例1中机器人关节在正弦输入下的关节参数变化图;
图4是实施例中控制器输出的控制信号图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
实施例1:
本实施例描述的自抗扰微分跟踪变结构控制方法,如图1所示,它包括采用跟踪微分器、扩张状态观测器的控制器,受到干扰信号干扰的被控对象,所述控制器中还包括变结构控制器,并包括如下步骤:
a.向控制器输入输入值v;
b.跟踪微分器TD跟踪该输入值v,并得到其跟踪信号v1及其微分v2,所述跟踪微分器TD的公式为:
c.所述扩张状态观测器对被控对象的当前状态进行观测,取得对被控对象输出值y的状态变量估计值z1、z2及干扰信号的实时作用量的估计值z3;
d.所述变结构控制器接收跟踪信号v1及其微分v2、状态变量估计值z1及其微分z2后,计算出控制信号u,其计算公式为:
u(t)
=[εsgn(s)+λs+c1(v2-z2+β1eESO)+c2(k2(v-v1)-2c2k·v2-z3+β1eESO]/c2b0
(1.2);
e.所述被控对象接收控制信号u后,输出在干扰信号干扰下的实际输出值y;
f.重复步骤c-步骤e,直至控制器控制的被控对象输出与在无干扰信号状态下接收输入值v后被控对象的输出值近似一致或相等的值。
对于步骤c中所述的扩张观测器,有公式:
eESO(t)=z1-y;
对于变结构控制器的设计,本发明中变结构控制器的切换函数为:
s=c1e1+c2e2;
在实际工作过程中,可将本方法应用于机器人控制,如图2所示,将机器人关节作为所述被控对象,并在机器人关节中设置有包括位置环及速度环的双环控制***,用该双环控制***控制伺服电机的转动力矩和角度,在实际使用中,采用绝对值编码器采集机器人关节的关节参数,包括转动角度和转动速度,该双环控制***可以等效为一个以目标关节角度r(t)为输入值v,以机器人关节中的伺服电机控制电流iq为控制信号u,以机器人关节运动中的关节参数r作为输出值y的二阶控制***,该二阶控制***的计算和信号接收输出功能,可以通过机器人关节中的运动控制器实现。
所述机器人关节在运转过程中,会受到机器人自身重力、关节摩擦力以及机器人其他关节运动的干扰。
可以理解的是,上述绝对值编码器是用于辅助绝对值编码器采集当前机器人关节参数的一种位移和速度传感器,所述的变结构控制器在此过程中起到了速度环及位置环中位置控制器和速度控制器的作用。
对于上述机器人关节的双环控制***,其工作流程为,向机器人关节输入目标关节角度r(t),并由跟踪微分器TD输出对目标关节角度r(t)的跟踪信号r*及其微分扩张状态观测器对当前机器人关节的关节参数进行观测估计,得到相应的状态变量估计值及干扰信号的实时作用量的估计值z3,将上述参数代入扩张观测器公式,有:
将上述公式代入切换公式及式(1.2)后,可以得到出伺服电机控制电流iq的计算公式,并得出当前***的传递函数:C(s)=133/s(s+25)。
举例来说,可以取输入值r(t)=0.5sin(6πt),初始干扰信号为-0.5,将这两个参数代入上述公式后,对式(1.1)中的k值进行动态调节,k值决定跟踪微分器TD的响应速度,其参数值越大,微分***的响应速度越快,本实施例中,根据机器人关节对控制***响应速度的需求,可以取k=0.5;同时,先取切换函数S=c1e1+c2e2中的c1=1、c2=1代入式(1.2)中进行计算,在实际控制过程中,根据输出的误差,用户还可以对c1及c2的值进行调整,从而达到减小误差的目的,上述机器人关节在所述的双环控制***中的变结构控制器控制下,其关节参数变化如图3中的跟踪信号所示,该跟踪信号在本方法的控制下,可以快速达到与输入值相符合的值,所述变结构控制器的输出值变化如图4所示。
本实施例提供的自抗扰微分跟踪变结构控制方法,利用非线性变结构控制器替代非线性状态误差经验反馈控制器,可以通过调节变结构控制器中的控制系数,***地减小干扰信号对未建模被控对象的输出的影响,调参速度和控制器设计有迹可循,不依赖工程师的经验。
Claims (1)
1.一种自抗扰微分跟踪变结构控制方法,它包括采用跟踪微分器、扩张状态观测器的控制器,受到干扰信号干扰的被控对象,其特征是所述控制器中还包括变结构控制器,并包括如下步骤:
a.向控制器输入输入值v;
b.跟踪微分器TD跟踪该输入值v,并得到其跟踪信号v1及其微分v2,所述跟踪微分器TD的公式为:
c.所述扩张状态观测器对被控对象的当前状态进行观测,取得对被控对象输出值y的状态变量估计值z1、z2及干扰信号的实时作用量的估计值z3;
d.所述变结构控制器接收跟踪信号v1及其微分v2、状态变量估计值z1及其微分z2后,计算出控制信号u,其计算公式为:
u(t)=
[εsgn(s)+λs+c1(v2-z2+β1eESO)+c2(k2(v-v1)-2c2k·v2-z3+β1eESO]/c2b0;
e.所述被控对象接收控制信号u后,输出在干扰信号干扰下的实际输出值y;
f.重复步骤c-步骤e,直至控制器控制的被控对象输出与在无干扰信号状态下接收输入值v后被控对象的输出值近似一致或相等的值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011114598.9A CN112180735A (zh) | 2020-10-16 | 2020-10-16 | 自抗扰微分跟踪变结构控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011114598.9A CN112180735A (zh) | 2020-10-16 | 2020-10-16 | 自抗扰微分跟踪变结构控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112180735A true CN112180735A (zh) | 2021-01-05 |
Family
ID=73950771
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011114598.9A Pending CN112180735A (zh) | 2020-10-16 | 2020-10-16 | 自抗扰微分跟踪变结构控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112180735A (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109358501A (zh) * | 2018-09-28 | 2019-02-19 | 中国科学院长春光学精密机械与物理研究所 | 自抗扰控制方法、控制器及精跟踪控制*** |
CN109460043A (zh) * | 2018-12-29 | 2019-03-12 | 上海海事大学 | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 |
CN110711114A (zh) * | 2019-10-17 | 2020-01-21 | 河北工业大学 | 一种基于动力学模型的外骨骼自抗扰控制方法 |
CN110955145A (zh) * | 2019-12-10 | 2020-04-03 | 哈尔滨理工大学 | 一种针对连续回转马达电液伺服***的五阶自抗扰控制方法 |
CN111416524A (zh) * | 2020-04-27 | 2020-07-14 | 山东大学 | 谐振型dc-dc变换器高抗扰快响应控制***及方法 |
CN111570072A (zh) * | 2020-05-07 | 2020-08-25 | 浙大宁波理工学院 | 一种水泥球磨机的负荷控制***及其方法 |
-
2020
- 2020-10-16 CN CN202011114598.9A patent/CN112180735A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109358501A (zh) * | 2018-09-28 | 2019-02-19 | 中国科学院长春光学精密机械与物理研究所 | 自抗扰控制方法、控制器及精跟踪控制*** |
CN109460043A (zh) * | 2018-12-29 | 2019-03-12 | 上海海事大学 | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 |
CN110711114A (zh) * | 2019-10-17 | 2020-01-21 | 河北工业大学 | 一种基于动力学模型的外骨骼自抗扰控制方法 |
CN110955145A (zh) * | 2019-12-10 | 2020-04-03 | 哈尔滨理工大学 | 一种针对连续回转马达电液伺服***的五阶自抗扰控制方法 |
CN111416524A (zh) * | 2020-04-27 | 2020-07-14 | 山东大学 | 谐振型dc-dc变换器高抗扰快响应控制***及方法 |
CN111570072A (zh) * | 2020-05-07 | 2020-08-25 | 浙大宁波理工学院 | 一种水泥球磨机的负荷控制***及其方法 |
Non-Patent Citations (1)
Title |
---|
邱峰 等: "基于线性自抗扰控制的船舶航迹积分滑模控制器", 《上海海事大学学报》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Erkorkmaz et al. | High speed CNC system design. Part III: high speed tracking and contouring control of feed drives | |
US7084596B2 (en) | Servomotor driving controller | |
CN102023612B (zh) | 一种数控机床伺服***摩擦误差补偿方法 | |
CN104260107B (zh) | 一种实现空间机械臂柔性关节齿隙补偿的方法 | |
WO2014141515A1 (ja) | サーボ制御装置 | |
JP4581096B2 (ja) | 摩擦補償方法、摩擦補償器及びモータ制御装置 | |
CN102385342B (zh) | 虚拟轴机床并联机构运动控制的自适应动态滑模控制方法 | |
CN110989355B (zh) | 一种改进型自抗扰控制器 | |
JPWO2014002678A1 (ja) | ロボット制御装置およびロボット制御方法 | |
CN103792888B (zh) | 基于进给***位置反馈信号的振动抑制控制器 | |
CN107479497A (zh) | 一种五轴加工轨迹轮廓误差双闭环补偿方法 | |
Zheng et al. | Tracking control of manipulator based on high-order disturbance observer | |
Meenakshipriya et al. | Modelling and control of ball and beam system using coefficient diagram method (CDM) based PID controller | |
CN103858335A (zh) | 伺服控制装置 | |
CN112847327A (zh) | 一种用于协作机器人关节的柔顺控制方法 | |
JP3866211B2 (ja) | アクチュエータの制御装置 | |
CN111933268B (zh) | 一种用于血管介入手术机器人***的时滞误差预测控制方法 | |
JP2005085074A (ja) | 位置制御装置 | |
Moghadam et al. | Hierarchical optimal contour control of motion systems | |
CN112180735A (zh) | 自抗扰微分跟踪变结构控制方法 | |
Zheng et al. | Simple online smooth trajectory generations for industrial systems | |
CN109773781B (zh) | 一种无传感器的工业机器人直线软浮动控制方法 | |
Yakub et al. | Comparative study on control method for two-mass systems | |
Bianco et al. | Smooth profile generation for a tile printing machine | |
CN110561427A (zh) | 一种基于补偿的串联弹性驱动器柔顺控制***及方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210105 |
|
RJ01 | Rejection of invention patent application after publication |