CN106200614A - 一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法 - Google Patents
一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法 Download PDFInfo
- Publication number
- CN106200614A CN106200614A CN201610562799.2A CN201610562799A CN106200614A CN 106200614 A CN106200614 A CN 106200614A CN 201610562799 A CN201610562799 A CN 201610562799A CN 106200614 A CN106200614 A CN 106200614A
- Authority
- CN
- China
- Prior art keywords
- control
- spacecraft
- moment
- sensor
- simulator
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Testing Of Devices, Machine Parts, Or Other Structures Thereof (AREA)
Abstract
本发明涉及一种航天器姿控测试系统由敏感器模拟器、执行机构模拟器、前置站、外系统等效器和数据显示及存储系统组成。其中前置站负责动力学计算并输出敏感器模拟器激励信号;执行机构模拟器中的静态控制力矩陀螺模拟器通过采用静态力矩测量台测量控制力矩陀螺产生的真实力矩并将其引入动力学计算。静态力矩测量台由底座、台面、四个成对称十字分布的二维力传感器和一个万向节构成,用于测量固定在其上台面的控制力矩陀螺的输出力矩。本发明能够使GNC系统的控制算法得以更真实有效的验证,而相比于半物理仿真和全物理仿真实验,该方法简单易行、成本极低。
Description
技术领域
本发明涉及一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法,可用于采用控制力矩陀螺作为执行机构进行姿态控制的航天器的GNC系统地面测试。
背景技术
控制力矩陀螺具有控制力矩大、相应速度快和功耗低等优点,因此越来越多的航天器为了是想姿态的快速机动而选择了控制力矩陀螺作为执行机构。特别对于大型长寿命航天器,控制力矩陀螺是其必须的执行机构,已经有着广泛和成熟的应用。
控制力矩陀螺作为高控制精度和稳定度、高机动能力的执行机构,需要更高性能的仿真系统对其进行地面验证。在传统的航天器姿态控制测试系统中,通过测量控制力矩陀螺输出的框架角位置和角速度信息,并将这些信息传递给控制力矩陀螺的数学模型以计算得出其输出力矩,最终将该力矩传递给航天器动力学仿真系统以实现闭环测试。
在传统仿真实验中,为了完成控制力矩陀螺数学模型的建立进行了一些假设:转子转速为标称转速,转子质量相对于转动轴均匀分布;框架角速度是相邻控制周期的框架位置之差;不考虑框架转动带来的附加角动量。然而,(1)高速转子由于结构不对称、加工误差等特性会导致转子不平衡,使得角动量呈现复杂的变化特性,导致转子角动量必然和假设值存在误差;(2)低速框架由于摩擦、间隙等因素的存在使得输入和输出信号关系会表现出回环特性和死区特性,导致框架角速度离散作差的计算方法带来离散化误差;(3)框架角位置传感器也必然会引入测量误差,在低速运行时,对于系统误差的影响更为明显;(4)由于框架是有质量的,其转动必然会产生额外的角动量误差;(5)由于计算方法和多层数据传输的原因,也会引起系统误差或时间延迟。以上误差的存在使得控制力矩陀螺输出的真实力矩与其数学模型的输出不一致,不一致增大了地面闭环实验与在轨运行真实姿态控制的差异,影响控制力矩陀螺地面验证的真实性。
综上,现有的航天器姿控测试系统中,单框架控制力矩陀螺采用简化的数学模型代替真实产品进行实验,由于单框架控制力矩陀螺结构和不确定扰动的复杂性,真实控制力矩陀螺的输出力矩特性与数学模型的输出力矩存在较大差异,该差异影响了仿真系统的真实性。
相比于上述系统,采用全物理仿真平台能够避免上述缺点,但全物理仿真平台使用成本巨大,只有在专项实验中使用。而针对频繁的系统实验,显然全程采用全物理仿真平台耗资巨大且无必要。
因此,有必要在设计一种测试系统,在保证运行成本较低的情况下能够将控制力矩陀螺的真实输出力矩在航天器姿控系统的闭环实验中体现出来。从而确保闭环实验的真实性和准确性。
发明内容
本发明的技术解决问题是:克服现有技术不足,提供一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法,解决了控制力矩陀螺真实输出力矩不能引入闭环实验的问题,减小地面闭环实验与在轨运行真实姿态控制的差异,提高控制力矩陀螺地面验证的真实性。
本发明的技术解决方案:一种采用控制力矩陀螺真实力矩的航天器姿控测试系统,如图1所示,包括:GNC控制器1、执行机构、静态力矩测量台3、前置站6、敏感器模拟器、敏感器、外系统等效器21、数据显示和存储系统22,其中:
GNC控制器1在每个控制周期接收来自敏感器的测量数据,根据敏感器的测量数据和姿态控制算法计算得出执行机构的控制命令并将所述控制命令发送给执行机构;
执行机构用于接收并执行来自GNC控制器1的控制命令,控制命令包括控制力矩陀螺控制命令、磁力矩器控制命令和推进系统控制命令,根据控制命令产生相应的力矩;执行机构包括控制力矩陀螺2、磁力矩器4和推进系统5;
静态力矩测量台3,用于测量控制力矩陀螺的输出力矩,根据控制力矩陀螺2的实际输出力矩得到测量力矩并输出给前置站6;
前置站6用于磁力矩器控制命令、推进系统控制命令以及静态力矩测量台3输出测量力矩的采集和恒流源激励信号、动态星模拟器激励信号以及红外地球模拟器激励信号的输出;前置站由仿真计算机7和信号调理模块7组成,其采集的推进系统控制命令传递给仿真计算机7的推进系统数学模型9,采集的磁力矩器控制命令传递给仿真计算机7的磁力矩器数学模型10,采集的静态力矩测量台3输出的测量力矩传递给仿真计算机7的力矩计算模块11;
仿真计算机7中的推进系统数学模型9用于计算推进系统作用于航天器本体系下的三轴力矩,其接收来自GNC控制器1的推进系统控制命令,经过仿真计算出推进系统作用于航天器本体系下的三轴力矩;
仿真计算机7中的磁力矩器数学模型10用于计算磁力矩器作用于航天器本体系下的三轴力矩,接收来自GNC控制器1的磁力矩器控制命令,从仿真计算机7中的动力学计算模块12的动力学输出中提取84坐标系下航天器的位置和姿态四元数,经过仿真计算输出磁力矩器作用于航天器本体系下的三轴力矩;
仿真计算机7中的力矩计算模块11用于计算控制力矩陀螺作用于航天器的实际力矩,接收静态力矩测量台3传来的测量力矩,从仿真计算机7中的坐标变换模块13获得惯性坐标系下航天器的角速度,经过仿真计算得出控制力矩陀螺作用于航天器的航天器本体系下的三轴力矩;
仿真计算机7中的动力学计算模块12用于完成航天器姿态动力学的计算,接收推进系统数学模型9、磁力矩器数学模型10以及力矩计算模块11输出的航天器本体系下的三轴力矩之和,即航天器本体系下的三轴合力矩,经过动力学计算,完成航天器的动力学输出;
仿真计算机7中的敏感器激励信号计算模块14用于完成各敏感器或敏感器模拟器激励信号的计算,敏感器激励信号计算模块14接收动力学计算模块12的动力学输出,根据动力学输出解算出并输出敏感器和敏感器模拟器的激励信号;
前置站6的信号调理模块8用于敏感器和敏感器模拟器信号的调理,其接收来自仿真计算机7中敏感器激励信号计算模块14输出的敏感器和敏感器模拟器激励信号,对这些信号进行必要的处理从而输出陀螺、加速度计17需要的恒流源激励信号,动态星模拟器15需要的动态星模拟器激励信号,红外地球模拟器16需要的红外地球模拟器激励信号和太阳敏感器需要的恒流源激励信号;
模拟器敏感器包括动态星模拟器15和红外地球模拟器16,分别用于完成对星空中指定区域星图和对地球红外辐射的模拟。动态星模拟器15通过接收前置站信号调理模块8输出的动态星模拟器激励信号,模拟出该激励指定的特定区域的星图并用该星图激励星敏感器18;红外地球模拟器16通过接收前置站信号调理模块8输出的红外地球模拟器激励信号,模拟出航天器不同位姿下接收到的地球红外辐射用于激励红外地球敏感器19;
敏感器包括陀螺、加速度计17,星敏感器18,红外地球敏感器19和太阳敏感器20,它们通过接收各自的激励信号完成对航天器姿态和角速度的测量并将测量结果输出给GNC控制器;
外系统等效器21用于完成对GNC控制器1发送指令和注入同时实现对GNC控制器1遥测数据的采集;
数据显示和存储系统22,用于实验过程中测试数据的显示和存储,其接收外系统等效器21采集到的遥测数据和发送出的指令和注入,将其实时地显示出来并存储到硬盘中。
所述静态力矩测量台3由上台面、底座、四个二维力传感器(Q1,Q2,Q3,Q4)和一个万向节组成;四个二维力传感器对称分布,固定在底座的上端面和上台面的下端面,用于测量上台面上所放置物体产生的三轴力矩;万向节固定于底座并支撑上台面中心,用于支撑上台面,使得在控制力矩陀螺无力矩输出时,上台面对四个二维力传感器的作用力为0;四个二维力传感器十字对称安装于底座上并对上台面进行支撑。
所述静态力矩测量台3的输出三轴力矩包括二维力传感器Q1测量得到的压力N1和侧向力F1,二维力传感器Q2测量得到的压力N2和侧向力F2,二维力传感器Q3测量得到的压力N3和侧向力F3,二维力传感器Q4测量得到的压力N4和侧向力F4,两个相对二维力传感器之间的距离为L。
所述的控制力矩陀螺2安装到静态力矩测量台3的上台面,当控制力矩陀螺2没有力矩输出时,所述的静态力矩测量台3输出的测量力矩为0。
所述推进系统数学模型9包含了推进系统5发动机的安装位置矩阵、安装姿态矩阵和发动机比冲,根据GNC控制器1发出的推进系统控制命令得到推进系统的开机时间和关机时间,根据开机时间和关机时间计算出推进系统产生的推力大小,再根据该推力大小和发动机的安装位置和安装姿态计算出推进系统数学模型9输出的航天器本体系下的三轴力矩。
所述磁力矩器数学模型10包含了磁力矩器4的安装姿态矩阵、力矩—控制命令对应公式和地球磁场模型,根据力矩—控制命令对应公式、地球磁场模型、GNC控制器1发出的磁力矩器控制命令以及动力学计算模块12给出的84坐标系下航天器的位置和姿态四元数计算得到磁力矩器输出力矩大小,根据计算得到的磁力矩器输出力矩大小和磁力矩4的安装姿态矩阵计算得出磁力矩器数学模型输出的航天器本体系下的三轴力矩。
所述力矩计算模块11包含有控制力矩陀螺2的安装矩阵A,控制力矩陀螺框架坐标系到控制力矩陀螺本体坐标系的转换矩阵B,根据接收到的来自坐标变换模块13的惯性系下航天器的姿态角速度ωb,来自静态力矩测量台3的输出力矩,通过如下公式
T=[Tx Ty Tz]T
Tx=(N2-N4)L
Ty=(N3-N1)L
Tz=(F1+F2+F3+F4)L
Tb=A(T+B((B-1A-1ωb)×H))
计算得出力矩计算模块11输出的航天器本体系下的三轴力矩Tb;静态力矩测量台3输出包括四个压力N1、N2、N3、N4,和四个侧向力F1、F2、F3、F4。
本发明测试方法的实现步骤如下:
(1)建造静态力矩测量台。在固定底座上建立直角坐标系OXYZ,OZ轴竖直向上。将四个二维力传感器Q1~Q4和一个万向节安装于固定底座,二维传感器Q1~Q4呈十字对称分布,万向节安装于四个二维传感器Q1~Q4的对称中心。在二维传感器Q1~Q4上安装测量台面,测量台面与四个力传感器和万向节固定。
(2)将控制力矩陀螺安装在静态力矩测量台上,使得控制力矩陀螺本体坐标系ObXbYbZb与静态力矩测量台的坐标系OXYZ重合。
(3)航天器姿态控制系统测试前静态力矩测量台的零位标定。零位标定在控制力矩陀螺安装到静态力矩测量台上后并完全静止时进行,记录控制力矩陀螺完全静止状态下静态力矩测量台的输出N10,N20,N30,N40,F10,F20,F30,F40。
(4)航天器姿态控制系统测试过程中控制力矩陀螺的输出力矩测量值计算。当控制力矩陀螺开始工作,静态力矩测量台四个二维力传感器的输出为N1,N2,N3,N4,F1,F2,F3,F4;根据(3)中测量得到的静态力矩测量台的零位输出,计算得到静态力矩测量台测量得到的控制力矩陀螺输出力矩Tc=(Txc,Tyc,Tzc)为
Txc=((N2-N20)-(N4-N40))L
Tyc=((N3-N30)-(N1-N10))L
Tzc=((F1-F10)+(F2-F20)+(F3-F30)+(F4-F40))L。
(5)控制力矩陀螺作用于航天器三轴上的力矩计算,根据(4)中得到的控制力矩陀螺输出力矩Tc和前置站力矩计算模块(11),得到控制力矩陀螺作用于航天器上的航天器本体系下的三轴力矩,并将该力矩输入给航天器姿态动力学参与航天器姿态运算。
(6)通过(5)得到的控制力矩陀螺最终作用于航天器上的航天器本体系下的三轴力矩与推进系统数学模型(9)与磁力矩器数学模型(10)输出的航天器本体系下的三轴力矩求和后作为航天器姿态动力学运算的输入力矩参与动力学仿真计算。
本发明和现有技术相比所具有的优点及积极效果:
(1)本采用静态多维力矩传感器的方式将控制力矩陀螺的真实输出力矩引入动力学,避免了传统建模方法的建模误差。
(2)可以辅助检测控制力矩陀螺本身的状态,如:测试过程中产品高速和低速机构的性能趋势,筛选性能优的控制力矩陀螺。
(3)测得的控制力矩陀螺输出力矩不受控制力矩陀螺转子不平衡,框架转速误差、死区非线性,控制力矩陀螺轴承干扰和空气阻尼等因素产生的影响,简单易行并且验证效果更加真实。在航天领域广泛应用控制力矩陀螺的前景下,该系统具有重要的参考价值和实用意义。
附图说明
图1为本发明的系统组成框图;
图2静态力矩测量台结构图。
具体实施方式
下面结合附图对本发明进行详细说明。
一、关键部件具体设计与实施
(1)GNC控制器1、执行机构和敏感器
GNC控制器1、执行机构和敏感器为真实的天上产品,用于航天器在轨期间完成GNC任务,是航天器姿控测试系统中的被测试对象。
(2)静态力矩测量台3及其标定算法
静态力矩测量台用于完成对固定于其测量面的控制力矩陀螺输出的力矩进行测量,如图2所示,其关键部件为4个二维力传感器、1个万向节、1个底座和1个上台面。根据控制力矩陀螺工作过程中产生的最大力矩输出N,兼顾到力传感器的灵敏度,以最大输出力矩的1.2倍作为静态力矩测量台的最大力矩测量量程,本发明中静态力矩测量台的最大测量量程为2000Nm;根据控制力矩陀螺的外形尺寸,选择静态力矩测量台的上台面半径R使得当控制力矩陀螺的重心位于上台面圆心位置正上方时,控制力矩陀螺安装座在水平面的投影落在力矩测量台上台面内,本发明中半径R选择为0.45m;力传感器动态响应要求高,本发明选用具有较高动态特性的二维压电晶体作为力敏感元件;力传感器按照十字对称布局安装,两个相对传感器之间距离L尽量大以提高测量灵敏度,本设计中选择为0.8m;根据最大测量量程和两个相对传感器之间的安装距离根据公式
Nmax=Tmax/L
选择力传感器纵向测量范围;根据公式
Nmax=Tmax/2L
选择力传感器的横向测量范围。
静态力矩测量台的标定在航天器姿控测试系统的开环运行阶段进行,在控制力矩陀螺完全静止的情况下对静态力矩测量台进行标定。对静态力矩测量台力传感器Q1~Q4的输出力矩进行采集,采集周期与动力学程序计算周期相同,记录20次采集结果N1i,N2i,N3i,N4i,F1i,F2i,F3i,F4i(i=1~20);计算其均值并取
(3)前置站6
前置站6用于完成磁力矩器控制命令、推进系统控制命令、静态力矩测量台3输出测量力矩的采集和恒流源激励信号、动态星模拟器激励信号、红外地球模拟器激励信号的输出以及动力学仿真算法运行;前置站由仿真计算机7和信号调理模块8组成。
控制器1输出给磁力矩器和推进系统的控制指令通过1分2电缆分别接到磁力矩器、推进系统和前置站。前置站只对控制器1发送出的控制信号进行接收监听;前置站负责将监听到的正确控制命令转换为数字量分别传递给推进系统数学模型9和磁力矩器数学模型10。静态力矩测量台的测量结果直接转换为数字量并由前置站采集后传递给力矩计算模块。本发明实施例中控制命令和与静态力矩测量台的数据交换均通过CPCI板卡实现,并将数据传递给仿真计算机。
(a)仿真计算机7和动力学仿真算法
仿真计算机7为前置站的核心设备,通过工业计算机实现,用于执行航天器动力学仿真算法。
推进系统数学模型9是航天器动力学仿真算法的一部分,其考虑了推进系统的开关机延迟和上升下降曲线的简化模型,且模型参数可配置。
磁力矩器数学模型10是航天器动力学仿真算法的一部分,所用到的地磁场模型采用球谐波模型。
力矩计算模块11是航天器动力学仿真算法的一部分,用于完成静态力矩测量台测量力矩到控制力矩陀螺作用到航天器本体系下三轴力矩的转换,其转换公式为
Tc=(Txc,Tyc,Tzc)
Txc=((N2-N20)-(N4-N40))L
Tyc=((N3-N30)-(N1-N10))L
Tzc=((F1-F10)+(F2-F20)+(F3-F30)+(F4-F40))L。
其中,N1,N2,N3,N4,F1,F2,F3,F4为静态力矩测量台的输出,N10,N20,N30,N40,F10,F20,F30,F40为静态力矩测量台的标定零位,Tc为静态力矩测量台的测量力矩,Tb为航天器本体系下三轴力矩,A为控制力矩陀螺在航天器上的安装矩阵,B为控制力矩陀螺框架坐标系到控制力矩陀螺本体坐标系的转换矩阵,ωb为航天器角速度载其本体系的投影,H为控制力矩陀螺转子的标称转动惯量。
动力学计算模块12是航天器动力学仿真算法的核心内容,其输入为航天器本体系下的三轴力矩,其计算公式如下:
am=F
其中,F为作用于航天器质心的力,q为航天器姿态四元数,I为航天器转动惯量,T为作用于航天器本体系下的三轴力矩。动力学计算模块的输出包括了航天器本体坐标系下航天器角速度,轨道坐标系下的姿态四元数q,84坐标系下航天器的位置和速度以及后续地球敏感器模拟器16用到的地球弦宽、地入角信息。
坐标变换模块13用于完成航天器本体系下的动力学输出到惯性坐标系和84坐标系下到转换。
敏感器激励信号计算模块14根据航天器本体系下的动力学输出计算的出各敏感器的激励信号,用于后续激励前置站的信号调理模块8。
(b)信号调理模块8
信号调理模块8用于完成数字信号到电信号的转换。针对陀螺和加速度17和红外太阳敏感器20,信号调理模块完成接收到的来自仿真计算机7的数字信号到恒流源信号的转换;针对动态星模拟器15,信号调理模块用于完成与动态星模拟器控制计算机之间的接口转换;针对红外地球模拟器16,信号调理模块用于完成与红外地球模拟器控制计算机之间的接口转换。
(4)模拟器敏感器
模拟器敏感器包括动态星模拟器15和红外地球敏感器模拟器16。动态星模拟器15接收经过前置站信号调理模块8输出的航天器姿态四元数q结合动态星模拟器自身星图,形成星空图象并将图象投给星敏感器18。红外地球敏感器模拟器根据前置站信号调理模块8传来的地球弦宽和地入角信息设置与其对应的模拟器状态。
(5)外系统等效器21和数据显示和存储系统22
外系统等效器用于与GNC分系统有信号连接关系的其他外部分系统用于配合GNC分系统完成测试工作;数据显示和存储系统22用于记录并显示测试过程成产生的数据,由工作人员进行现场判读和后续数据复查。
二、工作流程
本发明的工作流程如下:
(1)初始时刻,数据显示和存储系统、敏感器模拟器、静态力矩测量台、外系统等效器、前置站、GNC控制器、执行机构、敏感器依次序加电,并设置GNC控制器工作在待发工作模式;
(2)在控制力矩陀螺完全静止的状态下标定静态力矩测量台。
(3)测试设备设置到闭环工作模式,前置站动力学计算程序保持在待触发模式,程序不运行;
(4)外系统等效器模拟船箭分离信号发出;
(5)(a)前置站将监听到的控制命令和静态力矩测量台的输出传递到仿真计算机7;
(b)仿真计算机7根据输入的信息依次计算推进系统数学模型9、磁力矩器数学模型10和力矩计算模块11的输出并对三者输出求和;
(c)求和后的航天器本体系下的三轴力矩传递到动力学计算模块12进行动力学计算并输出计算结果;
(d)动力学计算结果分别发送给坐标变换模块13和敏感器激励信号计算模块14并得到各自输出结果;
(e)仿真计算机7输出给信号调理模块8敏感器和敏感器模拟器激励信号,信号调理模块8将其转换成敏感器和敏感器模拟器相应信号并从前置站输出。
(6)敏感器模拟器根据输入信息产生对应敏感器的激励信号,所有敏感器根据各自激励信号产生测量数据并将数据传递给GNC控制器1;
(7)GNC控制器1运行一拍控制器应用程序生成下一拍的控制指令并发送非执行机构;
(8)下一控制周期将重复(5)~(7)的步骤。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (8)
1.一种采用控制力矩陀螺真实力矩的航天器姿控测试系统,其特征在于包括:GNC控制器(1)、执行机构、静态力矩测量台(3)、前置站(6)、敏感器模拟器、敏感器、外系统等效器(21)、数据显示和存储系统(22),其中:
GNC控制器(1)在每个控制周期接收来自敏感器的测量数据,根据敏感器的测量数据和姿态控制算法计算得出执行机构的控制命令并将所述控制命令发送给执行机构;
执行机构用于接收并执行来自GNC控制器(1)的控制命令,控制命令包括控制力矩陀螺控制命令、磁力矩器控制命令和推进系统控制命令,根据控制命令产生相应的力矩;执行机构包括控制力矩陀螺(2)、磁力矩器(4)和推进系统(5);
静态力矩测量台(3),用于测量控制力矩陀螺的输出力矩,根据控制力矩陀螺(2)的实际输出力矩得到测量力矩并输出给前置站(6);
前置站(6)用于磁力矩器控制命令、推进系统控制命令以及静态力矩测量台(3)输出测量力矩的采集和恒流源激励信号、动态星模拟器激励信号以及红外地球模拟器激励信号的输出;前置站由仿真计算机(7)和信号调理模块(8)组成,其采集的推进系统控制命令传递给仿真计算机(7)的推进系统数学模型(9),采集的磁力矩器控制命令传递给仿真计算机(7)的磁力矩器数学模型(10),采集的静态力矩测量台(3)输出的测量力矩传递给仿真计算机(7)的力矩计算模块(11);
仿真计算机(7)中的推进系统数学模型(9)用于计算推进系统作用于航天器本体系下的三轴力矩,其接收来自GNC控制器(1)的推进系统控制命令,经过仿真计算出推进系统作用于航天器本体系下的三轴力矩;
仿真计算机(7)中的磁力矩器数学模型(10)用于计算磁力矩器作用于航天器本体系下的三轴力矩,接收来自GNC控制器(1)的磁力矩器控制命令,从仿真计算机(7)中的动力学计算模块(12)的动力学输出中提取84坐标系下航天器的位置和姿态四元数,经过仿真计算输出磁力矩器作用于航天器本体系下的三轴力矩;
仿真计算机(7)中的力矩计算模块(11)用于计算控制力矩陀螺作用于航天器的实际力矩,接收静态力矩测量台(3)传来的测量力矩,从仿真计算机(7)中的坐标变换模块(13)获得惯性坐标系下航天器的角速度,经过仿真计算得出控制力矩陀螺作用于航天器的航天器本体系下的三轴力矩;
仿真计算机(7)中的动力学计算模块(12)用于完成航天器姿态动力学的计算,接收推进系统数学模型(9)、磁力矩器数学模型(10)以及力矩计算模块(11)输出的航天器本体系下的三轴力矩之和,即航天器本体系下的三轴合力矩,经过动力学计算,完成航天器的动力学输出;
仿真计算机(7)中的敏感器激励信号计算模块(14)用于完成各敏感器或敏感器模拟器激励信号的计算,敏感器激励信号计算模块(14)接收动力学计算模块(12)的动力学输出,根据动力学输出解算出并输出敏感器和敏感器模拟器的激励信号;
前置站(6)的信号调理模块(8)用于敏感器和敏感器模拟器信号的调理,其接收来自仿真计算机(7)中敏感器激励信号计算模块(14)输出的敏感器和敏感器模拟器激励信号,对这些信号进行必要的处理从而输出陀螺、加速度计(17)需要的恒流源激励信号,动态星模拟器(15)需要的动态星模拟器激励信号,红外地球模拟器(16)需要的红外地球模拟器激励信号和太阳敏感器需要的恒流源激励信号;
模拟器敏感器包括动态星模拟器(15)和红外地球模拟器(16),分别用于完成对星空中指定区域星图和对地球红外辐射的模拟。动态星模拟器(15)通过接收前置站信号调理模块(8)输出的动态星模拟器激励信号,模拟出该激励指定的特定区域的星图并用该星图激励星敏感器(18);红外地球模拟器(16)通过接收前置站信号调理模块(8)输出的红外地球模拟器激励信号,模拟出航天器不同位姿下接收到的地球红外辐射用于激励红外地球敏感器(19);
敏感器包括陀螺、加速度计(17),星敏感器(18),红外地球敏感器(19)和太阳敏感器(20),它们通过接收各自的激励信号完成对航天器姿态和角速度的测量并将测量结果输出给GNC控制器;
外系统等效器(21)用于完成对GNC控制器(1)发送指令和注入同时实现对GNC控制器(1)遥测数据的采集;
数据显示和存储系统(22),用于实验过程中测试数据的显示和存储,其接收外系统等效器(21)采集到的遥测数据和发送出的指令和注入,将其实时地显示出来并存储到硬盘中。
2.根据权利要求1所述的一种采用控制力矩陀螺真实力矩的航天器姿控测试系统,其特征在于:所述静态力矩测量台(3)由上台面、底座、四个二维力传感器(Q1,Q2,Q3,Q4)和一个万向节组成;四个二维力传感器对称分布,固定在底座的上端面和上台面的下端面,用于测量上台面上所放置物体产生的三轴力矩;万向节固定于底座并支撑上台面中心,用于支撑上台面,使得在控制力矩陀螺无力矩输出时,上台面对四个二维力传感器的作用力为0;四个二维力传感器十字对称安装于底座上并对上台面进行支撑。
3.根据权利要求2所述的一种采用控制力矩陀螺真实力矩的航天器姿控测试系统,其特征在于:所述静态力矩测量台(3)的输出三轴力矩包括二维力传感器Q1测量得到的压力N1和侧向力F1,二维力传感器Q2测量得到的压力N2和侧向力F2,二维力传感器Q3测量得到的压力N3和侧向力F3,二维力传感器Q4测量得到的压力N4和侧向力F4,两个相对二维力传感器之间的距离为L。
4.根据权利要求1所述的一种采用控制力矩陀螺真实力矩的航天器姿控测试系统,其特征在于:所述控制力矩陀螺(2)安装到静态力矩测量台(3)的上台面,当控制力矩陀螺(2)没有力矩输出时,所述的静态力矩测量台(3)输出的测量力矩为0。
5.根据权利要求1所述的一种采用控制力矩陀螺真实力矩的航天器姿控测试系统,其特征在于:所述推进系统数学模型(9)包含了推进系统(5)发动机的安装位置矩阵、安装姿态矩阵和发动机比冲,根据GNC控制器(1)发出的推进系统控制命令得到推进系统的开机时间和关机时间,根据开机时间和关机时间计算出推进系统产生的推力大小,再根据该推力大小和发动机的安装位置和安装姿态计算出推进系统数学模型(9)输出的航天器本体系下的三轴力矩。
6.根据权利要求1所述的一种采用控制力矩陀螺真实力矩的航天器姿控测试系统,其特征在于:所述磁力矩器数学模型(10)包含了磁力矩器(4)的安装姿态矩阵、力矩—控制命令对应公式和地球磁场模型,根据力矩—控制命令对应公式、地球磁场模型、GNC控制器(1)发出的磁力矩器控制命令以及动力学计算模块(12)给出的84坐标系下航天器的位置和姿态四元数计算得到磁力矩器输出力矩大小,根据计算得到的磁力矩器输出力矩大小和磁力矩(4)的安装姿态矩阵计算得出磁力矩器数学模型输出的航天器本体系下的三轴力矩。
7.根据权利要求3所述的一种采用控制力矩陀螺真实力矩的航天器姿控测试系统,其特征在于:所述力矩计算模块(11)包含有控制力矩陀螺(2)的安装矩阵A,控制力矩陀螺框架坐标系到控制力矩陀螺本体坐标系的转换矩阵B,根据接收到的来自坐标变换模块(13)的惯性系下航天器的姿态角速度ωb,来自静态力矩测量台(3)的输出力矩,通过如下公式
T=[Tx Ty Tz]T
Tx=(N2-N4)L
Ty=(N3-N1)L
Tz=(F1+F2+F3+F4)L
Tb=A(T+B((B-1A-1ωb)×H))
计算得出力矩计算模块(11)输出的航天器本体系下的三轴力矩Tb;静态力矩测量台(3)输出包括四个压力N1、N2、N3、N4,和四个侧向力F1、F2、F3、F4。
8.一种采用控制力矩陀螺真实力矩的航天器姿控测试方法,其特征在于实现步骤如下:
第一步,建造静态力矩测量台。在固定底座上建立直角坐标系OXYZ,OZ轴竖直向上,将四个二维力传感器Q1~Q4和一个万向节安装于固定底座,二维传感器Q1~Q4呈十字对称分布,万向节安装于四个二维传感器Q1~Q4的对称中心;在二维传感器Q1~Q4上安装测量台面,测量台面与四个力传感器和万向节固定;
第二步,将控制力矩陀螺安装在静态力矩测量台上,使得控制力矩陀螺本体坐标系ObXbYbZb与静态力矩测量台的坐标系OXYZ重合;
第三步,航天器姿态控制系统测试前静态力矩测量台的零位标定。零位标定在控制力矩陀螺安装到静态力矩测量台上后并完全静止时进行,记录控制力矩陀螺完全静止状态下静态力矩测量台的输出N10,N20,N30,N40,F10,F20,F30,F40;
第四步,航天器姿态控制系统测试过程中控制力矩陀螺的输出力矩测量值计算,当控制力矩陀螺开始工作,静态力矩测量台四个二维力传感器的输出为N1,N2,N3,N4,F1,F2,F3,F4;根据第三步中测量得到的静态力矩测量台的零位输出,计算得到静态力矩测量台测量得到的控制力矩陀螺输出力矩Tc=(Txc,Tyc,Tzc)为
Txc=((N2-N20)-(N4-N40))L
Tyc=((N3-N30)-(N1-N10))L
Tzc=((F1-F10)+(F2-F20)+(F3-F30)+(F4-F40))L;
第五步,控制力矩陀螺作用于航天器三轴上的力矩计算,根据第四步中得到的控制力矩陀螺输出力矩Tc和前置站力矩计算模块,得到控制力矩陀螺作用于航天器上的航天器本体系下的三轴力矩,并将该力矩输入给航天器姿态动力学参与航天器姿态运算。
第六步,通过第五步得到的控制力矩陀螺最终作用于航天器上的航天器本体系下的三轴力矩与推进系统数学模型与磁力矩器数学模型输出的航天器本体系下的三轴力矩求和后作为航天器姿态动力学运算的输入力矩参与动力学仿真计算。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610562799.2A CN106200614B (zh) | 2016-07-15 | 2016-07-15 | 一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610562799.2A CN106200614B (zh) | 2016-07-15 | 2016-07-15 | 一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106200614A true CN106200614A (zh) | 2016-12-07 |
CN106200614B CN106200614B (zh) | 2018-12-21 |
Family
ID=57475634
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610562799.2A Active CN106200614B (zh) | 2016-07-15 | 2016-07-15 | 一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106200614B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106773794A (zh) * | 2017-02-14 | 2017-05-31 | 上海航天控制技术研究所 | 自主判断真实单机或数学模型接入半物理仿真系统的方法 |
CN108983637A (zh) * | 2018-09-04 | 2018-12-11 | 上海微小卫星工程中心 | 一种采用反作用轮的卫星控制系统半物理仿真方法 |
CN109186613A (zh) * | 2018-10-16 | 2019-01-11 | 北京电子工程总体研究所 | 基于地球敏感器和陀螺仪的航天器姿态确定系统及方法 |
CN110007659A (zh) * | 2019-03-21 | 2019-07-12 | 惠州工程职业学院 | 一种用于航天器姿态控制算法的集成测试仿真系统 |
CN110456663A (zh) * | 2019-08-19 | 2019-11-15 | 哈尔滨工业大学 | 基于多源信息融合的飞行器导航控制技术仿真装置及方法 |
CN110568773A (zh) * | 2019-09-29 | 2019-12-13 | 上海航天控制技术研究所 | 一种控制力矩陀螺群故障模拟仿真测试的方法及系统 |
CN110672129A (zh) * | 2019-11-08 | 2020-01-10 | 桂林电子科技大学 | 控制力矩陀螺动力特性测试的装置及方法 |
CN111207775A (zh) * | 2020-02-24 | 2020-05-29 | 上海航天控制技术研究所 | 卫星gnc系统半物理仿真闭环测试陀螺零位标定方法 |
CN112550771A (zh) * | 2020-12-22 | 2021-03-26 | 上海卫星工程研究所 | 姿轨控通用综合测试的控制力矩陀螺信号采集方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5251155A (en) * | 1990-01-24 | 1993-10-05 | Kabushiki Kaisha Toshiba | System identification apparatus using spectrum analysis of resonation frequencies |
CN101344788A (zh) * | 2008-09-02 | 2009-01-14 | 南京航空航天大学 | 小卫星姿态控制可靠性验证的仿真测试设备及其测试方法 |
CN101477376A (zh) * | 2009-01-14 | 2009-07-08 | 南京航空航天大学 | 航天器执行机构故障注入装置及其故障注入方法 |
RU90589U1 (ru) * | 2008-09-10 | 2010-01-10 | Томский Государственный Университет Систем Управления И Радиоэлектроники (Тусур) | Автоматизированный комплекс наземного контроля и испытаний систем электроснабжения космических аппаратов |
EP2508955A2 (en) * | 2011-04-06 | 2012-10-10 | The Boeing Company | Complex system function status diagnosis and presentation |
CN103197669A (zh) * | 2013-04-12 | 2013-07-10 | 北京航空航天大学 | 基于一种dgcmg构型的卫星多种姿态控制模式测试系统 |
CN104486335A (zh) * | 2014-12-12 | 2015-04-01 | 北京控制工程研究所 | 一种高复杂度航天器gnc数据实时智能处理系统 |
-
2016
- 2016-07-15 CN CN201610562799.2A patent/CN106200614B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5251155A (en) * | 1990-01-24 | 1993-10-05 | Kabushiki Kaisha Toshiba | System identification apparatus using spectrum analysis of resonation frequencies |
CN101344788A (zh) * | 2008-09-02 | 2009-01-14 | 南京航空航天大学 | 小卫星姿态控制可靠性验证的仿真测试设备及其测试方法 |
RU90589U1 (ru) * | 2008-09-10 | 2010-01-10 | Томский Государственный Университет Систем Управления И Радиоэлектроники (Тусур) | Автоматизированный комплекс наземного контроля и испытаний систем электроснабжения космических аппаратов |
CN101477376A (zh) * | 2009-01-14 | 2009-07-08 | 南京航空航天大学 | 航天器执行机构故障注入装置及其故障注入方法 |
EP2508955A2 (en) * | 2011-04-06 | 2012-10-10 | The Boeing Company | Complex system function status diagnosis and presentation |
CN103197669A (zh) * | 2013-04-12 | 2013-07-10 | 北京航空航天大学 | 基于一种dgcmg构型的卫星多种姿态控制模式测试系统 |
CN104486335A (zh) * | 2014-12-12 | 2015-04-01 | 北京控制工程研究所 | 一种高复杂度航天器gnc数据实时智能处理系统 |
Non-Patent Citations (2)
Title |
---|
ROBOT H 等: "Adaptive Control of space station with Control Moment Gyros", 《CONFERENCE ON DECISION AND CONTROL》 * |
张锦江 等: "天宫一号基于控制力矩陀螺的智能多模自适应姿态控制系统设计与验证", 《中国科学:技术科学》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106773794A (zh) * | 2017-02-14 | 2017-05-31 | 上海航天控制技术研究所 | 自主判断真实单机或数学模型接入半物理仿真系统的方法 |
CN106773794B (zh) * | 2017-02-14 | 2019-05-31 | 上海航天控制技术研究所 | 自主判断真实单机或数学模型接入半物理仿真系统的方法 |
CN108983637A (zh) * | 2018-09-04 | 2018-12-11 | 上海微小卫星工程中心 | 一种采用反作用轮的卫星控制系统半物理仿真方法 |
CN109186613A (zh) * | 2018-10-16 | 2019-01-11 | 北京电子工程总体研究所 | 基于地球敏感器和陀螺仪的航天器姿态确定系统及方法 |
CN110007659A (zh) * | 2019-03-21 | 2019-07-12 | 惠州工程职业学院 | 一种用于航天器姿态控制算法的集成测试仿真系统 |
CN110456663A (zh) * | 2019-08-19 | 2019-11-15 | 哈尔滨工业大学 | 基于多源信息融合的飞行器导航控制技术仿真装置及方法 |
CN110568773A (zh) * | 2019-09-29 | 2019-12-13 | 上海航天控制技术研究所 | 一种控制力矩陀螺群故障模拟仿真测试的方法及系统 |
CN110672129A (zh) * | 2019-11-08 | 2020-01-10 | 桂林电子科技大学 | 控制力矩陀螺动力特性测试的装置及方法 |
CN110672129B (zh) * | 2019-11-08 | 2024-01-16 | 桂林电子科技大学 | 控制力矩陀螺动力特性测试的装置及方法 |
CN111207775A (zh) * | 2020-02-24 | 2020-05-29 | 上海航天控制技术研究所 | 卫星gnc系统半物理仿真闭环测试陀螺零位标定方法 |
CN111207775B (zh) * | 2020-02-24 | 2023-07-07 | 上海航天控制技术研究所 | 卫星gnc系统半物理仿真闭环测试陀螺零位标定方法 |
CN112550771A (zh) * | 2020-12-22 | 2021-03-26 | 上海卫星工程研究所 | 姿轨控通用综合测试的控制力矩陀螺信号采集方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN106200614B (zh) | 2018-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106200614B (zh) | 一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法 | |
CN110471311A (zh) | 一种微纳卫星姿轨控半物理仿真综合实验平台 | |
CN102879014B (zh) | 深空探测接近过程的光学成像自主导航半物理仿真试验系统 | |
CN102620892B (zh) | 一种转动部件的动平衡测试方法 | |
CN104155538B (zh) | 一种小卫星天线综合试验测试系统 | |
CN102538819B (zh) | 基于双圆锥红外和星敏感器的自主导航半物理仿真试验系统 | |
CN101344788B (zh) | 小卫星姿态控制可靠性验证的仿真测试设备及其测试方法 | |
CN103344243B (zh) | 一种航空遥感惯性稳定平台摩擦参数辨识方法 | |
CN104296908B (zh) | 三自由度气浮台干扰力矩组成测量装置 | |
CN107037739B (zh) | 一种运载火箭半实物仿真试验惯组模拟方法 | |
CN107065594A (zh) | 一种运载火箭六自由度分布式半物理仿真方法及系统 | |
CN101497374B (zh) | 用飞轮等效模拟柔性附件振动对卫星产生干扰力矩的方法 | |
CN104133479B (zh) | 一种采用单轴气浮台模拟挠性卫星三轴姿态耦合运动的测试方法 | |
CN106840196A (zh) | 一种捷联惯性导航计算机测试系统及实现方法 | |
CN106844880A (zh) | 一种卫星动量轮扰振试验及数据判读方法 | |
CN104133379A (zh) | 四旋翼飞行器仿真方法 | |
CN105466477A (zh) | 一种面向卫星目标和恒星目标的天基观测模拟系统及方法 | |
CN109029504A (zh) | 一种基于光信号的整星级恒星敏感器测试系统及方法 | |
CN102636183A (zh) | 基于光纤监测和双轴转台离心机的挠性陀螺二次过载项测试方法 | |
CN103868648A (zh) | 三轴气浮仿真实验平台的质心测量方法 | |
CN104102216A (zh) | 一种基于过程的小卫星控制系统仿真与测试一体化系统及其方法 | |
CN102778333B (zh) | 一种在大型转动部件上做动平衡测试的方法 | |
CN105737848B (zh) | 一种系统级星敏感器观星系统及观星方法 | |
CN105628056A (zh) | 一种针对陀螺仪随机游走噪声的精细滤波方法与测试平台 | |
CN107588786B (zh) | 一种用于星敏感器仿真测试的多用途恒星模拟器驱动方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |