V01.32,No.6June,2007
火力与指挥控制
FireControlandCommandControl
第32卷第6期
2007年6月
文章编号:1002一0640(2007)06一0062一05
大圆航线导航与控制律设计
彭劲松秦永元
(西北工业大学自动化学院,陕西西安710072)
摘要:随着无人机(UAV)应用范围的扩大,要求无人机能精确跟踪预定航线。预定的飞行任务可以有两种规划方式,一是近似在当地切平面上的直线或曲线;二是飞行距离较长时在地球表面的大圆航线。第二种规划相对复杂,研究较少,因此,介绍了某型无人机的动力学模型,提出了一种全新的大圆航线导航解算算法,设计了大圆导航控制律,此外,还分析了常值风及突风干扰对导航的影响。经计算机仿真验证和部分的实际飞行试验结果表明:与预定航线的距离偏差较小,航迹精度较高,新算法及设计较好地满足了实际大圆航线飞行要求。
关键词:大圆航线,导航与控制,导航解算,控制律
中图分类号:TJ765文献标识码:A
DesignofNaVigationandControlLawforGreatCircleFlightPath
PENGJin—song,QINYong—yuan
((0zZPgPp厂A“£o优口£io起,ⅣDr施叫P盯P聊PD匆fFc^卵ifdz【,niu已"如y?Xi’彻710072。C^i超口)
Abstract:WithincreasingtheapplicationoftheUnmannedAirVehicles(UAV),theprecisiontrajectoryofUAViscritical.Twokindsofflightcoursescanbescheduled.Oneisstraightlineorcurveonthelocalplane.Theotheristhegreatcircleflightpathontheearthsurface.Thegreatcircleflightpathstudieslittkbecauseofcomplexcomparatively,so,inthispaper,thedynamicalmodelofanUAVispresented,thenaVigationalgorithmofgreatcircleflightpathisderivedindetail,andthelawofcontrolisdesigned.Inaddition,theeffectofnavigationunderthegustdisturbanceisanalyzed.Theresultsofsimulationshowthatthenavigationprecisionishigherandthecross—distancedeviationissmaller.Thenewalgorithmanddesignedmeetstheneedofactualgreatcircleflightpath.
Keywords:greatcircleflightpath,navigationandcontr01,navigationcomputation,controllaw
导航是弓f导飞行器通过最有利的航线到达目的地。飞机在空中自主导航飞行时,由机上的导航系统给出控制指令,使飞机按照规划好的航线飞往预定区域,完成预定任务。当飞行距离较短时,为求简便,将小范围的地球表面看作平面,预定航线规划为当地切平面上的直线或圆弧线,可以在此直角平面上近似计算各种导航参数与制导指令。当飞行距离较远,一般超过50km时,必须考虑到地球表面是个球面,飞行任务航线规划为从飞机起点到目的地的地球大圆航线,此时航程最短,最节省燃油,大圆航
收稿日期:2005一09—10修回日期:2006一01—15
作者简介:彭劲松(1974一),男,江西永新人,硕士研究生,主要从事检测技术与自动化装置的研究。线规划需在三维球体空间解算推导出各种导航参数和制导指令[1’6]。
本文根据惯导上常用的坐标变换矩阵及向量点积、叉积等数学知识,提出了一种全新的大圆航线导航解算算法,该算法及设计的控制律已在某型无人直升机上经过多次试验飞行,航迹精度较高;仿真表明,该算法及设计均切实有效可行,当然还将在进一步的试飞中验证及完善。
动力学模型
在仿真过程中采用的无人机模型是小扰动线性化模型‘2捌:
△义一A△X+B△U
式中:A是系统状态矩阵;B是控制矩阵;△X是状态向量的增量;叫是控制向量的增量。
}口
弓
万方数据
彭劲松,等:大圆航线导肮与控制律设计(总第32一0665)?63?1.1纵向运动方程
一X。
一Z,
一(帆一屹Z,)
O
—X。
一Z。
一(耽一也Z。)
O
O
—Z8
,
一(、M8一MjZa、)
f
O
O—X口
1O
一(也+也)0
10一Xa
0
一M8
O
嘲
△X一[△驴△口△岛△曰]了1△U一[△乱△d了’]丁
4=B一1.2
一X。
一Z。
一(My一也Zy
O
—X。
一Z。
一(屹一屹Z。
O
O—Xk
—ZdO
一(、M8:一M28)一M畸
0O
横向运动方程
|}]=『}1+
0一局
1O一(屹+胞O
lO[耋:]
△X一[卢户rf5]T△U一[乱n]T
A一
一1
irNr—Lr
1一i。i,
t。Lr—Nr
1一ipi,
0
一yd
irM?一k?
1一ipi,
ipL87一N8
1一i∥,
O
—yd
O
O
O
以上矩阵的计算需要用到飞机的气动导数,有
关定义见文献[2]。
2大圆航线导航解算
2.1由地理坐标确定的地垂线方向
记P点的地垂线单位向量为厶(向上为正)。记
P为地球坐标系,原点位于地心,咒轴穿过本初子午
线与赤道的交点,y。轴穿过东径90。子午线与赤道
的交点,乙轴沿地球自转轴。
记P点的地理坐标系为g,其原点为载体重心,
X。轴指向东,y。轴指向北,乙轴指向天顶(如图l
所示)。
『一8inAc08Ao]
lcosLcosA—cosLsinAsinLj
》=c;》=[茎茎::i誊:刁匿]一I薹;:刁
》=c;:z=J××cosLcosAlof一|cosLsinA『
L××sinL_JL1_JLsinL-J
乏:e=Icos厶sin九l(2)
“:8=lcosLisln凡I(2)
LSinLij
由单位向量点积,有艺?乏;一cos(艺,赢),所以
(二,赢):cos一,((:.茏):co。一?((:.:i)
||
咄㈨惭幽
1等雠。1尚篝。
也¨一㈨萋怫。
也,一一。
一Ⅳ一0
。蓑可
也一坼一H。
肛
万方数据
?64?(总第32一0666)
火力与指挥控制2007年第6期
__+
D一(R+^)?(“,“i)一
(R+^)?cos一1(cosLcos沁os厶cos凡+cosLsin知osLfsin凡+sinLsinLi)
上式中R为PPi大圆主曲率半径。
(3)
待飞时间:rPP一号
(4)
y
其中y为飞机的地速。2.3航向解算推导
航向如图2所示,设P点为飞机的瞬时位置,P,为下一个航路点,A为地球北极,AP为过P点的子午圈,PPr为大圆圈,即飞机所要执行的大圆航线,囊为P点处飞机的待航航向,即晚为子午圈AP平面与大圆圈P只平面所夹的角,规定北偏东为正。两平面间的夹角也可表示为两平面法线间的夹角。
c(地心)圈2航向示意图
子午面AP的法线单位向量为:毒。。=卺焉
大圆圈平面P只的法线单位向量为:“;×。
“。ד;
。修又两
囊一(玉。,,玉×。。),规定玉。。,至玉。
指向地心时,西,为正。
的旋转方向
由于玉×i?玉。。一cos(玉×i,兹×。一cos霞,所以
由于“;×i?“刍×。一cos(距;×i,“刍×。一cos霞,所以霞=cos一1(玉×f?玉。。)
其中玉萨南
l
“>×e
墩e2落奇
—'
-÷—+
“鼻×f一“。ד;一
OsinL—cosLsinA
。三二≯慝子
O
—cosLcosA
cos厶sin凡|=
cosLcosAO
JLsinLi
.J
(5)
(6)
(7)
一sinLcosLfsin久+cosLsin砖inLf]
sinLcosL。cos凡一cosLcos砖in己f
(8)
一cosLsin沁os厶cos九+cos£cos沁os厶sin凡J
—+
-.—’
_+
_+
“;×。=∥ד:=一“:ד。=
2.4偏航距解算推导
(9)
偏航距如图3所示,设飞机自航路点PH飞往P,,飞机的瞬时位置为尸,则PM大圆弧长即偏航
距d,其中M为P至PHP,大圆弧的最短弧长所确定的点。显然过M点的大圆弧PM切线垂直于乏¨和乏,所确定的平面。设沿切线的单位向量为:。H㈨,PH和P,点的地垂线单位向量为;H和:,,
则
一
“。一1:><“,
毗卜”刈一雨而
由于(:,:肘)=90。一(:,:。;一。,×;)
所以sin(:,二M)一cos(Z,艺。,一。,×i)=:t?:{,一。,×;
(:,;M)=sin一-(:e?:{i一,)。;)
她心C
“、\
‘9-I)d)入
?’\厂L
(;.1)硝
P\
、
U
、.
(“,““.!lf)
地心c
图3偏航距示意图
偏航距为:
d=(R+^)(:,Z肘)一(R+^)sin一,(矛?疲i一,,。,)(10)
其中:。根据式(1)确定;
一,
“;一1×甜;
比-”萨赢募甭
“;一lד;一
(11)
[_c童一三一,荨::固一
s咄一1
o
cos厶一1cost一1
l№蛐n凡I—
l一。o。£;一。。i。也一,。。。£,一。。。。^一,
o
jl。i儿:j
r—sinLf一1cosLfsin凡+cosLi一1sin凡一lsinL,]
sin三i一1cos三Icos^i—cos三f一1cos丑一1sin£f
LcosLf一1sin凡一lcosLicos^;+cosLi一1cos九一lcosLfsin九J
记
(12)
u磊一1)×f=一sin厶一1cos厶sin九+cos厶一isin九一lsin厶
引m
瞄
厶叱o
C
一
一
柙√1
妇协砒o
O
R∽
一
叩__引
一
OO
m¨∞
万方数据
彭劲松,等:大圆航线导肮与控制律设计(总第32一0667)?65?U乞一1)×:一sin£,一】cos厶cos凡一cosLi一】cos凡一lsin己,
U磊一1)×i一一cos厶一1sinA,lcosL:cosA:+
cosL,一lcos九~lcos上,sinA:
则
“;,一1)×;=
(13)
3大圆导航控制律的设计
为了使飞机跟踪预定航线,误差量取为飞机与预定航线的偏航距d和侧偏速度△y。偏航距规定在航线右侧为正,调节d到稳定状态可以使飞机保持在预定航线上。侧偏速度△y定义为当前飞机地速在希望速度方向的垂直方向的投影。希望速度方向,即飞机指向终止点的方向,规定△y远离航线为正,调节△y到稳定状态,可以保持飞机地速始终指向航线终止点。
导航程序实时计算d和△y,按照比例加微分控制规律得到的横向通道的滚转角控制量P,,再按照协调转弯的对应关系,得到航向通道的航向角速度控制量P。,[3]。
横向制导指令:
Py=一C1?d—C2?△y(14)航向制导指令:
P。=一(9.8/y)?sin(P,)(15)
由机载导航系统测量出飞机当前位置、速度等信息,位置是纬度、经度和高度,速度是东向、北向和天向地速。根据式(1)~式(13)进行导航解算及式(14)、式(15)控制律计算制导控制量。整个导航解算算法与控制律的设计流程具体内容见图4。
4仿真
4.1全球导航仿真显示与分析
飞行仿真显示如图5所示,仿真示例:地球大圆航线起点P1东经100。、北纬40。,终点P。东经110。、北纬50。,航线长度己=1359.185km(见图中*处)。
4.2抗风干扰能力分析
一般来说,大气不是静止的,而是活动的。在飞行器飞行的位置上,大气的速度称为风速度,以y硼
初如化:
输入航线起点P1的经度、纬度、高度
输入航线终点P2的经度、纬度、高度
求銎枣Pt、终点P2的单位向量:-、i:
求“、“所夹球的心角和航程D
求航线所在大圆平面的法线单位向量Zl。:
求飞机当前P的单位向量“
.
求PPf所在平面即希望大圆平面的迭线单位向量“川
求飞机所在子午面的法线单位向量“。
求大圆平面与P所在子午面的夹角即待航航向角热
求向量“与航线大圆平面法线“(t_1)五的夹角
求出偏航距d
求飞机实际航迹角与待航航向角之差
求出侧偏速度△y
计算横向制导指令R
计算航向制导指令匕,
求”l、“1所夹球心角和航线上待飞距离。
岛≤lim?
●YEs
.●一~’
导航数据计算程序.
.结束
N0
图4大圆航线导航与控制设计流程图
飞行仿真显示(地球坐标系一e系)
圈5全球导航仿真不意图
表示。飞行器质心相对于大地的速度称为对地速度,简称地速,以以表示。飞行器质心相对于大气的速度称为对空速度,简称空速,以亿表示。3个速度的矢量叠加关系如下:
y。=y。+yⅣ(16)空速和风速相加可得到飞机的东向地速亿和北向地速n,表示如下,其中妒是航向角:
万方数据
?66?(总第32一0668)火力与指挥控制2007年第6期y,=y。。+y。=y。?sin妙+y。
y。=y。+y。=y。?cos哕+V一
、…
风扰动有常值风、突风、随机紊流3种,下面采
用它们的模型来检验航迹精度。常值风参考o~
25km风特性的空间分布数据。突风模型为“1一
cosine”型,可用于突风速度3个正交分量中的任何
一个,m=z,3,,z。z轴沿无扰动时飞机速度方向;了
轴在飞机对称平面内垂直于z轴指向上;z轴垂直
于对称平面指向右H]。突风模型如图6所示。
<yⅣ=
y。一0z<O
y。[1一cos(配/d。)]
2
yⅣ=O
6
%了
,、4
蓦3
S2
l
0
O≤z≤2厶(18)
z>2矗。凳N…。……?●…??。…氏….|\…{...\…r…、\{i℃…’
O200400‘60080010001:
图6离散突风模型
针对平面导航的直线航线,仿真时加上10m/s的常值风扰动,加上右侧突风扰动,即m—z取口。一5m/s、d。=500m。偏航距对比见图7,仿真时间800s。
5结论
从仿真结果可看出,全球导航时飞机能按预定大圆航线导航飞行,受风干扰时偏航距最大不超过50m,结合试飞的效果看,本文提出的大圆航线导航解算算法精度高,设计的导航控制律对无人机的航迹跟踪也具有满意的控制效果。
参考文献:
[1]郑剑.无人直升机GPS/sINs组合导航系统的设计与应用研究:[D].北京:北京航空航天大学,
2002.
[2]张明廉.飞行控制系统[M].北京:航空工业出版社。1994.
[3]屈耀红.某型无人机的定位与导航控制研究:[D].西安:西北工业大学,2002.
[4]GJB902—90.军用直升机飞行品质规范[S].北京:中华人民共和国国家军用标准,1990.
L5]George
V,Liang
T.FromMissionPlanningtoFlightControlofUnmannedAerialVehicles:
50
40
10
O
一10
O100200300400500600700800
f,s
圈7a加入常值风干扰时偏航距
‘^-”
I
:
J
旺
O1002003(】【)4005()o60070080【)
£,s
圈7b加人突风干扰时偏航距
StrategiesandImplementationT001s[0L].Annual
ReviewsinControl,Available0nline,2005,11(4):
18—22.
[6]HasanAl,VachtsevanosG.IntelligentRouteP1anningforFastAutonomousVehicles0perating
inaLargeNaturalTerrain[J].JournalofRobotics
andAutonomousSystems,2002(40).卜24.
(上接第61页)
的综合决策支持框架。考虑战术行为的对抗性及信息的模糊性和不确定性,如何完善实体的态势识别与CXBR中的Context转换模型,将是后续研究工作的方向。
参考文献:
[1]GonzalezAJ.AContext埯aseRepresentationofTacticalKnoweledgeforUseinSimulation[M]
1998.
[2]AvlinoJz.AutomatedAcquisiti。nofTacticaIKnowledgeThrough
contextualization[M]1999.[3]夏佩伦.基于模糊逻辑的推理技术[J].潜艇学术研究,2002,20(4):15—18.
[4]MamdaniEH.ApplicationsofFuzzyAlgorithmforSimpleDynamicP1ant[J],P.IEE,1974,121:39—
41.
蝤
m
,
O
巧
m
蛤
E、飞
一
一
万方数据