CN113173267B - 一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法 - Google Patents

一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法 Download PDF

Info

Publication number
CN113173267B
CN113173267B CN202110481652.1A CN202110481652A CN113173267B CN 113173267 B CN113173267 B CN 113173267B CN 202110481652 A CN202110481652 A CN 202110481652A CN 113173267 B CN113173267 B CN 113173267B
Authority
CN
China
Prior art keywords
flywheel
angular momentum
torque
momentum
limit
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
Application number
CN202110481652.1A
Other languages
English (en)
Other versions
CN113173267A (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.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
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 Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN202110481652.1A priority Critical patent/CN113173267B/zh
Publication of CN113173267A publication Critical patent/CN113173267A/zh
Application granted granted Critical
Publication of CN113173267B publication Critical patent/CN113173267B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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
    • 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/28Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect
    • B64G1/285Guiding or controlling apparatus, e.g. for attitude control using inertia or gyro effect using momentum wheels
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02EREDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
    • Y02E60/00Enabling technologies; Technologies with a potential or indirect contribution to GHG emissions mitigation
    • Y02E60/16Mechanical energy storage, e.g. flywheels or pressurised fluids

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)
  • Magnetic Bearings And Hydrostatic Bearings (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种冗余飞轮组动态力矩分配与角动量跟踪控制方法,属于卫星姿态机动控制技术领域。本发明根据飞轮组的角动量储备以及机动过程中各飞轮实时角动量动态分配飞轮驱动电压,使得冗余飞轮组在所有飞轮都达到饱和前总是工作于不饱和状态,保证了机动力矩的持续、平稳输出,飞轮组的全部角动量能够获得充分的利用;另一方面,针对轴承摩擦、风阻以及电机损耗力矩等扰动因素,提出了一种角动量反馈跟踪控制技术,使力矩轮能够工作在速率轮的模式下,克服了角动量漂移问题,确保飞轮在大角度机动过程中准确跟踪期望角动量。

Description

一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法
技术领域
本发明涉及一种冗余飞轮组动态力矩分配与角动量跟踪控制方法,属于卫星姿态机动控制技术领域。
背景技术
如图1、2所示,为了有效提升卫星侧摆机动的敏捷性,卫星沿滚动轴(X 轴)安装了多台大力矩飞轮。为了确保大力矩飞轮力矩输出的平稳性,一般将飞轮角动量偏置在某个设定的中间值,以避开飞轮转速接近零与饱和两种特性复杂的状态。然而,当进行姿态机动时,若不作合理的力矩分配,某些飞轮将过早出现饱和,从而影响机动过程的平稳性。
发明内容
本发明的技术解决问题是:针对现有力矩分配技术的不足,提出一种冗余飞轮组动态力矩分配与角动量跟踪控制方法,通过飞轮驱动电压的动态分配以及角动量反馈跟踪控制,保证了机动力矩的持续、平稳输出,飞轮组的全部角动量能够获得充分的利用。
本发明的技术解决方案是:一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法,包括如下步骤:
(1.1)根据冗余飞轮组的偏置角动量,计算飞轮组的角动量储备;
(1.2)确定飞轮极限角动量;
(1.3)确定各飞轮的极限角动量后,即可求得任意时刻t各飞轮角动量储备ΔHi(t)及整个飞轮组的角动量储备:
(1.4)计算得到t时刻第i个飞轮的驱动电压Ui
(1.5)对飞轮输出力矩按控制周期ΔT进行数值积分
(1.6)计算得到角动量保持电压Ukeepi
Ukeepi=-kp(Hi-Hi0)-ki∫(Hi-Hi0)dt
其中kp为比例控制系数,ki为积分控制系数;
(1.7)获得飞轮控制电压Ui`=Ui+Ukeepi,发给飞轮进行飞轮的力矩输出与飞轮的角动量跟踪控制。
所述步骤(1.1)的具体过程为:
设冗余飞轮组由n≥2个绕机动轴共轴安装的大力矩飞轮组成,飞轮i 具有偏置角动量Hi,且H1+H2+…+Hn=0。
所述步骤(1.2)的具体过程为:若飞轮在机动过程中允许转速过零,则飞轮的角动量极限能够到达正向或者负向的最大标称角动量Hmax,则飞轮极限角动量按机动方向确定:
Figure BDA0003049490310000021
若飞轮转速不允许过零,则由飞轮的角动量偏置极性及姿态机动方向确定;
正向机动时,当飞轮偏置角动量也为正时,飞轮角动量应往负向输出,其极限角动量为0;反之,若飞轮偏置角动量为负时,则该飞轮极限角动量为负的最大角动量:
Figure BDA0003049490310000022
反向机动时,飞轮极限角动量为:
Figure BDA0003049490310000023
所述步骤(1.3)的具体过程为:确定各飞轮的极限角动量后,即可求得任意时刻t各飞轮角动量储备ΔHi(t)及整个飞轮组的角动量储备:
iΔHi(t)=∑i(Hlimi-Hi(t))
其中,Hlimi表示动量轮i的极限角动量,∑iΔHi(t)表示动量轮组可输出角动量之和。
所述步骤(1.4)的具体过程为:
根据轨迹规划得到的星体姿态机动前馈补偿力矩T(t),飞轮电压-力矩转换系数为CUT,得到t时刻第i个飞轮的驱动电压Ui,即
Figure BDA0003049490310000031
所述步骤(1.5)的具体过程为:对飞轮输出力矩按控制周期ΔT进行数值积分
Hi0=Hi0+CUTUiΔT
其中,Hi0为飞轮在每个控制周期力矩输出后的期望角动量。
所述步骤(1.6)的具体过程为:根据角动量Hi0,结合飞轮转速保持的PI 控制算法,计算角动量保持电压Ukeepi
Ukeepi=-kp(Hi-Hi0)-ki∫(Hi-Hi0)dt
其中kp为比例控制系数,ki为积分控制系数。
本发明与现有技术相比的有益效果是:
(1)、本发明根据飞轮组的角动量储备以及机动过程中各飞轮实时角动量动态分配飞轮驱动电压,使得冗余飞轮组在所有飞轮都达到饱和前总是工作于不饱和状态;
(2)、本发明保证了机动力矩的持续、平稳输出,飞轮组的全部角动量能够获得充分的利用,有效提高了轮控卫星的侧摆机动能力;
(3)、本发明针对轴承摩擦、风阻以及电机损耗力矩等扰动因素,提出了一种角动量反馈跟踪控制技术,使力矩轮能够工作在速率轮的模式下,克服了角动量漂移问题,确保飞轮在大角度机动过程中准确跟踪期望角动量。
附图说明
图1为基于冗余飞轮组的高稳定度机动控制原理框图;
图2为共轴安装飞轮角动量储备的确定(允许过零);
图3为基于大力矩飞轮组的高稳定度侧摆机动控制算法流程;
图4为5°、15°、32°姿态机动实测变化曲线。
图5为3个大力矩轮角动量实测变化曲线。
具体实施方式
以下结合附图1-5和具体实施例对本发明进行详细说明。
本发明提出的一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法,该方法包括如下步骤:
(1)、飞轮驱动电压的动态分配,包括如下步骤:
(1.1)、根据冗余飞轮组的偏置角动量,计算飞轮组的角动量储备;
设冗余飞轮组由n≥2个绕机动轴共轴安装的大力矩飞轮组成(绕机动轴等倾角安装的情形具有类似处理方法,仅需进行相应的角动量投影),飞轮i具有偏置角动量Hi,且H1+H2+…+Hn=0。
(1.2)、若飞轮在机动过程中允许转速过零,则飞轮的角动量极限能够到达正向或者负向的最大标称角动量Hmax,其角动量极限按机动方向确定:
Figure BDA0003049490310000041
(1.3)、若飞轮转速不允许过零,则由飞轮的角动量偏置极性及姿态机动方向确定。以正向机动为例,当飞轮偏置角动量也为正时,飞轮角动量应往负向输出,其极限角动量为0;反之,若飞轮偏置角动量为负时,则该飞轮极限角动量为负的最大角动量:
Figure BDA0003049490310000042
同理,反向机动时为:
Figure BDA0003049490310000043
(1.4)、确定各飞轮的极限角动量后,即可求得任意时刻t各飞轮角动量储备ΔHi(t)及整个飞轮组的角动量储备:
iΔHi(t)=∑i(Hlimi-Hi(t))
(1.5)、根据轨迹规划得到的星体姿态机动前馈补偿力矩T(t),飞轮电压- 力矩转换系数为CUT,则t时刻第i个飞轮的驱动电压Ui
Figure BDA0003049490310000051
(2)进一步设计了角动量反馈跟踪控制技术,弥补了由于非线性摩擦等各种不确知因素引起的力矩损失总和,使飞轮力矩输出准确跟踪期望值,其特征在于包括如下步骤:
(2.1)对飞轮输出力矩按控制周期ΔT进行数值积分
Hi0=Hi0+CUTUiΔT
其积分结果Hi0为飞轮在每个控制周期力矩输出后的期望角动量。
(2.2)根据角动量Hi0,结合飞轮转速保持的PI控制算法,计算角动量保持电压Ukeepi:
Ukeepi=-kp(Hi-Hi0)-ki∫(Hi-Hi0)dt
(3)最终获得飞轮控制电压如下
Ui=Ui+Ukeepi
实施例
下面以3台平行安装的飞轮为例,对本发明进行具体说明:
(1)根据冗余飞轮组的偏置角动量,计算飞轮组的角动量储备;
设3个25Nms的飞轮沿卫星X轴平行安装,其偏置角动量为
H1=15.0Nms
H2=-7.5Nms
H3=-7.5Nms
若允许飞轮转速过零,且整星沿X轴负方向机动,则各动量轮的极限角动量为
Hlim1=25Nms
Hlim2=25Nms
Hlim3=25Nms
则整个飞轮组沿X轴方向的动量轮储备为
ΔH1+ΔH2+ΔH3
=Hlim1-H1+Hlim2–H2+Hlim3–H3
=25–15.0+25+7.5+25+7.5=75Nms
设t时刻星体前馈补偿力矩为T=0.1Nm,飞轮电压-力矩转换系数为CUT= 0.01V/Nm,则t时刻各飞轮驱动电压为
U1=0.1*(25-15.0)/75/0.01=1.3333V
U2=0.1*(25+7.5)/75/0.01=4.3333V
U3=0.1*(25+7.5)/75/0.01=4.3333V
设控制周期ΔT=0.125s,对飞轮输出力矩按控制周期进行数值积分,其中设H10=15.0Nms,H20=-7.5Nms,H30=-7.5Nms,则
H10=15.0+0.01*1.3333*0.125=15.0017Nms
H20=-7.5+0.01*4.3333*0.125=-7.4946Nms
H30=-7.5+0.01*4.3333*0.125=-7.4946Nms
即可根据上述预期角动量进行飞轮PI控制,使各动量轮跟踪上述角动量。
根据本发明提出的方法,针对单轴气浮台进行5°、15°、32°姿态机动试验,试验表明,在姿态机动过程中,3个大力矩轮角动量均处于不饱和的工作状态,卫星姿态实现平稳机动,如图4和图5所示。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

Claims (1)

1.一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法,其特征在于:包括如下步骤:
(1.1)根据冗余飞轮组的偏置角动量,计算飞轮组的角动量储备;
(1.2)确定飞轮极限角动量;
(1.3)确定各飞轮的极限角动量后,即可求得任意时刻t各飞轮角动量储备ΔHi(t)及整个飞轮组的角动量储备:
(1.4)计算得到t时刻第i个飞轮的驱动电压Ui
(1.5)对飞轮输出力矩按控制周期ΔT进行数值积分;
(1.6)计算得到角动量保持电压Ukeepi
(1.7)获得飞轮控制电压Ui`=Ui+Ukeepi,发给飞轮进行飞轮的力矩输出与飞轮的角动量跟踪控制;
所述步骤(1.1)的具体过程为:
设冗余飞轮组由n≥2个绕机动轴共轴安装的大力矩飞轮组成,飞轮i具有偏置角动量Hi,且H1+H2+…+Hn=0;
所述步骤(1.2)的具体过程为:若飞轮在机动过程中允许转速过零,则飞轮的角动量极限能够到达正向或者负向的最大标称角动量Hmax,则飞轮极限角动量按机动方向确定:
Figure FDA0003682151940000011
若飞轮转速不允许过零,则由飞轮的角动量偏置极性及姿态机动方向确定;
正向机动时,当飞轮偏置角动量也为正时,飞轮角动量应往负向输出,其极限角动量为0;反之,若飞轮偏置角动量为负时,则该飞轮极限角动量为负的最大角动量:
Figure FDA0003682151940000012
反向机动时,飞轮极限角动量为:
Figure FDA0003682151940000021
所述步骤(1.3)的具体过程为:确定各飞轮的极限角动量后,即可求得任意时刻t各飞轮角动量储备ΔHi(t)及整个飞轮组的角动量储备:
iΔHi(t)=∑i(Hlimi-Hi(t))
其中,Hlimi表示动量轮i的极限角动量,∑iΔHi(t)表示动量轮组可输出角动量之和;
所述步骤(1.4)的具体过程为:
根据轨迹规划得到的星体姿态机动前馈补偿力矩T(t),飞轮电压-力矩转换系数为CUT,得到t时刻第i个飞轮的驱动电压Ui,即
Figure FDA0003682151940000022
所述步骤(1.5)的具体过程为:对飞轮输出力矩按控制周期ΔT进行数值积分
H′i0=Hi0+CUTUiΔT
其中,H′i0为飞轮i在1个控制周期ΔT内力矩输出后的期望角动量;
Hi0为飞轮i在1个控制周期ΔT前的期望角动量;
所述步骤(1.6)的具体过程为:根据角动量Hi0,结合飞轮转速保持的PI控制算法,计算角动量保持电压Ukeepi
Ukeepi=-kp(Hi-H′i0)-ki∫(Hi-H′i0)dt
其中kp为比例控制系数,ki为积分控制系数。
CN202110481652.1A 2021-04-30 2021-04-30 一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法 Active CN113173267B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110481652.1A CN113173267B (zh) 2021-04-30 2021-04-30 一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110481652.1A CN113173267B (zh) 2021-04-30 2021-04-30 一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法

Publications (2)

Publication Number Publication Date
CN113173267A CN113173267A (zh) 2021-07-27
CN113173267B true CN113173267B (zh) 2022-08-12

Family

ID=76925919

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110481652.1A Active CN113173267B (zh) 2021-04-30 2021-04-30 一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法

Country Status (1)

Country Link
CN (1) CN113173267B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113761664B (zh) * 2021-09-15 2024-01-30 长光卫星技术股份有限公司 一种遥感卫星成像期间飞轮转速优化方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5749545A (en) * 1993-02-09 1998-05-12 Gnatjuk; Sevastian Dmitrievich Autonomous on-board satellite control system
JP2005329857A (ja) * 2004-05-21 2005-12-02 Keio Gijuku 姿勢制御用フライホイール装置
CN103112602A (zh) * 2013-01-30 2013-05-22 北京控制工程研究所 一种基于推力器和动量轮联合的三轴角速度阻尼控制方法
CN103332301A (zh) * 2013-06-08 2013-10-02 北京航空航天大学 利用充液变惯量飞轮控制航天器姿态的方法及其执行机构
CN104176275A (zh) * 2014-07-16 2014-12-03 北京控制工程研究所 一种使用动量轮与磁力矩器联合的速率阻尼方法
CN106184820A (zh) * 2016-08-10 2016-12-07 西北工业大学 一种组合驱动多力矩输出动量轮及其控制方法
CN109850188A (zh) * 2018-12-12 2019-06-07 上海航天控制技术研究所 一种基于频率电压转换的飞轮稳速控制系统
CN110104217A (zh) * 2019-03-29 2019-08-09 上海卫星工程研究所 卫星姿态控制与大角动量补偿复用飞轮的构形与控制方法
CN112572838A (zh) * 2020-12-29 2021-03-30 中国人民解放军国防科技大学 基于动量轮与反射率控制装置的航天器姿态控制系统

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5749545A (en) * 1993-02-09 1998-05-12 Gnatjuk; Sevastian Dmitrievich Autonomous on-board satellite control system
JP2005329857A (ja) * 2004-05-21 2005-12-02 Keio Gijuku 姿勢制御用フライホイール装置
CN103112602A (zh) * 2013-01-30 2013-05-22 北京控制工程研究所 一种基于推力器和动量轮联合的三轴角速度阻尼控制方法
CN103332301A (zh) * 2013-06-08 2013-10-02 北京航空航天大学 利用充液变惯量飞轮控制航天器姿态的方法及其执行机构
CN104176275A (zh) * 2014-07-16 2014-12-03 北京控制工程研究所 一种使用动量轮与磁力矩器联合的速率阻尼方法
CN106184820A (zh) * 2016-08-10 2016-12-07 西北工业大学 一种组合驱动多力矩输出动量轮及其控制方法
CN109850188A (zh) * 2018-12-12 2019-06-07 上海航天控制技术研究所 一种基于频率电压转换的飞轮稳速控制系统
CN110104217A (zh) * 2019-03-29 2019-08-09 上海卫星工程研究所 卫星姿态控制与大角动量补偿复用飞轮的构形与控制方法
CN112572838A (zh) * 2020-12-29 2021-03-30 中国人民解放军国防科技大学 基于动量轮与反射率控制装置的航天器姿态控制系统

Also Published As

Publication number Publication date
CN113173267A (zh) 2021-07-27

Similar Documents

Publication Publication Date Title
CN106184199B (zh) 分布式控制电动汽车稳定性的集成控制方法
CN105539884B (zh) 一种卫星偏航控制导引方法
CN105912011A (zh) 一种四旋翼飞行器姿态的线性自抗扰控制方法
CN104590557B (zh) 一种多旋翼和固定翼复合飞行器的飞行控制方法及装置
CN108454623A (zh) 一种四轮独立驱动无人驾驶电动车辆轨迹跟踪控制方法
CN112346470A (zh) 一种基于改进自抗扰控制的四旋翼姿态控制方法
CN113359459B (zh) 旋翼飞行器滑模变结构的姿态控制方法
CN103895704B (zh) 基于后轮主动转向的变传动比控制方法
CN113173267B (zh) 一种冗余飞轮组的动态力矩分配与角动量跟踪控制方法
CN108508760A (zh) 一种多轮独立驱动滑差转向车辆的联合仿真方法及系统
CN107215454A (zh) 一种新型复合滚转姿态控制系统及方法
CN102880183A (zh) 一种用于偏航机动的控制力矩陀螺角动量管理方法
CN106990790A (zh) 一种抗饱和多旋翼飞行器控制方法
CN109460055B (zh) 一种飞行器控制能力确定方法、装置及电子设备
CN104590253A (zh) 一种四轮独立驱动电动汽车的横摆角速度控制方法
CN108062024B (zh) 一种考虑阻力的移动机器人反演滑模控制方法
CN113156965A (zh) 一种基于纵向速度规划的气垫船高速回转控制方法
Wei et al. Intelligent control in two-wheel self-balanced robot
CN113504721B (zh) 基于bp-pid神经网络的弹载电动舵机舵偏角位置跟踪方法
CN113147736A (zh) 基于独立轮系的电动车辆稳定性控制方法
Cao et al. Application of fuzzy control in four wheel steering control system
CN106585915A (zh) 基于鳍与翼鳍矢量控制的船舶减横摇系统双环控制方法
CN112965498A (zh) 一种智能扫路车运行轨迹跟踪控制方法
Yuan et al. An unmanned vehicle trajectory tracking method based on improved model-free adaptive control algorithm
CN113671835A (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