一种船用毫米波雷达液位计及其姿态融合测量方法与流程
本发明涉及船舶液位测量,更具体地,涉及一种船用毫米波雷达液位计及其姿态融合测量方法。
背景技术:
1、毫米波雷达液位计是一种非接触式物位测量仪表,广泛应用于船舶舱柜的液位监测。其工作原理是:毫米波雷达收发模块向被测液面发射调频连续波(fmcw)信号,接收液面反射信号并与发射信号混频,形成与目标距离对应的中频差拍信号;处理器对中频差拍信号进行模数转换和频谱分析,获得雷达天线相位中心至液面的距离,再根据预先设定的舱体高度或零点距离计算液位。
2、现有80ghz毫米波雷达液位计通常安装在舱柜顶部,并以雷达天线轴线相对水平液面近似垂直作为测量条件。在陆用固定储罐中,该条件通常能够保持稳定;但在船舶环境中,船体会随海况发生横摇、纵摇、振动及冲击,雷达外壳、天线和被测舱体随船体共同倾斜,而液体自由表面的平均法向仍主要由重力方向决定。因此,雷达天线轴线与液面法向之间会形成随船体运动变化的夹角。
3、当处理器仍将雷达沿波束方向测得的距离直接作为竖直空高时,会引入姿态相关误差。同时,液面在船体摇摆作用下产生晃荡,瞬时回波距离和回波幅度发生变化,常规固定滤波参数难以同时兼顾静止状态下的响应速度与摇摆状态下的显示稳定性。
4、现有毫米波雷达液位计通常包括毫米波雷达收发模块、模拟中频调理电路、处理器、显示及通信电路。毫米波雷达收发模块产生fmcw扫频信号并输出液面反射形成的中频差拍信号;模拟中频调理电路对中频差拍信号进行放大、滤波和共模偏置;处理器通过adc(模数转换器)采集原始中频数据,完成加窗、快速傅里叶变换、峰值搜索和距离换算,最后输出液位值。
5、部分仪表允许设置固定阻尼时间、回波窗口或回波锁定参数,但这些参数一般由用户预先设定,不能依据船体实时横摇、纵摇和运动强度对测量距离及滤波权重进行同步调整。现有产品通常也没有在雷达扫频同步时刻采集惯性数据,因而无法建立某一帧雷达回波与该帧对应姿态之间的确定关系。
6、综上所述,现有技术至少存在以下缺陷:
7、其一,将沿雷达波束方向测得的距离直接用于液位换算,未考虑雷达天线轴线与重力方向之间的夹角,船体横摇或纵摇时会产生姿态相关误差。
8、其二,雷达回波与船体姿态分别采集或完全不采集姿态,无法确定每一雷达测量帧所对应的横摇角和纵摇角。
9、其三,使用固定滤波参数,滤波较弱时船体摇摆会造成液位显示跳动,滤波较强时船舶静稳状态下真实液位变化又不能及时反映。
10、其四,仅根据雷达回波本身判断液面状态,难以区分真实液位变化与船体运动引起的短时测量波动。
11、因此,针对以上现状,迫切需要开发一种船用毫米波雷达液位计及其姿态融合测量方法,以克服当前实际应用中的不足。
技术实现思路
1、本发明旨在克服现有技术的上述缺陷,提供一种能够有效消除船体横摇、纵摇及液面晃动对液位测量影响的船用毫米波雷达液位计及其姿态融合测量方法,以解决现有技术中存在的姿态相关误差、雷达帧与姿态数据不同步、固定滤波参数难以兼顾响应速度与稳定性、以及难以区分真实液位变化与船体运动引起的测量波动等问题。
2、为实现上述目的,本发明提供以下技术方案:
3、一种船用毫米波雷达液位计,包括:
4、毫米波雷达收发模块,用于发射调频连续波信号并接收液面反射信号,输出中频差拍信号;
5、惯性测量模块,与雷达天线刚性连接,用于输出三轴加速度和三轴角速度;
6、模拟中频调理模块,与所述毫米波雷达收发模块连接,用于对所述中频差拍信号进行调理;
7、单一微控制器,分别与所述模拟中频调理模块和所述惯性测量模块连接,所述单一微控制器被配置为:
8、以同一计时基准记录所述毫米波雷达收发模块的雷达帧时间戳和所述惯性测量模块的惯性采样时间,建立每一雷达帧与对应时刻惯性数据的同步关系;
9、采集经调理后的中频差拍信号,并对所述中频差拍信号进行频谱分析以提取至少一个候选回波峰,基于所述候选回波峰获取每一雷达帧的候选回波距离;
10、读取所述惯性测量模块的数据,并根据所述同步关系获取每一雷达帧对应的惯性数据,解算每一雷达帧对应的船体姿态角;
11、将连续多个雷达帧的候选回波距离按照距离连续性进行关联,形成由各帧候选回波峰组成的动态回波轨迹,并将所述动态回波轨迹与对应的船体姿态角进行融合,以识别真实液面回波轨迹;
12、根据所述真实液面回波轨迹的波束距离和所述船体姿态角,计算姿态补偿后的最终距离或液位值;
13、输出模块,与所述单一微控制器连接,用于输出所述最终距离或液位值。
14、优选地,所述毫米波雷达收发模块输出雷达扫频同步信号,所述单一微控制器的定时器捕获端或外部中断端接收所述同步信号,并据此记录雷达帧时间戳以及启动或标记片内模数转换器的采样区间。
15、优选地,所述惯性测量模块通过数据就绪中断或fifo方式向所述单一微控制器提供惯性采样数据,所述单一微控制器采用与记录雷达帧时间戳相同的计时基准记录惯性采样时间。
16、优选地,所述单一微控制器解算船体姿态角的方式为:利用陀螺仪角速度进行短时间姿态递推,并利用低通处理后的重力加速度方向进行修正,得到横摇角和纵摇角。
17、优选地,所述单一微控制器识别真实液面回波轨迹的方式为:将候选回波距离根据所述船体姿态角投影到重力方向,得到投影后候选距离;判断所述投影后候选距离在相邻雷达帧之间是否连续,以及候选距离的变化方向和变化量是否与同期船体姿态变化相符;对满足连续性阈值且与姿态变化相符的候选回波轨迹赋予更高的液面轨迹置信度,并选择置信度最高的轨迹作为真实液面回波轨迹。
18、优选地,所述单一微控制器计算姿态补偿后的最终距离的方式为:根据所述船体姿态角计算雷达天线轴线与重力方向的夹角,并将所述真实液面回波轨迹的波束距离投影到重力方向,得到姿态补偿空高。
19、优选地,所述单一微控制器还被配置为:根据横摇角速度、纵摇角速度及动态加速度计算船体运动强度;根据所述运动强度确定滤波权重,并对所述最终距离或液位值进行递推滤波,其中运动强度越大,滤波权重越小;其中,所述动态加速度为从三轴加速度中去除重力分量后得到的加速度。具体的,所述动态加速度的提取方法为:利用所述单一微控制器已解算出的姿态四元数或旋转矩阵,将所述惯性测量模块输出的三轴加速度测量值从传感器坐标系转换到导航坐标系(即当地水平坐标系)中,在导航坐标系中减去重力矢量[0,0,g](其中g为当地重力加速度值),得到导航坐标系下的三轴动态加速度adx、ady、adz。
20、优选地,所述惯性测量模块为六轴或九轴惯性传感器,并通过spi、i2c、uart或can总线与所述单一微控制器通信连接。
21、本发明还提供一种基于上述船用毫米波雷达液位计的姿态融合测量方法,包括以下步骤:
22、步骤s1,通过毫米波雷达收发模块发射和接收信号,并经过模拟中频调理模块处理后,由单一微控制器采集获得每一雷达帧的中频差拍数据;
23、步骤s2,通过惯性测量模块采集三轴加速度和三轴角速度,并由所述单一微控制器读取并解算得到每一雷达帧对应的船体姿态角;
24、步骤s3,所述单一微控制器对所述中频差拍数据进行频谱分析,提取至少一个候选回波峰,并计算对应的候选波束距离;
25、步骤s4,所述单一微控制器将连续多个雷达帧的候选波束距离关联形成动态回波轨迹,并将所述动态回波轨迹与所述船体姿态角进行融合,识别出真实液面回波轨迹;
26、步骤s5,所述单一微控制器根据所述真实液面回波轨迹的波束距离和所述船体姿态角,计算姿态补偿后的最终距离或液位值,并通过输出模块输出。
27、优选地,所述步骤s4进一步包括:步骤s41,将候选波束距离根据所述船体姿态角投影到重力方向;步骤s42,判断投影后的候选距离在相邻帧之间的连续性和变化趋势是否与姿态角变化一致;步骤s43,对满足一致性条件的候选回波轨迹赋予高置信度,并将其确定为真实液面回波轨迹;所述步骤s5之后还包括:步骤s6,根据横摇角速度、纵摇角速度及动态加速度计算船体运动强度;步骤s7,根据所述运动强度动态调整滤波权重,对所述最终距离或液位值进行平滑滤波输出。
28、与现有技术相比,本发明具有以下有益效果:
29、第一,通过集成惯性测量模块并实时解算船体横摇角和纵摇角,将波束距离投影至重力方向进行姿态补偿,从根本上消除了船体倾斜导致的液位测量偏差。
30、第二,采用单一微控制器以统一计时基准记录雷达帧和惯性数据的时间戳,确保每一帧雷达回波均有与之严格对应的姿态数据,避免了数据异步引入的补偿误差。
31、第三,通过动态回波轨迹识别,依据候选距离连续性、轨迹置信度以及与姿态变化的一致性选择真实液面回波,有效抑制了液面晃荡和舱内障碍物导致的测量跳变与误锁定。
32、第四,根据船体运动强度动态调整滤波权重,在强摇摆时增强滤波以稳定显示,在静稳时减弱滤波以快速响应真实液位变化,实现了全工况下的最优输出表现。
33、第五,仅在现有液位计基础上增加一枚低成本mems惯性传感器,仍由原有单一微控制器完成全部处理,硬件改动小、成本低,便于产业化推广。
34、通过以下参照附图对本发明的示例性实施例的详细描述,本发明的其它特征及其优点将会变得清楚。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com