[发明专利]一种基于牛顿迭代的火星探测器二次制动捕获控制方法有效
申请号: | 202010120460.3 | 申请日: | 2020-02-26 |
公开(公告)号: | CN111414002B | 公开(公告)日: | 2023-06-06 |
发明(设计)人: | 冯建军;鲁启东;印兴峰;施桂国;刘付成;姜丽辉 | 申请(专利权)人: | 上海航天控制技术研究所 |
主分类号: | G05D1/10 | 分类号: | G05D1/10;G05D1/08 |
代理公司: | 中国航天科技专利中心 11009 | 代理人: | 徐晓艳 |
地址: | 201109 *** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 牛顿 火星 探测器 二次 制动 捕获 控制 方法 | ||
1.一种基于牛顿迭代的火星探测器二次制动捕获控制方法,其特征在于捕获制动期间火星探测器发生故障后,星上计算机复位,之后,采用基于牛顿迭代捕获制动优化方法,对火星探测器进行二次制动,具体二次制动方法步骤如下:
(2.1)、将匀角速率、姿态指向、点火时长作为捕获制动控制参数,根据预设的匀角速率初值α、姿态指向初值β、制动后出现故障时刻相对于制动发动机开机时刻的持续时间t,计算匀角速率迭代初始值α0和姿态指向迭代初始值β0;
匀角速率迭代初始值α0为:α0=α;
姿态指向迭代初始值β0为:β0=β+αt;
(2.2)、设置匀角速率迭代变量的初始变化值为Δα,设置姿态指向迭代变量的初始变化值为Δβ,计算二次捕获匀角速率迭代变量偏差参数α0′=α0+Δα,二次捕获姿态指向迭代变量偏差参数β'0=β0+Δβ;
(2.3)、将匀角速率迭代初始值α0、姿态指向迭代初始值β0、二次捕获匀角速率迭代变量偏差参数α0′,二次捕获姿态指向迭代变量偏差参数β'0分成三组,分别记为:第一参数组par1=[α0,β0]、第二参数组par2=[α0′,β0]和第三参数组par3=[α0,β0′];
(2.4)、将第一参数组、第二参数组、第三参数组分别代入二次捕获制动动力学方程中对时间进行积分,终止条件为积分后的位置速度转为轨道参数时得到的轨道偏心率达到目标轨道偏心率,求解得第一参数组、第二参数组、第三参数组对应的制动到目标轨道的点火时长dt1、dt2、dt3;
所述二次捕获制动动力学方程为:
其中,Rm为火星半径,Fx,Fy,Fz为推力在惯性坐标系中的三个分量,m为探测器的质量,J2为火星二阶带谐项系数,μ为火星引力常数,T为制动捕获推力大小,Isp为发动机的比冲,g0为重力加速度;x,y,z为探测器在火星惯性坐标系下的位置,vx,vy,vz为探测器在火星惯性坐标系下的速度;
(2.5)、设目标函数为G=(rp-rpm)2+dt,其中rp为制动后的近火点半径,rpm为目标近拱点半径,dt为二次捕获制动的点火时长;
(2.6)、将第一参数组、第二参数组、第三参数组对应的制动到目标轨道的点火时长dt1、dt2、dt3代入上述目标函数,求解得到第一参数组、第二参数组、第三参数组对应的第一目标函数值G1、第二目标函数值G2、第三目标函数值G3:
G1=(rp1-rpm)2+dt1
G2=(rp2-rpm)2+dt2
G3=(rp3-rpm)2+dt3
(2.7)、计算目标函数的偏导数
(2.8)、若以第一参数组计算得到的近火点高度与目标近火点高度的偏差在预设范围内,将此时的二次制动捕获匀角速率α0′、二次制动捕获初始姿态β0′、二次制动捕获点火时长dt作为当前二次制动捕获参数,用于轨道控制;否则,更新匀角速率迭代初始值α0、姿态指向迭代初始值β0,重新回到步骤(2.2)开始执行;
所述步骤(2.8)的更新步骤为:
w1为第一偏导系数和w2为第二偏导系数。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于上海航天控制技术研究所,未经上海航天控制技术研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010120460.3/1.html,转载请声明来源钻瓜专利网。