CN111273548A - 基于参考模型和扰动精确观测补偿的三阶舵机控制方法 - Google Patents
基于参考模型和扰动精确观测补偿的三阶舵机控制方法 Download PDFInfo
- Publication number
- CN111273548A CN111273548A CN202010080596.6A CN202010080596A CN111273548A CN 111273548 A CN111273548 A CN 111273548A CN 202010080596 A CN202010080596 A CN 202010080596A CN 111273548 A CN111273548 A CN 111273548A
- Authority
- CN
- China
- Prior art keywords
- control
- order
- steering engine
- reference model
- model
- 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.)
- Granted
Links
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
本发明公开了一种基于参考模型和扰动精确观测补偿的三阶舵机控制方法,所述方法包括如下步骤:步骤一、设计三阶舵机控制器;步骤二、建立三阶舵机模型;步骤三、选择参考模型;步骤四、选择外环控制律;步骤五、建立内环二阶控制模型;步骤六、建立二阶扩张状态观测器并设计状态观测器参数;步骤七、设计非线性滑模律;步骤八、设计信号预处理策略;步骤九、三阶舵机控制。本发明具有响应快速无超调、对参数变化不敏感、鲁棒性较好、控制精度高、抗干扰性强等优点。
Description
技术领域
本发明属于舵机控制技术领域,涉及一种舵机控制方法,具体涉及一种基于参考模型和扰动精确观测补偿的三阶弹用电动舵机控制方法。
背景技术
舵机是导弹重要的控制元件,其控制性能的优劣决定着导弹的控制性能和打击精度。随着军事技术的发展,要求导弹具有更高的打击精度和更优越的控制性能。舵机越来越向高精度、小体积、承载能力强的方向发展,而电动舵机具有成本低、控制***简单、寿命长等特点,在导弹上得到广泛应用。弹用电动舵机是一个非线性***,不同飞行环境下工作导致的负载变化较大,具有不确定性和强干扰等特性。实际应用中弹用舵机常采用PID控制器,然而由PID控制器确定的舵机性能受负载及一些非线性因素影响较大,控制过程中会产生超调现象,加之舵机的一些性能指标要求之间相互制约,传统PID控制器难以达到理想的控制效果。为提高导弹在强干扰条件下和不确定环境中的控制精度,并避免超调,从而提高导弹的控制性能,亟需一种能够对扰动进行精确观测并在控制中加以补偿的工程实用舵机控制方法。
基于“扰动能够影响被控输出,其作用反映在被控输出信息中”的思想,可借用观测器的设计思想,将控制过程中的模型不确定部分、内部扰动、外界扰动等各类扰动扩张成新的状态变量,实现对扰动的动态精确观测,再将扰动估计结果引入控制器的设计中,实现控制对象的动态补偿线性化,从而实现扰动精确观测与补偿。
为避免控制超调现象,可为控制设计一个过渡过程,减少初始控制偏差引起的控制量过大,提高控制***的稳定性、鲁棒性、适应性。一种可行的方法是在控制中引入参考模型,参考模型能够将控制输入指令转化为跟踪参考模型期望输出,能降低***超调。
此外,舵机模型的选择对控制器的设计也会产生影响。舵机数学模型包括二阶模型和三阶模型,一般舵机控制仿真中常采用二阶舵机模型,二阶模型和三阶模型在低频段和中频段差异较小,在高频段存在较大相位差异。三阶模型相对二阶模型更加精确和接近真实模型,若追求更好的控制品质应采用更为精确的三阶模型进行舵机控制器的设计。
发明内容
针对弹用舵机控制,本发明提供了一种基于参考模型和扰动精确观测补偿的三阶舵机控制方法。该方法具有响应快速无超调、对参数变化不敏感、鲁棒性较好、控制精度高、抗干扰性强等优点。
本发明的目的是通过以下技术方案实现的:
一种基于参考模型和扰动精确观测补偿的三阶舵机控制方法,包括如下步骤:
步骤一、设计三阶舵机控制器:
所述三阶舵机控制器采用内外环结构,内环由扩张状态观测器、非线性滑模控制器、三阶舵机模型三部分组成,外环包括参考模型、PD角度控制器;
步骤二、建立三阶舵机模型
从控制输入u到舵偏角θ的三阶舵机模型:
步骤三、选择参考模型
选择参考模型形式如下:
步骤四、选择外环控制律
外环为角度控制环,控制律采用PD控制律:
步骤五、建立内环二阶控制模型
令角速度跟踪误差为e=θc-θ,那么内环二阶控制模型为:
步骤六、建立二阶扩张状态观测器并设计状态观测器参数
针对内环二阶控制模型,建立二阶扩张状态观测器,其具体形式为:
这样状态观测器设计参数数目就降为一个,即只需设计k1,k1应选择较小值,保证观测器的快速收敛性;
状态观测器最终形式如下:
步骤七、设计非线性滑模控制律
内环控制律采用非线性滑模控制律,依次进行滑模面设计和滑模控制律设计,其中:
所采用的滑模面为:
S=sig(a1,e)+k2·a2·sig(2-1/a2,Z2+k1·sig(a1,e))/(2a2-1);
式中:sig(h,x)=((abs(x))h)·sign(x),a1、a2、k2均为设计参数,a2>a1>1,Z2表示观测器输出的观测值,符号函数sign(·)可替换为正弦过渡函数、双曲正切函数等,通过添加边界层方式降低抖振和超调;
所采用的控制律形式为:
u=-inv(B)·(k1·a1·G·(phi/k1+x2)+a·sig(r1,S)+b·sig(r2,S)+Z3);
式中:
r1>1、r2<1分别代表高幂次项和低幂次项,a、b为设计参数;
步骤八、设计信号预处理策略
(1)对外部输入的信号指令进行判断,当本周期信号指令与上一周期信号指令差值大于ζ1时,认定信号指令出现阶跃,此时对阶跃信号进行斜坡处理,保证信号变化斜率小于ζ2;
(2)对控制量指令进行硬饱和处理,即仅允许控制量幅值在一定阈值内变化;
步骤九、三阶舵机控制
(1)根据步骤八设计的信号预处理策略,对外部输入信号进行信号预处理;
(4)将实时角度误差信号e输入状态观测器,实现对状态量偏差以及对机械间隙、摩擦、温度变化、振动等引起的扰动的精确观测,Z1为估计值,Z2为估计值,Z3为以及由机械间隙、摩擦、温度变化振动等引起的扰动估计值;
(6)每个控制周期重复(1)到(5),以实现对期望舵偏指令信号的跟踪。
相比于现有技术,本发明具有如下优点:
1、本发明采用三阶舵机模型,从物理上更接近真实舵机模型。
2、本发明对导弹舵面控制过程中由机械间隙、摩擦、温度变化、振动等引起的各类扰动进行了精确估计,并在控制量中加以补偿,提高了导弹舵面控制的精度、抗干扰性。
3、本发明采用参考模型用来安排过渡过程,避免了超调的产生,进一步提高了控制***的稳定性与鲁棒性以及响应速度。
4、本发明提出了对信号进行预判断处理以及对控制量指令进行硬饱和处理两个控制策略,提高了工程实践性。
5、本发明可有效提高导弹控制性能。
附图说明
图1为舵机三阶***;
图2为控制***结构框图;
图3为角度曲线;
图4为角速度曲线;
图5为角速度观测误差曲线;
图6为控制量曲线。
具体实施方式
下面对本发明的技术方案作进一步的说明,但并不局限于此,凡是对本发明技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围,均应涵盖在本发明的保护范围中。
本发明提供了一种基于参考模型和扰动精确观测补偿的三阶舵机控制方法,基于参考模型和扰动精确观测补偿的舵机控制器采用内外环结构,内环主要由扩张状态观测器、非线性滑模控制器、三阶舵机模型这三部分组成,外环为参考模型、PD角度控制器。利用扩张状态观测器对机械间隙、摩擦、温度变化振动等引起的扰动进行精确观测,并引入滑模控制律的设计,以实现对控制量的补偿,同时通过引入参考模型,安排过渡过程避免超调,最终提高弹用电动舵机控制的鲁棒性、抗干扰性以及响应速度。本发明针对三阶舵机模型进行了基于参考模型和扰动精确观测补偿的控制器设计,并通过仿真验证了该控制方法的有效性。
完整的三阶舵机***如图1所示,由图1可得,从控制输入u到舵偏角θ的三阶舵机模型:
三阶舵机控制器考虑采用内外环控制结构,外环为PD角度控制环,内环为“参考模型+扩张状态观测器+滑模控制律”,结构框图如图2所示。
下面对各部分进行详细介绍。
外环为角度控制环,控制律采用PD控制律:
其中:Kp为比例控制系数,Kd为微分控制系数,θc为期望角度。
参考模型的引入是为了降低***超调,通过将舵机从跟踪外部指令转为跟踪参考模型期望输出,从而实现全控制***良好的时域特性和频域特性。
选择参考模型为:
其中:T表示参考模型时间常数,E表示参考模型阻尼系数。
扩张状态观测器是为了补偿由外部扰动、***参数不确定和基本控制律控制误差引起的复合匹配扰动,从而有效提高***控制精度。
扩张状态观测器选择为:
控制器采用非线性滑模控制器,所采用的滑模面为:
S=sig(a1,e)+k2·a2·sig(2-1/a2,Z2+k1·sig(a1,e))/(2a2-1) (6);
其中:
sig(h,x)=((abs(x))h)·sign(x);
a1、a2、k2均为设计参数,a2>a1>1,Z2表示观测器输出的观测值。符号函数sign(·)可替换为正弦过渡函数、双曲正切函数等,通过添加边界层方式降低抖振和超调。
所采用的控制律形式为:
u=-inv(B)·(k1·a1·G·(phi/k1+x2)+a·sig(r1,S)+b·sig(r2,S)+Z3) (7);
其中:
r1>1、r2<1分别代表高幂次项和低幂次项,a、b也为设计参数,a、b越大控制响应越快。
为获取更加优良的控制效果并保证控制方案的工程可实践性,考虑引入如下预处理步骤:
(1)对外部输入的信号指令进行判断,当本周期信号指令与上一周期信号指令差值大于ζ1时,认定信号指令出现阶跃,此时对阶跃信号进行斜坡处理,保证信号变化斜率小于ζ2(ζ1和ζ2具体数值视舵机工作频率范围以及控制量阈值而定);
(2)为避免可能存在的因信号快速变化等情况引起的控制量突变,对控制***输出的控制量指令进行硬饱和处理,即仅允许控制量幅值在一定阈值内变化(阈值大小设定视舵机实际工作特性而定)。
以参考输入为原始正弦调试信号为例,其仿真结果如图3-图6所示。由仿真结果可以看出,原始正弦调试信号下控制***实现了快速高精度的性能跟踪;角速度观测误差小,充分显示了观测器的良好特性。仿真结果表明,本发明所设计的基于参考模型和状态观测器的三阶舵机控制器对原始正弦信号、变频调试信号以及高频调试信号均具有良好的跟踪效果。
Claims (3)
1.一种基于参考模型和扰动精确观测补偿的三阶舵机控制方法,其特征在于所述方法包括如下步骤:
步骤一、设计三阶舵机控制器:
所述三阶舵机控制器采用内外环结构,内环由扩张状态观测器、非线性滑模控制器、三阶舵机模型三部分组成,外环包括参考模型、PD角度控制器;
步骤二、建立三阶舵机模型
从控制输入u到舵偏角θ的三阶舵机模型如下:
步骤三、选择参考模型
选择参考模型的形式如下:
步骤四、选择外环控制律
外环为角度控制环,控制律采用PD控制律:
式中:Kp为比例控制系数,Kd为微分控制系数,θc为期望角度;
步骤五、建立内环二阶控制模型
令角速度跟踪误差为e=θc-θ,那么内环二阶控制模型为:
步骤六、建立二阶扩张状态观测器并设计状态观测器参数
针对内环二阶控制模型,建立如下形式二阶扩张状态观测器:
步骤七、设计非线性滑模控制律
内环控制律采用非线性滑模控制律,依次进行滑模面设计和滑模控制律设计,其中:
所采用的滑模面为:
S=sig(a1,e)+k2·a2·sig(2-1/a2,Z2+k1·sig(a1,e))/(2a2-1);
式中:sig(h,x)=((abs(x))h)·sign(x),a1、a2、k2均为设计参数,Z2表示观测器输出的观测值;
所采用的控制律形式为:
u=-inv(B)·(k1·a1·G·(phi/k1+x2)+a·sig(r1,S)+b·sig(r2,S)+Z3);
式中:
r1>1、r2<1分别代表高幂次项和低幂次项,a、b为设计参数;
步骤八、设计信号预处理策略
(1)对外部输入的信号指令进行判断,当本周期信号指令与上一周期信号指令差值大于ζ1时,认定信号指令出现阶跃,此时对阶跃信号进行斜坡处理,保证信号变化斜率小于ζ2;
(2)对控制量指令进行硬饱和处理,即仅允许控制量幅值在一定阈值内变化;
步骤九、三阶舵机控制
(1)根据步骤八设计的信号预处理策略,对外部输入信号进行信号预处理;
(4)将实时角度误差信号e输入状态观测器,实现对状态量偏差以及对机械间隙、摩擦、温度变化振动引起的扰动的精确观测;
(6)每个控制周期重复(1)到(5),以实现对期望舵偏指令信号的跟踪。
2.根据权利要求1所述的基于参考模型和扰动精确观测补偿的三阶舵机控制方法,其特征在于所述步骤七中,符号函数sign(·)替换为正弦过渡函数或双曲正切函数。
3.根据权利要求1所述的基于参考模型和扰动精确观测补偿的三阶舵机控制方法,其特征在于所述步骤七中,a2>a1>1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010080596.6A CN111273548B (zh) | 2020-02-05 | 2020-02-05 | 基于参考模型和扰动精确观测补偿的三阶舵机控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010080596.6A CN111273548B (zh) | 2020-02-05 | 2020-02-05 | 基于参考模型和扰动精确观测补偿的三阶舵机控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111273548A true CN111273548A (zh) | 2020-06-12 |
CN111273548B CN111273548B (zh) | 2022-05-03 |
Family
ID=70997810
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010080596.6A Active CN111273548B (zh) | 2020-02-05 | 2020-02-05 | 基于参考模型和扰动精确观测补偿的三阶舵机控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111273548B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113848730A (zh) * | 2021-10-22 | 2021-12-28 | 北京航空航天大学 | 一种基于内模原理和自适应时变带宽观测器的三轴惯性稳定平台高精度控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130038266A1 (en) * | 2011-08-10 | 2013-02-14 | Samsung Electronics Co., Ltd. | Apparatus and method for controlling actuator |
CN107315350A (zh) * | 2017-08-10 | 2017-11-03 | 中国矿业大学 | 一种电静液作动***双闭环模型参考自适应控制方法 |
CN108363305A (zh) * | 2018-03-14 | 2018-08-03 | 中国人民解放军国防科技大学 | 基于主动干扰补偿的战术导弹鲁棒过载自驾仪设计方法 |
CN109460043A (zh) * | 2018-12-29 | 2019-03-12 | 上海海事大学 | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 |
CN110081046A (zh) * | 2019-05-27 | 2019-08-02 | 电子科技大学 | 一种基于反步控制的多电液伺服执行器跟踪同步控制方法 |
-
2020
- 2020-02-05 CN CN202010080596.6A patent/CN111273548B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130038266A1 (en) * | 2011-08-10 | 2013-02-14 | Samsung Electronics Co., Ltd. | Apparatus and method for controlling actuator |
CN107315350A (zh) * | 2017-08-10 | 2017-11-03 | 中国矿业大学 | 一种电静液作动***双闭环模型参考自适应控制方法 |
CN108363305A (zh) * | 2018-03-14 | 2018-08-03 | 中国人民解放军国防科技大学 | 基于主动干扰补偿的战术导弹鲁棒过载自驾仪设计方法 |
CN109460043A (zh) * | 2018-12-29 | 2019-03-12 | 上海海事大学 | 一种基于多模态非奇异终端滑模船舶航迹自抗扰控制方法 |
CN110081046A (zh) * | 2019-05-27 | 2019-08-02 | 电子科技大学 | 一种基于反步控制的多电液伺服执行器跟踪同步控制方法 |
Non-Patent Citations (2)
Title |
---|
HAO LI.ETC: "A New Modeling Reference Direct Adaptive Sliding Mode Control", 《JOINT 48TH IEEE CONFERENCE ON DECISION AND CONTROL AND》 * |
汤青波等: "电液伺服***的模型参考滑模自适应控制", 《机床与液压》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113848730A (zh) * | 2021-10-22 | 2021-12-28 | 北京航空航天大学 | 一种基于内模原理和自适应时变带宽观测器的三轴惯性稳定平台高精度控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111273548B (zh) | 2022-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104111607B (zh) | 一种考虑输入时滞的电机位置伺服***的控制方法 | |
Huang et al. | Intelligent friction modeling and compensation using neural network approximations | |
Mao et al. | Design and implementation of continuous finite-time sliding mode control for 2-DOF inertially stabilized platform subject to multiple disturbances | |
CN108228975B (zh) | 电机伺服***参数辨识方法以及消隙控制方法 | |
CN107121932B (zh) | 电机伺服***误差符号积分鲁棒自适应控制方法 | |
CN104242769A (zh) | 基于连续终端滑模技术的永磁同步电机速度复合控制方法 | |
CN103577244B (zh) | 负载模拟器的速度同步控制方法和*** | |
CN109426150B (zh) | 基于扩张状态观测器的负载模拟器反步控制方法 | |
Chwa et al. | Observer-based adaptive guidance law considering target uncertainties and control loop dynamics | |
CN107577146B (zh) | 基于摩擦整体逼近的伺服***的神经网络自适应控制方法 | |
CN110401391B (zh) | 异步电动机随机***模糊自适应动态面控制方法 | |
CN113238567B (zh) | 一种基于扩展状态观测器的底栖式auv弱抖振积分滑模点镇定控制方法 | |
CN113110511B (zh) | 一种基于广义模糊双曲模型的智能船舶航向控制方法 | |
CN109240092B (zh) | 基于多智能体可重构模块化柔性机械臂轨迹跟踪控制方法 | |
CN112769364B (zh) | 一种直流电机伺服***的快速自适应抗扰控制方法 | |
CN115202216A (zh) | 考虑输入约束的机械臂抗干扰有限时间控制方法 | |
CN112363524A (zh) | 一种基于自适应增益扰动补偿的再入飞行器姿态控制方法 | |
CN111273548B (zh) | 基于参考模型和扰动精确观测补偿的三阶舵机控制方法 | |
CN110842911B (zh) | 考虑关节电机特性的柔性机械臂联合建模和滑模控制方法 | |
CN113377006B (zh) | 一种基于不变流形观测器的全局快速终端滑模控制方法 | |
CN110908389A (zh) | 一种针对不确定水下机器人的自适应快速速度跟踪控制方法 | |
CN110888320B (zh) | 基于双电动缸同步运动误差建模的自适应鲁棒控制方法 | |
CN115309058B (zh) | 一种动力定位船的有限时间复合学习控制方法 | |
CN110647111A (zh) | 考虑输出离散性的电液伺服***非线性自抗扰控制方法 | |
CN112904719B (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 | ||
CB03 | Change of inventor or designer information | ||
CB03 | Change of inventor or designer information |
Inventor after: Wei Changzhu Inventor after: Liu Zhe Inventor after: Cui Naigang Inventor after: Sun Liwei Inventor after: Xu Hechuan Inventor before: Wei Changzhu Inventor before: Li Yuan Inventor before: Cui Naigang Inventor before: Sun Liwei Inventor before: Xu Hechuan |
|
GR01 | Patent grant | ||
GR01 | Patent grant |