首页 / 专利库 / 酿酒 / 葡萄酒酿造 / 稳定性 / 一种用于提高卫星三轴稳定性的方法

一种用于提高卫星三轴稳定性的方法

阅读:23发布:2021-01-17

专利汇可以提供一种用于提高卫星三轴稳定性的方法专利检索,专利查询,专利分析的服务。并且本 发明 涉及一种用于提高卫星三轴 稳定性 的方法,包括下列步骤:确定旋转部件的干扰 力 矩的固定 频率 ;根据所述固定频率以及控制系统的控制周期确定数字结构增强器的传递函数;根据卫星的惯量确定数字结构增强器的PID轮控方法;以及提供数字结构增强器以提高卫星三轴稳定性。通过该方法,可以显著降低因星上旋转部件的干扰力矩对卫星三轴稳定性的影响,并且同时至少部分地避免 现有技术 的缺点、例如对不规则旋转的部件无法配平、或者影响系统动态性能等。,下面是一种用于提高卫星三轴稳定性的方法专利的具体信息内容。

1.一种用于提高卫星三轴稳定性的方法,包括下列步骤:
确定旋转部件的干扰矩的固定频率
根据所述固定频率以及控制系统的控制周期确定数字结构增强器的传递函数;
根据卫星的惯量确定数字结构增强器的PID轮控方法;以及
提供数字结构增强器以提高卫星三轴稳定性。
2.根据权利要求1所述的方法,其中确定旋转部件的干扰力矩的固定频率包括:
根据旋转部件的转速确定干扰力矩的固定频率;或者
根据卫星的速度波动频率确定干扰力矩的固定频率。
3.根据权利要求1所述的方法,其中根据所述固定频率以及控制系统的控制周期确定数字结构增强器的传递函数包括:
根据下列公式对数字结构增强器的传递函数在x、y和z轴的分量进行建模:
其中b1x,b2x,b3x,a1x,a2x;b1y,b2y,b3y,a1y,a2y;b1z,b2z,b3z,a1z,a2z是数字结构增强器的待确定参数。
4.根据权利要求3所述的方法,其中通过下列方式确定所述待确定参数:
如果干扰力矩在x、y、z轴有分量,则
或者
如果干扰力矩在x轴没有分量,则:
b1x=b2x=b3x=a1x=a2x=0;或者
如果干扰力矩在y轴没有分量,则:
b1y=b2y=b3y=a1y=a2y=0;或者
如果干扰力矩在z轴没有分量,则:
b1z=b2z=b3z=a1z=a2z=0,
其中T为控制系统的控制周期,δz,δp是数字结构增强器的零极点阻尼比,本发明中的零极点配置为δz>δp,δp<<1。
5.根据权利要求1所述的方法,其中根据卫星的惯量确定数字结构增强器的PID轮控方法包括:
·根据卫星的惯量确定PID参数:
kp=[kpx,kpy,kpz],ki=[kix,kiy,kiz],kd=[kdx,kdy,kdz],
其中kpx=kpy=kpz,kix=kiy=kiz,kdx=kdy=kdz;
·确定PID轮控算法的控制力矩:
Tc=kp·ΔEuler+ki·ΔElrJF+kd·Δω+ωbi×(Iωbi+FWhxyz)
ΔEuler=Eulerc_FW-Eulerbr_FW
Δω=ωc_FW-ωbr_FW
ΔElrJF=ΔEuler·T
其中Tc为轮控期望控制力矩,维数为3,单位为Nm;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;FWhxyz为反作用轮合成三轴角动量,维数为3,单位为Nms;ωbi×(Iωbi+FWhxyz)为卫星三轴动力学耦合项;Eulerc_FW为轮控目标姿态角,维数为3,单位为rad;
Eulerbr_FW为轮控参考坐标系三轴姿态角,维数为3,单位为rad;ωc_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;
ωbr_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;T为控制系统的控制周期。
6.根据权利要求3所述的方法,其中根据卫星的惯量确定数字结构增强器的PID轮控方法还包括:
将数字增强器引入PID轮控算法;以及
形成完整的主动闭环控制回路。

说明书全文

一种用于提高卫星三轴稳定性的方法

技术领域

[0001] 本发明总体上涉及航天器姿态控制技术领域,具体而言涉及一种用于提高卫星三轴稳定性的方法。

背景技术

[0002] 随着现代卫星应用领域的不断拓展,星上载荷对转动机构的需求越来越大,因此星上的旋转部件越来越多,旋转部件的惯量越来越大,转速也越来越快。
[0003] 星上旋转部件的质心偏差和质量分布不均,会导致旋转面内产生动静不平衡干扰矩(静不平衡干扰力矩Ts和动不平衡干扰力矩Td)。动静不平衡干扰力矩均为固定频率的正弦干扰力矩。由于旋转部件的旋转面与卫星的X,Y,Z轴没有必然关系,因此动静不平衡干扰力矩在卫星三轴上均可能产生分量。静不平衡干扰力矩Ts和动不平衡干扰力矩Td在各轴上分量的频率一致,所以卫星三轴上干扰力矩Tnx,Tny,Tnz的表达式为可以合并为:
[0004] Tnx=Tsdx sin(ωt+λx)
[0005] Tny=Tsdy sin(ωt+λy)
[0006] Tnz=Tsdz sin(ωt+λz),
[0007] 其中Tsdx为Ts和Td合力矩在X轴方向上分量的幅值;λx为Ts和Td合力矩在X轴方向上分量的相位;Tsdy为Ts和Td合力矩在Y轴方向上分量的幅值;λy为Ts和Td合力矩在Y轴方向上分量的相位;Tsdz为Ts和Td合力矩在Z轴方向上分量的幅值;λz为Ts和Td合力矩在Z轴方向上分量的相位。
[0008] 动静不平衡干扰力矩引入的固定频率干扰力矩,会影响卫星的三轴稳定性,降低卫星的控制精度。为了消除这种影响,传统的做法是:
[0009] (1)从源头上通过结构设计和动平衡配平尽可能降低动静不平衡的干扰,但不能完全消除,而对于不规则的旋转部件,更是无法进行有效配平。
[0010] (2)姿控系统采用开环前馈的方式进一步抑制干扰,但是开环控制对于干扰的幅度和相位的建模准确度要求很高,同时受时延的影响很大;此外前馈控制会在系统闭环传递函数中增加一个新的零点,这个新增的零点可能会严重影响闭环系统的动态性能。因此应用开环前馈的方式具有高险。
[0011] 为打破传统方法的局限性,降低固定频率干扰力矩对卫星三轴稳定性的影响,提高卫星控制性能,需要一种新的解决方案。

发明内容

