当前位置:文档之家› 大圆航线导航与控制律设计

大圆航线导航与控制律设计

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,)

—X。

一Z。

一(耽一也Z。)

—Z8

一(、M8一MjZa、)

O—X口

1O

一(也+也)0

10一Xa

一M8

△X一[△驴△口△岛△曰]了1△U一[△乱△d了’]丁

4=B一1.2

一X。

一Z。

一(My一也Zy

—X。

一Z。

一(屹一屹Z。

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,

一yd

irM?一k?

1一ipi,

ipL87一N8

1一i∥,

—yd

以上矩阵的计算需要用到飞机的气动导数,有

关定义见文献[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为飞机的地速。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?玉。。)

其中玉萨南

“>×e

墩e2落奇

—'

-÷—+

“鼻×f一“。ד;一

OsinL—cosLsinA

。三二≯慝子

—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\

、.

(“,““.!lf)

地心c

图3偏航距示意图

偏航距为:

d=(R+^)(:,Z肘)一(R+^)sin一,(矛?疲i一,,。,)(10)

其中:。根据式(1)确定;

一,

“;一1×甜;

比-”萨赢募甭

“;一lד;一

(11)

[_c童一三一,荨::固一

s咄一1

cos厶一1cost一1

l№蛐n凡I—

l一。o。£;一。。i。也一,。。。£,一。。。。^一,

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

柙√1

妇协砒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。)]

yⅣ=O

%了

,、4

蓦3

S2

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

一10

O100200300400500600700800

f,s

圈7a加入常值风干扰时偏航距

‘^-”

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.

E、飞

 万方数据

相关主题
文本预览
相关文档 最新文档