一种偏置动量卫星单飞轮与磁联合控制方法和系统技术方案

技术编号:20924769 阅读:21 留言:0更新日期:2019-04-20 11:30
本发明专利技术公开了一种偏置动量卫星单飞轮与磁联合控制方法和系统,该方法包括:根据俯仰姿态角,计算得到磁卸载指令磁矩;根据滚动姿态角、偏航姿态角、滚动姿态角速度和偏航姿态角速度,计算得到磁章进动指令磁矩;将所述磁卸载指令磁矩与所述磁章进动指令磁矩进行叠加,得到总的指令磁矩。本发明专利技术充分利用星敏和陀螺的测量信息,实现了俯仰轴飞轮控制,滚动/偏航轴磁控,提高了姿态控制精度和稳定度,且不用考虑不同磁场区的算法切换,简单可靠。

A Single Flywheel and Magnetic Joint Control Method and System for Biased Momentum Satellite

The invention discloses a combined control method and system of single flywheel and magnetic for Biased Momentum satellite. The method includes: calculating magnetic moment of magnetic unloading command according to pitch attitude angle; calculating magnetic moment of precession command according to rolling attitude angle, yaw attitude angle, rolling attitude angular velocity and yaw attitude angular velocity; and calculating magnetic moment of magnetic unloading command and precession finger of magnetic chapter. The magnetic moments are superimposed to obtain the total command magnetic moments. The invention makes full use of the measurement information of star sensor and gyroscope, realizes the flywheel control of pitch axis, magnetic control of rolling/yaw axis, improves the accuracy and stability of attitude control, and does not need to consider the algorithm switching of different magnetic fields, so it is simple and reliable.