[0012] 本发明的任务是提供一种用于提高卫星三轴稳定性的方法,通过该方法,可以显著降低因星上旋转部件的干扰力矩对卫星三轴稳定性的影响,并且同时至少部分地避免现有技术的缺点、例如对不规则旋转的部件无法配平、或者影响系统动态性能等。
[0013] 根据本发明,该任务通过一种用于提高卫星三轴稳定性的方法来解决,该方法包括下列步骤:
[0014] 确定旋转部件的干扰力矩的固定频率;
[0015] 根据所述固定频率以及控制系统的控制周期确定数字结构增强器的传递函数;
[0016] 根据卫星的惯量确定数字结构增强器的PID轮控方法;以及
[0017] 提供数字结构增强器以提高卫星三轴稳定性。
[0018] 在本发明的一个优选方案中规定,确定旋转部件的干扰力矩的固定频率包括:
[0019] 根据旋转部件的转速确定干扰力矩的固定频率;或者
[0020] 根据卫星的速度波动频率确定干扰力矩的固定频率。
[0021] 在本发明的另一优选方案中规定,根据所述固定频率以及控制系统的控制周期确定数字结构增强器的传递函数包括:
[0022] 根据下列公式对数字结构增强器的传递函数在x、y和z轴的分量进行建模:
[0023]
[0024]
[0025]
[0026] 其中b1x,b2x,b3x,a1x,a2x;b1y,b2y,b3y,a1y,a2y;b1z,b2z,b3z,a1z,a2z是数字结构增强器的待确定参数。
[0027] 在本发明的又一优选方案中规定,通过下列方式确定所述待确定参数:
[0028] 如果干扰力矩在x、y、z轴有分量,则
[0029] 或者
[0030] 如果干扰力矩在x轴没有分量,则:
[0031] b1x=b2x=b3x=a1x=a2x=0;或者
[0032] 如果干扰力矩在y轴没有分量,则:
[0033] b1y=b2y=b3y=a1y=a2y=0;或者
[0034] 如果干扰力矩在z轴没有分量,则:
[0035] b1z=b2z=b3z=a1z=a2z=0,
[0036] 其中T为控制系统的控制周期,δz,δp是数字结构增强器的零极点阻尼比,本发明中的零极点配置为δz>δp,δp<<1。
[0037] 在本发明的另一优选方案中规定,根据卫星的惯量确定数字结构增强器的PID轮控方法包括:
[0038] ·根据卫星的惯量确定PID参数:
[0039] kp=[kpx,kpy,kpz],ki=[kix,kiy,kiz],kd=[kdx,kdy,kdz],
[0040] 其中kpx=kpy=kpz,kix=kiy=kiz,kdx=kdy=kdz;
[0041] ·确定PID轮控算法的控制力矩:
[0042] Tc=kp·ΔEuler+ki·ΔElrJF+kd·Δω+ωbi×(Iωbi+FWhxyz)
[0043] ΔEuler=Eulerc_FW-Eulerbr_FW
[0044] Δω=ωc_FW-ωbr_FW
[0045] ΔElrJF=ΔEuler·T
[0046] 其中Tc为轮控期望控制力矩,维数为3,单位为Nm;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;FWhxyz为反作用轮合成三轴角动量,维数为3,单位为Nms;ωbi×(Iωbi+FWhxyz)为卫星三轴动力学耦合项;Eulerc_FW为轮控目标姿态角,维数为3,单位为rad;Eulerbr_FW为轮控参考坐标系三轴姿态角,维数为3,单位为rad;ωc_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;
ωbr_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;T为控制系统的控制周期。
[0047] 在本发明的又一优选方案中规定,根据卫星的惯量确定数字结构增强器的PID轮控方法还包括:
[0048] 将数字增强器引入PID轮控算法;以及
[0049] 形成完整的主动闭环控制回路。
[0050] 本发明至少具有下列有益效果:(1)通过提供一种专针对当前干扰力矩配置的数字结构增强器,并形成完整的主动闭环PID轮控方法,可有效在整个系统的幅频特性曲线上,大幅降低固定频率的干扰力矩到卫星角速度的响应幅度,从而优化卫星的姿态控制性能;(2)本发明提出的针对固定频率干扰的控制方法,不需要确定干扰力矩的幅值与相位,而是只需在闭环PID反作用轮控制回路中串联一个数字结构增强器即可实现,方法简单有效,实现成本低,便于工程实现。附图说明
[0051] 下面结合附图参考具体实施例来进一步阐述本发明。
[0052] 图1示出了根据本发明的数字结构增强器的传递示意图;
[0053] 图2示出了根据本发明的带数字结构增强器的主动闭环PID轮控回路示意图;
[0054] 图3示出了根据本发明的数字结构增强器的频率特性曲线图;
[0055] 图4(a)示出了PID轮控方法对于扰动输入的系统响应频率特性曲线图;
[0056] 图4(b)示出了根据本发明的带数字结构增强器的固定频率干扰主动闭环抑制PID轮控方法对于扰动输入的系统响应频率特性曲线图;
[0057] 图5示出了本发明在某型号卫星上应用的效果图。

具体实施方式

