一种用于重力仪的倾斜反馈控制方法与流程

摘要: 本发明涉及重力仪,具体涉及一种用于重力仪的倾斜反馈控制方法。背景技术:1、机载重力梯度仪是用来直接或间接勘探矿产、石油等地下资源的核心设备,其通过测量重力梯度的...
一种用于重力仪的倾斜反馈控制方法与流程

本发明涉及重力仪,具体涉及一种用于重力仪的倾斜反馈控制方法。

背景技术:

1、机载重力梯度仪是用来直接或间接勘探矿产、石油等地下资源的核心设备,其通过测量重力梯度的细微变化来反演地下地质构造。但是飞机在飞行过程中会受到大气湍流、机动飞行等影响,从而产生角运动扰动,所以需要高性能的倾斜反馈控制系统,使重力梯度传感器与地球引力场保持高度姿态稳定。

2、现有的控制系统多采用固定增益参数的pid控制器,存在根本性技术矛盾,若用高增益、高带宽参数实现高精度测量,会降低相位裕度,遇强扰动易自激振荡致数据失效;若用低增益、低带宽的保守参数保证稳定,又会牺牲响应速度和精度,在平稳飞行时无法有效抑制背景噪声,且勘探数据精度、分辨率远低于理论指标,无法动态适应扰动环境,难以平衡稳定性与精度。

技术实现思路

1、本发明的目的在于提供一种用于重力仪的倾斜反馈控制方法,解决了背景技术中存在的问题。

2、为解决上述技术问题,本发明提供一种用于重力仪的倾斜反馈控制方法,具体步骤包括:

3、步骤一、构建湍流强度指数:

4、获取预设的机载惯性测量单元输出的三轴实时加速度测量值,并对所述的三轴实时加速度测量值进行高通滤波以分离高频分量;

5、计算所述高频分量于预设时间窗口内的方差以获得三轴的波动能量;

6、将所述三轴的波动能量进行加权求和,以生成表征当前扰动环境剧烈程度的湍流强度指数;

7、步骤二、生成动态融合因子:

8、将所述湍流强度指数与预设的安全阈值和告警阈值进行比较;

9、当所述湍流强度指数低于所述安全阈值时,确定动态融合因子为第一预设值;

10、当所述湍流强度指数高于所述告警阈值时,确定所述动态融合因子为第二预设值;

11、当所述湍流强度指数介于所述安全阈值与所述告警阈值之间时,通过预设的平滑过渡函数计算所述动态融合因子;

12、步骤三、合成实时控制器参数:

13、依据所述动态融合因子,对预设的高精度pid参数集与高稳定性pid参数集进行线性插值,以实时合成pid控制器参数;

14、步骤四、执行闭环反馈控制:

15、应用实时合成的pid控制器参数,对稳定平台的姿态执行闭环反馈控制。

16、优选的,所述步骤一中构建湍流强度指数所依赖的参数确定方法包括:

17、所述高通滤波的截止频率,是根据所述重力仪控制系统的带宽特性与典型大气湍流的频谱特性预设的;

18、计算方差所用的时间窗口长度,是为在响应实时性与计算稳定性之间取得平衡而预设的;

19、加权求和所用的三轴权重系数,是通过对历史飞行数据进行分析,以确定不同轴向的振动对稳定平台相位裕度消耗的敏感度后进行赋值的,敏感度最高的轴向被赋予最大权重。

20、优选的,所述步骤二中当所述湍流强度指数介于所述安全阈值与所述告警阈值之间时,所述通过预设的平滑过渡函数计算所述动态融合因子的步骤包括:

21、s21、将所述湍流强度指数与所述安全阈值和告警阈值的算术平均值进行求差,得到差值;

22、s22、将所述差值除以所述告警阈值与安全阈值之差的一半,得到商值;

23、s23、对所述商值应用预设的归一化s型过渡函数进行计算,以生成数值上在所述第一预设值与所述第二预设值之间连续且一阶导数连续变化的所述动态融合因子。

24、优选的,所述步骤二中预设的湍流强度安全阈值与告警阈值来源包括:

25、建立所述稳定平台的数学模型;

26、通过仿真分析,获得所述稳定平台的相位裕度、所述湍流强度指数以及pid参数三者间的函数关系图;

27、所述安全阈值的确定包括:将所述系统设定于高精度控制策略下,确定使所述相位裕度从初始值下降至预设的第一安全裕度值时所对应的所述湍流强度指数,作为所述安全阈值;

28、所述告警阈值的确定包括:将所述系统设定于高精度控制策略下,确定使所述相位裕度下降至预设的临界稳定裕度值时所对应的所述湍流强度指数,作为所述告警阈值。

29、优选的,所述步骤三中预设的高精度pid参数集与高稳定性pid参数集是在系统设计阶段,结合控制系统理论设计方法与仿真实验一次性确定的。

30、优选的,所述步骤三中依据动态融合因子对高精度pid参数集与高稳定性pid参数集进行线性插值的步骤具体包括:

31、s31、由1减去所述动态融合因子,得到差值;

32、s32、将所述高精度pid参数集中的比例增益参数与所述差值相乘,得到第一乘积;

33、s33、将所述高稳定性pid参数集中的比例增益参数与所述动态融合因子相乘,得到第二乘积;

34、s34、将所述第一乘积与所述第二乘积相加,以获得实时生效的比例增益参数;

35、s35、采用与所述比例增益参数相同的线性插值方法,获得实时生效的积分增益参数与微分增益参数。

36、优选的,通过所述步骤一至步骤四的协同执行,稳定平台的相位裕度在整个工作过程中被动态维持于所述临界稳定裕度值之上。

37、优选的,所述机载惯性测量单元输出的三轴实时加速度测量值,来源于安装于承载飞机机体上的惯性测量单元;

38、所述期望姿态设定值为一恒定零值,以要求所述稳定平台维持绝对水平台姿态。

39、优选的,所述高精度pid参数集用于优化常规飞行条件下的测量精度,所述高稳定性pid参数集用于确保强扰动环境下的系统稳定性;且所述执行闭环反馈控制的步骤包括:

40、s41、获取陀螺仪传感器测量得到的平台实时姿态,并与期望姿态设定值比较,以计算实时姿态误差;

41、s42、应用所述实时合成的pid控制器参数,对所述实时姿态误差进行比例、积分、微分运算,以生成最终控制信号;

42、s43、将所述最终控制信号输出至力矩电机,以完成对所述稳定平台姿态的闭环校正。

43、有益效果

44、与现有技术相比,本发明具有以下有益效果:

45、1.通过动态解耦稳定与精度矛盾,能根据扰动环境自适应切换控制策略。平稳飞行时采用高精度模式保障数据质量,出现强扰动时切换到高稳定模式确保设备安全,实现全工况最优控制,同时兼顾稳定性与精度。

46、2.通过前瞻性管理相位裕度,基于系统模型仿真设定阈值,能够提前感知扰动并调整参数,使相位裕度始终维持在安全阈值以上,从而有效规避突发扰动导致的失稳风险,克服了高增益系统易因强扰动振荡的缺陷。

47、3.通过归一化s型函数和线性插值实现控制策略平滑过渡,避免参数切换对设备的冲击,保证数据流连续,提升了设备物理完整性与数据可靠性。

48、4.在多数时间采用高精度模式抑制背景噪声,仅在必要时短暂牺牲精度,显著提高数据质量,提升了勘探效率与投资回报率,避免因全程保守控制导致精度损失大的问题。