CN104102224B - 一种双回路卫星姿态跟踪控制装置及方法 - Google Patents

一种双回路卫星姿态跟踪控制装置及方法 Download PDF

Info

Publication number
CN104102224B
CN104102224B CN201410283960.3A CN201410283960A CN104102224B CN 104102224 B CN104102224 B CN 104102224B CN 201410283960 A CN201410283960 A CN 201410283960A CN 104102224 B CN104102224 B CN 104102224B
Authority
CN
China
Prior art keywords
loop
satellite
attitude
controller
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.)
Active
Application number
CN201410283960.3A
Other languages
English (en)
Other versions
CN104102224A (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 Engineering Center for Microsatellites
Original Assignee
Shanghai Engineering Center for Microsatellites
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 Engineering Center for Microsatellites filed Critical Shanghai Engineering Center for Microsatellites
Priority to CN201410283960.3A priority Critical patent/CN104102224B/zh
Publication of CN104102224A publication Critical patent/CN104102224A/zh
Application granted granted Critical
Publication of CN104102224B publication Critical patent/CN104102224B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

一种双回路卫星姿态跟踪控制装置及方法，装置包括内环回路和外环回路构成的姿控闭环；所述内环回路包括依次连接的内环控制器、结构滤波模块、延迟模块以及陀螺敏感器；所述外环回路包括依次连接的外环控制器、内环控制器、结构滤波模块、延迟模块、积分模块以及星敏感器；其中，所述内环回路中的内环控制器、结构滤波模块以及延迟模块与所述外环回路共用，所述外环回路的带宽小于所述内环回路；通过内环回路消除卫星姿态角速度偏差，通过外环回路消除卫星姿态角度偏差并控制系统的稳定性。本发明基于内外环双环姿态控制结构，内环消除卫星姿态角速度偏差，外环消除姿态角度偏差并保证系统的稳定性，同时解决高精度稳态控制和高精度姿态跟踪控制。

Description

一种双回路卫星姿态跟踪控制装置及方法
技术领域
本发明涉及航天测量与控制技术领域，具体的说，是一种适用于微小卫星的双回路卫星姿态跟踪控制装置及方法。
背景技术
目前大部分对姿态机动能力和高精度稳定控制有较高要求的卫星姿控分系统，比如大部分零动量控制卫星的姿控分系统，普遍采用常规PID轮控算法实施卫星控制。随着卫星姿态控制需求的不断提高，对卫星姿态控制提出了更多的机动和控制精度的要求，而现有控制方法无法同时兼顾实现卫星姿态跟踪控制和较高的跟踪控制精度。
因此，为了减少星上姿控算法的复杂程度以及提高姿控软件的可靠性，满足任务多样化的控制需求、提高卫星适应能力，需要对现有卫星姿态跟踪控制方式进行改进。
发明内容
本发明的目的在于，提供一种双回路卫星姿态跟踪控制装置及方法，其能够减少星上姿控算法的复杂程度以及提高姿控软件的可靠性，满足任务多样化的控制需求、提高卫星适应能力。
为实现上述目的，本发明提供了一种双回路卫星姿态跟踪控制装置，包括内环回路和外环回路构成的姿控闭环；所述内环回路包括依次连接的内环控制器、结构滤波模块、延迟模块以及陀螺敏感器；所述外环回路包括依次连接的外环控制器、内环控制器、结构滤波模块、延迟模块、积分模块以及星敏感器；其中，所述内环回路中的内环控制器、结构滤波模块以及延迟模块与所述外环回路共用，所述外环回路的带宽小于所述内环回路；通过内环回路消除卫星姿态角速度偏差，通过外环回路消除卫星姿态角度偏差并控制系统的稳定性。
为了实现上述目的，本发明还提供了一种采用本发明所述的双回路卫星姿态跟踪控制装置的双回路卫星姿态跟踪控制方法，包括以下步骤：（1）外环控制器根据输入的姿态跟踪角度导引律控制系统稳定及卫星姿态角误差为零；（2）内环控制器对输入的卫星姿态角速度进行抑制后，经过结构滤波模块低通滤波以及延迟模块延迟后为卫星星体提供控制力矩，控制力矩与干扰力矩共同作用于卫星星体+卫星太阳能帆板耦合动力学模型后输出的角速度信号；（3）陀螺敏感器测得卫星姿态角速度信息输出一包含测速误差的测量角速度，反馈至所述内环控制器，消除卫星姿态角速度偏差；（4）积分模块将卫星星体+卫星太阳能帆板耦合动力学模型输出的角速度信号积分得到姿态角信号，之后星敏感器输出一包含测角误差的测量姿态角，反馈至所述外环控制器，消除卫星姿态角度偏差并控制系统的稳定性。
本发明的优点在于：基于内外环双环姿态控制结构，内环消除卫星姿态角速度偏差，外环消除姿态角度偏差并保证系统的稳定性，同时解决高精度稳态控制和高精度姿态跟踪控制；同时设计了前馈结构控制器来保证卫星对姿态机动能力。通过双回路PID轮控+前馈控制的设计，兼顾解决了高精度稳态控制和高精度姿态跟踪控制问题，减少了星上姿控算法的复杂程度和提高姿控软件的可靠性，满足任务多样化的控制需求，提高卫星适应能力，提高用户体验。
附图说明
图1，本发明所述的双回路卫星姿态跟踪控制装置的架构图；
图2，本发明所述的双回路卫星姿态跟踪控制方法的流程图。
具体实施方式
下面结合附图对本发明提供的一种双回路卫星姿态跟踪控制装置及方法的具体实施方式做详细说明。
参见图1，本发明所述的双回路卫星姿态跟踪控制装置架构图。所述装置包括内环回路和外环回路构成的姿控闭环，也即双回路PID轮控。
所述内环回路包括依次连接的内环控制器111、结构滤波模块112、延迟模块113以及陀螺敏感器114。所述外环回路包括依次连接的外环控制器121、内环控制器111、结构滤波模块112、延迟模块113、积分模块122以及星敏感器123。其中，所述内环回路中的内内环控制器111、结构滤波模块112以及延迟模块113与所述外环回路共用，所述外环回路的带宽小于所述内环回路；通过内环回路消除卫星姿态角速度偏差，通过外环回路消除卫星姿态角度偏差并控制系统的稳定性。
深入分析现有卫星控制算法技术的局限性，仿真发现，为了提高卫星姿态机动控制能力，通常将常规PID控制算法中的PID参数提高，从而提高了卫星带宽，但是这样的参数设计对角速度测量单机的噪声特性有较强的响应，从而引入了测量单机噪声，降低了控制精度。本发明提出的双回路控制中内环回路对角速度进行控制，能较好的降低角速度测量单机的噪声响应特性，提高了卫星控制精度。也即，利用内环回路抑制速度噪声和干扰，消除卫星姿态角速度偏差。本发明提出的双回路控制中外环回路对角度进行控制，也即用带宽较窄的外环回路克服角度噪声的影响，增强了系统稳定性，提高控制稳态裕度。
内环回路工作原理为：内环控制器111对输入的卫星姿态角速度进行抑制后，经过结构滤波模块112低通滤波以及延迟模块113延迟后为卫星星体17提供控制力矩，控制力矩与干扰力矩共同作用于卫星星体+卫星太阳能帆板耦合动力学模型18后输出的角速度信号，经陀螺敏感器114测得卫星姿态角速度信息输出一包含测速误差的测量角速度，反馈至所述内环控制器111。其中，执行机构为反作用轮模型；卫星星体17为带有挠性帆板的卫星三轴耦合动力学模型；卫星系统存在各种干扰，主要包括重力梯度干扰力矩、太阳辐射力矩、飞轮转速波动力矩、各测量环节噪声、转台扰动干扰力矩等等。引入干扰力矩，以更精确的对卫星姿态进行控制。
内环控制器111：可以采用双积分PI2控制器(Kr＋Kp/s＋Ki /s2)，保证充分的角速度抑制能力，Kr设计为P系数, Kp设计为一阶积分系数，Ki设计为一阶积分系数。
结构滤波模块112：可以采用低通滤波器来消弱挠性模态的影响。
延迟模块113：考虑系统计算、信号传输、控制器反应时间等等的综合延迟作用，设计延迟环节。
陀螺敏感器114：陀螺敏感器测量本体相对于惯性坐标系角速度信息。
外环回路工作原理为：外环控制器121根据导引律模块19输入的姿态跟踪角度导引律控制系统稳定及卫星姿态角误差为零，积分模块122将卫星星体+卫星太阳能帆板耦合动力学模型18输出的角速度信号积分得到姿态角信号，之后星敏感器123输出一包含测角误差的测量姿态角，反馈至所述外环控制器121。
外环控制器121：采用P控制器(Kp)，保证系统稳定性及稳态角度误差为零，Kp设计为P系数。
积分模块122：将卫星星体+卫星太阳能帆板耦合动力学模型18输出的角速度信号积分，得到姿态角信号。
星敏感器123：测量姿态角度信息，输出一包含测角误差的测量姿态角，作为反馈信息，与姿态跟踪角度导引律做差得到误差信号，作为所述外环控制器121的输入，形成闭环控制。
随着双回路控制稳定性的大幅提高，降低了卫星机动控制带宽，因而，作为优选的实施方式，本发明所述的双回路卫星姿态跟踪控制装置进一步包括前馈结构控制器101。所述前馈结构控制器101耦合至所述内环回路和外环回路之间，用于将姿态机动角度和角速度引入姿控闭环，大幅提高了卫星姿态机动控制能力。所述前馈结构控制器101：可以采用微分控制器，D系数。
本发明在深入分析了用户需求的基础上，提出了新的控制方式，基于内外环双环姿态控制结构，内环消除卫星姿态角速度偏差，外环消除姿态角度偏差并保证系统的稳定性，同时解决高精度稳态控制和高精度姿态跟踪控制。同时设计了前馈结构控制器来保证卫星对姿态机动能力。通过双回路PID轮控+前馈控制的设计，兼顾解决了高精度稳态控制和高精度姿态跟踪控制问题，减少了星上姿控算法的复杂程度和提高姿控软件的可靠性，满足任务多样化的控制需求，提高卫星适应能力，提高用户体验。
参见图2，本发明所述的双回路卫星姿态跟踪控制方法，包括以下步骤。
S22：外环控制器根据输入的姿态跟踪角度导引律控制系统稳定及卫星姿态角误差为零。
S24：内环控制器对输入的卫星姿态角速度进行抑制后，经过结构滤波模块低通滤波以及延迟模块延迟后为卫星星体提供控制力矩，控制力矩与干扰力矩共同作用于卫星星体+卫星太阳能帆板耦合动力学模型后输出的角速度信号。
S26：陀螺敏感器测得卫星姿态角速度信息输出一包含测速误差的测量角速度，反馈至所述内环控制器，消除卫星姿态角速度偏差。
本发明提出的双回路控制中内环回路对角速度进行控制，能较好的降低角速度测量单机的噪声响应特性，提高了卫星控制精度。也即，利用内环回路抑制速度噪声和干扰，消除卫星姿态角速度偏差。
S28：积分模块将卫星星体+卫星太阳能帆板耦合动力学模型输出的角速度信号积分得到姿态角信号，之后星敏感器输出一包含测角误差的测量姿态角，反馈至所述外环控制器，消除卫星姿态角度偏差并控制系统的稳定性。
本发明提出的双回路控制中外环回路对角度进行控制，也即用带宽较窄的外环回路克服角度噪声的影响，增强了系统稳定性，提高控制稳态裕度。
随着双回路控制稳定性的大幅提高，降低了卫星机动控制带宽。因而，作为优选的实施方式，本发明所述的双回路卫星姿态跟踪控制装置进一步包括前馈结构控制器，所述方法进一步包括：通过所述前馈结构控制器将姿态机动角度和角速度引入姿控闭环。通过前馈结构控制器将姿态机动角度和角速度引入姿控闭环，大幅提高了卫星姿态机动控制能力。
以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。

Claims (5)

1.一种双回路卫星姿态跟踪控制装置，其特征在于，包括内环回路和外环回路构成的姿控闭环；
所述内环回路包括依次连接的内环控制器、结构滤波模块、延迟模块以及陀螺敏感器；
所述外环回路包括依次连接的外环控制器、内环控制器、结构滤波模块、延迟模块、积分模块以及星敏感器；
其中，所述内环回路中的内环控制器、结构滤波模块以及延迟模块与所述外环回路共用，所述外环回路的带宽小于所述内环回路；通过内环回路消除卫星姿态角速度偏差，通过外环回路消除卫星姿态角度偏差并控制系统的稳定性；
所述装置进一步包括一前馈结构控制器，所述前馈结构控制器耦合至所述内环回路和外环回路之间，用于将姿态机动角度和角速度引入姿控闭环。
2.根据权利要求1所述的双回路卫星姿态跟踪控制装置，其特征在于，所述内环控制器采用双积分PI2控制器。
3.根据权利要求1所述的双回路卫星姿态跟踪控制装置，其特征在于，所述外环控制器采用P控制器。
4.根据权利要求3所述的双回路卫星姿态跟踪控制装置，其特征在于，前馈控制环节：采用微分控制器。
5.一种采用权利要求1所述的双回路卫星姿态跟踪控制装置的双回路卫星姿态跟踪控制方法，其特征在于，包含如下步骤：
(1)外环控制器根据输入的姿态跟踪角度导引律控制系统稳定及卫星姿态角误差为零；
(2)内环控制器对输入的卫星姿态角速度进行抑制后，经过结构滤波模块低通滤波以及延迟模块延迟后为卫星星体提供控制力矩，控制力矩与干扰力矩共同作用于卫星星体+卫星太阳能帆板耦合动力学模型后输出的角速度信号；
(3)陀螺敏感器测得卫星姿态角速度信息输出一包含测速误差的测量角速度，反馈至所述内环控制器，消除卫星姿态角速度偏差；
(4)积分模块将卫星星体+卫星太阳能帆板耦合动力学模型输出的角速度信号积分得到姿态角信号，之后星敏感器输出一包含测角误差的测量姿态角，反馈至所述外环控制器，消除卫星姿态角度偏差并控制系统的稳定性；
所述装置进一步包括一前馈结构控制器，所述方法进一步包括：
通过所述前馈结构控制器将姿态机动角度和角速度引入姿控闭环。
CN201410283960.3A 2014-06-24 2014-06-24 一种双回路卫星姿态跟踪控制装置及方法 Active CN104102224B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410283960.3A CN104102224B (zh) 2014-06-24 2014-06-24 一种双回路卫星姿态跟踪控制装置及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410283960.3A CN104102224B (zh) 2014-06-24 2014-06-24 一种双回路卫星姿态跟踪控制装置及方法

Publications (2)

Publication Number Publication Date
CN104102224A CN104102224A (zh) 2014-10-15
CN104102224B true CN104102224B (zh) 2016-09-07

Family

ID=51670445

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410283960.3A Active CN104102224B (zh) 2014-06-24 2014-06-24 一种双回路卫星姿态跟踪控制装置及方法

Country Status (1)

Country Link
CN (1) CN104102224B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106843256B (zh) * 2017-03-30 2020-08-07 上海航天控制技术研究所 一种采用位置速度双回路的卫星控制方法
CN107628273B (zh) * 2017-09-27 2019-06-04 上海航天控制技术研究所 一种基于可变控制周期的卫星姿态控制方法
CN110687782B (zh) * 2019-09-10 2022-09-02 中国航空工业集团公司洛阳电光设备研究所 电力自动巡线吊舱角度从动稳态误差预测与前馈补偿控制方法
CN112197803B (zh) * 2020-09-29 2022-04-15 北京环境特性研究所 船载光电传感器控制方法和装置

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH03220099A (ja) * 1990-01-24 1991-09-27 Toshiba Corp 人工衛星の姿勢制御装置
CN1074417A (zh) * 1991-09-06 1993-07-21 联邦德国航空航天有限公司 对绕着一固定轴旋转移动的宇宙飞行器进行姿态控制的装置和方法
JPH10244997A (ja) * 1997-03-05 1998-09-14 Mitsubishi Electric Corp 人工衛星の姿勢制御装置
US6131056A (en) * 1998-03-16 2000-10-10 Honeywell International Inc. Continuous attitude control that avoids CMG array singularities
CN101236092A (zh) * 2008-01-31 2008-08-06 北京控制工程研究所 紫外导航敏感器
CN101554926A (zh) * 2009-05-20 2009-10-14 上海微小卫星工程中心 航天器的姿态控制系统及方法
CN101576750A (zh) * 2009-04-14 2009-11-11 上海微小卫星工程中心 航天器的姿态跟踪控制系统及方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7142981B2 (en) * 2003-08-05 2006-11-28 The Boeing Company Laser range finder closed-loop pointing technology of relative navigation, attitude determination, pointing and tracking for spacecraft rendezvous

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH03220099A (ja) * 1990-01-24 1991-09-27 Toshiba Corp 人工衛星の姿勢制御装置
CN1074417A (zh) * 1991-09-06 1993-07-21 联邦德国航空航天有限公司 对绕着一固定轴旋转移动的宇宙飞行器进行姿态控制的装置和方法
JPH10244997A (ja) * 1997-03-05 1998-09-14 Mitsubishi Electric Corp 人工衛星の姿勢制御装置
US6131056A (en) * 1998-03-16 2000-10-10 Honeywell International Inc. Continuous attitude control that avoids CMG array singularities
CN101236092A (zh) * 2008-01-31 2008-08-06 北京控制工程研究所 紫外导航敏感器
CN101576750A (zh) * 2009-04-14 2009-11-11 上海微小卫星工程中心 航天器的姿态跟踪控制系统及方法
CN101554926A (zh) * 2009-05-20 2009-10-14 上海微小卫星工程中心 航天器的姿态控制系统及方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
卫星平台与天线去耦合控制;王磊;《中国博士学位论文全文数据库 工程科技Ⅱ辑》;20140115(第1期);第1-91页 *
大挠性多体卫星的自抗扰姿态控制系统设计;朱承元;《航天控制》;20041231;第22卷(第6期);第25-31页 *
小卫星姿态快速机动与稳定控制方法研究;李紫涵;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20120515(第5期);全文 *
带双轴太阳帆板驱动器的卫星建模与姿态控制;甘克力;《电机与控制学报》;20130131;第17卷(第1期);第82-87页 *

Also Published As

Publication number Publication date
CN104102224A (zh) 2014-10-15

Similar Documents

Publication Publication Date Title
CN104102224B (zh) 一种双回路卫星姿态跟踪控制装置及方法
CA2833877C (en) Formation flight control
Low et al. GPS-based path following control for a car-like wheeled mobile robot with skidding and slipping
Low et al. GPS-based tracking control for a car-like wheeled mobile robot with skidding and slipping
CN106774409B (zh) 一种无人机的半自主仿地飞行系统及其控制方法
CN104266663B (zh) 一种运动平台光电跟踪系统二级稳定扰动解耦方法
CN105259908A (zh) 一种雷达引导无人机自动着舰制导与控制系统及其控制方法
CN105005311B (zh) 一种飞行器俯仰通道攻角同步跟踪控制方法
CN109508025B (zh) 一种弹性飞行器的自抗扰姿态控制方法
CN102298389A (zh) 无人机起飞降落阶段的地面站全权接管控制系统
CN104097791A (zh) 一种基于磁敏感器和星敏感器的全姿态捕获方法及其装置
CN103576693A (zh) 基于二阶滤波器的水下机器人三维路径跟踪控制方法
US8996598B2 (en) Latency compensation
Jia et al. Accurate high-maneuvering trajectory tracking for quadrotors: A drag utilization method
CN103587681A (zh) 抑制侧滑角信号常值偏差影响的高超声速飞行器控制方法
CN104085539B (zh) 成像定标的姿态控制方法
CN103995465A (zh) 一种横侧向导引律设计方法
CN111061286B (zh) 一种滤波微分提供阻尼实现飞行器侧向过载控制的方法
RU68145U1 (ru) Система автоматического управления беспилотным летательным аппаратом
CN106354147A (zh) 一种基于发动机预摆的大质心横移下的姿轨控耦合控制系统与方法
Tao et al. A PID and fuzzy logic based method for Quadrotor aircraft control motion
CN204790578U (zh) 一种无人飞行器通用自动驾驶仪
CN106494643B (zh) 一种基于地心矢量信息的卫星姿态异常恢复控制方法
CN102880049A (zh) 一种基于帆板挠性形变测量的自适应振动控制方法
CN107807516A (zh) 一种基于模糊自适应pid控制的模拟转台控制系统

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant