一种基于无源RFID的掘进机位姿参数检测方法技术

技术编号:24329720 阅读:70 留言:0更新日期:2020-05-29 19:12
本发明专利技术公布了一种基于无源RFID的掘进机位姿参数检测方法,属于掘进机位姿识别领域;首先利用无源宽带谐波标签,建立谐波反向散射抗干扰模型,以消除发射天线泄漏的强自干扰和密集多径干扰;然后利用遗传算法优化选取使得相位误差容忍最大的最优频率组合;接着利用连贯发射宽带多频连续波相位差测距方法,解决掘进工作面距离模糊问题;采用几何定位算法获得机身上无源标签的高精度定位;最后建立掘进机机身位姿模型,根据无源标签的三维坐标位置,即可实现掘进机机身位姿参数检测。

A detection method of heading machine pose parameters based on passive RFID

【技术实现步骤摘要】
一种基于无源RFID的掘进机位姿参数检测方法
本专利技术涉及掘进机位姿识别领域,特别涉及一种基于无源RFID的掘进机位姿参数检测方法。
技术介绍
随着智能化装备和物联网技术的发展,矿山采、掘、运等安全生产过程逐渐趋向无人/少人化,悬臂式掘进机位姿实时识别技术是综掘工作面无人化技术的核心,掘进质量直接决定生产效率,对提高煤矿井下安全生产管理及人员调度的有效性、应对突发事故抢险救援的高效性、实现未来机器协同工作及智能化无人生产都具有重要意义。近年来,相关学者对掘进机位姿定位识别进行了一定的研究。中国矿业大学(北京)吴淼教授团队提出了一种面向掘进机的超宽带位姿协同检测方法,依据波达时间差及P440模块测距建立定位模型,利用协同定位算法估计定位点坐标,以及将悬臂式掘进机的机械机构简化为一系列平移或旋转关节串联而成的运动链,建立了掘进机空间位姿坐标体系;中国矿业大学的童敏明教授团队提出了一种基于机器视觉的掘进机机身实时监测系统,对掘进机机身位姿参数进行自动检测,抗干扰能力强。以上掘进机定位与姿态识别方法基本上采用的是有源定位识别技术,随智能化、无人化矿山开采技术的发展,有必要开展隧道、矿井等复杂环境下的无源识别方法的研究。
技术实现思路
本专利技术所要解决的技术问题是克服现有技术的不同而提供一种基于无源RFID的掘进机位姿参数检测方法,利用无源谐波反向散射标签消除了发射天线泄漏的强自干扰、抵抗密集多径干扰,基于连贯扫射宽带多频连续波相位差测距方法,解决掘进工作面距离模糊的问题,实现准确有效的掘进机位姿识别。本专利技术为解决上述技术问题采用以下技术方案:一种基于无源RFID的掘进机位姿参数检测方法,具体包括以下步骤:步骤1:利用无源宽带谐波标签,建立谐波反向散射抗干扰模型;步骤2:利用遗传算法优化选取使得相位误差容忍最大的最优频率组合;步骤3:利用连贯扫射宽带多频连续波相位差测距方法,解决掘进工作面距离模糊问题;步骤4:采用几何定位算法获得机身上无源标签的高精度定位;步骤5:建立掘进机机身位姿模型,根据无源标签的三维坐标位置,确定掘进机机身的具体位姿。作为本专利技术一种基于无源RFID的掘进机位姿参数检测方法的进一步优选方案,所述步骤1具体如下:当下行链路信号以载波频率f0从发射机传到标签以后,利用无源标签中的非线性元件产生相应的二次谐波频率为2f0,接收天线只接收2f0频率的谐波信号,不再接收频率为f0的信号,即二次谐波频率2f0为从标签到接收天线链路的信号,实现下行和上行链路的频率分集,消除了发射天线泄漏的强自干扰、抵抗密集多径干扰。作为本专利技术一种基于无源RFID的掘进机位姿参数检测方法的进一步优选方案,所述步骤2具体如下:步骤2.1,选择矿井无线通信优质载波频率包含916MHz和2.4GHz;步骤2.2,基于矿井工作面通信距离及相位差测距距离模糊产生的机理,利用遗传算法优化选择连贯扫射宽带多频连续波频率;其中,为了优化频率的选取,要定义一个阈值方程:其中,fi为第i个正弦波频率,其中,1≤i≤K,K为多频连续波个数,N是自然数集合,ai至少有一个为非零值,f为所选的最优频率组合,Rmax为可测得的最远距离,则最大相位误差阈值Φ为通过公式(1)和公式(2)即可利用遗传算法优化选取K个相位误差容忍最大的最优频率序列,设最优频率组合为fmax=f1≥f2…≥fK=fmin,则可得到相位误差阈值为作为本专利技术一种基于无源RFID的掘进机位姿参数检测方法的进一步优选方案,所述步骤3具体如下:构造回波信号模型,利用无源宽带谐波标签产生的K个二次谐波信号所产生的相位差组合来消除距离模糊,实现精确测距;读写器与无源宽带谐波标签之间的真实距离表示为由于掘进工作面空间受限,密集多径干扰严重,实际测得的相位差和理论值之间会有误差,导致测距误差ei存在;第i个频率作用下读写器到谐波标签的实际测量距离Ri可表示为为了解决距离模糊问题,通过连贯发射多频连续波和有约束的最小均方误差的方法,使各个频率作用下的测量误差ei的平方和最小,即约束条件是,对于所有满足此时,即可利用公式(6)和其两个约束条件,获得ni和真实距离R的无模糊估计值;如果相位差误差很大,且公式(7)将不成立,则放松阈值Φ为Φm+1=Φmω(8)直至满足为止;其中,ω为松弛因子,取值大于1,Φm表示第m次设置的阈值,用Φm+1替代公式(7)中的Φ,则得此时同理,利用公式(6)和其两个约束条件获得真实距离R的无模糊估计值。作为本专利技术一种基于无源RFID的掘进机位姿参数检测方法的进一步优选方案,所述步骤4具体如下:设读写器的坐标为S1(x1,y1,z1),S2(x2,y2,z2),S3(x3,y3,z3),S4(x4,y4,z4);则它们到每一个机身无源标签的距离可写成四个球面方程:求解上述方程组可得到机身无源谐波标签的三维坐标,分别表示为A(xa,ya,za),B(xb,yb,zb),C(xc,yc,zc);即采用几何定位算法可获得掘进机机身无源标签的精确定位。作为本专利技术一种基于无源RFID的掘进机位姿参数检测方法的进一步优选方案,所述步骤5具体如下:以巷道横截面底线中心为坐标原点、巷道中线的方向为x轴、腰线方向为z轴,建立掘进机机身位姿模型,并分别给出航向角、俯仰角,以及横滚角的计算公式:其中,航向角为在xoy平面上掘进机与x轴夹角,俯仰角为在xoz平面上掘进机与x轴夹角,横滚角为在yoz平面上掘进机与y轴夹角;根据无源标签的三维坐标位置A(xa,ya,za)、B(xb,yb,zb)和C(xc,yc,zc),利用公式(11)至公式(13)即可实现掘进机机身位姿参数检测。本专利技术采用以上技术方案与现有技术相比,具有以下技术效果:(1)采用无源谐波反向散射标签,可有效地消除发射天线泄漏的强自干扰、抵抗密集多径干扰;(2)利用连贯扫射宽带多频连续波相位差测距方法,解决掘进工作面距离模糊问题,实现高精度测距。附图说明图1为基于无源RFID的掘进机位姿参数检测方法流程图;图2为基于无源RFID的掘进机位姿参数检测系统结构图;图3为谐波反向散射多径场景图;图4为掘进机姿态角计算模型。具体实施方式下面结合附图对本专利技术的技术方案做进一步的详细说明:一种基于无源RFID的掘进机位姿参数检测方法,具体包括以下步骤:步骤1:利用无源宽带谐波标签,建立谐波反向散射抗干扰模型;当下行链路信号以载波频率f0从发射机传到标签以后,利用无源标签中的非线性元件产生相应的二次谐波频率为2f0,接收天线只接收2f0频率的谐波信号,不再接收频率为f0的信号,即二次谐波频率2f0为从标签到接收天线本文档来自技高网...

