CN106915477A - 一种姿态控制方法 - Google Patents

一种姿态控制方法 Download PDF

Info

Publication number
CN106915477A
CN106915477A CN201710128823.6A CN201710128823A CN106915477A CN 106915477 A CN106915477 A CN 106915477A CN 201710128823 A CN201710128823 A CN 201710128823A CN 106915477 A CN106915477 A CN 106915477A
Authority
CN
China
Prior art keywords
attitude
satellite
omega
formula
represent
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
Application number
CN201710128823.6A
Other languages
English (en)
Other versions
CN106915477B (zh
Inventor
吴敬玉
范季夏
王文妍
王新
钟超
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Aerospace Control Technology Institute
Original Assignee
Shanghai Aerospace Control Technology Institute
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Aerospace Control Technology Institute filed Critical Shanghai Aerospace Control Technology Institute
Priority to CN201710128823.6A priority Critical patent/CN106915477B/zh
Publication of CN106915477A publication Critical patent/CN106915477A/zh
Application granted granted Critical
Publication of CN106915477B publication Critical patent/CN106915477B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/244Spacecraft control systems
    • B64G1/245Attitude control algorithms for spacecraft attitude control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G1/00Cosmonautic vehicles
    • B64G1/22Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
    • B64G1/24Guiding or controlling apparatus, e.g. for attitude control
    • B64G1/36Guiding or controlling apparatus, e.g. for attitude control using sensors, e.g. sun-sensors, horizon sensors
    • B64G1/361Guiding or controlling apparatus, e.g. for attitude control using sensors, e.g. sun-sensors, horizon sensors using star sensors

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种姿态控制方法,包含以下过程:采用秒脉冲信号对影响卫星姿态精度的星上时间进行对准;实时对卫星姿态测量用的星敏感器误差进行修正;利用动力学耦合关系对斜飞卫星的重力梯度干扰力矩进行补偿;在姿态控制过程中利用输入成型控制方法对卫星挠性进行抑制;采用位置速度双回路和位置修正回路增加角速度前馈指令的姿态控制律实现高精度高稳定度姿态导引控制;采用饱和滑模变结构控制算法实现大惯量卫星的快速姿态机动。本发明具有计算方法简单,控制灵活,能够应用于大惯量大挠性斜飞卫星的姿态控制且大大提升了卫星的性能,降低了卫星硬件的研制成本的优点。

Description

一种姿态控制方法
技术领域
本发明涉及卫星姿态控制领域,特别涉及一种大惯量大挠性斜飞卫星快速姿态机动和高精度高稳定度姿态控制方法。
背景技术
为了满足高分辨率卫星的成像需求,需要实现卫星的高精度高稳定度姿态控制;为了提高卫星的使用效率,需要实现卫星的快速姿态机动。以合成孔径雷达成像卫星为例,由于其具有太阳电池阵大、天线大和卫星斜飞的特点,使得卫星惯量大、挠性大、重力梯度干扰力矩大。这给卫星的快速姿态机动和高精度高稳定度姿态控制带来了很大的困难,常规的解决办法是选用测量精度高的姿态敏感器、选用输出力矩大的执行机构。这对姿态敏感器和执行机构的设计提出了很高的要求,也大大增加了卫星硬件的研制成本。
发明内容
本发明目的是提供一种姿态控制方法,采用秒脉冲信号对影响卫星姿态精度的星上时间进行对准、实时对卫星姿态测量用的星敏感器误差进行修正、利用动力学耦合关系对斜飞卫星的重力梯度干扰力矩进行补偿、在姿态控制过程中利用输入成型控制方法对卫星挠性进行抑制、采用位置速度双回路和位置修正回路增加角速度前馈指令的姿态控制律实现高精度高稳定度姿态导引控制、采用饱和滑模变结构控制算法实现大惯量卫星的快速姿态机动,最终实现大惯量大挠性斜飞卫星快速姿态机动和高精度高稳定度姿态控制的目的。
为了实现上述目的,本发明通过以下技术方案实现:
一种姿态控制方法,包含以下过程:
采用秒脉冲信号对影响卫星姿态精度的星上时间进行有效性判断和误差修正;实时对卫星姿态测量用的星敏感器误差进行修正;利用动力学耦合关系对斜飞卫星的重力梯度干扰力矩进行补偿;在姿态控制过程中利用输入成型控制方法对卫星挠性进行抑制;采用位置速度双回路和位置修正回路增加角速度前馈指令的姿态控制律实现对卫星姿态导引控制;采用饱和滑模变结构控制算法实现大惯量卫星的快速姿态机动。
优选地,所述对影响卫星姿态精度的星上时间的误差修正进一步包含:星敏感器曝光时刻、陀螺角速度积分时间、飞轮转速指令发送时刻、推力器喷气指令发送时刻和轨道参数的准确的时间分别为控制计算机根据高精度秒脉冲信号计算的时间偏差与各自对应的未校准时的时间之和。
优选地,所述对星敏感器的误差修正:
θ=θ1-Δθ1-Δθ2-Δθ3-Δθ4
式中,θ为卫星目标姿态,θ1为星敏感器输出姿态,Δθ1为预估卫星在轨的安装偏差,Δθ2为其它星敏感器的常值偏差,Δθ3为各个星敏感器热变形偏差,Δθ4为各个星敏感器指向与该指向的偏差。
优选地,所述对斜飞卫星的重力梯度干扰力矩进行补偿进一步包含:
根据斜飞卫星在滚动方向的重力梯度干扰力矩,计算偏航轴方向角动量
hz=-Tdx/w0
式中,hz为卫星偏航方向角动量(单位Nms),Tdx为滚动方向重力梯度干扰力矩(单位Nm),w0为卫星轨道角速度(单位rad/s)。
优选地,所述成型控制方法为含有挠性附件的卫星姿态运动状态方程
式中,
0为对应维数的零矩阵,E为对应维数的单位矩阵,
Ic=I-Brot·BrotT,H=(E-BrotTI-1Brot)-1
Brot为挠性附件的耦合系数矩阵,ωc是以各阶挠性振动频率为元素的对角阵,ξc为以各阶挠性振动的阻尼比组成的对角阵,ηi为第i个挠性附件振动模态,为第i个挠性附件振动模态振动速度,I为挠性卫星转动惯量,Ic为卫星中心刚体转动惯量,q0为姿态四元数标量,E3为3阶单位矩阵,qv为姿态四元数矢量部分,为卫星惯性角速度,x为卫星姿态运动状态变量,q#表示运动学算子符号。
简化的姿态运动特征方程为
计算所述简化的姿态运动特征方程得到姿态运动特征值
得到姿态运动特征值
输入成型器的最小脉冲个数K和T:
式中,ξ为阻尼比,ωn为等效的振动频率,i为虚数符号。
在控制器中加入角加速度输入成型项,补偿模型简化误差的振动影响,得到控制器uc
式中,Shaper表示输入成型器,Kp表示比例控制系数,qvd表示目标四元数矢量部分,Kd表示微分控制系数,ωd表示目标姿态角速度,e0表示初始姿态到目标姿态对应的欧拉轴,qv0表示初始姿态四元数矢量部分,表示初始姿态角速度,ad表示目标姿态角加速度。
优选地,所述对卫星姿态导引控制进一步包含:位置回路控制器输出的三轴角速度指令ωkx、ωky、ωkz
式中:ωkx(k)表示滚动方向修正角速度、ωky(k)表示俯仰方向修正角速度、ωkz(k)表示偏航方向修正角速度,Kkx、Kkxint是滚动方向比例-积分控制参数;Kky、Kkyint是俯仰方向比例-积分控制参数;Kkz、Kkzint是偏航方向比例-积分控制参数;是星敏感器测量得到的滚动角;是星敏感器测量得到的俯仰角;是星敏感器测量得到的偏航角;ω0是轨道角速度,Ts表示控制周期;
陀螺角度增量积分为
式中:ΔGx(j)表示滚动方向第j个控制周期内陀螺组合输出的角度增量;ΔGy(j)表示俯仰方向第j个控制周期内陀螺组合输出的角度增量;ΔGz(j)表示偏航方向第j个控制周期内陀螺组合输出的角度增量;Gx(k)表示滚动方向前k个控制周期内角度增量的积分;Gy(k)表示滚动方向前k个控制周期内角度增量的积分;Gz(k)表示滚动方向前k个控制周期内角度增量的积分;
速度回路输入指令为
式中,表示滚动方向速度回路输入指令;θcom_y表示俯仰方向速度回路输入指令;ψcom_z表示偏航方向速度回路输入指令;
卫星三轴方向的控制力矩Tc为:
式中,KPx、KIx是滚动方向比例-积分控制参数;KPy、KIy是俯仰方向比例-积分控制参数;KPz、KIz是偏航方向比例-积分控制参数。
优选地,所述饱和滑模变结构控制算法进一步包含:
卫星相对目标姿态的姿态角误差:
式中,qao是星测量得到星体相对轨道系的姿态四元数,qd是期望的目标四元数;
将qe转换成姿态矩阵R(qe),
式中,是qe的矢量部分,的斜对称矩阵;
按照123转序,由R(qe)计算姿态角误差:
θe=asin(R31)
ψe=atan2(-R21,R11)
式中,Rij是矩阵R(qe)的第i行第j列的元素,a是力矩调节系数;
卫星相对目标姿态的姿态角速度误差:
ωe=ωorbit-R(qed
式中,R(qao)是qao对应的姿态矩阵,ω0是实时轨道角速度,ωd是期望的目标姿态角速度;
滑模面系数:
边界层厚度:
式中,a是力矩调节系数,取为0.1-0.5;ωf-min为卫星的太阳帆板的基频,0.1ωf-min为系统的带宽,ζx=0.7,ζy=0.7,ζz=0.7为系统的阻尼,Tcxmax,Tcymax,Tczmax为卫星在三个方向的最大控制力矩;Ixx、Iyy、Izz是卫星三轴方向转动惯量;
滑模面计算如下:
Sy=Kyθeey
Sz=Kzψeez
式中,ωxmax是姿态机动的最大角速度,可根据执行机动在滚动方向的最大角动量Hcxmax计算得到:
式中,ΔIxx是惯量的拉偏阈值,取值范围为0.1-0.3;
控制力矩计算如下:
当|ωei|<1×10-3×π/180,Tcimax=a·Tcimax,否则Tcimax=Tcimax
当|Si|>εi时,Tci=sign(Si)*Tcimax
当|Si|<εi时,
式中,i=x,y,z。
本发明与现有技术相比具有以下优点:
本发明采用秒脉冲信号对影响卫星姿态精度的星上时间进行对准、实时对卫星姿态测量用的星敏感器误差进行修正、利用动力学耦合关系对斜飞卫星的重力梯度干扰力矩进行补偿、在姿态控制过程中利用输入成型控制方法对卫星挠性进行抑制、采用位置速度双回路和位置修正回路增加角速度前馈指令的姿态控制律实现高精度高稳定度姿态导引控制、采用饱和滑模变结构控制算法实现大惯量卫星的快速姿态机动,实现大惯量大挠性斜飞卫星快速姿态机动和高精度高稳定度姿态控制。本发明计算方法简单,控制灵活,能够应用于大惯量大挠性斜飞卫星的姿态控制。大大提升了卫星的性能,降低了卫星硬件的研制成本。
附图说明
图1为本发明一种姿态控制方法的流程图;
图2为本发明一种姿态控制方法的卫星时间同步框图;
图3为本发明一种姿态控制方法的星敏感器误差修正方框图。
具体实施方式
以下结合附图,通过详细说明一个较佳的具体实施例,对本发明做进一步阐述。
如图1所示,本发明一种姿态控制方法,包含以下过程:
步骤1、采用秒脉冲信号对影响卫星姿态精度的星上时间进行对准;即如图2所示,通过控制计算机接收校时中心周期性产生的高精度秒脉冲信号,对本地基准时间进行有效性判断和误差修正,然后通过控制计算机分别对星敏感器曝光时刻、各个陀螺角速度积分时间、飞轮转速指令发送时刻、推力器喷气指令发送时刻和推力器轨道参数计算时刻进行校正,确保姿态控制所用的时间同步,减小由于时间不同步带来的姿态确定误差和姿态控制误差。以星敏感器曝光时刻修正为例,控制计算机根据高精度秒脉冲信号计算的时间偏差为Δt,星敏感器曝光时刻为t1,则校正后的星敏感器曝光时刻校正如式1所示,从而得到准确的曝光时间。其余对各个陀螺角速度积分时间、飞轮转速指令发送时刻、推力器喷气指令发送时刻和推力器轨道参数计算时刻的校正方法与所述敏感器曝光时刻的修正校正方法类同。
t2=t1+Δt (1)
步骤2、实时对卫星姿态测量用的星敏感器误差进行修正;利用星敏感器确定的姿态精度除了受制于星敏感器自身的测量精度和轨道测量精度(包含时间精度),还受制于星敏感器相对卫星安装基准的安装精度、星敏感器及其安装部位由于温度变化引起的测量误差等。为了精确得到卫星的姿态,实现对大惯量大挠性斜飞卫星快速姿态机动和高精度高稳定度姿态控制,需对上述因素进行标定和补偿:即如图3所示,对星敏感器的误差修正包含以下过程:
1)卫星发射前,通过地面对卫星空载、满载两种状态下的星敏感器相对卫星安装基准的偏差进行测量,预估卫星在轨的安装偏差Δθ1并进行修正。
2)卫星入轨后,以卫星上的任意一个星敏感器(如星敏感器1)为基准,修正其它星敏感器(如星敏感器2)的常值偏差Δθ2
3)在两个星敏感器数据融合工作的情况下,实时修正两个星敏感器的偏差。
4)根据温度变化情况,实时修正各个星敏感器热变形偏差Δθ3
5)根据卫星载荷指向的数据,修正各个星敏感器指向与该指向的偏差Δθ4。则
θ=θ1-Δθ1-Δθ2-Δθ3-Δθ4 (2)
其中θ为卫星目标姿态,θ1为星敏感器输出姿态。
步骤3、利用动力学耦合关系对斜飞卫星的重力梯度干扰力矩进行补偿;为了满足诸如合成孔径雷达卫星成像的需求,卫星长期工作在斜飞状态(即卫星滚动方向偏置一大角度),这种状态存在很大的重力梯度干扰力矩。
根据斜飞卫星在滚动方向的重力梯度干扰力矩,通过式3计算偏航轴方向所需要的角动量,通过飞轮转动提供该角动量,从而产生滚动方向的陀螺力矩,所述滚动方向的陀螺力矩克服滚动方向重力梯度干扰力矩的影响,实现对斜飞卫星的姿态控制。
hz=-Tdx/w0 (3)
式中,hz为卫星偏航方向角动量(单位Nms),Tdx为滚动方向重力梯度干扰力矩(单位Nm),w0为卫星轨道角速度(单位rad/s)。
步骤4、在姿态控制过程中利用输入成型控制方法对卫星挠性进行抑制;对于带有挠性附件的卫星,快速机动过程中如何减小挠性附件振动对控制系统产生的影响尤为重要。
对于绕欧拉轴单轴机动的航天器,通过简化系统特征矩阵实现非线性系统方程的求解问题;通过角加速度补偿来消除系统特征矩阵简化所带来的残余振动,从而有效的抑制机动过程中激发的振动,达到姿态快速机动和快速稳定。
含有挠性附件的卫星姿态运动状态方程见式4。
式中,At与Bt的表达见式5、式6。
式中,0为对应维数的零矩阵,E为对应维数的单位矩阵,Ic=I-Brot·BrotT,H=(E-BrotTI-1Brot)-1其中,Brot为挠性附件的耦合系数矩阵,ωc是以各阶挠性振动频率为元素的对角阵,ξc为以各阶挠性振动的阻尼比组成的对角阵,ηi为第i个挠性附件振动模态,为第i个挠性附件振动模态振动速度,I为挠性卫星转动惯量,Ic为卫星中心刚体转动惯量,q0为姿态四元数标量,E3为3阶单位矩阵,qv为姿态四元数矢量部分,为卫星惯性角速度,x为卫星姿态运动状态变量,q#表示运动学算子符号。
简化的姿态运动特征方程见式7
求解式8,得到姿态运动特征值λ。
得到输入成型器的最小脉冲个数为两个,它们的作用时间与幅值如下表。
作用时间 0 T
幅值 1/(1+K) K/(1+K)
上表中,K和T的表达式如下:
其中,ξ和ωn为求解式8后得到的共轭特征值对应的阻尼比和等效的振动频率,K和T分别脉冲的幅值和作用时刻。
在控制器中加入角加速度输入成型项,补偿模型简化误差的振动影响,得到控制器uc(用控制力矩来表示)如下:
式中,Shaper表示在第3步所设计的输入成型器,Kp表示比例控制系数,qvd表示目标四元数矢量部分,Kd表示微分控制系数,ωd表示目标姿态角速度,e0表示初始姿态到目标姿态对应的欧拉轴,qv0表示初始姿态四元数矢量部分,表示初始姿态角速度,ad表示目标姿态角加速度。。
步骤5、采用位置速度双回路和位置修正回路增加角速度前馈指令的姿态控制律实现高精度高稳定度姿态导引控制;即通过速度回路对积分陀螺组合的角度增量进行积分,对角度增量积分和位置回路控制器的输出指令之和进行控制,实现星体在惯性空间快速稳定。
具体为在惯性空间控制到星体的惯性角速度和角度为零。在位置修正回路中加入姿态导引的角速度指令,相当于系统的角速度前馈,提高系统响应能力,实现快速姿态导引控制。在滚动方向进行与偏航方向的解耦控制,消除偏航方向导引后对滚动方向的耦合影响,实现任意位置快速姿态导引接入控制,提高系统控制精度。
位置回路控制器输出的三轴角速度指令ωkx、ωky、ωkz见式11。
式中,Kkx、Kkxint是滚动方向比例-积分控制参数;Kky、Kkyint是俯仰方向比例-积分控制参数;Kkz、Kkzint是偏航方向比例-积分控制参数;是星敏感器测量得到的滚动角;是星敏感器测量得到的俯仰角;是星敏感器测量得到的偏航角;ω0是轨道角速度,Ts表示控制周期。
陀螺角度增量积分计算见式12。
其中:ΔGx(j)表示滚动方向第j个控制周期内陀螺组合输出的角度增量;ΔGy(j)表示俯仰方向第j个控制周期内陀螺组合输出的角度增量;ΔGz(j)表示偏航方向第j个控制周期内陀螺组合输出的角度增量;Gx(k)表示滚动方向前k个控制周期内角度增量的积分;Gy(k)表示滚动方向前k个控制周期内角度增量的积分;Gz(k)表示滚动方向前k个控制周期内角度增量的积分;
速度回路输入指令计算见式13
式中:表示滚动方向速度回路输入指令;θcom_y表示俯仰方向速度回路输入指令;ψcom_z表示偏航方向速度回路输入指令。
卫星三轴方向的控制力矩Tc由式14计算得到。
其中:KPx、KIx是滚动方向比例-积分控制参数;KPy、KIy是俯仰方向比例-积分控制参数;KPz、KIz是偏航方向比例-积分控制参数。
步骤6、采用饱和滑模变结构控制算法实现大惯量卫星的快速姿态机动。对于大惯量大挠性卫星,在执行机构输出能力确定后,姿态机动的加速段、匀速段和减速段也基本确定,但不同的算法对姿态机动基本到位后的姿态稳定时间影响较大。本发明通过利用基于饱和函数的滑模变结构控制算法,使卫星状态在滑模面上运动时实现加速、匀速、减速和快速姿态稳定。该算法具有简单可靠,运算量小,能够实现卫星姿态的快速稳定,使姿态机动时间缩短的优点。具体算法如下:
卫星相对目标姿态的姿态角误差:
式中,qao是星测量得到星体相对轨道系的姿态四元数,qd是期望的目标四元数。
将qe转换成姿态矩阵R(qe),
其中,是qe的矢量部分,的斜对称矩阵。
按照123转序,由R(qe)计算姿态角误差:
其中,Rij是矩阵R(qe)的第i行第j列的元素,a是力矩调节系数。
卫星相对目标姿态的姿态角速度误差:
ωe=ωorbit-R(qed (19)
其中,R(qao)是qao对应的姿态矩阵,ω0是实时轨道角速度,ωd是期望的目标姿态角速度。
设卫星的太阳帆板的基频为ωf-min,选取系统的带宽为0.1ωf-min,选择系统的阻尼ζx=0.7,ζy=0.7,ζz=0.7,根据执行机构的能力可以确定其在三个方向的最大控制力矩Tcxmax,Tcymax,Tczmax
则滑模面系数:
边界层厚度:
其中,a是力矩调节系数,取为0.1-0.5。取Ixx、Iyy、Izz是卫星三轴方向转动惯量。
滑模面计算如下:
Sy=Kyθeey (23)
Sz=Kzψeez (24)
式中,ωxmax是姿态机动的最大角速度,可根据执行机动在滚动方向的最大角动量Hcxmax计算得到:
其中ΔIxx是惯量的拉偏阈值,一般可取0.1-0.3。
控制力矩计算如下:
当|ωei|<1×10-3×π/180,Tcimax=a·Tcimax,否则Tcimax=Tcimax
当|Si|>εi时,Tci=sign(Si)*Tcimax
当|Si|<εi时,
其中,i=x,y,z。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。

Claims (8)

1.一种姿态控制方法,其特征在于,包含以下过程:
采用秒脉冲信号对影响卫星姿态精度的星上时间进行有效性判断和误差修正;
实时对卫星姿态测量用的星敏感器误差进行修正;
利用动力学耦合关系对斜飞卫星的重力梯度干扰力矩进行补偿;
在姿态控制过程中利用输入成型控制方法对卫星挠性进行抑制;
采用位置速度双回路和位置修正回路增加角速度前馈指令的姿态控制律实现对卫星姿态导引控制;
采用饱和滑模变结构控制算法实现大惯量卫星的快速姿态机动。
2.如权利要求1所述一种姿态控制方法,其特征在于,所述对影响卫星姿态精度的星上时间的误差修正进一步包含:星敏感器曝光时刻、陀螺角速度积分时间、飞轮转速指令发送时刻、推力器喷气指令发送时刻和轨道参数的准确的时间分别为控制计算机根据高精度秒脉冲信号计算的时间偏差与各自对应的未校准时的时间之和。
3.如权利要求1所述一种姿态控制方法,其特征在于,
所述对星敏感器的误差修正:
θ=θ1-Δθ1-Δθ2-Δθ3-Δθ4
式中,θ为卫星目标姿态,θ1为星敏感器输出姿态,Δθ1为预估卫星在轨的安装偏差,Δθ2为其它星敏感器的常值偏差,Δθ3为各个星敏感器热变形偏差,Δθ4为各个星敏感器指向与该指向的偏差。
4.如权利要求1所述一种姿态控制方法,其特征在于,所述对斜飞卫星的重力梯度干扰力矩进行补偿进一步包含:
根据斜飞卫星在滚动方向的重力梯度干扰力矩,计算偏航轴方向角动量
hz=-Tdx/w0
式中,hz为卫星偏航方向角动量(单位Nms),Tdx为滚动方向重力梯度干扰力矩(单位Nm),w0为卫星轨道角速度(单位rad/s)。
5.如权利要求1所述一种姿态控制方法,其特征在于,所述成型控制方法为含有挠性附件的卫星姿态运动状态方程
x · = A t x + B t u c
式中, 0为对应维数的零矩阵,E为对应维数的单位矩阵,Ic=I-Brot·BrotT,H=(E-BrotTI-1Brot)-1
Brot为挠性附件的耦合系数矩阵,ωc是以各阶挠性振动频率为元素的对角阵,ξc为以各阶挠性振动的阻尼比组成的对角阵,ηi为第i个挠性附件振动模态,为第i个挠性附件振动模态振动速度,I为挠性卫星转动惯量,Ic为卫星中心刚体转动惯量,q0为姿态四元数标量,E3为3阶单位矩阵,qv为姿态四元数矢量部分,为卫星惯性角速度,x为卫星姿态运动状态变量,q#表示运动学算子符号;
简化姿态运动特征方程:
P t * = θ E - H · ω c * - H 2 ξ c ω c
λ - E H · ω c 2 λ + H 2 ξ c ω c = 0
姿态运动特征值:
λ = ξω n ± ω n 1 - ξ 2 i
输入成型器的最小脉冲个数K和T:
K = e - π ξ 1 - ξ 2
T = π ω n 1 - ξ 2
式中,ξ为阻尼比,ωn为等效的振动频率,i为虚数符号。
在控制器中加入角加速度输入成型项,补偿模型简化误差的振动影响,得到控制器uc
u c = IK p ( S h a p e r ( q v d ) - q v ) + IK d ( S h a p e r ( ω d ) e 0 - ω b t b ) - K p I S h a p e r ( q v 0 ) + K p Iq v 0 - K d I S h a p e r ( ω b t 0 b ) + K p Iω b t 0 b + S h a p e r ( a d ) Ie 0
式中,Shaper表示输入成型器,Kp表示比例控制系数,qvd表示目标四元数矢量部分,Kd表示微分控制系数,ωd表示目标姿态角速度,e0表示初始姿态到目标姿态对应的欧拉轴,qv0表示初始姿态四元数矢量部分,表示初始姿态角速度,ad表示目标姿态角加速度。
6.如权利要求1所述一种姿态控制方法,其特征在于,所述对卫星姿态导引控制进一步包含:位置回路控制器输出的三轴角速度指令ωkx、ωky、ωkz
ω k y ( k ) = K k y θ ^ ( k ) + K k y int Σ j = 0 k θ ^ ( k ) T s + ω 0
ω k z ( k ) = K k z ψ ^ ( k ) + K k z int Σ j = 0 k ψ ^ ( k ) T s
式中,ωkx(k)表示滚动方向修正角速度、ωky(k)表示俯仰方向修正角速度、ωkz(k)表示偏航方向修正角速度,Kkx、Kkxint是滚动方向比例-积分控制参数;Kky、Kkyint是俯仰方向比例-积分控制参数;Kkz、Kkzint是偏航方向比例-积分控制参数;是星敏感器测量得到的滚动角;是星敏感器测量得到的俯仰角;是星敏感器测量得到的偏航角;ω0是轨道角速度,Ts表示控制周期;
陀螺角度增量积分为
G x ( k ) = Σ j = 0 k ( ΔG x ( j ) )
G y ( k ) = Σ j = 0 k ( ΔG y ( j ) )
G z ( k ) = Σ j = 0 k ( ΔG z ( j ) )
式中:ΔGx(j)表示滚动方向第j个控制周期内陀螺组合输出的角度增量;ΔGy(j)表示俯仰方向第j个控制周期内陀螺组合输出的角度增量;ΔGz(j)表示偏航方向第j个控制周期内陀螺组合输出的角度增量;Gx(k)表示滚动方向前k个控制周期内角度增量的积分;Gy(k)表示滚动方向前k个控制周期内角度增量的积分;Gz(k)表示滚动方向前k个控制周期内角度增量的积分;
速度回路输入指令为
θ c o m _ y ( k ) = Σ j = 0 k ω k y ( k ) T s + G y ( k )
ψ c o m _ z ( k ) = Σ j = 0 k ω k z ( k ) T s + G z ( k )
式中:表示滚动方向速度回路输入指令;θcom_y表示俯仰方向速度回路输入指令;ψcom_z表示偏航方向速度回路输入指令;
卫星三轴方向的控制力矩Tc为:
T c y ( k ) = K P y θ c o m _ y ( k ) + K I y Σ j = 0 k θ c o m _ y ( k ) · T s
T c z ( k ) = K P z ψ c o m _ z ( k ) + K I z Σ j = 0 k ψ c o m _ z ( k ) · T s
式中,KPx、KIx是滚动方向比例-积分控制参数;KPy、KIy是俯仰方向比例-积分控制参数;KPz、KIz是偏航方向比例-积分控制参数。
7.如权利要求1所述一种姿态控制方法,其特征在于,饱和滑模变结构控制算法中对卫星相对目标姿态的姿态角与角速度误差的计算进一步包含:
q e = q d - 1 ⊗ q a o
式中,qao是星测量得到星体相对轨道系的姿态四元数,qd是期望的目标四元数;
将qe转换成姿态矩阵R(qe),式中,是qe的矢量部分,的斜对称矩阵;
Q ~ e = 0 - q e 3 q e 2 q e 3 0 - q e 1 - q e 2 q e 1 0
按照123转序,由R(qe)计算姿态角误差:
θe=asin(R31)
ψe=atan2(-R21,R11)
式中,Rij是矩阵R(qe)的第i行第j列的元素,a是力矩调节系数;
卫星相对目标姿态的姿态角速度误差:
ω o r b i t = ω - R ( q a o ) 0 - ω 0 0
ωe=ωorbit-R(qed
式中,R(qao)是qao对应的姿态矩阵,ω0是实时轨道角速度,ωd是期望的目标姿态角速度。
8.如权利要求7所述一种姿态控制方法,其特征在于,所述饱和滑模变结构控制算法进一步包含:
滑模面系数:
K x = 0.1 × ω f - m i n 2 ζ x
K y = 0.1 × ω f - m i n 2 ζ y
K z = 0.1 × ω f - m i n 2 ζ z
边界层厚度:
ϵ x = aT c x m a x 4 ζ x 2 K x I x x
ϵ y = aT c y m a x 4 ζ y 2 K y I y y
ϵ z = aT c z m a x 4 ζ z 2 K z I z z
式中,a是力矩调节系数,取为0.1-0.5;ωf-min为卫星的太阳帆板的基频,0.1ωf-min为系统的带宽,ζx=0.7,ζy=0.7,ζz=0.7为系统的阻尼,Tcxmax,Tcymax,Tczmax为卫星在三个方向的最大控制力矩;Ixx、Iyy、Izz是卫星三轴方向转动惯量;滑模面计算如下:
Sy=Kyθeey
Sz=Kzψeez
式中,ωxmax是姿态机动的最大角速度,可根据执行机动在滚动方向的最大角动量Hcxmax计算得到:
ω x m a x = H c x m a x ( 1 + ΔI x x ) I x x
式中,ΔIxx是惯量的拉偏阈值,取值范围为0.1-0.3;
控制力矩:
当|ωei|<1×10-3×π/180,Tcimax=a·Tcimax,否则Tcimax=Tcimax
当|Si|>εi时,Tci=sign(Si)*Tcimax
当|Si|<εi时,
式中,i=x,y,z。
CN201710128823.6A 2017-03-06 2017-03-06 一种姿态控制方法 Active CN106915477B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710128823.6A CN106915477B (zh) 2017-03-06 2017-03-06 一种姿态控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710128823.6A CN106915477B (zh) 2017-03-06 2017-03-06 一种姿态控制方法

Publications (2)

Publication Number Publication Date
CN106915477A true CN106915477A (zh) 2017-07-04
CN106915477B CN106915477B (zh) 2018-01-30

Family

ID=59462062

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710128823.6A Active CN106915477B (zh) 2017-03-06 2017-03-06 一种姿态控制方法

Country Status (1)

Country Link
CN (1) CN106915477B (zh)

Cited By (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107608213A (zh) * 2017-10-12 2018-01-19 上海航天控制技术研究所 一种卫星姿态机动路径规划的参数设计方法
CN107628273A (zh) * 2017-09-27 2018-01-26 上海航天控制技术研究所 一种基于可变控制周期的卫星姿态控制方法
CN107719705A (zh) * 2017-09-26 2018-02-23 北京航空航天大学 一种使用固体微推力器阵列抑制卫星太阳帆板振动的方法
CN107839903A (zh) * 2017-09-25 2018-03-27 上海卫星工程研究所 单翼卫星转移轨道段帆板放气时间估计方法
CN108536009A (zh) * 2018-03-08 2018-09-14 南京航空航天大学 一种混合小推力航天器的轨道保持和扰动抑制方法
CN109443813A (zh) * 2018-09-28 2019-03-08 中国空间技术研究院 卫星电推进矢量调节机构转动测试方法
CN109445448A (zh) * 2018-10-31 2019-03-08 中国人民解放军战略支援部队航天工程大学 一种轮控小卫星自适应积分滑模姿态控制器
CN109521786A (zh) * 2019-01-23 2019-03-26 南京邮电大学 基于比例积分观测器的四旋翼无人机滑模姿态控制方法
CN109573105A (zh) * 2018-11-19 2019-04-05 上海埃依斯航天科技有限公司 末子级留轨应用子系统姿态控制方法
CN109625331A (zh) * 2018-12-26 2019-04-16 上海微小卫星工程中心 卫星控制器和卫星控制方法
CN110147115A (zh) * 2019-06-21 2019-08-20 哈尔滨工业大学 以载荷为中心、平台随动的旋转载荷卫星姿态控制方法
CN110389592A (zh) * 2019-07-18 2019-10-29 南京航空航天大学 一种基于分布式智能飞轮的航天器姿态控制方法
CN110703595A (zh) * 2019-08-01 2020-01-17 中国科学院力学研究所 一种星-臂耦合系统的主星姿态高精度预报方法及系统
CN110775299A (zh) * 2019-10-14 2020-02-11 北京控制工程研究所 一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法
CN111319801A (zh) * 2020-03-10 2020-06-23 上海航天控制技术研究所 一种适用于火星探测的中途修正策略制定及实施方法
CN111532453A (zh) * 2020-05-11 2020-08-14 鲁东大学 一种用于刚体微纳卫星的固定时间抗干扰姿态控制方法
CN111605734A (zh) * 2020-04-28 2020-09-01 北京控制工程研究所 一种航天器三超控制星时准确同步的滤波校时系统及方法
CN111731512A (zh) * 2020-04-30 2020-10-02 上海航天控制技术研究所 一种基于太阳翼驱动控制的火星环绕器在线角动量管理方法
CN112357121A (zh) * 2020-10-30 2021-02-12 哈尔滨工业大学 一种基于预置姿态的卫星入轨快速成像方法
CN112550766A (zh) * 2020-11-27 2021-03-26 上海航天控制技术研究所 一种处于推力器死区内提高卫星姿态控制精度的方法
CN113324714A (zh) * 2021-04-27 2021-08-31 上海卫星工程研究所 双超卫星舱间电缆刚度在轨测定方法与系统
CN113686334A (zh) * 2021-07-07 2021-11-23 上海航天控制技术研究所 一种提高星敏感器和陀螺在轨联合滤波精度的方法
CN114919774A (zh) * 2022-05-20 2022-08-19 南京航空航天大学 非接触载荷无扰卫星平台洛伦兹力执行器在轨标定方法
CN117074798A (zh) * 2023-08-11 2023-11-17 河北斐然科技有限公司 一种应用于导航功能飞行器的卫星天线测试转台
CN117968670A (zh) * 2024-04-02 2024-05-03 北京航空航天大学 一种微小卫星大角度姿态机动中的高精度指向方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060022091A1 (en) * 2004-07-30 2006-02-02 Peck Mason A Method and system for optimizing torque in a cmg array
CN101214859A (zh) * 2007-12-26 2008-07-09 北京控制工程研究所 一种变轨期间自主故障检测恢复控制的方法
CN103129752A (zh) * 2013-02-28 2013-06-05 中国资源卫星应用中心 一种基于地面导航的光学遥感卫星姿态角误差动态补偿方法
CN104085539A (zh) * 2014-06-26 2014-10-08 北京控制工程研究所 成像定标的姿态控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060022091A1 (en) * 2004-07-30 2006-02-02 Peck Mason A Method and system for optimizing torque in a cmg array
CN101214859A (zh) * 2007-12-26 2008-07-09 北京控制工程研究所 一种变轨期间自主故障检测恢复控制的方法
CN103129752A (zh) * 2013-02-28 2013-06-05 中国资源卫星应用中心 一种基于地面导航的光学遥感卫星姿态角误差动态补偿方法
CN104085539A (zh) * 2014-06-26 2014-10-08 北京控制工程研究所 成像定标的姿态控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
帅平 等: "《基于X射线脉冲星的导航卫星自主导航》", 《中国空间科学技术》 *

Cited By (41)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107839903A (zh) * 2017-09-25 2018-03-27 上海卫星工程研究所 单翼卫星转移轨道段帆板放气时间估计方法
CN107839903B (zh) * 2017-09-25 2020-07-14 上海卫星工程研究所 单翼卫星转移轨道段帆板放气时间估计方法
CN107719705A (zh) * 2017-09-26 2018-02-23 北京航空航天大学 一种使用固体微推力器阵列抑制卫星太阳帆板振动的方法
CN107719705B (zh) * 2017-09-26 2020-03-24 北京航空航天大学 一种使用固体微推力器阵列抑制卫星太阳帆板振动的方法
CN107628273B (zh) * 2017-09-27 2019-06-04 上海航天控制技术研究所 一种基于可变控制周期的卫星姿态控制方法
CN107628273A (zh) * 2017-09-27 2018-01-26 上海航天控制技术研究所 一种基于可变控制周期的卫星姿态控制方法
CN107608213B (zh) * 2017-10-12 2020-11-03 上海航天控制技术研究所 一种卫星姿态机动路径规划的参数设计方法
CN107608213A (zh) * 2017-10-12 2018-01-19 上海航天控制技术研究所 一种卫星姿态机动路径规划的参数设计方法
CN108536009A (zh) * 2018-03-08 2018-09-14 南京航空航天大学 一种混合小推力航天器的轨道保持和扰动抑制方法
CN108536009B (zh) * 2018-03-08 2021-01-15 南京航空航天大学 一种混合小推力航天器的轨道保持和扰动抑制方法
CN109443813A (zh) * 2018-09-28 2019-03-08 中国空间技术研究院 卫星电推进矢量调节机构转动测试方法
CN109445448B (zh) * 2018-10-31 2021-08-17 中国人民解放军战略支援部队航天工程大学 一种轮控小卫星自适应积分滑模姿态控制器
CN109445448A (zh) * 2018-10-31 2019-03-08 中国人民解放军战略支援部队航天工程大学 一种轮控小卫星自适应积分滑模姿态控制器
CN109573105A (zh) * 2018-11-19 2019-04-05 上海埃依斯航天科技有限公司 末子级留轨应用子系统姿态控制方法
CN109573105B (zh) * 2018-11-19 2022-06-14 上海埃依斯航天科技有限公司 末子级留轨应用子系统姿态控制方法
WO2020103290A1 (zh) * 2018-11-19 2020-05-28 上海埃依斯航天科技有限公司 末子级留轨应用子系统姿态控制方法
CN109625331A (zh) * 2018-12-26 2019-04-16 上海微小卫星工程中心 卫星控制器和卫星控制方法
CN109521786A (zh) * 2019-01-23 2019-03-26 南京邮电大学 基于比例积分观测器的四旋翼无人机滑模姿态控制方法
CN110147115B (zh) * 2019-06-21 2021-11-19 哈尔滨工业大学 以载荷为中心、平台随动的旋转载荷卫星姿态控制方法
CN110147115A (zh) * 2019-06-21 2019-08-20 哈尔滨工业大学 以载荷为中心、平台随动的旋转载荷卫星姿态控制方法
CN110389592B (zh) * 2019-07-18 2020-12-01 南京航空航天大学 一种基于分布式智能飞轮的航天器姿态控制方法
CN110389592A (zh) * 2019-07-18 2019-10-29 南京航空航天大学 一种基于分布式智能飞轮的航天器姿态控制方法
CN110703595A (zh) * 2019-08-01 2020-01-17 中国科学院力学研究所 一种星-臂耦合系统的主星姿态高精度预报方法及系统
CN110775299A (zh) * 2019-10-14 2020-02-11 北京控制工程研究所 一种唯星敏定姿定速的欠测量干扰抑制姿态控制方法
CN111319801A (zh) * 2020-03-10 2020-06-23 上海航天控制技术研究所 一种适用于火星探测的中途修正策略制定及实施方法
CN111319801B (zh) * 2020-03-10 2021-10-01 上海航天控制技术研究所 一种适用于火星探测的中途修正策略制定及实施方法
CN111605734A (zh) * 2020-04-28 2020-09-01 北京控制工程研究所 一种航天器三超控制星时准确同步的滤波校时系统及方法
CN111731512A (zh) * 2020-04-30 2020-10-02 上海航天控制技术研究所 一种基于太阳翼驱动控制的火星环绕器在线角动量管理方法
CN111731512B (zh) * 2020-04-30 2022-03-04 上海航天控制技术研究所 一种基于太阳翼驱动控制的火星环绕器在线角动量管理方法
CN111532453A (zh) * 2020-05-11 2020-08-14 鲁东大学 一种用于刚体微纳卫星的固定时间抗干扰姿态控制方法
CN112357121B (zh) * 2020-10-30 2022-04-29 哈尔滨工业大学 一种基于预置姿态的卫星入轨快速成像方法
CN112357121A (zh) * 2020-10-30 2021-02-12 哈尔滨工业大学 一种基于预置姿态的卫星入轨快速成像方法
CN112550766A (zh) * 2020-11-27 2021-03-26 上海航天控制技术研究所 一种处于推力器死区内提高卫星姿态控制精度的方法
CN113324714A (zh) * 2021-04-27 2021-08-31 上海卫星工程研究所 双超卫星舱间电缆刚度在轨测定方法与系统
CN113686334A (zh) * 2021-07-07 2021-11-23 上海航天控制技术研究所 一种提高星敏感器和陀螺在轨联合滤波精度的方法
CN113686334B (zh) * 2021-07-07 2023-08-04 上海航天控制技术研究所 一种提高星敏感器和陀螺在轨联合滤波精度的方法
CN114919774A (zh) * 2022-05-20 2022-08-19 南京航空航天大学 非接触载荷无扰卫星平台洛伦兹力执行器在轨标定方法
CN117074798A (zh) * 2023-08-11 2023-11-17 河北斐然科技有限公司 一种应用于导航功能飞行器的卫星天线测试转台
CN117074798B (zh) * 2023-08-11 2024-05-17 河北斐然科技有限公司 一种应用于导航功能飞行器的卫星天线测试转台
CN117968670A (zh) * 2024-04-02 2024-05-03 北京航空航天大学 一种微小卫星大角度姿态机动中的高精度指向方法
CN117968670B (zh) * 2024-04-02 2024-05-28 北京航空航天大学 一种微小卫星大角度姿态机动中的高精度指向方法

Also Published As

Publication number Publication date
CN106915477B (zh) 2018-01-30

Similar Documents

Publication Publication Date Title
CN106915477B (zh) 一种姿态控制方法
CN106873611B (zh) 一种多通道线性自抗扰控制器的设计方法
CN104792340B (zh) 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法
CN109573105B (zh) 末子级留轨应用子系统姿态控制方法
JP3027734B2 (ja) 衛星の位置を機内で自主的に求める方法と装置
US8321076B2 (en) On-line inertia estimation for use in controlling an aerospace vehicle
US9643740B2 (en) Gyroless three-axis sun acquisition using sun sensor and unscented kalman filter
CN102425980B (zh) 利用加速度计实现过载驾驶仪的控制方法
CN104596543B (zh) 一种基准不确定情况下陀螺仪组合误差系数标定方法
CN103955223A (zh) 一种深空探测软着陆过程的姿轨耦合控制方法
CN104570742A (zh) 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法
CN104483973A (zh) 基于滑模观测器的低轨挠性卫星姿态跟踪控制方法
US6463365B1 (en) System and method for controlling the attitude of a space craft
CN110316402A (zh) 一种编队控制模式下的卫星姿态控制方法
CN105807780B (zh) 一种基于飞轮输出偏差的抗干扰姿态控制方法及验证装置
CN108959734B (zh) 一种基于实时递推太阳光压力矩辨识方法及系统
CN105180936A (zh) 一种四轴惯性稳定平台系统的伺服回路解耦方法
CN105929836A (zh) 用于四旋翼飞行器的控制方法
CN103019247A (zh) 一种火星探测器无陀螺自主空间姿态机动控制方法
CN107861386A (zh) 一种基于角速度观测器的抗干扰姿态控制地面验证系统及其控制方法
CN105115505A (zh) 一种四轴惯性稳定平台系统的二阶动态干扰力矩补偿方法
CN109649691A (zh) 一种偏置动量卫星单飞轮与磁联合控制方法和系统
CN106326576B (zh) 一种任意基准系下的整星偏置角动量的偏航估计方法
Fiot et al. Estimation of air velocity for a high velocity spinning projectile using transerse accelerometers
CN112550765B (zh) 一种利用卫星姿态测量信息进行卫星大惯量转动部件的转动惯量在轨估计方法

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