CN102508492A - 一种飞行器在等高航路点间的定高度大圆飞行实现方法 - Google Patents
一种飞行器在等高航路点间的定高度大圆飞行实现方法 Download PDFInfo
- Publication number
- CN102508492A CN102508492A CN2011103472212A CN201110347221A CN102508492A CN 102508492 A CN102508492 A CN 102508492A CN 2011103472212 A CN2011103472212 A CN 2011103472212A CN 201110347221 A CN201110347221 A CN 201110347221A CN 102508492 A CN102508492 A CN 102508492A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- aircraft
- coordinate
- rightarrow
- real
- 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
Landscapes
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种飞行器在等高航路点间的定高度大圆飞行实现方法,其特征在于步骤如下:通过计算实际飞行航线与理想大圆航线之间的实时偏差,给出了飞行器实现两等高点之间的定高度大圆飞行的具体实施步骤,进而可拓展至多等高航路点间的定高度大圆飞行。通过对该方法进行仿真验证可知,其通过对飞行器的实时高度和实时方位的调整很好的解决了飞行器沿大圆定高度飞行的实现问题,精度高,并且对飞行器的机动能力要求较弱,所以可以应用于多种研究对象。
Description
技术领域
本发明涉及一种飞行器在等高航路点间的定高度大圆飞行实现方法,一种在考虑地球曲率情况下飞行器在等高航路点间的定高度大圆飞行的实现方法,属于飞行控制领域。
背景技术
等高航路点间的定高度大圆飞行是指飞行器在相邻等高航路点间均沿给定高度进行大圆飞行的一种飞行方式,是以两个等高航路点间的定高度大圆飞行为基础的。据此,本发明着重介绍两个预置等高航路点间的定高度大圆飞行实现方法。两个等高航路点间的飞行器定高度大圆飞行是指飞行器在由两个预置航路点和地心确定的平面内从第一个预置航路点开始沿定高度飞至第二个预置航路点的过程,示意图参见附图1。定高度大圆飞行作为定高度飞行的最简单和最基本形式,对其进行深入研究有着重要的意义。基于实际需求(如研究定高度飞行火箭在地形摄影和探矿的工作效能、无人机在定高度掠地或掠海平飞时的作战效能等),经常需要通过计算机仿真研究飞行器在定高度飞行时的工作效能。当所选飞行器的工作区域较小时,一般可将地球表面近似为平面进行处理;但是,如果工作区域较大,同样的近似处理将导致仿真处理结果失真。这时就需要一种高精度的考虑地球曲率的定高度实现方法。传统的高度控制做法是基于力矩控制,即通过改变飞行器力矩平衡来改变俯仰角姿态,进而改变升力大小,实现对高度的控制。该方法需要建立较复杂的动力学模型,不便于仿真实现,本发明给出了一种便于实现的模型简单的定高度大圆飞行控制方法,很好的克服了传统实现方法的弊端。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种飞行器在等高航路点间的定高度大圆飞行实现方法。
技术方案
一种飞行器在等高航路点间的定高度大圆飞行实现方法,其特征在于步骤如下:
步骤1将经纬高坐标转换到″Rg2″坐标系:
首先利用下述公式将给出的预置航路点的经纬高坐标转换到″Rd″坐标系:
X=(Re+H0)cosφ0cosλ0
Y=(Re+H0)cosφ0sinλ0
Z=(Re+H0)sinφ0
所述″Rd″坐标系为地心系,定义为:坐标原点为地心,X轴在赤道平面内并指向首子午线方向,Z轴指向北极,Y轴通过右手法则确定;
其中:从″Rd″坐标系到″Rg2″坐标系的旋转矩阵
所述″Rg2″坐标系坐标定义为:原点为地心,X轴指向其正北方向,Y轴指向天,Z轴指向其正东方向;
步骤3判断飞行器当前是否需要终止飞行:以表示″Rg2″坐标系下从地心指向飞行器当前位置的向量,当飞行器距第二个预置航路点(目标点)的距离小于飞行器在一个步长的最大飞行距离时,则飞行器终止飞行;否则,执行下一步骤;
步骤4计算飞行器实现定高度大圆飞行的实时过载:根据飞行器实际飞行航线与理想大圆航线之间的实时偏差来计算在″Rg2″坐标系下飞行器沿大圆定高飞行的实时过载其中为对应的单位向量,εn为向心加速度所对应的过载的大小,nH为高度方向偏差调节系数,nB为大圆法向偏差调节系数,表示在″Rg2″坐标系下预定大圆飞行平面的法向量;
所述
所述
所述
所述
所述
所述
步骤7计算飞行器在″Rc″坐标系下的实时坐标:令飞行器在″Rc″坐标系下的实时坐标为″Rg″和″Rc″的坐标原点在″Rg2″坐标系下对应的坐标分别为和″Rd″坐标系到″Rc″坐标系的转换矩阵为则其中,表示从″Rg″坐标系到″Rc″坐标系的转换矩阵
所述″Rc″为战区坐标系,定义为由给定的、位于地面上的坐标原点确定的北天东坐标系;
所述″Rg″为当地北天东坐标系,定义为坐标原点为位于地面上的选定点,X轴指向其正北方向,Y轴指向天,Z轴指向其正东方向;
有益效果
本发明提出的一种飞行器在等高航路点间的定高度大圆飞行实现方法,通过计算实际飞行航线与理想大圆航线之间的实时偏差,给出了飞行器实现两等高点之间的定高度大圆飞行的具体实施步骤,进而可拓展至多等高航路点间的定高度大圆飞行。通过对该方法进行仿真验证可知,其通过对飞行器的实时高度和实时方位的调整很好的解决了飞行器沿大圆定高度飞行的实现问题,精度高,并且对飞行器的机动能力要求较弱,所以可以应用于多种研究对象。
附图说明
图1:为基于“两个预置等高航路点”的定高度大圆飞行示意图,其中航路点1和航路点2分别表示飞行器沿大圆等高度飞行的起点和终点,Hn表示预想的飞行高度;
图2:为″Rd″坐标系、″Rg″坐标系和″Rc″坐标系之间的相对关系示意图,其中λ和分别为当地北天东坐标系原点对应的经度和纬度(单位为弧度),λ′和分别为战区坐标系原点对应的经度和纬度(单位为弧度);
图3:为飞行器在两个预置等高航路点间的定高度大圆飞行实现流程图;
图4:给出了″Rc″坐标系下飞行器在两个预置等高航路点间定高度大圆飞行的轨迹图;
图5:给出了飞行器飞行过程中的实时高度曲线,X轴代表飞行时间,Y轴代表实时高度;
图6:给出了飞行器飞行过程中的实时过载大小曲线,X轴代表飞行时间,Y轴代表实时过载大小。
具体实施方式
现结合实施例、附图对本发明作进一步描述:
首先将需要用到的坐标系说明如下:
1)地心系(″Rd″)
坐标原点为地心,X轴在赤道平面内并指向首子午线方向,Z轴指向北极,Y轴通过右手法则确定。
2)当地北天东坐标系(″Rg″)
坐标原点为位于地面上的选定点,X轴指向其正北方向,Y轴指向天,Z轴指向其正东方向。
3)″Rg2″坐标系
″Rg2″坐标系的坐标原点为地心,各轴指向与″Rg″的各轴指向对应相同。
4)战区坐标系(″Rc″)
坐标原点、各轴指向可根据需要指定(各轴指向只需满足右手准则即可)。在此令″Rc″为由给定的坐标原点(位于地面上)确定的北天东坐标系。
″Rd″、″Rg″和″Rc″的相对关系参见附图2。首先令两个预置等高航路点的经纬高分别为(λ1、Hn)、(λ2、Hn)、飞行器飞行速度的大小为Vn、飞行器所要稳定飞行的高度(相对于地面)为Hn、算法仿真步长为dt且″Rc″坐标系原点的经纬高为(λ′、0)。以上所有经纬度均以弧度形式给出,下面详细介绍基于“两个预置等高航路点”的定高度大圆飞行的实现步骤:
步骤1:将经纬高坐标转换到″Rg2″坐标系
令″Rg″坐标系的原点为第一个预置航路点在地面上的投影。实时过载的计算是在″Rg2″坐标系下完成的,所以首先要将预置航路点的坐标转换到″Rg2″坐标系。可通过首先将给出的预置航路点的经纬高坐标转换到″Rd″坐标系,然后再转换到″Rg2″坐标系这两步来实现。
Step1:将经纬高坐标转换到″Rd″坐标系
可以通过式1.1-1.3将经纬高坐标转换到″Rd″坐标系下表示:
X=(Re+H0)cosφ0cosλ0 (0.1)
Y=(Re+H0)cosφ0sinλ0 (0.2)
X,Y,Z分别表示给定点在″Rd″坐标系下对应的三坐标;
Step2:″Rd″坐标系到″Rg2″坐标系的转换
取给定点在″Rg2″坐标系下对应的坐标为(X′Y′Z′)T,则
其中
表示从″Rd″坐标系到″Rg2″坐标系的旋转矩阵。
步骤2:计算飞行器初始速度
令为飞行器在″Rg2″坐标系下的实时速度矢量。对进行初始化时要求其模等于Vn,且为了获得平滑的大圆飞行轨迹,取飞行器初始速度的方向为由两个预置航路点和地心确定的大圆在起始航路点处的切向。以和表示两个预置航路点在″Rg2″坐标系下的坐标,则可通过下式来初始化:
步骤3:判断飞行器当前是否需要终止飞行
步骤4:计算飞行器实现定高度大圆飞行的实时过载
ΔH=Ht-Hn (0.8)
其中Ht为飞行器的当前海拔高度,ΔH和分别为高度上的偏差和高度变化率。
Step2:计算
和分别为″Rg2″坐标系下地心指向预置航路点1和2的单位矢量,即为对应的单位向量,为对应的单位向量。两个预置等高航路点和地心确定了大圆平面,同时也确定了大圆平面的法向量所以无需每一步长均计算当Step1执行完之后,首先判断是否第一次执行Step2,若是,则执行Step2,否则直接执行Step3。
Step4:计算nH、nB和εn
其中K1、K2分别取0.025和0.07,g为重力加速度(取9.8)。
Step5.:计算
步骤5:计算飞行器在″Rg2″坐标系下的实时速度和实时矢径
步骤6:计算飞行器在″Rg″坐标系下的实时坐标
令飞行器在″Rg″坐标系下的实时坐标为则
步骤7:计算飞行器在″Rc″坐标系下的实时坐标
令飞行器在″Rc″坐标系下的实时坐标为″Rg″和″Rc″的坐标原点在″Rg2″坐标系下对应的坐标分别为和(和可根据经纬高坐标到″Rg2″坐标系的转换步骤得到),″Rd″坐标系到″Rc″坐标系的转换矩阵为(可通过式1.5计算得到,用λ′替换λ1、替换),则
其中,表示从″Rg″坐标系到″Rc″坐标系的转换矩阵,可通过下式计算得到:
和只需在第一次执行步骤7时计算即可。
下一部分仿真实现了飞行器在两个预置等高航路点间的定高度大圆飞行。假设飞行器匀速飞行的速度大小300m/s、两个预置等高航路点的经纬高坐标分别为(116,39,10000.0)(处于北京地区)、(121,31,10000.0)(处于上海地区)、预定飞行高度为10000m、仿真步长为0.1s、″Rc″坐标系的原点为(117,41,0)(处于北京地区)。
实施步骤如下:
步骤1:将经纬高坐标转换到″Rg2″坐标系
按照初始条件可得:
λ1=116*π/180 φ1=39*π/180 H1=10000
λ2=121*π/180 φ2=31*π/180 H2=10000
Vn=300 dt=0.1
Step1:将经纬高坐标转换到″Rd″坐标系
X1=(Re+H1)cosφ1cosλ1=-2176300.0772 Y1=(Re+H1)cosφ1sinλ1=4462076.4086
Z1=(Re+H1)sinφ1=4020184.8749
X2=(Re+H2)cosφ2cosλ2=-2820195.0935
Y2=(Re+H2)cosφ2sinλ2=4693592.8303
Z2=(Re+H2)sinφ2=3290133.7827
Step2:″Rd″坐标系到″Rg2″坐标系的转换
将λ1、φ1带入式1.5可得
则第一个预置航路点在″Rg2″坐标系下的坐标为
第二个预置航路点在″Rg2″坐标系下的坐标为
飞行器的初始位置在″Rg2″坐标系下的坐标
步骤2:计算飞行器初始速度
飞行器的初始速度为
步骤3:判断飞行器当前是否需要终止飞行
如果
即
则飞行器已经到达第二个预置航路点,终止飞行;否则,执行步骤4。
步骤4:计算飞行器实现定高度大圆飞行的实时过载
Step2:计算
否则,直接执行Step3。
Step4:计算nH、nB和εn
步骤5:计算飞行器在″Rg2″坐标系下的实时速度和实时矢径
步骤6:计算飞行器在″Rg″坐标系下的实时坐标
步骤7:计算飞行器在″Rc″坐标系下的实时坐标
然后返回步骤3。
步骤终
″Rc″坐标系下的飞行器大圆飞行轨迹图、飞行器实时高度图和飞行器实时过载大小图分别见附图4、附图5和附图6。从附图5可以看出飞行器定高度大圆飞行过程中的海拔高度基本稳定在9999.980m处,非常准确的模拟了两预置等高度航路点间的定高度大圆飞行,并且飞行轨迹非常平滑,体现了算法的可行性和有效性。附图6表明飞行器飞行过程中的过载大小基本稳定在0.9985,波动很小,说明该方法对于飞行器的机动能力的要求较弱,所以可广泛应用于飞行器定高度大圆飞行的研究中去。
Claims (1)
1.一种飞行器在等高航路点间的定高度大圆飞行实现方法,其特征在于步骤如下:
步骤1将经纬高坐标转换到″Rg2″坐标系:
首先利用下述公式将给出的预置航路点的经纬高坐标转换到″Rd″坐标系:
X=(Re+H0)cosφ0cosλ0
Y=(Re+H0)cosφ0sinλ0
Z=(Re+H0)sinφ0
其中Re=6378137m,λ0,分别表示给定点的经度、纬度,单位为弧度;H0为给定点的高度;X,Y,Z分别表示给定点在″Rd″坐标系下对应的三坐标;
所述″Rd″坐标系为地心系,定义为:坐标原点为地心,X轴在赤道平面内并指向首子午线方向,Z轴指向北极,Y轴通过右手法则确定;
其中:从″Rd″坐标系到″Rg2″坐标系的旋转矩阵
所述″Rg2″坐标系坐标定义为:原点为地心,X轴指向其正北方向,Y轴指向天,Z轴指向其正东方向;
步骤3判断飞行器当前是否需要终止飞行:以表示″Rg2″坐标系下从地心指向飞行器当前位置的向量,当飞行器距第二个预置航路点(目标点)的距离小于飞行器在一个步长的最大飞行距离时,则飞行器终止飞行;否则,执行下一步骤;
步骤4计算飞行器实现定高度大圆飞行的实时过载:根据飞行器实际飞行航线与理想大圆航线之间的实时偏差来计算在″Rg2″坐标系下飞行器沿大圆定高飞行的实时过载其中为对应的单位向量,εn为向心加速度所对应的过载的大小,nH为高度方向偏差调节系数,nB为大圆法向偏差调节系数,表示在″Rg2″坐标系下预定大圆飞行平面的法向量;
所述
所述
所述
所述
所述
所述
步骤7计算飞行器在″Rc″坐标系下的实时坐标:令飞行器在″Rc″坐标系下的实时坐标为″Rg″和″Rc″的坐标原点在″Rg2″坐标系下对应的坐标分别为和″Rd″坐标系到″Rc″坐标系的转换矩阵为则其中,表示从″Rg″坐标系到″Rc″坐标系的转换矩阵
所述″Rc″为战区坐标系,定义为由给定的、位于地面上的坐标原点确定的北天东坐标系;
所述″Rg″为当地北天东坐标系,定义为坐标原点为位于地面上的选定点,X轴指向其正北方向,Y轴指向天,Z轴指向其正东方向;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110347221 CN102508492B (zh) | 2011-11-04 | 2011-11-04 | 一种飞行器在等高航路点间的定高度大圆飞行实现方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201110347221 CN102508492B (zh) | 2011-11-04 | 2011-11-04 | 一种飞行器在等高航路点间的定高度大圆飞行实现方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102508492A true CN102508492A (zh) | 2012-06-20 |
CN102508492B CN102508492B (zh) | 2013-11-06 |
Family
ID=46220593
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201110347221 Expired - Fee Related CN102508492B (zh) | 2011-11-04 | 2011-11-04 | 一种飞行器在等高航路点间的定高度大圆飞行实现方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102508492B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9501060B1 (en) | 2014-12-31 | 2016-11-22 | SZ DJI Technology Co., Ltd | Vehicle altitude restrictions and control |
CN106708088A (zh) * | 2016-09-26 | 2017-05-24 | 重庆零度智控智能科技有限公司 | 坐标计算方法及装置、飞行控制方法及系统、无人机 |
CN107168355A (zh) * | 2017-06-22 | 2017-09-15 | 李宇昊 | 无人飞行器航线确定方法和装置 |
CN111426311A (zh) * | 2020-03-10 | 2020-07-17 | 民航数据通信有限责任公司 | 基于测地线的大圆航线计算体系方法及装置 |
CN114115332A (zh) * | 2021-10-29 | 2022-03-01 | 北京星途探索科技有限公司 | 一种应用于近程超声速巡航弹的掠地飞行技术 |
CN115017747A (zh) * | 2022-08-09 | 2022-09-06 | 安胜(天津)飞行模拟系统有限公司 | 一种eVTOL飞机的多倍速仿真重定位运行方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101261131A (zh) * | 2008-04-02 | 2008-09-10 | 北京航空航天大学 | 一种无人机固定半径盘旋领航方法 |
US7428476B1 (en) * | 2001-08-10 | 2008-09-23 | Yasumi Capital, Llc | System and method of simulating with respect to spheroid reference models using local surface coordinates |
-
2011
- 2011-11-04 CN CN 201110347221 patent/CN102508492B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7428476B1 (en) * | 2001-08-10 | 2008-09-23 | Yasumi Capital, Llc | System and method of simulating with respect to spheroid reference models using local surface coordinates |
CN101261131A (zh) * | 2008-04-02 | 2008-09-10 | 北京航空航天大学 | 一种无人机固定半径盘旋领航方法 |
Non-Patent Citations (1)
Title |
---|
张锦赓 等: "一种无人攻击机航路飞行仿真方法设计", 《电光与控制》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9501060B1 (en) | 2014-12-31 | 2016-11-22 | SZ DJI Technology Co., Ltd | Vehicle altitude restrictions and control |
US10216197B2 (en) | 2014-12-31 | 2019-02-26 | SZ DJI Technology Co., Ltd. | Vehicle altitude restrictions and control |
US11163318B2 (en) | 2014-12-31 | 2021-11-02 | SZ DJI Technology Co., Ltd. | Vehicle altitude restrictions and control |
US11687098B2 (en) | 2014-12-31 | 2023-06-27 | SZ DJI Technology Co., Ltd. | Vehicle altitude restrictions and control |
CN106708088A (zh) * | 2016-09-26 | 2017-05-24 | 重庆零度智控智能科技有限公司 | 坐标计算方法及装置、飞行控制方法及系统、无人机 |
CN107168355A (zh) * | 2017-06-22 | 2017-09-15 | 李宇昊 | 无人飞行器航线确定方法和装置 |
CN111426311A (zh) * | 2020-03-10 | 2020-07-17 | 民航数据通信有限责任公司 | 基于测地线的大圆航线计算体系方法及装置 |
CN111426311B (zh) * | 2020-03-10 | 2022-01-04 | 民航数据通信有限责任公司 | 基于测地线的大圆航线计算体系方法及装置 |
CN114115332A (zh) * | 2021-10-29 | 2022-03-01 | 北京星途探索科技有限公司 | 一种应用于近程超声速巡航弹的掠地飞行技术 |
CN115017747A (zh) * | 2022-08-09 | 2022-09-06 | 安胜(天津)飞行模拟系统有限公司 | 一种eVTOL飞机的多倍速仿真重定位运行方法 |
CN115017747B (zh) * | 2022-08-09 | 2022-10-21 | 安胜(天津)飞行模拟系统有限公司 | 一种eVTOL飞机的多倍速仿真重定位运行方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102508492B (zh) | 2013-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11286065B2 (en) | Method for designing reentry trajectory based on flight path angle planning | |
CN102508492B (zh) | 一种飞行器在等高航路点间的定高度大圆飞行实现方法 | |
WO2021036778A1 (zh) | 在高度速度剖面内直接规划再入轨迹的方法 | |
CN103728980B (zh) | 航天器相对轨道的控制方法 | |
Bryson et al. | Vehicle model aided inertial navigation for a UAV using low-cost sensors | |
CN103017753B (zh) | 一种无人机航路规划方法及装置 | |
CN104035335A (zh) | 基于高精度纵、横程解析预测方法的平稳滑翔再入制导律 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN109344449B (zh) | 航天器月地转移轨道逆向设计方法 | |
CN104443432B (zh) | 一种卫星有限推力共面圆轨道自主轨道转移制导方法 | |
CN101354251B (zh) | 一种深空探测器等效转移轨道确定方法 | |
CN105807781A (zh) | 一种基于比例导引的空间近距飞越末制导方法 | |
CN103112600A (zh) | 一种星际转移轨道设计方法 | |
CN105573337A (zh) | 一种满足再入角和航程约束的离轨制动闭路制导方法 | |
CN105242679A (zh) | 一种四旋翼飞行器的控制系统设计方法 | |
CN104215242A (zh) | 一种基于横向游移坐标系的极区惯性导航方法 | |
CN103453907B (zh) | 基于分层大气模型的行星进入段导航滤波方法 | |
CN110196066A (zh) | 基于格网姿态速度信息不变的虚拟极区方法 | |
CN105069311A (zh) | 一种远程火箭发射初态误差传播估计方法 | |
CN106379559A (zh) | 一种适用于导弹机载发射的过渡导航方法 | |
CN105718660A (zh) | 临近空间大范围机动弹道三维包络计算方法 | |
CN102582850A (zh) | 提高卫星磁控精度的方法 | |
CN103921957A (zh) | 一种探月飞船跳跃式再入的跃起点能量管理方法 | |
CN106200664A (zh) | 一种适应长时间失控的姿态控制方法 | |
CN105894126A (zh) | 一种火箭残骸的落点预报模型生成及定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20131106 Termination date: 20161104 |
|
CF01 | Termination of patent right due to non-payment of annual fee |