CN104515974B - 微波着陆机载设备角度、测距数据处理方法 - Google Patents
微波着陆机载设备角度、测距数据处理方法 Download PDFInfo
- Publication number
- CN104515974B CN104515974B CN201410757105.1A CN201410757105A CN104515974B CN 104515974 B CN104515974 B CN 104515974B CN 201410757105 A CN201410757105 A CN 201410757105A CN 104515974 B CN104515974 B CN 104515974B
- Authority
- CN
- China
- Prior art keywords
- moment
- function
- elevation angle
- angle
- azimuth
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明提供了一种微波着陆机载设备测角、测距数据处理方法,在机载设备测得的方位角、仰角及距离信息基础上,采用递推、插值方法,分别计算得到方位功能时刻飞机的距离值和仰角值,仰角功能时刻方位值和距离值,应用这些位置信息进行坐标变换,避免由于机载设备测量所得的方位角、仰角及距离信息不同步,给飞机导航带来的误差,提高着陆精度。
Description
技术领域
本发明属于微波着陆(Microwave Landing System,MLS)系统,用于微波着陆机载设备角度、测距信息的数据处理。
背景技术
微波着陆系统是一种精密导航设备,为飞机提供实时准确的引导信号,在实现Ⅱ、Ⅲ类飞机精密进近时,机载设备将测量的方位角θAZ、仰角θEL和距离信息L存放在数据总线上,当进行坐标变换时,分别取该时刻前的方位、仰角和距离数据,结合方位台天线、仰角台天线及DME/P天线的位置坐标,得到飞机相对于着陆点的位置(XT,YT,ZT),如图1所示。其中:方位角θAZ是方位台天线的相位中心和飞机之间的连线与方位台天线扫描中心线所在铅锤面的夹角;仰角θEL是仰角台天线的相位中心和飞机之间的连线与水平面的夹角;距离L是飞机与DME/P天线相位中心的距离。
由于微波着陆测角基于时基扫描波束技术,地面台发射的方位角、仰角制导信息采用时分体制,同时机载设备发射的测距询问脉冲具有伪随机特性,这样就会导致机载设备测得的方位角、仰角及距离不能实时反映飞机同一时刻的位置信息,也就是说测得的角度和距离数据与飞机的实际位置相比存在一定的偏差,直接利用这些数据进行坐标变换,会给飞机导航引导到来一定误差。
发明内容
为了克服现有技术的不足,本发明提供一种微波着陆机载设备测角、测距数据处理方法,采用递推、插值进行数据处理算法,解决了机载设备测得的方位角、仰角及距离不能真实反映飞机同一时刻实际位置状态的问题,提高了飞机导航和着陆精度。
本发明解决其技术问题所采用的技术方案包括以下步骤:
1)建立方位角的数学模型,其中,方位角状态方程XAZ(k+1)=φAZ·XAZ(k)+GAZ·wAZ(k),方位角量测方程θAZ(k)=HAZ·XAZ(k)+vAZ(k),为方位角k时刻的状态矢量;XAZ(k+1)为方位角k+1时刻的状态矢量;θAZ(k)为k时刻机载设备测得的方位角;为k时刻机载设备测得方位角的变化速度;为k时刻机载设备测得方位角变化加速度;Tk为当前k+1时刻方位功能距k时刻方位功能的时间间隔;HAZ=[10 0],为方位角测量矩阵;为方位角状态转移矩阵;为方位角动态噪声矩阵;wAZ(k)是过程噪声;vAZ(k)是测量噪声;过程噪声wAZ(k)与测量噪声vAZ(k)是互不相关的零均值白噪声;
2)建立仰角数据处理的数学模型,其中,仰角状态方程XEL(n+1)=φEL·XEL(n)+GEL·wEL(n),仰角量测方程θEL(n)=HEL·XEL(n)+vEL(n),为仰角在n时刻的状态矢量;XEL(n+1)为仰角在n+1时刻的状态矢量;HEL=[ 1 0 0],为仰角测量矩阵;为仰角状态转移矩阵;为仰角动态噪声矩阵;θEL(n)为在n时刻机载设备测得的仰角;表示n时刻机载设备测得的仰角变化速度;表示n时刻机载设备测得的仰角变化的加速度;Tn为当前n+1时刻仰角功能距n时刻仰角功能的时间间隔;wEL(n)是过程噪声;vEL(n)是测量噪声;过程噪声wEL(n)与观测噪声vEL(n)是互不相关的零均值白噪声;
3)建立距离数据处理的数学模型,其中,距离状态方程XL(m+1)=φL·XL(m)+GL·wL(m),距离量测方程L(m)=HL·XL(m)+vL(m),为m时刻的距离状态矢量;XL(m+1)为m+1时刻距离的状态矢量;HL=[1 0 0],为距离测量矩阵;为距离状态转移矩阵;为距离动态噪声矩阵;L(m)表示m时刻机载设备测得飞机距DME/P天线相位中心的距离;表示m时刻机载设备测得飞机距DME/P天线相位中心距离变化速度;表示m时刻机载设备测得飞机距DME/P天线相位中心距离加速度;Tm为当前m+1测距应答时刻距m测距应答时刻的时间间隔;wL(m)是过程噪声;vL(m)是测量噪声;过程噪声wL(m)与测量噪声vL(m)是互不相关的零均值白噪声序列;
4)根据微波着陆的功能识别码,判断输入功能类型:
如果是方位功能,则进行第5)步操作;
如果是仰角功能,则进行第6)步操作;
如果是测据功能,则进行第7)步操作;
5)采用Kalman滤波算法对方位角进行滤波处理,得到方位功能时刻的方位角θAZ(k)、方位角变化速度和变化加速度
6)采用Kalman滤波算法对仰角数据进行滤波处理,计算仰角功能时刻的仰角θEL(n)、仰角变化速度和变化加速度
7)采用Kalman滤波算法对仰角数据进行滤波处理,计算测距应答时刻的距离L(m)、距离变化速度和变化加速度
8)以方位、仰角功能第五位Baker码中点时刻为计时点,计算仰角功能距前一方位功能的时间差ΔTk;
9)以方位功能、仰角功能第五位Baker码中点时刻为计时点,计算方位功能距前一仰角功能的时间差ΔTn;
10)计算机载测距设备应答信号与测角信号经相关运算后的相关峰的时间差,得到测角功能时刻距测距应答信号的时间差ΔTL;
11)计算仰角功能时刻对应的实时方位角
12)计算方位功能时刻对应的实时仰角
13)计算测角功能时刻,对应的实时距离值
14)确定飞机在方位功能时刻实时位置信息,包括方位角θAZ(k)、仰角为θEL(n+1)和距离L(m);
15)确定飞机在仰角功能时刻实时位置信息,包括方位角为θAZ(k+1)、仰角θEL(n)和距离L(m);
16)将飞机在方位、仰角功能时刻的实时位置信息进行坐标变换,得到飞机相对于着陆点的坐标;
17)返回第4)步,等待对下一微波着陆功能数据的处理。
本发明的有益效果是:能够解决微波着陆数据处理中,由于机载设备测得的方位角、仰角及距离信息,不能真实反映飞机同一时刻实际位置的问题,提高了飞机导航和着陆精度;另一方面,由于地面设备方位、仰角和测距询问信号的重发率为40Hz左右,经该算法处理后,方位、仰角及距离输出数据率会达到80Hz,相当于角度发播速率和测距询问速率提高了一倍,由测角及测距原理可知:角度和距离测量的CMN(control motion noise,控制运动噪声)精度理论上提高到原先的1.4倍,进而也会提高了坐标变换精度。
附图说明
图1为本发明坐标变换所用坐标系示意图;
图2为本发明微波着陆测角、测距信号流示意图;
图3为接收机解调后的基带信号及测距应答时刻示意图;
图4为测角基带信号经过相关运算后的波形示意图;
图5为微波着陆机载设备测角、测距数据处理方法流程。
具体实施方式
下面结合附图和实施例对本发明进一步说明,本发明包括但不仅限于下述实施例。
本发明的基本思想是在机载设备测得的方位角、仰角及距离信息基础上,采用递推、插值方法,分别计算得到方位功能时刻飞机的距离值和仰角值,仰角功能时刻方位值和距离值,应用这些位置信息进行坐标变换,可以避免由于机载设备测量所得的方位角、仰角及距离信息不同步,给飞机导航带来的误差,提高着陆精度。
微波着陆角度、测距数据的处理方法特征在于:
1.建立方位角的数学模型
方位角的数学模型可表示如下:
XAZ(k+1)=φAZ·XAZ(k)+GAZ·wAZ(k) (1)
θAZ(k)=HAZ·XAZ(k)+vAZ(k) (2)
其中:(1)式为方位角状态方程
(2)式为方位角量测方程
为方位角k时刻的状态矢量;XAZ(k+1),为方位角k+1时刻的状态矢量;
θAZ(k)为k时刻机载设备测得的方位角;
为k时刻机载设备测得方位角的变化速度;
为k时刻机载设备测得方位角变化加速度;
Tk为当前k+1时刻方位功能距k时刻方位功能的时间间隔;
HAZ=[1 0 0],为方位角测量矩阵;
为方位角状态转移矩阵;
为方位角动态噪声矩阵;
wAZ(k)是过程噪声;
vAZ(k)是测量噪声(其中,过程噪声wAZ(k)与测量噪声vAZ(k)是互不相关的零均值白噪声)。
2.建立仰角数据处理的数学模型
仰角的数学模型可表示如下:
XEL(n+1)=φEL·XEL(n)+GEL·wEL(n) (3)
θEL(n)=HEL·XEL(n)+vEL(n) (4)
其中:(3)式为仰角状态方程
(4)式为仰角量测方程
为仰角在n时刻的状态矢量;
XEL(n+1)为仰角在n+1时刻的状态矢量;
HEL=[1 0 0],为仰角测量矩阵;
为仰角状态转移矩阵;
为仰角动态噪声矩阵;
θEL(n)为在n时刻机载设备测得的仰角;
表示n时刻机载设备测得的仰角变化速度;
表示n时刻机载设备测得的仰角变的化速度;
Tn为当前n+1时刻仰角功能距n时刻仰角功能的时间间隔;
wEL(n)是过程噪声;
vEL(n)是测量噪声(过程噪声wEL(n)与观测噪声vEL(n)是互不相关的零均值白噪声)。
3.建立距离数据处理的数学模型
距离测量的数学模型可表示如下:
XL(m+1)φL·XL(m)+GL·wL(m) (5)
L(m)=HL·XL(m)+vL(m) (6)
其中:(5)式为距离状态方程
(6)式为距离量测方程
为m时刻的距离状态矢量;XL(m+1)为m+1时刻距离的状态矢量;
HL=[1 0 0],为距离测量矩阵;
为距离状态转移矩阵;
为距离动态噪声矩阵;
L(m)表示m时刻机载设备测得飞机距DME/P天线相位中心的距离;
表示m时刻机载设备测得飞机距DME/P天线相位中心距离变化速度;
表示m时刻机载设备测得飞机距DME/P天线相位中心距离加速度;
Tm为当前m+1测距应答时刻距m测距应答时刻的时间间隔;
wL(m)是过程噪声;
vL(m)是测量噪声(过程噪声wL(m)与测量噪声vL(m)是互不相关的零均值白噪声序列)。
4.根据微波着陆的功能识别码,判断输入功能类型:
如果是方位功能,则进行第5步操作,对方位角进行Kalman滤波;
如果是仰角功能,则进行第6步操作,对仰角进行Kalman滤波;
如果是测据功能,则进行第7步操作,对距离进行Kalman滤波。
5.采用Kalman滤波算法对方位角进行滤波处理,得到方位功能时刻的方位角θAZ(k)、方位角变化速度和变化加速度详细过程在具体实施方式中进行说明。
6.采用Kalman滤波算法对仰角数据进行滤波处理,计算仰角功能时刻的仰角θEL(n)、仰角变化速度和变化加速度详细过程在具体实施方式中进行说明。
7.采用Kalman滤波算法对仰角数据进行滤波处理,计算测距应答时刻的距离L(m)、距离变化速度和变化加速度详细过程在具体实施方式中进行说明。
8.计算仰角功能时刻距前一方位功能的时间差
以方位、仰角功能第五位Baker码中点时刻为计时点,计算仰角功能距前一方位功能的时间差ΔTk。
9.计算方位功能时刻距前一仰角功能的时间差
与计算仰角功能时刻距前一方位功能时间差方法相同,以方位功能、仰角功能第五位Baker码中点时刻为计时点,计算方位功能距前一仰角功能的时间差ΔTn。
10.计算方位、仰角功能距前一测距应答信号的时间差
由于测距与测角功能分别由两套接收机来完成,计算机载测距设备应答信号与测角信号经相关运算后的相关峰的时间差,就可得到测角功能时刻距测距应答信号的时间差ΔTL,以图3、图4信号为例,A点为测距应答信号时刻,则:ΔTL为接收机收到测距应答信号距前面方位角功能第五位Baker码中点时刻的时间间隔。
11.计算仰角功能时刻对应的实时方位角
注:ΔTk单位为秒。
12.计算方位功能时刻对应的实时仰角
注:ΔTn单位为秒。
13.计算测角功能时刻,对应的实时距离值
测角功能时刻(包括方位和仰角)的距离为:
其中:L(m)为测角功能时刻飞机距DME/P天线相位中心距离(由步骤3计算);
为测角功能时刻飞机距DME/P天线相位中心距离变化速度(由步骤3计算);
为测角功能时刻飞机距DME/P天线相位中心距离变化加速度(由步骤3计算);
ΔTL为测距应答信号与测角功能扫描中点的时间差。
14.确定飞机在方位功能时刻实时位置信息
飞机在方位功能时刻实时位置信息如下:
方位角为θAZ(k)(机载设备测得);
仰角为θEL(n+1)(由步骤12得到);
距离L(m)(由步骤13计算得到)。
15.确定飞机在仰角功能时刻实时位置信息
飞机在仰角功能时刻实时位置信息如下:
方位角为θAZ(k+1),(由步骤11得到);
仰角为θEL(n),(机载设备测得);
距离为L(m),(步骤13计算得到)。
16.将飞机在方位、仰角功能时刻的实时位置信息进行坐标变换,得到飞机相对于着陆点的坐标
17.返回第4步,等待对下一微波着陆功能数据的处理。
微波着陆系统(Microwave Landing System,MLS)是一种精密导航设备,分为地面设备和机载设备,为飞机提供实时准确的引导信号,地面设备由方位制导台(AZ)、仰角制导台(EL)和精密测距设备(DME/P)组成,其中方位制导和仰角制导统称为角度制导,工作在5031~5090.7MHz频段,共有间隔为300kHz的200个波道。
下面以图3、图4为例说明微波着陆的信号特性:图3是微波着陆基带信号,包括高速方位信号、基本数据字2信号和仰角信号,其中A点为测距应答信号时刻;图4为解调后的基带信号经相关运算后的信号波形,其有3个相关峰,也就是说该信号包括3个功能信号,通过功能识别码就可识别出是何功能信号。
说明:以下论述中,k表示方位角时刻,n表示仰角时刻,m表示距离时刻。
步骤一:建立方位角数据处理的数学模型
飞机的方位角θAZ、方位角的变化速度及方位角变化加速度可用下面的差分方程描述:
式中:θAZ(k)为飞机在k时刻测得的方位角;
θAZ(k+1)为飞机在k+1时刻测得的方位角;
为k时刻飞机方位角的变化速度;
为k时刻飞机方位角变化加速度;
Tk为k+1时刻方位功能距k时刻方位功能的时间间隔。
这样飞机方位角的状态方程和量测方程可表示为:
XAZ(k+1)=φAZ·X(k)+GAZwAZ(k) (7)
θAZ(k)=HAZ·XAZ(k)+vAZ(k) (8)
其中:(7)式为方位角的状态方程,(8)式为方位角的量测方程
为k时刻的方位角状态矢量;
XAZ(k+1)为k+1时刻的方位角状态矢量;
θAZ(k)为在k时刻机载设备测得的方位角;
为k时刻机载设备测得方位角的变化速度;
为k时刻机载设备测得方位角变化加速度;
Tk为当前k+1时刻方位功能距k时刻方位功能的时间间隔;
HAZ=[1 0 0],为方位角测量矩阵;
为方位角状态转移矩阵;
为方位角动态噪声矩阵;
wAZ(k)是过程噪声;
vAZ(k)是测量噪声(其中,过程噪声wAZ(k)与观测噪声vAZ(k)是互不相关的零均值白噪声)。
步骤二:建立仰角数据处理的数学模型
仰角的数学模型可用下面的差分方程描述:
式中:θEL(n)为在n时刻飞机测得的仰角;
θEL(n+1)为在n+1时刻飞机测得的仰角;
表示n时刻飞机仰角的变化速度;
表示n时刻飞机仰角变化的加速度;
Tn为当前n+1时刻仰角功能距n时刻仰角功能的时间间隔。
这样飞机仰角的状态方程和量测方程为:
XEL(n+1)=φEL·XEL(n)+GEL·wEL(n) (9)
θEL(n)=HEL·XEL(n)+vEL(n) (10)
其中:(9)式为仰角状态方程
(10)式为仰角量测方程
为n时刻的仰角状态矢量;
XEL(n+1)为n+1时刻的仰角状态矢量
HEL=[1 0 0],为仰角测量矩阵;
为仰角状态转移矩阵;
为仰角动态噪声矩阵;
θEL(n)为在n时刻机载设备测得的仰角;
表示n时刻机载设备测得的仰角变化速度;
表示n时刻机载设备测得的仰角变化的加速度;
Tn为当前n+1时刻仰角功能距n时刻仰角功能的时间间隔;
wEL(n)是过程噪声;
vEL(n)是测量噪声(其中,过程噪声WEL(n)与观测噪声vEL(n)是互不相关的零均值白噪声)。
步骤三:建立距离数据处理的数学模型
距离的数学模型与角度相同,可用下面的差分方程描述:
式中:L(m)为在m时刻测得飞机距DME/P天线的距离;
L(m+1)为在m+1时刻测得飞机距DME/P天线的距离;
表示m时刻距离变化速度;
表示在m时刻距离变化的加速度;
Tm为m+1测距应答时刻距m测距应答时刻的时间间隔。
这样距离的状态方程和量测方程为:
XL(m+1)=φL·XL(m)+GL·wL(m) (11)
L(m)=HL·XL(m)+vL(m) (12)
其中:(11)式为距离状态方程
(12)式为距离量测方程
为m时刻的距离状态矢量;
XL(m+1)为m+1时刻的距离状态矢量;
HL=[1 0 0],为距离测量矩阵;
为距离状态转移矩阵;
为距离动态噪声矩阵;
L(m)表示m时刻机载设备测得飞机距DME/P天线相位中心的距离;
表示m时刻机载设备测得飞机距DME/P天线相位中心距离变化速度;
表示m时刻机载设备测得飞机距DME/P天线相位中心距离加速度;
Tm为当前m+1测距应答时刻距m测距应答时刻的时间间隔;
wL(m)是过程噪声;
vL(m)是测量噪声(过程噪声wL(m)与观测噪声vL(m)是互不相关的零均值白噪声序列)。
步骤四:根据微波着陆的功能识别码,判断输入功能类型
●如果是方位功能,则进行第5步操作,对方位角进行Kalman滤波;
●如果是仰角功能,则进行第6步操作,对仰角进行Kalman滤波;
●如果是测据功能,则进行第7步操作,对距离进行Kalman滤波。
步骤五:对方位角进行滤波处理
●采用Kalman算法对方位角进行滤波,Kalman算法具体递推公式如下:
一步预测均方误差阵:
滤波增益矩阵:
滤波均方差阵:Pk=(I-Kk·Hk)Pk/k-1
状态滤波值:
状态一步预测值:
●采用Kalman算法进行滤波用到的变量
这里,滤波器从k=4时刻开始工作,其中:
初始协方差阵
Tk为本次方位功能与上一次方位功能的时间间隔
Rwk-1为方位角的扰动噪声方差
Hk=HAZ=[1 0 0]
Rvk为方位角观测噪声协方差阵
zk为方位角测量值θAZ(k)
●方位角滤波的初始值设置
zk为方位角测量值:z1=θAZ(1),z2=θAZ(2),z3=θAZ(3)
方位角速度:
方位角加速度:
方位角的状态矢量:
T1表示时刻2的方位功能距时刻1方位功能的时间间隔;
T2表示时刻3的方位功能距时刻2方位功能的时间间隔。
这样,由Kalman滤波算法可计算得到方位功能时刻的方位角θAZ(k)、方位角变化速度和变化加速度
步骤六:对仰角进行滤波处理
采用Kalman算法对仰角进行滤波,可计算得到仰角功能时刻的仰角θEL(n)、仰角变化速度和变化加速度
●采用Kalman算法进行滤波用到的变量
滤波从n=4时刻开始
初始协方差阵
Tk为本次仰角功能与上一次仰角功能的时间间隔
Rwn-1为仰角的扰动噪声方差
Hk=HEL=[1 0 0]
Rvk为仰角观测噪声协方差阵
zk为仰角测量值θEL(n)
●仰角滤波的初始值设置
zk为仰角测量值:z1=θEL(1),z2=θEL(2),z3=θEL(3)
仰角速度:
仰角加速度:
仰角的状态矢量:
T1表示时刻2的仰角功能距时刻1仰角功能的时间间隔;
T2表示时刻3的仰角功能距时刻2仰角功能的时间间隔。
步骤七:对距离信息进行滤波处理
采用Kalman算法对距离进行滤波,可计算得到测距应答时刻飞机距DME/P天线的距离L(m)、速度和加速度。
●采用Kalman算法进行滤波用到的变量
滤波从m=4时刻开始
初始协方差阵
Tk为本次距离功能与上一次距离功能的时间间隔
Rwn-1为距离的扰动噪声方差
Hk=HL=[1 0 0]
Rvk为距离观测噪声协方差阵
zk为距离测量值L(m)
●距离滤波的初始值设置
zk为距离测量值:z1=L(1),z2=L(2),z3=L(3)
距离速度:
距离加速度:
距离的状态矢量:
T1表示时刻2的距离功能距时刻1距离功能的时间间隔;
T2表示时刻3的距离功能距时刻2距离功能的时间间隔。
步骤八:计算仰角功能时刻距前一方位功能的时间差
微波着陆系统采用时分体制,各功能数据占有一定时隙,都有“前导”信号,该信号包括载波截获段、接收机基准时间码和功能识别码,载波截获段是一段未经调制的纯载波,其作用是用于接收机载波跟踪与同步,以便进行数据信号的相关解调。微波着陆的基准时间码采用5位Baker码,通过相关运算,使接收机产生一个时间基准,用于数字信号的解调;功能识别码的作用是说明所收到的时隙的功能是什么,共占7个比特。
以方位、仰角功能第五位Baker码的中点为计时点,计算仰角功能距前一方位功能的时间差ΔTk。
步骤九:计算方位功能时刻距前一仰角功能的时间差
与计算仰角功能时刻距前一方位功能时间差方法相同,以方位功能、仰角功能第五位Baker码的中点为计时点,计算方位功能距前一仰角功能的时间差ΔTn。
步骤十:计算角功能与前一测距应答信号的时间差
由于测距与测角功能分别由两套接收机来完成,计算机载测距设备应答信号与测角信号经相关运算后的相关峰值的时间差,就可得到角功能时刻距测距应答信号的时间差ΔTL,以图3、图4信号为例,A点为测距应答信号时刻,则:ΔTL为接收机收到测距应答信号距角功能第五位Baker码中点时刻的时间间隔。
步骤十一:计算仰角功能时刻,实时的方位角
由步骤一可计算得到仰角功能前一时刻的方位角θAZ(k)、方位角变化速度及方位角加速度由于方位和仰角功能的时间长度不同,以两功能的扫描中点时间来计算,此时方位功能与仰角功能的时间差为ΔTk,此时仰角功能时刻的方位角为:
注:ΔTk单位为秒。
这样就得到在仰角功能时刻的实时方位角值。
步骤十二:计算方位功能时刻,实时的仰角
与上面步骤方法相同,可由步骤二计算得到方位功能前一时刻仰角为θEL(n),方位角变化速度角加速度此时方位功能与仰角功能的时间差为ΔTn,以两功能的扫描中点来计算,此时仰角功能时刻的方位角为:
注:ΔTn单位为秒
这样就得到在方位功能时刻的实时仰角值。
步骤十三:计算角功能时刻,实时的距离值
由步骤三可计算得到角功能前一时刻的距离为L(m),距离变化速度加速度此时测距应答信号与角功能扫描中点的时间差为ΔTL,则测角功能时刻(包括方位和仰角)的距离为:
注:ΔTL单位为秒
这样就得到在测角功能时刻实时的距离值。
步骤十四:确定飞机在方位功能时刻实时位置信息
飞机在方位功能时刻实时位置信息如下:
方位角θAZ(k),(由机载设备测得);
仰角θEL(n+1),(由步骤十二得到);
距离L(m+1),(由步骤十三计算得到)。
步骤十五:确定飞机在仰角功能时刻实时位置信息
飞机在仰角功能时刻实时位置信息如下:
仰角θEL(n),(由机载设备测得);
方位角θAZ(k+1),(由步骤十一得到);
距离L(m+1),(步骤十三计算得到)。
步骤十六:将飞机在方位、仰角功能时刻实时位置信息进行坐标变换,得到飞机相对于着陆点的坐标
坐标变换方法如下:
1.将步骤十五、步骤十六计算得出的飞机分别在方位功能及仰角功能时刻方位角θAZ、仰角θEL及距离L用方位台、仰角台、测距台及飞机的坐标表示
由图1所示的坐标系,得到下列关系式:
其中:方位台天线相位中心坐标为(XA,YA,ZA);
仰角台天线相位中心坐标为(XE,YE,ZE);
DME/P天线相位中心坐标为(XD,YD,ZD);
飞机坐标为(XT,YT,ZT)。
2.设定飞机的初始位置
X0=L+XA
Y0=X0·sin(θAZ)
3.以方位天线相位中心为原点,将方位台、仰角台及精密测距台进行平移
平移结果如下:
飞机坐标为:Xi′=Xi-XA Yi′=Yi-YA Zi′=Zi-ZA
方位台坐标为:XA′=XA-XA YA′=YA-YA ZA′=ZA-ZA
仰角台坐标为:XE′=XE-XA YE′=YE-YA ZE′=ZE-ZA
精密测距台坐标为:XD′=XD-XA YD′=YD-YA ZD′=ZD-ZA
4.设定在水平面上围绕Z轴进行坐标旋转初始角
(sinθp)0={1+(Z0-ZA)2/[(X0-XA)2+(Y0-YA)2]}1/2·sinθAZ
5.在水平面上围绕Z轴进行坐标旋转
经过变换后,飞机在Y轴方向的值为0,即
可得:
6.对飞机坐标和旋转角度进行迭代运算
当迭代运算达到所需的精度时,用X*、Y*、Z*的结果表示X′、Y′、Z′的值。
7.对坐标系进行平移,可得出飞机相对于着陆点的坐标
XT=X′+XA
YT=Y′+YA
ZT=Z′+ZA
步骤十七:返回步骤四,等待对下一微波着陆功能数据的处理。
下面以图3所示的信号流为例说明进行微波着陆测角、测距数据处理过程,并与常规坐标变换结果进行比较:
1.确定地面设备相对于着陆点的坐标
方位台天线相位中心(3000m,0m,3m);
仰角台天线相位中心(0m,100m,2.8m);
DME/P天线相位中心(3000m,5m,3m)。
2.计算飞机在仰角功能时刻距DME/P台的距离值
计算所用到的参数如下:
a.飞机距DME/P台距离L=10000m
b.设经Kalman滤波运算得到飞机此时的径向飞行速度:径向飞行加速度:
c.飞机收到测距应答信号距仰角功能扫描中点的时间间隔
ΔTL=11.6ms
则飞机在仰角功能时刻的距离为:
3.计算飞机仰角功能时刻的方位值
计算所用到的参数如下:
a.测角接收机在方位功能测得的方位角为3°,设经Kalman滤波运算得到飞机在方位功能时的角度变化率为:角加速度为:
b.测角接收机测得的仰角为4°。
c.方位功能与仰角功能的时间间隔为:0.0168s
d.计算飞机在仰角功能时刻的方位角
4.分别采用常规坐标变换及本发明两种方法进行计算
a.常规坐标变换所用的参数
飞机距DME/P台距离:L=10000m;
接收机在方位功能测得的方位角为3°;
接收机测得的仰角为4°。
b.采用本发明进行坐标变换的参数
接收机测得的仰角为4°;
飞机在仰角功能时刻的方位角:3.0049°
飞机在仰角功能时刻的距离值:10008.123m
c.计算结果
采用两种参数进行坐标变换,计算结果如表1、表2所示:
表1 本发明与常规算法坐标变换后相对于着陆点的距离、方位及下滑角
表2 本发明与常规算法坐标变换后相对于着陆点坐标
常规算法 | 本发明算法 | 两种方法偏差 | |
XT | 6974m | 6982.1m | 8.1m |
YT | -523.35m | -524.63m | -1.28m |
ZT | 492.42m | 492.98m | 0.56m |
可以看出,两种方法计算结果存在一定的差别,角度变化速度及加速度变化越快,这种差异也就越明显,采用本发明进行坐标变换更能真实反映出飞机的实时位置,提高飞机的导航精度。
Claims (1)
1.一种微波着陆机载设备测角、测距数据处理方法,其特征在于包括下述步骤:
1)建立方位角的数学模型,其中,方位角状态方程XAZ(k+1)=φAZ·XAZ(k)+GAZwAZ(k),方位角量测方程θAZ(k)=HAZ·XAZ(k)+vAZ(k),为方位角k时刻的状态矢量;XAZ(k+1)为方位角k+1时刻的状态矢量;θAZ(k)为k时刻机载设备测得的方位角;为k时刻机载设备测得方位角的变化速度;为k时刻机载设备测得方位角变化加速度;Tk为当前k+1时刻方位功能距k时刻方位功能的时间间隔;HAZ=[1 0 0],为方位角测量矩阵;为方位角状态转移矩阵;为方位角动态噪声矩阵;wAZ(k)是过程噪声;vAZ(k)是测量噪声;过程噪声wAZ(k)与测量噪声vAZ(k)是互不相关的零均值白噪声;
2)建立仰角数据处理的数学模型,其中,仰角状态方程XEL(n+1)=φEL·XEL(n)+GELwEL(n),仰角量测方程θEL(n)=HEL·XEL(n)+vEL(n),为仰角在n时刻的状态矢量;XEL(n+1)为仰角在n+1时刻的状态矢量;HEL=[1 0 0],为仰角测量矩阵;为仰角状态转移矩阵;为仰角动态噪声矩阵;θEL(n)为在n时刻机载设备测得的仰角;表示n时刻机载设备测得的仰角变化速度;表示n时刻机载设备测得的仰角变化的加速度;Tn为当前n+1时刻仰角功能距n时刻仰角功能的时间间隔;wEL(n)是过程噪声;vEL(n)是测量噪声;过程噪声wEL(n)与观测噪声vEL(n)是互不相关的零均值白噪声;
3)建立距离数据处理的数学模型,其中,距离状态方程XL(m+1)=φL·XL(m)+GL·wL(m),距离量测方程L(m)=HL·XL(m)+vL(m),为m时刻的距离状态矢量;XL(m+1)为m+1时刻距离的状态矢量;HL=[1 0 0],为距离测量矩阵;为距离状态转移矩阵;为距离动态噪声矩阵;L(m)表示m时刻机载设备测得飞机距DME/P天线相位中心的距离;表示m时刻机载设备测得飞机距DME/P天线相位中心距离变化速度;表示m时刻机载设备测得飞机距DME/P天线相位中心距离加速度;Tm为当前m+1测距应答时刻距m测距应答时刻的时间间隔;wL(m)是过程噪声;
vL(m)是测量噪声;过程噪声wL(m)与测量噪声vL(m)是互不相关的零均值白噪声序列;
4)根据微波着陆的功能识别码,判断输入功能类型:
如果是方位功能,则进行第5)步操作;
如果是仰角功能,则进行第6)步操作;
如果是测据功能,则进行第7)步操作;
5)采用Kalman滤波算法对方位角进行滤波处理,得到方位功能时刻的方位角θAZ(k)、方位角变化速度和变化加速度
6)采用Kalman滤波算法对仰角数据进行滤波处理,计算仰角功能时刻的仰角θEL(n)、仰角变化速度和变化加速度
7)采用Kalman滤波算法对仰角数据进行滤波处理,计算测距应答时刻的距离L(m)、距离变化速度和变化加速度
8)以方位、仰角功能第五位Baker码中点时刻为计时点,计算仰角功能距前一方位功能的时间差ΔTk;
9)以方位功能、仰角功能第五位Baker码中点时刻为计时点,计算方位功能距前一仰角功能的时间差ΔTn;
10)计算机载测距设备应答信号与测角信号经相关运算后的相关峰的时间差,得到测角功能时刻距测距应答信号的时间差ΔTL;
11)计算仰角功能时刻对应的实时方位角
12)计算方位功能时刻对应的实时仰角
13)计算测角功能时刻,对应的实时距离值
14)确定飞机在方位功能时刻实时位置信息,包括方位角θAZ(k)、仰角为θEL(n+1)和距离L(m+1);
15)确定飞机在仰角功能时刻实时位置信息,包括方位角为θAZ(k+1)、仰角θEL(n)和距离L(m+1);
16)将飞机在方位、仰角功能时刻的实时位置信息进行坐标变换,得到飞机相对于着陆点的坐标;
17)返回第4)步,等待对下一微波着陆功能数据的处理。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410757105.1A CN104515974B (zh) | 2014-12-10 | 2014-12-10 | 微波着陆机载设备角度、测距数据处理方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410757105.1A CN104515974B (zh) | 2014-12-10 | 2014-12-10 | 微波着陆机载设备角度、测距数据处理方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104515974A CN104515974A (zh) | 2015-04-15 |
CN104515974B true CN104515974B (zh) | 2017-02-22 |
Family
ID=52791566
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410757105.1A Active CN104515974B (zh) | 2014-12-10 | 2014-12-10 | 微波着陆机载设备角度、测距数据处理方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104515974B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105571593B (zh) * | 2015-11-27 | 2018-08-31 | 中国电子科技集团公司第二十研究所 | 一种基于mls的地理位置信息获取方法 |
CN106597382A (zh) * | 2016-12-15 | 2017-04-26 | 中国电子科技集团公司第二十研究所 | 模拟滤波特性对微波着陆相位信号解算影响的分析方法 |
CN106896347B (zh) * | 2017-03-14 | 2019-04-23 | 西安电子科技大学 | 一种产生微波着陆方位信号中扫描信号的方法 |
CN109507650B (zh) * | 2018-11-07 | 2020-09-01 | 中电科仪器仪表有限公司 | 一种微波着陆全数字多径干扰信号模拟方法及系统 |
CN109540153B (zh) * | 2019-01-23 | 2023-04-25 | 西安合众思壮防务科技有限责任公司 | 一种微波着陆系统引导飞机折线进场的方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0498655B1 (en) * | 1991-02-08 | 1996-08-28 | Rockwell International Corporation | Integrated enroute and approach guidance system for aircraft |
CN102353970A (zh) * | 2011-06-10 | 2012-02-15 | 北京航空航天大学 | 一种高抗干扰性能gps/sins组合导航系统及实现方法 |
CN103630136A (zh) * | 2013-12-05 | 2014-03-12 | 中国航空无线电电子研究所 | 冗余传感器配置下基于三级滤波的导航参数最优融合方法 |
-
2014
- 2014-12-10 CN CN201410757105.1A patent/CN104515974B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0498655B1 (en) * | 1991-02-08 | 1996-08-28 | Rockwell International Corporation | Integrated enroute and approach guidance system for aircraft |
CN102353970A (zh) * | 2011-06-10 | 2012-02-15 | 北京航空航天大学 | 一种高抗干扰性能gps/sins组合导航系统及实现方法 |
CN103630136A (zh) * | 2013-12-05 | 2014-03-12 | 中国航空无线电电子研究所 | 冗余传感器配置下基于三级滤波的导航参数最优融合方法 |
Non-Patent Citations (2)
Title |
---|
High Accuracy Navigation and Landing System Using GPS/IMU System Integration;Dr.-Ing. Jochen Meyer-Hilberg and Dr.-Ing. Thomas Jacob;《IEEE Aerospace and Electronic Systems Magazine》;19940731;第9卷(第7期);第11-17页 * |
微波着陆系统(MLS)接收机的数字信号处理;白磊;《中国优秀硕士学位论文全文数据库 信息科技辑》;20111215;第10-34页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104515974A (zh) | 2015-04-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104515974B (zh) | 微波着陆机载设备角度、测距数据处理方法 | |
CN107817469B (zh) | 基于非视距环境下超宽频测距实现室内定位方法 | |
CN109548141B (zh) | 基于卡尔曼滤波算法的室内环境基站坐标位置标定方法 | |
CN103105611B (zh) | 一种分布式多传感器智能信息融合方法 | |
CN104076353B (zh) | 一种面目标回波波束中心速度测量方法 | |
CN103869311B (zh) | 实波束扫描雷达超分辨成像方法 | |
CN112073895A (zh) | 一种基于csi高精度人员定位跟踪方法 | |
CN101839976B (zh) | 利用北斗一号终端进行雷达系统误差估计的方法 | |
CN109991567B (zh) | 一种水下滑翔机四面体阵三维被动测向方法 | |
CN105044667B (zh) | 一种运动目标的双星跟踪方法、装置和系统 | |
CN103048658A (zh) | 基于径向加速度的RA-Singer-EKF机动目标跟踪算法 | |
CN111199280B (zh) | 短波信道模型误差存在下联合信号复包络和载波相位信息的多站目标源地理坐标估计方法 | |
CN113342059B (zh) | 基于位置和速度误差的多无人机跟踪移动辐射源方法 | |
CN107942314A (zh) | 基于lasso特征提取的多普勒穿墙雷达定位方法 | |
CN103630875A (zh) | 一种射频识别定位方法及装置 | |
CN108680941A (zh) | 一种基于单站点的飞行器定位系统及方法 | |
CN104507097A (zh) | 一种基于WiFi位置指纹的半监督训练方法 | |
CN108983169B (zh) | 一种基于数字高程模型的米波雷达地形修正方法 | |
Zwirello et al. | Localization in industrial halls via ultra-wideband signals | |
CN112666517A (zh) | 一种基于时差测量的小型无人机信号定位系统及方法 | |
CN103096465A (zh) | 一种环境自适应的多目标直接定位方法 | |
CN111199281A (zh) | 基于地理坐标空域位置谱的短波单站直接定位偏差补偿方法 | |
CN107154533A (zh) | 低复杂度的ads‑b抗干扰阵列天线有源校正方法 | |
CN117146830B (zh) | 一种自适应多信标航位推算和长基线的紧组合导航方法 | |
CN113075616B (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 |