[发明专利]一种智能的月球软着陆轨道控制器

权利要求书

1.一种智能的月球软着陆轨道控制器，其特征在于：该轨道控制器由优化模块、仿真模块、执行模块组成；其中：

仿真模块把月球软着陆轨道分割成n个小段，并将n的值输入优化模块；每个节点的时刻由式(1)得到：

其中，t_k为第k+1个节点的时刻，k＝0,1,...,n，t₀为初始时间，记t₀＝0；

优化模块把包括初始节点和终节点在内的n+1个节点的推力方向角ψ与软着陆终端时刻t_f作为待优化的参数；初始化种群规模为N_s的粒子群，随机生成维度为n+2的粒子i的初始位置x_i＝(x_i1,x_i2,...,x_i(n+2))和初始速度v_i＝(v_i1,v_i2,...,v_i(n+2))，i＝1,2,...,N_s，并将粒子的位置信息传入仿真模块；定义维度变量d，d＝1,2,...,n+2；当d＝1,2,...,n+1时，x_id代表第d个节点的推力方向角，当d＝n+2时，x_id代表软着陆终端时刻，x_id∈[500,700]，v_id∈[-200,200]；种群规模N_s＝300～600；然后按以下方法进行迭代，初始时迭代计数T＝0：

(1)仿真模块中，月球软着陆过程中推力方向角表示成多项式(2)：

ψ(t)＝λ₀+λ₁t+λ₂t²+λ₃t³ (2)

其中ψ(t)表示着陆轨道t时刻的推力方向角，λ₀,λ₁,λ₂,λ₃为系数；优化模块输入的粒子的位置代表n+1个节点的推力方向角及软着陆终端时刻，按照式(1)得到n+1个节点的对应时刻；采用函数逼近法，利用n+1个节点的推力方向角及其对应时刻，对式(2)进行拟合，可以求得多项式的系数λ₀,λ₁,λ₂,λ₃，进而得到整个着陆轨道各个时刻的推力方向角ψ(t)；

(2)仿真模块存储了月球软着陆时着陆器的质心动力学方程，见式(3)：

式(3)中r为着陆器的月心距离，v为着陆器的径向速度，θ为着陆器极角，ω为着陆器极角角速度，μ为月球引力常数，m为着陆器质量，F为制动发动机推力，I_SP为制动发动机比冲；其中月球引力常数μ为常数，μ＝4902.75km³/s²，制动发动机推力F与制动发动机比冲I_SP与实际使用的发动机有关，也为常数；着陆器初始质量m₀根据实际确定；其他参数在着陆器着陆过程中发生变化；

初始条件为：

其中，r_p和r_a分别为霍曼转移段的近地点半径和远地点半径，r_p＝1753km，r_a＝1838km；

将步骤(1)中拟合得到的推力方向角ψ(t)、式(4)的初始条件以及着陆器初始质量m₀带入动力学方程(3)，所有数据单位统一，获得月球软着陆的轨道，并将获得的轨道信息输入给优化模块；

(3)优化模块中，优化目标为软着陆过程消耗燃料最少，即令式(5)中指标J最大：

同时，为实现软着陆，终端约束条件为：

其中，R为月球半径，R＝1738km；

在适应度函数中考虑约束条件，构造适应度函数fitness：

fitness＝J-α[(r(t_f)-R)²+v²(t_f)+ω²(t_f)] (7)

其中r(t_f)、v(t_f)、ω(t_f)分别表示仿真模块输入的软着陆轨道终端时刻的月心距离、径向速度、极角角速度；α为罚因子，α＝10000；根据仿真模块输入的软着陆轨道，按照式(7)计算适应度函数值；适应度函数值最大的粒子为全局最优粒子，其位置为p_best＝(p_best1,p_best2,...,p_best(n+2))；

(4)在优化模块中对所有粒子进行分群操作，包括以下子步骤：

(4.1)将所有粒子按照适应度函数值大小从大到小排序，选取适应度函数值最大的粒子作为一个子群中心；

(4.2)在剩下的粒子中选取适应度函数值最大的粒子，依次计算该粒子与各个子群中心的欧几里得距离；粒子i与粒子j的欧几里得距离dist(i,j)定义为：

其中，x_i＝(x_i1,x_i2,...,x_i(n+2))代表粒子i的位置，x_j＝(x_j1,x_j2,...,x_j(n+2))代表粒子j的位置，i,j＝1,2,...,N_s；若该粒子与某一个子群中心的欧几里得距离小于半径a，则将该粒子归为该子群中心所在的子群，并不再计算该粒子与剩下的子群中心的欧几里得距离；若该粒子与所有子群中心的距离都大于半径a，则将该粒子置为一个新的子群中心；半径a＝15～25；

(4.3)重复步骤4.2)，直到处理完所有粒子，则分群完成，且每个子群中心为该子群中适应度函数值最大的粒子；

(5)检查每个子群中的粒子数，若一个子群中的粒子数为S，且S＞S_max，S_max为子群允许的最大粒子数，则将适应度最差的(S-S_max)个粒子的位置和速度进行重置；S_max＝8～10；

(6)在一个子群中，fitness_1为该子群中最大的适应度函数值，fitness_2为该子群中第二大的适应度函数值，tol为搜索精度，tol＝0.01，若满足式(9)：

|fitness_1-fitness_2|＜tol (9)

则将第二大的适应度函数值的粒子q的位置按照式(10)处理：

x'_qd＝x_qd+η·rand (10)

其中，x_qd为粒子q原本的第d维位置，η为扰动因子，rand为0到1之间的随机数，x'_qd为粒子q扰动以后的第d维位置；扰动因子η的大小为：

η＝0.05(x_max-x_min) (11)

其中，x_max，x_min为粒子的搜索上下限，x_min＝0；

(7)按照式(12)(13)更新每个粒子的速度与位置：

v_id(T)＝v_id(T-1)+c₁·rand·(p_id-x_id(T-1))+c₂·rand·(p_igd-x_id(T-1)) (12)

x_id(T)＝x_id(T-1)+v_id(T) (13)

其中加速因子c₁＝c₂＝2，rand为0到1之间的随机数，p_i＝(p_i1，p_i2,...,p_i(n+2))为粒子x_i的历史最优位置，p_ig＝(p_ig1，p_ig2,...,p_ig(n+2))为粒子i所在的子群的最优粒子的位置；更新后，当d＝1,2,...,n+1时，若x_id＜0，则令x_id＝0，若则令当d＝n+2时，若x_id＜500，则令x_id＝500，若x_id＞700，则令x_id＝700；

(8)迭代计数累加，T＝T+1；

(9)重复步骤(1)～(8)，直到达到最大迭代次数T_max停止迭代，T_max＝100～2000；

种群全局最优粒子p_best＝(p_best1,p_best2,...,p_best(n+2))所在的位置即优化后的n+1个节点的推力方向角和终端时刻；将全局最优粒子的位置信息输入仿真模块，按照式(2)、(3)、(4)获得优化后的月球软着陆轨道，月球软着陆最优轨道规划完成；

仿真模块将最优软着陆轨道通过实时通讯传递给执行模块的执行元件执行，实现燃料消耗最少的月球软着陆最优控制。