CN107037739A - 一种运载火箭半实物仿真试验惯组模拟方法 - Google Patents
一种运载火箭半实物仿真试验惯组模拟方法 Download PDFInfo
- Publication number
- CN107037739A CN107037739A CN201611100052.1A CN201611100052A CN107037739A CN 107037739 A CN107037739 A CN 107037739A CN 201611100052 A CN201611100052 A CN 201611100052A CN 107037739 A CN107037739 A CN 107037739A
- Authority
- CN
- China
- Prior art keywords
- used group
- clapped
- gyro
- increment
- pulse
- 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
- G05B17/00—Systems involving the use of models or simulators of said systems
- G05B17/02—Systems involving the use of models or simulators of said systems electric
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种运载火箭控制系统半实物仿真试验惯组模拟的方法,在进行半实物仿真调试、测试及正式试验阶段,可用于替代真实惯组及转台进行仿真试验,另外还具备测试真实转台和惯组动态特性的功能,该方法接收动力学模型的姿态、速度、位置信号,解算得到惯组陀螺及加表测量信号,模拟出惯组及转台的主要功能,实现正常模式及故障模式下的开环、闭环半实物仿真试验,测出转台+惯组组合体的动态特性,并且该方法可对现有转台与惯组的动态特性进行测试和模拟,在测试试验时惯组模拟器可模拟转台和惯组的主要功能,由姿态、速度、位置生成加表和陀螺测量信息,在试验过程中可代替真实设备进行试验,显著降低成本,并降低试验复杂度,简化流程。
Description
技术领域
本发明涉及运载火箭控制系统半实物仿真领域,具体涉及一种运载火箭半实物仿真试验惯组模拟方法。
背景技术
为了保证运载火箭控制系统半实物仿真试验的可靠与价值,惯组被普遍用于飞行及试验的高精度测量,通常还配置双惯组冗余。同时,闭环试验时还需配置大型高精度转台驱动惯组,这些配置大大增加了试验成本。
惯组、转台的动态特性对实时性要求极高的半实物仿真试验有很大影响。目前动态特性测试完全依赖专业的动态分析仪器,大大增加了试验成本。
发明内容
本发明的目的在于克服现有技术的上述不足,提供一种运载火箭半实物仿真试验惯组模拟方法,该模拟方法可以测出转台+惯组组合体的动态特性,并且可以代替真实设备进行试验,大大降低成本,具有更广阔的应用范围。
本发明的上述目的主要是通过如下技术方案予以实现的:
一种运载火箭半实物仿真试验惯组模拟方法,包括如下步骤:
步骤(1)、每个时间周期采集外部发送的姿态、速度和位置信息,并将所述姿态、速度和位置信息输入给惯组传递函数,模拟惯组的动态特性,获得动态姿态、速度和位置信息;
步骤(2)、对所述动态姿态、速度和位置信息进行脉冲反算,得到陀螺脉冲增量和加表脉冲增量;
步骤(3)、对所述陀螺脉冲增量和加表脉冲增量进行故障注入,并将故障注入后的陀螺脉冲增量和加表脉冲增量周期性实时向外输出。
在上述运载火箭半实物仿真试验惯组模拟方法中,还包括进行惯组模拟器参数配置,所述惯组模拟器参数配置为根据需要模拟或者被测惯组的实际参数进行惯组模拟器参数配置,包括安装矩阵Eg、Ea,标度因数Kg、Ka,零偏Dg、Da。
在上述运载火箭半实物仿真试验惯组模拟方法中,所述步骤(1)中惯组传递函数通过如下方法得到:
步骤(1.1)、每个时间周期将正弦激励信号通过转换矩阵转化为转台框角;
步骤(1.2)、采用所述转台框角控制转台运转,并实时采集惯组陀螺脉冲信号;
步骤(1.3)、将所述惯组陀螺脉冲信号进行导航计算得到姿态角信号,包括俯仰姿态角偏航姿态角ψ和滚动姿态角γ;
步骤(1.4)、根据所述姿态角信号与正弦激励信号得到惯组及转台组合体的惯组传递函数。
在上述运载火箭半实物仿真试验惯组模拟方法中,所述步骤(1.1)、(1.4)中的正弦激励信号包括俯仰、偏航和滚动姿态角的三个正弦信号,所述三个正弦信号分别根据如下正弦函数生成:
f(t)=A×sin(w×t)
其中A为幅值,w为圆频率,t为模拟器本地时钟。
在上述运载火箭半实物仿真试验惯组模拟方法中,所述转换矩阵为姿态角到转台框角的转化矩阵Czb,所述转台框角包括转台外框α、中框β和内框λ,具体转换公式如下:
其中:ψtrig、γtrig分别为俯仰、偏航和滚动姿态角。
在上述运载火箭半实物仿真试验惯组模拟方法中,所述步骤(1.3)中将所述惯组陀螺脉冲信号进行导航计算得到姿态角信号的具体方法如下:
(1.3.1)、将采集到的相邻两拍脉冲求差,得到周期时间内的陀螺脉冲增量ΔNg,所述ΔNg包括惯组陀螺三轴及斜轴的脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs;
(1.3.2)、根据如下公式得到惯组安装位置的角增量,包括惯组陀螺三轴及斜轴的角增量Δθx、Δθy、Δθz、Δθs:
其中:Kgx、Kgy、Kgz分别为惯组陀螺三个轴的标度因数,Kgs为惯组陀螺斜轴的标度因数,Dgx、Dgy、Dgz分别为惯组陀螺三个轴的零偏,Dgs为惯组陀螺斜轴的零偏,ΔT为解算周期,即相邻两拍脉冲的时间差;Eg为安装矩阵。
(1.3.3)、根据惯组安装位置的角增量计算当前拍四元数q0(n)、q1(n)、q2(n)、q3(n):
其中:q0(n-1)、q1(n-1)、q2(n-1)、q3(n-1)为上一拍的四元数;n为正整数,且n≥1;
(1.3.4)、根据四元数q0(n)、q1(n)、q2(n)、q3(n)计算四元数到姿态角的转换矩阵C,再由四元数到姿态角的转换矩阵C计算姿态角信息,包括俯仰姿态角偏航姿态角ψnav、滚动姿态角γnav,具体公式如下:
当|C31|<0.9999999时
否则:
在上述运载火箭半实物仿真试验惯组模拟方法中,所述步骤(1.4)中根据所述姿态角信号与正弦激励信号采用最小二乘法得到惯组及转台组合体的惯组传递函数
在上述运载火箭半实物仿真试验惯组模拟方法中,步骤(2)中对所述动态姿态、速度和位置信息进行脉冲反算,得到陀螺脉冲增量和加表脉冲增量的具体方法如下:
(3.1)、根据上一拍的动态姿态ψn-1、γn-1生成上一拍的姿态角到四元数的转换矩阵Cn-1,根据当前拍的动态姿态ψn、γn生成当前拍的姿态角到四元数的转换矩阵Cn;
(3.2)、根据上一拍的姿态角到四元数的转换矩阵Cn-1和当前拍的姿态角到四元数的转换矩阵Cn计算角增量Δθx、Δθy、Δθz:
(3.3)、根据角增量Δθx、Δθy、Δθz计算惯组陀螺三轴及斜轴的陀螺脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs:
(3.4)、根据上一拍的位置Px(n-1)、Py(n-1)、Pz(n-1)计算上一拍的引力加速度gx(n-1)、gy(n-1)、gz(n-1),根据当前拍的位置Pxn、Pyn、Pzn计算当前拍的引力加速度gxn、gyn、gzn:
(3.5)、根据上一拍的速度Vx(n-1)、Vy(n-1)、Vz(n-1)和当前拍的速度Vxn、Vyn、Vzn计算视速度增量ΔWx、ΔWy、ΔWz:
(3.6)根据视速度增量ΔWx、ΔWy、ΔWz计算惯组加表三轴及斜轴的加表脉冲增量ΔNax、ΔNay、ΔNaz、ΔNas。
在上述运载火箭半实物仿真试验惯组模拟方法中,所述步骤(2)中对所述动态姿态、速度和位置信息进行脉冲反算,得到陀螺脉冲增量和加表脉冲增量的具体方法如下,其中所述动态姿态、速度和位置信息包括上一拍的动态姿态ψn-1、γn-1,速度Vx(n-1)、Vy(n-1)、Vz(n-1),位置Px(n-1)、Py(n-1)、Pz(n-1),当前拍的动态姿态ψn、γn,速度Vxn、Vyn、Vzn,位置Pxn、Pyn、Pzn:
(2.1)、根据上一拍的动态姿态ψn-1、γn-1生成上一拍的姿态角到四元数的转换矩阵Cn-1:
根据当前拍的动态姿态ψn、γn生成当前拍的姿态角到四元数的转换矩阵Cn:
(2.2)、计算角增量Δθx、Δθy、Δθz:
(2.2.1)根据上一拍的姿态角到四元数的转换矩阵Cn-1得到上一拍的四元数:
根据当前拍的姿态角到四元数的转换矩阵Cn得到当前拍的四元数:
(2.2.2)、根据上一拍和当前拍的四元数计算角增量Δθx、Δθy、Δθz:
Qn-1=[q(n-1)0 -q(n-1)1 -q(n-1)2 -q(n-1)3]
Qn=[qn0 qn1 qn2 qn3]
若Δq≥10-5,则
否则:
(2.3)、根据角增量Δθx、Δθy、Δθz计算惯组陀螺三轴及斜轴的陀螺脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs:
(2.4)、根据上一拍的位置Px(n-1)、Py(n-1)、Pz(n-1)计算上一拍的引力加速度gx(n-1)、gy(n-1)、gz(n-1),根据当前拍的位置Pxn、Pyn、Pzn计算当前拍的引力加速度gxn、gyn、gzn:
(rn-1)2=(Px(n-1))2+(Py(n-1))2+(Pz(n-1))2
(rn)2=(Pxn)2+(Pyn)2+(Pzn)2
其中:GM、Re、J2为地球相关常数;
(2.5)、根据上一拍的速度Vx(n-1)、Vy(n-1)、Vz(n-1)和当前拍的速度Vxn、Vyn、Vzn计算视速度增量ΔWx、ΔWy、ΔWz:
(2.6)根据视速度增量ΔWx、ΔWy、ΔWz计算计算惯组加表三轴及斜轴的加表脉冲增量ΔNax、ΔNay、ΔNaz、ΔNas:
Dax、Day、Daz分别为惯组加表三个轴的零偏,Ea为安装矩阵;Das为惯组加表斜轴的零偏。
在上述运载火箭半实物仿真试验惯组模拟方法中,所述步骤(3)中对所述陀螺脉冲增量和加表脉冲增量在t0时刻注入故障,包括常值故障、常零故障、线性故障和交变故障。
在上述运载火箭半实物仿真试验惯组模拟方法中,所述常值故障、常零故障、线性故障、交变故障注入方式如下:
常值故障:
常零故障:
线性故障:
交变故障:
其中:t为时间,k为线性故障斜率,a为设定常值,t0为故障注入时刻,A'为交变故障幅值,ω'为交变故障圆频率。
本发明与现有技术相比具有如下有益效果:
(1)、本发明提出的运载火箭控制系统半实物仿真试验惯组模拟方法,可代替真实的转台和惯组,接收动力学模型的姿态、速度、位置信号,解算得到惯组陀螺及加表测量信号,模拟出惯组及转台的主要功能,实现正常模式及故障模式下的开环、闭环半实物仿真试验,测出转台+惯组组合体的动态特性,并且本发明方法可对现有转台与惯组的动态特性进行测试和模拟。
(2)、本发明在进行转台与惯组动态特性测试时,惯组模拟器生成正弦激励信号,转化为框角并发送给转台,模拟器采集惯组测量信号并进行导航姿态信息解算得到姿态角信息,将姿态角信息与激励信号对比分析,可得转台+惯组的动态特性。
(3)、本发明在测试试验时,惯组模拟器可模拟转台和惯组的主要功能,由姿态、速度、位置生成加表和陀螺测量信息,在试验过程中可以代替真实设备进行试验,显著降低成本,并降低试验复杂度,简化流程。
(4)、本发明可实现多惯组的实时模拟,并能对生成的测量信息注入特定故障,完成真实转台和惯组无法实现的试验项目,并且在试验中可以修改配置参数,模拟多套惯组,具有较广的应用范围,实用性强。
附图说明
图1为本发明惯组模拟器测量动态特性原理图。
图2为本发明惯组模拟器功能原理图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细的描述:
如图1所示为本发明惯组模拟器测量动态特性原理图,图2为本发明惯组模拟器主要功能原理图,本发明运载火箭半实物仿真试验惯组模拟方法,具体包括如下步骤:
步骤(一)、根据需要模拟或者被测的惯组实际参数进行惯组模拟器参数配置,参数配置包括安装矩阵Eg、Ea,标度因数Kg、Ka,零偏Dg、Da。
步骤(二)、每个时间周期采集外部发送的姿态、速度和位置信息,并将所述姿态、速度和位置信息输入给惯组传递函数,模拟惯组的动态特性,获得动态姿态、速度和位置信息。
其中惯组传递函数通过如下方法得到:
步骤(2.1)、使能惯组模拟器的内部时钟,时间t每毫秒累加,由正弦激励模块产生正弦信号f(t)=A[0]*sin(ω[0]*t),当正弦信号激励次数大于N[0]时,即运行时间t>N[0]*2*π/ω[0]时,正弦激励更新为f(t)=A[1]*sin(ω[1]*t),当正弦信号激励次数大于N[1]时,即运行时间t>(N[0]*2*π/ω[0]+N[1]*2*π/ω[1])时,正弦激励更新为f(t)=A[2]*sin(ω[2]*t),依此更新正弦激励信号为f(t)=A[i]*sin(ω[i]*t),更新时间为
步骤(2.2)、每个时间周期将正弦激励信号通过转换矩阵转化为转台框角。正弦激励信号包括俯仰、偏航和滚动姿态角的三个正弦信号,所述三个正弦信号分别根据如下正弦函数生成:
f(t)=A×sin(w×t)
其中:A为惯组模拟器设置幅值,w为圆频率,t为模拟器本地时钟,周期性累加,惯组模拟器可同时生成三个正弦信号,作为俯仰、偏航、滚动姿态角的模拟。
转换矩阵为姿态角到转台框角的转化矩阵Czb,转台框角包括转台外框α、中框β和内框λ,具体转换公式如下:
其中:ψtrig、γtrig分别为俯仰、偏航和滚动姿态角。
步骤(2.3)、采用所述转台框角控制转台运转,并实时采集惯组陀螺脉冲信号;
步骤(2.4)、将惯组陀螺脉冲信号进行导航计算得到姿态角信号,包括俯仰姿态角偏航姿态角ψ和滚动姿态角γ;具体方法如下:
(2.4.1)、将采集到的相邻两拍脉冲求差,得到周期时间内的陀螺脉冲增量ΔNg,所述ΔNg包括惯组陀螺三轴及斜轴的脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs;
(2.4.2)、根据如下公式得到惯组安装位置的角增量,包括惯组陀螺三轴及斜轴的角增量Δθx、Δθy、Δθz、Δθs:
其中:Kgx、Kgy、Kgz分别为惯组陀螺三个轴的标度因数,Kgs为惯组陀螺斜轴的标度因数,Dgx、Dgy、Dgz分别为惯组陀螺三个轴的零偏,Dgs为惯组陀螺斜轴的零偏,ΔT为解算周期,即相邻两拍脉冲的时间差;Eg为安装矩阵。
(2.4.3)、根据惯组安装位置的角增量计算当前拍四元数q0(n)、q1(n)、q2(n)、q3(n):
其中:q0(n-1)、q1(n-1)、q2(n-1)、q3(n-1)为上一拍的四元数;n为正整数,且n≥1。其中初始值即q00、q01、q02、q03为根据试验需求给出,为已知量。且四元数q0(n)、q1(n)、q2(n)、q3(n)为脉冲计算姿态角的中间变量。
(2.4.4)、根据四元数q0(n)、q1(n)、q2(n)、q3(n)计算四元数到姿态角的转换矩阵C,再由四元数到姿态角的转换矩阵C计算姿态角信息,包括俯仰姿态角偏航姿态角ψnav、滚动姿态角γnav,具体公式如下:
当|C31|<0.9999999时
否则:
步骤(2.4)、根据所述姿态角信号与正弦激励信号采用最小二乘法得到惯组及转台组合体的惯组传递函数。
步骤(三)、对动态姿态、速度和位置信息进行脉冲反算,得到陀螺脉冲增量和加表脉冲增量。其中动态姿态、速度和位置信息包括上一拍的动态姿态ψn-1、γn-1,速度Vx(n-1)、Vy(n-1)、Vz(n-1),位置Px(n-1)、Py(n-1)、Pz(n-1),当前拍的动态姿态ψn、γn,速度Vxn、Vyn、Vzn,位置Pxn、Pyn、Pzn。
具体方法如下:
(3.1)、根据上一拍的动态姿态ψn-1、γn-1生成上一拍的姿态角到四元数的转换矩阵Cn-1:
根据当前拍的动态姿态ψn、γn生成当前拍的姿态角到四元数的转换矩阵Cn:
(3.2)、计算角增量Δθx、Δθy、Δθz:
(3.2.1)首先根据上一拍的姿态角到四元数的转换矩阵Cn-1得到上一拍的四元数:
根据当前拍的姿态角到四元数的转换矩阵Cn得到当前拍的四元数:
上述四元数q(n-1)0~q(n-1)3,qn0~qn3为姿态角计算脉冲的中间变量。
(3.2.2)、根据上一拍和当前拍的四元数计算角增量Δθx、Δθy、Δθz:
Qn-1=[q(n-1)0 -q(n-1)1 -q(n-1)2 -q(n-1)3]
Qn=[qn0 qn1 qn2 qn3]
若Δq≥10-5,则
否则:
其中Δq为中间变量。
(3.3)、根据角增量Δθx、Δθy、Δθz计算惯组陀螺三轴及斜轴的陀螺脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs:
其中ΔT为解算周期,即相邻两拍脉冲的时间差。
为安装矩阵。
(3.4)、根据上一拍的位置Px(n-1)、Py(n-1)、Pz(n-1)计算上一拍的引力加速度gx(n-1)、gy(n-1)、gz(n-1),根据当前拍的位置Pxn、Pyn、Pzn计算当前拍的引力加速度gxn、gyn、gzn:
(rn-1)2=(Px(n-1))2+(Py(n-1))2+(Pz(n-1))2
(rn)2=(Pxn)2+(Pyn)2+(Pzn)2
其中:GM、Re、J2为地球相关常数;
(3.5)、根据上一拍的速度Vx(n-1)、Vy(n-1)、Vz(n-1)和当前拍的速度Vxn、Vyn、Vzn计算视速度增量ΔWx、ΔWy、ΔWz:
其中:Cn为转换矩阵,步骤(3.1)得到。
(3.6)根据视速度增量ΔWx、ΔWy、ΔWz计算计算惯组加表三轴及斜轴的加表脉冲增量ΔNax、ΔNay、ΔNaz、ΔNas:
其中:Dax、Day、Daz分别为惯组加表三个轴的零偏,Das为惯组加表斜轴的零偏。
Ea为安装矩阵;且
步骤(四)、对陀螺脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs和加表脉冲增量ΔNax、ΔNay、ΔNaz、ΔNas进行故障注入。并将故障注入后的陀螺脉冲增量和加表脉冲增量周期性实时向外输出给控制计算机。
即对惯组模拟器陀螺的X、Y、Z、S轴及加表的X、Y、Z、S轴脉冲增量在t0时刻注入故障,包括常值故障、常零故障、线性故障、交变故障。注入方式如下:
常值故障:
常零故障:
线性故障:
交变故障:
其中:t为时间,k为线性故障斜率,a为设定常值,t0为故障注入时刻,A'为交变故障幅值,ω'为交变故障圆频率。
本发明提出的运载火箭控制系统半实物仿真试验惯组模拟方法是在半实物仿真时利用惯组模拟器替换转台和惯组组合体,采集模型解算出的姿态、速度、位置信息,将该信息反算成测量信息再发送给控制计算机,另外,该发明可实现对真实转台和惯组组合体的动态特性测试与模拟。
为了保证运载火箭控制系统半实物仿真试验的可靠与价值,惯组被普遍用于飞行及试验的高精度测量,通常还配置双惯组冗余。同时,闭环试验时还需配置大型高精度转台驱动惯组,这些配置大大增加了试验成本。在未配全这些设备、产品时,采用惯组模拟器可显著节约成本。
惯组、转台的动态特性对实时性要求极高的半实物仿真试验有很大影响。目前动态特性测试完全依赖专业的动态分析仪器,增加了试验成本,利用惯组模拟器即能完成该项测试并能进一步模拟该特性。
不同系列的运载火箭通常配有不同惯组,同一型号的惯组参数也可能有较大差异,采用惯组模拟器可通过配置参数的方式模拟各种不同类型的惯组,可便捷的进行算法分析、参数分析、闭环试验。
本发明在进行半实物仿真调试、测试及正式试验阶段,可用于替代真实惯组及转台进行仿真试验,另外还具备测试真实转台和惯组动态特性的功能。真实惯组一般包含陀螺及加表测量装置,地面试验时需将惯组放置在转台上,随着转台的运动给出测量信号。惯组模拟器主要包含以下功能:测量与模拟转台与惯组组合体的动态特性;通过配置参数模拟不同惯组的主要特性;根据姿态、速度、位置信息模拟惯组的陀螺及加表输出;根据需求模拟惯组的多种故障模式。在不具备转台或者惯组时,可用惯组模拟器进行试验;在系统调试阶段,可用惯组模拟器进行测试、调试与算法验证。
本发明提出的运载火箭控制系统半实物仿真试验惯组模拟方法,该方法的应用可替换转台和惯组,接收动力学模型的姿态、速度、位置信号,解算得到惯组陀螺及加表测量信号,模拟出惯组及转台的主要功能,实现正常模式及故障模式下的开环、闭环半实物仿真试验。另外,应用此方法可对现有转台与惯组的动态特性进行测试和模拟。
以上所述,仅为本发明最佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
Claims (11)
1.一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:包括如下步骤:
步骤(1)、每个时间周期采集外部发送的姿态、速度和位置信息,并将所述姿态、速度和位置信息输入给惯组传递函数,模拟惯组的动态特性,获得动态姿态、速度和位置信息;
步骤(2)、对所述动态姿态、速度和位置信息进行脉冲反算,得到陀螺脉冲增量和加表脉冲增量;
步骤(3)、对所述陀螺脉冲增量和加表脉冲增量进行故障注入,并将故障注入后的陀螺脉冲增量和加表脉冲增量周期性实时向外输出。
2.根据权利要求1所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:还包括进行惯组模拟器参数配置,所述惯组模拟器参数配置为根据需要模拟或者被测惯组的实际参数进行惯组模拟器参数配置,包括安装矩阵Eg、Ea,标度因数Kg、Ka,零偏Dg、Da。
3.根据权利要求1所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:所述步骤(1)中惯组传递函数通过如下方法得到:
步骤(1.1)、每个时间周期将正弦激励信号通过转换矩阵转化为转台框角;
步骤(1.2)、采用所述转台框角控制转台运转,并实时采集惯组陀螺脉冲信号;
步骤(1.3)、将所述惯组陀螺脉冲信号进行导航计算得到姿态角信号,包括俯仰姿态角偏航姿态角ψ和滚动姿态角γ;
步骤(1.4)、根据所述姿态角信号与正弦激励信号得到惯组及转台组合体的惯组传递函数。
4.根据权利要求3所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:所述步骤(1.1)、(1.4)中的正弦激励信号包括俯仰、偏航和滚动姿态角的三个正弦信号,所述三个正弦信号分别根据如下正弦函数生成:
f(t)=A×sin(w×t)
其中A为幅值,w为圆频率,t为模拟器本地时钟。
5.根据权利要求3或4所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:所述转换矩阵为姿态角到转台框角的转化矩阵Czb,所述转台框角包括转台外框α、中框β和内框λ,具体转换公式如下:
其中:ψtrig、γtrig分别为俯仰、偏航和滚动姿态角。
6.根据权利要求3所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:所述步骤(1.3)中将所述惯组陀螺脉冲信号进行导航计算得到姿态角信号的具体方法如下:
(1.3.1)、将采集到的相邻两拍脉冲求差,得到周期时间内的陀螺脉冲增量ΔNg,所述ΔNg包括惯组陀螺三轴及斜轴的脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs;
(1.3.2)、根据如下公式得到惯组安装位置的角增量,包括惯组陀螺三轴及斜轴的角增量Δθx、Δθy、Δθz、Δθs:
其中:Kgx、Kgy、Kgz分别为惯组陀螺三个轴的标度因数,Kgs为惯组陀螺斜轴的标度因数,Dgx、Dgy、Dgz分别为惯组陀螺三个轴的零偏,Dgs为惯组陀螺斜轴的零偏,ΔT为解算周期,即相邻两拍脉冲的时间差;Eg为安装矩阵。
(1.3.3)、根据惯组安装位置的角增量计算当前拍四元数q0(n)、q1(n)、q2(n)、q3(n):
其中:q0(n-1)、q1(n-1)、q2(n-1)、q3(n-1)为上一拍的四元数;n为正整数,且n≥1;
(1.3.4)、根据四元数q0(n)、q1(n)、q2(n)、q3(n)计算四元数到姿态角的转换矩阵C,再由四元数到姿态角的转换矩阵C计算姿态角信息,包括俯仰姿态角偏航姿态角ψnav、滚动姿态角γnav,具体公式如下:
当|C31|<0.9999999时
否则:
7.根据权利要求3所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:所述步骤(1.4)中根据所述姿态角信号与正弦激励信号采用最小二乘法得到惯组及转台组合体的惯组传递函数。
8.根据权利要求1~4或6~7之一所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:所述步骤(2)中对所述动态姿态、速度和位置信息进行脉冲反算,得到陀螺脉冲增量和加表脉冲增量的方法如下:
(3.1)、根据上一拍的动态姿态ψn-1、γn-1生成上一拍的姿态角到四元数的转换矩阵Cn-1,根据当前拍的动态姿态ψn、γn生成当前拍的姿态角到四元数的转换矩阵Cn;
(3.2)、根据上一拍的姿态角到四元数的转换矩阵Cn-1和当前拍的姿态角到四元数的转换矩阵Cn计算角增量Δθx、Δθy、Δθz:
(3.3)、根据角增量Δθx、Δθy、Δθz计算惯组陀螺三轴及斜轴的陀螺脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs:
(3.4)、根据上一拍的位置Px(n-1)、Py(n-1)、Pz(n-1)计算上一拍的引力加速度gx(n-1)、gy(n-1)、gz(n-1),根据当前拍的位置Pxn、Pyn、Pzn计算当前拍的引力加速度gxn、gyn、gzn:
(3.5)、根据上一拍的速度Vx(n-1)、Vy(n-1)、Vz(n-1)和当前拍的速度Vxn、Vyn、Vzn计算视速度增量ΔWx、ΔWy、ΔWz:
(3.6)根据视速度增量ΔWx、ΔWy、ΔWz计算惯组加表三轴及斜轴的加表脉冲增量ΔNax、ΔNay、ΔNaz、ΔNas。
9.根据权利要求8所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:得到陀螺脉冲增量和加表脉冲增量的具体方法如下,其中所述动态姿态、速度和位置信息包括上一拍的动态姿态ψn-1、γn-1,速度Vx(n-1)、Vy(n-1)、Vz(n-1),位置Px(n-1)、Py(n-1)、Pz(n-1),当前拍的动态姿态ψn、γn,速度Vxn、Vyn、Vzn,位置Pxn、Pyn、Pzn:
(2.1)、根据上一拍的动态姿态ψn-1、γn-1生成上一拍的姿态角到四元数的转换矩阵Cn-1:
根据当前拍的动态姿态ψn、γn生成当前拍的姿态角到四元数的转换矩阵Cn:
(2.2)、计算角增量Δθx、Δθy、Δθz:
(2.2.1)根据上一拍的姿态角到四元数的转换矩阵Cn-1得到上一拍的四元数:
根据当前拍的姿态角到四元数的转换矩阵Cn得到当前拍的四元数:
(2.2.2)、根据上一拍和当前拍的四元数计算角增量Δθx、Δθy、Δθz:
Qn-1=[q(n-1)0 -q(n-1)1 -q(n-1)2 -q(n-1)3]
Qn=[qn0 qn1 qn2 qn3]
若Δq≥10-5,则
否则:
(2.3)、根据角增量Δθx、Δθy、Δθz计算惯组陀螺三轴及斜轴的陀螺脉冲增量ΔNgx、ΔNgy、ΔNgz、ΔNgs:
(2.4)、根据上一拍的位置Px(n-1)、Py(n-1)、Pz(n-1)计算上一拍的引力加速度gx(n-1)、gy(n-1)、gz(n-1),根据当前拍的位置Pxn、Pyn、Pzn计算当前拍的引力加速度gxn、gyn、gzn:
(rn-1)2=(Px(n-1))2+(Py(n-1))2+(Pz(n-1))2
(rn)2=(Pxn)2+(Pyn)2+(Pzn)2
其中:GM、Re、J2为地球相关常数;
(2.5)、根据上一拍的速度Vx(n-1)、Vy(n-1)、Vz(n-1)和当前拍的速度Vxn、Vyn、Vzn计算视速度增量ΔWx、ΔWy、ΔWz:
(2.6)根据视速度增量ΔWx、ΔWy、ΔWz计算计算惯组加表三轴及斜轴的加表脉冲增量ΔNax、ΔNay、ΔNaz、ΔNas:
Dax、Day、Daz分别为惯组加表三个轴的零偏,Ea为安装矩阵;Das为惯组加表斜轴的零偏。
10.根据权利要求1~4、6~7或9之一所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:所述步骤(3)中对所述陀螺脉冲增量和加表脉冲增量在t0时刻注入故障,包括常值故障、常零故障、线性故障和交变故障。
11.根据权利要求10所述的一种运载火箭半实物仿真试验惯组模拟方法,其特征在于:所述常值故障、常零故障、线性故障、交变故障注入方式如下:
常值故障:
常零故障:
线性故障:
交变故障:
其中:t为时间,k为线性故障斜率,a为设定常值,t0为故障注入时刻,A'为交变故障幅值,ω'为交变故障圆频率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611100052.1A CN107037739B (zh) | 2016-12-02 | 2016-12-02 | 一种运载火箭半实物仿真试验惯组模拟方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611100052.1A CN107037739B (zh) | 2016-12-02 | 2016-12-02 | 一种运载火箭半实物仿真试验惯组模拟方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107037739A true CN107037739A (zh) | 2017-08-11 |
CN107037739B CN107037739B (zh) | 2020-02-14 |
Family
ID=59530696
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611100052.1A Active CN107037739B (zh) | 2016-12-02 | 2016-12-02 | 一种运载火箭半实物仿真试验惯组模拟方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107037739B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108562288A (zh) * | 2018-05-08 | 2018-09-21 | 北京航天时代激光导航技术有限责任公司 | 一种激光捷联惯组系统级在线自标定系统及方法 |
CN109084755A (zh) * | 2018-06-14 | 2018-12-25 | 东南大学 | 一种基于重力视速度与参数辨识的加速度计零偏估计方法 |
CN110262282A (zh) * | 2019-05-27 | 2019-09-20 | 南京理工大学 | 火箭子级落区控制三轴转台半实物仿真系统及方法 |
CN111176310A (zh) * | 2019-12-31 | 2020-05-19 | 北京星际荣耀空间科技有限公司 | 一种运载火箭姿态控制系统的测试方法、装置及系统 |
CN112810834A (zh) * | 2020-12-23 | 2021-05-18 | 北京航天自动控制研究所 | 一种同时考核惯性导航和模拟飞行的地面试验方法 |
CN113844682A (zh) * | 2021-09-13 | 2021-12-28 | 北京控制工程研究所 | 一种火星edl过程大动态导航试验验证系统及方法 |
CN114063469A (zh) * | 2021-10-29 | 2022-02-18 | 北京星途探索科技有限公司 | 一种基于解算微分方程的带转台半实物仿真验证技术 |
CN114166248A (zh) * | 2021-11-26 | 2022-03-11 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统多功能仿真测试装置与方法 |
CN114326440A (zh) * | 2021-12-31 | 2022-04-12 | 航天科工火箭技术有限公司 | 一种用于运载火箭的仿真试验系统及方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6968281B2 (en) * | 2001-11-06 | 2005-11-22 | Honeywell International, Inc. | Method for calibrating an inertial measurement unit |
CN104006827A (zh) * | 2014-06-09 | 2014-08-27 | 湖北三江航天红阳机电有限公司 | 一种惯组标定用北向基准稳定性评估测试方法 |
CN104596540A (zh) * | 2014-10-13 | 2015-05-06 | 北京航空航天大学 | 一种惯导/里程计组合导航的半实物仿真方法 |
CN104897169A (zh) * | 2015-02-03 | 2015-09-09 | 南京航空航天大学 | 一种微型姿态模块的动态精度测试系统及其方法 |
CN105783941A (zh) * | 2016-02-24 | 2016-07-20 | 北京航天控制仪器研究所 | 一种基于spi总线通信协议输出的惯性测量单元的测试方法 |
-
2016
- 2016-12-02 CN CN201611100052.1A patent/CN107037739B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6968281B2 (en) * | 2001-11-06 | 2005-11-22 | Honeywell International, Inc. | Method for calibrating an inertial measurement unit |
CN104006827A (zh) * | 2014-06-09 | 2014-08-27 | 湖北三江航天红阳机电有限公司 | 一种惯组标定用北向基准稳定性评估测试方法 |
CN104596540A (zh) * | 2014-10-13 | 2015-05-06 | 北京航空航天大学 | 一种惯导/里程计组合导航的半实物仿真方法 |
CN104897169A (zh) * | 2015-02-03 | 2015-09-09 | 南京航空航天大学 | 一种微型姿态模块的动态精度测试系统及其方法 |
CN105783941A (zh) * | 2016-02-24 | 2016-07-20 | 北京航天控制仪器研究所 | 一种基于spi总线通信协议输出的惯性测量单元的测试方法 |
Non-Patent Citations (3)
Title |
---|
滕冲等: "惯组测试系统中自检自校系统的设计与实现", 《计算机应用》 * |
符文星等: "导弹武器系统分布式半实物仿真系统研究", 《系统仿真学报》 * |
董文彬等: "基于某型号飞控半实物仿真试验变加载模拟技术的研究", 《航天控制》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108562288A (zh) * | 2018-05-08 | 2018-09-21 | 北京航天时代激光导航技术有限责任公司 | 一种激光捷联惯组系统级在线自标定系统及方法 |
CN108562288B (zh) * | 2018-05-08 | 2020-07-14 | 北京航天时代激光导航技术有限责任公司 | 一种激光捷联惯组系统级在线自标定系统及方法 |
CN109084755B (zh) * | 2018-06-14 | 2021-06-25 | 东南大学 | 一种基于重力视速度与参数辨识的加速度计零偏估计方法 |
CN109084755A (zh) * | 2018-06-14 | 2018-12-25 | 东南大学 | 一种基于重力视速度与参数辨识的加速度计零偏估计方法 |
CN110262282A (zh) * | 2019-05-27 | 2019-09-20 | 南京理工大学 | 火箭子级落区控制三轴转台半实物仿真系统及方法 |
CN111176310A (zh) * | 2019-12-31 | 2020-05-19 | 北京星际荣耀空间科技有限公司 | 一种运载火箭姿态控制系统的测试方法、装置及系统 |
CN112810834A (zh) * | 2020-12-23 | 2021-05-18 | 北京航天自动控制研究所 | 一种同时考核惯性导航和模拟飞行的地面试验方法 |
CN113844682A (zh) * | 2021-09-13 | 2021-12-28 | 北京控制工程研究所 | 一种火星edl过程大动态导航试验验证系统及方法 |
CN113844682B (zh) * | 2021-09-13 | 2023-06-16 | 北京控制工程研究所 | 一种火星edl过程大动态导航试验验证系统及方法 |
CN114063469A (zh) * | 2021-10-29 | 2022-02-18 | 北京星途探索科技有限公司 | 一种基于解算微分方程的带转台半实物仿真验证技术 |
CN114166248A (zh) * | 2021-11-26 | 2022-03-11 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统多功能仿真测试装置与方法 |
CN114166248B (zh) * | 2021-11-26 | 2023-09-05 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统多功能仿真测试装置与方法 |
CN114326440A (zh) * | 2021-12-31 | 2022-04-12 | 航天科工火箭技术有限公司 | 一种用于运载火箭的仿真试验系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107037739B (zh) | 2020-02-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107037739A (zh) | 一种运载火箭半实物仿真试验惯组模拟方法 | |
CN106444429A (zh) | 具有故障诊断能力无人直升机的飞控仿真系统 | |
CN107065594A (zh) | 一种运载火箭六自由度分布式半物理仿真方法及系统 | |
CN101344788B (zh) | 小卫星姿态控制可靠性验证的仿真测试设备及其测试方法 | |
CN105353789B (zh) | 连续振动信号时间历程复现控制方法 | |
CN101793591B (zh) | 飞行器气动伺服弹性地面模拟试验系统 | |
CN105676671B (zh) | 一种对日定向控制的半物理仿真测试系统 | |
CN106200614B (zh) | 一种采用控制力矩陀螺真实力矩的航天器姿控测试系统及方法 | |
CN110471311A (zh) | 一种微纳卫星姿轨控半物理仿真综合实验平台 | |
CN106844880A (zh) | 一种卫星动量轮扰振试验及数据判读方法 | |
CN105137804B (zh) | 一种针对飞行姿态扰动的实验室模拟方法 | |
CN101497374A (zh) | 用飞轮等效模拟柔性附件振动对卫星产生干扰力矩的方法 | |
CN105604807A (zh) | 风电机组监测方法及装置 | |
CN109917669A (zh) | 基于dSPACE实时仿真机的卫星GNC系统集成验证装置和方法 | |
CN105867350A (zh) | 一种基于pxi架构的卫星地面闭环模拟器 | |
CN105242679A (zh) | 一种四旋翼飞行器的控制系统设计方法 | |
CN107064559A (zh) | 一种基于角摇摆运动的sins加速度计频率特性测试方法 | |
CN103047986B (zh) | 一种大尺度时空及在轨动态效应模拟方法 | |
CN105865432B (zh) | 一种针对陀螺仪多源噪声的混合滤波方法与测试平台 | |
CN103017789A (zh) | 一种摆动式红外地球敏感器的故障模拟方法 | |
CN107054702B (zh) | 一种半物理仿真测试中地磁场模拟方法 | |
CN105158746A (zh) | 一种基于fpga的目标旋转微多普勒信号产生方法 | |
CN105467462A (zh) | 低低跟踪重力测量卫星地面演示验证系统 | |
CN110262447A (zh) | 一种基于ann的acs闭环系统故障定位方法 | |
CN106324572A (zh) | 一种gps模拟器及其实现方法 |
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 |