CN112649884B - 应用于航空电磁测量系统的吊舱姿态实时调整方法 - Google Patents
应用于航空电磁测量系统的吊舱姿态实时调整方法 Download PDFInfo
- Publication number
- CN112649884B CN112649884B CN202110044375.8A CN202110044375A CN112649884B CN 112649884 B CN112649884 B CN 112649884B CN 202110044375 A CN202110044375 A CN 202110044375A CN 112649884 B CN112649884 B CN 112649884B
- Authority
- CN
- China
- Prior art keywords
- attitude
- nacelle
- data
- dimensional
- class
- 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
- 238000005259 measurement Methods 0.000 title claims abstract description 60
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000004590 computer program Methods 0.000 claims description 9
- 238000005070 sampling Methods 0.000 claims description 7
- 238000004891 communication Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 238000011835 investigation Methods 0.000 description 5
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000005674 electromagnetic induction Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 229910052500 inorganic mineral Inorganic materials 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 239000011707 mineral Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000012805 post-processing Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V3/00—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation
- G01V3/38—Processing data, e.g. for analysis, for interpretation, for correction
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D47/00—Equipment not otherwise provided for
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
-
- 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
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Geology (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Geophysics (AREA)
- Environmental & Geological Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Automation & Control Theory (AREA)
- Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
- Wind Motors (AREA)
Abstract
本发明提供一种应用于航空电磁测量系统的吊舱姿态实时调整方法,结合历史的第一类三维姿态数据以及第二类三维姿态数据,可以确定出用于描述吊舱的姿态信息的姿态偏离度指标以及姿态平稳度指标,基于姿态偏离度指标以及姿态平稳度指标,可以准确确定出吊舱的姿态调整策略。将姿态调整策略发送至飞行员,进而使飞行员可以确定出飞机的姿态调整策略,并对飞机的姿态进行调整,带动吊舱进行姿态调整,可以保证吊舱的姿态保持平稳,使吊舱测量得到的垂直磁场分量更准确,可以获得准确的倾子矢量。
Description
技术领域
本发明涉及航空大地电磁探测技术领域,尤其涉及一种应用于航空电磁测量系统的吊舱姿态实时调整方法。
背景技术
航空电磁测量法是以电磁感应理论为基础的一种地球物理勘查方法,具有速度快、成本低、通行性好、可大面积覆盖等优势,目前广泛用于基础地质调查、矿产资源勘查、油气勘查,以及水文、工程、环境勘查等领域。
航空电磁测量系统通常分空中部分和地面部分,空中部分包含有飞机以及吊舱,吊舱位于飞机下方,且为环形硬连接结构,吊舱和飞机是通过软绳吊挂连接。地面部分包含有地面基站。通过吊舱可以测量吊舱位置的垂直磁场分量,结合地面基站测量得到的基站位置的水平磁场分量,可以确定出倾子矢量,即垂直磁场分量与水平磁场分量之间的复系数关系。
在理想情况下,如果飞机按照设计时速飞行,吊舱姿态处于水平状态,此时可以准确确定出垂直磁场分量,进而可以准确确定出倾子矢量。但由于飞机的实际飞行环境中风速和风向随时变化,因此若飞机依然按照设计时速飞行,吊舱姿态则会处于非水平状态,这将导致测得的垂直磁场分量中包含了水平分量噪声,使垂直磁场分量不准确,进而导致获得错误的倾子矢量。为此,现急需提供一种应用于航空电磁测量系统的吊舱姿态实时调整方法。
发明内容
本发明实施例提供一种应用于航空电磁测量系统的吊舱姿态实时调整方法,用以解决现有技术中存在的缺陷。
本发明实施例提供一种应用于航空电磁测量系统的吊舱姿态实时调整方法,包括:
获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;
基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;
基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整。
根据本发明一个实施例的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述第一类三维姿态数据以及所述第二类三维姿态数据均采用欧拉角表示;相应的,
所述基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标,具体包括:
基于所述第一类三维姿态数据对应的欧拉角的任一角分量的均方根值,确定所述吊舱在所述任一角分量上的姿态偏离度指标;
基于所述第二类三维姿态数据对应的欧拉角的所述任一角分量的均方根值,确定所述吊舱在所述任一角分量上的姿态平稳度指标。
根据本发明一个实施例的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,具体包括:
确定所述吊舱在所有角分量上的姿态平稳度指标的最小值,并确定所述姿态调整策略为调整所述最小值对应的角分量;
继续确定所述吊舱在所有角分量上的姿态平稳度指标的最小值,直至所述吊舱在所有角分量上的姿态偏离度指标均在预设范围内。
根据本发明一个实施例的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据,具体包括:
基于设置于所述吊舱上的至少一个姿态传感器,获取所述第一类三维姿态数据以及所述第二类三维姿态数据。
根据本发明一个实施例的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述姿态传感器的采样率为2Hz至10Hz。
根据本发明一个实施例的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述基于设置于所述吊舱上的至少一个姿态传感器,获取所述第一类三维姿态数据以及所述第二类三维姿态数据,具体包括:
分别获取每个所述姿态传感器在所述第一预设时间段内每个采集时刻采集的第一类四元数数据以及在所述第二预设时间段内每个采集时刻采集的第二类四元数数据,并计算所有所述姿态传感器在每个采集时刻对应的第一类四元数数据均值以及第二类四元数数据均值;
分别将所述第一类四元数数据均值以及所述第二类四元数数据均值转换为欧拉角,得到所述第一类三维姿态数据以及所述第二类三维姿态数据。
根据本发明一个实施例的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述第二预设时间段的时长为所述第一预设时间段的时长的二倍。
本发明实施例还提供一种应用于航空电磁测量系统的吊舱姿态实时调整装置,包括:获取模块、指标确定模块以及策略确定模块。
获取模块用于获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;
指标确定模块用于基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;
策略确定模块用于基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整。
本发明实施例还提供一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现如上述任一种所述应用于航空电磁测量系统的吊舱姿态实时调整方法的步骤。
本发明实施例还提供一种非暂态计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现如上述任一种所述应用于航空电磁测量系统的吊舱姿态实时调整方法的步骤。
本发明实施例提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,结合历史的第一类三维姿态数据以及第二类三维姿态数据,可以确定出用于描述吊舱的姿态信息的姿态偏离度指标以及姿态平稳度指标,基于姿态偏离度指标以及姿态平稳度指标,可以准确确定出吊舱的姿态调整策略。将姿态调整策略发送至飞行员,进而使飞行员可以确定出飞机的姿态调整策略,并对飞机的姿态进行调整,带动吊舱进行姿态调整,可以保证吊舱的姿态保持平稳,使吊舱测量得到的垂直磁场分量更准确,可以获得准确的倾子矢量。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的一种应用于航空电磁测量系统的吊舱姿态实时调整方法的流程示意图;
图2是本发明实施例采用的航空电磁测量系统的空中部分的结构示意图;
图3是本发明实施例提供的一种应用于航空电磁测量系统的吊舱姿态实时调整方法中吊舱的姿态调整顺序示意图;
图4是本发明实施例提供的一种应用于航空电磁测量系统的吊舱姿态实时调整装置的结构示意图;
图5是本发明实施例提供的一种电子设备的结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
目前的航空电磁测量系统,由于飞机的实际飞行环境中风速和风向随时变化,在飞机依然按照设计时速飞行时,会导致航空电磁测量系统中的吊舱姿态处于非水平状态,这将导致吊舱测量得到的垂直磁场分量中包含了水平分量噪声,使垂直磁场分量的测量结果不准确,进而导致获得错误的倾子矢量。也就是说,风阻对吊舱姿态的影响很大,因此需要实时改变飞机的飞行速度和姿态以保持吊舱水平飞行。吊舱飞行姿态直接决定了电磁数据的质量,因此保持吊舱水平飞行对于剔除水平磁场分量对垂直磁场分量的干扰降低动态噪声具有实际意义。在实际飞行中受多种因素影响需要对吊舱飞行姿态进行校正研究,以获得高质量的垂直磁场分量的测量数据。通常的做法是采取事后数据处理时对倾子进行姿态校正,但也不能完全校正。并且如果吊舱倾斜角度太大,无法进行事后处理校正。
为此,本发明实施例中提供了一种吊舱飞行姿态解算监控反馈算法,将需要调整的姿态实时的传递给飞行员,计算出调整飞机姿态的最优操作顺序,以保障吊舱平稳飞行。
图1为本发明实施例中提供的一种应用于航空电磁测量系统的吊舱姿态实时调整方法的流程示意图,如图1所示,该方法包括:
S1,获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;
S2,基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;
S3,基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整。
具体地,本发明实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,其执行主体可以为服务器,可以为本地服务器,也可以为云端服务器。本地服务器可以配置于航空电磁测量系统内,并可以与飞机驾驶室内的显示屏幕电连接。
首先执行步骤S1,获取航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长。吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据是指吊舱在当前时刻前最近的第一预设时间段内的第一类三维姿态数据,吊舱至当前时刻的第二预设时间段内的第二类三维姿态数据是指吊舱在当前时刻前最近的第二预设时间段内的第二类三维姿态数据。第一预设时间段的时长以及第二预设时间段的时长可以根据需要进行设置,但是需要保证的是,第一预设时间段的时长小于第二预设时间段的时长,即第一类三维姿态数据的数量少于第二类三维姿态数据的数量。其中,“第一”、“第二”仅起到区分作用,并无其他限定作用。本发明实施例中,第一类三维姿态数据以及第二类三维姿态数据均可以采用欧拉角、四元数等形式表示。
其次执行步骤S2,根据第一类三维姿态数据确定吊舱的姿态偏离度指标,根据第一类三维姿态数据以及第二类三维姿态数据,确定吊舱的姿态平稳度指标。其中,吊舱的姿态偏离度指标用于表征吊舱在当前时刻的倾斜程度,可以通过第一预设时间段内姿态数据的有效值或平均值表示。姿态偏离度指标的取值越大,表示吊舱在当前时刻越倾斜。吊舱的姿态平稳度指标用于表征吊舱在当前时刻的平稳程度,可以通过第二预设时间段内姿态数据的有效值或平均值与吊舱在第一预设时间段内姿态数据的有效值或平均值之间的差异表示,即可以通过吊舱在第二预设时间段内的姿态数据波动幅度表示。姿态平稳度指标的取值越大,表示吊舱在当前时刻越平稳。
最后执行步骤S3,根据步骤S2中确定的姿态偏离度指标以及姿态平稳度指标,确定吊舱的姿态调整策略,并将姿态调整策略向飞行员显示。可以将姿态调整策略发送至飞机驾驶室内的显示屏幕,由显示屏幕向飞行员显示姿态调整策略。由于吊舱自重300-500公斤,直径8-12米,通过软绳与飞机相连。无法直接控制吊舱姿态,只能通过调整飞机姿态来修正吊舱的姿态变化。又由于飞机的姿态调整方向与吊舱的姿态调整方向一致,因此飞行员在接收到姿态调整策略之后,可以确定飞机的姿态调整策略,并根据飞机的姿态调整策略调整飞机的姿态,由飞机带动吊舱进行姿态调整。其中,姿态调整策略可以包括调整角度、不同姿态角的调整顺序以及调整方向等参数的取值,本发明实施例中对此不作具体限定。
本发明实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,结合历史的第一类三维姿态数据以及第二类三维姿态数据,可以确定出用于描述吊舱的姿态信息的姿态偏离度指标以及姿态平稳度指标,基于姿态偏离度指标以及姿态平稳度指标,可以准确确定出吊舱的姿态调整策略。将姿态调整策略发送至飞行员,进而使飞行员可以确定出飞机的姿态调整策略,并对飞机的姿态进行调整,带动吊舱进行姿态调整,可以保证吊舱的姿态保持平稳,使吊舱测量得到的垂直磁场分量更准确,可以获得准确的倾子矢量。
在上述实施例的基础上,本发明实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据,具体包括:
基于设置于所述吊舱上的至少一个姿态传感器,获取所述第一类三维姿态数据以及所述第二类三维姿态数据。
具体地,图2为本发明实施例中采用的航空电磁测量系统的空中部分的结构示意图,如图2所示,空中部分包括飞机21和吊舱22,在吊舱22上可以有至少一个姿态传感器23,至少一个姿态传感器23可以均匀设置在吊舱22上,姿态传感器23的数量可以根据需要进行设置,本发明实施例中对此不作具体限定。作为优选方案,可以在吊舱22上均匀设置4个姿态传感器23,以提高测量精度。姿态传感器可以是基于微电机系统(Micro-Electro-Mechanical System,MEMS)技术的高性能三维运动姿态测量系统,可以包含三轴陀螺仪、三轴加速度计,三轴电子罗盘等运动传感器,通过内嵌的低功耗ARM处理器得到经过温度补偿的三维姿态与方位等数据。利用基于四元数的三维算法和特殊数据融合技术,实时输出以四元数、欧拉角表示的零漂移三维姿态方位数据。本发明实施例中采用的姿态传感器可以是惯导姿态传感器,也可以是其他类型的姿态传感器。
在上述实施例的基础上,本发明实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述姿态传感器的采样率为2Hz至10Hz。
在上述实施例的基础上,本发明实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述第二预设时间段的时长为所述第一预设时间段的时长的二倍。
具体地,考虑到飞行员的反应时间以及操作时间,可以将第一预设时间段的时长设置为5s,将第二预设时间段的时长设置为10s,进而当姿态传感器的采样率为2Hz时,第一类三维姿态数据的数量可以是10个,第二类三维姿态数据的数量可以是20个,以剔除个别飞点的影响。
在上述实施例的基础上,本发明实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,所述基于设置于所述吊舱上的至少一个姿态传感器,获取所述第一类三维姿态数据以及所述第二类三维姿态数据,具体包括:
分别获取每个所述姿态传感器在所述第一预设时间段内每个采集时刻采集的第一类四元数数据以及在所述第二预设时间段内每个采集时刻采集的第二类四元数数据,并计算所有所述姿态传感器在每个采集时刻对应的第一类四元数数据均值以及第二类四元数数据均值;
分别将所述第一类四元数数据均值以及所述第二类四元数数据均值转换为欧拉角,得到所述第一类三维姿态数据以及所述第二类三维姿态数据。
具体地,以姿态传感器的数量为4个,分别为A、B、C、D,进行举例,则每个姿态传感器在每个采集时刻采集的四元数数据均可以用Qn1、Qn2、Qn3、Qn4(n=A、B、C、D)表示。四元数数据均值可以表示为:
(w、x、y、z)可以表示吊舱在任一采集时刻的姿态数据。
在笛卡尔坐标系中,定义ψ、θ、分别为绕Z轴、Y轴、X轴的旋转角度,本发明实施例中可以用Tait-Bryan angle表示,即ψ、θ、/>分别为Yaw(偏航角)、Pitch(俯仰角)、Roll(横滚角),偏航角、俯仰角以及横滚角均为欧拉角的一个角分量,为对应方向上的姿态角。
四元数转为三维空间的欧拉角的公式为:
在上述实施例的基础上,所述第一类三维姿态数据以及所述第二类三维姿态数据均采用欧拉角表示;相应的,
所述基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标,具体包括:
基于所述第一类三维姿态数据对应的欧拉角的任一角分量的均方根值,确定所述吊舱在所述任一角分量上的姿态偏离度指标;
基于所述第二类三维姿态数据对应的欧拉角的所述任一角分量的均方根值,确定所述吊舱在所述任一角分量上的姿态平稳度指标。
具体地,以姿态传感器的采样率均为2Hz,第一预设时间段为5s、第二预设时间段为10s进行举例,第一预设时间段内包含有10个第一类三维姿态数据,第二预设时间段内包含有20个第二类三维姿态数据。对于三个角分量,均具有对应的姿态偏离度指标及姿态平稳度指标,θma表示吊舱在俯仰角θ上的姿态偏离度指标,表示吊舱在横滚角/>上的姿态偏离度指标,ψma表示吊舱在偏航角ψ上的姿态偏离度指标。θdif表示吊舱在俯仰角θ上的姿态平稳度指标,/>表示吊舱在横滚角/>上的姿态平稳度指标,ψdif表示吊舱在偏航角ψ上的姿态平稳度指标。
进而有:
以θma为例,θma越大,表示吊舱的姿态在俯仰角θ方向上倾斜越大。θma越小,表示吊舱的姿态在俯仰角θ方向上倾斜越小。
以θdif为例,θdif≥0,且θdif越大,表示吊舱的姿态在俯仰角θ方向上越平稳,表明俯仰角θ最近10个采样点的姿态数据比上10个(第11-20个)采样点的数据波动幅度小。
在上述实施例的基础上,所述基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,具体包括:
确定所述吊舱在所有角分量上的姿态平稳度指标的最小值,并确定所述姿态调整策略为调整所述最小值对应的角分量;
继续确定所述吊舱在所有角分量上的姿态平稳度指标的最小值,直至所述吊舱在所有角分量上的姿态偏离度指标均在预设范围内。
具体地,吊舱的姿态调整策略可以包括姿态调整的顺序,如图3所示,可以先比较θdif、ψdif三个数值的大小,确定这三个数值中最小值/>对应的姿态角需要调整,例如/>则先调整俯仰角θ,直到/>然后继续确定θdif、/>ψdif三个数值中的最小值,如果此时/>则调整偏航角ψ,如此不断循环调整下去,直到θma、/>ψma都在各自的预设范围内。此时,飞行员可以控制飞机维持当前飞行状态。
如图4所示,在上述实施例的基础上,本发明实施例中提供了一种应用于航空电磁测量系统的吊舱姿态实时调整装置,包括:获取模块41、指标确定模块42和策略确定模块43。其中,
获取模块41用于获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;
指标确定模块42用于基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;
策略确定模块43用于基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整。
图5示例了一种电子设备的实体结构示意图,如图5所示,该电子设备可以包括:处理器(processor)510、通信接口(Communications Interface)520、存储器(memory)530和通信总线540,其中,处理器510,通信接口520,存储器530通过通信总线540完成相互间的通信。处理器510可以调用存储器530中的逻辑指令,以执行上述各实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,该方法包括:获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整。
此外,上述的存储器530中的逻辑指令可以通过软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
另一方面,本发明实施例还提供一种计算机程序产品,所述计算机程序产品包括存储在非暂态计算机可读存储介质上的计算机程序,所述计算机程序包括程序指令,当所述程序指令被计算机执行时,计算机能够执行上述各实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,该方法包括:获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整。
又一方面,本发明实施例还提供一种非暂态计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现以执行上述各实施例提供的上述各实施例中提供的应用于航空电磁测量系统的吊舱姿态实时调整方法,该方法包括:获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整。
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性的劳动的情况下,即可以理解并实施。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到各实施方式可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件。基于这样的理解,上述技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (8)
1.一种应用于航空电磁测量系统的吊舱姿态实时调整方法,其特征在于,包括:
获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;
基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;
基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整;
其中,所述第一类三维姿态数据以及所述第二类三维姿态数据均采用欧拉角表示;相应的,
所述基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标,具体包括:
基于所述第一类三维姿态数据对应的欧拉角的任一角分量的均方根值,确定所述吊舱在所述任一角分量上的姿态偏离度指标;
基于所述第二类三维姿态数据对应的欧拉角的所述任一角分量的均方根值,确定所述吊舱在所述任一角分量上的姿态平稳度指标;
其中,所述基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,具体包括:
确定所述吊舱在所有角分量上的姿态平稳度指标的最小值,并确定所述姿态调整策略为调整所述最小值对应的角分量;
继续确定所述吊舱在所有角分量上的姿态平稳度指标的最小值,直至所述吊舱在所有角分量上的姿态偏离度指标均在预设范围内。
2.根据权利要求1所述的应用于航空电磁测量系统的吊舱姿态实时调整方法,其特征在于,所述获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据,具体包括:
基于设置于所述吊舱上的至少一个姿态传感器,获取所述第一类三维姿态数据以及所述第二类三维姿态数据。
3.根据权利要求2所述的应用于航空电磁测量系统的吊舱姿态实时调整方法,其特征在于,所述姿态传感器的采样率为2Hz至10Hz。
4.根据权利要求3所述的应用于航空电磁测量系统的吊舱姿态实时调整方法,其特征在于,所述基于设置于所述吊舱上的至少一个姿态传感器,获取所述第一类三维姿态数据以及所述第二类三维姿态数据,具体包括:
分别获取每个所述姿态传感器在所述第一预设时间段内每个采集时刻采集的第一类四元数数据以及在所述第二预设时间段内每个采集时刻采集的第二类四元数数据,并计算所有所述姿态传感器在每个采集时刻对应的第一类四元数数据均值以及第二类四元数数据均值;
分别将所述第一类四元数数据均值以及所述第二类四元数数据均值转换为欧拉角,得到所述第一类三维姿态数据以及所述第二类三维姿态数据。
5.根据权利要求1所述的应用于航空电磁测量系统的吊舱姿态实时调整方法,其特征在于,所述第二预设时间段的时长为所述第一预设时间段的时长的二倍。
6.一种应用于航空电磁测量系统的吊舱姿态实时调整装置,其特征在于,包括:
获取模块,用于获取所述航空电磁测量系统内的吊舱至当前时刻的第一预设时间段内的第一类三维姿态数据以及至当前时刻的第二预设时间段内的第二类三维姿态数据;所述第一预设时间段的时长小于所述第二预设时间段的时长;
指标确定模块,用于基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标;所述第一类三维姿态数据以及所述第二类三维姿态数据均采用欧拉角表示;相应的,所述基于所述第一类三维姿态数据以及所述第二类三维姿态数据,确定所述吊舱的姿态偏离度指标以及姿态平稳度指标,具体包括:基于所述第一类三维姿态数据对应的欧拉角的任一角分量的均方根值,确定所述吊舱在所述任一角分量上的姿态偏离度指标;基于所述第二类三维姿态数据对应的欧拉角的所述任一角分量的均方根值,确定所述吊舱在所述任一角分量上的姿态平稳度指标;
策略确定模块,用于基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,并将所述姿态调整策略向飞行员显示,以使所述飞行员基于所述姿态调整策略,对所述吊舱进行姿态调整;所述基于所述姿态偏离度指标以及所述姿态平稳度指标,确定所述吊舱的姿态调整策略,具体包括:确定所述吊舱在所有角分量上的姿态平稳度指标的最小值,并确定所述姿态调整策略为调整所述最小值对应的角分量;继续确定所述吊舱在所有角分量上的姿态平稳度指标的最小值,直至所述吊舱在所有角分量上的姿态偏离度指标均在预设范围内。
7.一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至5任一项所述应用于航空电磁测量系统的吊舱姿态实时调整方法的步骤。
8.一种非暂态计算机可读存储介质,其上存储有计算机程序,其特征在于,该计算机程序被处理器执行时实现如权利要求1至5任一项所述应用于航空电磁测量系统的吊舱姿态实时调整方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110044375.8A CN112649884B (zh) | 2021-01-13 | 2021-01-13 | 应用于航空电磁测量系统的吊舱姿态实时调整方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110044375.8A CN112649884B (zh) | 2021-01-13 | 2021-01-13 | 应用于航空电磁测量系统的吊舱姿态实时调整方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112649884A CN112649884A (zh) | 2021-04-13 |
CN112649884B true CN112649884B (zh) | 2024-02-09 |
Family
ID=75368321
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110044375.8A Active CN112649884B (zh) | 2021-01-13 | 2021-01-13 | 应用于航空电磁测量系统的吊舱姿态实时调整方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112649884B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113415433B (zh) * | 2021-07-30 | 2022-11-29 | 成都纵横大鹏无人机科技有限公司 | 基于三维场景模型的吊舱姿态修正方法、装置和无人机 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6281970B1 (en) * | 1998-03-12 | 2001-08-28 | Synergistix Llc | Airborne IR fire surveillance system providing firespot geopositioning |
CN101232979A (zh) * | 2005-08-01 | 2008-07-30 | 丰田自动车株式会社 | 移动体姿态角检测设备 |
CN106200664A (zh) * | 2016-08-19 | 2016-12-07 | 北京航天自动控制研究所 | 一种适应长时间失控的姿态控制方法 |
CN107063198A (zh) * | 2017-05-09 | 2017-08-18 | 天津大学 | 一种船载自稳定云台测量系统及应用方法 |
CN206991121U (zh) * | 2017-04-28 | 2018-02-09 | 四川翼飞腾科技有限公司 | 一种飞行器姿态感知系统 |
CN108827313A (zh) * | 2018-08-10 | 2018-11-16 | 哈尔滨工业大学 | 基于扩展卡尔曼滤波器的多模式旋翼飞行器姿态估计方法 |
CN110220533A (zh) * | 2019-05-16 | 2019-09-10 | 武汉新瑞通达信息技术有限公司 | 一种基于传递对准的机载光电吊舱设备失准角标定方法 |
CN111026139A (zh) * | 2019-09-25 | 2020-04-17 | 中国人民解放军63850部队 | 一种基于飞行轨迹的三维模型姿态调整控制方法 |
CN111158036A (zh) * | 2020-01-16 | 2020-05-15 | 吉林大学 | 一种吊舱姿态实时测量、解算与监控装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7133776B2 (en) * | 2000-07-28 | 2006-11-07 | Litton Systems, Inc. | Attitude alignment of a slave inertial measurement system |
-
2021
- 2021-01-13 CN CN202110044375.8A patent/CN112649884B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6281970B1 (en) * | 1998-03-12 | 2001-08-28 | Synergistix Llc | Airborne IR fire surveillance system providing firespot geopositioning |
CN101232979A (zh) * | 2005-08-01 | 2008-07-30 | 丰田自动车株式会社 | 移动体姿态角检测设备 |
CN106200664A (zh) * | 2016-08-19 | 2016-12-07 | 北京航天自动控制研究所 | 一种适应长时间失控的姿态控制方法 |
CN206991121U (zh) * | 2017-04-28 | 2018-02-09 | 四川翼飞腾科技有限公司 | 一种飞行器姿态感知系统 |
CN107063198A (zh) * | 2017-05-09 | 2017-08-18 | 天津大学 | 一种船载自稳定云台测量系统及应用方法 |
CN108827313A (zh) * | 2018-08-10 | 2018-11-16 | 哈尔滨工业大学 | 基于扩展卡尔曼滤波器的多模式旋翼飞行器姿态估计方法 |
CN110220533A (zh) * | 2019-05-16 | 2019-09-10 | 武汉新瑞通达信息技术有限公司 | 一种基于传递对准的机载光电吊舱设备失准角标定方法 |
CN111026139A (zh) * | 2019-09-25 | 2020-04-17 | 中国人民解放军63850部队 | 一种基于飞行轨迹的三维模型姿态调整控制方法 |
CN111158036A (zh) * | 2020-01-16 | 2020-05-15 | 吉林大学 | 一种吊舱姿态实时测量、解算与监控装置 |
Also Published As
Publication number | Publication date |
---|---|
CN112649884A (zh) | 2021-04-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20190317532A1 (en) | Gimbal control method, control system, gimbal, and unmanned aircraft | |
CN110221625B (zh) | 无人机精确位置的自主降落导引方法 | |
JP2015526726A (ja) | 風ベクトルの推定 | |
WO2020103049A1 (zh) | 旋转微波雷达的地形预测方法、装置、系统和无人机 | |
CN108475069B (zh) | 农业无人飞行器的控制方法、飞行控制器及农业无人机 | |
CN110488865B (zh) | 无人机航向确定方法、装置及无人机 | |
CN107101636B (zh) | 一种使用卡尔曼滤波器辨识多旋翼动力学模型参数的方法 | |
CN110377056B (zh) | 无人机航向角初值选取方法及无人机 | |
KR102118157B1 (ko) | 기상관측용 무인비행체의 센서탑재장치, 기상관측용 무인비행체 및 기상관측용 무인비행체를 이용한 기상관측 방법 | |
US20220178697A1 (en) | Method and apparatus for correcting yaw angle of aircraft, and aircraft | |
US20210108923A1 (en) | Information processing apparatus, information processing method, and program | |
CN110873563B (zh) | 一种云台姿态估计方法及装置 | |
CN108801250B (zh) | 基于水下机器人的实时姿态获取方法及装置 | |
CN112649884B (zh) | 应用于航空电磁测量系统的吊舱姿态实时调整方法 | |
Zhou et al. | Spinning projectile’s angular measurement using crest and trough data of a geomagnetic sensor | |
RU2564379C1 (ru) | Бесплатформенная инерциальная курсовертикаль | |
Zorina et al. | Enhancement of INS/GNSS integration capabilities for aviation-related applications | |
WO2021217329A1 (zh) | 高度检测方法、补偿量的确定方法、装置和无人机 | |
CN107490866B (zh) | 一种飞行员可穿戴显示系统及其定位头部姿态的方法 | |
CN111026139B (zh) | 一种基于飞行轨迹的三维模型姿态调整控制方法 | |
Lembono et al. | Orientation filter and angular rates estimation in monocopter using accelerometers and magnetometer with the extended kalman filter | |
KR101340158B1 (ko) | 고정 표적을 이용한 무인항공기의 표적 위치 보정 방법 및 컴퓨터 판독 가능한 기록매체 | |
CN108227734A (zh) | 用于控制无人机的电子控制装置、相关的无人机、控制方法及计算机程序 | |
CN106527464A (zh) | 一种无人机姿态保持方法及装置 | |
CN108801260B (zh) | 基于水下机器人的数据处理方法及装置 |
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 |