CN106020221B - 一种基于输出反馈的抗干扰姿态控制验证平台及验证方法 - Google Patents

一种基于输出反馈的抗干扰姿态控制验证平台及验证方法 Download PDF

Info

Publication number
CN106020221B
CN106020221B CN201610370208.1A CN201610370208A CN106020221B CN 106020221 B CN106020221 B CN 106020221B CN 201610370208 A CN201610370208 A CN 201610370208A CN 106020221 B CN106020221 B CN 106020221B
Authority
CN
China
Prior art keywords
interference
attitude
attitude control
output feedback
spacecraft
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
CN201610370208.1A
Other languages
English (en)
Other versions
CN106020221A (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.)
Beihang University
Original Assignee
Beihang University
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 Beihang University filed Critical Beihang University
Priority to CN201610370208.1A priority Critical patent/CN106020221B/zh
Publication of CN106020221A publication Critical patent/CN106020221A/zh
Application granted granted Critical
Publication of CN106020221B publication Critical patent/CN106020221B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种基于输出反馈的抗干扰姿态控制验证平台及验证方法,包括实时仿真目标机、姿态确定模块、姿态控制模块、反作用飞轮组、试验主控模块、干扰模拟器和三轴气浮台;实时仿真目标机运算航天器姿态运动学模型;姿态确定模块滤波与解算实时仿真目标机输出的姿态信息;姿态控制模块运算姿态控制算法,为反作用飞轮组提供力矩控制指令;反作用飞轮组接收力矩控制指令后输出力矩信号至仿真目标机;试验主控模块向姿态控制模块发送控制方法切换信号,抗干扰姿态控制单元根据该切换信号运行相应控制算法;干扰模拟器模拟挠性部件振动干扰;三轴气浮台模拟航天器在外层空间的力学环境。本发明验证了基于输出反馈的抗干扰姿态控制方法的有效性。

Description

