基于多频连续波相位差测距的掘进机位姿识别方法

摘要

随着矿山生产过程的日趋无人/少人化,采掘装备位姿识别技术对煤矿井下安全生产和机器协同工作具有重要意义.为了解决在空间受限的复杂掘进作业环境下,电磁波频繁反射和散射会造成密集多径和大相位误差问题,采用无源宽带谐波标签生成可利用的谐波信号,建立基于非线性二次谐波反向散射的抗干扰模型,通过上、下行链路的频率分集,抑制矿井密集多径干扰;通过基于距离的几何定位方法,提出连贯发射宽带多频连续波(Coherent Sending Broadband Multifrequency Continuous-Wave,CSMCW)相位差测距算法,来解决大相位误差条件下的测距、定位和识别的准确性难题;并以掘进机为例,研究了基于CSMCW相位差测距的无源掘进机位姿识别方法.为了验证上述理论和算法的可行性,设定了长×宽×高为105 m×4 m×3 m的掘进机仿真实验场景,分别对谐波标签抗干扰性能、CSMCW相位差测距和掘进机位姿识别效果进行了仿真测试.仿真结果表明:采用无源宽带谐波标签,与传统无源标签相比可以获得更大的信干比,具有较强的顽健性,能够有效抑制纳秒级密集多径干扰;与二次相差测距算法、参差频差测距算法相比,基于谐波反向散射抗干扰模型的CSMCW测距算法具有更强的鲁棒性,在低信噪比条件下定位测距可达到厘米级的分辨率,保证了掘进机位姿姿态角的识别;信噪比(SNR)=-5 dB、测量距离为100 m时,基于提出的多频连续波相位差测距的位姿识别方法得到掘进机航向角、俯仰角、横滚角最大误差精度约为2.3°,能够满足未来的应用要求.