CN113820733B - 一种基于定向天线和多普勒信息的运动载体导航方法和装置 - Google Patents

一种基于定向天线和多普勒信息的运动载体导航方法和装置 Download PDF

Info

Publication number
CN113820733B
CN113820733B CN202110845079.8A CN202110845079A CN113820733B CN 113820733 B CN113820733 B CN 113820733B CN 202110845079 A CN202110845079 A CN 202110845079A CN 113820733 B CN113820733 B CN 113820733B
Authority
CN
China
Prior art keywords
carrier
beacon
motion
directional antenna
information
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
Application number
CN202110845079.8A
Other languages
English (en)
Other versions
CN113820733A (zh
Inventor
郭金库
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Xi'an Daheng Tiancheng It Co ltd
Original Assignee
Xi'an Daheng Tiancheng It Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Xi'an Daheng Tiancheng It Co ltd filed Critical Xi'an Daheng Tiancheng It Co ltd
Priority to CN202110845079.8A priority Critical patent/CN113820733B/zh
Publication of CN113820733A publication Critical patent/CN113820733A/zh
Application granted granted Critical
Publication of CN113820733B publication Critical patent/CN113820733B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/393—Trajectory determination or predictive tracking, e.g. Kalman filtering
    • 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
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13—Receivers
    • G01S19/24—Acquisition or tracking or demodulation of signals transmitted by the system
    • G01S19/29—Acquisition or tracking or demodulation of signals transmitted by the system carrier including Doppler, related
    • 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
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • 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
    • Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
    • Y02D30/00—Reducing energy consumption in communication networks
    • Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks

Abstract

一种基于定向天线和多普勒信息的运动载体导航方法，已知运动载体的精确初始位置、固定或者移动的信标位置信息，基于定向天线的天线波束控制系统利用惯性测量组件或惯性导航系统辅助，在运动载体的运动过程中保持定向天线始终对准信标，输出对准时的运动载体姿态角及姿态角偏差；利用多普勒频移跟踪模块接收定向天线获得的信标信号，并测量获得信标信号中由于运动载体运动带来的多普勒频率信息，修正惯性测量组件或者惯性导航系统的误差，得到修正后的运动载体导航位置信息。本发明还提供了相应的导航装置，可实现在GPS/BD等导航定位系统失效的情况下，为车辆、舰船、飞机、导弹等运动载体提供满足一定精度的导航定位信息。

Description

一种基于定向天线和多普勒信息的运动载体导航方法和装置
技术领域
本发明属于运动平台导航技术领域，特别涉及一种基于定向天线和多普勒信息的运动载体导航方法和装置。
背景技术
目前车辆、舰船、飞机、导弹等运动载体普遍采用惯性、卫星以及各种组合导航技术。然而GPS/BD等导航定位系统由于导航终端普遍采用全向天线(尽管已有各种抗干扰天线出现和应用)，非常容易被干扰和欺骗。在复杂环境和对抗环境下，各运动载体不能仅依赖卫星导航作为手段。惯性导航方式可以实现自主导航，但其误差会随时间积累，对于长时间、高精度导航来说其精度难以满足要求。当前无人系统发展迅速，智能化程度越来越高，对高精度抗干扰导航要求非常迫切。
发明内容
为了克服上述现有技术的缺点，针对运动载体导航需求，本发明的目的在于提供一种基于定向天线和多普勒信息的运动载体导航方法和装置，能够实现在GPS/BD等导航定位系统失效的情况下，利用地球同步通信卫星等固定或移动信标的位置和信标信号，在运动载体上进行信号处理，从而实现一种低成本的应急导航定位系统，满足车辆、舰船、飞机、导弹等运动载体的一定精度导航定位信息。
为了实现上述目的，本发明采用的技术方案是：
一种基于定向天线和多普勒信息的运动载体导航方法，包括以下步骤：
S1：已知运动载体的精确初始位置、固定或者移动的信标位置信息，所述运动载体搭载有定向天线；
S2：基于所述定向天线的天线波束控制系统利用惯性测量组件或惯性导航系统辅助，在运动载体的运动过程中保持定向天线始终对准信标，输出对准时的运动载体姿态角及运动载体姿态角偏差；
S3：利用多普勒频移跟踪模块接收定向天线获得的信标信号，并测量获得信标信号中由于运动载体运动带来的多普勒频率信息；
S4：基于定向天线对准信标时运动载体姿态角及运动载体姿态角偏差、信标位置信息以及运动载体接收到的信标信号多普勒频率信息，修正惯性测量组件或者惯性导航系统的误差，最后输出修正后的运动载体导航位置信息。
本发明的一个实施例，所述S1中：
当固定或者移动的信标有多个时，选择使用多个定向天线，S2、S3中实现多个波束对准多个信标，并获得多个多普勒频率和波束指向信息；S4导航计算时利用多个多普勒频率和波束指向信息，提高修正的精度。
本发明所述运动载体可为导弹、飞机、舰船或车辆，所述固定的信标可为地球同步通信卫星，所述移动的信标可为地球非同步轨道通信卫星，所述定向天线可为反射面天线、平板天线或相控阵天线。
本发明的一个实施例，所述S2中，包括以下步骤：
S2.1：在运动载体的运动过程中，在惯性测量组件或惯性导航系统的辅助下，获得运动载体的运动信息，即运动载体的经纬度信息、姿态角以及姿态角变化率；
S2.2：利用运动载体的经纬度信息、姿态角以及信标位置确定定向天线的天线波束在地理系的方位角A、俯仰角E、极化角V，并利用天线波束控制系统实现波束调整，使定向天线初步对向信标，实现信标信号的捕获；
S2.3：定向天线捕获到信标信号后，以信号极大值方式精对准信标，完成信标稳定跟踪，并得到精对准时定向天线的天线波束在地理系实际的方位角AT与俯仰角ET；
S2.4：实现波束跟踪后，根据方位角和俯仰角控制偏差信号，获得运动载体的姿态角偏差，所述运动载体的姿态角偏差即方位角A、俯仰角E与实际的方位角AT、俯仰角ET之间的偏差。
本发明的一个实施例，所述定向天线的天线波束在地理系的方位角A、俯仰角E、极化角V如下：
其中，L为运动载体所在点的纬度，pi为π，λ为运动载体的经度，λs为信标星下点的经度；
所述S2.3中，捕获信标信号后，对A、E进行精对准，即调制天线波束方向，直至接收到的信标信号能量最大，此时即认为实现了精对准，精对准后即得到定向天线的天线波束在地理系实际的方位角AT与俯仰角ET。
本发明的一个实施例，所述信标信号中由于运动载体运动带来的多普勒频率信息包括真实的多普勒频率和多普勒频率误差δf，其中：
δf＝δvr·ers·c/fcarrier＝δva·c/fcarrier
式中：vr是运动载体在ECEF(地心地固坐标系)坐标系中的速度，δvr是运动载体在ECEF坐标系中的速度误差，vs是信标在ECEF坐标系中的速度，ers是运动载体到信标的视线方向在ECEF坐标系中的单位矢量，c是光速，fcarrier是载波频率，δva是运动载体在运动载体到卫星视频方向的速度误差。
本发明还提供了一种基于定向天线和多普勒信息的运动载体导航装置，包括：
惯性测量组件或者惯性导航系统：搭载于运动载体，用于获取运动载体的运动信息，即运动载体经纬度信息、运动载体的姿态角以及姿态角变化率；
定向天线：搭载于运动载体，用于产生具有明显方向性的天线波束
波束控制模块：搭载于运动载体，利用运动载体经纬度信息、运动载体的姿态角以及信标位置确定定向天线的方位角、俯仰角，并按照信号能量最大的原则控制波束调整，实现定向天线精准对信标；
多普勒频移跟踪模块：搭载于运动载体，完成信标信号的滤波、处理和多普勒频率跟踪，获得多普勒频移信息；
导航计算模块：搭载于运动载体，根据定向天线对准信标时的运动载体姿态角及姿态角偏差、信标位置信息、运动载体接收到的信标信号多普勒频率信息，修正惯性测量组件或者惯性导航系统的误差，输出修正后的运动载体导航位置信息。
本发明的一个实施例，所述定向天线的主瓣用于接收信号，主瓣的宽度尽量窄并且增益高，天线覆盖频率应当能够满足接收跟踪信标信号的要求，副瓣应尽可能小以增强抗干扰性。
与现有技术相比，本发明的有益效果是：运动载体的初始精确位置和信标的位置为已知条件。惯性测量组件IMU或者惯性导航系统INS存在积累误差，但在短时间内其输出的运动载体经纬度信息、运动载体的姿态角以及姿态角变化率能够满足定向天线初步捕获信标信号；定向天线捕获到信标信号后，以波束控制模块以信号极大值方式自动对准信标，完成信标稳定跟踪，这种方式可以实现得到此时运动载体定向天线的指向信息即运动载体的姿态角偏差；多普勒频移跟踪模块可以获得运动载体和信标间的相对运动多普勒频移信息；根据运动载体的姿态角及姿态角偏差、信标位置信息、运动载体接收到的信标信号多普勒频率信息作为输入，可以用来修正惯性测量组件IMU或者惯性导航系统 INS的运动载体经纬度信息、运动载体的姿态角以及姿态角变化率，从而输出修正后的运动载体导航位置信息。
附图说明
图1为本发明导航方法步骤图。
图2为本发明导航装置原理示意图。
图3为本发明导航装置原理框架图。
图4为本发明一个实例中运动载体、卫星信标以及坐标关系示意图。
图5为本发明一个实例中运动载体位置修正前后对比图。
图6为本发明一个实例组合导航中，估计的载体在东向与北向姿态角的误差，单位为角秒。
图7为本发明一个实例的组合导航中，估计的载体在天向姿态角的误差，单位为角分。
图8为本发明一个实例的组合导航中，估计的载体的速度误差，单位为m/s。
图9为本发明一个实例的组合导航中，估计的载体的位置误差，单位为m。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。通常在此处附图中描述和出示的本发明实施例的组件可以以各种不同的配置来布置和设计。因此，以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围，而是仅仅表示本发明的选定实施例。基于本发明的实施例，本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本发明保护的范围。
如图1所示，本发明提供了一种基于定向天线和多普勒信息的运动载体导航方法，包括以下步骤：
S1：已知运动载体的精确初始位置、固定或者移动的信标位置信息，所述运动载体搭载有定向天线。
在本发明中，运动载体可为导弹、飞机、舰船或车辆等，固定的信标可为地球同步通信卫星等，移动的信标可为地球非同步轨道通信卫星等。定向天线可为反射面天线、平板天线或各种类型相控阵天线。
当固定或者移动的信标有多个时，可根据使用环境和其它限制优化固定选择其中一个，并根据策略在运行过程中切换，也可选择多个信标，并选择使用多个定向天线。
S2：基于所述定向天线的天线波束控制系统利用惯性测量组件(IMU)或惯性导航系统(INS)辅助，在运动载体的运动过程中保持定向天线始终对准信标，输出对准时的运动载体姿态角及运动载体姿态角偏差。具体包括以下步骤：
S2.1：在运动载体的运动过程中，在惯性测量组件或惯性导航系统的辅助下，获得运动载体的运动信息，即运动载体的经纬度信息、姿态角以及姿态角变化率；
S2.2：利用运动载体的经纬度信息、姿态角以及信标位置确定定向天线的天线波束在地理系的方位角A、俯仰角E、极化角V，并利用天线波束控制系统实现波束调整，使定向天线初步对向信标，实现信标信号的捕获；
S2.3：定向天线捕获到信标信号后，以信号极大值方式精对准信标，完成信标稳定跟踪，并得到精对准时定向天线的天线波束在地理系实际的方位角AT与俯仰角ET；
S2.4：实现波束跟踪后，根据方位角和俯仰角控制偏差信号，获得运动载体的姿态角偏差，所述运动载体的姿态角偏差即方位角A、俯仰角E与实际的方位角AT、俯仰角ET之间的偏差。
运动载体运动过程中，IMU或INS不断的测量出车体的姿态变化，并利用波束控制系统调整波束指向，以保证定向天线波束始终指向信标并持续跟踪。
S3：利用多普勒频移跟踪模块接收定向天线获得的信标信号，并测量获得信标信号中由于运动载体运动带来的多普勒频率信息。当S1选择多个信标和多个定向天线时，多个波束对准多个信标，可获得多个多普勒频率和波束指向信息。
S4：基于定向天线对准信标时运动载体姿态角及运动载体姿态角偏差、信标位置信息以及运动载体接收到的信标信号多普勒频率信息，修正惯性测量组件或者惯性导航系统的误差，最后输出修正后的运动载体导航位置信息。当S1 选择多个信标和多个定向天线时，导航计算利用多个多普勒频率和波束指向信息，提高修正的精度。
本发明利用定向天线指向信息、运动载体姿态角偏差、信标位置信息、多普勒信息修正得到的导航信息可以修正惯性测量组件IMU或者惯性导航系统 INS的误差累积，实现高精度的导航信息输出；上述方法和装置仅利用定向天线接收\跟踪信标信号，由于运动载体不断运动，干扰或欺骗信号难以通过定向天线主瓣进入，是一种抗干扰的导航方法。
参考图2和图3，本发明还提供了一种基于定向天线和多普勒信息的运动载体导航装置，包括：
惯性测量组件或者惯性导航系统：搭载于运动载体，用于获取运动载体的运动信息，即运动载体经纬度信息、运动载体的姿态角以及姿态角变化率。
定向天线：搭载于运动载体，用于产生具有明显方向性的天线波束。主瓣用于接收信号，主瓣的宽度尽量窄并且增益高，天线覆盖频率应当能够满足接收跟踪信标信号的要求，副瓣应尽可能小以增强抗干扰性。
波束控制模块：搭载于运动载体，利用运动载体经纬度信息、运动载体的姿态角以及信标位置确定定向天线的方位角、俯仰角，并按照信号能量最大的原则控制波束调整，实现定向天线精准对信标。
多普勒频移跟踪模块：搭载于运动载体，完成信标信号的滤波、处理和多普勒频率跟踪，获得多普勒频移信息。
导航计算模块：搭载于运动载体，根据定向天线对准信标时的运动载体姿态角及姿态角偏差、信标位置信息、运动载体接收到的信标信号多普勒频率信息，修正惯性测量组件或者惯性导航系统的误差，输出修正后的运动载体导航位置信息。
在本发明的一个具体实施例中，选择通信卫星作为信标，选择通信卫星或载波为跟踪信号源，运动载体、卫星信标以及坐标关系如图4所示，设运动载体(在北半球)所在点的经纬度分别为λ(东经为正，西经为负)、L；卫星星下点的经度为λs。
符号定义：
[Ve,Vn,Vu]T是运动载体在东北天坐标下的速度矢量；
[δVe,δVn,δVu]T是运动载体速度误差矢量；
[λ,L,h]T是运动载体的经-纬-高表达形式下的位置矢量；
[δλ,δL,δh]T为相应的误差矢量；
[ex,ey,ez]T是运动载体相对通信卫星视线方向在ECEF坐标系下的单位矢量；
RN地球半径，f地球的偏心率。
球面坐标系到直角坐标系的转换：
x＝(RN+h)cosLcosλ
y＝(RN+h)cosLsinλ
z＝[RN(1-f)2+h]sinL
根据图4所示：
λdelta＝λ-λsat
Xb2s＝-(Re+Hsat)·sinλdelta
Yb2s＝-(Re+Hsat)·cosλdelta·sinL
Zb2s＝(Re+Hsat)·cosλdelta·cosL-Re-Altb
其中：
化简可得：
此即为定向天线的天线波束在地理系的方位角A、俯仰角E、极化角V，可以称为静态对星角。其中，pi即为π，λ为运动载体的经度，λs为信标星下点的经度。
在S2中，运动载体运动过程中对星的过程是，通过运动载体大概的经纬度，可以算出计算出目标卫星信标在地理系的方位角A、俯仰角E、极化角V，将天线调整到相应的角度后，开始对星，捕获卫星波束后，再对波束方位角与俯仰角进行精对准，即调制天线波束方向，直至接收到的信标信号能量最大，此时即认为实现了精对准，精对准后即得到定向天线的天线波束在地理系实际的方位角AT与俯仰角ET。
在S3中，采用ECEF坐标进行处理，由LLH到ECEF的位置关系转换为：
x＝(RN+h)cosLcosλ
y＝(RN+h)cosLsinλ
z＝[RN(1-f)2+h]sinL
从LLH到ECEF的坐标转换关系为：
从ECEF到LLH的坐标转换关系为：
接收机测量信标信号中由于运动载体运动带来的多普勒频率信息包括真实的多普勒频率/>和多普勒频率误差δf：
δf＝δvr·ers·c/fcarrier＝δva·c/fcarrier
式中：
是真实的多普勒频率
δf是多普勒频率误差
c是光速
fcarrier是载波频率
vr是运动载体在ECEF坐标系中的速度
vs是目标卫星在ECEF坐标系中的速度
δvr是运动载体在ECEF坐标系中的速度误差
ers是运动载体到目标卫星的视线方向在ECEF坐标系中的单位矢量
δva是运动载体在运动载体到卫星视频方向的速度误差
由于目标卫星为赤道同步轨道卫星，vs基本为0，所以
va＝(-vesinλ-vnsinLcosλ+vucosLcosλ)ex
+(vecosλ-vnsinLsinλ+vucosLsinλ)ey
+(vncosL+vusinL)ez
式中：
Δx＝x(s)-xr＝(RN+hsat)cosλsat-(RN+hr)cosLcosλ
Δy＝y(s)-yr＝(RN+hsat)sinλsat-(RN+hr)cosLsinλ
Δz＝z(s)-zr＝-[RN(1-f)2+hr]sinL
由于式中λ和L的变化对[ex ey ez]的影响非常小，所以在微分的时候，可以将[exey ez]看成一个常量来处理。
对上式求微分，得其误差形式：
δva＝[(-vncosL-vusinL)(excosλ+eysinλ)+(-vnsinL+vucosL)ez]δL +[(vnsinLsinλ-vecosλ-vucosLsinλ)ex+(-vnsinLcosλ-vesinλ+vucosLcosλ)ez]δλ (-exsinLcosλ-eysinLsinλ+ezcosL)δvn+(-exsinλ+eycosλ)δve+ (excosLcosλ+eycosLsinλ+ezsinL)δvu
从上式可以看出，运动载体相对卫星速度(多普勒频率)对经度、纬度以及东、北、天向速度都有可观测性，利用此信息可对经度、纬度定位信息以及东、北、天向速度信息进行修正。
S4中，由于载体的姿态精确已知，在此基础上利用惯性导航得到的载体运行轨迹在空间内走向是确定的，又由S1可以精确知道载体的初始位置，则这条空间内的轨迹只受加速度传感器的零偏造成其积分的速度与位置误差。利用S3 得到的多普勒频率与速度和位置的可观性，可以估计加速度传感器的零偏，从而对速度与位置误差进行修正。
在本实施例中，构建状态空间模型如下：
表示状态过程更新方程，x是状态量组合滤波器，采用扩展卡尔曼滤波器等组合滤波器，可以对状态x进行估计。
z＝Hx+v表示量测方程，z是观测量状态空间模型，
式中，为运动载体的航向与姿态在东向、北向与天向三个方向上的误差，通过[θγ ψ]与运动载体INS当前航姿计算得到；θ是动中通系统通过波束扫描得到的惯导的俯仰角量测值；γ是惯性导航系统通过重力观测到横滚角测量值；ψ是动中通系统通过波束扫描得到的惯导的方位角量测值；δvn为运动载体的速度误差；δp为运动载体的位置误差；εb为惯性导航系统的角速度零偏；/>为惯性导航系统的加速度计零偏。
为惯性导航系统的东向误差；/>为惯性导航系统的北向误差；/>为惯性导航系统的天向误差；δva是动中通接收到的信标的多普勒频率测量出来的动中通与信标的相对速度误差；δL为利用S1计算出来的当地纬度误差；δλ为利用S1计算出来的当地经度误差；δAlt为利用气压计计算出来的当地高度误差。
其中：
F为过程更新矩阵：
式中：
表示以/>为矢量的反对称矩阵，Map＝M1+M2，/> Mvp＝(vn×)(2M1+M2)+M3，
为地球自转以及运动载体在地球表面运动产生的角速度在导航坐标系中的投影；/>是陀螺测量的角速度以及加速度计测量的比力；/>分别是陀螺测量的载体相对惯性坐标系旋转量在载体坐标系x,y,z轴上的投影，/>分别是载体比力在载体坐标系 x,y,z轴上的投影；/>是导航坐标系下的比力，/> 为运动载体在导航坐标系下的东向向速度，/>为运动载体在导航坐标系下的北向速度，/>为运动载体在导航坐标系下的天向速度；为地球自转矢量在导航坐标系中的投影；ωie＝7.2921151467×10-5rad/s，是地球自转角速度；/>为载体在地球表面运动产生的角速度在导航坐标系中的投影；L为运动载体所在位置的纬度；RMh＝RM+h,RNh＝RN+h，RM,RN分别为地球的子午圈主曲率半径和卯酉圈主曲率半径，h为海拔高度；g＝g0(1+β1sin2L+β2sin4L)-β3h，为重力加速度大小，β1＝5.27094×10-3,β2＝2.32718×10-5,β3＝2g0/Re＝3.086×10-6(1/s2)为重力加速度拟合多项式参数；/>为从载体坐标系向导航坐标系的旋转矩阵，/>表示/>中的第i列，例如/>表示/>的第2列，g0＝9.80616m/s2是重力加速度多项式常量；G为噪声输入驱动矩阵，w为状态更新的过程噪声。
H为量测矩阵：
其中：
fd1×5＝[fdve fdvn fdvu fdλ fdL]
fdve＝-exsinλ+eycosλ
fdvn＝-exsinLcosλ-eysinLsinλ+ezcosL
fdvu＝excosLcosλ+eycosLsinλ+ezsinL
I3×3是三行三列的单位矩阵，[ex,ey,ez]T是运动载体相对通信卫星视线方向在ECEF坐标系下的单位矢量；λ为运动载体的经度，L为运动载体的纬度。
采用自制的陀螺阵列IMU，更新率100Hz，以车辆作为运动载体并选择一条行驶路径。将GPS的东、北、天向速度通过坐标变换得到了运动载体相对目标卫星的LOS速度，做作量测值进行组合导航，在600秒到1200秒间GPS不再参与导航，利用上述算法进行组合导航。组合导航的结果如图5、图6～图9 所示。
其中图5中线条a表示采用本发明方法进行组合导航的位置轨迹，线条b 表示GNSS定位设备给出的参考位置轨迹，可看出基于本发明的导航与参考轨迹比较吻合。
从图6～图9可以看出，采用本方法用例的组合导航中，估计的位置误差在经度与纬度方向上最大不超过200米，可应用于在GNSS无效情况下的组合导航。
从结果可知，本发明提出的导航方法和装置可以在不依赖GNSS的情况下，有效修正IMU的积累误差，实现一定精度的导航位置输出。

Claims (7)

1.一种基于定向天线和多普勒信息的运动载体导航方法，其特征在于，包括以下步骤：
S1：已知运动载体的精确初始位置、固定或者移动的信标位置信息，所述运动载体搭载有定向天线；
S2：基于所述定向天线的天线波束控制系统利用惯性测量组件或惯性导航系统辅助，在运动载体的运动过程中保持定向天线始终对准信标，输出对准时的运动载体姿态角及运动载体姿态角偏差；
S3：利用多普勒频移跟踪模块接收定向天线获得的信标信号，并测量获得信标信号中由于运动载体运动带来的多普勒频率信息；
S4：基于定向天线对准信标时运动载体姿态角及运动载体姿态角偏差、信标位置信息以及运动载体接收到的信标信号多普勒频率信息，修正惯性测量组件或者惯性导航系统的误差，最后输出修正后的运动载体导航位置信息；
所述S2中，包括以下步骤：
S2.1：在运动载体的运动过程中，在惯性测量组件或惯性导航系统的辅助下，获得运动载体的运动信息，即运动载体的经纬度信息、姿态角以及姿态角变化率；
S2.2：利用运动载体的经纬度信息、姿态角以及信标位置确定定向天线的天线波束在地理系的方位角A、俯仰角E、极化角V，并利用天线波束控制系统实现波束调整，使定向天线初步对向信标，实现信标信号的捕获；
S2.3：定向天线捕获到信标信号后，以信号极大值方式精对准信标，完成信标稳定跟踪，并得到精对准时定向天线的天线波束在地理系实际的方位角AT与俯仰角ET；
S2.4：实现波束跟踪后，根据方位角和俯仰角控制偏差信号，获得运动载体的姿态角偏差，所述运动载体的姿态角偏差即方位角A、俯仰角E与实际的方位角AT、俯仰角ET之间的偏差。
2.根据权利要求1所述基于定向天线和多普勒信息的运动载体导航方法，其特征在于，所述S1中：当固定或者移动的信标有多个时，选择使用多个定向天线，S2、S3中实现多个波束对准多个信标，并获得多个多普勒频率和波束指向信息；S4导航计算时利用多个多普勒频率和波束指向信息，提高修正的精度。
3.根据权利要求1或2所述基于定向天线和多普勒信息的运动载体导航方法，其特征在于，所述运动载体为导弹、飞机、舰船、炮弹或车辆，所述固定的信标为地球同步通信卫星，所述移动的信标为地球非同步轨道通信卫星，所述定向天线为反射面天线、平板天线或相控阵天线。
4.根据权利要求1所述基于定向天线和多普勒信息的运动载体导航方法，其特征在于，所述定向天线的天线波束在地理系的方位角A、俯仰角E、极化角V如下：
其中，L为运动载体所在点的纬度，pi为π，λ为运动载体的经度，λs为信标星下点的经度；
所述S2.3中，捕获信标信号后，对A、E进行精对准，即调制天线波束方向，直至接收到的信标信号能量最大，此时即认为实现了精对准，精对准后即得到定向天线的天线波束在地理系实际的方位角AT与俯仰角ET。
5.根据权利要求1所述基于定向天线和多普勒信息的运动载体导航方法，其特征在于，所述信标信号中由于运动载体运动带来的多普勒频率信息包括真实的多普勒频率和多普勒频率误差δf，其中：
δf＝δvr·ers·c/fcarrier＝δva·c/fcarrier
式中：vr是运动载体在ECEF(地心地固坐标系)坐标系中的速度，δvr是运动载体在ECEF坐标系中的速度误差，vs是信标在ECEF坐标系中的速度，ers是运动载体到信标的视线方向在ECEF坐标系中的单位矢量，c是光速，fcarrier是载波频率，δva是运动载体在运动载体到卫星视频方向的速度误差。
6.一种实现权利要求1所述基于定向天线和多普勒信息的运动载体导航方法的导航装置，其特征在于，包括：
惯性测量组件或者惯性导航系统：搭载于运动载体，用于获取运动载体的运动信息，即运动载体经纬度信息、运动载体的姿态角以及姿态角变化率；
定向天线：搭载于运动载体，用于产生具有明显方向性的天线波束；
波束控制模块：搭载于运动载体，利用运动载体经纬度信息、运动载体的姿态角以及信标位置确定定向天线的方位角、俯仰角，并按照信号能量最大的原则控制波束调整，实现定向天线精准对信标；
多普勒频移跟踪模块：搭载于运动载体，完成信标信号的滤波、处理和多普勒频率跟踪，获得多普勒频移信息；
导航计算模块：搭载于运动载体，根据定向天线对准信标时的运动载体姿态角及姿态角偏差、信标位置信息、运动载体接收到的信标信号多普勒频率信息，修正惯性测量组件或者惯性导航系统的误差，输出修正后的运动载体导航位置信息。
7.根据权利要求6所述导航装置，其特征在于，所述定向天线的主瓣用于接收信号，主瓣的宽度尽量窄并且增益高，天线覆盖频率应当能够满足接收跟踪信标信号的要求，副瓣应尽可能小以增强抗干扰性。
CN202110845079.8A 2021-07-26 2021-07-26 一种基于定向天线和多普勒信息的运动载体导航方法和装置 Active CN113820733B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110845079.8A CN113820733B (zh) 2021-07-26 2021-07-26 一种基于定向天线和多普勒信息的运动载体导航方法和装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110845079.8A CN113820733B (zh) 2021-07-26 2021-07-26 一种基于定向天线和多普勒信息的运动载体导航方法和装置

Publications (2)

Publication Number Publication Date
CN113820733A CN113820733A (zh) 2021-12-21
CN113820733B true CN113820733B (zh) 2023-07-25

Family

ID=78923963

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110845079.8A Active CN113820733B (zh) 2021-07-26 2021-07-26 一种基于定向天线和多普勒信息的运动载体导航方法和装置

Country Status (1)

Country Link
CN (1) CN113820733B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116772838B (zh) * 2023-08-21 2023-10-20 成都时代宇辰科技有限公司 一种用于机械相控阵天线的惯导误差补偿的方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102353970A (zh) * 2011-06-10 2012-02-15 北京航空航天大学 一种高抗干扰性能gps/sins组合导航系统及实现方法
CN103612649A (zh) * 2013-11-25 2014-03-05 成都南中软易科技有限公司 基于激光多普勒测速的列车精确定位方法及装置
CN103995272A (zh) * 2014-06-11 2014-08-20 东南大学 一种新型惯性辅助gps接收机实现方法
CN104076349A (zh) * 2014-05-29 2014-10-01 西北大学 一种基于多普勒频移的被动式移动目标定位方法
CN110161546A (zh) * 2019-05-23 2019-08-23 杭州中科微电子有限公司 一种利用迭代加权模糊度函数法的卫星定向装置及方法
WO2020077941A1 (zh) * 2018-10-15 2020-04-23 东南大学 一种城市峡谷环境下用于测绘车辆的定位系统及方法
CN112461238A (zh) * 2020-12-14 2021-03-09 北京航天控制仪器研究所 一种动态随机布设信标的室内人员定位导航系统及方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102353970A (zh) * 2011-06-10 2012-02-15 北京航空航天大学 一种高抗干扰性能gps/sins组合导航系统及实现方法
CN103612649A (zh) * 2013-11-25 2014-03-05 成都南中软易科技有限公司 基于激光多普勒测速的列车精确定位方法及装置
CN104076349A (zh) * 2014-05-29 2014-10-01 西北大学 一种基于多普勒频移的被动式移动目标定位方法
CN103995272A (zh) * 2014-06-11 2014-08-20 东南大学 一种新型惯性辅助gps接收机实现方法
WO2020077941A1 (zh) * 2018-10-15 2020-04-23 东南大学 一种城市峡谷环境下用于测绘车辆的定位系统及方法
CN110161546A (zh) * 2019-05-23 2019-08-23 杭州中科微电子有限公司 一种利用迭代加权模糊度函数法的卫星定向装置及方法
CN112461238A (zh) * 2020-12-14 2021-03-09 北京航天控制仪器研究所 一种动态随机布设信标的室内人员定位导航系统及方法

Also Published As

Publication number Publication date
CN113820733A (zh) 2021-12-21

Similar Documents

Publication Publication Date Title
US8213803B2 (en) Method and system for laser based communication
CN109786966B (zh) 低轨卫星地面站天线的跟踪装置及其应用方法
EP4022799B1 (en) Yaw drift compensation for pointing an antenna
US11168984B2 (en) Celestial navigation system and method
US6072433A (en) Autonomous formation flying sensor
US6377211B1 (en) Apparatus and method for pointing a directional device from a moving vehicle toward a spacecraft
CN113701753A (zh) 一种基于相控阵天线的定位定向装置及方法
US8204677B2 (en) Tracking method
US8521427B1 (en) Vehicle navigation using cellular networks
US10046869B2 (en) Inertial sensing augmentation for navigation of spacecraft
US5749545A (en) Autonomous on-board satellite control system
US7877173B2 (en) Method and apparatus for determining a satellite attitude using crosslink reference signals
CN113701751A (zh) 一种基于多波束天线的导航装置
CN113794497B (zh) 一种具有抗干扰定位功能的移动卫星通信天线终端
US6216983B1 (en) Ephemeris/attitude reference determination using communications links
CN113820733B (zh) 一种基于定向天线和多普勒信息的运动载体导航方法和装置
KR100571120B1 (ko) 레이저 장치를 이용한 3차원 측위 시스템
US6133870A (en) Ephemeris determination using intersatellite ranging and ephemeris knowledge of other satellites
US20160170030A1 (en) Orientation Measurements for Drift Correction
JP2001056235A (ja) オンボード光学系および他の衛星の天体暦を用いる天体暦／姿勢基準決定システム
CN112833878B (zh) 一种近地面多源天文自主导航方法
EP1207403A1 (en) Method for determining the position of reference axes in an inertial navigation system of an object in respect with the basic coordinates and embodiments thereof
JP4295618B2 (ja) Ｇｐｓの初期化のための衛星姿勢調整
JP2002162195A (ja) 飛翔体誘導装置
LeMaster et al. Mars navigation system utilizes GPS

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
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: A navigation method and device for moving carriers based on directional antennas and Doppler information

Effective date of registration: 20231221

Granted publication date: 20230725

Pledgee: Xi'an innovation financing Company limited by guarantee

Pledgor: XI'AN DAHENG TIANCHENG IT Co.,Ltd.

Registration number: Y2023980073485

PE01 Entry into force of the registration of the contract for pledge of patent right