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