CN113665849B - 一种ekf滤波算法与神经网络联合的自主相位控制方法 - Google Patents
一种ekf滤波算法与神经网络联合的自主相位控制方法 Download PDFInfo
- Publication number
- CN113665849B CN113665849B CN202111147746.1A CN202111147746A CN113665849B CN 113665849 B CN113665849 B CN 113665849B CN 202111147746 A CN202111147746 A CN 202111147746A CN 113665849 B CN113665849 B CN 113665849B
- Authority
- CN
- China
- Prior art keywords
- satellite
- orbit
- control
- phase
- track
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 57
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 31
- 238000013528 artificial neural network Methods 0.000 title claims abstract description 26
- 238000001914 filtration Methods 0.000 title claims abstract description 23
- 230000008569 process Effects 0.000 claims abstract description 19
- 238000013461 design Methods 0.000 claims abstract description 8
- 239000011159 matrix material Substances 0.000 claims description 14
- 239000000126 substance Substances 0.000 claims description 13
- 230000008859 change Effects 0.000 claims description 10
- 238000005259 measurement Methods 0.000 claims description 4
- 230000003044 adaptive effect Effects 0.000 claims description 3
- 229920000642 polymer Polymers 0.000 claims description 3
- 230000036544 posture Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 2
- 230000007704 transition Effects 0.000 claims description 2
- 238000004088 simulation Methods 0.000 abstract description 4
- 238000013459 approach Methods 0.000 abstract description 2
- 230000001105 regulatory effect Effects 0.000 abstract 1
- 238000011217 control strategy Methods 0.000 description 10
- 238000012423 maintenance Methods 0.000 description 10
- 238000010586 diagram Methods 0.000 description 5
- 230000000694 effects Effects 0.000 description 5
- 230000015572 biosynthetic process Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000009434 installation Methods 0.000 description 4
- 238000012937 correction Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000013213 extrapolation Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 239000010763 heavy fuel oil Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000001373 regressive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- 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/242—Orbits and trajectories
-
- 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
-
- 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
- B64G1/245—Attitude control algorithms for spacecraft attitude control
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种EKF滤波算法与神经网络联合的自主相位控制方法,涉及航空航天应用技术领域,为解决现有技术中,存在轨道控制过程中忽略了卫星姿态造成的干扰问题,本发明的控制方法,采用扩展卡尔曼滤波算法来确定卫星轨道,通过确定后的轨道来计算卫星相位的漂移,当卫星相位漂出设定的相位阈值时,开始调整卫星姿态并进行轨道控制,星上提前自主生成轨道控制量和控制方向。为保证轨道控制过程中的姿态稳定,提出了一种基于4个斜装推力器的姿态控制方法,并采用神经网络来逼近干扰力矩。数学仿真结果证明了所提出的自主相位控制方法是有效可行的。本发明方法可靠性较高,通过本发明的设计算法和方案可以实现高精度的自主相位控制。
Description
技术领域
本发明涉及航空航天应用技术领域,具体涉及一种基于神经网络的自主相位控制方法。航天器轨道确定与控制,用于实现并优化卫星的轨道控制功能。
背景技术
由于遥感卫星的相位保持是实现地面应用需求的关键技术,随着卫星数量增多,相位控制任务会越来越繁重,增加了地面操作人员和地面站的压力,因此自主相位控制是解决该问题的有效手段。目前在遥感卫星在自主轨道控制方面的研究和应用较少。
现有技术1,杜耀珂,杨盛庆,完备,王文妍,陈筠力。近地卫星严格回归轨道保持控制[J].航空学报,2018,39(12):334-344。研究了近地卫星基于严格回归参考轨道的轨道保持控制方法。将卫星编队理论引入单星绝对轨道保持控制,提出了“虚拟卫星编队”的概念,分析了卫星轨道相对于参考空间轨迹在轨道摄动情况下的偏离状态及变化趋势,然后根据卫星编队相对运动学,推导出了偏离状态与虚拟卫星编队构形参数之间的对应关系,并设计了以轨道参数超调、偏置及阈值触发为特征的管道保持控制策略。数值仿真证明了该策略的有效性,但是需要地面干预,会占用大量的测控弧段来完成轨控任务,操作繁琐且效率较低。
现有技术2,刘洁,李克行,丁建钊,杨家艾,陈超。一种基于GNSS的自主轨控策略研究[A]。中国惯性技术学会。惯性技术与智能导航学术研讨会论文集[C].中国惯性技术学会:中国惯性技术学会,2019:6。提出了一种低轨卫星的自主轨控策略及其实现方案。该方法依据GNSS实时定轨数据确定实时轨道根数,采用平滑滤波对准平根数进行拟合,并以此为依据开展轨控策略研究。自主轨道控制以维持轨道半长轴和偏心率为主要目标,基于压力传感器实现推力的实时自主标定和卫星质量的自主计算,并将轨控策略与整星任务相结合进行自主的轨道控制。但是忽略了轨道控制时对卫星姿态的干扰影响。
现有技术3,谢挺,刘刚,高旭东.带有控制增益自校正的甚低轨道卫星自主轨道维持方法[J].上海,2018,35(05):67-74。设计了一种带有轨控增益校正的自主轨道维持方法。该方法可通过前一次轨控的结果对轨控增益进行校正,提高轨控算法对卫星质量、推力大小等不确定因素的鲁棒性,逐渐提高轨道控制的精度。该方法很好地实现了甚低轨道高度维持控制,但是忽略了轨道控制时对卫星姿态的干扰影响。
现有技术4,莫凡,丁建钊,任放,张新伟,赵晨光,王家炜,赵文彦.一种低轨遥感卫星自主轨道控制方法[J].航天器工程,2020,29(03):12-17提出一种无需地面站支持的自主轨道控制方法。利用在轨实时计算得到的轨道偏差作为触发条件,在偏差超出阈值时,卫星根据轨道外推结果、剩余燃料质量、发动机推力等参数自主计算轨控时间,并在不与载荷任务冲突的前提下,实施发动机点火,实现卫星轨道误差的在轨自主补偿。但是忽略了轨道控制时对卫星姿态造成的干扰。
发明内容
本发明为解决现有技术中,存在轨道控制过程中忽略了卫星姿态造成的干扰问题,提供一种EKF滤波算法与神经网络联合的自主相位控制方法。
一种EKF滤波算法与神经网络联合的自主相位控制方法,采用航天器化学推进系统作为推力器进行设计与实现;该方法由以下步骤实现:
步骤一、采用扩展卡尔曼滤波算法,实时确定卫星轨道;
步骤二、自主轨道控制;具体过程为:
步骤二一、相位预测:
设定通过卫星间获取轨道数据,且轨道控制过程中GPS导航接收机数据正常可用;则两颗卫星的初始相位差为δ1,期望的相位差为δ2,期望的相位差偏差为Δδ;
步骤二二、将初始相位差调整到δ2±Δδ,则需要调整两颗卫星的高度差控制相位漂移速度,则两颗卫星的轨道周期差值为:
式中,ΔT为两颗卫星的周期差,a1为第一卫星的轨道半长轴,a2为第二卫星的轨道半长轴;μ为引力常数;
两颗卫星的相位随时间的变化规律为:
其中,为相位变化量,/>T相位漂移时长;
步骤二三、自主判断策略:
当两颗卫星的相位超过阈值时,所述第一卫星在后,第二卫星在前,当a1>a2且则降低第一卫星的轨道高度,当a1<a2且/>时,则提高第一卫星的轨道高度;
根据步骤二三的自主判断策略,轨道控制量为:
Δa=λ|a1-a2|
式中,λ为增益系数;
由轨道摄动引起的半长轴变化为:
式中,ΔVS为轨道控制推力器提供的径向速度增量,ΔVT为轨道控制推力器提供的横向速度增量,ΔVt为姿态控制推力器提供的横向速度增量,n为轨道角速度,e为偏心率,f为真近点角;
则化学推进系统的控制器为:
Δa=Δa1+Δa2
式中,Δa2=KaΔa1,Ka为姿态控制推力器的比例系数,该比例系数在卫星进入轨道后需要进行校准;
步骤二四、将脉冲控制模型应用于化学推进系统,分配控制时间计算速度增量,由推力器提供的横向速度增量为:
式中,F为推力器提供的推力,M0为卫星初始质量,t1为轨道控制推力器工作时间,为姿态控制推力器作用于横向的总工作时间,t2j为4个姿态控制推力器作用于横向的工作时间;
步骤三、轨道控制过程中的姿态控制;
定义qd为期望的姿态角,wd为期望的角速度,则偏差四元数e1和偏差角速度e2表示为:
定义滑模面S为:
S=e2+K1e1=w-wr
式中,wr=wd-K1e1,当S→0时,偏差四元数e1和偏差角速度e2沿滑模面趋向于零;
在轨道控制过程中,动力学模型中的不确定扰动部分采用神经网络逼近;定义为:
则设计的控制器表示为:
式中,饱和函数sat(S)表示为:
自适应更新率为:
式中,Γ=diag{Γii},i=1,2···7,当t→∞时,S→0,因此,q→qd和w→wd;则认为跟踪误差是有界的。
本发明的有益效果:本发明的控制方法,采用扩展卡尔曼滤波算法来确定卫星轨道,通过确定后的轨道来计算卫星相位的漂移,当卫星相位漂出设定的相位阈值时,开始调整卫星姿态并进行轨道控制,星上提前自主生成轨道控制量和控制方向。为保证轨道控制过程中的姿态稳定,提出了一种基于四个斜装推力器的姿态控制方法,并采用神经网络来逼近干扰力矩。数学仿真结果证明了所提出的自主相位控制方法是有效可行的。
本发明选用化学推进系统作为推力机构进行设计与实现。化学推进系统是遥感卫星中常用的一种推进系统,可靠性较高,化学推进系统的推力相对较大,并且存在安装偏差、推力矢量偏差和质心偏差,会导致卫星姿态不稳定,影响轨道控制效率和精度,很难实现高精度的相位控制,因此很难实现自主控制,通过本发明的设计算法和方案可以实现高精度的自主相位控制。
附图说明
图1为本发明所述的一种EKF滤波算法与神经网络联合的自主相位控制方法的流程图;
图2为本发明所述的一种EKF滤波算法与神经网络联合的自主相位控制方法的控制原理框图;
图3为本发明所述的一种EKF滤波算法与神经网络联合的自主相位控制方法中EKF算法滤波后的位置误差示意图;
图4为EKF算法滤波后的速度误差示意图;
图5为卫星相位变化效果图;
图6为卫星半长轴变化效果图;
图7为RBF神经网络控制下的四元数偏差示意图;
图8为RBF神经网络控制力矩示意图。
具体实施方式
结合图1至图8说明本实施方式,一种EKF滤波算法与神经网络联合的自主相位控制方法,选用化学推进系统作为推力器进行设计与实现。具体的自主相位控制流程如图1所示。
一、滤波算法设计;
考虑中心引力项、高阶引力项J2,J3和J4,地球的引力势函数表示为
其中Re为地球半径,μ为引力常数,为地心纬度/>R=R是轨道位置的模。
定义卫星速度矢量V=[vx vy vz]T,轨道的状态变量为X=[x y z vx vy vz]T,则得到卫星轨道的状态方程和观测方程为
其中,W(t)为系统的随机噪声,V(t)为测量噪声,H(X,t)和F(X,t)为向量函数,可表示为
其中,
对式(2)进行线性离化,可得
其中,Wk和Vk是均值为零的独立高斯白噪声,其中,Qk和Rk为噪声协方差矩阵,/>和/>为不同时刻的高斯白噪声,δkj为均值差,状态矩阵A和观测矩阵Hk为:
则EKF公式可表示为:
其中,Φk,k-1=I6×6+AT+A2T2/2为状态转移矩阵,I6×6为单位矩阵,T为采样周期,Pk/k-1为k时刻先验估计协方差,Kk为状态增益矩阵,Pk和Pk-1为k时刻和k-1时刻状态后验估计误差协方差矩阵,为k时刻的误差估计,/>和/>为k时刻和k-1时刻后验状态估计值,/>为k时刻先验状态估计值,Zk为测量值。。根据上式可实时确定卫星轨道。
二、自主相位控制设计;对商业地球观测星座来说,相位分布的维持对卫星的重访和覆盖特别重要。如果同一轨道平面上的两颗卫星高度差较大,相位很快会超出阈值。因此,两颗卫星应尽可能保持在同一轨道高度。
若卫星间可以获取轨道数据,并且轨控期间GPS导航接收机数据正常可用。两颗卫星的初始相位差为δ1,期望的相位差为δ2,期望的相位差偏差为Δδ,两颗星的轨道半长轴为a1和a2,要将初始相位差调整到δ2±Δδ,则需要调整两颗星的高度差来控制相位漂移速度,两颗星的轨道周期差值为
其中,ΔT为两颗卫星的周期差,两颗卫星的相位随时间的变化规律为
其中,为相位变化量,/>T相位漂移时长。
当两颗卫星的相位超过限值时,卫星1在后,卫星2在前,当a1>a2且则降低卫星1的轨道高度,当a1<a2且/>时,则提高卫星1的轨道高度。
根据上述自主判断策略,轨道控制量为
Δa=λ|a1-a2| (11)
式中λ为增益系数。
由轨道摄动引起的半长轴变化为
其中,ΔVS为轨控推力器提供的径向速度增量,ΔVT是轨控推力器提供的横向速度增量,ΔVt是姿控推力器提供的横向速度增量,n是轨道角速度,e(e≈0)是偏心率,f是真近点角。
则化学推进系统的控制器为
Δa=Δa1+Δa2 (13)
式中Δa2=KaΔa1,Ka为姿态控制推力器的比例系数,该比例系数在卫星进入轨道后需要进行校准。
将脉冲控制模型应用于化学推进系统,分配控制时间计算速度增量,由推力器提供的横向速度增量为
式中,F为推力器提供的推力,M0为卫星初始质量,t1为轨道控制推力器工作时间,为姿态控制推力器作用于横向的总工作时间,t2j为4个姿态控制推力器作用于横向的工作时间。
三、轨控过程中姿态控制算法设计;
在轨道控制过程中,由于推进系统推力方向偏差、推进器安装偏差、质心偏差等因素,轨控推力会对卫星产生姿态耦合力矩,导致卫星姿态不稳定。具体的控制原理如图2所示。
定义qd为期望的姿态角,wd是期望的角速度,则偏差四元数e1和偏差角速度e2表示为
定义滑模面
S=e2+K1e1=w-wr (16)
其中,wr=wd-K1e1,当S→0时,偏差四元数和偏差角速度沿滑模面趋向于零。
在轨道控制过程中,动力学模型中的不确定扰动部分采用神经网络逼近。
定义
则设计的控制器表示为
其中,饱和函数sat(S)表示为
自适应更新率为
其中,Γ=diag{Γii},(i=1,2···7),当t→∞时,S→0,因此,q→qd和w→wd。意味着跟踪误差是有界的。
具体实施方式二、本实施方式为具体实施方式一所述的一种EKF滤波算法与神经网络联合的自主相位控制方法的实施例,以一颗带有化学推进系统的卫星为例,该推进系统含有5个推力器,进行仿真验证所提控制方法的有效性。最大控制力矩为0.5Nm,推进系统的偏差值和初始轨道如表1和表2所示。
表1推进系统偏差
参数 | 参数值 |
几何安装偏差 | θa=[0.5;0;0;0;0.5]° |
几何安装偏差方位角 | θac=[90;90;90;90;90]° |
推力偏差 | θb=[1;1;1;1;1]° |
推力偏差方位角 | θbc=[90;90;90;90;90]° |
质心偏移 | Imc=[0.01;0.01;0.01]mm |
表2初始轨道参数
卫星系统初始参数如表3所示。神经网络控制算法被设计用来提高推进系统的姿态控制精度,RBF神经网络参数如表4所示。
表3卫星初始参数
参数 | 参数值 |
推力 | F=1.3N |
比例系数 | Ka=1.3 |
卫星质量 | M0=200kg |
真空比冲 | Is=2000N·s/kg |
转动惯量 | I=diag(55 50 30) |
初始姿态 | q0=[0.2;0.3;0.4] |
初始姿态角速度 | w0=[-0.2;0.1;0.3](°/s) |
期望姿态 | qd=[0;0.8509;0] |
期望姿态角速度 | w0=[0;0;0](°/s) |
表4EKF和RBF神经网络控制器
参数 | 参数值 |
Pk0 | diag(200 300 400 0.3 0.5 0.3) |
Qk | diag(15 15 15 8 8 8)×0.0001 |
Rk | diag(600 600 600 0.06 0.06 0.06)×10 |
T | 0.125s |
K1 | diag(0.63 0.63 0.63) |
Kd | diag(88.7 78.8 78.8)×0.23 |
Ks | diag(0.006 0.006 0.006) |
Γ | diag(4 4 4 4 4 4 4)×100 |
卫星轨道受到的噪声可认为是随机噪声,该噪声会产生较大的轨道瞬时波动,因此,需要设计轨道滤波算法,卫星轨道位置和速度的随机噪声分别设置在[-3030]m和[-0.050.05]m/s范围内。采用所设计的EKF算法对卫星进行轨道滤波,EKF效果如图3和图4所示。
由于GPS在卫星上的位置数据误差约为30m,不利于自主轨道控制策略的制定,因此采用EKF算法对GPS数据进行滤波。从图3和图4可知,位置噪声从峰值30m降到0.6m以内,速度噪声从峰值0.05m/s降到0.016m/s以内。可以看出,所设计的EKF算法可以显著提高定轨精度,并成功地为自主控制策略的制定奠定了基础。
图5和图6分别给出了卫星的相位变化和平均轨道半长轴变化,确定轨道后,开始制定轨道控制策略。相位要求范围为[117.5°-122.5°],当卫星相位超过该阈值时,卫星推进系统自动开始工作,轨道确定和相位跟踪是实现自主相位保持的必要技术手段。
从图5和图6可知,卫星平均轨道半长轴为6903.7±0.2km,应用EKF算法得到的轨道半长轴为6903.7±0.02km,另一颗卫星轨道半长轴为6902.7±0.02km,由于两颗卫星有轨道高度差的存在,因此两颗卫星之间的相位会以一定的速度进行漂移,在705s时相位超过117.5°,卫星开始自主制定控制策略,控制时间和持续时间分别是705s和62s,卫星的控制量是1.04km。控制后半长轴控制偏差在10m以内,相位开始回漂,轨道控制精度相对较高,这主要与姿态控制推力器的比例系数有关,该系数标定不准确将影响轨道控制精度,图7和图8给出了四元数偏差曲线和控制力矩曲线。
从图7和图8可知,在轨道控制过程中,神经网络控制下的四元数偏差在-2×10-3和2×10-3内,神经网络控制下的控制力矩稳定在±0.15Nm内,充分地说明了神经网络控制算法的优越性,并且证明了卫星从相位跟踪到自主轨道确定,再到轨道控制策略整个过程的有效性和可行性,实现了自主相位控制。
Claims (2)
1.一种EKF滤波算法与神经网络联合的自主相位控制方法,其特征是:采用航天器化学推进系统作为推力器进行设计与实现;该方法由以下步骤实现:
步骤一、采用扩展卡尔曼滤波算法,实时确定卫星轨道;
步骤二、自主轨道控制;具体过程为:
步骤二一、相位预测:
设定通过卫星间获取轨道数据,且轨道控制过程中GPS导航接收机数据正常可用;则两颗卫星的初始相位差为δ1,期望的相位差为δ2,期望的相位差偏差为Δδ;
步骤二二、将初始相位差调整到δ2±Δδ,则需要调整两颗卫星的高度差控制相位漂移速度,则两颗卫星的轨道周期差值为:
式中,ΔT为两颗卫星的周期差,a1为第一卫星的轨道半长轴,a2为第二卫星的轨道半长轴;μ为引力常数;
两颗卫星的相位随时间的变化规律为:
其中,为相位变化量,/>T相位漂移时长;
步骤二三、自主判断策略:
当两颗卫星的相位超过阈值时,所述第一卫星在后,第二卫星在前,当a1>a2且则降低第一卫星的轨道高度,当a1<a2且/>时,则提高第一卫星的轨道高度;
根据步骤二三的自主判断策略,轨道控制量为:
Δa=λ|a1-a2|
式中,λ为增益系数;
由轨道摄动引起的半长轴变化为:
式中,ΔVS为轨道控制推力器提供的径向速度增量,ΔVT为轨道控制推力器提供的横向速度增量,ΔVt为姿态控制推力器提供的横向速度增量,n为轨道角速度,e为偏心率,f为真近点角;
则化学推进系统的控制器为:
Δa=Δa1+Δa2
式中,Δa2=KaΔa1,Ka为姿态控制推力器的比例系数,该比例系数在卫星进入轨道后需要进行校准;
步骤二四、将脉冲控制模型应用于化学推进系统,分配控制时间计算速度增量,由推力器提供的横向速度增量为:
式中,F为推力器提供的推力,M0为卫星初始质量,t1为轨道控制推力器工作时间,为姿态控制推力器作用于横向的总工作时间,t2j为4个姿态控制推力器作用于横向的工作时间;
步骤三、轨道控制过程中的姿态控制;
定义qd为期望的姿态角,wd为期望的角速度,则偏差四元数e1和偏差角速度e2表示为:
定义滑模面S为:
S=e2+K1e1=w-wr
式中,wr=wd-K1e1,当S→0时,偏差四元数e1和偏差角速度e2沿滑模面趋向于零;
在轨道控制过程中,动力学模型中的不确定扰动部分采用神经网络逼近;定义为:
则设计的控制器表示为:
式中,I为转动惯量,饱和函数sat(S)表示为:
自适应更新率为:
式中,Γ=diag{Γii},i=1,2···7,当t→∞时,S→0,因此,q→qd和w→wd;则认为跟踪误差是有界的。
2.根据权利要求1所述的一种EKF滤波算法与神经网络联合的自主相位控制方法,其特征在于:所述扩展卡尔曼滤波算法的设计方法为:
步骤一一、根据中心引力项,高阶引力项J2,J3和J4,则地球的引力势函数U表示为:
式中,Re为地球半径,μ为引力常数,为地心纬度,表示为:/>R=|R|是轨道位置的模,z为z轴的位置;
步骤一二、定义卫星速度矢量V=[vx vy vz]T,轨道的状态变量X=[x y z vx vy vz]T,则获得卫星轨道的状态方程和观测方程为:
式中,W(t)为系统的随机噪声,V(t)为测量噪声,H(X,t)和F(X,t)为向量函数,表示为:
其中,
对所述卫星轨道的状态方程和观测方程进行线性离化,得到:
式中,Wk和Vk是均值为零的独立高斯白噪声,其中,Qk和Rk为噪声协方差矩阵,/>和/>为不同时刻的高斯白噪声,δkj为均值差,状态矩阵A和观测矩阵Hk分别为:
则EKF公式表示为:
其中,Φk,k-1=I6×6+AT+A2T2/2为状态转移矩阵,I6×6为单位矩阵,T为采样周期,Pk/k-1为k时刻先验估计协方差,Kk为状态增益矩阵,Pk和Pk-1为k时刻和k-1时刻状态后验估计误差协方差矩阵,为k时刻的误差估计,/>和/>为k时刻和k-1时刻后验状态估计值,/>为k时刻先验状态估计值,Zk为测量值;根据上式可实时确定卫星轨道。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111147746.1A CN113665849B (zh) | 2021-09-29 | 2021-09-29 | 一种ekf滤波算法与神经网络联合的自主相位控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111147746.1A CN113665849B (zh) | 2021-09-29 | 2021-09-29 | 一种ekf滤波算法与神经网络联合的自主相位控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113665849A CN113665849A (zh) | 2021-11-19 |
CN113665849B true CN113665849B (zh) | 2023-08-01 |
Family
ID=78550396
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111147746.1A Active CN113665849B (zh) | 2021-09-29 | 2021-09-29 | 一种ekf滤波算法与神经网络联合的自主相位控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113665849B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114852375A (zh) * | 2022-03-24 | 2022-08-05 | 北京控制工程研究所 | 一种编队卫星相对轨道变化估计方法、估计装置 |
CN114771873B (zh) * | 2022-03-24 | 2024-05-03 | 北京控制工程研究所 | 一种超低轨卫星轨道自主精确维持方法 |
CN115771624B (zh) * | 2023-02-13 | 2023-05-26 | 北京航空航天大学 | 一种基于强化学习的自适应卫星姿轨控制方法 |
KR102605907B1 (ko) * | 2023-04-06 | 2023-11-27 | 세종대학교 산학협력단 | 우주선을 위한 적응형 슬라이딩 모드 자세 제어 방법 및 장치 |
CN117311394B (zh) * | 2023-11-28 | 2024-03-12 | 中国西安卫星测控中心 | 一种非严格多星串联编队系统中星间相位超越控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2697651B1 (fr) * | 1992-10-29 | 1995-02-03 | Aerospatiale | Procédé et appareil de calibration des gyromètres d'un satellite stabilisé 3-axes. |
US6089507A (en) * | 1996-12-05 | 2000-07-18 | Parvez; Shabbir Ahmed | Autonomous orbit control with position and velocity feedback using modern control theory |
CN112572835B (zh) * | 2020-12-15 | 2022-07-05 | 长光卫星技术股份有限公司 | 一种具有姿态切换的卫星在轨角动量管理及控制方法 |
CN112632454A (zh) * | 2020-12-17 | 2021-04-09 | 长光卫星技术有限公司 | 一种基于自适应卡尔曼滤波算法的mems陀螺滤波方法 |
CN112607065B (zh) * | 2020-12-23 | 2023-04-18 | 长春工业大学 | 一种基于电推进系统的高精度相位控制方法 |
-
2021
- 2021-09-29 CN CN202111147746.1A patent/CN113665849B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113665849A (zh) | 2021-11-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113665849B (zh) | 一种ekf滤波算法与神经网络联合的自主相位控制方法 | |
US7142981B2 (en) | Laser range finder closed-loop pointing technology of relative navigation, attitude determination, pointing and tracking for spacecraft rendezvous | |
EP0453096B1 (en) | Apparatus for inclined orbit attitude control of a satellite in an inclined orbit | |
EP0943122A1 (en) | Autonomous on-board orbit control/maintenance system for satellites | |
CN108181916B (zh) | 小卫星相对姿态的控制方法及装置 | |
CN108279703A (zh) | 一种用于非合作机动目标拦截的轨道控制方法 | |
CN108454883B (zh) | 一种动力上升二次轨控可靠入轨方法及系统 | |
Cao et al. | Minimum sliding mode error feedback control for fault tolerant reconfigurable satellite formations with J2 perturbations | |
CN113761809B (zh) | 一种基于深度神经网络的无源探测定轨方法 | |
CN113189619A (zh) | 一种低轨星座相位保持参数估计方法 | |
CN111638643B (zh) | 一种位移模式无拖曳控制动力学协调条件确定方法 | |
CN115014355A (zh) | 一种双体无人船的定点返航调控方法及装置 | |
Hablani | Endgame guidance and relative navigation of strategic interceptors with delays | |
CN114861320B (zh) | 一种航天器姿控推力建模及定轨解算方法 | |
CN111290433B (zh) | 一种长期自主编队联合管道保持方法 | |
Li et al. | Strong tracking cubature Kalman filter for real-time orbit determination for impulse maneuver satellite | |
EP0840186B1 (en) | Transient-free gain switching | |
CN110209190B (zh) | 一种卫星标称轨道无偏飞行控制的方法 | |
Mehrjardi et al. | Integrated attitude-orbit dynamics and control of spacecraft systems: State of the art and future trends | |
CN113602533B (zh) | 一种基于气动力辅助的超低轨卫星轨道控制方法 | |
CN115622612B (zh) | 巨型星座轨道保持迭代学习控制方法 | |
Rigatos et al. | A nonlinear optimal control approach for autonomous reentry space vehicles | |
CN116817932B (zh) | 一种轨道维持、轨道确定和重力场实时测绘的一体化方法 | |
Guan et al. | Application of robust fault-tolerant control in satellite attitude control system | |
CN116841310A (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: No. 1299, Mingxi Road, Beihu science and Technology Development Zone, Changchun City, Jilin Province Applicant after: Changguang Satellite Technology Co.,Ltd. Address before: 130032 no.1299, Mingxi Road, Beihu science and Technology Development Zone, Changchun City, Jilin Province Applicant before: CHANG GUANG SATELLITE TECHNOLOGY Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |