一种着陆器动力下降液体晃动抑制方法技术

本发明专利技术涉及一种着陆器动力下降姿态控制方法，尤其涉及一种着陆器动力下降期间的液体晃动抑制姿态控制方法，属于航天器姿态控制技术领域。该方法针对动力下降段液体晃动抑制问题，采用两个滤波系数不同的观测器，分别估计缓慢变化的发动机干扰力矩和发动机干扰力矩与晃动干扰力矩之和。根据两种估计干扰力矩一段时间的历史值，判定干扰力矩状态和观测器估计状态，选择一种干扰力矩估值，进行姿控控制前馈补偿，提高了姿态控制精度。

【技术实现步骤摘要】
一种着陆器动力下降液体晃动抑制方法
本专利技术涉及一种着陆器动力下降姿态控制方法，尤其涉及一种着陆器动力下降期间的液体晃动抑制姿态控制方法，属于航天器姿态控制

技术介绍
探测器动力下降期间，制导系统根据探测器位置速度信息给出目标姿态，姿态控制系统根据姿态确定给出的当前姿态，控制探测器趋向于目标姿态，最终软着陆在月球表面。当着陆器推进剂贮箱为表面张力贮箱时，在着陆过程中，除了发动机产生干扰力矩外，液体推进剂容易晃动而产生晃动力矩，危机着陆安全。
技术实现思路
本专利技术的技术解决问题是：克服现有技术的不足，针对动力下降期间具有液体推进剂的着陆器姿态控制，提出一种动力下降液体晃动抑制方法，提高了姿态控制精度。本专利技术的技术解决方案是：一种着陆器动力下降液体晃动抑制方法，基于隆伯格观测器方法可以估计着陆器的角速度和干扰力矩，且隆伯格观测器的角速度系数和干扰力矩系数范围均为0～1；当隆伯格观测器的干扰力矩系数大于零小于0.5时，估计结果为缓慢变化的发动机干扰力矩以及对应的角速度，定义为慢变干扰力矩和慢变角速度，此时的隆伯格观测器系数定义为慢变角速度系数和慢变干扰力矩系数；当隆伯格观测器的干扰力矩系数大于等于0.5小于1时，估计结果为发动机干扰力矩与晃动干扰力矩之和以及对应的角速度，定义为快变干扰力矩和快变角速度，此时的隆伯格观测器系数定义为快变角速度系数和快变干扰力矩系数；根据快变干扰力矩与慢变干扰力矩的差值在一段时间的统计特性，决定采用快变干扰力矩或者慢变干扰力矩作为姿态控制的前馈补偿力矩；该方法基于隆伯格观测器估计着陆器的角速度和干扰力矩，具体步骤包括：(1)设定着陆器的初始状态时，快变角速度ω_e1(0)＝[000]T，快变干扰力矩Md_e1(0)＝[000]T；慢变角速度ω_e2(0)＝[000]T，慢变干扰力矩Md_e2(0)＝[000]T；初始姿态控制力矩Mc(0)＝[000]T；(2)第i(i≥1)个控制周期时，估计快变角速度ω_e1(i)，ω_e1(i)＝ω_e1(i-1)+J-1·(Mc(i-1)+Md_e1(i-1)-cross(ω_e1(i-1),J·ω_e1(i-1)))·Δt+L11·(ω(i)-ω_e1(i-1)-J-1·(Mc(i-1)+Md_e1(i-1)-cross(ω_e1(i-1),J·ω_e1(i-1)))·Δt)；其中：ω_e1(i-1)为上周期快变角速度，Md_e1(i-1)为上周期快变干扰力矩，L11为快变角速度系数，Mc(i-1)为上周期姿态控制力矩，ω(i)为第i个控制周期测量得到姿态角速度，J为着陆器惯量矩阵，Δt为控制周期；(3)第i个控制周期时，估计快变干扰力矩Md_e1(i)，Md_e1(i)＝Md_e1(i-1)+L21·J·(ω(i)-ω_e1(i-1)-J-1·(Mc(i-1)+Md_e1(i-1)-cross(ω_e1(i-1),J·ω_e1(i-1)))·Δt)/Δt；其中：L21为快变干扰力矩系数；(4)第i个控制周期时，估计慢变角速度ω_e2(i)，ω_e2(i)＝ω_e2(i-1)+J-1·(Mc(i-1)+Md_e2(i-1)-cross(ω_e2(i-1),J·ω_e2(i-1)))·Δt+L12·(ω(i)-ω_e2(i-1)-J-1·(Mc(i-1)+Md_e2(i-1)-cross(ω_e2(i-1),J·ω_e2(i-1)))·Δt)；其中：ω_e2(i-1)为上周期慢变角速度，Md_e2(i-1)为上周期慢变干扰力矩，L12为慢变角速度系数；(5)第i个控制周期时，估计慢变干扰力矩Md_e2(i)，Md_e2(i)＝Md_e2(i-1)+L22·J·(ω(i)-ω_e2(i-1)-J-1·(Mc(i-1)+Md_e2(i-1)-cross(ω_e2(i-1),J·ω_e2(i-1)))·Δt)/Δt；其中：L22为慢变干扰力矩系数；(6)第i个控制周期时，获取力矩差历史值矩阵dMde，矩阵dMde为3行Nw列的矩阵，Nw为统计周期数；获取的方法是，将步骤(3)的Md_e1(i)减去步骤(5)的Md_e2(i)的差值Md_e1(i)-Md_e2(i)，赋值给力矩差历史值矩阵dMde的第mod(i,Nw)列，其中：函数mod()为求余数函数；(7)第i个控制周期时，若i<Nw，则：前馈补偿力矩ΔMd(i)＝[000]T；(8)第i个控制周期时，若i≥Nw，则：计算滚动力矩差均值Meanx(i)，计算滚动力矩差方差stdx(i)，其中：j＝1～Nw；若|dMde(1,i)-Meanx(i)|>stdx(i)，则：将Md_e2(i)的第1个元素赋值给ΔMd(i)的第1个元素；若|dMde(1,i)-Meanx(i)|≤stdx(i)，则：将Md_e1(i)的第1个元素赋值给ΔMd(i)的第1个元素；(9)第i个控制周期时，若i≥Nw，则：计算俯仰力矩差均值Meany(i)，计算俯仰力矩差方差stdy(i)，其中：j＝1～Nw；若|dMde(2,i)-Meany(i)|>stdy(i)，则：将Md_e2(i)的第2个元素赋值给ΔMd(i)的第2个元素；若|dMde(2,i)-Meany(i)|≤stdy(i)，则：将Md_e1(i)的第2个元素赋值给ΔMd(i)的第2个元素；(10)第i个控制周期时，若i≥Nw，则：计算偏航力矩差均值Meanz(i)，计算偏航力矩差方差stdz(i)，其中：j＝1～Nw；若|dMde(3,i)-Meanz(i)|>stdz(i)，则：将Md_e2(i)的第3个元素赋值给ΔMd(i)的第3个元素；若|dMde(3,i)-Meanz(i)|≤stdz(i)，则：将Md_e1(i)的第3个元素赋值给ΔMd(i)的第3个元素；(11)第i个控制周期时，计算姿态控制力矩Mc(i)，Mc(i)＝TPID(i)+ΔMd(i)，其中：TPID(i)为PID控制力矩。本专利技术与现有技术相比的有益效果是：本专利技术姿态控制方法，针对动力下降段液体晃动抑制问题，采用滤波系数不同的隆伯格观测器，分别估计缓慢变化的发动机干扰力矩和发动机干扰力矩与晃动干扰力矩之和。根据两种估计干扰力矩一段时间的历史值，判定干扰力矩状态和观测器估计状态，选择一种干扰力矩估值，进行姿控控制前馈补偿，提高了姿态控制精度。本专利技术公开了一种着陆器动力下降姿态控制方法，该方法针对动力下降段液体晃动抑制问题，采用两个滤波系数不同的观测器，分别估计缓慢变化的发动机干扰力矩和发动机干扰力矩与晃动干扰力矩之和。根据两种估计干扰力矩一段时间的历史值，判定干扰力矩状态和观测器估计状态，选择一种干扰力矩估值，进行姿控控制前馈补偿，提高了姿态控制精度。具体实施方式本专利技术的实现步骤如下：(1)设定着陆器的初始状态时，快变角速度ω_e1(0)＝[000]T，快变干扰力矩Md_e1(0)＝[000]T；慢变角速度ω_e2(0)＝[000]T，慢变干扰力矩Md_e2(0)＝[000]T；初始姿态控制力矩Mc(0)＝[000]T；(2)第i(i≥1)个控制周期时，估计快变角速度ω_e1(i)，ω_e1(i)＝ω_e1(i本文档来自技高网...

【技术保护点】
1.一种着陆器动力下降液体晃动抑制方法，其特征在于具体步骤包括：(1)设定着陆器初始状态时，快变角速度ω_e1(0)＝[0 0 0]T，快变干扰力矩Md_e1(0)＝[0 0 0]T；慢变角速度ω_e2(0)＝[0 0 0]T，慢变干扰力矩Md_e2(0)＝[0 0 0]T；初始姿态控制力矩Mc(0)＝[0 0 0]T；(2)第i个控制周期时，使用隆伯格观测器估计快变角速度ω_e1(i)的值；i≥1；(3)第i个控制周期时，使用隆伯格观测器估计快变干扰力矩Md_e1(i)的值；(4)第i个控制周期时，使用隆伯格观测器估计慢变角速度ω_e2(i)的值；(5)第i个控制周期时，使用隆伯格观测器估计慢变干扰力矩Md_e2(i)的值；(6)第i个控制周期时，获取力矩差历史值矩阵dMde；(7)第i个控制周期时，若i

【技术特征摘要】
1.一种着陆器动力下降液体晃动抑制方法，其特征在于具体步骤包括：(1)设定着陆器初始状态时，快变角速度ω_e1(0)＝[000]T，快变干扰力矩Md_e1(0)＝[000]T；慢变角速度ω_e2(0)＝[000]T，慢变干扰力矩Md_e2(0)＝[000]T；初始姿态控制力矩Mc(0)＝[000]T；(2)第i个控制周期时，使用隆伯格观测器估计快变角速度ω_e1(i)的值；i≥1；(3)第i个控制周期时，使用隆伯格观测器估计快变干扰力矩Md_e1(i)的值；(4)第i个控制周期时，使用隆伯格观测器估计慢变角速度ω_e2(i)的值；(5)第i个控制周期时，使用隆伯格观测器估计慢变干扰力矩Md_e2(i)的值；(6)第i个控制周期时，获取力矩差历史值矩阵dMde；(7)第i个控制周期时，若i<Nw，则：前馈补偿力矩ΔMd(i)＝[000]T；(8)第i个控制周期时，若i≥Nw，则：计算滚动力矩差均值Meanx(i)；计算滚动力矩差方差stdx(i)；其中：j＝1～Nw；若|dMde(1,i)-Meanx(i)|>stdx(i)，则：将Md_e2(i)的第1个元素赋值给ΔMd(i)的第1个元素；若|dMde(1,i)-Meanx(i)|≤stdx(i)，则：将Md_e1(i)的第1个元素赋值给ΔMd(i)的第1个元素；(9)第i个控制周期时，若i≥Nw，则：计算俯仰力矩差均值Meany(i)；计算俯仰力矩差方差stdy(i)；其中：j＝1～Nw；若|dMde(2,i)-Meany(i)|>stdy(i)，则：将Md_e2(i)的第2个元素赋值给ΔMd(i)的第2个元素；若|dMde(2,i)-Meany(i)|≤stdy(i)，则：将Md_e1(i)的第2个元素赋值给ΔMd(i)的第2个元素；(10)第i个控制周期时，若i≥Nw，则：计算偏航力矩差均值Meanz(i)；计算偏航力矩差方差stdz(i)；其中：j＝1～Nw；若|dMde(3,i)-Meanz(i)|>stdz(i)，则：将Md_e2(i)的第3个元素赋值给ΔMd(i)的第3个元素；若|dMde(3,i)-Meanz(i)|≤stdz(i)，则：将Md_e1(i)的第3个元素赋值给ΔMd(i)的第3个元素；(11)第i个控制周期时，计算姿态控制力矩Mc(i)。2.根据权利要求1所述的一种着陆器动力下降液体晃动抑制方法，其特征在于：所述的步骤(2)中，快变角速度ω_e1(i)的值为：ω_e1(i)＝ω_e1(i-1)+J-1·(Mc(i-1)+Md_e1(i-1)-cross(ω_e1(i-1),J·ω_e1(i-1)))·Δt+L11·(ω(i)-ω_e1(i-1)-J-1·(Mc(i-1)+Md_e1(i-1)-cross(ω_e1(i-1),J·ω_e1(i-1)))·Δt)；其中：ω_e1(i-1)为上周期快变角速度...

【专利技术属性】
技术研发人员：张洪华，关轶峰，李骥，王志文，于洁，于萍，
申请(专利权)人：北京控制工程研究所，
类型：发明
国别省市：北京,11