[0058] 应当指出,各附图中的各组件可能为了图解说明而被夸大地示出,而不一定是比例正确的。在各附图中,给相同或功能相同的组件配备了相同的附图标记。
[0059] 在本发明中,除非特别指出,“布置在…上”、“布置在…上方”以及“布置在…之上”并未排除二者之间存在中间物的情况。
[0060] 在本发明中,各实施例仅仅旨在说明本发明的方案,而不应被理解为限制性的。
[0061] 在本发明中,除非特别指出,量词“一个”、“一”并未排除多个元素的场景。
[0062] 在此还应当指出,在本发明的实施例中,为清楚、简单起见,可能示出了仅仅一部分部件或组件,但是本领域的普通技术人员能够理解,在本发明的教导下,可根据具体场景需要添加所需的部件或组件。
[0063] 在此还应当指出,在本发明的范围内,“相同”、“相等”、“等于”等措辞并不意味着二者数值绝对相等,而是允许一定的合理误差,也就是说,所述措辞也涵盖了“基本上相同”、“基本上相等”、“基本上等于”。
[0064] 另外,本发明的各方法的步骤的编号并未限定所述方法步骤的执行顺序。除非特别指出,各方法步骤可以以不同顺序执行。
[0065] 本发明所要解决的技术问题是:提供一种带数字结构增强器的闭环PID轮控方法,降低由于星上旋转部件旋转引入的固定频率的干扰力矩对卫星三轴稳定性的影响,提高卫星的控制精度。
[0066] 为解决所述问题,本发明提供了一种带数字结构增强器的固定频率干扰主动闭环抑制PID轮控方法,包括:
[0067] 步骤一、确定干扰力矩的固定频率;
[0068] 步骤二、根据干扰力矩的频率特性,以及控制系统的控制周期,设计针对该固定频率的数字结构增强器;
[0069] 步骤三、根据卫星的惯量等特性,设计带步骤二中数字结构增强器的PID算法,形成闭环控制回路。
[0070] 进一步,所述步骤一根据星上旋转部件的转速直接确定干扰力矩的固定频率,或者根据卫星的角速度波动情况确定干扰力矩的固定频率。
[0071] 若已知旋转部件的转速n(rpm),则其引入的干扰力矩的频率ω(rad/s)表达式为:
[0072]
[0073] 若旋转部件的转速未知或者不确定时,根据卫星的角速度波动情况间接确定干扰力矩的固定频率:通过在轨测量获取卫星的角速度波动频率f(Hz),旋转部件引入的干扰力矩的频率ω(rad/s)表达式为:
[0074] ω=2πf。
[0075] 进一步,所述步骤二中设计的一种数字结构增强器的传递示意图如图1所示,其表达式为:
[0076]
[0077]
[0078]
[0079] 上式中,G(z)为数字结构增强器进行z变化得到的传递函数表达式;b1x,b2x,b3x,a1x,a2x;b1y,b2y,b3y,a1y,a2y;b1z,b2z,b3z,a1z,a2z为待确定的数字结构增强器的参数。
[0080] 进一步,确定上述数字结构增强器的参数:
[0081] 如果固定频率干扰力矩在X,Y,Z轴有分量,则有:
[0082]
[0083]
[0084]
[0085]
[0086]
[0087] 如果固定频率干扰力矩在X轴没有分量,则有:
[0088] b1x=b2x=b3x=a1x=a2x=0;
[0089] 如果固定频率干扰力矩在Y轴没有分量,则有:
[0090] b1y=b2y=b3y=a1y=a2y=0;
[0091] 如果固定频率干扰力矩在Z轴没有分量,则有:
[0092] b1z=b2z=b3z=a1z=a2z=0。
[0093] 其中,T为控制系统的控制周期;δz,δp为数字结构增强器的零极点阻尼比,本发明中的零极点配置为δz>δp,δp<<1。
[0094] 进一步,本发明还给出了带数字结构增强器的主动闭环抑制PID轮控算法,包括:
[0095] 步骤3.1、根据卫星的惯量等特性,确定PID参数
[0096] kp=[kpx,kpy,kpz],ki=[kix,kiy,kiz],kd=[kdx,kdy,kdz],
[0097] 其中kpx=kpy=kpz,kix=kiy=kiz,kdx=kdy=kdz,则常规PID轮控算法为:
[0098] Tc=kp·ΔEuler+ki·ΔElrJF+kd·Δω+ωbi×(Iωbi+FWhxyz)
[0099] ΔEuler=Eulerc_FW-Eulerbr_FW
[0100] Δω=ωc_FW-ωbr_FW
[0101] ΔElrJF=ΔEuler·T。
[0102] 上式中,Tc为轮控期望控制力矩,维数为3,单位为Nm;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;FWhxyz为反作用轮合成三轴角动量,维数为3,单位为Nms;ωbi×(Iωbi+FWhxyz)为卫星三轴动力学耦合项。Eulerc_FW为轮控目标姿态角,维数为3,单位为rad;Eulerbr_FW为轮控参考坐标系三轴姿态角,维数为3,单位为rad;ωc_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;ωbr_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;T为控制系统的控制周期。
[0103] 由此可以得到常规PID轮控方法的控制力矩。
[0104] 所述步骤三还包括:
[0105] 步骤3.2、根据图2所示的带数字结构增强器的主动闭环轮控回路示意图,将数字增强器引入PID轮控算法,对常规PID算法计算得到的控制力矩进行处理,形成完整的主动闭环控制回路。
[0106] 根据图1所示的数字增强器传递示意图,三轴分别引入2个中间状态量:[X1_x X2_x]、[X1_y X2_y]、[X1_z X2_z],有X1_x_pre为上一周期X轴状态量X1_x的值,初值为0;X2_x_pre为上一周期X轴状态量X2_x的值,初值为0;X1_y_pre为上一周期Y轴状态量X1_y的值,初值为0;X2_y_pre为上一周期Y轴状态量X2_y的值,初值为0;X1_z_pre为上一周期Z轴状态量X1_z的值,初值为0;X2_z_pre为上一周期Z轴状态量X2_z的值,初值为0。则有状态量离散系统迭代算法为:
[0107] X1_x=-a1xX1_x_pre+X2_x_pre+(b2x-a1x·b1x)·Tcx
[0108] X2_x=-a2xX1_x_pre+(b3x-a2x·b1x)·Tcx
[0109] X1_y=-a1yX1_y_pre+X2_y_pre+(b2y-a1y·b1y)·Tcy
[0110] X2_y=-a2yX1_y_pre+(b3y-a2y·b1y)·Tcy
[0111] X1_z=-a1zX1_z_pre+X2_z_pre+(b2z-a1z·b1z)·Tcz
[0112] X2_z=-a2zX1_z_pre+(b3z-a2z·b1z)·Tcz;
[0113] 数字增强器处理后的反作用轮控制力矩为:
[0114] Tcx_zeng=X1_x+b1x·Tcx
[0115] Tcy_zeng=X1_y+b1y·Tcy
[0116] Tcz_zeng=X1_z+b1z·Tcz。
[0117] 本发明提出的技术方案通过了地面仿真验证并成功应用于型号卫星中,仿真验证结果及在轨数据显示,通过本发明成果,降低了固定频率的干扰力矩到卫星角速度的响应幅度,从而优化了卫星的控制性能。
[0118] 下面结合附图和实施例对本发明的精神和实质作进一步说明。
[0119] 实施例一
[0120] 本发明实施例提供的一种带数字结构增强器的固定频率干扰主动闭环抑制PID轮控方法包括:
[0121] 步骤一、星上的旋转部件转速未知,通过在轨测量获取卫星的角速度波动频率f(Hz),则旋转部件引入的干扰力矩的固定频率ωrad/s为:
[0122] ω=2πf。
[0123] 步骤二、设计针对该频率的数字结构增强器,其传递示意图如图1所示,相应表达式为:
[0124]
[0125]
[0126]
[0127] 固定频率干扰力矩在卫星X,Y,Z轴均有分量,故而数字结构增强器的参数的表达式分别为:
[0128]
[0129]
[0130]
[0131]
[0132]
[0133] 上式中,T为控制系统的控制周期;δz,δp为数字结构增强器的零极点阻尼比,选择零极点配置为δz>δp,δp<<1。
[0134] 步骤三、设计带步骤二中数字结构增强器的PID轮控算法,形成闭环控制回路。
[0135] 步骤3.1、根据卫星的惯量等特性,确定PID参数kp=[kpx,kpy,kpz],ki=[kix,kiy,kiz],kd=[kdx,kdy,kdz],其中kpx=kpy=kpz,kix=kiy=kiz,kdx=kdy=kdz,则常规PID轮控算法为:
[0136] Tc=kp·ΔEuler+ki·ΔElrJF+kd·Δω+ωbi×(Iωbi+FWhxyz)
[0137] ΔEuler=Eulerc_FW-Eulerbr_FW
[0138] Δω=ωc_FW-ωbr_FW
[0139] ΔElrJF=ΔEuler·T。
[0140] 上式中,Tc为轮控期望控制力矩,维数为3,单位为Nm;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;FWhxyz为反作用轮合成三轴角动量,维数为3,单位为Nms;ωbi×(Iωbi+FWhxyz)为卫星三轴动力学耦合项。Eulerc_FW为轮控目标姿态角,维数为3,单位为rad;Eulerbr_FW为轮控参考坐标系三轴姿态角,维数为3,单位为rad;ωc_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;ωbr_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;T为控制系统的控制周期。
[0141] 由此可以得到常规PID轮控方法的控制力矩。
[0142] 步骤3.2、将数字增强器引入PID轮控算法,对常规PID算法计算得到的控制力矩进行处理,形成完整的主动闭环控制回路。
[0143] 根据图1所示的数字增强器传递示意图,三轴分别引入2个状态量:[X1_x X2_x],[X1_y X2_y],[X1_z X2_z],有X1_x_pre为上一周期X轴状态量X1_x的值,初值为0;X2_x_pre为上一周期X轴状态量X2_x的值,初值为0;X1_y_pre为上一周期Y轴状态量X1_y的值,初值为0;X2_y_pre为上一周期Y轴状态量X2_y的值,初值为0;X1_z_pre为上一周期Z轴状态量X1_z的值,初值为0;X2_z_pre为上一周期Z轴状态量X2_z的值,初值为0。则有状态量离散系统迭代算法为:
[0144] X1_x=-a1xX1_x_pre+X2_x_pre+(b2x-a1x·b1x)·Tcx
[0145] X2_x=-a2xX1_x_pre+(b3x-a2x·b1x)·Tcx
[0146] X1_y=-a1yX1_y_pre+X2_y_pre+(b2y-a1y·b1y)·Tcy
[0147] X2_y=-a2yX1_y_pre+(b3y-a2y·b1y)·Tcy
[0148] X1_z=-a1zX1_z_pre+X2_z_pre+(b2z-a1z·b1z)·Tcz
[0149] X2_z=-a2zX1_z_pre+(b3z-a2z·b1z)·Tcz;
[0150] 数字增强器处理后的反作用轮控制力矩为:
[0151] Tcx_zeng=X1_x+b1x·Tcx
[0152] Tcy_zeng=X1_y+b1y·Tcy
[0153] Tcz_zeng=X1_z+b1z·Tcz。
[0154] 实施例二
[0155] 本实例针对具体型号卫星,描述本发明实施例的具体实施方式。
[0156] 卫星的结构形式包含旋转部件,旋转部件的旋转面与卫星Z轴垂直。卫星在轨工作时,旋转部件工作转速为10rpm。
[0157] 由于旋转部件的旋转面与卫星Z轴垂直,动静不平衡干扰力矩在卫星Z轴上没有产生分量,而卫星X轴、Y轴上均存在固定频率的动静不平衡干扰力矩。
[0158] 根据本发明技术,通过如下步骤,降低旋转部件引入的固定频率的干扰对于卫星姿态角速度的影响。
[0159] 步骤一、根据星上旋转部件的转速10rpm,确定引入的干扰力矩的固定频率ωrad/s:
[0160]
[0161] 步骤二、设计针对该频率的数字结构增强器。数字结构增强器的传递示意图如图1所示,其表达式为:
[0162]
[0163]
[0164]
[0165] 由于固定频率干扰力矩在Z轴没有分量,因此数字结构增强器的参数的表达式分别为:
[0166]
[0167]
[0168]
[0169]
[0170]
[0171] b1z=b2z=b3z=a1z=a2z=0;
[0172] 控制系统的控制周期T=0.25s;选择数字结构增强器的零极点配置为δp=0.01,δz=1.5。由此确定数字结构增强器的参数为:
[0173] b1x=b1y=1.382;
[0174] b2x=b2y=-1.928;
[0175] b3x=b3y=0.6124;
[0176] a1x=a1y=-1.928;
[0177] a2x=a2y=0.9949;
[0178] b1z=b2z=b3x=a1z=a2z=0;
[0179] 则确定数字结构增强器的表达式为:
[0180]
[0181] 图3为该数字结构增强器的频率特性曲线图。由图3可知,在固定频率ω=1.047rad/s处,数字结构增强器的输出幅值由原先的0dB上升至43.6dB,因此该数字结构增强器对固定频率为ω=1.047rad/s的输入有放大作用。
[0182] 步骤三、设计带有步骤二中的数字结构增强器的PID算法。
[0183] 步骤3.1、根据卫星的惯量等特性,确定PID参数,得到常规PID轮控算法:
[0184] kp=[kpx,kpy,kpz]=[1,1,1],ki=[kix,kiy,kiz]=[0.001,0.001,0.001],kd=[kdx,kdy,kdz]=[120,120,120],则常规PID轮控算法为:
[0185] Tc=kp·ΔEuler+ki·ΔElrJF+kd·Δω+ωbi×(Iωbi+FWhxyz)
[0186] ΔEuler=Eulerc_FW-Eulerbr_FW
[0187] Δω=ωc_FW-ωbr_FW
[0188] ΔElrJF=0.25·ΔEuler。
[0189] 上式中,Tc为轮控期望控制力矩,维数为3,单位为Nm;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;FWhxyz为反作用轮合成三轴角动量,维数为3,单位为Nms;ωbi×(Iωbi+FWhxyz)为卫星三轴动力学耦合项。Eulerc_FW为轮控目标姿态角,维数为3,单位为rad;Eulerbr_FW为轮控参考坐标系三轴姿态角,维数为3,单位为rad;ωc_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;ωbi为卫星惯性系姿态角速度,维数为3,单位为rad/s;ωbr_FW为轮控参考坐标系三轴角速度,维数为3,单位为rad/s;控制系统的控制周期T=0.25s。
[0190] 由此可以得到常规PID轮控方法的控制力矩。
[0191] 步骤3.2、根据图2所示的带数字结构增强器的主动闭环轮控回路示意图,将数字增强器引入PID轮控算法,对常规PID算法计算得到的控制力矩进行处理,形成完整的主动闭环控制回路。
[0192] 根据图1所示的数字增强器传递示意图,三轴分别引入2个中间状态量:[X1_x X2_x],[X1_y X2_y],[X1_z X2_z],有X1_x_pre为上一周期X轴状态量X1_x的值,初值为0;X2_x_pre为上一周期X轴状态量X2_x的值,初值为0;X1_y_pre为上一周期Y轴状态量X1_y的值,初值为0;X2_y_pre为上一周期Y轴状态量X2_y的值,初值为0;X1_z_pre为上一周期Z轴状态量X1_z的值,初值为0;X2_z_pre为上一周期Z轴状态量X2_z的值,初值为0。则有状态量离散系统迭代算法为:
[0193] X1_x=1.928·X1_x_pre+X2_x_pre+0.739·Tcx
[0194] X2_x=-0.9949·X1_x_pre-0.763·Tcx
[0195] X1_y=1.928·X1_y_pre+X2_y_pre+0.739·Tcy
[0196] X2_y=-0.9949X1_y_pre-0.763·Tcy;
[0197] 数字增强器处理后的反作用轮控制力矩为:
[0198] Tcx_zeng=X1_x+1.382·Tcx
[0199] Tcy_zeng=X1_y+1.382·Tcy
[0200] Tcz_zeng=Tcz。
[0201] 图4(a)为常规PID轮控方法对于扰动输入的系统响应频率特性曲线图;图4(b)为带数字结构增强器的固定频率干扰主动闭环抑制PID轮控方法对于扰动输入的系统响应频率特性曲线图。由图4(a)与图4(b)的对比可知,在固定频率ω=1.047rad/s处,常规PID轮控方法中干扰力矩到卫星角速度的响应幅度为-43.3dB,带数字结构增强器的主动闭环抑制PID轮控方法中的响应幅度为-84.3dB,由此可知带数字结构增强器的主动闭环抑制PID轮控方法可以大幅降低固定频率为ω=1.047rad/s的干扰力矩到卫星角速度的响应幅度,从而优化卫星的姿态控制性能。
[0202] 图5为本发明在型号卫星上的在轨应用效果图。在9:40:10—9:43:30期间应用带数字结构增强器的固定频率干扰主动闭环抑制PID轮控方法,其余时间采用常规PID轮控方法。在对地定向的工作模式下,卫星的目标惯性系姿态角速度为[0 -0.06 0]°/s。应用常规PID轮控方法时,卫星惯性系姿态角速度X的波动幅值为0.022°/s;卫星惯性系姿态角速度Y的波动幅值为0.015°/s。应用本发明的带数字结构增强器的固定频率干扰主动闭环抑制PID轮控方法时,卫星惯性系姿态角速度X的波动幅值为0.0027°/s,卫星惯性系姿态角速度Y的波动幅值为0.005°/s。由此可知,本发明方法成功应用于某型号卫星,可以显著改善卫星惯性系姿态角速度X与惯性系姿态角速度Y由于受到固定频率动静不平衡干扰而产生的波动,优化卫星的姿态控制性能。
[0203] 本发明至少具有下列有益效果:(1)通过提供一种专门针对当前干扰力矩配置的数字结构增强器,并形成完整的主动闭环PID轮控方法,可有效在整个系统的幅频特性曲线上,大幅降低固定频率的干扰力矩到卫星角速度的响应幅度,从而优化卫星的姿态控制性能;(2)本发明提出的针对固定频率干扰的控制方法,不需要确定干扰力矩的幅值与相位,而是只需在闭环PID反作用轮控制回路中串联一个数字结构增强器即可实现,方法简单有效,实现成本低,便于工程实现。
[0204] 虽然本发明的一些实施方式已经在本申请文件中予以了描述,但是本领域技术人员能够理解,这些实施方式仅仅是作为示例示出的。本领域技术人员在本发明的教导下可以想到众多的变型方案、替代方案和改进方案而不超出本发明的范围。所附权利要求书旨在限定本发明的范围,并藉此涵盖这些权利要求本身及其等同变换的范围内的方法和结构。
相关专利内容
标题 发布/更新时间 阅读量
高稳定性变压器 2020-05-12 164
高稳定性气化器 2020-05-12 213
稳定性控制装置 2020-05-12 170
稳定性组合物Ⅰ 2020-05-12 616
高稳定性截止阀 2020-05-11 365
稳定性电磁炉 2020-05-11 191
转发器稳定性 2020-05-12 677
高稳定性测绘仪 2020-05-12 800
一种稳定性PP 2020-05-13 976
高稳定性频率源 2020-05-11 895
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