CN107402516A - 基于联合执行机构的递阶饱和模糊pd姿态控制方法 - Google Patents
基于联合执行机构的递阶饱和模糊pd姿态控制方法 Download PDFInfo
- Publication number
- CN107402516A CN107402516A CN201710480273.4A CN201710480273A CN107402516A CN 107402516 A CN107402516 A CN 107402516A CN 201710480273 A CN201710480273 A CN 201710480273A CN 107402516 A CN107402516 A CN 107402516A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- attitude
- mtr
- 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 33
- 239000011159 matrix material Substances 0.000 claims description 21
- 230000008859 change Effects 0.000 claims description 5
- 238000009434 installation Methods 0.000 claims description 5
- 239000000203 mixture Substances 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 3
- 230000009471 action Effects 0.000 claims description 2
- 230000014509 gene expression Effects 0.000 claims 2
- 230000004044 response Effects 0.000 abstract description 3
- 230000033228 biological regulation Effects 0.000 description 4
- 238000004088 simulation Methods 0.000 description 4
- 108091092878 Microsatellite Proteins 0.000 description 3
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000009514 concussion Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Artificial Intelligence (AREA)
- Radar, Positioning & Navigation (AREA)
- Combustion & Propulsion (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Chemical & Material Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于联合执行机构的递阶饱和模糊PD姿态控制方法,根据姿态四元数以及目标四元数得到姿态误差四元数;根据测得的角速度设计第一模糊控制增益;根据姿态角误差设计第二模糊控制增益;根据相应模糊控制规则、两个模糊控制增益在线调整PD姿态控制律的比例增益和微分增益;计算输出力矩;分别通过姿态动力学方程和姿态运动学方程求解星体的实际角速度与更新后的反馈实时姿态四元数。本发明设计递阶饱和模糊PD控制器具有出色的鲁棒性,控制器的设计十分灵活,实现PD姿态控制律的比例增益和微分增益由模糊逻辑***根据实时的姿态误差在线整定,解决了单一递阶饱和PD控制器响应速度慢、***超调量大,甚至引起***震荡的问题。
Description
技术领域
本发明属于卫星姿态控制技术领域,尤其涉及一种基于联合执行机构的递阶饱和模糊PD控制器的控制方法。
背景技术
随着航天飞行任务复杂程度的提高,微小卫星姿态控制***对实现大角度姿态机动的快速性及稳定性有着较高的要求。当星体在大角度姿态调节的过程中,须考虑卫星执行机构最大输出力矩以及转速陀螺测量精度限制的问题,因此现有技术采用递阶饱和控制律,但是当其与单一PD控制律结合时,会出现星体在姿态调节过程中的加速段响应时间较长、滑行段姿态角速度饱和时间较长及减速段较缓慢等问题,这些问题促使星体姿态调节过程时间增加,导致***消耗推力器介质质量增加,因此也增加了实验成本。
发明内容
发明目的:针对大角度快速机动的敏捷卫星,既可以实现大角度姿态机动的快速性及稳定性,又可以缩短姿态调节时间,本发明提供一种基于联合执行机构的递阶饱和模糊PD姿态控制方法。
技术方案:一种基于联合执行机构的递阶饱和模糊PD姿态控制方法,包括以下步骤:
步骤一:使用卫星姿态敏感器检测姿态四元数,设姿态四元数为Q;提供目标四元数QT;根据所述姿态四元数Q以及目标四元数QT得到姿态误差四元数Qe;
步骤二:在所述模糊逻辑控制器中设定姿态角速度的最大阈值;使用卫星姿态敏感器检测姿态角速度ω。根据测得的姿态角速度ω设计第一模糊控制增益K1, K1为姿态角速度的最大阈值与实际测得姿态角速度ω最大值的比值;
步骤三:根据步骤一获得的姿态角误差Qe设计第二模糊控制增益K2,K2为姿态角速度的最大阈值与实际测得姿态角误差Qe最大值的比值;
步骤四:选择使用二维模糊逻辑控制器,并设定模糊控制规则;所述姿态误差四元数Qe和姿态角速度ω分别通过第一模糊控制增益K1和第二模糊控制增益 K2输入到模糊控制器中;模糊控制器输出得到PD姿态控制律的比例增益Kp和微分增益Kd;
步骤五:设输出力矩为T,根据姿态误差四元数Qe、姿态角速度ω、实时变化的比例增益Kp和微分增益Kd计算T:
T=satσ[KdJω+KpJsatσ(Qe)-ω×(Jbω+CJwΩ]+Au
式中,J为转动惯量;Jw为飞轮转动惯量组成的对角阵;Jb为整星转动惯量;A为冷力推力器安装矩阵;u为冷力推力器产生推力的大小;C为飞轮的安装矩阵;Ω为飞轮角速度相对于本体坐标系构成的矩阵;
步骤六:对步骤五所述的输出力矩T进行分配力矩,计算实际控制力矩,分别通过姿态动力学方程和姿态运动学方程求解星体的实际角速度ω′与更新后的反馈实时姿态四元数Q′,然后将Q′作为步骤一中的Q、ω′作为步骤二中的ω循环操作步骤一至步骤六。
有益效果:本发明提供一种基于联合执行机构的递阶饱和模糊PD姿态控制方法,基于欧拉轴转动的递阶饱和模糊PD姿态控制方法,对输出力矩进行分配,同时采用喷气推力器和反作用飞轮作为联合执行机构为微小卫星姿态机动提供大且精确的控制力矩。相比较现有技术,本发明所设计的递阶饱和模糊PD控制器具有出色的鲁棒性,控制器的设计十分灵活,实现PD姿态控制律的比例增益和微分增益由模糊逻辑***根据实时的姿态误差在线整定,解决了单一递阶饱和 PD控制器响应速度慢、***超调量大的问题,甚至引起***震荡的问题。本发明可广泛应用于航天器的控制***。
附图说明
图1为基于联合执行机构的递阶饱和模糊PD姿态控制方法的控制流程图;
图2为递阶饱和PD控制方法的三轴力矩输出曲线;
图3为递阶饱和PD控制方法的三轴角速度变化输出曲线;
图4为递阶饱和PD控制方法的三轴角度变化输出曲线;
图5为递阶饱和PD控制方法的姿态角度误差输出曲线;
图6为递阶饱和模糊PD控制方法的在线整定Kp值输出曲线;
图7为递阶饱和模糊PD控制方法的在线整定Kd值输出曲线;
图8为递阶饱和模糊PD控制方法的三轴力矩输出曲线;
图9为递阶饱和模糊PD控制方法的三轴角速度输出曲线;
图10为递阶饱和模糊PD控制方法的***角度输出曲线;
图11为递阶饱和模糊PD控制方法的姿态角度误差输出曲线。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明。
如图1所示,一种基于联合执行机构的递阶饱和模糊PD姿态控制方法,包括以下步骤:
步骤一:使用卫星姿态敏感器检测姿态四元数,设姿态四元数为Q;根据所述姿态四元数Q以及目标四元数QT得到姿态误差四元数Qe;
所述姿态误差四元数Qe为:
即:
其中,为共轭姿态目标四元数。
步骤二:在所述模糊逻辑控制器中设定姿态角速度的最大阈值;使用卫星姿态敏感器检测姿态角速度ω,根据测得的姿态角速度ω设计第一模糊控制增益K1, K1为姿态角速度的最大阈值与实际测得姿态角速度ω最大值的比值;
步骤三:根据步骤一获得的姿态角误差Qe设计第二模糊控制增益K2,K2为姿态角速度的最大阈值与实际测得姿态角误差Qe最大值的比值;
步骤四:选择使用二维模糊逻辑控制器,并设定模糊控制规则;所述姿态误差四元数Qe和姿态角速度ω分别通过第一模糊控制增益K1和第二模糊控制增益 K2输入到模糊控制器中;模糊控制器输出得到PD姿态控制律的比例增益Kp和微分增益Kd;
其中,模糊控制规则的建立为:
所述二维模糊逻辑控制器的输入为姿态误差四元数Qe及反馈角速度,对输入参数进行模糊化得:
由步骤二、步骤三对PD姿态控制律的比例增益Kp和微分增益Kd模糊化:
从而建立两者的模糊规则为:
步骤五:设输出力矩为T,根据姿态误差四元数Qe、姿态角速度ω、实时变化的比例增益Kp和微分增益Kd推导出T的计算公式为:
T=satσ[KdJω+KpJsatσ(Qe)-ω×(Jbω+CJwΩ]+Au
式中,J为转动惯量;Jw为飞轮转动惯量组成的对角阵;Jb为整星转动惯量;A为冷力推力器安装矩阵;u为冷力推力器产生推力的大小;C为飞轮的安装矩阵;Ω为飞轮角速度相对于本体坐标系构成的矩阵。式中各参数均为已知固定值或可以通过敏感器测得。
步骤六:对步骤五所述的输出力矩T进行分配力矩,计算实际控制力矩,分别通过姿态动力学方程和姿态运动学方程求解星体的实际角速度ω′与更新后的反馈实时姿态四元数Q′,然后循环操作步骤一至步骤六。
实际角速度ω′与更新后的反馈实时姿态四元数Q′的求解方法为:
设姿态运动学方程为根据姿态四元数描述姿态运动学方程:
其中,ω=[ωX ωY ωZ]T为轨道坐标系卫星角速度在本体坐标系中表示, E(Q)表示如下:
故得姿态运动学方程为:
设刚体卫星动力学方程为即姿态动力学方程,有:
式中,Tb为卫星所受的合外力矩,ω0为卫星相对于地心惯性坐标系的角速度,H为卫星整体角动量:
H=Hb+Hw=Jbω+CJwΩ (10)
式中,Hb为卫星本体角动量,Hw为飞轮相对星体转动的角动量,Jb为整星转动惯量,C为飞轮的安装矩阵,Jw为飞轮转动惯量组成的对角阵,Ω为飞轮相对于飞轮本体角速度构成的矩阵,代入得:
其中,
和分别为喷气***和飞轮作用于卫星的力矩;为重力梯度干扰力矩;为气动干扰、太阳光压等其它干扰力矩;由于干扰力矩较小,假设星体只受到喷气和飞轮的作用力。
为了验证本实施例的效果,针对递阶饱和PD控制方法和递阶饱和模糊PD 控制方法做了两组实验。
图2、3、4、5均为递阶饱和PD控制方法的实验数据,由仿真结果可以看出,基于联合执行结构的卫星姿态递阶饱和控制律控制卫星姿态机动50.1°需要耗时约150s,在机动过程中飞轮输出力矩限制在0.005Nm内,冷气推力器作为执行机构在0~4.5s内提供大力矩,及在力矩大于0.005Nm时采用冷气推力器提供力矩。卫星绕z轴机动,X轴和Y轴飞轮的输出力矩为零。卫星z轴角速度限制在0.5deg/s内,X轴和Y轴飞轮的角速度为零。从仿真结果可以看出,姿态稳定后,姿态角误差控制在0.23°以内,另外采用反馈四元数误差为参数的卫星姿态运动学方程可以保证卫星在大角度姿态机动时平滑经过姿态角为0°的情况,克服采用方向余弦描述姿态运动学时矩阵奇异的问题。卫星的姿态机动包含三个阶段:
1)加速段0~20s,星体转速持续增加并在加速段结束达到允许最大值 0.5deg/s;
2)滑行段20s~84s,z轴方向转速保持最大值滑行;
3)减速段84s~,卫星姿态角速度重新回零,完成大角度姿态机动。
图6至图11为递阶饱和模糊PD控制方法,由仿真结果可以看出,***参数经模糊控制律在线整定后得P=-0.0657,D=0.3675,基于联合执行机构递阶饱和模糊PD卫星姿态控制律控制卫星姿态机动50.1°需要耗时约145s,在机动过程中飞轮输出力矩限制在0.005Nm内,冷气推力器作为执行机构在0~1.4s内提供大力矩,及在力矩大于0.005Nm时采用冷气推力器提供力矩。卫星绕z轴机动, X轴和Y轴飞轮的输出力矩为零。从仿真结果可以看出,姿态稳定后,姿态角误差控制在0.2°以内。另外采用反馈四元数误差为参数的卫星姿态运动学方程可以保证卫星在大角度姿态机动时平滑经过姿态角为0°的情况,克服采用方向余弦描述姿态运动学时矩阵奇异的问题。卫星的姿态机动包含三个阶段:
1)加速段0~1.5s,星体转速持续增加并在加速段结束达到允许最大值0.0087rad/s;
2)滑行段1.5s~60s,Z轴方向转速保持最大值滑行;
3)减速段60s~,卫星姿态角速度重新回零,完成大角度姿态机动。
递阶饱和模糊PD姿态控制律的比例增益和微分增益由模糊逻辑***根据实时的姿态误差在线整定结果如图6至图11所示。
进一步对递阶饱和PD和递阶饱和模糊PD进行比较分析,两种控制律都采用基于递阶饱和的三轴稳定姿态控制算法,执行机构都采用冷气推进器和飞轮联合执行机构,比较结果见表1。
表1联合执行机构控制方法比较
从表1可看出,递阶饱和模糊PD姿态控制律在***稳定以及卫星机动的三个阶段所用时间上略优于递阶饱和PD控制律,同时冷气推力***喷气时间大大缩短,导致冷气消耗也大大减小,适合于微小卫星的星载。
Claims (4)
1.一种基于联合执行机构的递阶饱和模糊PD姿态控制方法,其特征在于,包括以下步骤:
步骤一:使用卫星姿态敏感器检测姿态四元数,设姿态四元数为Q;提供目标四元数QT;根据所述姿态四元数Q以及目标四元数QT得到姿态误差四元数Qe;
步骤二:在所述模糊逻辑控制器中设定姿态角速度的最大阈值;使用卫星姿态敏感器检测姿态角速度ω,根据测得的姿态角速度ω设计第一模糊控制增益K1,K1为姿态角速度的最大阈值与实际测得姿态角速度ω最大值的比值;
步骤三:根据步骤一获得的姿态角误差Qe设计第二模糊控制增益K2,K2为姿态角速度的最大阈值与实际测得姿态角误差Qe最大值的比值;
步骤四:选择使用二维模糊逻辑控制器,并设定模糊控制规则;所述姿态误差四元数Qe和姿态角速度ω分别通过第一模糊控制增益K1和第二模糊控制增益K2输入到模糊控制器中;模糊控制器输出得到PD姿态控制律的比例增益Kp和微分增益Kd;
步骤五:设输出力矩为T,根据姿态误差四元数Qe、姿态角速度ω、实时变化的比例增益Kp和微分增益Kd计算T:
T=satσ[KdJω+KpJsatσ(Qe)-ω×(Jbω+CJwΩ]+Au
式中,J为转动惯量;Jw为飞轮转动惯量组成的对角阵;Jb为整星转动惯量;A为冷力推力器安装矩阵;u为冷力推力器产生推力的大小;C为飞轮的安装矩阵;Ω为飞轮角速度相对于本体坐标系构成的矩阵;
步骤六:对步骤五所述的输出力矩T进行分配力矩,计算实际控制力矩,分别通过姿态动力学方程和姿态运动学方程求解星体的实际角速度ω'与更新后的反馈实时姿态四元数Q',然后将Q'作为步骤一中的Q、ω'作为步骤二中的ω循环操作步骤一至步骤六。
2.根据权利要求1所述的基于联合执行机构的递阶饱和模糊PD姿态控制方法,其特征在于,所述步骤一中,姿态误差四元数Qe为:
<mrow>
<msub>
<mi>Q</mi>
<mi>e</mi>
</msub>
<mo>=</mo>
<msubsup>
<mi>Q</mi>
<mi>T</mi>
<mo>*</mo>
</msubsup>
<mo>&CircleTimes;</mo>
<mi>Q</mi>
</mrow>
即:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>e</mi>
<mn>0</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>e</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>e</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>e</mi>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mi>o</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mi>o</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>3</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mi>o</mi>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>3</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>2</mn>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mi>o</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>q</mi>
<mn>3</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中为共轭姿态目标四元数。
3.根据权利要求1所述的基于联合执行机构的递阶饱和模糊PD姿态控制方法,其特征在于,所述步骤六中,实际角速度ω'与更新后的反馈实时姿态四元数Q'的求解方法为:
设姿态运动学方程为根据姿态四元数描述姿态运动学方程:
<mrow>
<mover>
<mi>Q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mi>E</mi>
<mrow>
<mo>(</mo>
<mi>Q</mi>
<mo>)</mo>
</mrow>
<mi>&omega;</mi>
</mrow>
其中,ω=[ωX ωY ωZ]T为轨道坐标系卫星角速度在本体坐标系中的表示,Q=[q0 qt1qt2 qt3]为姿态四元数,E(Q)为:
<mrow>
<mi>E</mi>
<mrow>
<mo>(</mo>
<mi>Q</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mo>-</mo>
<msup>
<mi>q</mi>
<mi>T</mi>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>q</mi>
<mo>&times;</mo>
</msup>
<mo>+</mo>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<msub>
<mi>I</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
其中,E(Q)表示由姿态四元数四个参数组成的矩阵,矩阵参数如下:
qT=[qt1 qt2 qt3],
故得姿态运动学方程为:
<mrow>
<mover>
<mi>q</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mi>&omega;</mi>
<mo>&times;</mo>
<mi>q</mi>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>q</mi>
<mn>0</mn>
</msub>
<mi>&omega;</mi>
</mrow>
其中,q=[qt1 qt2 qt3]T,
设刚体卫星动力学方程为则有:
<mrow>
<mover>
<mi>H</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mn>0</mn>
</msub>
<mo>&times;</mo>
<mi>H</mi>
<mo>=</mo>
<msup>
<mi>T</mi>
<mi>b</mi>
</msup>
</mrow>
式中,Tb为卫星所受的合外力矩,ω0为卫星相对于地心惯性坐标系的角速度,H为卫星整体角动量:
H=Hb+Hw=Jbω+CJwΩ
式中,Hb为卫星本体角动量,Hw为飞轮相对星体转动的角动量,Jb为整星转动惯量,C为飞轮的安装矩阵,Jw为飞轮转动惯量组成的对角阵,Ω为飞轮角速度相对于本体坐标系构成的矩阵,代入得:
<mrow>
<mi>J</mi>
<mover>
<mi>&omega;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mn>0</mn>
<mo>&times;</mo>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>J</mi>
<mi>b</mi>
</msub>
<mi>&omega;</mi>
<mo>+</mo>
<msub>
<mi>CJ</mi>
<mi>w</mi>
</msub>
<mi>&Omega;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mi>T</mi>
<mi>b</mi>
</msup>
</mrow>
<mrow>
<msubsup>
<mi>&omega;</mi>
<mn>0</mn>
<mo>&times;</mo>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mn>0</mn>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mrow>
<mn>0</mn>
<mi>y</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mrow>
<mn>0</mn>
<mi>z</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mn>0</mn>
<mi>x</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mrow>
<mn>0</mn>
<mi>y</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mrow>
<mn>0</mn>
<mi>x</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<mi>J</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>J</mi>
<mrow>
<mi>x</mi>
<mi>x</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mrow>
<mi>x</mi>
<mi>y</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mrow>
<mi>x</mi>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mrow>
<mi>y</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>J</mi>
<mrow>
<mi>y</mi>
<mi>y</mi>
</mrow>
</msub>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mrow>
<mi>y</mi>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mrow>
<mi>z</mi>
<mi>x</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mrow>
<mi>z</mi>
<mi>y</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>J</mi>
<mrow>
<mi>z</mi>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msup>
<mi>T</mi>
<mi>b</mi>
</msup>
<mo>=</mo>
<msubsup>
<mi>T</mi>
<mi>w</mi>
<mi>b</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>T</mi>
<mi>p</mi>
<mi>b</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>T</mi>
<mi>g</mi>
<mi>b</mi>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>T</mi>
<mi>d</mi>
<mi>b</mi>
</msubsup>
</mrow>
其中,为ω0反对称矩阵,J为转动惯量,Tb为整星所受的力矩,ω0x表示x轴的角速度,ω0y表示y轴的角速度,ω0z表示z轴的角速度;和分别为喷气***和飞轮作用于卫星的力矩;为重力梯度干扰力矩;为气动干扰、太阳光压等其它干扰力矩;由于干扰力矩较小,假设星体只受到喷气和飞轮的作用力。
4.根据权利要求1所述的基于联合执行机构的递阶饱和模糊PD姿态控制方法,其特征在于,所述步骤三中,模糊控制规则的建立为:
所述二维模糊逻辑控制器的输入为姿态误差四元数Qe及姿态角速度ω,对输入参数进行模糊化得:
qe={NB NM NS NO PO PS PM PB}
ωe={NB NM NS NO PO PS PM PB}
由步骤二、步骤三对PD姿态控制律的比例增益Kp和微分增益Kd模糊化:
kp={NB NM NS NO PO PS PM PB}
kd={NB NM NS NO PO PS PM PB}
从而建立两者的模糊规则为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710480273.4A CN107402516B (zh) | 2017-06-22 | 2017-06-22 | 基于联合执行机构的递阶饱和模糊pd姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710480273.4A CN107402516B (zh) | 2017-06-22 | 2017-06-22 | 基于联合执行机构的递阶饱和模糊pd姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107402516A true CN107402516A (zh) | 2017-11-28 |
CN107402516B CN107402516B (zh) | 2019-07-02 |
Family
ID=60404794
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710480273.4A Active CN107402516B (zh) | 2017-06-22 | 2017-06-22 | 基于联合执行机构的递阶饱和模糊pd姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107402516B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109018441A (zh) * | 2018-09-13 | 2018-12-18 | 上海航天控制技术研究所 | 一种卫星任意姿态机动过程偏流角跟踪控制方法 |
CN109507875A (zh) * | 2019-01-08 | 2019-03-22 | 哈尔滨工业大学 | 一种欧拉旋转卫星姿态机动递阶饱和pid控制方法 |
CN110187634A (zh) * | 2018-02-23 | 2019-08-30 | 北京京东尚科信息技术有限公司 | 飞行器的控制方法、装置和计算机可读存储介质 |
CN111897207A (zh) * | 2020-08-13 | 2020-11-06 | 北京中科宇航技术有限公司 | 一种适应执行机构饱和的快速姿态机动控制方法 |
CN113296393A (zh) * | 2021-05-27 | 2021-08-24 | 安徽工业大学 | 基于自调整模糊迭代学习的二连杆机械臂控制方法、装置及介质 |
CN113466483A (zh) * | 2021-06-17 | 2021-10-01 | 北京控制工程研究所 | 无陀螺情况下卫星角速度异常故障在线智能诊断方法 |
CN113759706A (zh) * | 2021-11-05 | 2021-12-07 | 普宙科技(深圳)有限公司 | 基于轴角矢量的多旋翼姿态自抗扰控制方法及*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013003845A (ja) * | 2011-06-16 | 2013-01-07 | Institute Of National Colleges Of Technology Japan | 組み込み知能コントローラ、制御システム、制御プログラム、記録媒体、及び制御方法 |
CN103019099A (zh) * | 2012-12-14 | 2013-04-03 | 北京航空航天大学 | 一种卫星姿态模糊控制器参数优化方法 |
CN103984237A (zh) * | 2014-06-04 | 2014-08-13 | 西北工业大学 | 基于运动状态综合识别的轴对称飞行器三通道自适应控制***设计方法 |
CN104950671A (zh) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | 基于自适应模糊的再入飞行器pid型滑模姿态控制方法 |
-
2017
- 2017-06-22 CN CN201710480273.4A patent/CN107402516B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013003845A (ja) * | 2011-06-16 | 2013-01-07 | Institute Of National Colleges Of Technology Japan | 組み込み知能コントローラ、制御システム、制御プログラム、記録媒体、及び制御方法 |
CN103019099A (zh) * | 2012-12-14 | 2013-04-03 | 北京航空航天大学 | 一种卫星姿态模糊控制器参数优化方法 |
CN103984237A (zh) * | 2014-06-04 | 2014-08-13 | 西北工业大学 | 基于运动状态综合识别的轴对称飞行器三通道自适应控制***设计方法 |
CN104950671A (zh) * | 2015-06-10 | 2015-09-30 | 北京理工大学 | 基于自适应模糊的再入飞行器pid型滑模姿态控制方法 |
Non-Patent Citations (4)
Title |
---|
尹大千: "一种重力梯度稳定卫星姿态确定与控制方法研究", 《工程科技II辑》 * |
段晨阳: "小卫星反作用飞轮与磁力矩器联合姿态控制方法研究", 《工程科技II辑》 * |
陈志明等: "采用动量轮及推进器的微小卫星的姿态机动控制", 《中国惯性技术学报》 * |
马慧媛: "挠性多体卫星姿态控制方法研究", 《工程科技II辑》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110187634A (zh) * | 2018-02-23 | 2019-08-30 | 北京京东尚科信息技术有限公司 | 飞行器的控制方法、装置和计算机可读存储介质 |
CN109018441A (zh) * | 2018-09-13 | 2018-12-18 | 上海航天控制技术研究所 | 一种卫星任意姿态机动过程偏流角跟踪控制方法 |
CN109507875A (zh) * | 2019-01-08 | 2019-03-22 | 哈尔滨工业大学 | 一种欧拉旋转卫星姿态机动递阶饱和pid控制方法 |
CN109507875B (zh) * | 2019-01-08 | 2022-03-04 | 哈尔滨工业大学 | 一种欧拉旋转卫星姿态机动递阶饱和pid控制方法 |
CN111897207A (zh) * | 2020-08-13 | 2020-11-06 | 北京中科宇航技术有限公司 | 一种适应执行机构饱和的快速姿态机动控制方法 |
CN111897207B (zh) * | 2020-08-13 | 2023-11-14 | 北京中科宇航技术有限公司 | 一种适应执行机构饱和的快速姿态机动控制方法 |
CN113296393A (zh) * | 2021-05-27 | 2021-08-24 | 安徽工业大学 | 基于自调整模糊迭代学习的二连杆机械臂控制方法、装置及介质 |
CN113466483A (zh) * | 2021-06-17 | 2021-10-01 | 北京控制工程研究所 | 无陀螺情况下卫星角速度异常故障在线智能诊断方法 |
CN113759706A (zh) * | 2021-11-05 | 2021-12-07 | 普宙科技(深圳)有限公司 | 基于轴角矢量的多旋翼姿态自抗扰控制方法及*** |
CN113759706B (zh) * | 2021-11-05 | 2022-02-08 | 普宙科技(深圳)有限公司 | 基于轴角矢量的多旋翼姿态自抗扰控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN107402516B (zh) | 2019-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107402516A (zh) | 基于联合执行机构的递阶饱和模糊pd姿态控制方法 | |
CN106292681B (zh) | 一种基于观测器和在线控制分配的卫星主动容错控制方法 | |
Wang et al. | Robust H∞ attitude tracking control of a quadrotor UAV on SO (3) via variation-based linearization and interval matrix approach | |
Pérez et al. | Differential drag spacecraft rendezvous using an adaptive Lyapunov control strategy | |
CN103592848B (zh) | 一种变速控制力矩陀螺群的精准敏捷操纵方法 | |
CN103092208B (zh) | 基于sgcmg和rw的航天器高精度快速姿态机动方法 | |
CN106896821B (zh) | 一种变速控制力矩陀螺的角动量管理方法 | |
Hu et al. | Nonlinear proportional-derivative control incorporating closed-loop control allocation for spacecraft | |
Sutherland et al. | Attitude control of a 2U cubesat by magnetic and air drag torques | |
CN103076807B (zh) | 一种欠驱动柔性航天器姿态稳定的控制方法 | |
CN108804846B (zh) | 非合作目标组合体航天器的数据驱动姿态控制器设计方法 | |
CN112572835B (zh) | 一种具有姿态切换的卫星在轨角动量管理及控制方法 | |
Weiss et al. | Model predictive control for simultaneous station keeping and momentum management of low-thrust satellites | |
CN104076818B (zh) | 考虑线性化误差的空间交会***的增益调度控制方法 | |
CN104309822A (zh) | 一种基于参数优化的航天器单脉冲水滴形绕飞轨迹悬停控制方法 | |
CN107187615A (zh) | 卫星分布式载荷的编队方法 | |
Wang et al. | Control analysis of an underactuated spacecraft under disturbance | |
CN102749846B (zh) | 一种两平行构型VSDGCMGs奇异回避操纵律设计方法 | |
Li et al. | Dynamics and control for contactless interaction between spacecraft and tumbling debris | |
Kojima et al. | Steering control law for double-gimbal scissored-pair CMG | |
Xia et al. | Time-shared scheme design for attitude control system during space separation | |
CN104850128B (zh) | 一种用于具有大惯量积航天器的动量轮布局配置方法 | |
Wu et al. | Adaptive parameter identification based nadir-pointing control of spacecraft with misaligned rotational component | |
Reijneveld et al. | Attitude control system of the Delfi-n3Xt satellite | |
Wibben et al. | Integrated guidance and attitude control for asteroid proximity operations using higher order sliding 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 |