CN105905317B - 一种卫星对日定向控制系统及其控制方法 - Google Patents
一种卫星对日定向控制系统及其控制方法 Download PDFInfo
- Publication number
- CN105905317B CN105905317B CN201610414531.4A CN201610414531A CN105905317B CN 105905317 B CN105905317 B CN 105905317B CN 201610414531 A CN201610414531 A CN 201610414531A CN 105905317 B CN105905317 B CN 105905317B
- Authority
- CN
- China
- Prior art keywords
- sun
- control
- vector
- satellite
- data
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 238000005259 measurement Methods 0.000 claims description 33
- 238000004422 calculation algorithm Methods 0.000 claims description 17
- 238000004364 calculation method Methods 0.000 claims description 17
- 239000011159 matrix material Substances 0.000 claims description 14
- 238000009434 installation Methods 0.000 claims description 6
- 206010034972 Photosensitivity reaction Diseases 0.000 claims description 2
- 230000003287 optical effect Effects 0.000 claims description 2
- 238000010276 construction Methods 0.000 abstract description 3
- 230000005540 biological transmission Effects 0.000 description 6
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000001174 ascending effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
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
本发明提供了一种卫星对日定向控制系统及其控制方法。其系统包括:骨架、陀螺、星敏感器、太阳敏感器、电路、数据线路和星载控制组件,根据系统工作模式选择采用不同的姿态敏感器通过不同的方法计算出本体系下的太阳矢量,由卫星结构设计信息计算本体系下太阳帆板法线矢量,根据矢量旋转定义推导出误差四元数,计算误差角速度代入PID控制律,将计算的控制指令传送给反作用飞轮完成对日定向控制。该控制装置可满足两种工作模式下卫星的对日定向控制,统一了星上控制算法及参数设定,并使卫星对日定向机动路径最短,该发明可广泛适用于各种需要进行对日定向控制的卫星。
Description
技术领域
本发明属于卫星姿态控制技术领域,具体涉及一种卫星对日定向控制系统及其控制方法。
背景技术
对于一类带固定太阳电池阵(太阳帆板)的卫星,长期在轨运行时为了保证能源供应,一般会有对日定向模式,另外卫星安全模式中也需要对日定向,二者都要求将卫星太阳电池面指向太阳方向。
常用的卫星对日定向控制有两种方式。
第一种是以太阳敏感器+陀螺作为测量元件,反作用飞轮作为控制执行元件,控制计算机根据太阳敏感器测得的太阳角和陀螺测得的角速度,计算控制指令并发送给反作用飞轮,实现太阳帆板单轴对日定向控制。
第二种是以星敏感器+陀螺作为测量元件,反作用飞轮作为控制执行元件,根据星敏感器的测量信息可以知道卫星当前姿态,由陀螺测得角速度,根据太阳历可以计算出目标坐标系即偏置太阳黄道坐标系在惯性系下的姿态,控制计算机根据上述信息可以计算控制指令并发送给反作用飞轮,实现卫星姿态与偏置太阳黄道坐标系的重合,即实现对日定向三轴稳定。
卫星姿态控制系统设计时,出于可靠性和安全性等考虑,一般在卫星正常工作模式下采用第二种方案,在故障或安全模式下采用第一种方案,这样从控制算法上需要设计两套不同的算法;同时方案二需要建立单独的对日定向坐标系,该坐标系为动坐标系,需要实时解算,如果能省去该步骤,可以简化算法;从对日定向控制的目的上说没有必要使用三轴稳定控制,单轴定向姿态机动相比于三轴稳定姿态机动路径更短,时间更优。
发明内容
本发明针对一类带固定太阳电池阵卫星的帆板对日定向控制问题,提出了一种卫星对日定向控制系统及其控制方法。其系统组成包括:系统骨架、陀螺、星敏感器、太阳敏感器、电路、数据线路和反作用飞轮,它还包括由工作模式选择模块、本体太阳矢量计算模块、本体帆板法线矢量计算模块、误差角速度计算模块、误差四元数计算模块和控制力矩计算模块组成的星载控制组件,其中本体太阳矢量计算模块包括子模块1和子模块2,子模块1对应星敏感器,子模块2对应太阳敏感器;陀螺、星敏感器、太阳敏感器、反作用飞轮和星载控制组件固定在骨架上,通过电路供电,通过数据线路传递数据。特点是测量组合太阳敏感器和星敏感器,共用一套数据算法的星载控制组件,各器件、模块的功用及控制方法如下:
陀螺用于测量卫星的三轴角速度,并将测量到的角速度数据发送给星载控制组件中的误差角速度计算模块;
误差角速度计算模块根据接收到的角速度数据,结合预先设定的目标角速度计算出误差角速度数据,并将得到的误差角速度数据发送给控制力矩计算模块;
星敏感器用于测量卫星姿态信息,并将测量到的姿态信息数据发送给星载控制组件中的工作模式选择模块;
太阳敏感器用于测量太阳敏感器坐标系下的双轴太阳角信息,并将测量到的太阳角数据发送给星载控制组件中的工作模式选择模块;
工作模式选择模块接收星敏感器测量的姿态数据和太阳敏感器测量的太阳角数据,并根据当前工作模式选择采用星敏感器数据或者太阳敏感器数据,并将所选测量数据发送给本体太阳矢量计算模块中的子模块1或者子模块2,子模块1对应星敏感器,子模块2对应太阳敏感器;
本体太阳矢量计算模块包括子模块1和子模块2,子模块1用于接收工作模式选择模块发送的星敏感器测量数据并计算太阳矢量在卫星本体中的单位矢量,子模块2用于接收工作模式选择模块发送的太阳敏感器测量数据并计算太阳矢量在卫星本体中的单位矢量,两个模块不同时工作,本体太阳矢量计算模块将算得的本体太阳单位矢量数据发送给误差四元数计算模块;
卫星工作模式的设定由星上自主管理程序设定或者地面发送的遥控指令设定;
本体帆板法线矢量计算模块,根据卫星结构设计所确定的帆板安装方位信息,计算帆板法线方向在卫星本体中的单位矢量,并将其发送给误差四元数计算模块;
误差四元数计算模块根据接收到的本体太阳单位矢量数据和本体帆板法线单位矢量数据,根据矢量旋转四元数计算算法计算姿态误差四元数,并将算得的误差四元数数据发送给控制力矩计算模块;
控制力矩计算模块根据接收到的误差四元数数据和误差角速度数据,由姿态控制算法计算控制力矩指令,并将算得的控制力矩指令发送给反作用飞轮;
反作用飞轮依据控制指令来改变输出力矩,实现卫星对日定向控制。
一种卫星对日定向控制装置的控制方法,它通过如下算法实现:
1)陀螺测量的角速度记为ω,将其发送给误差角速度计算模块,目标角速度记为ωc,由星上自主程序设定或者地面发送的遥控指令设定,计算误差角速度ωe=ω-ωc,并将ωe发送给控制力矩计算模块;
2)星敏感器测量数据为卫星相对于J2000地心惯性坐标系的姿态四元数记为qbi=[q0 q1 q2 q3],并发送给工作模式选择模块;
3)太阳敏感器测量坐标系记为O-xsyszs,Ozs轴为太阳敏感器光轴,另外两轴沿测量方向构成正交坐标系,太阳敏感器的角度测量值是太阳矢量在基准面xsOzs面上的投影与Ozs轴之间的夹角ε,以及太阳矢量在基准面ysOzs面上的投影与Ozs轴之间的夹角η,且并发送给工作模式选择模块;
4)工作模式选择模块主要执行如下逻辑判断,即:
当卫星工作在对日定向模式时,采用星敏感器测量数据并将其发送给本体太阳矢量计算模块的子模块1,不采用太阳敏感器数据;
当卫星工作在安全模式时,采用太阳敏感器测量数据并将其发送给本体太阳矢量计算模块的子模块2,不采用星敏感器数据;
卫星工作模式的设定由星上自主管理程序设定或者地面发送的遥控指令设定;
5)本体太阳矢量计算模块包括子模块1和子模块2,两个模块算法如下:
子模块1接收工作模式选择模块发送的星敏感器测量数据qbi,对应的姿态矩阵为
由太阳历或者平均太阳轨道根数计算公式可以得到太阳矢量在J2000地心惯性系中的指向矢量Se,该太阳历数据或计算公式可以由设计人员预先装定在该模块中;
太阳位置矢量在卫星本体系指向的单位矢量为S1=AbiSe;
子模块2接收工作模式选择模块发送的太阳敏感器测量数据ε、η,计算太阳矢量在太阳敏感器坐标系O-xsyszs中指向的单位矢量
令本体坐标系到太阳敏感器坐标系的旋转四元数为qmb,同姿态矩阵的表达式计算敏感器安装矩阵Rmb,可计算出太阳矢量在本体系指向的单位矢量
本体太阳矢量计算模块将由子模块1或者子模块2计算的本体系太阳单位矢量S1发送给误差四元数计算模块;
6)由本体帆板法线矢量计算模块计算太阳帆板法线在卫星本体系指向的单位矢量U1;
帆板坐标系的Z轴与帆板法线重合,X、Y轴在帆板平面内构成正交坐标系,根据卫星结构设计确定帆板安装矩阵Rfb,帆板坐标系中其法线矢量为Uf=[0 0 1]T,则帆板法线矢量在卫星本体系指向的单位矢量
本体帆板法线矢量计算模块将计算的本体系帆板法线单位矢量U1发送给误差四元数计算模块;
7)误差四元数计算模块根据接收到的本体系太阳单位矢量S1和本体系帆板法线单位矢量U1,计算误差四元数也即由矢量S1到矢量U1的旋转四元数qe,算法如下:
计算本体坐标系中旋转轴方向的单位矢量
n1、n2、n3为该矢量在本体系中的三个分量,计算绕n轴的旋转角度θ=arcsin(|S1×U1|),计算旋转四元数或者误差四元数
误差四元数计算模块将计算的误差四元数qe发送给控制力矩计算模块;
8)控制力矩计算模块根据接收到的误差四元数qe和误差角速度ωe计算控制力矩指令,算法如下:
Tw=-kpqe-kdωe-ki∫qedt
其中Tw为飞轮力矩指令,qe为误差四元数矢部,kp、kd、ki分别为PID控制律的比例、微分、积分系数矩阵,为保证算法收敛性要求三个系数矩阵正定,三项系数由设计人员预先装定在该模块中;
控制力矩计算模块将计算的控制力矩指令Tw发送给反坐用飞轮;
9)反作用飞轮接收控制力矩计算模块发送的控制力矩指令,产生控制力矩,实现卫星姿态的对日定向控制。
本发明具有如下优点:
1)不需要建立对日定向坐标系,简化控制系统设计。
2)采用一套算法兼顾星敏感器+陀螺和太阳敏感器+陀螺两种测量方案;同时将经典三轴稳定控制策略应用于单轴定向控制;实现了星上控制算法的统一。
3)保证了任意姿态转入对日定向模式的姿态机动路径最短。
4)可以非常简单的实现绕对日定向轴的旋转控制,应用于星敏感器视场受地气光干扰的情形。
本发明也适用于采用小推力器作为执行机构的卫星对日定向控制,只需要将计算出的控制力矩指令进行脉冲调制处理,再发送给推力器即可完成控制。
附图说明
图1为本发明的控制原理框图。
图2为双轴数字太阳敏感器示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
结合图1说明本实施方式,一种卫星对日定向控制系统及其控制方法,它包括陀螺1、星敏感器2、太阳敏感器3和反作用飞轮5;它还包括星载控制组件4,所述星载控制组件包括工作模式选择模块4-1、本体太阳矢量计算模块4-2、本体帆板法线矢量计算模块4-3、误差角速度计算模块4-4、误差四元数计算模块4-5和控制力矩计算模块4-6;
所述陀螺1用于测量卫星的三轴角速度,并将测量到的角速度数据发送给星载控制组件中的误差角速度计算模块4-4;
所述误差角速度计算模块4-4根据接收到的角速度数据,结合预先设定的目标角速度计算出误差角速度数据,并将得到的误差角速度数据发送给控制力矩计算模块4-6;
所述星敏感器2用于测量卫星姿态信息,并将测量到的姿态信息数据发送给星载控制组件中的工作模式选择模块4-1;
所述太阳敏感器3用于测量太阳敏感器坐标系下的双轴太阳角信息,并将测量到的太阳角数据发送给星载控制组件中的工作模式选择模块4-1;
所述工作模式选择模块4-1接收星敏感器2测量的姿态数据和太阳敏感器3测量的太阳角数据,并根据当前工作模式选择采用星敏感器数据或者太阳敏感器数据,并将所选测量数据发送给本体太阳矢量计算模块4-2中的子模块1或者子模块2,子模块1对应星敏感器,子模块2对应太阳敏感器;
所述本体太阳矢量计算模块4-2包括子模块1和子模块2,子模块1用于接收工作模式选择模块4-1发送的星敏感器测量数据并计算太阳矢量在卫星本体中的单位矢量,子模块2用于接收工作模式选择模块4-1发送的太阳敏感器测量数据并计算太阳矢量在卫星本体中的单位矢量,两个模块不同时工作,本体太阳矢量计算模块将算得的本体太阳单位矢量数据发送给误差四元数计算模块4-5;
所述本体帆板法线矢量计算模块4-3,根据卫星结构设计所确定的帆板安装方位信息,计算帆板法线方向在卫星本体中的单位矢量,并将其发送给误差四元数计算模块4-5;
所述误差四元数计算模块4-5根据接收到的本体太阳单位矢量数据和本体帆板法线单位矢量数据,根据矢量旋转四元数计算算法计算姿态误差四元数,并将算得的误差四元数数据发送给控制力矩计算模块4-6;
所述控制力矩计算模块4-6根据接收到的误差四元数数据和误差角速度数据,由姿态控制算法计算控制力矩指令,并将算得的控制力矩指令发送给反作用飞轮5;
所述反作用飞轮5依据控制指令来改变输出力矩,实现卫星对日定向控制。
考虑一颗带固定太阳帆板的卫星,该卫星采用上述装置进行对日定向控制,该卫星技术参数为:
转动惯量(kgm2):Ib=diag([Ibx Iby Ibz])=diag([50 300 300]),
太阳帆板的安装矩阵为:
太阳敏感器的安装矩阵为:
PID控制参数取为:kp=0.02Ib、kd=0.3Ib、ki=0.005Ib;
结合两个工况对该实施例进行说明;
工况一:工作模式为对日定向模式,当前儒略日JD=2457024,
陀螺测量的角速度为:ω=[0.01 0.01 -0.01]T(°/s),
设定目标角速度为:ωc=[0 0 0]T(°/s),
星敏感器测量的星体姿态四元数为:
qbi=[-0.06699 0.250 -0.9330 0.250],
太阳敏感器测量的太阳角为:ε=20.45°,η=35.92°;
1)误差角速度计算模块4-4计算误差角速度
ωe=ω-ωc=[0.01 0.01 -0.01]T(°/s),
将其发送给控制力矩计算模块4-6;
2)工作模式选择模块根据4-1当前工作模式为对日定向模式,选择采用星敏感器2测量数据,并将其发送给本体太阳矢量计算模块4-2的子模块1,不采用太阳敏感器3的测量数据;
3)本体太阳矢量计算模块4-2的子模块1接收工作模式选择模块4-1发送的星敏感器测量数据qbi,计算姿态矩阵为
这里由平均太阳轨道根数计算公式可以得到太阳矢量在J2000地心惯性系中的指向矢量Se,计算公式如下,
天文单位AU=1.49597870e8km,计算从J2000算起的儒略世纪数则平均太阳轨道根数如下(单位为度),
a=1.00000102AU
e=0.01670862-0.00004204T-0.000000124T2
ε=23.439302-0.013004T-0.16e-6T2
Ω=0
ω=282.937347+1.719533T+0.46e-6T2
u=280.466447+36000.769822T+0.000304T2
对应根数分别为半长轴、偏心率、黄赤交角(即轨道倾角)、升交点赤经、近地点平黄经(即平近地点幅角)和对于当天平春分点的近地点平黄经(即平纬度幅角),可计算出平近点角为M=u-ω,迭代求解开普勒方程E-e sin E=M,可以求出偏近点角E和真近点角f,则太阳黄经(即纬度幅角)为
Λ=ω+f,
地-日间距离
在地心赤道惯性系中太阳的位置矢量为
对rh进行单位化可以得到太阳矢量在J2000地心惯性系中的指向矢量
Se=rh/rh=[0.18648 -0.90140 -0.39077]T,
太阳位置矢量在卫星本体系指向的单位矢量为
S1=AbiSe=[0.28920 -0.56141 0.77535]T;
本体太阳矢量计算模块4-2将由子模块1计算的本体系太阳单位矢量S1发送给误差四元数计算模块4-5;
4)由本体帆板法线矢量计算模块4-3计算太阳帆板法线在卫星本体系指向的单位矢量U1,帆板坐标系中其法线矢量为Uf=[0 0 1]T,则帆板法线矢量在卫星本体系指向的单位矢量
本体帆板法线矢量计算模块4-3将计算的本体系帆板法线单位矢量U1发送给误差四元数计算模块4-5;
5)误差四元数计算模块4-5根据接收到的本体系太阳单位矢量S1和本体系帆板法线单位矢量U1,计算误差四元数也即由矢量S1到矢量U1的旋转四元数qe,算法如下:
计算本体坐标系中旋转轴方向的单位矢量
计算绕n轴的旋转角度θ=arcsin(|S1×U1|)=0.31047rad,计算旋转四元数或者误差四元数
误差四元数计算模块4-5将计算的误差四元数qe发送给控制力矩计算模块4-6;
8)控制力矩计算模块4-6根据接收到的误差四元数qe和误差角速度ωe计算控制力矩指令:
Tw=-kpqe-kdωe-ki∫qedt=[0.0472 0.7448 0.4548]T(Nm)
控制力矩计算模块将计算的控制力矩指令Tw发送给反坐用飞轮5;
9)反作用飞轮5接收控制力矩指令,产生控制力矩,完成第一个控制周期的控制。
工况二:工作模式为安全模式,其它条件同工况一;
1)误差角速度计算模块4-4计算误差角速度
ωe=ω-ωc=[0.01 0.01 -0.01]T(°/s),
将其发送给控制力矩计算模块4-6;
2)工作模式选择模块根据4-1当前工作模式为安全模式,选择采用太阳敏感器3测量数据,并将其发送给本体太阳矢量计算模块4-2的子模块2,不采用星敏感器2的测量数据;
3)本体太阳矢量计算模块4-2的子模块2接收工作模式选择模块4-1发送的太阳敏感器测量数据ε=20.45°,η=35.92°,计算太阳矢量在太阳敏感器坐标系O-xsyszs中指向的单位矢量
计算太阳矢量在本体系指向的单位矢量
本体太阳矢量计算模块4-2将由子模块2计算的本体系太阳单位矢量S1发送给误差四元数计算模块4-5;
4)由本体帆板法线矢量计算模块4-3计算太阳帆板法线在卫星本体系指向的单位矢量U1,帆板坐标系中其法线矢量为Uf=[0 0 1]T,则帆板法线矢量在卫星本体系指向的单位矢量
本体帆板法线矢量计算模块4-3将计算的本体系帆板法线单位矢量U1发送给误差四元数计算模块4-5;
5)误差四元数计算模块4-5根据接收到的本体系太阳单位矢量S1和本体系帆板法线单位矢量U1,计算误差四元数也即由矢量S1到矢量U1的旋转四元数qe,算法如下:
计算本体坐标系中旋转轴方向的单位矢量
计算绕n轴的旋转角度θ=arcsin(|S1×U1|)=0.31043rad,计算旋转四元数或者误差四元数
误差四元数计算模块4-5将计算的误差四元数qe发送给控制力矩计算模块4-6;
8)控制力矩计算模块4-6根据接收到的误差四元数qe和误差角速度ωe计算控制力矩指令:
Tw=-kpqe-kdωe-ki∫qedt=[0.0486 0.7647 0.4663]T(Nm)
控制力矩计算模块4-6将计算的控制力矩指令Tw发送给反坐用飞轮5;
9)反作用飞轮5接收控制力矩指令,产生控制力矩,完成第一个控制周期的控制。
本发明不仅局限于上述具体实施方式,本领域一般技术人员根据本发明公开的内容,可以采用其它多种具体实施方式实施本发明。在不脱离本发明构思的前提下,还可以做出若干简单推演或替换,都应当视为属于本发明所提交的权利要求书确定的专利保护范围。
Claims (2)
1.一种卫星对日定向控制系统,包括:系统骨架、陀螺、星敏感器、太阳敏感器、电路、数据线路和反作用飞轮,它还包括由工作模式选择模块、本体太阳矢量计算模块、本体帆板法线矢量计算模块、误差角速度计算模块、误差四元数计算模块和控制力矩计算模块组成的星载控制组件,其中本体太阳矢量计算模块包括第一子模块和第二子模块,第一子模块对应星敏感器,第二子模块对应太阳敏感器,陀螺、星敏感器、太阳敏感器、反作用飞轮和星载控制组件固定在系统骨架上,通过电路供电,通过数据线路传递数据;
基于上述卫星对日定向控制系统通过测量组合太阳敏感器和星敏感器,共用一套数据算法的星载控制组件的控制方法,实现卫星对日定向控制,控制流程如下:
(1)陀螺测量卫星的三轴角速度,并将测量到的角速度数据发送给星载控制组件中的误差角速度计算模块;
(2)误差角速度计算模块接收到角速度数据,结合预先设定的目标角速度计算出误差角速度数据,并将得到的误差角速度数据发送给控制力矩计算模块;
(3)星敏感器测量卫星姿态信息,并将测量到的姿态信息数据发送给星载控制组件中的工作模式选择模块;
(4)太阳敏感器测量太阳敏感器坐标系下的双轴太阳角信息,并将测量到的太阳角数据发送给星载控制组件中的工作模式选择模块;
(5)当工作模式选择星敏感器+陀螺测量组合时,工作模式选择模块接收星敏感器测量的姿态数据发送给本体太阳矢量计算模块中的第一子模块进行计算,第一子模块算得的本体太阳单位矢量数据发送给误差四元数计算模块;
(6)当工作模式选择太阳敏感器+陀螺测量组合时,工作模式选择模块接收太阳敏感器测量的太阳角数据发送给本体太阳矢量计算模块中的第二子模块进行计算,第二子模块算得的本体太阳单位矢量数据发送给误差四元数计算模块;
(7)本体帆板法线矢量计算模块根据帆板在卫星结构的安装方位信息,计算帆板法线方向在卫星本体中的单位矢量,并将计算数据发送给误差四元数计算模块;
(8)误差四元数计算模块根据接收到的本体太阳单位矢量数据和本体帆板法线单位矢量数据,计算姿态误差四元数,并将算得的误差四元数数据发送给控制力矩计算模块;
(9)控制力矩计算模块根据接收到的误差四元数数据和误差角速度数据,计算控制力矩指令,并将算得的控制力矩指令发送给反作用飞轮;
(10)反作用飞轮接收控制力矩指令来改变输出力矩,实现卫星对日定向控制。
2.根据权利要求1所述的一种卫星对日定向控制系统,其特征在于,获取控制力矩指令的方法如下:
(1)由陀螺测量卫星角速度ω,由星敏感器测量卫星相对于J2000地心惯性坐标系的姿态四元数qbi=[q0 q1 q2 q3],太阳敏感器测量太阳角ε、η,
其中:太阳敏感器测量坐标系记为O-xsyszs,Ozs轴为太阳敏感器光轴,另外两轴沿测量方向构成正交坐标系,太阳敏感器的角度测量值是太阳矢量在基准面xsOzs面上的投影与Ozs轴之间的夹角ε,以及太阳矢量在基准面ysOzs面上的投影与Ozs轴之间的夹角η;
(2)设定目标角速度ωc,计算误差角速度ωe=ω-ωc;
(3)当卫星工作模式为对日定向模式时,由星敏感器测量数据qbi,计算姿态矩阵Abi,由太阳历或者平均太阳轨道根数计算公式可以得到太阳矢量在J2000地心惯性系中的指向矢量Se,计算太阳位置矢量在卫星本体系指向的单位矢量为S1=AbiSe,
当卫星工作模式为安全模式时,由太阳敏感器测量数据ε、η,计算太阳矢量在太阳敏感器坐标系O-xsyszs中指向的单位矢量
根据敏感器安装矩阵Rmb,计算太阳矢量在本体系指向的单位矢量
(4)令帆板安装矩阵为Rfb,帆板坐标系中其法线矢量为Uf=[0 0 1]T,计算帆板法线矢量在卫星本体系指向的单位矢量
(5)计算本体坐标系中旋转轴方向的单位矢量
n1、n2、n3为该矢量在本体系中的三个分量,计算绕n轴的旋转角度θ=arcsin(|S1×U1|),计算旋转四元数或者误差四元数
(6)根据误差四元数qe和误差角速度ωe计算控制力矩指令,算法如下:
Tw=-kpqe-kdωe-ki∫qedt
其中Tw为飞轮的控制力矩指令,qe为误差四元数矢部,kp、kd、ki分别为PID控制律的比例、微分、积分系数矩阵,要求三个系数矩阵正定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610414531.4A CN105905317B (zh) | 2016-06-07 | 2016-06-07 | 一种卫星对日定向控制系统及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610414531.4A CN105905317B (zh) | 2016-06-07 | 2016-06-07 | 一种卫星对日定向控制系统及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105905317A CN105905317A (zh) | 2016-08-31 |
CN105905317B true CN105905317B (zh) | 2019-08-02 |
Family
ID=56751034
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610414531.4A Active CN105905317B (zh) | 2016-06-07 | 2016-06-07 | 一种卫星对日定向控制系统及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105905317B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2812876C1 (ru) * | 2023-07-07 | 2024-02-05 | Акционерное общество "Военно-промышленная корпорация "Научно-производственное объединение машиностроения" | Система астроориентации орбитального космического аппарата с обратными связями |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106595657B (zh) * | 2016-11-02 | 2019-10-01 | 沈阳航空航天大学 | 轴对称飞行器姿态测量装置及其测量方法 |
CN106864774B (zh) * | 2017-03-13 | 2019-12-20 | 上海航天控制技术研究所 | 卫星从任意姿态到对日定向的控制方法和系统 |
CN107703975A (zh) * | 2017-08-30 | 2018-02-16 | 长光卫星技术有限公司 | 无线能量传输型帆板对日跟踪系统 |
CN107621788B (zh) * | 2017-09-11 | 2021-04-02 | 北京电子工程总体研究所 | 一种协同仿真系统及服务器 |
CN107600464B (zh) * | 2017-09-18 | 2019-08-23 | 上海航天控制技术研究所 | 利用星敏感器信息的飞轮控制捕获太阳及对日定向方法 |
CN107796546B (zh) * | 2017-09-22 | 2020-07-14 | 上海卫星工程研究所 | 针对卫星力矩陀螺组在轨输出力矩的动态测量方法 |
CN107839903B (zh) * | 2017-09-25 | 2020-07-14 | 上海卫星工程研究所 | 单翼卫星转移轨道段帆板放气时间估计方法 |
CN108502209B (zh) * | 2018-05-24 | 2019-10-01 | 上海微小卫星工程中心 | 一种基于陀螺积分计算太阳矢量的卫星自旋太阳捕获方法 |
CN109032158B (zh) * | 2018-07-24 | 2021-07-09 | 北京控制工程研究所 | 一种直线规划的头对日—尾对日交替连续偏航姿态控制方法 |
CN110228605B (zh) * | 2019-06-18 | 2021-03-23 | 北京电子工程总体研究所 | 一种基于太阳敏感器的卫星安全对日控制方法 |
CN111366126A (zh) * | 2020-03-19 | 2020-07-03 | 上海卫星工程研究所 | 地面测站天线对卫星指向的视向量计算系统 |
CN111717415B (zh) * | 2020-06-22 | 2022-05-17 | 中国科学院微小卫星创新研究院 | 一种星座卫星太阳电池阵对日跟踪方法 |
CN111846289B (zh) * | 2020-08-06 | 2021-11-16 | 上海航天控制技术研究所 | 一种太阳帆板偏置安装时的卫星对日定向控制方法及卫星 |
CN112061425B (zh) * | 2020-09-08 | 2022-04-08 | 上海航天控制技术研究所 | 一种敏捷小卫星星敏感器受地气光干扰的规避方法 |
CN113358024B (zh) * | 2021-05-08 | 2022-08-12 | 上海卫星工程研究所 | 一种卫星仪器相对精测数据处理方法及系统 |
CN113830330B (zh) * | 2021-09-30 | 2023-08-29 | 北京控制工程研究所 | 一种基于中继星测控的卫星姿态指向方法和系统 |
CN115903475B (zh) * | 2022-10-26 | 2023-09-15 | 西安电子科技大学 | 基于空间太阳能电站地面验证系统对日定向模型控制方法 |
CN117516551A (zh) * | 2024-01-05 | 2024-02-06 | 中国西安卫星测控中心 | 一种卫星本体系太阳矢量的综合获得方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06127491A (ja) * | 1992-10-16 | 1994-05-10 | Toshiba Corp | 人工衛星の姿勢制御装置 |
US5865402A (en) * | 1995-05-24 | 1999-02-02 | Daimler-Benz Aerospace Ag | Triaxially stabilized, earth-oriented satellite and corresponding sun and earth acquisition process using a magnetometer |
CN103092209A (zh) * | 2013-01-30 | 2013-05-08 | 北京控制工程研究所 | 一种基于动量轮控制的全姿态捕获方法 |
CN104097793A (zh) * | 2014-06-24 | 2014-10-15 | 上海微小卫星工程中心 | 一种卫星零动量磁控太阳捕获装置及方法 |
CN104326093A (zh) * | 2014-11-26 | 2015-02-04 | 哈尔滨工业大学 | 光学成像小卫星姿态控制系统及工作模式在轨切换方法 |
-
2016
- 2016-06-07 CN CN201610414531.4A patent/CN105905317B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06127491A (ja) * | 1992-10-16 | 1994-05-10 | Toshiba Corp | 人工衛星の姿勢制御装置 |
US5865402A (en) * | 1995-05-24 | 1999-02-02 | Daimler-Benz Aerospace Ag | Triaxially stabilized, earth-oriented satellite and corresponding sun and earth acquisition process using a magnetometer |
CN103092209A (zh) * | 2013-01-30 | 2013-05-08 | 北京控制工程研究所 | 一种基于动量轮控制的全姿态捕获方法 |
CN104097793A (zh) * | 2014-06-24 | 2014-10-15 | 上海微小卫星工程中心 | 一种卫星零动量磁控太阳捕获装置及方法 |
CN104326093A (zh) * | 2014-11-26 | 2015-02-04 | 哈尔滨工业大学 | 光学成像小卫星姿态控制系统及工作模式在轨切换方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2812876C1 (ru) * | 2023-07-07 | 2024-02-05 | Акционерное общество "Военно-промышленная корпорация "Научно-производственное объединение машиностроения" | Система астроориентации орбитального космического аппарата с обратными связями |
Also Published As
Publication number | Publication date |
---|---|
CN105905317A (zh) | 2016-08-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105905317B (zh) | 一种卫星对日定向控制系统及其控制方法 | |
CN106814746B (zh) | 一种航天器姿轨一体化反步跟踪控制方法 | |
CN107600464B (zh) | 利用星敏感器信息的飞轮控制捕获太阳及对日定向方法 | |
US4358076A (en) | Method of sun and earth acquisition for three axis stabilized satellites equipped with acquisition sensors | |
JP2847302B2 (ja) | 静止衛星のための自律軌道コントロール方法およびシステム | |
Mazal et al. | Cluster flight algorithms for disaggregated satellites | |
TWI717726B (zh) | 一種繞地衛星姿態資料融合系統及其方法 | |
CN103092209A (zh) | 一种基于动量轮控制的全姿态捕获方法 | |
Li et al. | A simple orbit-attitude coupled modelling method for large solar power satellites | |
EP3744645A1 (en) | Spacecraft attitude control strategy for reducing disturbance torques | |
CN102004491B (zh) | 一种卫星初入轨段的初始太阳捕获方法 | |
CN110304279A (zh) | 一种电推进卫星的质心在轨标定补偿方法 | |
CN112783183B (zh) | 一种太阳同步圆回归轨道的轨道规划方法 | |
Somov et al. | In-flight calibration, alignment and verification of an astroinertial attitude determination system for free-flying robots and land-survey satellites | |
CN110162069B (zh) | 一种近地轨道航天器阳光反射凝视期望姿态解析求解方法 | |
CN105740594A (zh) | 月球轨道飞行器表面红外辐射和反射辐射热流计算方法 | |
CN108427429A (zh) | 一种考虑动态指向约束的航天器视轴机动控制方法 | |
Shen et al. | Point return orbit design and characteristics analysis for manned lunar mission | |
US11338944B2 (en) | Control system for executing a safing mode sequence in a spacecraft | |
Xie et al. | Guidance, navigation, and control for spacecraft rendezvous and docking: theory and methods | |
Ito et al. | Active use of solar radiation pressure for angular momentum control of the PROCYON micro-spacecraft | |
Wu et al. | Variable structure-based decentralized relative attitude-coordinated control for satellite formation | |
Carrara et al. | Attitude determination, control and operating modes for CONASAT Cubesats | |
Jackson et al. | Design of a small space robot for on-orbit assembly missions | |
CN110466803A (zh) | 基于等倾角姿态控制的自旋稳定卫星姿态预测方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 |