CN112363518B - 一种减少火箭飞行软件前台运算时间的姿态角计算方法 - Google Patents
一种减少火箭飞行软件前台运算时间的姿态角计算方法 Download PDFInfo
- Publication number
- CN112363518B CN112363518B CN202011018944.3A CN202011018944A CN112363518B CN 112363518 B CN112363518 B CN 112363518B CN 202011018944 A CN202011018944 A CN 202011018944A CN 112363518 B CN112363518 B CN 112363518B
- Authority
- CN
- China
- Prior art keywords
- attitude angle
- current control
- control period
- period
- inertial
- 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
- 238000004364 calculation method Methods 0.000 title claims abstract description 35
- 238000005070 sampling Methods 0.000 claims abstract description 7
- 238000000034 method Methods 0.000 abstract description 5
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
Images
Classifications
-
- 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
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0833—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using limited authority control
-
- 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)
- Computer Security & Cryptography (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种减少火箭飞行软件前台运算时间的姿态角计算方法,包括步骤如下:步骤1、捷联惯性导航***对箭体的姿态角进行采样,通过脉冲折合计算,求解当前控制周期箭体坐标系姿态角增量的三轴分量;步骤2、将当前控制周期箭体坐标系的姿态角增量的三轴分量转换成当前控制周期惯性系三通道姿态角增量的三轴分量;步骤3、分别计算出当前控制周期的惯性系姿态角。本发明的方法改进了姿态角简单计算方式,减少飞行控制软件前台运算时间。
Description
技术领域
本发明涉及一种姿态角简单计算方法。
背景技术
为保证姿控***控制信号的实时性,减小信号采样与控制输出的时间间隔,姿控飞行控制软件通常分解为前台计算和后台计算两个模块,前台计算主要计算控制指令并输出,应具有尽可能少的计算量,后台计算完成姿控软件的其余部分功能,为下一周期的实时控制信号的计算作好准备。
运载火箭三通道欧拉角控制情况下,飞行控制软件需要在每个控制周期计算姿态角,耗时较长且计算的姿态角不够精确。
发明内容
本发明所要解决的技术问题是:克服现有技术的不足,提出一种减少火箭飞行软件前台运算时间的姿态角计算方法。改进了姿态角简单计算方式,减少飞行控制软件前台运算时间。
本发明所采用的技术方案是:一种减少火箭飞行软件前台运算时间的姿态角计算方法,包括步骤如下:
步骤1、捷联惯性导航***对箭体的姿态角进行采样,通过脉冲折合计算,求解当前控制周期箭体坐标系姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT),其中nT表示当前控制周期;T表示周期,n为正整数;
步骤2、将当前控制周期箭体坐标系的姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT)转换成当前控制周期惯性系三通道姿态角增量的三轴分量ΔθxJ(nT)、ΔθyJ(nT)、ΔθzJ(nT);
步骤2中,若满足|cosψ[(n-1)T]|>10-12,则
γ(nT)=γ[(n-1)T]+ΔθxJ(nT)。
一种减少火箭飞行软件前台运算时间的姿态角计算***,包括:
第一模块、接收捷联惯性导航***发送的当前控制周期箭体坐标系姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT),发送给第二模块;
其中,nT表示当前控制周期;T表示周期,n为正整数;
第二模块、用于将当前控制周期箭体坐标系的姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT)转换成当前控制周期惯性系三通道姿态角增量的三轴分量ΔθxJ(nT)、ΔθyJ(nT)、ΔθzJ(nT);
第二模块中,若满足|cosψ[(n-1)T]|>10-12,则
γ(nT)=γ[(n-1)T]+ΔθxJ(nT)。
本发明与现有技术相比的有益效果是:
(1)本发明为了减少运载火箭飞行软件前台运算时间,在捷联惯性组合、速率陀螺和捷联加速度测量装置采样脉冲完成后,立刻进行姿态角简单计算,以便于后续的校正网络计算,相比于传统控制方式在每个控制周期姿态角精确解算,可极大减少飞行控制软件前台计算时间。
(2)本发明的简单清晰,易于实现,通过姿态角简单计算,避免在飞行控制软件前台进行复杂冗余和四元数计算,减少前台运算时间,相比于传统姿态角简单计算,该方法将箭体坐标系简单姿态角增量转换到惯性系,提高了简单姿态角计算的准确性。
附图说明
图1为简单姿态角计算流程图。
具体实施方式
下面结合实施例对本发明作进一步阐述。
实施例1
在捷联惯性组合、速率陀螺和捷联加速度测量装置脉冲采样完成后,箭上飞行控制软件将采样的惯组脉冲折合,计算出每个控制周期三通道箭体坐标系简单姿态角增量,通过箭体坐标系向惯性坐标系转换求解惯性系三通道简单姿态角增量,将惯性系简单姿态角增量叠加到上一周期制导***经过冗余和四元数计算的精确姿态角,即可实现姿态角的简单计算。
如图1所示,一种减少火箭飞行软件前台运算时间的姿态角计算方法,包括步骤如下:
步骤1、捷联惯性导航***对箭体的姿态角进行采样,通过脉冲折合计算,求解当前控制周期箭体坐标系姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT),其中nT表示当前控制周期;T表示周期,n为正整数;
步骤2、将当前控制周期箭体坐标系的姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT)转换成当前控制周期惯性系三通道姿态角增量的三轴分量ΔθxJ(nT)、ΔθyJ(nT)、ΔθzJ(nT),若满足|cosψ[(n-1)T]|>10-12,则
ψ(nT)=ψ[(n-1)T]+ΔθyJ(nT),
γ(nT)=γ[(n-1)T]+ΔθxJ(nT)。
基于上述减少火箭飞行软件前台运算时间的姿态角计算方法建立的姿态角计算***,包括:
第一模块、接收捷联惯性导航***发送的当前控制周期箭体坐标系姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT),发送给第二模块;
其中,nT表示当前控制周期;T表示周期,n为正整数;
第二模块、用于将当前控制周期箭体坐标系的姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT)转换成当前控制周期惯性系三通道姿态角增量的三轴分量ΔθxJ(nT)、ΔθyJ(nT)、ΔθzJ(nT);
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (2)
1.一种减少火箭飞行软件前台运算时间的姿态角计算方法,其特征在于,包括步骤如下:
步骤1、捷联惯性导航***对箭体的姿态角进行采样,通过脉冲折合计算,求解当前控制周期箭体坐标系姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT),其中nT表示当前控制周期;T表示周期,n为正整数;
步骤2、将当前控制周期箭体坐标系的姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT)转换成当前控制周期惯性系三通道姿态角增量的三轴分量ΔθxJ(nT)、ΔθyJ(nT)、ΔθzJ(nT);
步骤2中,若满足|cosψ[(n-1)T]|>10-12,则
2.一种减少火箭飞行软件前台运算时间的姿态角计算***,其特征在于,包括:
第一模块、接收捷联惯性导航***发送的当前控制周期箭体坐标系姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT),发送给第二模块;
其中,nT表示当前控制周期;T表示周期,n为正整数;
第二模块、用于将当前控制周期箭体坐标系的姿态角增量的三轴分量Δθx1J(nT)、Δθy1J(nT)、Δθz1J(nT)转换成当前控制周期惯性系三通道姿态角增量的三轴分量ΔθxJ(nT)、ΔθyJ(nT)、ΔθzJ(nT);
第二模块中,若满足|cosψ[(n-1)T]|>10-12,则
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011018944.3A CN112363518B (zh) | 2020-09-24 | 2020-09-24 | 一种减少火箭飞行软件前台运算时间的姿态角计算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011018944.3A CN112363518B (zh) | 2020-09-24 | 2020-09-24 | 一种减少火箭飞行软件前台运算时间的姿态角计算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112363518A CN112363518A (zh) | 2021-02-12 |
CN112363518B true CN112363518B (zh) | 2023-07-14 |
Family
ID=74506852
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011018944.3A Active CN112363518B (zh) | 2020-09-24 | 2020-09-24 | 一种减少火箭飞行软件前台运算时间的姿态角计算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112363518B (zh) |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100547352C (zh) * | 2007-12-03 | 2009-10-07 | 哈尔滨工程大学 | 适合于光纤陀螺捷联惯性导航***的地速检测方法 |
JP5338464B2 (ja) * | 2009-05-08 | 2013-11-13 | 株式会社Ihi | 慣性航法装置、飛翔体及び航法データ算出方法 |
CN103983267A (zh) * | 2014-06-03 | 2014-08-13 | 中北大学 | 基于螺旋矢量的捷联姿态位置一体化更新算法 |
CN106767788B (zh) * | 2017-01-04 | 2019-07-19 | 北京航天自动控制研究所 | 一种组合导航方法和*** |
CN110057382B (zh) * | 2019-04-23 | 2021-07-09 | 西北工业大学 | 一种基于发射坐标系的捷联惯导数值更新方法 |
-
2020
- 2020-09-24 CN CN202011018944.3A patent/CN112363518B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN112363518A (zh) | 2021-02-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108535755B (zh) | 基于mems的gnss/imu车载实时组合导航方法 | |
CN104181572B (zh) | 一种弹载惯性/卫星紧组合导航方法 | |
CN106482734A (zh) | 一种用于imu多传感器数据融合的滤波方法 | |
CN103363992B (zh) | 基于梯度下降的四旋翼无人机姿态航向参考***解算方法 | |
CN105865455B (zh) | 一种利用gps与加速度计计算飞行器姿态角的方法 | |
CN104422948A (zh) | 一种嵌入式组合导航***及其方法 | |
CN103941274B (zh) | 一种导航方法及导航终端 | |
JP2007183138A (ja) | 小型姿勢センサ | |
CN110174121A (zh) | 一种基于地磁场自适应修正的航姿***姿态解算方法 | |
CN111207745A (zh) | 一种适用于大机动无人机垂直陀螺仪的惯性测量方法 | |
CN106248082B (zh) | 一种飞行器自主导航***及导航方法 | |
CN108344413A (zh) | 一种水下滑翔器导航***及其低精度与高精度转换方法 | |
CN104406592B (zh) | 一种用于水下滑翔器的导航***及姿态角校正和回溯解耦方法 | |
CN101929862A (zh) | 基于卡尔曼滤波的惯性导航***初始姿态确定方法 | |
CN112363518B (zh) | 一种减少火箭飞行软件前台运算时间的姿态角计算方法 | |
CN113108787B (zh) | 一种长航时惯导/卫星全球组合导航方法 | |
CN114485675A (zh) | 无人机航姿解算方法 | |
CN108731668B (zh) | 一种稳定平台惯导模拟***及其数据传输方法 | |
CN115950452A (zh) | 一种机载惯导的高精度对准方法 | |
CN112762960A (zh) | 一种飞行器所处风场的在线计算方法 | |
CN110836669A (zh) | Gnss/mimu/气压高度计的组合导航***及方法 | |
CN116182900B (zh) | 纬度未知条件下动基座大失准角一体化对准方法 | |
CN113108786B (zh) | 考虑飞行可靠性的长航时旋转惯导/卫星组合导航方法 | |
CN111121761A (zh) | 一种基于空速的微机械惯导滚动角确定方法 | |
JPH07270176A (ja) | 船舶の慣性航法装置 |
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 |