【技术保护点】
1.一种基于无源RFID的掘进机位姿参数检测方法,其特征在于,具体包括以下步骤:/n步骤1:利用无源宽带谐波标签,建立谐波反向散射抗干扰模型;/n步骤2:利用遗传算法优化选取使得相位误差容忍最大的最优频率组合;/n步骤3:利用连贯扫射宽带多频连续波相位差测距方法,解决掘进工作面距离模糊问题;/n步骤4:采用几何定位算法获得机身上无源标签的高精度定位;/n步骤5:建立掘进机机身位姿模型,根据无源标签的三维坐标位置,确定掘进机机身的具体位姿。/n

【技术特征摘要】
1.一种基于无源RFID的掘进机位姿参数检测方法,其特征在于,具体包括以下步骤:
步骤1:利用无源宽带谐波标签,建立谐波反向散射抗干扰模型;
步骤2:利用遗传算法优化选取使得相位误差容忍最大的最优频率组合;
步骤3:利用连贯扫射宽带多频连续波相位差测距方法,解决掘进工作面距离模糊问题;
步骤4:采用几何定位算法获得机身上无源标签的高精度定位;
步骤5:建立掘进机机身位姿模型,根据无源标签的三维坐标位置,确定掘进机机身的具体位姿。


2.根据权利要求1所述的一种基于无源RFID的掘进机位姿参数检测方法,其特征在于,所述步骤1具体如下:
当下行链路信号以载波频率f0从发射机传到标签以后,利用无源标签中的非线性元件产生相应的二次谐波频率为2f0,接收天线只接收2f0频率的谐波信号,不再接收频率为f0的信号,即二次谐波频率2f0为从标签到接收天线链路的信号,实现下行和上行链路的频率分集,消除了发射天线泄漏的强自干扰、抵抗密集多径干扰。