一种基于输出反馈的抗干扰姿态控制验证平台及验证方法
技术领域
本发明涉及一种基于输出反馈的抗干扰姿态控制验证平台及验证方法,属于航天器的姿态控制领域。
背景技术
随着空间技术的不断发展和航天需要的不断增长,越来越多的航天器携带有大型抛物面天线、太阳帆板、空间机械臂等挠性机构,这些挠性机构使航天器的功能日益强大,但同时也给航天器的姿态控制问题带来了严峻的考验,尤其是当航天器的控制精度要求较高时,如对地观测卫星、太空望远镜等。这种大挠性、低阻尼的结构一旦遇到外界干扰将产生了振动,振动将会严重影响有效荷载的正常工作,导致性能下降或失效。此外,航天器含有多源干扰,既包括太阳光压、大气阻力、空间尘埃等外部环境干扰,航天器本身又有帆板振动、执行机构误差、敏感器测量噪声等内部扰动。包含挠性部件振动干扰在内的多源干扰严重影响航天器的控制精度,尤其是航天器硬件固定的情况下,难以在硬件上进一步挖掘控制精度提升的空间,因此对抗干扰姿态控制方法的研究及应用成为提高控制精度的重要新途径。基于干扰观测器的控制能够充分利用干扰的特性,实现了干扰的高精度估计与补偿。此外,基于干扰观测器的控制易于与其它控制方式相结合,设计复合姿态控制器来同时实现干扰的补偿与抑制,从而提升挠性航天器的姿态控制精度。另外,现阶段大多数姿态控制方法都通过假定***的全部状态可测来设计控制器。但在实际的航天工程中难以满足上述假设,如在部分测量敏感器出现故障的情况下。而且由于角速度测量成本等原因,越来越多的学者在研究无角速度量测的情况下的姿态控制问题,实际上是一种输出反馈的姿态控制问题。因此,基于输出反馈的抗干扰姿态控制方法具备很强的理论及实用意义。
姿控方法验证平台已经在航天器研制过程中得到了广泛应用,国内航天五院502所、航天八院812所,还有哈工大、清华、北航等高校都曾研制出姿控方法验证平台,但现有的姿控方法验证装置通常针对特定型号的航天器而研制,有的仅仅针对某特定航天任务,为验证某种特定方法搭建,忽略了挠性部件振动等干扰的影响,无法用于针对挠性部件振动干扰的多种抗干扰姿态控制方法研究。2010年7月发表于《北京航空航天大学学报》第36卷第7期的文献《基于气浮台的微小卫星姿态控制实时仿真》搭建了半物理仿真实验平台对单刚体微小卫星的姿态控制问题进行了实时仿真研究,其控制方法为传统PID控制方法,该方法不能有效抵消挠性部件振动带来的干扰,同时该试验平台无法完成多种抗干扰控制方法的测试分析。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供一种基于输出反馈的抗干扰姿态控制验证平台及验证方法,基于输出反馈的抗干扰姿态控制方法可以实现干扰的同时补偿与抑制,能显著提高***实时性、精度和稳定度,可用于挠性航天器的高精度姿态控制;验证装置与验证方法可用于验证包括基于输出反馈的抗干扰姿态控制方法在内的多种姿态控制方法,并能够实现不同姿态控制方法下控制效果的测试分析,验证了基于输出反馈的抗干扰姿态控制方法的有效性。
所设计的一种基于输出反馈的抗干扰姿态控制方法验证平台,克服了现有姿态控制方法验证平台对挠性部件振动干扰研究的缺失,该验证平台可以研究航天器飞行过程中来自挠性部件振动对控制***的影响并进行综合分析,同时通过切换不同控制信号,姿态控制单元逐次验证多种控制方法,试验主控模块中的数据存储分析与对比测试单元能够完成包括基于输出反馈的抗干扰姿态控制方法在内的多种控制方法的对比测试分析。针对带有挠性机构的航天器,克服现有技术的不足,利用已知信息,设计一种基于输出反馈的抗干扰姿态控制方法,实现了干扰的同时补偿与抑制,从而提升姿态控制***的鲁棒性、控制精度和抗干扰能力。
本发明的技术解决方案为:一种基于输出反馈的抗干扰姿态控制方法验证平台,包括实时仿真目标机、姿态确定模块、姿态控制模块、反作用飞轮组、试验主控模块、干扰模拟器以及三轴气浮台;所述实时仿真目标机实时运算航天器运动学模型;所述姿态确定模块对实时仿真目标机输出的姿态信息进行实时滤波与解算;所述姿态控制模块实时运算姿态控制算法,为反作用飞轮组提供力矩控制指令,包括了抗干扰姿态控制单元和无线接收单元,抗干扰姿态控制单元运算控制算法,无线接收单元接收试验主控模块发出的控制方法切换指令;所述反作用飞轮组在接收力矩控制指令后,将输出力矩信号传给实时仿真目标机;试验主控模块用于向姿态控制模块发送控制方法切换信号,该切换信号通过无线发送单元发出,姿态控制模块中的抗干扰姿态控制单元根据无线接收单元接收控制方法切换信号,运行相应的控制算法,数据存储分析与对比测试单元存储不同控制算法下的仿真实时运算数据,用于对比分析不同控制算法下的控制效果,此外,试验主控模块也用于向干扰模拟器发出试验指令,使其工作或关断;干扰模拟器用来模拟挠性部件振动干扰;三轴气浮台作为仿真的支撑平台,实时仿真目标机、姿态确定模块、姿态控制模块以及反作用飞轮组安装在气浮台上,气浮台的转动用来模拟航天器在外层空间的姿态变化;验证平台的数据流回路如下:航天器的期望姿态通过姿态控制模块的导入***回路,该期望姿态信号通过与姿态确定模块滤波后的姿态信息进行比较,得到偏差信号;将此偏差信号传递给姿态控制模块,该模块接收试验主控模块中控制方法切换信号后选择并运行相应的控制方法,该姿态控制方法解算出指令力矩信号并传送至反作用飞轮组;反作用飞轮组在接收指令力矩信号后输出执行力矩信号,该力矩作用在三轴气浮台的台面,三轴气浮台模拟航天器在外层空间的力学环境,三轴气浮台检测到飞轮输出力矩作用下的台面转动角速度,转动角速度信号传入实时仿真目标机;试验主控模块控制干扰模拟器开通与关断,模拟的挠性部件干扰加载到实时仿真目标机,仿真目标机运算加入挠性部件干扰后的运动学模型,得到包括航天器三轴转动角度和三轴转动角速度的姿态信息,航天器姿态信息的实时数据传输给试验主控模块中的数据存储分析与对比测试单元,该单元保存实时运算数据,同时该姿态信息传送至姿态确定模块;姿态确定模块将经过滤波后得到的姿态信息与期望姿态作比较后获得新的偏差信号,形成了验证平台的数据流回路。
所述的一种基于输出反馈的抗干扰姿态控制方法验证装置,其中的抗干扰姿态控制单元通过接收控制信号切换指令,能够实现姿态控制算法的选择并运行相应的姿态控制算法,因此,该验证装置能够完成多种姿态控制算法下控制效果对比分析。
其中运行于姿态控制模块中的基于输出反馈的抗干扰姿态控制方法,包括以下步骤:首先,用状态空间方法描述包含挠性部件振动干扰的航天器姿态动力学模型;其次,设计干扰观测器对挠性部件振动干扰进行估计;再次,设计动态输出反馈控制器,并将动态输出反馈控制器与干扰观测器进行复合;最后,求解干扰观测器与动态输出反馈控制器的增益矩阵,完成基于输出反馈的姿态控制方法的设计;具体设计步骤如下:
第一步:用状态空间方法描述包含挠性部件振动干扰的航天器姿态动力学模型;
建立航天器姿态动力学模型,如下表示:
J1,J2,J3分别为三轴的转动惯量,n为航天器轨道角速度,φ(t),θ(t),ψ(t)分别为航天器本体坐标系和轨道坐标系之间的三轴欧拉角,即滚转角、俯仰角和偏航角;分别为三轴姿态角速度;分别为三轴姿态角加速度;Td1(t),Td2(t),Td3(t)分别为三轴干扰力矩,u1(t),u2(t),u3(t)分别为三轴控制力矩;从姿态动力学模型中提取惯量矩阵,航天器姿态动力学模型转化为如下形式:
其中d1(t)=[Td1(t),Td2(t),Td3(t)]T表示干扰力矩;u(t)=[u1(t),u2(t),u3(t)]T为航天器姿态控制***的控制输入,
p(t)=[φ(t),θ(t),ψ(t)]T为三轴欧拉角,ep(t)=p(t)-pp(t),pp(t)为参考轨迹信号,定义:
考虑到航天器姿态控制***中会发生挠性部件振动干扰和三轴干扰力矩的情况,则采用状态空间形式描述的航天器姿态控制***为:
其中,
x(t)、u(t)、d0(t)和d1(t)分别为航天器姿态控制***的状态变量、控制输入、挠性部件振动干扰和三轴干扰力矩;y(t)为量测输出,C为量测矩阵,且C为非满秩矩阵,因此航天器姿态控制***部分状态不可测;
第二步:设计干扰观测器对挠性部件振动干扰进行估计;
针对上述航天器姿态控制***中的挠性部件振动干扰d0(t),挠性部件振动干扰模型由下式表示:
其中,w(t)是挠性部件振动干扰的状态变量,B3是不可建模随机干扰的增益阵,δ(t)是能量有界的不可建模随机干扰,系数矩阵V为挠性部件振动干扰模型的输出矩阵,W表示挠性部件振动干扰模型的***阵,考虑到航天器姿态控制***状态不是全部可测,构造如下干扰观测器:
其中,为w(t)的估计值,v(t)为辅助变量,L为待定的干扰观测器增益矩阵;则航天器姿态控制***的干扰估计误差ew(t)满足:
其中,
第三步:设计动态输出反馈控制器,并将动态输出反馈控制器与干扰观测器进行复合;
设计动态输出反馈控制器为:
将干扰观测器与动态输出反馈控制器进行复合,得到如下抗干扰姿态控制方法:
其中xk是动态输出反馈控制器的状态,Ak、Bk、Ck、Dk为待定的动态输出反馈控制器系数矩阵,u1(t)为动态输出反馈控制器的输入,u(t)为航天器姿态控制***的控制输入;
第四步:求解干扰观测器与动态输出反馈控制器的增益矩阵,完成基于输出反馈的抗干扰姿态控制方法的设计;
联立干扰估计误差满足条件方程、状态空间描述方程以及将干扰观测器与动态输出反馈控制器复合后的方程,得到复合***如下:
其中,未知参数Ak、Bk、Ck、Dk以及L由以下凸优化算法求解:
其中,
Φ22=Q1W+YCBV+(Q1W+YCBV)T,Φ23=(YCB+Q1B1),P2>0,Q1>0,S>0,Ac,Bc,Cc,Dc,Y为矩阵变量,C1表示H性能可调输出矩阵,γ>0为给定的常数,0表示零元素或零矩阵,I表示单位矩阵,“*”表示对称矩阵的对称部分,则干扰观测器与动态输出反馈控制器的增益矩阵为:
本发明与现有技术相比的优点在于:
(1)本发明克服了现有姿态控制方法验证平台对挠性部件振动干扰研究的缺失,针对航天器飞行过程中存在的挠性部件振动干扰,提出了基于输出反馈的抗干扰姿态控制方法,能显著提高航天器姿态控制***实时性、精度和稳定度。
(2)本发明的姿态控制模块通过接收不同控制信号,姿态控制单元选择并运行相应控制方法,因此本发明能够逐次验证多种控制方法,克服了传统航天器姿态控制方法验证平台只能验证一种控制方法的不足,同时数据存储分析对比测试单元对比不同姿态控制方法下控制效果的优劣,完成测试分析。
附图说明
图1为本发明基于输出反馈的抗干扰姿态控制方法验证平台的数据流回路;
图2为本发明基于输出反馈的抗干扰姿态控制方法的设计流程图。
具体实施方式
下面结合附图对本发明的具体实施方式做进一步详细说明。
以微纳三轴稳定卫星的姿控***仿真试验为例,来说明验证平台以及基于输出反馈的抗干扰姿态控制方法。
本发明的基于输出反馈的抗干扰姿态控制方法验证平台包括实时仿真目标机1、姿态确定模块2、姿态控制模块3、反作用飞轮组4、试验主控模块5、干扰模拟器6以及三轴气浮台7;所述实时仿真目标机实时运算微纳卫星运动学模型;所述姿态确定模块2对实时仿真目标机1输出的姿态信息进行实时滤波与解算;所述姿态控制模块3实时运算姿态控制算法,为反作用飞轮组4提供力矩控制指令,包括了抗干扰姿态控制单元31和无线接收单元32,抗干扰姿态控制单元31运算姿态控制算法,无线接收单元32接收试验主控模块5发出的姿态控制方法切换指令;所述反作用飞轮组4在接收力矩控制指令后,将输出力矩信号传给实时仿真目标机1;试验主控模块5用于向姿态控制模块3发送控制方法切换信号,该切换信号通过无线发送单元52发出,姿态控制模块3中的抗干扰姿态控制31单元通过根据无线接收单元32接收控制信号切换指令,能够实现控制算法的选择并运行相应的控制算法。数据存储分析与对比测试单元53存储不同姿态控制算法下的仿真实时运算数据,因此,该验证平台能够完成多种姿态控制算法下控制效果对比分析。此外,试验主控模块也用于向干扰模拟器发出试验指令,使其工作或关断;干扰模拟器6用来模拟挠性部件振动干扰;三轴气浮台7作为仿真的支撑平台,实时仿真目标机1、姿态确定模块2、姿态控制模块3以及反作用飞轮组4安装在气浮台上,气浮台的转动用来模拟微纳卫星在外层空间的姿态变化;验证平台的数据流回路如下:微纳卫星的期望姿态通过姿态控制模块3的导入***回路,该期望姿态信号通过与姿态确定模块2滤波后的姿态信息进行比较,得到偏差信号;将此偏差信号传递给姿态控制模块3,该模块接收试验主控模块5中控制方法切换信号后选择并运行相应的姿态控制方法,可供选择的姿态控制方法包括基于飞轮输出偏差的抗干扰姿态控制方法、基于滑模变结构的航天器姿态控制方法和航天器姿态PID控制方法,被选择的姿态控制方法解算出指令力矩信号并传送至反作用飞轮组4;反作用飞轮组4在接收指令力矩信号后输出执行力矩信号,该力矩作用在三轴气浮台7的台面,三轴气浮台7模拟微纳卫星在外层空间的力学环境,三轴气浮台7检测到飞轮输出力矩作用下的台面转动角速度,转动角速度信号传入实时仿真目标机1;试验主控模块5控制干扰模拟器6开通与关断,模拟的挠性部件干扰加载到实时仿真目标机1,仿真目标机1运算加入挠性部件干扰后的运动学模型,得到包括微纳卫星三轴转动角度和三轴转动角速度的姿态信息,微纳卫星姿态信息的实时数据传输给试验主控模块5中的数据存储分析与对比测试单元53,该单元保存实时运算数据,同时该姿态信息传送至姿态确定模块2;姿态确定模块2将经过滤波后得到的姿态信息与期望姿态作比较后获得新的偏差信号,形成了验证平台的数据流回路。
如图2所示,基于输出反馈的抗干扰姿态控制方法包括以下步骤:首先,用状态空间方法描述包含挠性部件振动干扰的微纳卫星姿态动力学模型;其次,设计干扰观测器对挠性部件振动干扰进行估计;再次,设计动态输出反馈控制器,并将动态输出反馈控制器与干扰观测器进行复合;最后,求解干扰观测器与动态输出反馈控制器的增益矩阵,完成基于输出反馈的姿态控制方法的设计;具体设计步骤如下:
1.用状态空间方法描述包含挠性部件振动干扰的航天器姿态动力学模型;
建立航天器姿态动力学模型,如下表示:
J1,J2,J3分别为三轴的转动惯量,n为航天器轨道角速度,φ(t),θ(t),ψ(t)分别为航天器本体坐标系和轨道坐标系之间的三轴欧拉角,即滚转角、俯仰角和偏航角;分别为三轴姿态角速度;分别为三轴姿态角加速度;Td1(t),Td2(t),Td3(t)分别为三轴干扰力矩,u1(t),u2(t),u3(t)分别为三轴控制力矩;从姿态动力学模型中提取惯量矩阵,航天器姿态动力学模型转化为如下形式:
其中d1(t)=[Td1(t),Td2(t),Td3(t)]T表示干扰力矩;u(t)=[u1(t),u2(t),u3(t)]T为***的控制输入,
p(t)=[φ(t),θ(t),ψ(t)]T为三轴欧拉角,ep(t)=p(t)-pp(t),pp(t)为参考轨迹信号,定义:
考虑到航天器姿态控制***中会发生挠性部件振动干扰和三轴干扰力矩的情况,则采用状态空间形式描述的航天器姿态控制***为:
其中,
x(t)、u(t)、d0(t)和d1(t)分别为航天器姿态控制***的状态变量、控制输入、挠性部件振动干扰和三轴干扰力矩;y(t)为量测输出,C为量测矩阵,且C为非满秩矩阵,因此航天器姿态控制***部分状态不可测;
2.设计干扰观测器对挠性部件振动干扰进行估计;
针对上述航天器姿态控制***中的挠性部件振动干扰d0(t),挠性部件振动干扰模型由下式表示:
其中,w(t)是挠性部件振动干扰的状态变量,B3是不可建模随机干扰的增益阵,δ(t)是能量有界的不可建模随机干扰,系数矩阵V为挠性部件振动干扰模型的输出矩阵,W表示挠性部件振动干扰模型的***阵,考虑到航天器姿态控制***的状态不是全部可测,构造如下干扰观测器:
其中,为w(t)的估计值,v(t)为辅助变量,L为待定的干扰观测器增益矩阵;则航天器姿态控制***的干扰估计误差ew(t)满足:
其中,
3.设计动态输出反馈控制器,并将动态输出反馈控制器与干扰观测器进行复合;
设计动态输出反馈控制器为:
将干扰观测器与动态输出反馈控制器进行复合,得到如下抗干扰姿态控制方法:
其中xk是动态输出反馈控制器的状态,Ak、Bk、Ck、Dk为待定的动态输出反馈控制器系数矩阵,u1(t)为动态输出反馈控制器的输入,u(t)为航天器姿态控制***的控制输入;
4.求解干扰观测器与动态输出反馈控制器的增益矩阵,完成基于输出反馈的抗干扰姿态控制方法的设计;
联立干扰估计误差满足条件方程、状态空间描述方程以及将干扰观测器与动态输出反馈控制器复合后的方程,得到复合***如下:
其中,未知参数Ak、Bk、Ck、Dk以及L由以下凸优化算法求解:
其中,
Φ22=Q1W+YCBV+(Q1W+YCBV)T,Φ23=(YCB+Q1B1),P2>0,Q1>0,S>0,Ac,Bc,Cc,Dc,Y为矩阵变量,C1表示H性能可调输出矩阵,γ>0为给定的常数,0表示零元素或零矩阵,I表示单位矩阵,“*”表示对称矩阵的对称部分,则干扰观测器与动态输出反馈控制器的增益矩阵为:
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。

