[发明专利]一种基于超宽带的井下车辆定位方法

说明书

技术领域

本发明涉及井下采矿设备技术领域，尤其涉及一种基于超宽带的井下车辆定位方法。

背景技术

目前，地下金属矿智能开采的主要内容是井下采矿设备的智能化，即实现井下铲运设备的自主行驶、装卸，钻孔、装药设备的位置自动调控，这些都需要以设备在井下工作过程中的精确位置为依据，因此井下设备的精确定位是实现车辆自主导航的关键性支撑技术，是实现智能化开采的重要任务之一。

对于井下车辆，如需实现车辆自主行驶，除了需要车辆实时的位置信息之外，还需要清楚车辆的姿态，特别是井下车辆在大地坐标系下的绝对姿态，其中车辆行驶过程中的航向角是车辆在已知规划路径行驶的关键参数。现有技术中井下车辆航向角测量还未有研究，基于多陀螺系统的航向角预测受到成本、安装方式、地磁影响等诸多方面的影响，还没有成熟技术。

发明内容

本发明的目的是提供一种基于超宽带的井下车辆定位方法，该方法能够克服传统意义上因多径效应造成的井下测距困难，有效地为金属矿山井下车辆动态实时地提供位置信息，并根据这类信息进行自主导航。

一种基于超宽带的井下车辆定位方法，所述方法包括：

在井下的定位基站内部设置两个核心的超宽带载波UWB模块；其中一个模块为信标发送模块，用于定时发送信标包，该信标包用来让车载设备搜索到目前处于哪些定位基站的覆盖范围；另外一个模块为定位模块，用来测距以及在测距的同时传递规定格式的无线数据；

在车载设备的内部设置相应的两个核心UWB模块；其中一个模块为搜星模块，用于搜索所述定位基站发送的信标包，以确定所述车载设备目前处于哪些定位基站的覆盖范围；另一个模块为定位模块，用来与所述定位基站内的定位模块配合来完成测距操作；

通过将所述车载设备中的搜星模块和定位模块分开设置，实现对井下车辆的定位。

由上述本发明提供的技术方案可以看出，该方法能够克服传统意义上因多径效应造成的井下测距困难，有效地为金属矿山井下车辆动态实时地提供位置信息，并根据这类信息进行自主导航。

附图说明

为了更清楚地说明本发明实施例的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域的普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他附图。

图1为本发明实施例所提供基于超宽带的井下车辆定位方法流程示意图；

图2为本发明所举实例中双程测距法TW-TOF的图解示意图；

图3为本发明所举实例中三边定位计算的示意图；

图4为本发明所举实例中几何测距点过交的示意图；

图5为本发明所举实例中几何测距点欠交的示意图；

图6为本发明所举实例中航向角计算误差的示意图。

具体实施方式

下面结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明的保护范围。

下面将结合附图对本发明实施例作进一步地详细描述，如图1所示为本发明实施例所提供基于超宽带的井下车辆定位方法流程示意图，所述方法包括：

步骤11：在井下的定位基站内部设置有两个核心的超宽带载波UWB模块；

在该步骤中，定位基站称为井下固定点，一般将其称为“锚点”，这里在定位基站内部设置两个核心的超宽带载波UWB模块。

其中一个模块为信标发送模块，用于定时发送信标包，该信标包用来让车载设备搜索到目前处于哪几个定位基站的覆盖范围；另外一个模块为定位模块，用来测距以及在测距的同时传递规定格式的无线数据。

步骤12：在车载设备的内部设置有相应的两个核心UWB模块；

在该步骤中，车载设备称为移动定位点，在车载设备的内部设置有相应的两个核心UWB模块。

其中一个模块为搜星模块，用于搜索所述定位基站发送的信标包，以确定所述车载设备目前处于哪些定位基站的覆盖范围内；另一个模块为定位模块，用来与所述定位基站内的定位模块配合来完成测距操作。

具体实现中，搜星模块可以基于到达时间差测量法TDOA(Time difference of Arrival)来实现，具体来说：