3.根据权利要求2所述的一种基于无源RFID的掘进机位姿参数检测方法,其特征在于,所述步骤2具体如下:
步骤2.1,选择矿井无线通信优质载波频率包含916MHz和2.4GHz;
步骤2.2,基于矿井工作面通信距离及相位差测距距离模糊产生的机理,利用遗传算法优化选择连贯扫射宽带多频连续波频率;其中,为了优化频率的选取,要定义一个阈值方程:



其中,fi为第i个正弦波频率,其中,1≤i≤K,K为多频连续波个数,N是自然数集合,ai至少有一个为非零值,f为所选的最优频率组合,Rmax为可测得的最远距离,则最大相位误差阈值Φ为



通过公式(1)和公式(2)即可利用遗传算法优化选取K个相位误差容忍最大的最优频率序列,设最优频率组合为fmax=f1≥f2…≥fK=fmin,则可得到相位误差阈值为





4.根据权利要求3所述的一种基于无源RFID的掘进机位姿参数检测方法,其特征在于,所述步骤3具体如下:
构造回波信号模型,利用无源宽带谐波标签产生的K个二次谐波信号所产生的相位差组合来消除距离模糊,实现精确测距;读写器与无源宽带谐波标签之间的真实距离表示为<...

【专利技术属性】
技术研发人员:张晓光杨悦孙彦景滕跃段元星曹俊祥赵真汉
申请(专利权)人:中国矿业大学
类型:发明
国别省市:江苏;32

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1