Claims (6)

1.一种基于输出反馈的抗干扰姿态控制验证平台,其特征在于:所述验证装置包括实时仿真目标机、姿态确定模块、姿态控制模块、反作用飞轮组、试验主控模块、干扰模拟器以及三轴气浮台;所述实时仿真目标机实时运算航天器运动学模型,得到包括航天器三轴转动角度和三轴转动角速度的姿态信息;所述姿态确定模块对实时仿真目标机输出的所述姿态信息进行实时滤波与解算;所述姿态控制模块实时运算姿态控制算法,所述姿态控制算法包括基于输出反馈的抗干扰姿态控制方法与其它已知姿态控制方法,为反作用飞轮组提供力矩控制指令,所述姿态控制模块包括抗干扰姿态控制单元和无线接收单元,抗干扰姿态控制单元运算所述姿态控制算法,无线接收单元接收试验主控模块发出的姿态控制方法切换指令;所述反作用飞轮组在接收力矩控制指令后,将输出力矩信号传给实时仿真目标机;试验主控模块用于向姿态控制模块发送控制方法切换信号,该切换信号通过无线发送单元发出,姿态控制模块中的抗干扰姿态控制单元根据无线接收单元接收姿态控制方法切换信号,选择并运行包括基于输出反馈的抗干扰姿态控制方法与其它已知姿态控制方法在内的相应的姿态控制算法,数据存储分析与对比测试单元存储不同姿态控制算法下的仿真实时运算数据,用于对比分析不同姿态控制算法下的控制效果,此外,试验主控模块也用于向干扰模拟器发出试验指令,使其工作或关断;干扰模拟器用来模拟挠性部件振动干扰;三轴气浮台作为仿真的支撑平台,实时仿真目标机、姿态确定模块、姿态控制模块以及反作用飞轮组安装在气浮台上,气浮台的转动用来模拟航天器在外层空间的姿态变化;
所述基于输出反馈的抗干扰姿态控制方法步骤如下:
第一步,采用状态空间方法描述包含挠性部件振动干扰的航天器姿态动力学模型;
第二步,针对第一步中状态空间方法描述的航天器姿态动力学模型中的挠性部件振动干扰设计干扰观测器对挠性部件振动干扰进行估计;
第三步,设计动态输出反馈控制器,并将动态输出反馈控制器与第二步设计的干扰观测器进行复合;
第四步,最后,求解第二步设计的干扰观测器的增益矩阵与第三步设计的动态输出反馈控制器的增益矩阵,完成基于输出反馈的抗干扰姿态控制方法的设计。
2.根据权利要求1所述的基于输出反馈的抗干扰姿态控制验证平台,其特征在于:所述第一步,航天器姿态动力学模型如下表示:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>J</mi> <mn>1</mn> </msub> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>J</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>J</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mn>4</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>J</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> <mi>&amp;phi;</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>u</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>T</mi> <mrow> <mi>d</mi> <mn>1</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>J</mi> <mn>2</mn> </msub> <mover> <mi>&amp;theta;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mn>3</mn> <msup> <mi>n</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>J</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> <mi>&amp;theta;</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>u</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>T</mi> <mrow> <mi>d</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>J</mi> <mn>3</mn> </msub> <mover> <mi>&amp;psi;</mi> <mo>&amp;CenterDot;&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>1</mn> </msub> <mo>-</mo> <msub> <mi>J</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>J</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> <mover> <mi>&amp;phi;</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>n</mi> <mn>2</mn> </msup> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>J</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mi>&amp;psi;</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>u</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>T</mi> <mrow> <mi>d</mi> <mn>3</mn> </mrow> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>
J1,J2,J3分别为三轴的转动惯量,n为航天器轨道角速度,t为时间,φ(t),θ(t),ψ(t)分别为航天器本体坐标系和轨道坐标系之间的三轴欧拉角,即滚转角、俯仰角和偏航角;分别为三轴姿态角速度;分别为三轴姿态角加速度;Td1(t),Td2(t),Td3(t)分别为三轴干扰力矩,u1(t),u2(t),u3(t)分别为三轴控制力矩;
航天器姿态动力学模型转化为如下形式:
其中d1(t)=[Td1(t),Td2(t),Td3(t)]T表示干扰力矩;u(t)=[u1(t),u2(t),u3(t)]T为航天器姿态控制***的控制输入,
p(t)=[φ(t),θ(t),ψ(t)]T为三轴欧拉角,为p(t)的一阶导数,为p(t)的二阶导数,ep(t)=p(t)-pp(t),pp(t)为参考轨迹信号,定义:
<mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mrow> <mo>&amp;lsqb;</mo> <munderover> <mo>&amp;Integral;</mo> <mn>0</mn> <mi>t</mi> </munderover> <msub> <mi>e</mi> <mi>p</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;tau;</mi> <mo>)</mo> </mrow> <mi>d</mi> <mi>&amp;tau;</mi> <mo>,</mo> <msub> <mi>e</mi> <mi>p</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>,</mo> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>p</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> </mrow> <mi>T</mi> </msup> </mrow>
考虑到航天器姿态控制***中会发生挠性部件振动干扰和三轴干扰力矩的情况,则采用状态空间形式描述的航天器姿态控制***为:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>A</mi> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>B</mi> <mrow> <mo>(</mo> <mi>u</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <msub> <mi>d</mi> <mn>0</mn> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>B</mi> <mn>1</mn> </msub> <msub> <mi>d</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>C</mi> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>
其中,
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>A</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msup> <mi>M</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>K</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <msup> <mi>M</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>C</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>B</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>M</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msub> <mi>B</mi> <mi>u</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <msub> <mi>B</mi> <mn>1</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>M</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msub> <mi>B</mi> <mi>w</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
A,B,B1为系数矩阵;
x(t)、u(t)、d0(t)和d1(t)分别为航天器姿态控制***的状态变量、控制输入、挠性部件振动干扰和三轴干扰力矩;是x(t)的一阶导数,y(t)为量测输出,C为量测矩阵,且C为非满秩矩阵,因此航天器姿态控制***部分状态不可测。
3.根据权利要求1所述的基于输出反馈的抗干扰姿态控制验证平台,其特征在于:所述第二步:构造干扰观测器对挠性部件振动干扰进行估计如下:
针对航天器姿态控制***中的挠性部件振动干扰d0(t),挠性部件振动干扰模型由下式表示:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>d</mi> <mn>0</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>V</mi> <mi>w</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>w</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>W</mi> <mi>w</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>B</mi> <mn>3</mn> </msub> <mi>&amp;delta;</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>
其中,w(t)是挠性部件振动干扰的状态变量,是w(t)的一阶导数,B3是不可建模随机干扰的增益阵,δ(t)是能量有界的不可建模随机干扰,系数矩阵V为挠性部件振动干扰模型的输出矩阵,W表示挠性部件振动干扰模型的***阵;考虑到航天器姿态控制***状态不是全部可测,构造如下干扰观测器:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mn>0</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>V</mi> <mover> <mi>w</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>w</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>v</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mi>L</mi> <mi>y</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>v</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mrow> <mo>(</mo> <mi>W</mi> <mo>+</mo> <mi>L</mi> <mi>C</mi> <mi>B</mi> <mi>V</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mi>v</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>-</mo> <mi>L</mi> <mi>y</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <mi>L</mi> <mi>C</mi> <mi>B</mi> <mi>u</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>
其中,为w(t)的估计值,v(t)为辅助变量,L为待定的干扰观测器增益矩阵;则航天器姿态控制***的干扰估计误差ew(t)满足:
<mrow> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>w</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mrow> <mo>(</mo> <mi>W</mi> <mo>+</mo> <mi>L</mi> <mi>C</mi> <mi>B</mi> <mi>V</mi> <mo>)</mo> </mrow> <msub> <mi>e</mi> <mi>w</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>L</mi> <mi>C</mi> <mi>A</mi> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>LCB</mi> <mn>1</mn> </msub> <msub> <mi>d</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow>
其中, 为干扰估计误差的一阶导数,C为量测矩阵;d1(t)=[Td1(t),Td2(t),Td3(t)]T表示干扰力矩,Td1(t),Td2(t),Td3(t)分别为三轴干扰力矩;y(t)为量测输出,x(t)为航天器姿态控制***的状态变量,u(t)为航天器姿态控制的控制输入,t为时间;
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>A</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msup> <mi>M</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>K</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <msup> <mi>M</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>C</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <mi>B</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>M</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msub> <mi>B</mi> <mi>u</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> <mtd> <mrow> <msub> <mi>B</mi> <mn>1</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mi>M</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msub> <mi>B</mi> <mi>w</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
J1,J2,J3分别为三轴的转动惯量,
4.根据权利要求1所述的基于输出反馈的抗干扰姿态控制验证平台,其特征在于:所述第三步:设计动态输出反馈控制器,并将动态输出反馈控制器与干扰观测器进行复合如下;
设计动态输出反馈控制器为:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>A</mi> <mi>k</mi> </msub> <msub> <mi>x</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>B</mi> <mi>k</mi> </msub> <mi>y</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>u</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>C</mi> <mi>k</mi> </msub> <msub> <mi>x</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>D</mi> <mi>k</mi> </msub> <mi>y</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>
将干扰观测器与动态输出反馈控制器进行复合,得到如下抗干扰姿态控制方法:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>A</mi> <mi>k</mi> </msub> <msub> <mi>x</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>B</mi> <mi>k</mi> </msub> <mi>y</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>u</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>C</mi> <mi>k</mi> </msub> <msub> <mi>x</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>D</mi> <mi>k</mi> </msub> <mi>y</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mn>0</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>
其中xk(t)是动态输出反馈控制器的状态,是xk(t)的一阶导数,Ak、Bk、Ck、Dk为待定的动态输出反馈控制器系数矩阵,y(t)为量测输出,d0(t)为挠性部件振动干扰,为d0(t)的估计值,u1(t)为动态输出反馈控制器的输入,u(t)为航天器姿态控制***的控制输入,t为时间。
5.根据权利要求1所述的基于输出反馈的抗干扰姿态控制验证平台,其特征在于:所述第四步:求解干扰观测器与动态输出反馈控制器的增益矩阵,完成基于输出反馈的抗干扰姿态控制方法的设计如下:
联立干扰估计误差满足条件方程、状态空间描述方程以及将干扰观测器与动态输出反馈控制器复合后的方程,得到复合***如下:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mi>w</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>A</mi> <mo>+</mo> <msub> <mi>BD</mi> <mi>k</mi> </msub> <mi>C</mi> </mrow> </mtd> <mtd> <mrow> <msub> <mi>BC</mi> <mi>k</mi> </msub> </mrow> </mtd> <mtd> <mrow> <mi>B</mi> <mi>V</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>B</mi> <mi>k</mi> </msub> <mi>C</mi> </mrow> </mtd> <mtd> <msub> <mi>A</mi> <mi>k</mi> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>L</mi> <mi>C</mi> <mi>A</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>W</mi> <mo>+</mo> <mi>L</mi> <mi>C</mi> <mi>B</mi> <mi>V</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>e</mi> <mi>w</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>B</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>LCB</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <msub> <mi>d</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow>
其中,未知参数Ak、Bk、Ck、Dk以及L由以下凸优化算法求解:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&amp;Phi;</mi> <mn>11</mn> </msub> </mtd> <mtd> <msub> <mi>&amp;Phi;</mi> <mn>12</mn> </msub> </mtd> <mtd> <msub> <mi>&amp;Phi;</mi> <mn>13</mn> </msub> </mtd> <mtd> <msub> <mi>&amp;Phi;</mi> <mn>14</mn> </msub> </mtd> <mtd> <msub> <mi>&amp;Phi;</mi> <mn>15</mn> </msub> </mtd> <mtd> <mrow> <msup> <msub> <mi>&amp;Phi;</mi> <mn>16</mn> </msub> <mi>T</mi> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mo>*</mo> </mtd> <mtd> <msub> <mi>&amp;Phi;</mi> <mn>22</mn> </msub> </mtd> <mtd> <msub> <mi>&amp;Phi;</mi> <mn>23</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mrow> <mo>-</mo> <msup> <mi>&amp;gamma;</mi> <mn>2</mn> </msup> <mi>I</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mrow> <mo>-</mo> <mi>I</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mrow> <mo>-</mo> <mi>I</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mo>*</mo> </mtd> <mtd> <mrow> <mo>-</mo> <mi>I</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>&lt;</mo> <mn>0</mn> </mrow>
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>P</mi> <mn>2</mn> </msub> </mtd> <mtd> <mi>S</mi> </mtd> </mtr> <mtr> <mtd> <mi>S</mi> </mtd> <mtd> <mi>S</mi> </mtd> </mtr> </mtable> </mfenced> <mo>&gt;</mo> <mn>0</mn> </mrow>
其中,
Φ22=Q1W+YCBV+(Q1W+YCBV)T,Φ23=(YCB+Q1B1),P2>0,Q1>0,S>0,Ac,Bc,Cc,Dc,Y为矩阵变量;Ak、Bk、Ck、Dk为待定的动态输出反馈控制器系数矩阵;xk(t)是动态输出反馈控制器的状态,是xk(t)的一阶导数,ew(t)为干扰估计误差,为干扰估计误差的一阶导数,x(t)为航天器姿态控制***的状态变量,是x(t)的一阶导数,d1(t)=[Td1(t),Td2(t),Td3(t)]T表示干扰力矩,Td1(t),Td2(t),Td3(t)分别为三轴干扰力矩;C为量测矩阵,t为时间;系数矩阵V为挠性部件振动干扰模型的输出矩阵,W表示挠性部件振动干扰模型的***阵,A,B,B1为系数矩阵;
J1,J2,J3分别为三轴的转动惯量,
C1表示参数已知H性能可调输出矩阵,γ>0为给定的常数,0表示零元素或零矩阵,I表示单位矩阵,“*”表示对称矩阵的对称部分,
则干扰观测器与动态输出反馈控制器的增益矩阵为:
<mrow> <mi>L</mi> <mo>=</mo> <msup> <msub> <mi>Q</mi> <mn>1</mn> </msub> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mi>Y</mi> <mo>,</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>A</mi> <mi>k</mi> </msub> </mtd> <mtd> <msub> <mi>B</mi> <mi>k</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>C</mi> <mi>k</mi> </msub> </mtd> <mtd> <msub> <mi>D</mi> <mi>k</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msup> <mi>S</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mi>I</mi> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>A</mi> <mi>c</mi> </msub> </mtd> <mtd> <msub> <mi>B</mi> <mi>c</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>C</mi> <mi>c</mi> </msub> </mtd> <mtd> <msub> <mi>D</mi> <mi>c</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>.</mo> </mrow>
6.一种基于输出反馈的抗干扰姿态控制验证方法,其特征在于实现为:航天器的期望姿态通过姿态控制模块输入,该期望姿态信号通过与姿态确定模块滤波后的姿态信息进行比较,得到偏差信号;将此偏差信号传递给姿态控制模块,该姿态控制模块接收试验主控模块中控制方法切换信号后运行基于输出反馈的抗干扰姿态控制方法,所述姿态控制算法解算出指令力矩信号并传送至反作用飞轮组;反作用飞轮组在接收指令力矩信号后输出执行力矩信号,该力矩作用在三轴气浮台的台面,三轴气浮台模拟航天器在外层空间的力学环境,三轴气浮台检测到飞轮输出力矩作用下的台面转动角速度,转动角速度信号传入实时仿真目标机;试验主控模块控制干扰模拟器开通与关断,模拟的挠性部件干扰加载到实时仿真目标机,仿真目标机运算加入挠性部件干扰后的运动学模型,得到包括航天器三轴转动角度和三轴转动角速度的姿态信息,航天器姿态信息的实时数据传输给试验主控模块中的数据存储分析与对比测试单元,该单元保存实时运算数据,同时该姿态信息传送至姿态确定模块;姿态确定模块将经过滤波后得到的姿态信息与期望姿态作比较后获得新的偏差信号,形成了验证的数据流回路;
所述基于输出反馈的抗干扰姿态控制方法步骤如下:
第一步,采用状态空间方法描述包含挠性部件振动干扰的航天器姿态动力学模型;
第二步,针对第一步中状态空间方法描述的航天器姿态动力学模型中的挠性部件振动干扰设计干扰观测器对挠性部件振动干扰进行估计;
第三步,设计动态输出反馈控制器,并将动态输出反馈控制器与第二步设计的干扰观测器进行复合;
第四步,最后,求解第二步设计的干扰观测器的增益矩阵与第三步设计的动态输出反馈控制器的增益矩阵,完成基于输出反馈的抗干扰姿态控制方法的设计。
CN201610370208.1A 2016-05-30 2016-05-30 一种基于输出反馈的抗干扰姿态控制验证平台及验证方法 Active CN106020221B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610370208.1A CN106020221B (zh) 2016-05-30 2016-05-30 一种基于输出反馈的抗干扰姿态控制验证平台及验证方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610370208.1A CN106020221B (zh) 2016-05-30 2016-05-30 一种基于输出反馈的抗干扰姿态控制验证平台及验证方法

Publications (2)

Publication Number Publication Date
CN106020221A CN106020221A (zh) 2016-10-12
CN106020221B true CN106020221B (zh) 2018-01-19

Family

ID=57092430

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610370208.1A Active CN106020221B (zh) 2016-05-30 2016-05-30 一种基于输出反馈的抗干扰姿态控制验证平台及验证方法

Country Status (1)

Country Link
CN (1) CN106020221B (zh)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106777469B (zh) * 2016-11-15 2020-07-03 上海航天控制技术研究所 用于挠性卫星挠性振动评估的地面物理仿真验证***和验证方法
CN107272446A (zh) * 2017-08-03 2017-10-20 爱普(福建)科技有限公司 一种面向控制算法的仿真平台及仿真方法
CN107450588B (zh) * 2017-09-29 2018-06-22 北京航空航天大学 一种挠性航天器姿态控制***的强抗扰控制方法
CN107505846B (zh) * 2017-10-12 2018-09-21 北京航空航天大学 一种空间机械臂***抗干扰姿态协调验证装置及控制方法
CN108020360B (zh) * 2017-10-23 2020-07-10 上海卫星工程研究所 星上干扰力矩补偿的高精度半物理测试方法
CN107861386B (zh) * 2017-11-08 2019-03-19 北京航空航天大学 一种基于角速度观测器的抗干扰姿态控制地面验证***及其控制方法
CN108557116B (zh) * 2018-05-08 2021-04-13 哈尔滨工业大学 带有旋转载荷的卫星平台的姿态控制方法和装置
CN108594271B (zh) * 2018-08-01 2020-07-10 北京航空航天大学 一种基于复合分层滤波的抗欺骗干扰的组合导航方法
CN110471434B (zh) * 2019-07-18 2020-11-20 南京航空航天大学 一种航天器姿态控制智能反作用飞轮及其控制方法
CN114815663A (zh) * 2022-05-13 2022-07-29 天津大学 一种航天器姿态仿真控制方法及***
CN114987800A (zh) * 2022-05-19 2022-09-02 上海航天控制技术研究所 一种基于滑模干扰观测的航天器高精度姿态控制方法
CN117311377B (zh) * 2023-11-30 2024-01-30 北京航空航天大学 一种基于复合干扰分离估计的航天器精细姿态控制方法
CN117406785B (zh) * 2023-12-01 2024-03-19 北京航空航天大学 一种挠性深耦合动态下航天器输出反馈姿态指向控制方法
CN118011838B (zh) * 2024-04-08 2024-06-07 北京航空航天大学 一种基于仿生激励干扰分离器的航天器误差标定方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103235509A (zh) * 2013-03-29 2013-08-07 北京控制工程研究所 一种基于动量轮的转动部件干扰补偿方法
CN103847985A (zh) * 2014-04-01 2014-06-11 哈尔滨工业大学 一种基于无线传输的三自由度空间模拟器
CN104133479A (zh) * 2014-08-08 2014-11-05 上海新跃仪表厂 一种采用单轴气浮台模拟挠性卫星三轴姿态耦合运动的测试***及其方法
CN104155969A (zh) * 2014-07-28 2014-11-19 北京航空航天大学 一种零动量轮摩擦抑制与抵消验证***
CN104932510A (zh) * 2015-06-04 2015-09-23 北京航空航天大学 一种针对飞轮低速摩擦的挠性航天器姿态控制***与方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103235509A (zh) * 2013-03-29 2013-08-07 北京控制工程研究所 一种基于动量轮的转动部件干扰补偿方法
CN103847985A (zh) * 2014-04-01 2014-06-11 哈尔滨工业大学 一种基于无线传输的三自由度空间模拟器
CN104155969A (zh) * 2014-07-28 2014-11-19 北京航空航天大学 一种零动量轮摩擦抑制与抵消验证***
CN104133479A (zh) * 2014-08-08 2014-11-05 上海新跃仪表厂 一种采用单轴气浮台模拟挠性卫星三轴姿态耦合运动的测试***及其方法
CN104932510A (zh) * 2015-06-04 2015-09-23 北京航空航天大学 一种针对飞轮低速摩擦的挠性航天器姿态控制***与方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于气浮台的小卫星姿态控制全物理仿真实验***;高华宇等;《计算机测量与控制》;20091231;第17卷;1153-1156页 *
大型卫星三轴气浮台全物理仿真***;李季苏等;《控制工程》;20010331(第3期);22-26页 *

Also Published As

Publication number Publication date
CN106020221A (zh) 2016-10-12

Similar Documents

Publication Publication Date Title
CN106020221B (zh) 一种基于输出反馈的抗干扰姿态控制验证平台及验证方法
Hu et al. Robust fault-tolerant tracking control for spacecraft proximity operations using time-varying sliding mode
CN110794863B (zh) 一种控制性能指标可定制的重型运载火箭姿态控制方法
CN102538819B (zh) 基于双圆锥红外和星敏感器的自主导航半物理仿真试验***
CN105843244A (zh) 一种基于输出反馈的挠性航天器精细姿态控制方法
Zou et al. A compound control method based on the adaptive neural network and sliding mode control for inertial stable platform
CN107861386B (zh) 一种基于角速度观测器的抗干扰姿态控制地面验证***及其控制方法
CN109782787B (zh) 一种太阳光压辅助下欠驱动航天器姿态的双模mpc控制方法
CN104656447A (zh) 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法
CN105629732A (zh) 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法
CN107458630B (zh) 悬挂式主动重力补偿***悬挂点跨尺度跟踪方法
Zhang et al. Integrated translational and rotational control for the terminal landing phase of a lunar module
CN109343347A (zh) 一种海底飞行节点的轨迹跟踪控制方法
Pusch et al. Aeroelastic modeling and control of an experimental flexible wing
CN109870273A (zh) 基于动量守恒的航天器在轨质心辨识方法
CN105807780A (zh) 一种基于飞轮输出偏差的抗干扰姿态控制方法及验证装置
Campos et al. An active helideck testbed for floating structures based on a stewart-gough platform
Zhang et al. Adaptive disturbance observer-based dual-loop integral-type fast terminal sliding mode control for micro spacecraft and its gimbal tracking device
CN113359444B (zh) 基于神经网络的挠性航天器刚柔耦合特性智能辨识方法
Chaoui et al. Neural network modeling of cold-gas thrusters for a spacecraft formation flying test-bed
Tian et al. Sliding mode control strategy of 3-UPS/S shipborne stable platform with LSTM neural network prediction
CN110502025B (zh) 考虑反作用飞轮特性及功率受限的航天器姿态控制方法
Chin Systematic modeling and model-based simulation of a remotely operated vehicle using matlab and simulink
CN113312028A (zh) 用于卫星姿轨控通用测试的动力学软件架构方法及***
Yanyachi et al. Low-cost Test System for 1U CubeSat Attitude Control with Reaction Wheels

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant