CN113108779A - 一种基于1553b总线三冗余的自主箭测系统 - Google Patents
一种基于1553b总线三冗余的自主箭测系统 Download PDFInfo
- Publication number
- CN113108779A CN113108779A CN202110265699.4A CN202110265699A CN113108779A CN 113108779 A CN113108779 A CN 113108779A CN 202110265699 A CN202110265699 A CN 202110265699A CN 113108779 A CN113108779 A CN 113108779A
- Authority
- CN
- China
- Prior art keywords
- test
- rocket
- attitude angle
- initial value
- initial
- 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.)
- Granted
Links
Images
Classifications
-
- 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
-
- 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/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Testing Of Engines (AREA)
Abstract
本发明涉及一种基于1553B总线三冗余的自主箭测系统,属于运载火箭测试及发射流程设计领域;包括主控微机、前置主机、箭载计算机;箭载计算机设置在运载火箭上,且箭载计算机内部设置有3个独立的DPU;主控微机:向前置主机发送系统测试开始指令;前置主机:接收主控微机传来的系统测试开始指令,向箭载计算机上传测试数据;上传结束后,向箭载计算机发送系统测试开始指令;箭载计算机:确定运载火箭后续姿态角的初值;以后续姿态角初值作为初始值,按照测试数据开始运行并测试;本发明减少了地面测试设备和人员的干预,提高测试效率,提升运载火箭测试的可靠性、经济成本,减少测试复杂度。
Description
技术领域
本发明属于运载火箭测试及发射流程设计领域,涉及一种基于1553B总线三冗余的自主箭测系统。
背景技术
现役运载火箭箭载计算机通常采用32位DSP处理器进行计算,计算能力不小于30MIPS,通过RS422响应地面控制计算机的控制指令、并反馈状态,通过1553B总线接收地面上传的各种测试及飞行程序,响应地面发送的硬件复位电平信号进行箭载计算机复位,以便切换不同状态。
现代科技的进步促进了运载火箭的快速发展,随着国产高等级芯片的飞速发展,运载火箭箭载计算机计算能力和存储能力不断提升,通过将稳定系统软件存储于箭载计算机的FLASH,可节约集成测试、射前测试的流程时间,提高测试效率。此外,箭机使用64位DSP处理器后,计算能力不小于300MIPS,可以将原地面测试计算机运行的惯组合成精度、全自主对准算法挪至箭上,实现箭载计算机的自主箭测,进一步缩减人工操作,提高系统可靠性。
为提高系统可靠度,新一代运载火箭采用3套1553B总线实现箭上单机及箭地间通信,在箭载计算机进行导航计算时,初始姿态角由全自主对准计算提供。3套DPU分别利用3套1553B总线计算得到了3组姿态角,然而在计算时,如何保证每套DPU接收的惯组数据均输入正常,在完全全自主对准后,如何对3套姿态角进行冗余判别,是目前技术的难点,没有很好的解决方法。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提出一种基于1553B总线三冗余的自主箭测系统,减少了地面测试设备和人员的干预,提高测试效率,提升运载火箭测试的可靠性、经济成本,减少测试复杂度。
本发明解决技术的方案是:
一种基于1553B总线三冗余的自主箭测系统,包括主控微机、前置主机、箭载计算机;箭载计算机设置在运载火箭上,且箭载计算机内部设置有3个独立的DPU;
主控微机:向前置主机发送系统测试开始指令;
前置主机:接收主控微机传来的系统测试开始指令,向箭载计算机上传测试数据;上传结束后,向箭载计算机发送系统测试开始指令;
箭载计算机:接收前置主机传来的测试数据;接收运载火箭测量的3组惯组数据;每个DPU接收1组惯组数据,实现DPU与惯组数据一一对应;每个DPU计算出1组初始姿态角,共3组初始姿态角,分别为 为俯仰姿态角,ψ为偏航姿态角,γ为滚转姿态角;设定A组初始姿态角的优先级大于B组初始姿态角的优先级,且B组初始姿态角的优先级大于C组初始姿态角的优先级;根据确定运载火箭后续姿态角的初值;接收前置主机传来的系统测试开始指令;运载火箭以后续姿态角初值作为初始值,按照测试数据开始运行并测试。
在上述的一种基于1553B总线三冗余的自主箭测系统,所述测试数据包括稳定系统状态测试数据和模拟飞行状态测试数据;测试数据为预先装订在前置主机中的。
在上述的一种基于1553B总线三冗余的自主箭测系统,所述每个DPU采用凝固粗对准+kalman滤波精对准算法,计算出初始姿态角。
在上述的一种基于1553B总线三冗余的自主箭测系统,所述各DPU计算出1组初始姿态角的计算时长为900s。
在上述的一种基于1553B总线三冗余的自主箭测系统,所述运载火箭后续姿态角的初值的确定方法为:
步骤一、计算每2组初始姿态角之间的姿态角偏差ΔAB、ΔAC、ΔBC;
在上述的一种基于1553B总线三冗余的自主箭测系统,所述步骤二中,对ΔAB、ΔAC、ΔBC的判断方法为:
在上述的一种基于1553B总线三冗余的自主箭测系统,所述运载火箭测试包括稳定系统状态测试和模拟飞行状态测试;当箭载计算机接收的测试数据为稳定系统状态测试数据时,实现运载火箭稳定系统状态测试;当箭载计算机接收的测试数据为模拟飞行状态测试数据时,实现运载火箭模拟飞行状态测试。
本发明与现有技术相比的有益效果是:
(1)本发明中箭载计算机可自主进行惯组合成精度、全自主对准等算法的计算,可减少对地面测试设备的依赖,使用可靠性更高的箭上单机完成流程的测试;
(2)本发明地面前置主机接收到惯组遥测消息后可同时计算合成精度、初始姿态角等,与箭载计算机计算结果进行比对,提高了可靠性;
(3)本发明充分利用了箭载计算机的计算能力,地面前置主机与箭载计算机仅需收发异步控制指令、遥测消息,对数据的实时性要求低,为未来实现箭地无缆化提供基础。
附图说明
图1为本发明自主箭测系统示意图;
图2为本发明粗对准算法框图。
具体实施方式
下面结合实施例对本发明作进一步阐述。
根据现役运载火箭的测试流程需要精简测试人员、减少测试状态人工把控的需求,兼顾系统可靠性、成本等要求,充分利用新一代高性能箭载计算机的存储和计算能力,本发明提供一种基于1553B总线三冗余的自主箭测系统,箭载计算机在接收到地面开始测试指令后,即可自动完成相应流程的测试,减少地面测试设备和人员的干预,提高测试效率,提升运载火箭测试的可靠性、经济成本,减少测试复杂度。
基于1553B总线三冗余的自主箭测系统,如图1所示,具体包括主控微机、前置主机、箭载计算机;箭载计算机设置在运载火箭上,且箭载计算机内部设置有3个独立的DPU。运载火箭测试包括稳定系统状态测试和模拟飞行状态测试,箭载计算机分别使用不同的软件。测试开始前,将需要使用的稳定系统软件、飞行软件通过测试口固化于箭载计算机内部。
将箭载计算机在稳定系统测试和模飞测试中需要使用的稳定系统软件、飞行测试软件在测试开始前由地面测试设备通过1553B总线烧写固化至FLASH中。
将箭地电缆连接好,地面测发控设备打开并连接好服务器,由系统指挥确认测试状态,后端主控微机选择测试条目。
根据系统测试流程,后端主控微机通过TCP网络向前端PLC发送配电指令,PLC接收指令后依序为箭上测量系统、控制系统加电。箭上单机上电后,由前端的前置主机作为BC,通过1553B总线发送启动自检测模式码,箭上各终端自检完成后,系统回采检测结果,主控微机判断合格后等待惯组预热好。
主控微机:通过TCP网络向前置主机发送系统测试开始指令;
前置主机:接收主控微机传来的系统测试开始指令,通过1553B总线向箭载计算机上传测试数据;测试数据包括稳定系统状态测试数据和模拟飞行状态测试数据;测试数据为预先装订在前置主机中。上传结束后,校对校验和正确后,通过箭地RS422总线向箭载计算机发送系统测试开始指令。
箭载计算机:接收前置主机传来的测试数据;接收运载火箭测量的3组惯组数据;每个DPU接收1组惯组数据,实现DPU与惯组数据一一对应;读取FLASH中固化的稳定系统软件,进行程序跳转,作为BC组织消息,读取箭上惯组脉冲,首先开展惯组合成精度测试,由箭载计算机的3个独立CPU分别计算,计算得到的3套合成精度结果通过RS422下传至地面前置主机。判断惯组合成精度测试合格后,箭载计算机进行全自主对准计算。箭载计算机3个DPU分别使用1套总线上的惯组数据,3个DPU分别收到惯组数据后首先使用如下方法进行惯组数据判断,流程为:
1)判断是否有DPU惯组输入,判断DPU惯组输入异常有如下标准:惯组数据不更新、惯组总线数据CRC校验不通过、DPU心跳不合格;
2)如果有DPU惯组输入异常情况,依据DPU1、DPU2、DPU3的优先级选择输出的DPU号;
3)如果3个DPU均判别出DPU惯组输入异常,则使用上一拍表决的DPU号作为后续计算的输出。
每个DPU计算出1组初始姿态角,各DPU计算出1组初始姿态角的计算时长为900s。每个DPU采用凝固粗对准+kalman滤波精对准算法,计算出初始姿态角。
本发明中控制系统采用全自主对准方案,即利用捷联惯组测量的角速度和视加速度信息确定捷联惯组的三个初始姿态角,直接作为g系导航的初值,无需光学瞄准设备。全自主对准采用凝固粗对准+Kalman滤波精对准方法。
如图2所示,粗对准采用凝固解析方案,姿态矩阵分为五个矩阵计算:
其中:A0表示发射方位角,常值装订。
其中:B0表示发射点地理纬度,常值装订。
其中:
ωe0:地球自转角速率,常值装订;
Tcd:表示粗对准时间,精对准开始时刻(tjdz0)相对初始对准开始时刻(tdz0)的时间,常值装订。
采用双矢量定姿得到,主要包含视速度增量计算、视速度增量累加和计算、地心惯性系下视速度增量计算、转换矩阵计算等内容。
精对准采用Kalman滤波方案,根据捷联惯导系统误差方程,在晃动基座下仅考虑速度误差和失准角误差,其他系统误差均纳入系统噪声。
共获得3组初始姿态角,分别为 为俯仰姿态角,ψ为偏航姿态角,γ为滚转姿态角;设定A组初始姿态角的优先级大于B组初始姿态角的优先级,且B组初始姿态角的优先级大于C组初始姿态角的优先级;根据确定运载火箭后续姿态角的初值;
运载火箭后续姿态角的初值的确定方法为:
步骤一、计算每2组初始姿态角之间的姿态角偏差ΔAB、ΔAC、ΔBC;
接收前置主机传来的系统测试开始指令;运载火箭以后续姿态角初值作为初始值,按照测试数据开始运行并测试。运载火箭测试包括稳定系统状态测试和模拟飞行状态测试;当箭载计算机接收的测试数据为稳定系统状态测试数据时,实现运载火箭稳定系统状态测试;当箭载计算机接收的测试数据为模拟飞行状态测试数据时,实现运载火箭模拟飞行状态测试。
箭载计算机运载火箭以后续姿态角初值作为初始值,自动切换进入G系导航。经系统指挥确认后,主控微机控制地面中频电源启动,伺服电机泵上电,为伺服机构提供压力;控制前置主机通过RS422向箭载计算机发送一级稳定系统零位测试开始指令,箭载计算机查询姿态角,控制伺服输出。二级、三级稳定系统零位测试同理。
箭载计算机自动完成稳定系统测试后,前端PLC发送电平信号,控制箭载计算机复位。
测试完成后,主控微机使用延时的方式,在箭载计算机完成飞行程序后对箭上及地面设备进行断电操作,断电操作采用上电的逆序操作。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (7)
1.一种基于1553B总线三冗余的自主箭测系统,其特征在于:包括主控微机、前置主机、箭载计算机;箭载计算机设置在运载火箭上,且箭载计算机内部设置有3个独立的DPU;
主控微机:向前置主机发送系统测试开始指令;
前置主机:接收主控微机传来的系统测试开始指令,向箭载计算机上传测试数据;上传结束后,向箭载计算机发送系统测试开始指令;
2.根据权利要求1所述的一种基于1553B总线三冗余的自主箭测系统,其特征在于:所述测试数据包括稳定系统状态测试数据和模拟飞行状态测试数据;测试数据为预先装订在前置主机中的。
3.根据权利要求2所述的一种基于1553B总线三冗余的自主箭测系统,其特征在于:所述每个DPU采用凝固粗对准+kalman滤波精对准算法,计算出初始姿态角。
4.根据权利要求3所述的一种基于1553B总线三冗余的自主箭测系统,其特征在于:所述各DPU计算出1组初始姿态角的计算时长为900s。
7.根据权利要求6所述的一种基于1553B总线三冗余的自主箭测系统,其特征在于:所述运载火箭测试包括稳定系统状态测试和模拟飞行状态测试;当箭载计算机接收的测试数据为稳定系统状态测试数据时,实现运载火箭稳定系统状态测试;当箭载计算机接收的测试数据为模拟飞行状态测试数据时,实现运载火箭模拟飞行状态测试。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110265699.4A CN113108779B (zh) | 2021-03-11 | 2021-03-11 | 一种基于1553b总线三冗余的自主箭测系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110265699.4A CN113108779B (zh) | 2021-03-11 | 2021-03-11 | 一种基于1553b总线三冗余的自主箭测系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113108779A true CN113108779A (zh) | 2021-07-13 |
CN113108779B CN113108779B (zh) | 2022-10-28 |
Family
ID=76711141
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110265699.4A Active CN113108779B (zh) | 2021-03-11 | 2021-03-11 | 一种基于1553b总线三冗余的自主箭测系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113108779B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113443173A (zh) * | 2021-09-01 | 2021-09-28 | 星河动力(北京)空间科技有限公司 | 运载火箭的导航系统、方法、装置、电子设备及存储介质 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008241320A (ja) * | 2007-03-26 | 2008-10-09 | Mitsubishi Electric Corp | 飛しょう体及び飛しょう体に搭載される慣性装置の調定方法 |
GB201403426D0 (en) * | 2014-02-27 | 2014-04-16 | Atlantic Inertial Systems Ltd | Inertial navigation system |
CN105222806A (zh) * | 2015-10-10 | 2016-01-06 | 上海新跃仪表厂 | 一种运载火箭双捷联惯组方位偏差标定装置及方法 |
CN105224428A (zh) * | 2015-07-29 | 2016-01-06 | 上海新跃仪表厂 | 控制信号数字传输的箭载计算机动态特性测试方法及系统 |
CN107389093A (zh) * | 2017-07-13 | 2017-11-24 | 中国人民解放军63820部队吸气式高超声速技术研究中心 | 一种静基座下惯性平台初始自对准方法 |
CN109163735A (zh) * | 2018-09-29 | 2019-01-08 | 苏州大学 | 一种晃动基座正向-正向回溯初始对准方法 |
CN109916395A (zh) * | 2019-04-04 | 2019-06-21 | 山东智翼航空科技有限公司 | 一种姿态自主冗余组合导航算法 |
CN110304270A (zh) * | 2019-06-03 | 2019-10-08 | 宁波天擎航天科技有限公司 | 用于运载火箭的全方位发射控制方法、装置、计算机设备 |
CN111102993A (zh) * | 2019-12-31 | 2020-05-05 | 中国人民解放军战略支援部队航天工程大学 | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 |
-
2021
- 2021-03-11 CN CN202110265699.4A patent/CN113108779B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008241320A (ja) * | 2007-03-26 | 2008-10-09 | Mitsubishi Electric Corp | 飛しょう体及び飛しょう体に搭載される慣性装置の調定方法 |
GB201403426D0 (en) * | 2014-02-27 | 2014-04-16 | Atlantic Inertial Systems Ltd | Inertial navigation system |
CN105224428A (zh) * | 2015-07-29 | 2016-01-06 | 上海新跃仪表厂 | 控制信号数字传输的箭载计算机动态特性测试方法及系统 |
CN105222806A (zh) * | 2015-10-10 | 2016-01-06 | 上海新跃仪表厂 | 一种运载火箭双捷联惯组方位偏差标定装置及方法 |
CN107389093A (zh) * | 2017-07-13 | 2017-11-24 | 中国人民解放军63820部队吸气式高超声速技术研究中心 | 一种静基座下惯性平台初始自对准方法 |
CN109163735A (zh) * | 2018-09-29 | 2019-01-08 | 苏州大学 | 一种晃动基座正向-正向回溯初始对准方法 |
CN109916395A (zh) * | 2019-04-04 | 2019-06-21 | 山东智翼航空科技有限公司 | 一种姿态自主冗余组合导航算法 |
CN110304270A (zh) * | 2019-06-03 | 2019-10-08 | 宁波天擎航天科技有限公司 | 用于运载火箭的全方位发射控制方法、装置、计算机设备 |
CN111102993A (zh) * | 2019-12-31 | 2020-05-05 | 中国人民解放军战略支援部队航天工程大学 | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 |
Non-Patent Citations (5)
Title |
---|
TEODOR LUCIAN GRIGORIE等: "Poster abstract: Precision improvement of aircrafts attitude estimation through gyro sensors data fusion in a redundant inertial measurement unit", 《IPSN-14 PROCEEDINGS OF THE 13TH INTERNATIONAL SYMPOSIUM ON INFORMATION PROCESSING IN SENSOR NETWORKS》 * |
崔桂利等: "冗余惯组初始基准现场校准装置研究", 《宇航计测技术》 * |
彭蓉等: "箭载捷联惯导系统水平自对准的两种实用方法", 《中国惯性技术学报》 * |
裴忠海等: "运载火箭捷联惯组全自主对准技术应用研究", 《上海航天》 * |
谈学军等: "双捷联冗余技术在长征二号丁运载火箭上的研发与实践", 《上海航天》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113443173A (zh) * | 2021-09-01 | 2021-09-28 | 星河动力(北京)空间科技有限公司 | 运载火箭的导航系统、方法、装置、电子设备及存储介质 |
CN113443173B (zh) * | 2021-09-01 | 2021-11-16 | 星河动力(北京)空间科技有限公司 | 运载火箭的导航系统、方法、装置、电子设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN113108779B (zh) | 2022-10-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110304270B (zh) | 用于运载火箭的全方位发射控制方法、装置、计算机设备 | |
CN107544467B (zh) | 整星条件下的双星编队控制闭环测试系统及方法 | |
CN105184002B (zh) | 一种数传天线指向角度的仿真分析方法 | |
CN111688952B (zh) | 一种卫星姿态控制系统 | |
US8321076B2 (en) | On-line inertia estimation for use in controlling an aerospace vehicle | |
CN102854887A (zh) | 一种无人机航迹规划和远程同步操控方法 | |
CN109823571A (zh) | 一种遥感微纳卫星的多阶段姿态控制方法 | |
CN105115508A (zh) | 基于后数据的旋转制导炮弹快速空中对准方法 | |
CN113108779B (zh) | 一种基于1553b总线三冗余的自主箭测系统 | |
CN104121930B (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN103512570B (zh) | 一种预置45°带解算失效判定的寻北方法 | |
CN112783204B (zh) | 一种四旋翼无人机地面机动目标实时跟踪系统及方法 | |
CN111141282B (zh) | 基于龙芯处理器定瞄计算机的定位瞄准控制方法及装置 | |
CN112393743A (zh) | 一种物理运动测试方式的组合导航验证系统及方法 | |
CN112668107A (zh) | 基于立式转台的航天运载器试验方法、装置及存储介质 | |
CN103954271A (zh) | 一种包括全站仪的测量系统和测量方法 | |
CN115214693B (zh) | 横摆角速度修正方法、装置以及车辆 | |
CN109857140A (zh) | 运载火箭俯仰程序角计算方法、系统、设备及存储介质 | |
CN112650193B (zh) | 一种两体动力学模型试验验证方法 | |
CN115127592A (zh) | 一种惯组测试方法、系统、终端设备及存储介质 | |
CN114485675A (zh) | 无人机航姿解算方法 | |
CN108416093B (zh) | 一种通用的星箭分离时刻卫星飞行状态确定系统及方法 | |
CN113108809A (zh) | 用于卫星姿轨控综合测试的星敏感器信号模拟设备及方法 | |
CN112550771B (zh) | 姿轨控通用综合测试的控制力矩陀螺信号采集方法及系统 | |
CN112577489B (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 |