CN112947539B - 一种补偿直线驱动器引起的舵面非线性的方法 - Google Patents
一种补偿直线驱动器引起的舵面非线性的方法 Download PDFInfo
- Publication number
- CN112947539B CN112947539B CN202011491273.2A CN202011491273A CN112947539B CN 112947539 B CN112947539 B CN 112947539B CN 202011491273 A CN202011491273 A CN 202011491273A CN 112947539 B CN112947539 B CN 112947539B
- Authority
- CN
- China
- Prior art keywords
- control surface
- displacement
- angle
- command
- driver
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 238000006073 displacement reaction Methods 0.000 claims abstract description 57
- 238000004364 calculation method Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本申请提供了一种补偿直线驱动器引起的舵面非线性的方法,包括:确定舵面的偏转角度,将所述偏转角度平均分成多份,确定每个角度所对应的驱动器位移;构建所述驱动器位移与对应截距的关系式,从而确定所述截距;根据所述截距构建舵面指令角度与直线驱动器指令位移的关系式;根据接收到的舵面指令角度判断舵面角度所处的偏转角度区间,从而确定舵面角度所对应的当前份,根据当前份及舵面指令角度与直线驱动器指令位移的关系式确定指令位移,使直线驱动器的驱动位移为所述指令位移。本申请所提供的方法可以在不降低运算速度的情况下,通过插值算法,补偿直线驱动器驱动舵面偏转引起的非线性,提高舵面偏度的控制精度。
Description
技术领域
本申请属于飞机伺服***控制技术领域,特别涉及一种补偿直线驱动器引起的舵面非线性的方法。
背景技术
伺服作动***是飞机上控制舵面偏转角度的***,通过伺服作动***能够实现控制飞机的飞行方向,完成俯仰、滚转、偏航等飞行动作。伺服作动***一般采用直线驱动器或直线电机驱动舵面偏转,通过摆杆、摇臂及铰接点将直线位移转化为角位移,如图1所示。
在伺服作动***设计时,认为直线驱动器的总行程与舵面偏转角度的总行程对应即可,设系数k为直线驱动器的总行程除以舵面偏转角度的总行程。在使用时,伺服作动***在接收到舵面指令后,将舵面指令乘系数k后输出成位移指令,驱动舵面偏转。但由于摆杆的轴线与作动筒的轴线不平行,且两条轴线的夹角不断变化,因此直线驱动器的位移与舵面偏转角度的对应关系是非线性的,这种非线性因素会影响舵面除极限位置外的控制精度。
发明内容
本申请的目的是提供了一种补偿直线驱动器引起的舵面非线性的方法,以解决或减轻背景技术中的至少一个问题。
本申请的技术方案是:一种补偿直线驱动器引起的舵面非线性的方法,包括:
确定舵面的偏转角度,将所述偏转角度平均分成多份,确定每个角度所对应的驱动器位移;
构建所述驱动器位移与对应截距的关系式,从而确定所述截距;
根据所述截距构建舵面指令角度与直线驱动器指令位移的关系式;
根据接收到的舵面指令角度判断舵面角度所处的偏转角度区间,从而确定舵面角度所对应的当前份,根据当前份及舵面指令角度与直线驱动器指令位移的关系式确定指令位移,使直线驱动器的驱动位移为所述指令位移。
进一步的,舵面偏转角度平均分的份数根据控制精度确定。
进一步的,所述份数不少于10份。
进一步的,每个角度所对应的驱动器位移值根据直线驱动器位移与舵面偏转轨迹的几何关系确定。
进一步的,所述驱动器位移值与对应截距的关系式包括:
xi=k(i/n)θm+yi,i=0,1,2,...,n-1,n;
xi+1=k((i+1)/n)θm+yi+1,i=0,1,2,...,n-1,n;
令yiθ=(yi+yi+1)/2,i=0,1,2,...,n-1,n;
式中,n为份数,角标i表示当前份,xi和xi+1分别为当前i份和当前i+1份所对应的驱动器位移值,θm为偏转角度总行程,yi和yi+1分别为当前i份和当前i+1份所对应的区间终点截距,yiθ为当前i份所对应的截距,k为偏转角度与驱动器位移的比例系数。
进一步的,所述舵面指令角度与直线驱动器指令位移的关系式为:
x=k·θ+yiθ,i=0,1,2,...,n-1,n;
式中,x为直线驱动器指令位移,θ为舵面指令角度。
本申请所提供的方法可以在不降低运算速度的情况下,通过插值算法,补偿直线驱动器驱动舵面偏转引起的非线性,提高舵面偏度的控制精度。
附图说明
为了更清楚地说明本申请提供的技术方案,下面将对附图作简单地介绍。显而易见地,下面描述的附图仅仅是本申请的一些实施例。
图1为本申请中的直线驱动器驱动舵面偏转示意图。
具体实施方式
为使本申请实施的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行更加详细的描述。
为了克服现有技术所具有的问题,本申请提供了一种补偿直线驱动器引起的舵面偏度非线性的方法,用于提高采用直线驱动器的舵面偏度控制精度。
本申请所提供的补偿直线驱动器引起的舵面偏度非线性的方法通过将全行程分为几段,采用差值的方式得出不同段的近似线性方程。
本申请的方法具体包括如下过程:
如图1所示,首先确定舵面判偏转角度的总行程θm,将舵面角位移总行程θm平均分为n份,每份的偏转角度即为0,(1/n)θm,(2/n)θm,...,((n-1)/n)θm,θm,计算与各偏转角度对应的驱动器位移值x1,x2,...,xn-1,xn,其中,驱动器位移值可根据图1所示的直线驱动器与偏转角度的几何关系确定。
在本申请中,舵面偏转角度平均分的份数根据控制精度确定,为了保证精度,份数通常不低于10份。
构建驱动器位移值与截距的关系式:
xi=k(i/n)θm+yi,i=0,1,2,...,n-1,n (1)
xi+1=k((i+1)/n)θm+yi+1,i=0,1,2,...,n-1,n (2)
令yiθ=(yi+yi+1)/2,i=0,1,2,...,n-1,n (3)
式中,n为份数,角标i表示当前份,xi和xi+1分别为当前i份和当前i+1份所对应的驱动器位移值,θm为偏转角度总行程,yi和yi+1分别为当前i份和当前i+1份所对应的区间终点截距,yiθ为当前i份所对应的截距,k为偏转角度与驱动器位移的比例系数。
通过上式可计算得到截距yiθ的值。
之后,构建舵面指令角度与直线驱动器指令位移的关系式,有:
x=k·θ+yiθ,i=0,1,2,...,n-1,n (4)
在伺服作动***接收到舵面指令角度θ后,首先判断舵面指令角度θ所处的偏转区间,将θ/(θm/n)向下取整后计算得到当前份i的值。i值确定后,通过已确定的截距yiθ值,计算指令位移x的结果并作为位移指令输入。
下面结合本申请实施例中的具体数值对本申请作进一步说明。
假设舵面偏转角度的最大行程θm为60°,直线驱动器的最大位移为60mm,则系数k=1。将偏转角度最大行程平均分为10份,即n=10。根据几何关系计算各角度对应的位移值xi,以及上述公式1-3,计算得到截距yi和yiθ,计算结果详见表1。
表1计算结果表
i | θi | xi | yi | yiθ |
0 | 0 | 0 | 0 | 0.2966 |
1 | 6 | 5.4068 | -0.5932 | 0.7073 |
2 | 12 | 11.1785 | -0.8215 | 0.8056 |
3 | 18 | 17.2103 | -0.7897 | 0.6922 |
4 | 24 | 23.4052 | -0.5948 | 0.4592 |
5 | 30 | 29.6764 | -0.3236 | 0.1875 |
6 | 36 | 35.9486 | -0.0514 | -0.0542 |
7 | 42 | 42.1597 | 0.1597 | -0.2101 |
8 | 48 | 48.2605 | 0.2605 | -0.2379 |
9 | 54 | 54.2152 | 0.2152 | -0.1076 |
10 | 60 | 60 | 0 | - |
根据上述公式4得到指令位移x与偏转区间的计算表,详见表2。
表2指令位移x计算表
指令角度θ取值 | 指令位移x计算公式 |
当0≤θ<6 | x=θ-0.2966 |
当6≤θ<12 | x=θ-0.7073 |
当12≤θ<18 | x=θ-0.8056 |
当18≤θ<24 | x=θ-0.6922 |
当24≤θ<30 | x=θ-0.4592 |
当30≤θ<36 | x=θ-0.1875 |
当36≤θ<42 | x=θ+0.0542 |
当42≤θ<48 | x=θ+0.2101 |
当48≤θ<54 | x=θ+0.2379 |
当54≤θ<60 | x=θ+0.1076 |
60 | x=θ |
例如,当输入的指令角位移为5°时,指令位移x=5-0.2966=4.7034mm,则将位移指令4.7034输入到伺服作动***中,控制舵面动作。
根据几何关系可计算得舵面偏转角度为5°时,对应的直线驱动器线性位移指令为4.4774,而采用本申请的方法后,理论控制精度为1-(4.7034-4.4774)/4.4774=95.0%,而采用本申请的方法前的控制精度为1-(54-4.4774)/4.4774=88.3%。由此可见,采用本申请的方法可以显著提高控制精度,补偿直线驱动器驱动舵面偏转引起的非线性。
本申请所提供的方法可以在不降低运算速度的情况下,通过插值算法,补偿直线驱动器驱动舵面偏转引起的非线性,提高舵面偏度的控制精度。
以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以所述权利要求的保护范围为准。
Claims (6)
1.一种补偿直线驱动器引起的舵面非线性的方法,其特征在于,包括:
确定舵面的偏转角度,将所述偏转角度平均分成多份,确定每个角度所对应的驱动器位移;
构建所述驱动器位移与对应截距的关系式,从而确定所述截距;
根据所述截距构建舵面指令角度与直线驱动器指令位移的关系式;
根据接收到的舵面指令角度判断舵面角度所处的偏转角度区间,从而确定舵面角度所对应的当前份,根据当前份及舵面指令角度与直线驱动器指令位移的关系式确定指令位移,使直线驱动器的驱动位移为所述指令位移。
2.如权利要求1所述的补偿直线驱动器引起的舵面非线性的方法,其特征在于,舵面偏转角度平均分的份数根据控制精度确定。
3.如权利要求2所述的补偿直线驱动器引起的舵面非线性的方法,其特征在于,所述份数不少于10份。
4.权利要求1所述的补偿直线驱动器引起的舵面非线性的方法,其特征在于,每个角度所对应的驱动器位移值根据直线驱动器位移与舵面偏转轨迹的几何关系确定。
5.权利要求1所述的补偿直线驱动器引起的舵面非线性的方法,其特征在于,所述驱动器位移值与对应截距的关系式包括:
xi=k(i/n)θm+yi,i=0,1,2,...,n-1,n;
xi+1=k((i+1)/n)θm+yi+1,i=0,1,2,...,n-1,n;
令yiθ=(yi+yi+1)/2,i=0,1,2,...,n-1,n;
式中,n为份数,角标i表示当前份,xi和xi+1分别为当前i份和当前i+1份所对应的驱动器位移值,θm为偏转角度总行程,yi和yi+1分别为当前i份和当前i+1份所对应的区间终点截距,yiθ为当前i份所对应的截距,k为偏转角度与驱动器位移的比例系数。
6.权利要求5所述的补偿直线驱动器引起的舵面非线性的方法,其特征在于,所述舵面指令角度与直线驱动器指令位移的关系式为:
x=k·θ+yiθ,i=0,1,2,...,n-1,n;
式中,x为直线驱动器指令位移,θ为舵面指令角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011491273.2A CN112947539B (zh) | 2020-12-17 | 2020-12-17 | 一种补偿直线驱动器引起的舵面非线性的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011491273.2A CN112947539B (zh) | 2020-12-17 | 2020-12-17 | 一种补偿直线驱动器引起的舵面非线性的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112947539A CN112947539A (zh) | 2021-06-11 |
CN112947539B true CN112947539B (zh) | 2023-07-07 |
Family
ID=76234871
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011491273.2A Active CN112947539B (zh) | 2020-12-17 | 2020-12-17 | 一种补偿直线驱动器引起的舵面非线性的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112947539B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6246929B1 (en) * | 1999-06-16 | 2001-06-12 | Lockheed Martin Corporation | Enhanced stall and recovery control system |
CN104155987A (zh) * | 2014-08-11 | 2014-11-19 | 北京航天自动控制研究所 | 基于气动耦合特性的飞行器姿态补偿控制方法和装置 |
CN105467833A (zh) * | 2015-12-07 | 2016-04-06 | 南京航空航天大学 | 一种非线性自适应飞行控制方法 |
CN106354009A (zh) * | 2016-09-20 | 2017-01-25 | 江苏理工学院 | 一种飞翼飞行器舵机执行器组合控制分配方法 |
CN108082448A (zh) * | 2017-11-03 | 2018-05-29 | 中航通飞研究院有限公司 | 一种双腔液压助力器非线性补偿装置 |
CN109387176A (zh) * | 2017-08-02 | 2019-02-26 | 中国航空工业集团公司西安飞机设计研究所 | 一种飞机舵面角位移测量装置 |
CN110597071A (zh) * | 2019-10-17 | 2019-12-20 | 陕西师范大学 | 一种飞行器纵向过载控制的主动抗扰方法 |
CN111086626A (zh) * | 2019-12-27 | 2020-05-01 | 中国航空工业集团公司西安飞机设计研究所 | 提高飞机飞控***舵面控制精度的方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8567331B2 (en) * | 2008-12-11 | 2013-10-29 | University Of Wyoming | Rudder roll stabilization by nonlinear dynamic compensation |
FR3002334B1 (fr) * | 2013-02-19 | 2016-07-15 | Airbus Operations Sas | Procede et dispositif d'estimation d'un moment de tangage non desire d'un avion, et applications au controle du tangage de l'avion. |
US10969796B2 (en) * | 2017-12-22 | 2021-04-06 | Textron Innovation, Inc. | Autopilot nonlinear compensation |
-
2020
- 2020-12-17 CN CN202011491273.2A patent/CN112947539B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6246929B1 (en) * | 1999-06-16 | 2001-06-12 | Lockheed Martin Corporation | Enhanced stall and recovery control system |
CN104155987A (zh) * | 2014-08-11 | 2014-11-19 | 北京航天自动控制研究所 | 基于气动耦合特性的飞行器姿态补偿控制方法和装置 |
CN105467833A (zh) * | 2015-12-07 | 2016-04-06 | 南京航空航天大学 | 一种非线性自适应飞行控制方法 |
CN106354009A (zh) * | 2016-09-20 | 2017-01-25 | 江苏理工学院 | 一种飞翼飞行器舵机执行器组合控制分配方法 |
CN109387176A (zh) * | 2017-08-02 | 2019-02-26 | 中国航空工业集团公司西安飞机设计研究所 | 一种飞机舵面角位移测量装置 |
CN108082448A (zh) * | 2017-11-03 | 2018-05-29 | 中航通飞研究院有限公司 | 一种双腔液压助力器非线性补偿装置 |
CN110597071A (zh) * | 2019-10-17 | 2019-12-20 | 陕西师范大学 | 一种飞行器纵向过载控制的主动抗扰方法 |
CN111086626A (zh) * | 2019-12-27 | 2020-05-01 | 中国航空工业集团公司西安飞机设计研究所 | 提高飞机飞控***舵面控制精度的方法 |
Non-Patent Citations (3)
Title |
---|
Nonlinear Attitude Control of Tiltrotor Aircraft Based on Active Disturbance Rejection Sliding Mode Method;Zhen Pan 等;《IEEE Xplore》;第1351-1356页 * |
大型飞机飞控***舵面偏角检测非线性补偿技术研究;王贵 等;《航空科学技术》;第29卷(第04期);第57-59页 * |
飞行器控制分配技术研究现状与展望;马建军 等;《飞行力学》;第第27卷卷(第第3期期);第1-4页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112947539A (zh) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107415939B (zh) | 一种分布式驱动电动汽车转向稳定性控制方法 | |
CN111497826B (zh) | 一种电动汽车横摆稳定性协调控制方法及*** | |
CN106292287B (zh) | 一种基于自适应滑模控制的uuv路径跟踪方法 | |
WO2018188276A1 (zh) | 一种六自由度机器人末端空间曲线轨迹的误差建模方法 | |
CN111152225A (zh) | 存在输入饱和的不确定机械臂固定时间轨迹跟踪控制方法 | |
CN101927495B (zh) | 一种冗余度机械臂重复运动规划方法 | |
CN113601512B (zh) | 一种机械臂奇异点的通用规避方法与*** | |
CN108363301B (zh) | 基于干扰观测滑模变结构的轮廓误差交叉耦合控制方法 | |
WO2021248797A1 (zh) | 基于b样条曲线的路径规划方法、运动控制方法及*** | |
CN110217229B (zh) | 一种适用于高速极限工况的路径跟踪控制方法 | |
CN110244731B (zh) | 三节编组虚拟轨道列车主动循迹控制方法 | |
CN110568758A (zh) | 一种自动驾驶汽车的参数自适应横向运动lqr控制方法 | |
CN110217227B (zh) | 一种适用于冰雪道路工况的转向制动联合避撞控制方法 | |
CN111930072B (zh) | 一种双轴运动控制***的轨迹跟踪控制方法 | |
CN108381555B (zh) | 一种飞行作业机器人冗余度机械臂下位控制器的设计方法 | |
CN103231381A (zh) | 一种冗余度机械臂的新型加速度层重复运动规划方法 | |
CN111959527A (zh) | 一种基于转角优化序列的汽车路径跟踪控制方法 | |
CN110362110B (zh) | 一种固定时自适应神经网络无人机航迹角控制方法 | |
CN104647379A (zh) | 一种驱动器非线性条件下的双臂机器人运动控制方法 | |
CN113050653B (zh) | 一种处理状态不等式约束的线控转向***建模控制方法 | |
CN114906349B (zh) | 高机动飞机升降舵效率损失故障的自适应容错控制方法 | |
CN112947539B (zh) | 一种补偿直线驱动器引起的舵面非线性的方法 | |
CN111309002A (zh) | 一种基于矢量的轮式移动机器人避障方法及*** | |
CN113738390A (zh) | 一种矩形顶管机的分时迁移空间姿态微调纠偏方法 | |
CN106347361A (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 |