CN109823571A - 一种遥感微纳卫星的多阶段姿态控制方法 - Google Patents
一种遥感微纳卫星的多阶段姿态控制方法 Download PDFInfo
- Publication number
- CN109823571A CN109823571A CN201910064067.4A CN201910064067A CN109823571A CN 109823571 A CN109823571 A CN 109823571A CN 201910064067 A CN201910064067 A CN 201910064067A CN 109823571 A CN109823571 A CN 109823571A
- Authority
- CN
- China
- Prior art keywords
- satellite
- wheel set
- momentum wheel
- attitude
- control
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 57
- 230000006340 racemization Effects 0.000 claims abstract description 5
- 239000011159 matrix material Substances 0.000 claims description 24
- 238000003384 imaging method Methods 0.000 claims description 19
- 238000009434 installation Methods 0.000 claims description 6
- 230000003287 optical effect Effects 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 3
- 230000005358 geomagnetic field Effects 0.000 claims description 2
- 230000010354 integration Effects 0.000 claims description 2
- 238000004804 winding Methods 0.000 claims description 2
- 238000000926 separation method Methods 0.000 abstract 2
- 108091092878 Microsatellite Proteins 0.000 description 2
- 230000036544 posture Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种遥感微纳卫星的多阶段姿态控制方法,属于航天器姿态控制技术领域。本发明方法以三轴磁力矩器和动量轮组作为姿态控制执行部件,设计了星箭分离后的消旋、对日捕获、对日定向、对地遥感四个主要阶段的姿态控制方法,以及对日定向和对地遥感两阶段间姿态机动的控制方法。消旋阶段消除星箭分离后卫星较大的角速率,建立起了基本受控的姿态;对日捕获及对日定向阶段保证了太阳帆板长期处于充电状态;对地遥感阶段确保了遥感拍照任务的完成。本发明方法以传统PD控制为基础,结合前馈控制,利用四元数表示姿态误差,具有卫星机动响应快,稳态时鲁棒性强、控制精度高的优点,满足了遥感微纳卫星的任务需求。
Description
技术领域
本发明涉及一种遥感微纳卫星的多阶段姿态控制方法,属于航天器姿态控制技术领域。
背景技术
对于作为遥感载荷平台的卫星而言,在非遥感成像任务期间,需要保持太阳帆板稳定对日以保证星上能源供应;在遥感成像任务期间,为获得高分辨率的遥感图像,需要在保持高精度稳定的卫星姿态;同时,由于遥感成像任务时间相对短,卫星需要具有姿态快速机动的能力以在不同任务时期进行姿态转换。因此,对卫星进行准确的姿态控制是十分有必要的。
2005年,余勇等研究者提出了一种主动磁控为主的微小卫星姿态控制方法。该方法以磁力矩器主动磁控为主,结合重力梯度杆与动量轮偏置稳定的控制系统进行姿态稳定控制。2013年,王梦赑等研究者提出了一种基于模糊自适应PI控制器的微纳卫星飞行姿态控制方法。该方法使用模糊自适应PI控制器发送脉冲控制信号,控制飞轮速度,进而达到控制卫星飞行姿态。2016年,刘勇等研究者提出了一种皮纳卫星的姿态控制方法。这种方法基于PD控制设计控制器,仅使用磁力矩器完成对皮纳卫星进行姿态控制,是一种简便但精度有限的控制方法。
上述现有微小卫星姿态控制方法中,均未考虑卫星在不同阶段控制方法的不同,以及各阶段间机动过程的控制方法,且都仅采用了一种姿态控制执行部件的控制策略,未考虑多个姿态控制执行部件间的协同工作。对于面向遥感应用的微纳卫星而言,整个飞行期间会根据任务需要处于不同姿态阶段。这就需要对不同姿态阶段设计不同的姿态控制方法,并选择合适的姿态控制执行部件单独或协同控制卫星姿态,以满足不同阶段的卫星姿态控制需求。
发明内容
本发明的目的是为克服已有技术的不足之处,提出一种遥感微纳卫星的多阶段姿态控制方法。本发明使遥感微纳卫星的姿态控制可以实现低功耗、低成本、轻型化且具有一定鲁棒性,同时能为遥感成像任务下卫星姿态控制提供一定精度的姿态数据。
本发明提出一种遥感微纳卫星的多阶段姿态控制方法,包括以下步骤:
(1)消旋阶段;
(1-1)实时获取卫星三轴角速率,将卫星三轴角速率作为偏差,采用PD控制方法,得到三轴磁力矩器目标输出力矩eMT:
其中,为卫星三轴角速率,Ixyz为卫星转动惯量矩阵,k1T为第一三轴磁力矩器比例系数;
(1-2)以三轴磁力矩器为控制部件,将步骤(1-1)计算得的目标输出力矩,转化为三轴磁力矩器的控制量,形成控制指令,驱动三轴磁力矩器进行卫星三轴角速率的阻尼,作为消旋阶段的姿态控制方式;
当卫星三轴角速率保持在设定角速率值以内的时间达到设定的第一时间阈值时,消旋阶段结束,进入步骤(2)对日捕获阶段;
(2)对日捕获阶段;
(2-1)启动动量轮组达到设定的额定转速,动量轮组启动期间采用消旋阶段的姿态控制方式;
(2-2)当动量轮组达到额定转速并保持稳定后,利用动量轮组驱动卫星以设定的搜索角速率ωc,按照绕X轴、绕Z轴、绕XZ轴和绕﹣XZ轴的顺序,依次分别旋转一圈,以搜寻太阳矢量;
当卫星旋转时,实时获取卫星三轴角速率,将卫星三轴角速率作为偏差,采用PD控制方法,得到卫星绕不同轴旋转时动量轮组的目标输出力矩eMW:
当卫星绕X轴旋转时,计算表达式如下:
eMW=-kd1WIxyz[ωbix -ωc ωbiy ωbiz]T
当卫星绕Z轴旋转时,计算表达式如下:
eMW=-kd1WIxyz[ωbix ωbiy ωbiz -ωc]T
当卫星绕XZ轴旋转时,计算表达式如下:
当卫星绕XZ轴旋转时,计算表达式如下:
其中,ωbix为卫星X轴角速率,ωbiy为卫星Y轴角速率,ωbiz为卫星Z轴角速率,kd1W为第一动量轮组微分系数;
(2-3)将步骤(2-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量,转化为控制指令,驱动卫星以设定角速率旋转搜寻太阳矢量;当搜寻到太阳矢量时,卫星停止旋转,进入步骤(2-4);
(2-4)以太阳敏感器量测得卫星本体系中的太阳矢量与太阳敏感器光轴矢量进行叉乘作为偏差,结合实时的卫星三轴角速率采用PD控制方法,得到动量轮组目标输出力矩eMW:
其中,kp2W为第二动量轮组比例系数、kd2W为第二动量轮组微分系数;
(2-5)将步骤(2-4)计算得的目标输出力矩,结合动量轮组的转动惯量,计算出动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态,使太阳敏感器光轴对日,结束对日捕获阶段,进入步骤(3)对日定向阶段;
(3)对日定向阶段;
(3-1)实时获取卫星姿态和三轴角速率;根据卫星太阳帆板法向量和卫星当前位置轨道系下的太阳矢量,结合卫星姿态和三轴角速率,计算出卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对于期望姿态的角速率其中,将卫星帆板稳定对日、卫星剩余两个自由度为最小转角的状态作为卫星的期望姿态;
(3-2)将Qbd和作为偏差量,采用PD控制方法,结合前馈补偿项得到动量轮组目标输出力矩eMW:
其中,03×1为3×1的零矩阵,I3为3×3单位矩阵,h为动量轮组的转动惯量,kp3W为第三动量轮组比例系数、kd3W为第三动量轮组微分系数;
(3-3)将步骤(3-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量并转化为控制指令,驱动动量轮组控制卫星调整姿态,使卫星帆板稳定对日,直到卫星接收到遥感成像命令后,进入步骤(4)对日定向到对地遥感机动阶段;
(4)对日定向到对地遥感机动阶段;
(4-1)实时获取卫星姿态四元数Qbo和三轴角速率结合卫星中遥感相机安装矩阵、偏流角和侧摆角,计算卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对期望姿态的角速率
(4-2)对步骤(4-1)计算得的姿态四元数Qbd的标部分量qbd0进行判定并更新动量轮组目标输出力矩:
若arccos(qbd0)大于设定角度α,则更新动量轮组目标输出力矩为:
若0.1°<arccos(qbd0)≤α,则更新动量轮组目标输出力矩为:
若arccos(qbd0)≤0.1°,则更新动量轮组目标输出力矩为:
其中,ωmax为设定的卫星最大可机动角速度,qbd为姿态四元数Qbd的矢部分量,kd4W为第四动量轮组比例系数系数,kp5W为第五动量轮组比例系数,kd5W为第五动量轮组微分系数;
(4-3)将步骤(4-2)计算得到的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态;
当卫星姿态保持在arccos(qbd0)≤0.1°的时间达到设定的第二时间阈值时,进入步骤(5)对地遥感阶段;
(5)对地遥感阶段;
(5-1)实时获取卫星姿态四元数Qbo和三轴角速率结合卫星中遥感相机安装矩阵、偏流角和侧摆角,计算卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对期望姿态的角速率
(5-2)以步骤(5-1)计算得的Qbd和作为偏差量,采用PD控制方法,结合前馈补偿项得到动量轮组目标输出力矩eMW:
其中,kp5W为第五动量轮组比例系数,kd5W为第五动量轮组微分系数;
(5-3)将步骤(5-2)计算得到的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态,使卫星遥感相机稳定对地成像,当卫星完成遥感成像后,进入步骤(6)对地遥感成像到对日定向机动阶段;
(6)对地遥感成像到对日定向机动阶段;
(6-1)实时获取卫星姿态四元数Qbo和三轴角速率结合卫星太阳帆板法向量,卫星当前位置轨道系下的太阳矢量,计算卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对于期望姿态的角速率
(6-2)对步骤(6-1)计算得的姿态四元数Qbd的标量分量qbd0进行判定并更新动量轮组目标输出力矩:
若arccos(qbd0)大于设定角度β,则更新动量轮组目标输出力矩为:
若0.1°<arccos(qbd0)≤β,则更新动量轮组目标输出力矩为:
若arccos(qbd0)≤0.1°,则更新动量轮组目标输出力矩为:
其中,kp3W为第三动量轮组比例系数,kd3W为第三动量轮组微分系数,kd6W为第六动量轮组微分系数;
(6-3)将步骤(6-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态;
当卫星姿态保持在arccos(qbd0)≤0.1°的时间达到设定的第三时间阈值时,重新返回步骤(3)对日定向阶段。
本发明的特点及有益效果在于:
本发明方法在遥感微纳卫星的不同任务阶段提出了不同的姿态控制方法,及各阶段间机动过程的控制方法,满足了遥感微纳卫星各阶段的姿态控制需求。本方法以传统PD控制为基础,利用四元数姿态偏差信息和角速度偏差信息,结合前馈控制,使得卫星机动响应快,在稳态阶段控制鲁棒性强、精度高。本方法结合了三轴磁力矩器和动量轮组两种不同的执行部件的特点进行姿态控制,在需要长时间同方向力矩输出时,使用三轴磁力矩器进行控制;在高精度稳定控制阶段使用动量轮组进行控制,利用三轴磁力矩器进行动量轮的卸载,保证了各姿态执行部件的长时间稳定工作。
附图说明
图1是本发明方法的整体流程图。
具体实施方式
本发明提出一种遥感微纳卫星的多阶段姿态控制方法,下面结合附图和具体实施例进一步详细说明如下。
在本发明方法的一个实施例中,设定微纳卫星的整星质量为38.5kg,三轴转动惯量为X轴1.43kg·m2;Y轴1.76kg·m2;Z轴2.43kg·m2。设定遥感成像相机的镜头指向与卫星星体Z轴同向。姿态执行部件中,动量轮组为三个正装三轴集成动量轮和一个斜装动量轮,各轴转动惯量均为1.1318×10-4kg·m2,最高转速大于7000rpm,转速控制误差小于3rpm(3σ),最大输出力矩大于2mNm;磁力矩器可提供的三轴磁矩均大于2.5Am2。微纳卫星三轴初始角速率为[-3.5,-3.5,-3.5]°/s,初始姿态三轴欧拉角为[160,20,60]°。
本发明提出一种遥感微纳卫星的多阶段姿态控制方法,整体流程如图1所示,包括以下步骤:
(1)消旋阶段;
卫星与运载火箭分离,星载系统开机自检和初始化完成后,将首先自主进入该阶段。
(1-1)利用卫星姿态确定模块实时获取卫星三轴角速率;
将卫星三轴角速率作为偏差,采用PD控制方法,得到三轴磁力矩器目标输出力矩eMT:
其中,为卫星三轴角速率,Ixyz为卫星转动惯量矩阵,k1T为第一三轴磁力矩器比例系数。
(1-2)以三轴磁力矩器为控制部件,将步骤(1-1)计算得的目标输出力矩,转化为三轴磁力矩器的控制量,形成控制指令,驱动三轴磁力矩器进行卫星三轴角速率的阻尼,作为消旋阶段的姿态控制方式。
当卫星三轴角速率保持在设定角速率值(常规取值为1°/s)以内的时间达到设定的第一时间阈值(常规取值为100s至200s),消旋阶段结束,进入步骤(2)对日捕获阶段。
(2)对日捕获阶段;
(2-1)启动动量轮组达到设定的额定转速。动量轮组启动期间采用消旋阶段的姿态控制方式,保持卫星三轴角速率的稳定。
(2-2)当动量轮组达到额定转速并保持稳定后,利用动量轮组驱动卫星以设定的搜索角速率ωc,按照绕X轴、绕Z轴、绕XZ轴和绕﹣XZ轴的顺序,依次分别旋转一圈,以搜寻太阳矢量。
当卫星旋转时,利用卫星姿态确定模块实时获取卫星三轴角速率,,将卫星三轴角速率作为偏差,采用PD控制方法,得到卫星绕不同轴旋转时动量轮组的目标输出力矩eMW:
当卫星绕X轴旋转时,计算表达式如下:
eMW=-kd1WIxyz[ωbix -ωc ωbiy ωbiz]T
当卫星绕Z轴旋转时,计算表达式如下:
eMW=-kd1WIxyz[ωbix ωbiy ωbiz -ωc]T
当卫星绕XZ轴旋转时,计算表达式如下:
当卫星绕XZ轴旋转时,计算表达式如下:
其中,ωc为搜索角速率,[ωbix ωbiy ωbiz]T为卫星三轴角速率向量(ωbix为卫星X轴角速率,ωbiy为卫星Y轴角速率,ωbiz为卫星Z轴角速率),Ixyz为卫星转动惯量矩阵,kd1W为第一动量轮组微分系数。
(2-3)将步骤(2-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算出动量轮组控制量并转化为控制指令,驱动卫星以设定角速率旋转搜寻太阳矢量。此期间,以太阳敏感器的有效输出作为搜寻中断标志,一旦搜寻到太阳矢量后,卫星即停止旋转,进入步骤(2-4)。
(2-4)以太阳敏感器量测得卫星本体系中的太阳矢量与太阳敏感器光轴矢量进行叉乘作为偏差,结合实时的卫星三轴角速率采用PD控制方法,得到动量轮组目标输出力矩eMW:
其中,Ixyz为卫星转动惯量矩阵,kp2W为第二动量轮组比例系数、kd2W为第二动量轮组微分系数。
(2-5)将步骤(2-4)计算得的目标输出力矩,结合动量轮组的转动惯量,计算出动量轮组控制量并转化为控制指令,驱动动量轮组控制卫星调整姿态,使太阳敏感器光轴对日,结束对日捕获阶段,进入步骤(3)对日定向阶段。
(2-6)在此阶段,实时检测卫星动量轮组转速,若动量轮组转速与额定转速差值达到设定转速差阈值,则利用三轴磁力矩器进行动量轮组角动量的卸载,具体方法如下:
以动量轮组当前时刻的转速和额定转速之差为偏差量,采用PD控制方法,得到三轴磁力矩器目标输出力矩,表达式如下:
eMT=-k2T(Ωmw-Ωrate), (1)
其中,eMT表示三轴磁力矩器目标输出力矩,Ωmw为动量轮组当前时刻的转速,Ωrate为额定转速,k2T为第二三轴磁力矩器比例系数。
将式(1)计算得的三轴磁力矩器目标输出力矩,结合三轴磁强计测量的地磁场,计算三轴磁力矩器的控制量并转化为对应的控制指令,驱动三轴磁力矩器进行动量轮组角动量的卸载。
步骤(2-6)存在于动量轮启动完成后的整个对日捕获阶段,以保证动量轮组的实时转速不超过设定的上限值。
(3)对日定向阶段;
在该阶段,将卫星帆板稳定对日,卫星剩余两个自由度为最小转角保持状态作为期望姿态。
(3-1)利用卫星姿态确定模块实时获取卫星姿态和三轴角速率。
根据卫星太阳帆板法向量,和卫星当前位置轨道系下的太阳矢量,结合卫星姿态和三轴角速率,计算出卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对于期望姿态的角速率
(3-2)将Qbd和作为偏差量,采用PD控制方法,结合前馈补偿项得到动量轮组目标输出力矩eMW:
其中,03×1为3×1的零矩阵,I3为3×3单位矩阵,为卫星三轴角速率,Ixyz为卫星转动惯量矩阵,h为动量轮组的转动惯量,kp3W为第三动量轮组比例系数、kd3W为第三动量轮组微分系数。
(3-3)将步骤(3-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算出动量轮组控制量并转化为控制指令,驱动动量轮组控制卫星调整姿态,使卫星帆板稳定对日,直到卫星接收到遥感成像命令后,进入步骤(4)对日定向到对地遥感机动阶段。
(3-4)在此阶段,重复步骤(2-6),实时检测卫星动量轮组转速,若动量轮组转速与额定转速差值达到转速差阈值,则利用三轴磁力矩器进行动量轮组角动量的卸载。
步骤(3-4)存在于整个对日定向阶段,以保证动量轮组的实时转速不超过设定的上限值。
(4)对日定向到对地遥感机动阶段;
当卫星收到遥感成像命令后,需经过该机动阶段进入对地遥感成像阶段。在该阶段,将卫星遥感相机稳定对地,卫星剩余两个自由度为最小转角保持状态作为期望姿态。
(4-1)利用卫星姿态确定模块实时获取卫星姿态四元数Qbo和三轴角速率结合卫星中遥感相机安装矩阵、偏流角和侧摆角,计算卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对期望姿态的角速率
(4-2)根据步骤(4-1)计算得的姿态四元数Qbd的标部分量qbd0进行判断:
若arccos(qbd0)大于设定角度α,则卫星当前姿态与期望姿态偏差较大,需进行快速机动,更新动量轮组目标输出力矩为:
若0.1°<arccos(qbd0)≤α,则卫星需减缓机动速度,更新动量轮组目标输出力矩为:
若arccos(qbd0)≤0.1°,则进行卫星姿态稳定控制,动量轮组目标输出力矩为:
其中,eMW表示动量轮组目标输出力矩,ωmax为设定的卫星最大可机动角速度,qbd为姿态四元数Qbd的矢部分量,Ixyz为卫星转动惯量矩阵,I3为3×3单位矩阵,h为动量轮组的转动惯量,kd4W为第四动量轮组比例系数,kp5W为第五动量轮组比例系数,kd5W为第五动量轮组微分系数。
(4-3)将步骤(4-2)更新后的目标输出力矩,结合动量轮组的转动惯量,计算出动量轮组控制量并转化为控制指令,驱动动量轮组控制卫星调整姿态。
当卫星姿态保持在arccos(qbd0)≤0.1°的情况超过一定时间(第二时间阈值,常规取值为50s至100s)后,卫星完成机动过程,进入步骤(5)对地遥感阶段。
(5)对地遥感阶段;
在该阶段,将卫星遥感相机稳定对地,卫星剩余两个自由度为最小转角保持状态作为期望姿态。
(5-1)利用卫星姿态确定模块实时获取卫星姿态四元数Qbo和三轴角速率结合卫星中遥感相机安装矩阵,偏流角和侧摆角,计算卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对期望姿态的角速率
(5-2)以步骤(5-1)计算得的Qbd和作为偏差量,采用PD控制方法,结合前馈补偿项得到动量轮组目标输出力矩eMW:
其中,I3为3×3单位矩阵,Ixyz为卫星转动惯量矩阵,h为动量轮组的转动惯量,kp5W为第五动量轮组比例系数,kd5W为第五动量轮组微分系数。
(5-3)将步骤(5-2)计算得到的目标输出力矩,结合动量轮组的转动惯量,计算出动量轮组控制量并转化为控制指令,驱动动量轮组控制卫星调整姿态,使卫星遥感相机稳定对地成像,当卫星完成遥感成像后,自主进入步骤(6)。
(5-4)在此阶段,重复步骤(2-6),实时检测卫星动量轮组转速,若动量轮组转速与额定转速差值达到设定数值,则利用三轴磁力矩器进行动量轮组角动量的卸载。
步骤(5-4)存在于整个对地遥感阶段,以保证动量轮组的实时转速不超过设定的上限值。
(6)对地遥感成像到对日定向机动阶段;
当卫星收到遥感成像结束后,需自主经过该机动阶段返回对日定向阶段。在该阶段,将卫星帆板稳定对日,卫星剩余两个自由度为最小转角保持状态作为期望姿态。
(6-1)利用卫星姿态确定模块实时获取卫星姿态四元数Qbo和三轴角速率结合卫星太阳帆板法向量,卫星当前位置轨道系下的太阳矢量,计算出卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对于期望姿态的角速率
(6-2)对步骤(6-1)计算得的姿态四元数Qbd的标量分量qbd0进行判断:
若arccos(qbd0)大于设定角度β,当前姿态与期望姿态偏差较大,需进行快速机动,动量轮组目标输出力矩为:
若0.1°<arccos(qbd0)≤β,则卫星需减缓机动速度,动量轮组目标输出力矩为:
若arccos(qbd0)≤0.1°,则进行卫星姿态稳定控制,动量轮组目标输出力矩为:
其中,eMW表示动量轮组目标输出力矩,ωmax为设定的卫星最大可机动角速度,qbd为姿态四元数Qbd的矢部分量,Ixyz为卫星转动惯量矩阵,I3为3×3单位矩阵,h为动量轮组的转动惯量,kp3W为第三动量轮组比例系数,kd3W为第三动量轮组微分系数,kd6W为第六动量轮组微分系数。
(6-3)将步骤(6-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算出动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态。当卫星姿态保持在arccos(qbd0)≤0.1°的情况超过一定时间(第三时间阈值,常规取值为50s至100s)后,卫星完成机动过程,重新返回步骤(3)对日定向阶段。
Claims (2)
1.一种遥感微纳卫星的多阶段姿态控制方法,其特征在于,该方法包括以下步骤:
(1)消旋阶段;
(1-1)实时获取卫星三轴角速率,将卫星三轴角速率作为偏差,采用PD控制方法,得到三轴磁力矩器目标输出力矩eMT:
其中,为卫星三轴角速率,Ixyz为卫星转动惯量矩阵,k1T为第一三轴磁力矩器比例系数;
(1-2)以三轴磁力矩器为控制部件,将步骤(1-1)计算得的目标输出力矩,转化为三轴磁力矩器的控制量,形成控制指令,驱动三轴磁力矩器进行卫星三轴角速率的阻尼,作为消旋阶段的姿态控制方式;
当卫星三轴角速率保持在设定角速率值以内的时间达到设定的第一时间阈值时,消旋阶段结束,进入步骤(2)对日捕获阶段;
(2)对日捕获阶段;
(2-1)启动动量轮组达到设定的额定转速,动量轮组启动期间采用消旋阶段的姿态控制方式;
(2-2)当动量轮组达到额定转速并保持稳定后,利用动量轮组驱动卫星以设定的搜索角速率ωc,按照绕X轴、绕Z轴、绕XZ轴和绕﹣XZ轴的顺序,依次分别旋转一圈,以搜寻太阳矢量;
当卫星旋转时,实时获取卫星三轴角速率,将卫星三轴角速率作为偏差,采用PD控制方法,得到卫星绕不同轴旋转时动量轮组的目标输出力矩eMW:
当卫星绕X轴旋转时,计算表达式如下:
eMW=-kd1WIxyz[ωbix -ωc ωbiy ωbiz]T
当卫星绕Z轴旋转时,计算表达式如下:
eMW=-kd1WIxyz[ωbix ωbiy ωbiz -ωc]T
当卫星绕XZ轴旋转时,计算表达式如下:
当卫星绕XZ轴旋转时,计算表达式如下:
其中,ωbix为卫星X轴角速率,ωbiy为卫星Y轴角速率,ωbiz为卫星Z轴角速率,kd1W为第一动量轮组微分系数;
(2-3)将步骤(2-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量,转化为控制指令,驱动卫星以设定角速率旋转搜寻太阳矢量;当搜寻到太阳矢量时,卫星停止旋转,进入步骤(2-4);
(2-4)以太阳敏感器量测得卫星本体系中的太阳矢量与太阳敏感器光轴矢量进行叉乘作为偏差,结合实时的卫星三轴角速率采用PD控制方法,得到动量轮组目标输出力矩eMW:
其中,kp2W为第二动量轮组比例系数、kd2W为第二动量轮组微分系数;
(2-5)将步骤(2-4)计算得的目标输出力矩,结合动量轮组的转动惯量,计算出动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态,使太阳敏感器光轴对日,结束对日捕获阶段,进入步骤(3)对日定向阶段;
(3)对日定向阶段;
(3-1)实时获取卫星姿态和三轴角速率;根据卫星太阳帆板法向量和卫星当前位置轨道系下的太阳矢量,结合卫星姿态和三轴角速率,计算出卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对于期望姿态的角速率其中,将卫星帆板稳定对日、卫星剩余两个自由度为最小转角的状态作为卫星的期望姿态;
(3-2)将Qbd和作为偏差量,采用PD控制方法,结合前馈补偿项得到动量轮组目标输出力矩eMW:
其中,03×1为3×1的零矩阵,I3为3×3单位矩阵,h为动量轮组的转动惯量,kp3W为第三动量轮组比例系数、kd3W为第三动量轮组微分系数;
(3-3)将步骤(3-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量并转化为控制指令,驱动动量轮组控制卫星调整姿态,使卫星帆板稳定对日,直到卫星接收到遥感成像命令后,进入步骤(4)对日定向到对地遥感机动阶段;
(4)对日定向到对地遥感机动阶段;
(4-1)实时获取卫星姿态四元数Qbo和三轴角速率结合卫星中遥感相机安装矩阵、偏流角和侧摆角,计算卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对期望姿态的角速率
(4-2)对步骤(4-1)计算得的姿态四元数Qbd的标部分量qbd0进行判定并更新动量轮组目标输出力矩:
若arccos(qbd0)大于设定角度α,则更新动量轮组目标输出力矩为:
若0.1°<arccos(qbd0)≤α,则更新动量轮组目标输出力矩为:
若arccos(qbd0)≤0.1°,则更新动量轮组目标输出力矩为:
其中,ωmax为设定的卫星最大可机动角速度,qbd为姿态四元数Qbd的矢部分量,kd4W为第四动量轮组比例系数系数,kp5W为第五动量轮组比例系数,kd5W为第五动量轮组微分系数;
(4-3)将步骤(4-2)计算得到的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态;
当卫星姿态保持在arccos(qbd0)≤0.1°的时间达到设定的第二时间阈值时,进入步骤(5)对地遥感阶段;
(5)对地遥感阶段;
(5-1)实时获取卫星姿态四元数Qbo和三轴角速率结合卫星中遥感相机安装矩阵、偏流角和侧摆角,计算卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对期望姿态的角速率
(5-2)以步骤(5-1)计算得的Qbd和作为偏差量,采用PD控制方法,结合前馈补偿项得到动量轮组目标输出力矩eMW:
其中,kp5W为第五动量轮组比例系数,kd5W为第五动量轮组微分系数;
(5-3)将步骤(5-2)计算得到的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态,使卫星遥感相机稳定对地成像,当卫星完成遥感成像后,进入步骤(6)对地遥感成像到对日定向机动阶段;
(6)对地遥感成像到对日定向机动阶段;
(6-1)实时获取卫星姿态四元数Qbo和三轴角速率结合卫星太阳帆板法向量,卫星当前位置轨道系下的太阳矢量,计算卫星当前姿态相对于期望姿态的姿态四元数Qbd,以及卫星本体相对于期望姿态的角速率
(6-2)对步骤(6-1)计算得的姿态四元数Qbd的标量分量qbd0进行判定并更新动量轮组目标输出力矩:
若arccos(qbd0)大于设定角度β,则更新动量轮组目标输出力矩为:
若0.1°<arccos(qbd0)≤β,则更新动量轮组目标输出力矩为:
若arccos(qbd0)≤0.1°,则更新动量轮组目标输出力矩为:
其中,kp3W为第三动量轮组比例系数,kd3W为第三动量轮组微分系数,kd6W为第六动量轮组微分系数;
(6-3)将步骤(6-2)计算得的目标输出力矩,结合动量轮组的转动惯量,计算动量轮组控制量,转化为控制指令,驱动动量轮组控制卫星调整姿态;
当卫星姿态保持在arccos(qbd0)≤0.1°的时间达到设定的第三时间阈值时,重新返回步骤(3)对日定向阶段。
2.如权利要求1所述的方法,其特征在于,在对日捕获阶段、对日定向阶段和对地遥感阶段,分别包括以下步骤:
实时检测卫星动量轮组转速,若动量轮组转速与额定转速差值达到设定转速差阈值,则利用三轴磁力矩器进行动量轮组角动量的卸载,具体方法如下:
以动量轮组当前时刻的转速和额定转速之差为偏差量,采用PD控制方法,得到三轴磁力矩器目标输出力矩,表达式如下:
eMT=-k2T(Ωmw-Ωrate) (1)
其中,eMT表示三轴磁力矩器目标输出力矩,Ωmw为动量轮组当前时刻的转速,Ωrate为额定转速,k2T为第二三轴磁力矩器比例系数;
然后将式(1)计算得到的三轴磁力矩器目标输出力矩,结合三轴磁强计测量的地磁场,计算三轴磁力矩器的控制量并转化为对应的控制指令,驱动三轴磁力矩器进行动量轮组角动量的卸载。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910064067.4A CN109823571B (zh) | 2019-01-23 | 2019-01-23 | 一种遥感微纳卫星的多阶段姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910064067.4A CN109823571B (zh) | 2019-01-23 | 2019-01-23 | 一种遥感微纳卫星的多阶段姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109823571A true CN109823571A (zh) | 2019-05-31 |
CN109823571B CN109823571B (zh) | 2020-07-03 |
Family
ID=66862141
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910064067.4A Active CN109823571B (zh) | 2019-01-23 | 2019-01-23 | 一种遥感微纳卫星的多阶段姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109823571B (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110395411A (zh) * | 2019-08-13 | 2019-11-01 | 中国科学院微小卫星创新研究院 | 一种低轨遥感微纳卫星及其热设计方法 |
CN110816897A (zh) * | 2019-10-31 | 2020-02-21 | 北京控制工程研究所 | 一种基于cmg系统的多模式转换控制方法 |
CN111056045A (zh) * | 2019-12-26 | 2020-04-24 | 航天行云科技有限公司 | 一种三轴磁力矩器的控制方法以及装置 |
CN111332501A (zh) * | 2020-02-26 | 2020-06-26 | 上海航天控制技术研究所 | 一种卫星姿态控制系统的多控制多基准的设计方法 |
CN111483618A (zh) * | 2020-04-09 | 2020-08-04 | 上海航天控制技术研究所 | 一种适用于火星探测的多指向驱动任务自主管理控制方法 |
CN111532456A (zh) * | 2020-05-15 | 2020-08-14 | 清华大学 | 一种控制方法和装置 |
CN111688952A (zh) * | 2020-05-21 | 2020-09-22 | 清华大学 | 一种卫星姿态控制系统 |
CN112052599A (zh) * | 2020-09-14 | 2020-12-08 | 中国科学院微小卫星创新研究院 | 提高高分辨率光学遥感相机的成像质量方法 |
CN112061424A (zh) * | 2020-07-16 | 2020-12-11 | 北京控制工程研究所 | 一种基于融合目标姿态的机动过程能源角动态跟踪方法 |
CN112504235A (zh) * | 2020-11-16 | 2021-03-16 | 长光卫星技术有限公司 | 一种小卫星在轨自主成像方法 |
CN112849433A (zh) * | 2020-11-26 | 2021-05-28 | 上海航天控制技术研究所 | 一种卫星大惯量转动部件的不平衡幅值与相位的在轨调试方法 |
CN114139275A (zh) * | 2021-10-29 | 2022-03-04 | 浙江时空道宇科技有限公司 | Sada转角计算方法及系统 |
CN115140318A (zh) * | 2022-07-20 | 2022-10-04 | 南京理工大学 | 一种适用于微纳卫星大角速率消旋的磁阻尼控制方法 |
CN115817856A (zh) * | 2022-11-21 | 2023-03-21 | 清华大学 | 基于纯磁控方式的卫星对日自旋稳定姿态控制方法及装置 |
CN116395148A (zh) * | 2023-03-20 | 2023-07-07 | 银河航天(北京)网络技术有限公司 | 一种星箭分离控制系统及控制方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101934863A (zh) * | 2010-09-29 | 2011-01-05 | 哈尔滨工业大学 | 基于磁力矩器和飞轮的卫星姿态全方位控制方法 |
WO2011076260A1 (en) * | 2009-12-22 | 2011-06-30 | Nokia Corporation | Positioning satellites |
CN103241390A (zh) * | 2013-05-30 | 2013-08-14 | 清华大学 | 微纳卫星飞行姿态控制装置及方法 |
CN105667838A (zh) * | 2016-03-14 | 2016-06-15 | 西北工业大学 | 一种皮纳卫星的模块化姿态确定与控制装置及其方法 |
CN108945526A (zh) * | 2018-07-23 | 2018-12-07 | 北京航空航天大学 | 一种失效卫星的消旋控制方法及系统 |
CN109018441A (zh) * | 2018-09-13 | 2018-12-18 | 上海航天控制技术研究所 | 一种卫星任意姿态机动过程偏流角跟踪控制方法 |
CN109164822A (zh) * | 2018-09-26 | 2019-01-08 | 北京航空航天大学 | 一种基于具有混合执行机构的航天器姿态控制方法 |
-
2019
- 2019-01-23 CN CN201910064067.4A patent/CN109823571B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011076260A1 (en) * | 2009-12-22 | 2011-06-30 | Nokia Corporation | Positioning satellites |
CN101934863A (zh) * | 2010-09-29 | 2011-01-05 | 哈尔滨工业大学 | 基于磁力矩器和飞轮的卫星姿态全方位控制方法 |
CN103241390A (zh) * | 2013-05-30 | 2013-08-14 | 清华大学 | 微纳卫星飞行姿态控制装置及方法 |
CN105667838A (zh) * | 2016-03-14 | 2016-06-15 | 西北工业大学 | 一种皮纳卫星的模块化姿态确定与控制装置及其方法 |
CN108945526A (zh) * | 2018-07-23 | 2018-12-07 | 北京航空航天大学 | 一种失效卫星的消旋控制方法及系统 |
CN109018441A (zh) * | 2018-09-13 | 2018-12-18 | 上海航天控制技术研究所 | 一种卫星任意姿态机动过程偏流角跟踪控制方法 |
CN109164822A (zh) * | 2018-09-26 | 2019-01-08 | 北京航空航天大学 | 一种基于具有混合执行机构的航天器姿态控制方法 |
Non-Patent Citations (2)
Title |
---|
王光辉等: "纯磁控微小卫星姿态控制方法研究", 《计算机仿真》 * |
袁斌文等: "采用观测器的偏置动量小卫星姿态容错控制", 《宇航学报》 * |
Cited By (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110395411A (zh) * | 2019-08-13 | 2019-11-01 | 中国科学院微小卫星创新研究院 | 一种低轨遥感微纳卫星及其热设计方法 |
CN110816897A (zh) * | 2019-10-31 | 2020-02-21 | 北京控制工程研究所 | 一种基于cmg系统的多模式转换控制方法 |
CN111056045B (zh) * | 2019-12-26 | 2021-03-23 | 航天行云科技有限公司 | 一种三轴磁力矩器的控制方法以及装置 |
CN111056045A (zh) * | 2019-12-26 | 2020-04-24 | 航天行云科技有限公司 | 一种三轴磁力矩器的控制方法以及装置 |
CN111332501A (zh) * | 2020-02-26 | 2020-06-26 | 上海航天控制技术研究所 | 一种卫星姿态控制系统的多控制多基准的设计方法 |
CN111332501B (zh) * | 2020-02-26 | 2021-08-10 | 上海航天控制技术研究所 | 一种卫星姿态控制系统的多控制多基准的设计方法 |
CN111483618A (zh) * | 2020-04-09 | 2020-08-04 | 上海航天控制技术研究所 | 一种适用于火星探测的多指向驱动任务自主管理控制方法 |
CN111483618B (zh) * | 2020-04-09 | 2021-10-01 | 上海航天控制技术研究所 | 一种适用于火星探测的多指向驱动任务自主管理控制方法 |
CN111532456A (zh) * | 2020-05-15 | 2020-08-14 | 清华大学 | 一种控制方法和装置 |
CN111532456B (zh) * | 2020-05-15 | 2021-11-12 | 清华大学 | 一种控制方法和装置 |
CN111688952A (zh) * | 2020-05-21 | 2020-09-22 | 清华大学 | 一种卫星姿态控制系统 |
CN111688952B (zh) * | 2020-05-21 | 2021-11-23 | 清华大学 | 一种卫星姿态控制系统 |
CN112061424A (zh) * | 2020-07-16 | 2020-12-11 | 北京控制工程研究所 | 一种基于融合目标姿态的机动过程能源角动态跟踪方法 |
CN112052599A (zh) * | 2020-09-14 | 2020-12-08 | 中国科学院微小卫星创新研究院 | 提高高分辨率光学遥感相机的成像质量方法 |
CN112052599B (zh) * | 2020-09-14 | 2024-03-29 | 中国科学院微小卫星创新研究院 | 提高高分辨率光学遥感相机的成像质量方法 |
CN112504235A (zh) * | 2020-11-16 | 2021-03-16 | 长光卫星技术有限公司 | 一种小卫星在轨自主成像方法 |
CN112849433A (zh) * | 2020-11-26 | 2021-05-28 | 上海航天控制技术研究所 | 一种卫星大惯量转动部件的不平衡幅值与相位的在轨调试方法 |
CN112849433B (zh) * | 2020-11-26 | 2022-11-22 | 上海航天控制技术研究所 | 一种卫星大惯量转动部件的不平衡幅值与相位的在轨调试方法 |
CN114139275A (zh) * | 2021-10-29 | 2022-03-04 | 浙江时空道宇科技有限公司 | Sada转角计算方法及系统 |
CN115140318A (zh) * | 2022-07-20 | 2022-10-04 | 南京理工大学 | 一种适用于微纳卫星大角速率消旋的磁阻尼控制方法 |
CN115817856A (zh) * | 2022-11-21 | 2023-03-21 | 清华大学 | 基于纯磁控方式的卫星对日自旋稳定姿态控制方法及装置 |
CN116395148A (zh) * | 2023-03-20 | 2023-07-07 | 银河航天(北京)网络技术有限公司 | 一种星箭分离控制系统及控制方法 |
CN116395148B (zh) * | 2023-03-20 | 2023-09-15 | 银河航天(北京)网络技术有限公司 | 一种星箭分离控制系统及控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109823571B (zh) | 2020-07-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109823571B (zh) | 一种遥感微纳卫星的多阶段姿态控制方法 | |
CN104527994B (zh) | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 | |
AU639504B2 (en) | Satellite roll and yaw attitude control method | |
CN111688952B (zh) | 一种卫星姿态控制系统 | |
CN109911249B (zh) | 低推重比飞行器的星际转移有限推力入轨迭代制导方法 | |
JPH06510499A (ja) | 地球を指向する3軸安定化衛星および付属する太陽と地球を捕捉する方法 | |
US9988162B2 (en) | Method and device for control of a sunlight acquisition phase of a spacecraft | |
US5458300A (en) | Method for controlling the attitude of a satellite aimed towards a celestial object and a satellite suitable for implementing it | |
CN111897357A (zh) | 一种卫星对地扫描的姿态跟踪控制方法 | |
CN111605737B (zh) | 一种航天器三超控制多级协同规划与敏捷机动方法 | |
CN112572835B (zh) | 一种具有姿态切换的卫星在轨角动量管理及控制方法 | |
CN114889849A (zh) | 一种航天器多约束飞越最优速度的估计方法 | |
JP2021011257A (ja) | 結合された天文座標系の非線形モデル予測制御 | |
JP2023514545A (ja) | 太陽エネルギーを追跡するシステム | |
Deng et al. | Flexible attitude control design and on-orbit performance of the ZDPS-2 satellite | |
CN109445448B (zh) | 一种轮控小卫星自适应积分滑模姿态控制器 | |
CN114684389A (zh) | 考虑再入约束的月地转移窗口及精确转移轨道确定方法 | |
CN110955255B (zh) | 基于cmg的高精度轨控姿态维持方法、系统及介质 | |
Lavezzi et al. | Attitude control strategies for an imaging cubesat | |
CN114019794B (zh) | 一种固定轨位电推分时卸载的整轨角动量估计和管理方法 | |
Johnston-Lemke et al. | Arc-minute attitude stability on a nanosatellite: enabling stellar photometry on the smallest scale | |
Steyn | A dual-wheel multi-mode spacecraft actuator for near-minimum-time large angle slew maneuvers | |
RU2702932C1 (ru) | Способ динамичной высокоточной ориентации и стабилизации космического аппарата | |
Hao et al. | A practical rapid attitude maneuver control system using control moment gyros for microsatellite tsubame | |
Somova | Guidance and economical digital control of a satellite orientation in initial modes |
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 |