【技术实现步骤摘要】
一种偏置动量卫星单飞轮与磁联合控制方法和系统
本专利技术属于卫星控制
,尤其涉及一种偏置动量卫星单飞轮与磁联合控制方法和系统。
技术介绍
飞轮由于其良好的输出性能及不消耗燃料的特点,一般是高精高稳控制的首选执行机构。当失去三轴飞轮控制能力时,可借助于磁控,牺牲一定的控制精度保证系统稳定性。在偏置动量卫星系统中,滚动-偏航轴的强耦合作用使得该系统产生长周期的进动效应与短周期的章动效应。因而可利用喷气或者磁的章进动控制般作为星敏故障缺乏三轴姿态信息时的降级模式使用,仅利用地平仪的滚动轴信息来同时控制滚动轴和偏航轴。但由于地平仪本身测量精度较低,且章进动控制算法中用到了角度微分项,增大了误差,因而控制精度较低。随着单机及元器件的发展,星敏和陀螺的可靠性越来越高,章进动控制更多的使用需求是缺乏三轴轮控能力时的降级模式,而非缺乏三轴姿态信息时的降级模式。
技术实现思路
本专利技术的技术解决问题:克服现有技术的不足,提供一种偏置动量卫星单飞轮与磁联合控制方法和系统,充分利用星敏和陀螺的测量信息,实现了俯仰轴飞轮控制,滚动/偏航轴磁控。为了解决上述技术问题,本专利技术公开了一种偏置动量卫星单飞轮与磁联合控制方法,包括:根据俯仰姿态角,计算得到磁卸载指令磁矩;根据滚动姿态角、偏航姿态角、滚动姿态角速度和偏航姿态角速度,计算得到磁章进动指令磁矩;将所述磁卸载指令磁矩与所述磁章进动指令磁矩进行叠加,得到总的指令磁矩。优选的,根据俯仰姿态角,计算得到磁卸载指令磁矩,包括:根据俯仰姿态角,计算得到俯仰轴的控制用角动量;根据所述俯仰轴的控制用角动量,计算得到磁卸载指令磁矩。优选的,还包括:确定俯仰轴所需的偏置角动量;将计算得到的俯仰轴的控制用角动量与俯仰轴所需的偏置角动量进行叠加,得到总的俯仰轴指令角动量;将所述总的俯仰轴指令角动量发送至俯仰轴飞轮,以实现对俯仰姿态的控制。优选的,还包括:通过俯仰轴飞轮进行俯仰姿态控制,并获取通过星敏测量得到所述俯仰姿态角。优选的,还包括:通过俯仰磁力矩器进行滚动和偏航姿态控制,并获取通过星敏测量得到滚动姿态角和偏航姿态角,以及,获取通过陀螺测量得到的滚动姿态角速度和偏航姿态角速度。优选的,根据滚动姿态角、偏航姿态角、滚动姿态角速度和偏航姿态角速度,计算得到磁章进动指令磁矩,包括:根据滚动姿态角和偏航姿态角,计算得到磁进动指令磁矩;根据滚动姿态角速度和偏航姿态角速度,计算得到磁章动指令磁矩;将磁进动指令磁矩与磁章动指令磁矩进行叠加,得到总的磁章进动指令磁矩。优选的,俯仰轴飞轮卸载的目标为维持俯仰轴偏置角动量不变,仅将俯仰轴控制用角动量卸载到零。本专利技术还公开了一种偏置动量卫星单飞轮与磁联合控制系统,包括:第一解算模块,用于根据俯仰姿态角,计算得到磁卸载指令磁矩;第二解算模块,用于根据滚动姿态角、偏航姿态角、滚动姿态角速度和偏航姿态角速度,计算得到磁章进动指令磁矩;第三解算模块,用于将所述磁卸载指令磁矩与所述磁章进动指令磁矩进行叠加,得到总的指令磁矩。本专利技术与现有技术相比具有以下优点:本专利技术充分利用星敏和陀螺的测量信息,实现了俯仰轴飞轮控制,滚动/偏航轴磁控,提高了姿态控制精度和稳定度,且不用考虑不同磁场区的算法切换,简单可靠。附图说明图1是本专利技术实施例中一种偏置动量卫星单飞轮与磁联合控制方法的步骤流程图;图2是本专利技术实施例中一种坐标系定义图;图3是本专利技术实施例中一种开环幅频特性图。具体实施方式为使本专利技术的目的、技术方案和优点更加清楚,下面将结合附图对本专利技术公开的实施方式作进一步详细描述。如图1,在本实施例中,所述偏置动量卫星单飞轮与磁联合控制方法,包括:步骤101,根据俯仰姿态角,计算得到磁卸载指令磁矩。在本实施例中,可以通过俯仰轴飞轮进行俯仰姿态控制,并获取通过星敏测量得到所述俯仰姿态角。然后,根据俯仰姿态角,计算得到磁卸载指令磁矩。优选的,可以根据俯仰姿态角,基于姿态角的PI+校正控制率,计算得到俯仰轴的控制用角动量;根据所述俯仰轴的控制用角动量,计算得到磁卸载指令磁矩。优选的,该偏置动量卫星单飞轮与磁联合控制方法,还可以包括:确定俯仰轴所需的偏置角动量;将计算得到的俯仰轴的控制用角动量与俯仰轴所需的偏置角动量进行叠加,得到总的俯仰轴指令角动量;将所述总的俯仰轴指令角动量发送至俯仰轴飞轮,以实现对俯仰姿态的控制。步骤102,根据滚动姿态角、偏航姿态角、滚动姿态角速度和偏航姿态角速度,计算得到磁章进动指令磁矩。在本实施例中,可以通过俯仰磁力矩器进行滚动和偏航姿态控制,并获取通过星敏测量得到滚动姿态角和偏航姿态角,以及,获取通过陀螺测量得到的滚动姿态角速度和偏航姿态角速度。优选的,可以根据滚动姿态角和偏航姿态角,计算得到磁进动指令磁矩;根据滚动姿态角速度和偏航姿态角速度,计算得到磁章动指令磁矩;将磁进动指令磁矩与磁章动指令磁矩进行叠加,得到总的磁章进动指令磁矩。步骤103,将所述磁卸载指令磁矩与所述磁章进动指令磁矩进行叠加,得到总的指令磁矩。其中,需要说明的是,在本实施例中,俯仰轴飞轮卸载的目标为维持俯仰轴偏置角动量不变,仅将俯仰轴控制用角动量卸载到零。在上述实施例的基础上,下面结合一个具体实例进行说明。以某型号为例,如图2和图3,三轴转动惯量为[Ix;Iy;Iz]≈[4500;5000;5500]Kg·m2,俯仰轴偏置动量轮最大角动量为68(N·ms),三轴磁力矩器最大输出磁矩为95(Am2)。1.计算俯仰轴指令角动量俯仰轴的偏置动量轮需要提供一定的偏置角动量hy0(N·ms),取偏置角动量hy0=-60N·ms。控制用角动量,控制算法采用基于姿态角的PI+校正控制率,参数设计采用希望频率特性法期望的开环Bode图,如图3所示。偏置动量飞轮的传递特性可近似于一个一阶滤波器,时间常数很大(约为18s),此项会给系统带来一个严重滞后,影响系统稳定性。带宽适当降低,以减少飞轮传递特性带来的影响。选取剪切频率ωc=0.03rad/s,得到控制器参数如下:KTy=3ωc=0.09其中,KPy、KIy、KTy为PI+校正控制率的控制参数。俯仰轴的控制用角动量计算如下:其中,s为拉普拉斯算子,Δθ为姿态角偏差。将hyc限幅在[-8Nms,+8Nms]以内。总的俯仰轴指令角动量:hy=hy0+hyc。2.计算磁章进动指令磁矩利用星敏提供的滚动角和偏航角ψ,计算磁进动指令磁矩:其中,kp=3.4e7为进动控制系数、B(i),(i=x,y,z)为本体系下的三轴磁场强度。利用陀螺提供的滚动角速度ω(x)和偏航角速度ω(z),计算磁章动指令磁矩:Md(y)=-kdB(z)ω(x)+kdB(x)ω(z)其中,kd=3.4e10为磁章动控制系数。磁进动指令磁矩与磁章动指令磁矩进行叠加,得到总的磁章进动指令磁矩:M(y)=Mp(y)+Md(y)3.将磁卸载指令磁矩与磁章进动指令磁矩进行叠加,得到总的指令磁矩利用滚动、偏航轴磁棒对俯仰轴飞轮进行磁卸载,仅对控制用角动量进行卸载,不对偏置角动量卸载,则滚动、偏航轴磁矩设计如下:其中,|B|为三轴磁场强度的模长;kx、kz为分别为滚动、偏航轴磁卸载系数。总的三轴指令磁矩为:M=[M(x)M(y)M(z)]′将M三轴分量均限幅在[-95Am2,+95Am2]以内。其中,需要说明本文档来自技高网...

