CN107065549A - 一种基于非线性变结构的电动舵机设计方法 - Google Patents
一种基于非线性变结构的电动舵机设计方法 Download PDFInfo
- Publication number
- CN107065549A CN107065549A CN201710242951.3A CN201710242951A CN107065549A CN 107065549 A CN107065549 A CN 107065549A CN 201710242951 A CN201710242951 A CN 201710242951A CN 107065549 A CN107065549 A CN 107065549A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msup
- mfrac
- nonlinear
- 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
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)
- Steering Control In Accordance With Driving Conditions (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于非线性变结构的电动舵机设计方法,首先测量舵机角位置信号与角速度信号,构造误差信号与误差微分信号,设计非线性滑模面的第一项,构造非线性终端函数项,组成非线性滑模面的第二项,构造类柔化函数项,组成非线性滑模面的第三项,构造非线性滑模面的第四项,最终组成非线性变结构控制的滑模面,设计舵机非线性变结构控制律,对电动舵机的建模;通过不断调整控制参数,使得整个电动舵机系统具有满意的快速性。本发明的有益效果是提高了电动舵机的反应速度,从而特别适合应用于高超声速飞行器等快速运动体控制的执行机构。
Description
技术领域
本发明属于高超声速飞行器控制领域,涉及一种基于非线性变结构的电动舵机设计方法。
背景技术
随着飞行器速度的增加,尤其是高超声速飞行器控制技术的发展,其对执行机构快速性的要求越来越高。电动舵机是其中应有非常广泛的一类执行机构,其快速性的好坏决定着整个高超声速控制系统的品质。传统的PID控制器很早就被应用于电动舵机系统的设计,其由于采用线性控制技术而具有成熟可靠的优点,因此广受工程欢迎。但其设计在快速性上也过于保守,因此在近年来不断有研究者尝试采用非线性控制的手段,进行一些快速反应舵机的设计。本文通过引入非线性滑模面,设计了一类新颖的快速反应电动舵机,其不仅在理论上具有很强的新颖性,同时在工程上也具有很好的实用性。
发明内容
本发明的目的在于提供一种基于非线性变结构的电动舵机设计方法,解决了传统的线性PID控制器在快速响应性上已经不适合应用于高超声速飞行器等快速运动体控制执行机构的问题。
本发明所采用的技术方案是按照以下步骤进行:
步骤一:测量舵机角位置信号与角速度信号,其中角位置信号记为y,角速度信号记为
步骤二:构造误差信号e与误差微分信号其中,e=r-y,r为舵机输入指令信号;
步骤三:非线性滑模面的构造;设计非线性滑模面的第一项:s1=c1e,其中c1为正的参数;
构造非线性终端函数项,组成非线性滑模面的第二项:s2=c2e1/3,其中c2为正的参数;
构造类柔化函数项,组成非线性滑模面的第三项:,其中c3为正的参数;
构造非线性滑模面的第四项:
根据上述四项,组成非线性变结构控制的滑模面s:s=s1+s2+s3+s4;
步骤四:电动舵机非线性变结构控制律的设计;设计舵机非线性变结构控制律:u=ueq+u1+u2
其中ueq为等效函数项,其设计如下:
其中T为舵机模型中的惯性时间常数;
u1为大增益滑模面项:u1=Tkas,ka为正的控制系数;
u2为类柔化函数滑模项:kb为正的控制系数;
步骤五:电动舵机的建模;采用如下微分方程建模:
ya为舵机的转动角速度;
步骤六:将步骤一至步骤四所得的控制律,代入步骤五所建立的电动舵机模型,通过不断调整控制参数,使得整个电动舵机系统具有满意的快速性。
进一步,按照权利要求1所述一种基于非线性变结构的电动舵机设计方法,其特征在于:所述步骤三中c1在[0,100]间;c2在[0,10]间;c3在[0,100]间。
进一步,所述步骤四中,ka在[0,50]之间,kb在[0,50]之间。
本发明的有益效果是提高了电动舵机的反应速度,从而特别适合应用于高超声速飞行器等快速运动体控制的执行机构。
附图说明
图1是一种基于非线性变结构控制的电动舵机设计方法原理框图;
图2是电动舵机简化系统模型结构图;
图3是本发明实施例提供的5度指令跟踪情况下的舵机20ms响应角度曲线与指令比较图;
图4是本发明实施例提供的5度指令跟踪情况下的舵机20ms响应控制律曲线;
图5是本发明实施例提供的5度指令跟踪情况下的舵机10ms响应角度曲线与指令比较图;
图6是本发明实施例提供的5度指令跟踪情况下的舵机10ms响应控制律曲线。
具体实施方式
下面结合具体实施方式对本发明进行详细说明。
本发明通过测量舵机的角位置信号进行反馈,与输入舵机指令进行比较,形成误差信号;并通过设计误差信号的非线性终端增益项以及类柔化函数项,在通过测量舵机转动的角速度信号形成误差的微分项;然后通过上述误差信号、误差非线性终端增益项以误差类柔化函数项与误差微分项四类信号进行综合而形成变结构控制中的滑模面信号,再由滑模面信号设计大增益滑模面项与类柔化函数滑模项以及等效函数项,再由上述大增益滑模项、类柔化函数滑模项与等效函数项组成最终的电动舵机控制规律,以实现对输入舵机指令进行跟踪。其步骤如下:
步骤一:舵机角位置与角速度的测量;采用电位计与角速度传感器,分别测量舵机的角位置信号与角速度信号,其中角位置信号记为y,角速度信号记为
步骤二:构造误差信号与误差微分信号;
利用上一步得到的角位置信号y与舵机输入指令信号r进行反馈比较,得到误差信号,记为e,其满足如下关系e=r-y;利用上一步测量的角速度信号直接构成误差微分信号即进行上述误差微分信号的构造设计的原因在于当输入指令信号为常值时,有r的微分等于0,此时而当输入指令信号为非常值时,考虑到舵系统的快速性要强于指令的快变特性,因此输入指令可视为慢变信号,此时角速度信号与误差微分信号两者近似相等,即故在此我们直接用舵机转动角速度信号构造误差微分信号。
步骤三:非线性滑模面的构造;首先根据上述误差项,设计非线性滑模面的第一项如下,记为s1=c1e,其中c1为正的参数,可在[0,100]间挑选合适的值,控制舵机系统的反应速度。再利用上述误差信号构造非线性终端函数项,组成非线性滑模面的第二项,其满足如下数学表达式:
s2=c2e1/3,其中c2为正的参数,可在[0,10]间挑选合适的值,控制舵机系统的反应速度。其次利用误差信号构造类柔化函数项,组成非线性滑模面的第三项,其满足如下数学表达式:
其中c3为正的参数,可在[0,100]间挑选合适的值,控制舵机系统的反应速度,同时由于该项具有柔化函数的类似功能,可减小振荡。
然后利用误差微分项,构造非线性滑模面的第四项如下:
该项的加入主要是引入微分之后,能够增大系统的阻尼,从而也能大大减小系统的振荡。最后根据上述四项,组成非线性变结构控制的滑模面s如下:s=s1+s2+s3+s4;
步骤四:电动舵机非线性变结构控制律的设计;根据上述滑模面信息s,设计如下的舵机非线性变结构控制律:
u=ueq+u1+u2,其中ueq为等效函数项,其设计如下
其中T为舵机模型中的惯性时间常数。而舵机模型见图1原理框图。
而u1为大增益滑模面项,其设计如下:
u1=Tkas,ka为正的控制系数,可在[0,50]之间选取。
而u2为类柔化函数滑模项,其设计如下:
kb为正的控制系数,可在[0,50]之间选取。
步骤五:电动舵机的建模;采用如下微分方程建模:
ya为舵机的转动角速度,整个舵机系统模型可用图2描述。控制目标是设计控制器使得舵系统的输出位置y信号跟踪期望信号r。
步骤六:将步骤一至步骤四所得的控制律,代入步骤五所建立的电动舵机模型,通过不断调整控制参数,并观察输出角位置曲线,从而确定最终电动舵机控制方案中的控制参数,使得整个电动舵机系统具有满意的快速性。
案例实施与计算机仿真模拟结果分析
选取舵机模型参数为T=0.05,按照上述所设计控制律进行仿真,选取输入角度指令为r=5/57.3,初始状态如下:y(0)=0,ya(0)=0,,选取控制参数如下:c1=150,c2=2,c3=50、ka=520、kb=570,将步骤四所得到的综合控制律代入模型五进行仿真,得到仿真结果图3至图4所示。图3中,横坐标为时间,单位s,纵坐标为舵机舵偏角,单位度。图4横坐标为时间,单位s,纵坐标为控制律,无量纲。
通过以上仿真结果与曲线图3与图4可以看出,可见响应曲线具有很好的快速性,上升时间大约在20ms左右,而且和舵系统的时间常数T=0.05相比,具有很大的改善。而控制律曲线也表明,整个响应过程比较平滑,没有超调和振荡,因此也满足工程应用需求。
同时也可以进一步提高舵机响应的快速性,我们设计控制参数如下:
c1=550,c2=5,c3=500、ka=520、kb=570
此时响应曲线如图5与图6所示,可见响应曲线的快速性上升到10ms左右。图5横坐标为时间,单位s,纵坐标为舵机舵偏角,单位度。图6横坐标为时间,单位s,纵坐标为控制律,无量纲。
从以上案例仿真结果可以看出,本发明提供的基于非线性变结构控制的电动舵机设计方法能够有效地提高其快速性,因此本发明具有很好的理论价值与实用价值,能够作为高速运动的飞行器的执行机构而应用于工程之中。
本发明方法的特点是通过测量舵机的角位置信号进行反馈,与输入舵机指令进行比较,形成误差信号;并通过设计误差信号的非线性终端增益项以及类柔化函数项,再通过测量舵机转动的角速度信号形成误差的微分项;然后通过上述误差信号、误差非线性终端增益项以误差类柔化函数项与误差微分项四类信号进行综合而形成变结构控制中的滑模面信号,再由滑模面信号设计大增益滑模面项与类柔化函数滑模项以及等效函数项,再由上述大增益滑模项、类柔化函数滑模项与等效函数项组成最终的电动舵机控制规律,以实现对输入舵机指令进行跟踪。本发明与传统的PID反馈控制组成的舵机设计方法的不同之处是由于引入了大量的非线性函数,如类柔化函数与非线性终端函数,从而提高了电动舵机的反应速度,从而特别适合应用于高超声速飞行器等快速运动体控制的执行机构。因此本发明方法不仅有较大的创新性,而且具有较大的理论价值和工程价值。
以上所述仅是对本发明的较佳实施方式而已,并非对本发明作任何形式上的限制,凡是依据本发明的技术实质对以上实施方式所做的任何简单修改,等同变化与修饰,均属于本发明技术方案的范围内。
Claims (3)
1.一种基于非线性变结构的电动舵机设计方法,其特征在于按照以下步骤进行:
步骤一:测量舵机角位置信号与角速度信号,其中角位置信号记为y,角速度信号记为
步骤二:构造误差信号e与误差微分信号其中,e=r-y,r为舵机输入指令信号;
步骤三:非线性滑模面的构造;
设计非线性滑模面的第一项:s1=c1e,其中c1为正的参数;
构造非线性终端函数项,组成非线性滑模面的第二项:s2=c2e1/3,其中c2为正的参数;
构造类柔化函数项,组成非线性滑模面的第三项:,其中c3为正的参数;
构造非线性滑模面的第四项:
根据上述四项,组成非线性变结构控制的滑模面s:s=s1+s2+s3+s4;
步骤四:电动舵机非线性变结构控制律的设计;
设计如下的舵机非线性变结构控制律:
u=ueq+u1+u2
其中ueq为等效函数项,其设计如下:
<mrow>
<msub>
<mi>u</mi>
<mrow>
<mi>e</mi>
<mi>q</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>T</mi>
<mo>&lsqb;</mo>
<mo>-</mo>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mo>(</mo>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>2</mn>
</msub>
<mfrac>
<mn>1</mn>
<mn>3</mn>
</mfrac>
<msup>
<mi>e</mi>
<mrow>
<mo>-</mo>
<mn>2</mn>
<mo>/</mo>
<mn>3</mn>
</mrow>
</msup>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>3</mn>
</msub>
<mfrac>
<mrow>
<mo>(</mo>
<msup>
<mi>e</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>e</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mfrac>
<mo>-</mo>
<msub>
<mi>c</mi>
<mn>3</mn>
</msub>
<mfrac>
<mrow>
<mn>2</mn>
<mi>e</mi>
<mi>e</mi>
</mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>e</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mfrac>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mi>T</mi>
</mfrac>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>&rsqb;</mo>
</mrow>
其中T为舵机模型中的惯性时间常数;
u1为大增益滑模面项:u1=Tkas,ka为正的控制系数;
u2为类柔化函数滑模项:kb为正的控制系数;
步骤五:电动舵机的建模;采用如下微分方程建模:
<mrow>
<msub>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>a</mi>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mi>T</mi>
</mfrac>
<msub>
<mi>y</mi>
<mi>a</mi>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mi>T</mi>
</mfrac>
<mi>u</mi>
</mrow>
<mrow>
<mover>
<mi>y</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msub>
<mi>y</mi>
<mi>a</mi>
</msub>
</mrow>
ya为舵机的转动角速度;
步骤六:将步骤一至步骤四所得的控制律,代入步骤五所建立的电动舵机模型,通过不断调整控制参数,使得整个电动舵机系统具有满意的快速性。
2.按照权利要求1所述一种基于非线性变结构的电动舵机设计方法,其特征在于:所述步骤三中c1在[0,100]间;c2在[0,10]间;c3在[0,100]间。
3.按照权利要求1所述一种基于非线性变结构的电动舵机设计方法,其特征在于:所述步骤四中,ka在[0,50]之间,kb在[0,50]之间。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710242951.3A CN107065549B (zh) | 2017-04-14 | 2017-04-14 | 一种基于非线性变结构的电动舵机设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710242951.3A CN107065549B (zh) | 2017-04-14 | 2017-04-14 | 一种基于非线性变结构的电动舵机设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107065549A true CN107065549A (zh) | 2017-08-18 |
CN107065549B CN107065549B (zh) | 2020-04-28 |
Family
ID=59600681
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710242951.3A Active CN107065549B (zh) | 2017-04-14 | 2017-04-14 | 一种基于非线性变结构的电动舵机设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107065549B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108803357A (zh) * | 2018-09-03 | 2018-11-13 | 中国科学院长春光学精密机械与物理研究所 | 一种pid和改进滑模的电动舵机混合控制方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3866212B2 (ja) * | 2002-12-26 | 2007-01-10 | 本田技研工業株式会社 | アクチュエータの制御装置 |
CN103994698A (zh) * | 2014-05-23 | 2014-08-20 | 中国人民解放军海军航空工程学院 | 基于过载与角速度测量的导弹俯仰通道简单滑模控制方法 |
CN104698835A (zh) * | 2015-02-10 | 2015-06-10 | 中国航天科技集团公司第九研究院第七七一研究所 | 一种电动舵机的变结构控制系统及方法 |
CN105676852A (zh) * | 2016-01-13 | 2016-06-15 | 天津大学 | 小型无人直升机无动力学模型结构自适应姿态控制方法 |
CN106406333A (zh) * | 2016-12-05 | 2017-02-15 | 烟台南山学院 | 一种基于积分型终端滑模的平流层飞艇俯仰角跟踪方法 |
-
2017
- 2017-04-14 CN CN201710242951.3A patent/CN107065549B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3866212B2 (ja) * | 2002-12-26 | 2007-01-10 | 本田技研工業株式会社 | アクチュエータの制御装置 |
CN103994698A (zh) * | 2014-05-23 | 2014-08-20 | 中国人民解放军海军航空工程学院 | 基于过载与角速度测量的导弹俯仰通道简单滑模控制方法 |
CN104698835A (zh) * | 2015-02-10 | 2015-06-10 | 中国航天科技集团公司第九研究院第七七一研究所 | 一种电动舵机的变结构控制系统及方法 |
CN105676852A (zh) * | 2016-01-13 | 2016-06-15 | 天津大学 | 小型无人直升机无动力学模型结构自适应姿态控制方法 |
CN106406333A (zh) * | 2016-12-05 | 2017-02-15 | 烟台南山学院 | 一种基于积分型终端滑模的平流层飞艇俯仰角跟踪方法 |
Non-Patent Citations (5)
Title |
---|
LEI JUNWEI: "Research on a kind of sliding mode lane keeping control for automated vehicles based on hybrid information of position and angular velocity", 《OPTIK》 * |
周满: "电动舵机变结构控制律研究", 《CNKI中国优秀硕士学位论文全文数据库(电子期刊)工程科技II辑》 * |
彭书华 等: "不确定参数电动舵机滑模变结构控制", 《电机与控制与学报》 * |
杨丽曼 等: "仿射非线性系统的二阶滑模控制律研究", 《北京航空航天大学学报》 * |
杨海容: "基于变结构控制的电动舵机设计", 《万方学位论文数据库》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108803357A (zh) * | 2018-09-03 | 2018-11-13 | 中国科学院长春光学精密机械与物理研究所 | 一种pid和改进滑模的电动舵机混合控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN107065549B (zh) | 2020-04-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103994698B (zh) | 基于过载与角速度测量的导弹俯仰通道简单滑模控制方法 | |
CN103116275B (zh) | 基于滑模补偿的微陀螺仪鲁棒神经网络控制系统及方法 | |
CN108008720A (zh) | 一种轮式移动机器人的模糊滑模轨迹跟踪控制及方法 | |
CN102591212B (zh) | 一种时变测量延迟输出信号飞行器纵向运动状态观测方法 | |
CN102540882B (zh) | 一种基于最小参数学习法的飞行器航迹倾角控制方法 | |
CN103324087B (zh) | 基于神经网络的微陀螺仪的自适应反演控制系统及方法 | |
CN102654772B (zh) | 一种基于控制力受限情况下飞行器航迹倾角反演控制方法 | |
CN107132761A (zh) | 一种采用纯模糊与模糊pid复合控制的电动舵机设计方法 | |
CN107272719B (zh) | 基于协调因子的高超声速飞行器姿态运动协调控制方法 | |
CN105353789B (zh) | 连续振动信号时间历程复现控制方法 | |
CN108572548A (zh) | 一种扰动感知控制方法 | |
CN104267596B (zh) | 一种小车倒立摆系统的有限时间解耦控制方法 | |
CN102707624A (zh) | 基于飞行器常规模型的纵向控制器区域设计方法 | |
CN110162933A (zh) | 一种共轴多旋翼仿真方法及系统 | |
CN107065544A (zh) | 基于攻角幂函数的高超飞行器神经网络控制方法 | |
CN107505841A (zh) | 一种基于干扰估计器的机械臂姿态鲁棒控制方法 | |
CN107457783A (zh) | 基于pd控制器的六自由度机械臂自适应智能检测方法 | |
CN106446424A (zh) | 一种非定常气动力模型参数预测方法 | |
CN103838141B (zh) | 一种面向控制的大型天线建模方法 | |
CN107414827A (zh) | 基于线性反馈控制器的六自由度机械臂自适应检测方法 | |
CN108762083A (zh) | 一种基于加速度观测器的自动控制系统 | |
CN105278331A (zh) | 一种微陀螺的鲁棒自适应神经网络h无穷控制方法 | |
CN102566446B (zh) | 基于线性模型组的无人直升机全包线数学模型构建方法 | |
CN104007660B (zh) | 一种基于反演设计的伺服系统的抗饱和控制方法 | |
CN107065549A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |