CN115453600A - Flight state identification method and system based on airborne double-antenna GNSS and MINS combined navigation - Google Patents
Flight state identification method and system based on airborne double-antenna GNSS and MINS combined navigation Download PDFInfo
- Publication number
- CN115453600A CN115453600A CN202211208601.2A CN202211208601A CN115453600A CN 115453600 A CN115453600 A CN 115453600A CN 202211208601 A CN202211208601 A CN 202211208601A CN 115453600 A CN115453600 A CN 115453600A
- Authority
- CN
- China
- Prior art keywords
- gnss
- state
- data
- accelerometer
- flight
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 37
- 230000003068 static effect Effects 0.000 claims abstract description 8
- 238000012937 correction Methods 0.000 claims description 21
- 238000004364 calculation method Methods 0.000 claims description 14
- 238000004458 analytical method Methods 0.000 claims description 10
- 238000002360 preparation method Methods 0.000 claims description 7
- 230000009977 dual effect Effects 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 description 9
- 239000011159 matrix material Substances 0.000 description 7
- 230000009286 beneficial effect Effects 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 4
- 238000009825 accumulation Methods 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
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/42—Determining position
- G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
- G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域technical field
本发明涉及导航技术领域,具体涉及基于机载双天线GNSS和MINS组合导航的飞行状态识别方法及系统。The invention relates to the technical field of navigation, in particular to a flight state identification method and system based on integrated navigation of airborne dual-antenna GNSS and MINS.
背景技术Background technique
组合导航的基本原理是利用信息融合技术,通过最优估计、数字滤波等信号处理方法把各种导航系统如无线电、卫星、天文、地形及景象匹配等导航系统的结合。以发挥各种导航技术优势,达到比任何单一导航方式更高的导航精度和可靠性。The basic principle of integrated navigation is to use information fusion technology to combine various navigation systems such as radio, satellite, astronomy, terrain and scene matching through signal processing methods such as optimal estimation and digital filtering. In order to give full play to the advantages of various navigation technologies, it can achieve higher navigation accuracy and reliability than any single navigation method.
与惯导相比,GNSS具有成本低,导航精度高,且误差不随时间积累等优点,GNSS导航系统输出的导航信息作为系统状态的观测量,通过卡尔曼滤波对系统的状态(位置、速度等)及误差进行最优估计,以实现对惯导系统的校准和误差补偿。而惯导系统自主、实时、连续等优点可弥补GNSS易受干扰、动态环境可靠性差的不足。Compared with inertial navigation, GNSS has the advantages of low cost, high navigation accuracy, and the error does not accumulate over time. The navigation information output by the GNSS navigation system is used as the observation of the system state, and the state of the system (position, speed, etc.) ) and the error are optimally estimated to realize the calibration and error compensation of the inertial navigation system. The advantages of inertial navigation system, such as autonomy, real-time, and continuous, can make up for the shortcomings of GNSS that are susceptible to interference and poor reliability in dynamic environments.
在不同的地貌环境中,机体会面临着各种环境干扰,还有可能会出现卫星信号失效的情况,此时组合导航系统失去了卫星量测信号的更新,姿态可能会逐渐发生漂移导致误差角度逐渐增大,影响导航系统的姿态精度。为此,需要对机体状态进行识别,并且基于不同的状态采用何种方式进行误差补偿。In different landform environments, the body will face various environmental interferences, and there may be situations where satellite signals fail. At this time, the integrated navigation system loses the update of satellite measurement signals, and the attitude may gradually drift, resulting in error angles. Gradually increasing will affect the attitude accuracy of the navigation system. To this end, it is necessary to identify the state of the body, and to use which method of error compensation based on different states.
发明内容Contents of the invention
本发明目的之一旨在提供一种基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,可根据GNSS数据的解算速度对机体状态进行判断,且在判断出机体状态后,基于不同状态,判断是否对横滚角进行修正。One of the purposes of the present invention is to provide a flight state identification method based on the integrated navigation of airborne dual-antenna GNSS and MINS, which can judge the state of the airframe according to the calculation speed of GNSS data, and after judging the state of the airframe, based on different Status, to determine whether to correct the roll angle.
基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,包括以下内容:A flight status identification method based on airborne dual-antenna GNSS and MINS integrated navigation, including the following:
对GNSS发送的数据进行解析,判断数据有效性,若GNSS数据有效,则根据GNSS数据的解算速度作为机体飞行状态判断依据,当时,判定机体处于地面准备态,此时采用GNSS数据,包括航向、俯仰角、速度和位置进行误差补偿修正,同时利用加速度计进行横滚角的修正;当时,判定机体为运动状态,此时使用GNSS数据,包括航向、俯仰角、速度、位置进行误差补偿修正,横滚角不进行误差补偿修正,其中,vε为速度阈值参数,依据GNSS的速度量测噪声进行取值。Analyze the data sent by GNSS to judge the validity of the data. If the GNSS data is valid, the calculation speed of the GNSS data will be used as the basis for judging the flight status of the aircraft. , it is determined that the airframe is in the ground preparation state. At this time, GNSS data, including heading, pitch angle, speed and position, are used for error compensation and correction, and the accelerometer is used to correct the roll angle; when , it is determined that the body is in motion. At this time, GNSS data is used, including heading, pitch angle, speed, and position for error compensation correction, and roll angle is not for error compensation correction. Among them, v ε is the speed threshold parameter, according to the GNSS speed Measure the noise to take the value.
本发明的有益效果在于:本发明可在GNSS数据有效时,根据GNSS数据的解算速度对机体飞行状态进行判断,具体为当时,判定机体处于地面准备态,此时采用GNSS数据,包括航向、俯仰角、速度和位置进行误差补偿修正,同时利用加速度计进行横滚角的修正,由于GNSS只能提供航向和俯仰角,在进行飞行姿态识别并确认当前状态可以使用加速度计进行误差补偿时,则可使用加速度计获得横滚角量测值;当时,判定机体为运动状态,此时使用GNSS数据,包括航向、俯仰角、速度、位置进行误差补偿修正,横滚角不进行误差补偿修正,将横滚角量测误差设为零。The beneficial effect of the present invention is that: the present invention can judge the flight state of the airframe according to the calculation speed of the GNSS data when the GNSS data is valid, specifically when At this time, it is determined that the airframe is in the ground preparation state. At this time, GNSS data, including heading, pitch angle, speed and position, are used for error compensation and correction. At the same time, the accelerometer is used to correct the roll angle. Since GNSS can only provide heading and pitch angle, When performing flight attitude recognition and confirming that the current state can use the accelerometer for error compensation, the accelerometer can be used to obtain the roll angle measurement value; when , it is determined that the body is in motion. At this time, the GNSS data, including heading, pitch angle, speed, and position, are used for error compensation correction. The roll angle does not perform error compensation correction, and the roll angle measurement error is set to zero.
本发明基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,还包括:The present invention is based on the flight state identification method of airborne dual-antenna GNSS and MINS integrated navigation, also includes:
当GNSS数据无效时,则利用加速度计进行飞行状态识别,根据如下公式求取k时刻的加速度计输出 When the GNSS data is invalid, use the accelerometer to identify the flight state, and calculate the accelerometer output at time k according to the following formula
当时,判定机体处于稳定态,此时的机体为匀速巡航状态或者地面静止状态,此阶段使用加速度计进行姿态误差补偿修正,其中,为阈值参数,其取值视导航系统所在环境的具体噪声水平设定;当时,计算水平双轴加速度计的输出来进行具体飞行状态判定,判定方法如下:when When , it is determined that the body is in a stable state. At this time, the body is in a constant speed cruising state or a static state on the ground. At this stage, the accelerometer is used to correct the attitude error compensation. Among them, is the threshold parameter, and its value depends on the specific noise level of the environment where the navigation system is located; when When , calculate the output of the horizontal two-axis accelerometer To determine the specific flight status, the determination method is as follows:
当时,与陀螺仪数据进行结合判定,机体处于转弯状态或者盘旋状态,其中,为阈值参数,依据水平加速度计的噪声具体取值,when When , combined with the gyroscope data to determine, the body is in a turning state or a hovering state, wherein, is the threshold parameter, according to the specific value of the noise of the horizontal accelerometer,
时,机体的机动状态大,处于起飞或者降落阶段。 When , the maneuvering state of the airframe is large, and it is in the stage of take-off or landing.
有益效果在于:通过该方法,在GNSS信号有效情况下,也可利用加速度计和陀螺仪对机体进行飞行状态的有效识别。The beneficial effect is that: through the method, when the GNSS signal is valid, the accelerometer and the gyroscope can also be used to effectively identify the flight state of the airframe.
本发明基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,还包括:The present invention is based on the flight state identification method of airborne dual-antenna GNSS and MINS integrated navigation, also includes:
在机体静态对准阶段,分别利用如下公式求得当地基准重力加速度 In the static alignment phase of the airframe, the following formulas are used to obtain the local reference gravity acceleration
有益效果在于:事先在机体静态对准阶段计算出当地基准重力加速度以便用于与加速度计输出作比较,从而识别机体当前状态。The beneficial effect is that the local reference gravitational acceleration is calculated in advance in the static alignment phase of the airframe for use with the accelerometer output For comparison, so as to identify the current state of the body.
本发明基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,GNSS数据的有效性判断方法为:The present invention is based on the flight state identification method of airborne dual-antenna GNSS and MINS integrated navigation, and the validity judgment method of GNSS data is:
GNSS数据的解算误差通过三个精度因子进行判断,分别是PDOP、VDOP和HDOP,PDOP2=HDOP2+VDOP2,其中,PDOP表示的是经度、纬度和高度之间的标准差平方和开根号,VDOP表示的是经度和纬度之间的标准差平方和开平方,HDOP表示高度的标准差,当其中任一个精度因子大于3时,则判断GNSS数据无效。The calculation error of GNSS data is judged by three precision factors, which are PDOP, VDOP and HDOP respectively, PDOP 2 =HDOP 2 +VDOP 2 , where PDOP represents the square sum of standard deviations between longitude, latitude and height. The root sign, VDOP means the square root of the standard deviation between longitude and latitude, and HDOP means the standard deviation of the height. When any precision factor is greater than 3, it is judged that the GNSS data is invalid.
有益效果在于:双天线GNSS在单天线GNSS基础上,以天线1为基准站,天线2为终端站,通过差分定位法获取两天线的坐标并解得两天线之间的基线矢量,进而完成航向与俯仰角的测量,GNSS数据的解算误差可通过上述三个精度因子进行判断,当任一精度因子大于3,GNSS数据精度已不满足组合导航的融合要求,此时GNSS数据将失效不可用。The beneficial effect is that the dual-antenna GNSS is based on the single-antenna GNSS, with the antenna 1 as the reference station and the antenna 2 as the terminal station, the coordinates of the two antennas are obtained through the differential positioning method and the baseline vector between the two antennas is obtained, and then the heading is completed. With the measurement of pitch angle, the calculation error of GNSS data can be judged by the above three precision factors. When any precision factor is greater than 3, the accuracy of GNSS data does not meet the fusion requirements of integrated navigation. At this time, GNSS data will be invalid and unavailable .
本发明基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,还包括对当前导航路线下的GNSS数据无效阶段的时长进行预测,若预测时长大于设定阈值,则发出第一提示信息。The present invention is based on the flight state identification method of the airborne dual-antenna GNSS and MINS integrated navigation, which also includes predicting the duration of the GNSS data invalid phase under the current navigation route, and if the predicted duration is greater than the set threshold, then sending out the first prompt message.
有益效果在于:若预测当前导航路线下的GNSS数据无效阶段的时长大于设定阈值,则说明在当前导航路线下,机体将较长时间的接收不到GNSS信号或解算的GNSS数据将无效不可用,在这种情况,仅采用MINS导航系统采集的数据进行姿态解算和误差补偿,由于MINS导航系统存在误差随时间积累的不足,因此可能存在误差较大的问题,导致导航精度降低,因此需要发出第一提示信息。The beneficial effect is that: if the duration of the GNSS data invalid stage under the current navigation route is predicted to be greater than the set threshold, it means that under the current navigation route, the body will not receive GNSS signals for a long time or the calculated GNSS data will be invalid. In this case, only the data collected by the MINS navigation system is used for attitude calculation and error compensation. Because the MINS navigation system has insufficient error accumulation over time, there may be a problem of large errors, resulting in a decrease in navigation accuracy. Therefore, The first prompt message needs to be issued.
本发明基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,还包括对GNSS数据无效阶段的时长进行计算,当计算得到的时长大于设定阈值时,则发出第二提示信息。The flight state identification method based on the airborne dual-antenna GNSS and MINS integrated navigation of the present invention also includes calculating the duration of the GNSS data invalid phase, and when the calculated duration is greater than the set threshold, a second prompt message is issued.
有益效果在于:若计算的当前导航路线下的GNSS数据无效阶段的时长已经大于设定阈值,则说明在当前导航路线下,机体已经较长时间的接收不到GNSS信号或解算的GNSS数据无效不可用,在这种情况,仅采用MINS导航系统采集的数据进行姿态解算和误差补偿,由于MINS导航系统存在误差随时间积累的不足,因此可能存在误差较大的问题,导致导航精度降低,因此需要发出第二提示信息。The beneficial effect is: if the calculated duration of the GNSS data invalid phase under the current navigation route is greater than the set threshold, it means that under the current navigation route, the body has not been able to receive GNSS signals for a long time or the calculated GNSS data is invalid Not available. In this case, only the data collected by the MINS navigation system is used for attitude calculation and error compensation. Because the MINS navigation system has insufficient error accumulation over time, there may be a problem of large errors, resulting in reduced navigation accuracy. Therefore, it is necessary to issue a second prompt message.
本发明的另一目的旨在提供一种基于机载双天线GNSS和MINS组合导航的飞行状态识别系统,包括GNSS数据有效性分析模块,用于对GNSS发送的数据进行解析,判断数据有效性;飞行状态识别模块,用于在GNSS数据有效的情况下,根据GNSS数据的解算速度判断机体飞行状态,当时,判定机体处于地面准备态,此时采用GNSS数据,包括航向、俯仰角、速度和位置进行误差补偿修正,同时利用加速度计进行横滚角的修正;当时,判定机体为运动状态,此时使用GNSS数据,包括航向、俯仰角、速度、位置进行误差补偿修正,横滚角不进行误差补偿修正,其中,vε为速度阈值参数,依据GNSS的速度量测噪声进行取值。Another object of the present invention is to provide a flight status identification system based on airborne dual-antenna GNSS and MINS integrated navigation, including a GNSS data validity analysis module, which is used to analyze the data sent by GNSS and judge the validity of the data; The flight state recognition module is used to judge the flight state of the body according to the calculation speed of the GNSS data when the GNSS data is valid. , it is determined that the airframe is in the ground preparation state. At this time, GNSS data, including heading, pitch angle, speed and position, are used for error compensation and correction, and the accelerometer is used to correct the roll angle; when , it is determined that the body is in motion. At this time, GNSS data is used, including heading, pitch angle, speed, and position for error compensation correction, and roll angle is not for error compensation correction. Among them, v ε is the speed threshold parameter, according to the GNSS speed Measure the noise to take the value.
通过该系统,可根据GNSS数据的解算速度对机体飞行状态进行判断,且在判断出飞机飞行状态后,基于不同情况,判断是否对横滚角进行修正。Through this system, the flight state of the airframe can be judged according to the calculation speed of the GNSS data, and after the flight state of the aircraft is judged, it can be judged whether to correct the roll angle based on different situations.
本发明基于机载双天线GNSS和MINS组合导航的飞行状态识别系统,所述飞行状态识别模块,还用于当GNSS数据无效时,利用加速度计进行飞行状态识别,根据如下公式求取k时刻的加速度计输出 The present invention is based on the flight state recognition system of airborne dual-antenna GNSS and MINS integrated navigation, and the flight state recognition module is also used for when the GNSS data is invalid, using the accelerometer to carry out flight state recognition, according to the following formula to obtain the k moment accelerometer output
当时,判定机体处于稳定态,此时的机体为匀速巡航状态或者地面静止状态,此阶段使用加速度计进行姿态误差补偿修正,其中,为阈值参数,其取值视导航系统所在环境的具体噪声水平设定;当时,计算水平双轴加速度计的输出来进行具体飞行状态判定,判定方法如下:when When , it is determined that the body is in a stable state. At this time, the body is in a constant speed cruising state or a stationary state on the ground. At this stage, the accelerometer is used to correct the attitude error compensation. Among them, is the threshold parameter, and its value depends on the specific noise level of the environment where the navigation system is located; when When , calculate the output of the horizontal two-axis accelerometer To determine the specific flight status, the determination method is as follows:
当时,与陀螺仪数据进行结合判定,机体处于转弯状态或者盘旋状态,其中,为阈值参数,依据水平加速度计的噪声具体取值,when When , combined with the gyroscope data to determine, the body is in a turning state or a hovering state, wherein, is the threshold parameter, according to the specific value of the noise of the horizontal accelerometer,
时,机体的机动状态大,处于起飞或者降落阶段。 When , the maneuvering state of the airframe is large, and it is in the stage of take-off or landing.
通过飞行状态识别模块,在GNSS信号有效情况下,也可利用加速度计和陀螺仪对机体进行飞行状态的有效识别。Through the flight state identification module, the accelerometer and gyroscope can also be used to effectively identify the flight state of the airframe when the GNSS signal is valid.
附图说明Description of drawings
图1为本发明基于机载双天线GNSS和MINS组合导航的飞行状态识别方法的流程图。Fig. 1 is the flow chart of the flight state identification method based on the integrated navigation of airborne dual antenna GNSS and MINS in the present invention.
具体实施方式detailed description
以下结合附图对本发明的优选实施例进行说明,应当理解,下述所描述的优选实施例仅用于对本发明进行解释说明,并不会对本发明的保护范围起到限定作用。The preferred embodiments of the present invention will be described below in conjunction with the accompanying drawings. It should be understood that the preferred embodiments described below are only used to explain the present invention and do not limit the protection scope of the present invention.
本申请的说明书、权利要求书、实施例中的术语“第一”、“第二”等是用于区别类似的对象,而不是用于描述特定的顺序或者先后次序。The terms "first", "second" and the like in the specification, claims, and embodiments of the present application are used to distinguish similar objects, rather than to describe a specific order or sequence.
下面通过优选的具体实施方式对本发明进一步详细说明:The present invention is described in further detail below by preferred specific embodiments:
实施例一Embodiment one
如附图1所示:本实施例公开了一种基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,包括以下内容:As shown in accompanying drawing 1: present embodiment discloses a kind of flight status identification method based on airborne dual-antenna GNSS and MINS integrated navigation, comprising the following contents:
对GNSS发送的数据进行解析,判断数据有效性,若GNSS数据有效,则根据GNSS数据的解算速度作为机体飞行状态判断依据,当时,判定机体处于地面准备态,此时采用GNSS数据,包括航向、俯仰角、速度和位置进行误差补偿修正,同时利用加速度计进行横滚角的修正;当时,判定机体为运动状态,此时使用GNSS数据,包括航向、俯仰角、速度、位置进行误差补偿修正,横滚角不进行误差补偿修正,其中,vε为速度阈值参数,依据GNSS的速度量测噪声进行取值。Analyze the data sent by GNSS to judge the validity of the data. If the GNSS data is valid, the calculation speed of the GNSS data will be used as the basis for judging the flight status of the airframe. , it is determined that the airframe is in the ground preparation state. At this time, the GNSS data, including heading, pitch angle, speed and position, are used for error compensation and correction, and the accelerometer is used to correct the roll angle; when , it is determined that the body is in motion. At this time, GNSS data is used, including heading, pitch angle, speed, and position for error compensation correction, and roll angle is not for error compensation correction. Among them, v ε is the speed threshold parameter, which is based on the speed Measure the noise to take the value.
本实施例中,GNSS数据的有效性判断方法为:GNSS数据的解算误差通过三个精度因子进行判断,分别是PDOP、VDOP和HDOP,PDOP2=HDOP2+VDOP2,其中,PDOP表示的是经度、纬度和高度之间的标准差平方和开根号,VDOP表示的是经度和纬度之间的标准差平方和开平方,HDOP表示高度的标准差,当其中任一个精度因子大于3时,则判断GNSS数据无效。In this embodiment, the validity judgment method of GNSS data is: the solution error of GNSS data is judged by three precision factors, which are respectively PDOP, VDOP and HDOP, and PDOP 2 =HDOP 2 +VDOP 2 , wherein, PDOP represents It is the square root of the standard deviation between longitude, latitude and height, VDOP means the square root of the standard deviation between longitude and latitude, HDOP means the standard deviation of height, when any precision factor is greater than 3 , it is judged that the GNSS data is invalid.
本实施例中,所述的误差补偿采用离散卡尔曼滤波器,状态量的选择使用间接法。状态方程和量测方程,分别用于反应组合导航的状态特性以及量测信息与状态之间的关系。In this embodiment, the discrete Kalman filter is used for the error compensation, and the indirect method is used for the selection of state quantities. The state equation and the measurement equation are respectively used to reflect the state characteristics of the integrated navigation and the relationship between the measurement information and the state.
组合导航的状态方程如下:The state equation of integrated navigation is as follows:
选择MINS的姿态失准角[φE φN φU]T、东北天向速度误差[δvE δvN δvU]T、经纬高位置误差[δL δλ δh]T、陀螺仪相关漂移和加速度计相关漂移作为状态向量(共15维),如下:Select MINS attitude misalignment angle [φ E φ N φ U ] T , velocity error in northeast direction [δv E δv N δv U ] T , high latitude and longitude position error [δL δλ δh] T , gyroscope related drift and accelerometer related drift As a state vector (a total of 15 dimensions), as follows:
在t时刻系统的状态转移矩阵为:The state transition matrix of the system at time t is:
式中,FI(t)是惯导系统的误差矩阵,其可以表示为如下形式:In the formula, F I (t) is the error matrix of the inertial navigation system, which can be expressed as the following form:
式中的αs=diag(1/τsx 1/τsy 1/τsz)(s=g,a),1/τsi(s=g,a;i=x,y,z)是马尔科夫时间相关常数。In the formula, α s =diag(1/τ sx 1/τ sy 1/τ sz )(s=g,a), 1/τsi(s=g,a; i=x,y,z) is Marko time-dependent constant.
选用陀螺仪的随机白噪声[wgεx wgεy wgεz]T、加速度计的随机白噪声[waεx waεywaεz]T、陀螺仪的一阶马尔科夫驱动白噪声[ηgx ηgy ηg]z T和加速度计的一阶马尔科夫驱动白噪声[ηax ηay ηaz]T作为系统的噪声,所以系统噪声矩阵为:Choose the random white noise of the gyroscope [w gεx w gεy w gεz ] T , the random white noise of the accelerometer [w aεx w aεy w aεz ] T , the first-order Markov driving white noise of the gyroscope [η gx η gy η g ] z T and the first-order Markov driven white noise [η ax η ay η az ] T of the accelerometer as the noise of the system, so the system noise matrix is:
W(t)=[wgεx wgεy wgεz waεx waεy waεz ηgx ηgy ηgz ηax ηay ηaz]W(t)=[w gεx w gεy w gεz w aεx w aεy w aεz η gx η gy η gz η ax η ay η az ]
与噪声矩阵相对应的协方差矩阵P为:The covariance matrix P corresponding to the noise matrix is:
系统噪声分配矩阵为:The system noise allocation matrix is:
设计的双天线GNSS和MINS组合导航系统使用了位置、速度和姿态数据共九维数据作为观测值,量测方程如下所示:The designed dual-antenna GNSS and MINS integrated navigation system uses nine-dimensional data of position, velocity and attitude data as observation values, and the measurement equation is as follows:
Z(t)9×1=H(t)9×15X(t)15×1+R(t)9×1 Z(t) 9×1 =H(t) 9×15 X(t) 15×1 +R(t) 9×1
其中 为INS解算姿态,为GNSS和磁力计提供的姿态角。in Calculate attitude for INS, Attitude angle provided for GNSS and magnetometer.
H(t)=[HΦ(t)3×15 Hv(t)3×15 Hp(t)3×15]T,H(t)=[H Φ (t) 3×15 H v (t) 3×15 H p (t) 3×15 ] T ,
其中,in,
HΦ=[I3×3 03×12]H Φ =[I 3×3 0 3×12 ]
Hv=[03×3 I3×3 03×9]H v =[0 3×3 I 3×3 0 3×9 ]
Hp=[03×6 I3×3 03×6]H p =[0 3×6 I 3×3 0 3×6 ]
量测噪声矩阵R(t)=[RΦ(t) Rv(t) Rp(t)]T,其中RΦ(t)为GNSS和磁力计的白噪声,Rv(t)和Rp(t)分别为GNSS接收机的速度和位置测量白噪声。Measurement noise matrix R(t)=[R Φ (t) R v (t) R p (t)] T , where R Φ (t) is the white noise of GNSS and magnetometer, R v (t) and R p (t) is the white noise of the velocity and position measurements of the GNSS receiver, respectively.
本实施例中,当GNSS数据无效时,则利用加速度计进行飞行状态识别,根据如下公式求取k时刻的加速度计输出 In this embodiment, when the GNSS data is invalid, the accelerometer is used to identify the flight state, and the accelerometer output at time k is obtained according to the following formula
在机体静态对准阶段,分别利用如下公式求得当地基准重力加速度 In the static alignment phase of the airframe, the following formulas are used to obtain the local reference gravity acceleration
当时,判定机体处于稳定态,此时的机体为匀速巡航状态或者地面静止状态,此阶段使用加速度计进行姿态误差补偿修正,其中,为阈值参数,其取值视导航系统所在环境的具体噪声水平设定;当时,计算水平双轴加速度计的输出来进行具体飞行状态判定,判定方法如下:when When , it is determined that the body is in a stable state. At this time, the body is in a constant speed cruising state or a static state on the ground. At this stage, the accelerometer is used to correct the attitude error compensation. Among them, is the threshold parameter, and its value depends on the specific noise level of the environment where the navigation system is located; when When , calculate the output of the horizontal two-axis accelerometer To determine the specific flight status, the determination method is as follows:
当时,与陀螺仪数据进行结合判定,机体处于转弯状态或者盘旋状态,其中,为阈值参数,依据水平加速度计的噪声具体取值,when When , combined with the gyroscope data to determine, the body is in a turning state or a hovering state, wherein, is the threshold parameter, according to the specific value of the noise of the horizontal accelerometer,
时,机体的机动状态大,处于起飞或者降落阶段。 When , the maneuvering state of the airframe is large, and it is in the stage of take-off or landing.
本实施例的基于机载双天线GNSS和MINS组合导航的飞行状态识别方法,还包括对当前导航路线下的GNSS数据无效阶段的时长进行预测,若预测时长大于设定阈值,则发出第一提示信息。The flight state identification method based on the airborne dual-antenna GNSS and MINS integrated navigation of this embodiment also includes predicting the duration of the GNSS data invalid phase under the current navigation route, and if the predicted duration is greater than the set threshold, a first prompt is issued information.
本实施例中,还包括对GNSS数据无效阶段的时长进行计算,当计算得到的时长大于设定阈值时,则发出第二提示信息。In this embodiment, it also includes calculating the duration of the GNSS data invalid phase, and when the calculated duration is greater than the set threshold, a second prompt message is issued.
本实施例还公开了一种基于机载双天线GNSS和MINS组合导航的飞行状态识别系统,包括GNSS数据有效性分析模块,用于对GNSS发送的数据进行解析,判断数据有效性;飞行状态识别模块,用于在GNSS数据有效的情况下,根据GNSS数据的解算速度判断机体飞行状态,当时,判定机体处于地面准备态,此时采用GNSS数据,包括航向、俯仰角、速度和位置进行误差补偿修正,同时利用加速度计进行横滚角的修正;当时,判定机体为运动状态,此时使用GNSS数据,包括航向、俯仰角、速度、位置进行误差补偿修正,横滚角不进行误差补偿修正,其中,vε为速度阈值参数,依据GNSS的速度量测噪声进行取值。This embodiment also discloses a flight state identification system based on airborne dual-antenna GNSS and MINS integrated navigation, including a GNSS data validity analysis module, which is used to analyze the data sent by GNSS and judge the validity of the data; flight state identification The module is used to judge the flight state of the body according to the calculation speed of the GNSS data when the GNSS data is valid. , it is determined that the airframe is in the ground preparation state. At this time, GNSS data, including heading, pitch angle, speed and position, are used for error compensation and correction, and the accelerometer is used to correct the roll angle; when , it is determined that the body is in motion. At this time, GNSS data is used, including heading, pitch angle, speed, and position for error compensation correction, and roll angle is not for error compensation correction. Among them, v ε is the speed threshold parameter, according to the GNSS speed Measure the noise to take the value.
本实施例中,所述飞行状态识别模块,还用于当GNSS数据无效时,利用加速度计进行飞行状态识别,根据如下公式求取k时刻的加速度计输出 In the present embodiment, the flight state identification module is also used to use the accelerometer to identify the flight state when the GNSS data is invalid, and obtain the accelerometer output at k time according to the following formula
当时,判定机体处于稳定态,此时的机体为匀速巡航状态或者地面静止状态,此阶段使用加速度计进行姿态误差补偿修正,其中,为阈值参数,其取值视导航系统所在环境的具体噪声水平设定;当时,计算水平双轴加速度计的输出来进行具体飞行状态判定,判定方法如下:when When , it is determined that the body is in a stable state. At this time, the body is in a constant speed cruising state or a stationary state on the ground. At this stage, the accelerometer is used to correct the attitude error compensation. Among them, is the threshold parameter, and its value depends on the specific noise level of the environment where the navigation system is located; when When , calculate the output of the horizontal two-axis accelerometer To determine the specific flight status, the determination method is as follows:
当时,与陀螺仪数据进行结合判定,机体处于转弯状态或者盘旋状态,其中,为阈值参数,依据水平加速度计的噪声具体取值,when When , combined with the gyroscope data to determine, the body is in a turning state or a hovering state, wherein, is the threshold parameter, according to the specific value of the noise of the horizontal accelerometer,
时,机体的机动状态大,处于起飞或者降落阶段。 When , the maneuvering state of the airframe is large, and it is in the stage of take-off or landing.
实施例二Embodiment two
本实施例与实施例一不同之处在于:机载双天线GNSS和MINS组合导航的飞行状态识别系统,还包括GNSS信号分析模块,所述GNSS信号分析模块用于判断当前GNSS信号是否可用,若不可用,则向地面控制端发送当前GNSS信号不可用。具体的,GNSS信号分析模块用于判断当前GNSS信号是否可用,包括当前无GNSS信号,或当前GNSS信号精度不满足要求。The difference between this embodiment and Embodiment 1 is that the flight status identification system of the airborne dual-antenna GNSS and MINS integrated navigation also includes a GNSS signal analysis module, and the GNSS signal analysis module is used to judge whether the current GNSS signal is available, if If not available, the current GNSS signal is not available to the ground control terminal. Specifically, the GNSS signal analysis module is used to determine whether the current GNSS signal is available, including that there is currently no GNSS signal, or the accuracy of the current GNSS signal does not meet the requirements.
与实施例一种通过精度因子判断GNSS信号是否可用相比,本实施例中,所述GNSS信号分析模块,通过计算D和之差,判断GNSS信号的精度,即判断GNSS信号是否可用。其中D为机体两个天线之间的实际安装距离,为根据两天线的位置坐标,计算得到的两天线的定位距离。Compared with the first embodiment of judging whether the GNSS signal is available by the precision factor, in this embodiment, the GNSS signal analysis module calculates D and The difference is to judge the accuracy of the GNSS signal, that is, to judge whether the GNSS signal is available. Where D is the actual installation distance between the two antennas of the airframe, is the positioning distance of the two antennas calculated according to the position coordinates of the two antennas.
本实施例的地面控制端,在接收到当前GNSS信号不可用后,调取当前机体所在位置的历史导航数据,并根据历史导航数据判断当前机体机载双天线模块是否发生故障,若是,则向GNSS信号分析模块发出故障信号。The ground control terminal of this embodiment, after receiving that the current GNSS signal is unavailable, retrieves the historical navigation data of the current airframe location, and judges whether the current airborne dual antenna module of the current airframe fails according to the historical navigation data, and if so, reports to The GNSS signal analysis module sends a fault signal.
本实施例中,所述历史导航数据包括历史机体接收GNSS信号情况,历史机体的初始姿态信息、误差补偿后的机体姿态信息,以及计算的速度和位置信息,进一步地,所述的历史导航数据为距离当前机体导航时间最近的多组关联存储的导航数据,所述地面控制端,用于对多组关联存储的导航数据进行综合分析,判断当前机体机载双天线模块是否发生故障。In this embodiment, the historical navigation data includes the historical airframe receiving GNSS signals, the initial attitude information of the historical airframe, the airframe attitude information after error compensation, and the calculated speed and position information. Further, the historical navigation data It is multiple sets of associated stored navigation data closest to the navigation time of the current airframe, and the ground control terminal is used to comprehensively analyze the multiple sets of associated stored navigation data to determine whether the current airborne dual-antenna module is faulty.
地面控制端根据历史导航数据判断当前机体机载双天线模块是否发生故障,具体分析方式是:所述历史机体接收GNSS信号情况是指历史机体是否接收到GNSS信号,若历史机体未有接收到GNSS信号的,则地面控制端可直接判断当前机体机载双天线模块未发生故障;若历史机体未接收到GNSS信号的概率占比达到60%以上,则进一步分析剩余接收到GNSS信号的历史机体的初始姿态信息、误差补偿后的机体姿态信息,以及计算的速度和位置信息,若分析剩余接收到GNSS信号的历史机体未采用GNSS信号接收的第二导航用数据进行误差补偿占比达到60%以上,则判断当前机体机载双天线模块未发生故障;若历史机体接收到GNSS信号的占比达到80%以上,或历史机体接收到GNSS信号的占比在60-80%之间,且接收到GNSS信号的历史机体采用GNSS信号接收的第二导航用数据进行误差补偿,误差均在允许范围内占比达到90%以上,则判断当前机体机载双天线模块发生故障。The ground control terminal judges whether the airborne dual-antenna module of the current airframe is faulty according to the historical navigation data. The specific analysis method is: the historical airframe receiving the GNSS signal refers to whether the historical airframe has received the GNSS signal. If the historical airframe has not received the GNSS signal signal, the ground control terminal can directly judge that the airborne dual-antenna module of the current airframe has not failed; if the probability that the historical airframe has not received the GNSS signal reaches more than 60%, then further analyze the remaining historical airframes that have received the GNSS signal. Initial attitude information, airframe attitude information after error compensation, and calculated speed and position information, if the analysis of the remaining historical airframes that received GNSS signals did not use the second navigation data received by GNSS signals for error compensation accounted for more than 60% , it is judged that the airborne dual-antenna module of the current airframe is not faulty; if the proportion of the historical airframe receiving the GNSS signal reaches more than 80%, or the proportion of the historical airframe receiving the GNSS signal is between 60-80%, and the received The historical body of the GNSS signal uses the second navigation data received by the GNSS signal to perform error compensation. If the error is within the allowable range and the ratio reaches more than 90%, it is judged that the dual antenna module onboard the current body is faulty.
以上结合附图详细阐述了本申请的优选实施方式,优选实施方式中典型的公知结构及公知性常识技术在此未作过多描述,所属领域普通技术人员可以在本实施方式给出的启示下,结合自身能力完善并实施本发明技术方案,一些典型的公知结构、公知方法或公知性常识技术不应当成为所属领域普通技术人员实施本申请的障碍。The preferred embodiment of the present application has been described in detail above in conjunction with the accompanying drawings. The typical known structures and common knowledge technologies in the preferred embodiment are not described here too much. Those of ordinary skill in the art can learn from the inspiration given by this embodiment. , in combination with one's own ability to perfect and implement the technical solution of the present invention, some typical known structures, known methods or common knowledge technologies should not become obstacles for those of ordinary skill in the art to implement the present application.
本申请要求的保护范围应当以其权利要求书的内容为准,发明内容、具体实施方式及说明书附图记载的内容用于解释权利要求书。The scope of protection required by this application shall be based on the content of the claims, and the content of the invention, specific implementation methods, and the contents recorded in the drawings of the specification are used to interpret the claims.
在本申请的技术构思范围内,还可以对本申请的具体实施方式作出若干变型,这些变型后的具体实施方式也应该视为在本申请的保护范围内。Within the scope of the technical conception of the present application, some modifications can also be made to the specific embodiments of the present application, and the specific embodiments after these modifications should also be regarded as within the protection scope of the present application.
Claims (8)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211208601.2A CN115453600A (en) | 2022-09-30 | 2022-09-30 | Flight state identification method and system based on airborne double-antenna GNSS and MINS combined navigation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211208601.2A CN115453600A (en) | 2022-09-30 | 2022-09-30 | Flight state identification method and system based on airborne double-antenna GNSS and MINS combined navigation |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115453600A true CN115453600A (en) | 2022-12-09 |
Family
ID=84308015
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211208601.2A Pending CN115453600A (en) | 2022-09-30 | 2022-09-30 | Flight state identification method and system based on airborne double-antenna GNSS and MINS combined navigation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115453600A (en) |
-
2022
- 2022-09-30 CN CN202211208601.2A patent/CN115453600A/en active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11585951B1 (en) | Heading or pitch determination systems and methods with high confidence error bounds | |
CN107656301B (en) | A vehicle positioning method based on multi-source information fusion | |
CN101858748B (en) | Fault-tolerance autonomous navigation method of multi-sensor of high-altitude long-endurance unmanned plane | |
CN110780326A (en) | Vehicle-mounted integrated navigation system and positioning method | |
TW518422B (en) | Positioning and proximity warning method and system thereof for vehicle | |
CN112505737B (en) | GNSS/INS integrated navigation method | |
CN110487301A (en) | A kind of airborne strapdown inertial navigation system Initial Alignment Method of radar auxiliary | |
CN110926468B (en) | Communication-in-motion antenna multi-platform navigation attitude determination method based on transfer alignment | |
CN108387227B (en) | Multi-node information fusion method and system of airborne distributed POS | |
US20020165669A1 (en) | Attitude measurement using a single GPS receiver with two closely-spaced antennas | |
CN105928515B (en) | A kind of UAV Navigation System | |
CN111141273A (en) | Combined navigation method and system based on multi-sensor fusion | |
CN109059909A (en) | Satellite based on neural network aiding/inertial navigation train locating method and system | |
CN108151765B (en) | Positioning and attitude measuring method for online real-time estimation and compensation of magnetometer error | |
CN115327588A (en) | A high-precision positioning method for unmanned automatic operation special vehicles based on network RTK | |
CN116182867A (en) | INS/UWB unmanned aerial vehicle positioning method based on tight combination in complex indoor environment | |
CN112697154B (en) | Self-adaptive multi-source fusion navigation method based on vector distribution | |
CN109596127A (en) | A kind of air navigation aid of radio auxiliary dead reckoning | |
CN107764268B (en) | Method and device for transfer alignment of airborne distributed POS (point of sale) | |
CN115479605A (en) | High-altitude long-endurance unmanned aerial vehicle autonomous navigation method based on space target directional observation | |
US20240302183A1 (en) | Method and system for crowdsourced creation of magnetic map | |
CN105928519A (en) | Navigation algorithm based on INS inertial navigation, GPS navigation and magnetometer | |
CN115453601A (en) | Airborne double-antenna GNSS and MINS combined navigation system and navigation method | |
CN115453600A (en) | Flight state identification method and system based on airborne double-antenna GNSS and MINS combined navigation | |
CN111007542A (en) | Method for calculating MIMU installation error angle in vehicle-mounted satellite-based enhanced multimode GNSS/MIMU combined navigation |
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 |