利用磁强计信息实现喷气速率阻尼的方法 |
|||||||
申请号 | CN201710418922.8 | 申请日 | 2017-06-06 | 公开(公告)号 | CN107215482A | 公开(公告)日 | 2017-09-29 |
申请人 | 上海航天控制技术研究所; | 发明人 | 程卫强; 李英波; 张子龙; 聂章海; 谭晓宇; 刘晓娜; 彭瑞; 刘斌; 鲁启东; 马瑞; 吴伟清; | ||||
摘要 | 本 发明 涉及一种利用 磁强计 信息实现喷气速率阻尼的方法,包含:S1、采用磁强计测量得到地 磁场 强度B,计算 地磁场 强度B的矢量在体 坐标系 中对时间的微分构造地磁场强度B的斜对称矩阵并求解该斜对称矩阵的伪逆矩阵S2、根据公式计算得到卫星本体坐标系相对惯性系的 角 速率矢量,即卫星角速率ω;S3、根据解算得到的卫星角速率ω,控制推 力 器的喷气宽度,对卫星进行喷气速率阻尼,将卫星角速率ω降低并控制在敏感器可工作的速率范围内。本发明采用磁强计测得的地磁场强度信息,来解算卫星角速率,并以此实现卫星的喷气速率阻尼;无需依赖陀螺组合信息,工作简单可靠,价格低廉。 | ||||||
权利要求 | 1.一种利用磁强计信息实现喷气速率阻尼的方法,其特征在于,包含以下步骤: |
||||||
说明书全文 | 利用磁强计信息实现喷气速率阻尼的方法技术领域背景技术[0002] 当卫星失稳进入全姿态捕获模式后,首先要对其进行速率阻尼,用于将卫星的角速率控制到敏感器可工作的速率范围内,以便进入捕获太阳和对日定向等后续工作模式。传统的速率阻尼方法是采用陀螺组合测得卫星角速率来控制推力器喷气输出,从而将卫星角速率阻尼在一定范围内。然而,陀螺组合的寿命一直是制约卫星寿命的主要部件之一,且陀螺组合的成本昂贵。因此,寻求一种不依赖陀螺组合的速率阻尼方法是当前非常必要的。 发明内容[0003] 本发明的目的是提供一种利用磁强计信息实现喷气速率阻尼的方法,采用磁强计测得的地磁场强度信息,来解算卫星角速率,并以此实现卫星的喷气速率阻尼;无需依赖陀螺组合信息,工作简单可靠,价格低廉。 [0004] 为实现上述目的,本发明提供一种利用磁强计信息实现喷气速率阻尼的方法,包含以下步骤: [0005] S1、采用磁强计测量得到地磁场强度B,计算地磁场强度B的矢量在体坐标系中对时间的微分 构造地磁场强度B的斜对称矩阵 并求解该斜对称矩阵 的伪逆矩阵[0006] S2、根据公式 计算得到卫星本体坐标系相对惯性系的角速率矢量,即卫星角速率ω; [0007] S3、根据解算得到的卫星角速率ω,控制推力器的喷气宽度,对卫星进行喷气速率阻尼,将卫星角速率ω降低并控制在敏感器可工作的速率范围内。 [0008] 所述的S1中,具体包含以下步骤: [0009] S11、利用磁强计测量得到地磁场强度B: [0010] [0011] S12、计算地磁场强度B的矢量在体坐标系中对时间的微分 [0012] [0013] S13、构造地磁场强度B的斜对称矩阵 [0014] [0015] 并求解斜对称矩阵 的伪逆矩阵 [0016] 所述的S2中,具体包含以下步骤: [0017] S21、地磁场的变化表示为: [0018] [0019] 令 [0020] 得 [0021] 其中, 为地磁场强度B的矢量在惯性系中对时间的微分,记为 为地磁场强度B的矢量在体坐标系中对时间的微分,记为 [0022] S22、地磁场强度B的矢量在卫星轨道平面内的周期性变化,相对于卫星角速率ω可忽略不计,即 [0023] S23、根据S21和S22可得: [0024] [0025] 以矩阵表示可解得: [0026] [0027] 所述的S3中,具体包含以下步骤: [0028] S31、设定三轴喷气规律: [0029] 设置三档卫星角速率阈值ωx1、ωx2、ωx3,且ωx1<ωx2<ωx3;并限定: [0030] 当ω>ωx3时,设置推力器的喷气宽度为-T3; [0031] 当ωx2<ω<ωx3时,设置推力器的喷气宽度为-T2; [0032] 当ωx1<ω<ωx2时,设置推力器的喷气宽度为-T1; [0033] S32、在对卫星进行喷气速率阻尼时,根据解算得到的卫星角速率ω,按照三轴喷气规律设定推力器的喷气宽度,使卫星角速率ω逐渐减小;在减小过程中,当卫星角速率ω经过阈值ωx1、ωx2、ωx3时,按照三轴喷气规律对应调整推力器的喷气宽度。 [0034] 所述的S31中,喷气宽度满足T1≤T2≤T3≤T,其中,T为控制周期,T1需大于推力器的最小稳定喷气宽度。 [0035] 所述的S31中,三档卫星角速率阈值中的最小值ωx1由T1喷气量产生的卫星角速度决定。 [0036] 综上所述,本发明所提供的利用磁强计信息实现喷气速率阻尼的方法,采用磁强计测得的地磁场强度信息,来解算卫星角速率,并将其作为控制输入来实现卫星的喷气速率阻尼。因此,本发明无需依赖陀螺组合信息,工作简单可靠,价格低廉。或者,本发明也能够作为陀螺组合故障情况下的备份方案,以进一步保障卫星运行的可靠性。附图说明 [0037] 图1为本发明中的利用磁强计信息实现喷气速率阻尼的方法示意图。 具体实施方式[0038] 以下结合图1,详细说明本发明的一个优选实施例。 [0039] 如图1所示,为本发明所提供的利用磁强计信息实现喷气速率阻尼的方法,包含以下步骤: [0040] S1、采用磁强计测量得到地磁场强度B,计算地磁场强度B的矢量在体坐标系中对时间的微分 构造地磁场强度B的斜对称矩阵 并求解该斜对称矩阵 的伪逆矩阵[0041] S2、根据公式 计算得到卫星本体坐标系相对惯性系的角速率矢量,即卫星角速率ω; [0042] S3、根据解算得到的卫星角速率ω,控制推力器的喷气宽度,对卫星进行喷气速率阻尼,将卫星角速率ω降低并控制在敏感器可工作的速率范围内。 [0043] 所述的S1中,具体包含以下步骤: [0044] S11、利用磁强计测量得到地磁场强度B: [0045] [0046] S12、计算地磁场强度B的矢量在体坐标系中对时间的微分 [0047] [0048] S13、构造地磁场强度B的斜对称矩阵 [0049] [0050] 并求解斜对称矩阵 的伪逆矩阵 [0051] 所述的S2中,具体包含以下步骤: [0052] S21、地磁场的变化表示为: [0053] [0054] 令 [0055] 得 [0056] 其中, 为地磁场强度B的矢量在惯性系中对时间的微分,记为 为地磁场强度B的矢量在体坐标系中对时间的微分,记为 [0057] S22、地磁场强度B的矢量在卫星轨道平面内以2ω0的角频率作周期性变化,其中ω0为卫星轨道角速度,但相对于卫星角速率ω而言非常小,小到可忽略不计,即可认为[0058] S23、根据S21和S22可得: [0059] [0060] 以矩阵表示可解得: [0061] [0062] 如图1所示,所述的S3中,根据解算得到的卫星角速率ω、卫星质量特性和推力器特性,设计三轴喷气规律以实现喷气速率阻尼;具体包含以下步骤: [0063] S31、设置三档卫星角速率阈值ωx1、ωx2、ωx3,且ωx1<ωx2<ωx3;并进一步限定: [0064] 当ω>ωx3时,设置推力器的喷气宽度为-T3; [0065] 当ωx2<ω<ωx3时,设置推力器的喷气宽度为-T2; [0066] 当ωx1<ω<ωx2时,设置推力器的喷气宽度为-T1; [0067] 其中,喷气宽度即为喷气的持续时间,表明喷气量的强度;当卫星角速率为正时,喷气宽度取负,表示其需要减小卫星角速率ω的值,相反当卫星角速率为负时,喷气宽度需要取正; [0068] S32、在对卫星进行喷气速率阻尼时,根据解算得到的卫星角速率ω,按照上述的三轴喷气规律设定推力器的喷气宽度,使卫星角速率ω逐渐减小,在卫星角速率ω减小的过程中,一旦经过阈值ωx1、ωx2、ωx3时,需要及时按照三轴喷气规律调整推力器的喷气宽度。也就是说,当卫星角速率ω由大(ωx3)经过中(ωx2)再变小(ωx1)的过程中,推力器的喷气宽度也由大(-T3)经过中(-T2)再变小(-T1)。 [0069] 所述的S31中,设定的喷气宽度需要满足T1≤T2≤T3≤T,T为控制周期,T1受推力器的性能制约,需要稍大于推力器的最小稳定喷气宽度。 [0070] 所述的S31中,三档卫星角速率阈值中的最小值ωx1由T1喷气量产生的卫星角速度决定。 [0071] 本发明中,虽然利用磁强计信息解算得到的卫星角速率存在有一定的误差,但这并不妨碍将其用于卫星的喷气速率阻尼。一般只要将卫星角速率阻尼至0.2°/s以下,就可满足包括星敏感器在内的绝大多数敏感器的工作要求。 [0072] 综上所述,本发明所提供的利用磁强计信息实现喷气速率阻尼的方法,采用磁强计测得的地磁场强度信息,来解算卫星角速率,并将其作为控制输入来实现卫星的喷气速率阻尼。因此,本发明无需依赖陀螺组合信息,工作简单可靠,价格低廉。进一步,本发明也能够作为陀螺组合故障情况下的备份方案,以进一步保障卫星运行的可靠性。 |