【技术保护点】
1.一种偏置动量卫星单飞轮与磁联合控制方法,其特征在于,包括:根据俯仰姿态角,计算得到磁卸载指令磁矩;根据滚动姿态角、偏航姿态角、滚动姿态角速度和偏航姿态角速度,计算得到磁章进动指令磁矩;将所述磁卸载指令磁矩与所述磁章进动指令磁矩进行叠加,得到总的指令磁矩。

【技术特征摘要】
1.一种偏置动量卫星单飞轮与磁联合控制方法,其特征在于,包括:根据俯仰姿态角,计算得到磁卸载指令磁矩;根据滚动姿态角、偏航姿态角、滚动姿态角速度和偏航姿态角速度,计算得到磁章进动指令磁矩;将所述磁卸载指令磁矩与所述磁章进动指令磁矩进行叠加,得到总的指令磁矩。2.根据权利要求1所述的偏置动量卫星单飞轮与磁联合控制方法,其特征在于,根据俯仰姿态角,计算得到磁卸载指令磁矩,包括:根据俯仰姿态角,计算得到俯仰轴的控制用角动量;根据所述俯仰轴的控制用角动量,计算得到磁卸载指令磁矩。3.根据权利要求2所述的偏置动量卫星单飞轮与磁联合控制方法,其特征在于,还包括:确定俯仰轴所需的偏置角动量;将计算得到的俯仰轴的控制用角动量与俯仰轴所需的偏置角动量进行叠加,得到总的俯仰轴指令角动量;将所述总的俯仰轴指令角动量发送至俯仰轴飞轮,以实现对俯仰姿态的控制。4.根据权利要求1或3所述的偏置动量卫星单飞轮与磁联合控制方法,其特征在于,还包括:通过俯仰轴飞轮进行俯仰姿态控制,并获取通过星敏测量得到所述俯仰姿态角。5.根据权利要求1所述的偏置动量卫星单飞轮与磁联合控制方法,其特征在于...

【专利技术属性】
技术研发人员:刘川朱文山李圣文郑梦兴杨真
申请(专利权)人:上海航天控制技术研究所
类型:发明
国别省市:上海,31

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1