一种具备自修正的井下多传感融合低功耗无线定位系统

1.本技术涉及井下定位技术领域，特别是涉及一种具备自修正的井下多 传感融合低功耗无线定位系统。


背景技术：

2.要实现井下辅助运输车辆的井下无人自主工作，首要问题就是辅助运 输车辆的煤矿井下精确定位问题，现有的煤矿运输机车定位大多数采用人 工巡检或基于rfid、zigbee、wi-fi和uwb等无线通信技术的定位方式， 人工巡检成本高、效率低、时间长，安全隐患较大，而单纯通过无线通信 方式进行定位，由于煤矿井下巷道狭长，空间狭小，存在较多的大型用电 设备，都将对无线信号的传播和通信带来较多的干扰，使得单纯基于无线 通信的方式进行定位，定位精度无法达到满意的效果，系统稳定性也差强 人意，虽然uwb技术的定位精度以及系统稳定性较好，但该技术涉及的定 位方式要求工作时间所有设备都处于在线工作状态，不仅增加资源消耗， 还容易造成无线通信网络拥堵等问题，容易影响定位精度。


技术实现要素：

[0003][0004]
基于此，有必要针对上述技术问题，提供一种能够解决容易影响定位 精度的问题的具备自修正的井下多传感融合低功耗无线定位系统。
[0005]
一种具备自修正的井下多传感融合低功耗无线定位系统，所述系统包 括：uwb测距基站、rfid基站、uwb标签、rfid标签、imu模块、嵌 入式硬件平台和上位机；
[0006]
预设数量的所述uwb测距基站是根据uwb测距基站和uwb标签的 通讯距离a，按小于等于所述通讯距离a的1/2尺寸，等间距的布置于井下 辅助运输车辆所通过的煤矿井下巷道没有异物遮挡的同一侧，并保持同一 水平；
[0007]
所述rfid基站是按照每两个所述uwb测距基站之间中间位置处布置 一个rfid基站，且两个相邻的rfid基站之间的布置距离大于rfid基站 与rfid标签的通讯距离b，确保rfid标签不会同时与两个rfid基站通 讯；
[0008]
每个所述uwb测距基站和各所述uwb测距基站两侧的rfid基站通 过有线网络连接方式接入同一个嵌入式硬件平台；
[0009]
所述rfid标签和所述uwb标签配置于待定位的井下辅助运输车辆上 靠近uwb测距基站布置方位的一侧；
[0010]
所述imu模块设置于待定位的井下辅助运输车辆上；
[0011]
所述上位机与所述嵌入式硬件平台网络、所述imu模块网络连接。
[0012]
在其中一个实施例中，所述嵌入式硬件平台与rfid基站之间的数字信 息传输采用2进制编码，使用通用串行总线接口、以rs485协议传输，嵌 入式硬件平台通过发出高电平信号的上沿激活uwb测距基站、低电平信号 的下沿关闭uwb测距基站，该高电平信号和低
电平信号使用通用串行总线 接口、以rs422协议传输。
[0013]
在其中一个实施例中，所述嵌入式硬件平台通过rs485协议接收rfid 基站的信号进行处理，通过com传输实现uwb测距基站激活与休眠功能， 并将接收所述uwb测距基站反馈信号传输至所述上位机。
[0014]
在其中一个实施例中，所述imu模块用于获取待定位的井下辅助运输 车辆的速度、加速度、角速度信息，进行位置解算，获得第一位置信息i
la
。
[0015]
在其中一个实施例中，所述上位机用于获取所述imu模块传输的第一 位置信息i
la
，以及所述嵌入式硬件平台网络传输的反馈信号进行位置解算， 获得最终测量位置信息并输入偏移卡尔曼滤波器，利用偏移卡尔曼滤波器 降低非视距干扰等测量干扰，输出最终的定位信息并显示。
[0016]
上述具备自修正的井下多传感融合低功耗无线定位系统，通过预设数 量的uwb测距基站是根据uwb测距基站和uwb标签的通讯距离a，按 小于等于通讯距离a的1/2尺寸，等间距的布置于井下辅助运输车辆所通过 的煤矿井下巷道没有异物遮挡的同一侧，并保持同一水平；rfid基站是按 照每两个uwb测距基站之间中间位置处布置一个rfid基站，且两个相邻 的rfid基站之间的布置距离大于rfid基站与rfid标签的通讯距离b， 确保rfid标签不会同时与两个rfid基站通讯；每个uwb测距基站和各 uwb测距基站两侧的rfid基站通过网络连接同一个嵌入式硬件平台； rfid标签和uwb标签配置于待定位的井下辅助运输车辆上靠近uwb测 距基站布置方位的一侧；imu模块设置于待定位的井下辅助运输车辆上； 上位机与嵌入式硬件平台网络、imu模块网络连接，通过imu与uwb的 融合定位，避免了只用无线定位时易受环境影响而导致的定位精度下降， 提高了定位精度。
附图说明
[0017]
图1为一个实施例中煤矿井下的uwb基站、rfid基站、uwb标签、rfid 标签布置示意图；
[0018]
图2为一个实施例中嵌入式硬件平台示意图。
具体实施方式
[0019]
为了使本技术的目的、技术方案及优点更加清楚明白，以下结合附图及 实施例，对本技术进行进一步详细说明。应当理解，此处描述的具体实施 例仅仅用以解释本技术，并不用于限定本技术。
[0020]
在一个实施例中，提供了一种具备自修正的井下多传感融合低功耗无 线定位系统，包括：uwb测距基站、rfid基站、uwb标签、rfid标签、 imu模块、嵌入式硬件平台和上位机；
[0021]
预设数量的uwb测距基站是根据uwb测距基站和uwb标签的通讯 距离a，按小于等于通讯距离a的1/2尺寸，等间距的布置于井下辅助运输 车辆所通过的煤矿井下巷道没有异物遮挡的同一侧，并保持同一水平；rfid 基站是按照每两个uwb测距基站之间中间位置处布置一个rfid基站，且 两个相邻的rfid基站之间的布置距离大于rfid基站与rfid标签的通讯 距离b，确保rfid标签不会同时与两个rfid基站通讯；每个uwb测距 基站和各uwb测距基站两侧的rfid基站通过有线网络连接方式接入同一 个嵌入式硬件平台；rfid标签和
uwb标签配置于待定位的井下辅助运输 车辆上靠近uwb测距基站布置方位的一侧；imu模块设置于待定位的井 下辅助运输车辆上；上位机与嵌入式硬件平台网络、imu模块网络连接。
[0022]
其中，预设数量可根据煤矿井下巷道的长度确定，也可以根据实际需 要确定。根据uwb测距基站和uwb标签的通讯距离a，等间距将预设数 量的uwb测距基站布置于井下辅助运输车辆所通过的煤矿井下巷道，可以 提高uwb技术测距精度，减小因传输过程中的信号衰减导致的测距误差。 上位机与嵌入式硬件平台网络、imu模块的网络连接，可以利用井下已具 备的网络环境实现网络连接。
[0023]
以辅助运输车辆前进方向为正方向，通过对uwb测距基站和rfid基 站进行“正、负”标定命名的方式进行区分，例“某uwb测距基站正方向 上的rfid基站”，同时，在后文描述中可见，“某uwb测距基站正方向上 的rfid基站”与“该uwb测距基站正方向上相邻的uwb测距基站的负 方向上的rfid基站”两种描述指向为同一个rfid基站，即同一个rfid 基站在不同的语境描述下有两种指向性描述。
[0024]
具体地：如图1所示，以井下辅助运输车辆前进方向为“正”方向， 依据uwb测距基站和uwb标签的通讯距离a，将uwb测距基站以小于 等于通讯距离的1/2尺寸，等间距的布置于辅助运输车辆所通过的煤矿井下 巷道的同一侧，保持同一水平，并保证没有异物遮挡。并从井下辅助运输 车辆出发起点开始，依次命名为uwb1、uwb2……
uwbi……
uwbn。
[0025]
每两个uwb测距基站之间中间位置处布置一个rfid基站，根据rfid 基站与rfid标签的通讯距离b，保证两个相邻的rfid基站之间的布置距 离大于通讯距离b，确保rfid标签不会同时与两个rfid基站通讯。以辅 助运输车辆前进方向为正方向，对rfid基站进行区分命名，如第i个uwb 测距基站uwbi负方向上的rfid基站记为rfid
ia
，正方向上的rfid基站 记为rfid
ib
，第i+1个uwb测距基站uwbi负方向上的rfid基站记为 rfid
i+1a
，且rfid
ib
与rfid
i+1a
所指为同一个rfid基站，后续描述中为简 便起见，将该rfid基站描述为rfid基站rfid
ib
/rfid
i+1a
。
[0026]
在一个实施例中，嵌入式硬件平台与rfid基站之间的数字信息传输采 用2进制编码，使用通用串行总线接口、以rs485协议传输，嵌入式硬件 平台通过发出高电平信号的上沿激活uwb测距基站、低电平信号的下沿关 闭uwb测距基站，该高电平信号和低电平信号使用通用串行总线接口、以 rs422协议传输。
[0027]
在一个实施例中，所述嵌入式硬件平台通过rs485协议接收rfid基 站的信号进行处理，通过com传输实现uwb测距基站激活与休眠功能， 并将接收所述uwb测距基站反馈信号传输至所述上位机。
[0028]
其中，rfid基站检测到待定位的井下辅助运输车辆上的rfid标签信 号时，将该信号反馈给对应的嵌入式硬件平台，嵌入式硬件平台将信号转 换为激活uwb测距基站的信号，传输给对应的uwb测距基站，实现对uwb测距基站激活与休眠功能。如图2所示，嵌入式硬件平台是基于stm32 平台构建的，包括stm32嵌入式单片机、rfid信号接收模块1、rfid信 号接收模块2和uwb测距基站激活/休眠模块。
[0029]
在对煤矿井下巷道的待定位的井下辅助运输车辆进行定位时，首先初 始化uwb标签，使uwb标签以固定的间隔发射广播请求帧r0。井下辅助 运输车辆运动初始时，出发点为起点的第一个和第二个uwb测距基站处于 激活状态，其他uwb测距基站处于休眠状态。被激活的uwb测距基站采 集uwb标签发出的信号，并以各自re帧返回uwb标签，采集uwb标签 与
uwb基站之间的信号强度、信号飞行时间等信息作为反馈信号返回给嵌 入式硬件平台，嵌入式硬件平台将反馈信号反馈给上位机。
[0030]
待定位的井下辅助运输车辆前进方向为“正”方向进行标识定位，当 待定位的井下辅助运输车辆运动至某一uwb测距基站(记为uwbi)的负 方向上的rfid基站(记为rfid
ia
)信号接收范围内，待定位的井下辅助运 输车辆上的rfid标签与rfid基站rfidia建立通讯，激活该uwb测距 基站uwbi正方向上的相邻uwb测距基站(记为uwb
i+1
)，此刻该uwb 测距基站uwbi的负方向上的相邻uwb测距基站(记为uwb
i-1
)已处于激 活状态，则此时共有uwb
i-1
、uwbi和uwb
i+1
共计三个uwb测距基站同 时处于激活状态，其他uwb测距基站处于节能休眠状态，
[0031]
在一个实施例中，所述imu模块用于获取待定位的井下辅助运输车辆 的速度、加速度、角速度信息，进行位置解算，获得第一位置信息i
la
。
[0032]
运动开始时，待定位的井下辅助运输车辆上的imu模块被激活，开始 同步实时记录待定位的井下辅助运输车辆的速度、加速度、角速度信息， 并基于这些信息实时解算位置信息，记为位置信息i
la
。
[0033]
在一个实施例中，上位机用于获取所述imu模块传输的第一位置信息 i
la
，以及所述嵌入式硬件平台网络传输的反馈信号进行位置解算，获得最终 测量位置信息并输入偏移卡尔曼滤波器，输出最终的定位信息并显示。
[0034]
其中，输入偏移卡尔曼滤波器进一步处理，可以降低非视距干扰等测 量干扰。
[0035]
上位机通过三个uwb测距基站与uwb标签分别建立的通讯，传输的 反馈信号，分别计算三个uwb测距基站与uwb标签的相对距离。
[0036]
上位机根据uwb标签与三个uwb测距基站的相对距离，计算出此时 uwb标签所代表的待定位的井下辅助运输车辆的实时位置信息，记为第二 位置信息u
la
。当待定位的井下辅助运输车辆继续行进，到达uwb测距基 站uwbi的正方向上的rfid基站处，即uwb测距基站uwb
i+1
的负方向上 的rfid基站(记为rfid
ib
/rfid
i+1a
)，此时rfid标签与该rfid基站 rfid
ib
/rfid
i+1a
建立通讯，关闭此uwb测距基站uwb
i-1
，同样的，激活 uwb测距基站uwbi的正方向上间隔相邻的uwb测距基站uwb
i+2
，保证 uwb标签同时与三个uwb测距基站(uwbi、uwb
i+1
、uwb
i+2
)建立通讯， 获得此刻的位置信息。为叙述方便，该位置信息仍命名为第二位置信息u
la
。
[0037]
计算三个uwb测距基站与uwb标签的相对距离，可以选用tof、 ss-twr、ds-twr、ads-twr等技术计算，均为该领域内的常见技术， 在此不再赘述。
[0038]
根据uwb标签与三个uwb测距基站的相对距离，计算出此时uwb 标签所代表的待定位的井下辅助运输车辆的实时位置信息，可以采用toa、 tdoa、三边定位等定位技术，该技术为领域内的常见技术，在此不再赘述。
[0039]
在t时刻，计算得到t时刻的第二位置信息为u
la
(t)，imu模块计算得 到t时刻的第一位置信息为i
la
(t)，当|u
la
(t)-i
la
(t)|≥er时，重新测量并计算u
la
(t) 和i
la
(t)，当|u
la
(t)-i
la
(t)|＜er时，得到融合后的最终测量位置信息 t
l
＝α1
×ula
(t)+α2
×ila
(t)，其中，er、α1与α2为权重融合参数，结合实际环境 测算得出。
[0040]
将实测的位置信息t
l
作为观测值输入偏移卡尔曼滤波器，解算得出最 终的定位信息回传上位机显示，完成定位。
[0041]
其中，偏移卡尔曼滤波器是对基本的卡尔曼滤波器进行卡尔曼增益矩 阵的重构，卡尔曼滤波器为该领域内的常见技术，在此不再赘述。增益矩 阵的重构，是指通过对卡尔
曼滤波器中的测量残差向量元素y
res
(i)进行比较， 获得系数矩阵ξ，
[0042][0043][0044]
其中，ξ(i)为系数矩阵中第i个元素，i∈1,2,3
……
n，δ与ε为卡尔曼增 益修正系数，其取值与现场环境相关，需要结合实际环境测算得出。并以 此矩阵代替原来的卡尔曼增益，获得的新卡尔曼滤波器称为偏移卡尔曼滤 波器。
[0045]
本技术的一种基于射频识别技术(rfid)，捷联惯导技术(imu)，超 宽带(ultra wide band，uwb)技术融合的低功耗井下辅助运输车辆的高 精度定位技术方法，以解决复杂井下环境干扰下煤矿井下辅助运输车辆定 位精度差及传统的uwb技术定位过程中大量基站同时工作引发功耗高及 通讯网络拥堵等问题。主要分为两个功能部分，第一功能部分的目的为利 用射频识别技术(rfid)及超宽带(ultra wide band，uwb)技术实现井 下辅助运输车辆的低功耗粗定位，得到uwb粗定位信息，记为u
la
，第二 功能部分的目的是利用第一部分得到的uwb粗定位信息u
la
，结合imu设 备得到的粗定位信息，记为i
la
，基于扩展卡尔曼滤波技术及权重抉择重构 实现井下辅助运输车辆在复杂环境干扰下的高精度动态定位
[0046]
上述具备自修正的井下多传感融合低功耗无线定位系统，用于井下辅 助运输车辆的高精度定位，一方面可以通过休眠及分段唤醒机制，减小功 耗，同时减少uwb系统同时在线通讯设备数量，减少通讯拥堵，提高通讯 及定位效率，另一方面imu与uwb的融合定位，避免了只用无线定位时 易受环境影响而导致的定位精度下降，同时还通过引入偏移卡尔曼滤波器， 解决了因复杂井下环境干扰下而导致的非视距定位误差(nlos)或因车辆 震动而导致的imu设备测量误差，提高了煤矿井下辅助运输车辆定位精度 和系统可靠性，为煤矿井下辅助运输车辆后续的自主导航无人驾驶等技术 的发展提供了可靠保证，降低安全风险。
[0047]
上述具备自修正的井下多传感融合低功耗无线定位系统的具体工作步 骤为：
[0048]
步骤1：如图1所示，将uwb标签配置于待定位的井下辅助运输车辆 上靠近uwb测距基站布置方位的一侧，运动开始时，初始化uwb标签， 使uwb标签以固定的间隔发射广播请求帧r0，同时imu模块被激活，开 始同步实时记录车辆的速度、加速度、角速度信息，并基于这些信息实时 解算位置信息，记为第一位置信息i
la
。
[0049]
步骤2：待定位的井下辅助运输车辆运动初始时，uwb测距基站uwb1和uwb2处于激活状态，其他uwb测距基站处于休眠状态。
[0050]
步骤3：在t时刻，待定位的井下辅助运输车辆运动至uwb测距基站 uwbi负方向上的rfid基站rfid
ia
的信号接收范围内时，rfid标签与rfid 基站rfidia建立通讯，通过嵌入式硬件平台发出信号激活uwb测距基站 uwb
i+1
，且此时uwb测距基站基站uwb
i-1
已在车辆到达之前激活并保持 激活状态，则此时uwb
i-1
、uwbi和uwb
i+1
共计三个uwb测距基站同时 处于激活状态，其他uwb测距基站处于节能休眠状态，三个uwb测距基 站与uwb标签建立通讯，采
集uwb标签发出的信号，并以各自re帧返 回uwb标签，采集uwb标签与uwb基站之间的信号强度、信号飞行时 间等信息作为反馈信号返回给嵌入式硬件平台，嵌入式硬件平台将反馈信 号反馈给上位机，上位机分别计算uwb测距基站与uwb标签的相对距离。
[0051]
步骤4：上位机根据uwb标签与三个uwb测距基站的相对距离，计 算出此时uwb标签所代表的待定位的井下辅助运输车辆的实时位置信息， 记为第二位置信息u
la
(t)，imu模块计算得到的第一位置信息为i
la
(t)，当 |u
la
(t)-i
la
(t)|≥er时，重新测量并计算u
la
(t)和i
la
(t)，当|u
la
(t)-i
la
(t)|＜er时，得 到融合后的最终测量位置信息t
l
(t)＝α1
×ula
(t)+α2
×ila
(t)，其中，er、α1与α2 为权重融合参数，结合实际环境测算得出。将最终测量位置信息t
l
(t)作为观 测值输入偏移卡尔曼滤波器，解算此刻最终的定位信息location(t)并在上位 机显示。
[0052]
步骤5：当待定位的井下辅助运输车辆继续行进，在t+1时刻到达rfid 基站rfid
ib
/rfid
i+1a
处时，rfid标签与该rfid基站rfid
ib
/rfid
i+1a
建立 通讯，通过嵌入式硬件平台发出信号关闭uwb测距基站uwb
i-1
，激活uwb 测距基站uwb
i+2
，保证uwb标签同时与uwbi、uwb
i+1
、uwb
i+2
建立通 讯，嵌入式硬件平台将反馈信号反馈给上位机获得此刻的第二位置信息。 为叙述方便，该位置信息仍命名为位置信息u
la
(t+1)，imu模块计算得到的 第一位置信息为与i
la
(t+1)，当|u
la
(t+1)-i
la
(t+1)|≥er时，重新测量并计算u
la
(t+1) 和i
la
(t+1)，当|u
la
(t+1)-i
la
(t+1)|＜er时，得到融合后的最终测量位置信息 t
l
(t+1)＝α1
×ula
(t+1)+α2
×ila
(t+1)。将最终测量位置信息t
l
(t+1)作为观测值输 入偏移卡尔曼滤波器，解算此刻最终的定位信息location(t)并在上位机显示。
[0053]
进一步的，每一次调用偏移卡尔曼滤波器，都需进行一次增益矩阵重 构并以此矩阵代替原来的卡尔曼增益，过程为对卡尔曼滤波器中的测量残 差向量元素y
res
(i)进行比较，获得系数矩阵ξ,
[0054][0055][0056]
以上实施例的各技术特征可以进行任意的组合，为使描述简洁，未对 上述实施例中的各个技术特征所有可能的组合都进行描述，然而，只要这 些技术特征的组合不存在矛盾，都应当认为是本说明书记载的范围。
[0057]
以上所述实施例仅表达了本技术的几种实施方式，其描述较为具体和 详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对 于本领域的普通技术人员来说，在不脱离本技术构思的前提下，还可以做 出若干变形和改进，这些都属于本技术的保护范围。因此，本技术专利的 保护范围应以所附权利要求为准。