一种火箭发动机推力矢量摆角测量解算方法、设备及介质与流程

摘要: 本发明属于航天运载器及导弹飞行控制,尤其涉及一种火箭发动机推力矢量摆角测量解算方法、设备及介质。背景技术:1、在运载火箭、战略导弹及高超声速飞行器(后续仅以火箭...
一种火箭发动机推力矢量摆角测量解算方法、设备及介质与流程

本发明属于航天运载器及导弹飞行控制,尤其涉及一种火箭发动机推力矢量摆角测量解算方法、设备及介质。

背景技术:

1、在运载火箭、战略导弹及高超声速飞行器(后续仅以火箭为例)的飞行控制系统中,火箭发动机通常采用双向摇摆推力矢量解算技术来精确调整飞行姿态。通常采用在发动机上正交安装的2台伺服作动器作为执行机构,驱动发动机摇摆,但在发动机工作过程中由于安装支点的形变、安装间隙等非线性环节,使得实际的发动机喷管摆角与伺服作动器指令不一致。在控制系统研制过程中,需要获取发动机喷管相对于箭体的实际偏转角度(即推力矢量摆角),以分析执行机构的时域和频域动态性能。

2、目前的摆角测量技术主要分为“直接测量法”和“间接测量法”两大类。直接测量法通常在发动机万向节(如十字轴或球铰)的旋转轴系上直接安装角位移传感器(如旋转电位计、旋转变压器或光电编码器)。虽然这种方法能直接读取角度值,但由于万向节位于发动机喉部附近,工作环境极其恶劣(高温辐射、高频剧烈振动、结构变形),且万向节结构紧凑,往往难以预留传感器的安装空间,且存在较大的测量误差。目前工程上应用更为广泛的是间接测量法,利用安装在伺服作动器对侧的线性位移传感器(如lvdt、磁致伸缩传感器)来测量作动器或传感器的伸缩长度,再通过近似算法反解出对应的发动机喷管摆角。尽管间接测量法避开了恶劣环境,但现有的解算算法在面对新型运载器的复杂布局时,面临着严峻的挑战:

3、传统的测量解算算法通常建立在简化的“平面三角几何”或“共面安装”假设之上。即假设线性传感器的上支点(机架侧)与发动机万向节的旋转中心处于同一横截平面内(轴向高度差为0)。在此假设下,传感器与喷管的运动关系被简化为二维平面内的三角形余弦定理求解。

4、然而,受限于发动机舱狭小的空间及承力结构布局,传感器的上支点往往无法布置在通过万向节中心的箭体横截面(与箭体纵轴垂直,以下简称万向节中心横截面或摆心横截面)内,而是存在显著的轴向偏置(即上支点与通过万向节中心横截面的距离)。此时,传感器、上支点、下支点与万向节中心构成了一个复杂的“空间四边形”运动机构。若仍沿用基于共面假设的传统算法,会忽略轴向高度差对伸缩量的非线性影响,导致计算出的摆角存在显著的静态几何误差,严重影响测量解算精度。

5、当发动机进行双向同时摇摆时,由于空间机构的约束,一个通道的摆动会引起另一个通道传感器长度的变化(即几何交叉耦合效应)。设两台伺服作动器驱动对应的实际摆角分别为,两个传感器的长度是两个摆角的复杂非线性二元函数。

6、要从测量的长度反求角度,本质上是求解一组非线性二元耦合方程组的逆解()。现有的解决方法通常有以下两种,但均存在不足:

7、查表法:预先存储大量离散点的数据表。但这需要占用大量存储空间,且精度受限于插值算法,难以达到高精度解算要求。

8、传统的牛顿-拉夫逊迭代法(newton-raphson):通过计算雅可比矩阵(jacobianmatrix)的逆矩阵进行迭代求解。然而,该方法涉及大量的矩阵求导、求逆运算及复杂的三角函数计算,计算量巨大,且存在迭代不收敛的风险。

9、现有算法往往针对特定的几何构型推导解析解,一旦发动机安装参数(如偏置距离、初始长度)发生微调,就需要重新推导繁琐的数学公式并修改代码,缺乏通用性,增加了软件维护成本。

10、综上所述,现有的推力矢量测量解算方法往往建立传感器的上支点必须布置在通过万向节中心的箭体横截面内这一严格约束,给结构设计和布局带来困难。

11、因此,亟需一种基于通用笛卡尔坐标系建模,且能通过低算力消耗的数值优化方法快速、精确反解出发动机真实摆角的技术方案。

技术实现思路

1、本发明实施例的目的在于提供一种火箭发动机推力矢量摆角测量解算方法、设备及介质,以解决现有的推力矢量摆角测量解算方法存在上述缺陷问题。

2、本发明第一方面提供一种火箭发动机推力矢量摆角测量解算方法,其包括:构建包含轴向偏置参数的空间矢量模型,将方程组求解转化为无约束的非线性最小二乘优化问题,并采用数值微分辅助的梯度下降法进行求解,得到数学模型参数。

3、根据本发明第一方面的一些实施例中,在得到数学模型参数后,引入了几何解耦还原环节,输出箭体固连坐标系下的真实物理摆角。

4、根据本发明第一方面的一些实施例中,以火箭发动机的万向节旋转中心为原点构建箭体固连坐标系,并获取两路线性位移传感器的几何安装特性。

5、根据本发明第一方面的一些实施例中,进一步包括:基于所述两路线性位移传感器的几何安装特性和采集到的两个传感器电压得到相应两通道线性位移传感器的实时长度数据;

6、基于所述两通道线性位移传感器的实时长度数据和火箭发动机绕万向节转动的广义欧拉角建立旋转变换的几何约束方程组;

7、基于所述旋转变换的几何约束方程组构建非线性最小二乘目标函数以得到二元标量损失函数;

8、基于所述二元标量损失函数采用梯度下降法在解算周期内实时搜索角度最优解,并基于所述角度最优解进行几何解耦还原并输出物理摆角,从而完成火箭发动机推力矢量摆角测量解算。

9、本发明第二方面提供另一种火箭发动机推力矢量摆角测量解算方法,包括:

10、构建以火箭发动机的万向节旋转中心为原点的箭体固连坐标系,并获取两路线性位移传感器的几何安装特性;

11、基于所述两路线性位移传感器的几何安装特性和采集到的两个传感器电压得到相应通道线性位移传感器的实时长度数据;

12、基于所述两通道线性位移传感器的实时长度数据和火箭发动机绕万向节转动的广义欧拉角建立旋转变换的几何约束方程组;

13、基于所述旋转变换的几何约束方程组构建非线性最小二乘目标函数以得到二元标量损失函数;

14、基于所述二元标量损失函数采用梯度下降法在解算周期内实时搜索角度最优解,并基于所述角度最优解进行几何解耦还原并输出物理摆角,从而完成火箭发动机推力矢量摆角测量解算。

15、在本发明第二方面的一些实施例中,所述两路线性位移传感器的几何安装特性包括定点矢量和动点初始矢量;

16、所述定点矢量为所述两路线性位移传感器在机架侧的上支点位置矢量;

17、所述动点初始矢量为火箭发动机处于零位时所述两路线性位移传感器在喷管侧的下支点位置矢量。

18、在本发明第二方面的一些实施例中,所述基于所述两通道线性位移传感器的实时长度数据和火箭发动机绕万向节转动的广义欧拉角建立旋转变换的几何约束方程组,包括:

19、基于所述火箭发动机绕万向节转动的广义欧拉角构建从喷管坐标系到箭体固连坐标系的旋转变换矩阵;

20、基于所述旋转变换矩阵、所述两路线性位移传感器在机架侧的上支点位置矢量、所述两路线性位移传感器在喷管侧的下支点位置矢量和所述两通道线性位移传感器的实时长度数据建立所述旋转变换的几何约束方程组。

21、在本发明第二方面的一些实施例中,基于所述旋转变换的几何约束方程组构建非线性最小二乘目标函数以得到二元标量损失函数,包括:

22、利用正交矩阵性质消除所述旋转变换的几何约束方程组的高次项,从而将所述几何约束方程组转化为标量内积形式约束方程组;

23、基于所述标量内积形式约束方程组得到残差函数方程组;

24、基于所述残差函数方程组构建非线性最小二乘目标函数得到所述二元标量损失函数。

25、在本发明第二方面的一些实施例中,所述基于所述二元标量损失函数采用梯度下降法在解算周期内实时搜索角度最优解,包括以下步骤:

26、设定角度迭代初值和最大迭代次数,并基于所述角度迭代初值和所述二元标量损失函数计算得到当前损失函数值后,进入迭代循环;

27、每次迭代中,基于所述当前损失函数值判断当前迭代是否收敛,以得到角度最优解:

28、若所述当前损失函数值小于预设阈值,则判定当前迭代收敛,并跳出迭代循环,得到角度最优解;

29、否则,判定当前迭代未收敛,采用中心差分法计算数值梯度并沿梯度负方向更新角度参数,以作为下一次迭代的角度迭代值计算当前损失函数值,直至所述当前损失函数值小于预设阈值或达到所述最大迭代次数,得到角度最优解;

30、其中,为广义欧拉角在笛卡尔坐标系下绕轴的主旋转角的最优解,为广义欧拉角在笛卡尔坐标系下绕轴的从旋转角的最优解。

31、在本发明第二方面的一些实施例中,所述设定角度迭代初值包括:将上一解算周期的解算结果作为当前周期的角度迭代初值,或者,初始设定当前周期的角度迭代初值为0。

32、在本发明第二方面的一些实施例中,所述采用中心差分法计算数值梯度并沿梯度负方向更新角度参数,包括:

33、采用中心差分法分别近似计算所述二元标量损失函数关于所述广义欧拉角的偏导数,得到所述数值梯度,其公式如下:

34、;

35、基于所述数值梯度沿梯度负方向更新角度参数,其公式如下:

36、;

37、其中,为微小扰动量的常数,为自适应或固定学习率,为所述二元标量损失函数,为广义欧拉角在笛卡尔坐标系下绕轴的主旋转角,为广义欧拉角在笛卡尔坐标系下绕轴的从旋转角,为所述主旋转角的数值梯度,为所述从旋转角的数值梯度。

38、在本发明第二方面的一些实施例中,所述基于所述角度最优解进行几何解耦还原并输出物理摆角,包括:

39、将所述广义欧拉角在笛卡尔坐标系下绕轴的主旋转角的最优解通过所述主旋转轴直接映射,输出主旋转轴在箭体固连坐标系下的物理摆角:

40、

41、将所述广义欧拉角在笛卡尔坐标系下绕轴的从旋转角的最优解通过所述从旋转轴投影矫正,输出从旋转轴在箭体固连坐标系下的物理摆角,其投影校正公式如下:

42、;

43、其中,、为所述伺服作动器驱动下的真实物理摆角在箭体固连坐标系中的表示,为所述广义欧拉角在笛卡尔坐标系下绕轴的主旋转角的最优解,为所述广义欧拉角在笛卡尔坐标系下绕轴的从旋转角的最优解。

44、本发明第三方面提供一种计算机设备,包括存储器、处理器及存储在存储器上的计算机程序,所述处理器执行所述计算机程序以实现第一方面或第二方面所述方法的步骤。

45、本发明第四方面提供一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,计算机程序被处理器执行时实现本发明第一方面或第二方面所述方法的步骤。

46、本发明提供的火箭发动机推力矢量摆角测量解算方法、设备及介质,该方法通过建立包含轴向偏置参数的空间矢量模型,将复杂的逆运动学求解转化为低维标量函数的无约束优化问题,即构建了二元标量损失函数,将复杂的方程组求解转化为无约束的非线性最小二乘优化问题,并采用数值微分辅助的梯度下降法进行求解;在优化求解出数学模型参数后,引入了几何解耦还原环节,输出箭体固连坐标系下的真实物理摆角。本发明能够通过低算力消耗的数值优化方法快速、精确地反解出发动机真实摆角。