一种基于UWB和Kalman的室内停车场高精度定位系统的制作方法

本发明涉及车辆定位领域，特别是涉及一种基于uwb和kalman的室内停车场高精度定位系统。

背景技术：

随着科技和现代社会的发展，机动车辆保有量迅速增加，智能交通将是未来交通系统的发展方向。室内停车场也变得越来越拥挤，但由于人们对停车场复杂多样的布局和停车位标志不熟悉、引导不到位等原因，使得在迷宫似的地下停车场停车难和找车难，成为驾驶者苦恼的新问题。如何在停车场内获得高精度的车辆位置信息就变得越来越重要。

室外地面停车场一般都有成熟的停车定位导航系统，大都是结合卫星导航（gps）实现车辆定位进而实现停车导航。但是室内和地下停车时场由于建筑物的遮挡无法接收gps信号，不能使用gps定位。如何在室内及地下停车场实现车辆的准确定位就成为了急需解决的难题。

技术实现要素：

本发明主要解决的技术问题是提供一种基于uwb和kalman的室内停车场高精度定位系统，通过采用uwb信号前沿检测技术和kalman滤波相结合，将移动台安装在车辆上，将基站安装在停车场内，当装有移动台的车辆进入装有基站的停车场后，基站通过轮询消息唤醒处于休眠状态的移动台进行定位，通过前沿检测技术获得准确的uwb定位信号，以获得高精度的定位信息，最后通过kalman滤波技术进一步提高定位精度。从而解决了在室内停车场失去gps信号后无法知道车辆位置信息的问题，本系统定位精度高，可达20cm级别的定位精度，在基于uwb和kalman的室内停车场高精度定位系统的普及上有着广泛的市场前景。

为解决上述技术问题，本发明提供一种基于uwb和kalman的室内停车场高精度定位系统，包括：若干基站和若干独立设置的移动台，

所述若干基站安装在停车场内，所述若干移动台分别安装在车辆上，

所述基站、所述移动台分别包括数据处理mcu芯片和uwb射频芯片，所述数据处理mcu芯片通过spi接口与所述uwb射频芯片通信连接，

所述uwb射频芯片包括前沿检测装置，所述前沿检测装置实现对uwb无线信号的前沿检测，过滤掉不良信号，获得完整的良好uwb无线信号，所述前沿检测装置对uwb无线信号进行时间标记，以便进行tof计算出uwb信号收发机之间的测距，得到基于时间的测距信息，

所述数据处理mcu芯片控制所述uwb射频芯片的uwb信号的接收与发送，所述数据处理mcu芯片读取所述uwb射频芯片的寄存器获取基于时间的测距信息，所述数据处理mcu芯片读取基于时间的测距信息后进行位置坐标解算，根据到不同的所述基站之间的距离计算出所述移动台的位置信息，获得初步位置信息，所述数据处理mcu芯片将获得的初步位置信息使用kalman滤波算法滤波迭代进行滤波处理，得到精确位置信息。

在本发明一个较佳实施例中，所述uwb射频芯片工作的具体步骤包括：

（1）所述uwb射频芯片接收uwb无线信号，

（2）所述uwb射频芯片接收到uwb无线信号后进行前沿检测，将得到的uwb无线信号与预设的信号阈值进行比较，得到该条信号的诊断信息，

（3）根据诊断信息判断是否采用该条信息携带的时间戳，

（4）根据时间戳信息计算出距离数据，并保存在所述uwb射频芯片的寄存器中。

在本发明一个较佳实施例中，所述基于时间的测距信息包括所述uwb射频

芯片收到uwb无线信号的时间信息以及根据uwb无线信号在空间中的飞行速度

计算出的距离信息。

在本发明一个较佳实施例中，所述数据处理mcu芯片通过唤醒引脚控制所

述uwb射频芯片的工作模式。

在本发明一个较佳实施例中，所述kalman滤波算法的算法包括：

x(k+1)=ax(k)+fw(k)

y(k)=hx(k)+v(k)

其中k为离散时间，a为状态转移矩阵，h为观测矩阵，w为输入噪声，v为观测噪声，f为噪声驱动矩阵。

在本发明一个较佳实施例中，所述uwb射频芯片采用dw1000芯片。

在本发明一个较佳实施例中，所述数据处理mcu芯片采用stm32f103芯片。

本发明的有益效果是：本发明基于uwb和kalman的室内停车场高精度定位系统通过采用uwb信号前沿检测技术和kalman滤波相结合，将移动台安装在车辆上，将基站安装在停车场内，当装有移动台的车辆进入装有基站的停车场后，基站通过轮询消息唤醒处于休眠状态的移动台进行定位，通过前沿检测技术获得准确的uwb定位信号，以获得高精度的定位信息，最后通过kalman滤波技术进一步提高定位精度。从而解决了在室内停车场失去gps信号后无法知道车辆位置信息的问题，本系统定位精度高，可达20cm级别的定位精度，在基于uwb和kalman的室内停车场高精度定位系统的普及上有着广泛的市场前景。

附图说明

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

图1是本发明的基于uwb和kalman的室内停车场高精度定位系统一较佳实施例的结构示意图；

图2是本发明的基于uwb和kalman的室内停车场高精度定位系统一较佳实施例的算法流程图。

具体实施方式

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

请参阅图1-图2，本发明实施例包括：

一种基于uwb和kalman的室内停车场高精度定位系统，包括：若干基站和若干独立设置的移动台。

所述若干基站安装在停车场内，所述若干移动台分别安装在车辆上，

所述基站、所述移动台分别包括数据处理mcu芯片和uwb射频芯片，所述数据处理mcu芯片通过spi接口与所述uwb射频芯片通信连接，

所述uwb射频芯片包括前沿检测装置，所述前沿检测装置实现对uwb无线信号的前沿检测，过滤掉不良信号，获得完整的良好uwb无线信号，所述前沿检测装置对uwb无线信号进行时间标记，以便进行tof计算出uwb信号收发机之间的测距，得到基于时间的测距信息，

所述数据处理mcu芯片控制所述uwb射频芯片的uwb信号的接收与发送，所述数据处理mcu芯片读取所述uwb射频芯片的寄存器获取基于时间的测距信息，所述数据处理mcu芯片读取基于时间的测距信息后进行位置坐标解算，根据到不同的所述基站之间的距离计算出所述移动台的位置信息，获得初步位置信息，所述数据处理mcu芯片将获得的初步位置信息使用kalman滤波算法滤波迭代进行滤波处理，得到精确位置信息。

近年来，随着无线通信技术的发展，应运而生了许多新兴室内定位技术，uwb技术就是其中热点技术之一。uwb技术是一种无载波超宽带通信技术，使用从纳秒到微秒级别的窄脉冲传输数据。它具有抗干扰性能强，传输速率高，带宽极宽，功耗低，发射功率小诸多优点。由于uwb技术超高的时间分辨率，可以获得可达厘米级的定位精度。根据uwb技术的特点以及室内定位的技术要求，可以知道uwb技术可以完全满足室内停车场的车辆定位要求，因此本发明开展了一种基于uwb技术的室内停车场的车辆定位系统研究，并通过前沿检测技术和kalman滤波相结合的融合算法提高系统定位精度。

优选地，所述uwb射频芯片工作的具体步骤包括：

（1）所述uwb射频芯片接收uwb无线信号，

（2）所述uwb射频芯片接收到uwb无线信号后进行前沿检测，将得到的uwb无线信号与预设的信号阈值进行比较，得到该条信号的诊断信息，

（3）根据诊断信息判断是否采用该条信息携带的时间戳，

（4）根据时间戳信息计算出距离数据，并保存在所述uwb射频芯片的寄存器中。

本发明所述前沿检测技术的算法在所述uwb射频芯片内完成。它是在信道脉冲响应中搜索以找到的第一个到达路径信号，这在有限的并且在相当短的时间内完成。具体完成在接收的信息中查找和调整时间信息的过程。将收到的uwb无线信号和与预设的有效信号的信道响应阈值进行比较，当计算出的结果小于设定的阈值标记，该条信息为不良信息，只有计算出的结果大于或者等于设定的阈值时才接收处理该条信息并用于计算uwb无线信号发送机和接收机之间的距离。为了提高系统实时性，可将前沿检测时间设置为不超过100us的定时器，超过定时器即进入休眠或者下一次测距循环。

优选地，所述基于时间的测距信息包括所述uwb射频芯片收到uwb无线信号的时间信息以及根据uwb无线信号在空间中的飞行速度计算出的距离信息。

优选地，所述数据处理mcu芯片通过唤醒引脚控制所述uwb射频芯片的工作模式，以此来降低功耗。

kalman滤波算法是一种与增益和观测矩阵无关，可以预先离线计算出、从而可以减少实时在线计算量。通过“预测-修正”过程，降低观测过程中的误差得到更高精度的定位结果。kalman滤波算法在所述数据处理mcu芯片内进行迭代计算，提高系统定位精度。

在本发明一个较佳实施例中，所述kalman滤波算法的算法包括：

x(k+1)=ax(k)+fw(k)

y(k)=hx(k)+v(k)

其中k为离散时间，a为状态转移矩阵，h为观测矩阵，w为输入噪声，v为观测噪声，f为噪声驱动矩阵。

所述的kalman滤波算法在所述数据处理mcu芯片内完成，当所述数据处理mcu芯片得到移动台到基站的距离信息和位置信息后，根据状态方程与预测方程并结合车辆运动的速度信息进行滤波迭代，提高系统定位精度。滤波预测方程如下：

x(t)=x(t-1)+v*t

其中x为位置量，v为车辆速度，t为采样时间。

优选地，所述uwb射频芯片采用dw1000芯片。所述uwb射频芯片集成射频收发机、功率放大器、pll时钟、电源管理模块、spi接口等，适用性广。

优选地，所述数据处理mcu芯片采用stm32f103芯片。所述数据处理mcu芯片包括cortex-m3内核cpu、dma单元、串口、spi接口、flash单元（128kb）、sram等，适用性广。

本发明基站、移动台的硬件构成主要包括数据处理mcu芯片和uwb射频芯片，此外还有一些必要的辅助设备，如晶振电源等。

结合图1，基站安装在停车场内，移动台安装在车辆上。一个停车场内最少有4个基站，4个基站用来定位移动台的位置。4个基站相对于3个基站可以获得更高精度的定位结果。当安装有移动台的车辆进入到安装有基站的停车场内，基站通过发送轮询消息唤醒处于休眠状态的移动台设备，并通过全球唯一的64位地址进行设备识别和网络id配置。

当基站唤醒移动台后，移动台与4个基站之间互相发送带有消息收发时间信息的帧进行通信，通过对时间数据处理得到移动台与基站之间单向uwb无线信号的飞行时间，然后时间和光速的乘积得到移动台到每个基站的距离，通过移动台到4个基站的距离就可以通过空间中多点定位原理得到移动台的位置坐标。

结合图2，本发明的算法流程是基站通过轮询信息检测到有移动台进入停车场后，与其进行通信，并利用前沿检测技术进行处理uwb信号，过滤不良信号，得到精度较高的时间信息，然后进行位置解算得到移动台的坐标，最后对解算出来的坐标进行kalman滤波进一步提高定位精度。

本发明基于uwb和kalman的室内停车场高精度定位系统的有益效果是：

一、通过采用uwb技术可以获得10-20cm的定位精度，通过前沿检测和kalman滤波融和算法处理后可以进一步提高精度到10cm以内，定位精度高；

二、本发明移动台与基站采用相同的架构设计，降低系统的复杂度，方便使用，且系统体积小，集成度高，便于在停车场和汽车上布置安装，通用性强；

三、本系统采用dw1000射频芯片，通过mcu控制其工作模式包括deepsleep、sleep、idle、init、off、rx、tx、rxpreamblesniff状态，当射频芯片没有发送接收任务时进入sleep模式，当离开停车场后进入deepsleep模式或者off模式，功耗低；

四、本系统硬件成本低，主要器件就包括uwb射频芯片、mcu数据处理芯片及电池，大大降低了成本。

以上所述仅为本发明的实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书内容所作的等效结构或等效流程变换，或直接或间接运用在其它相关的技术领域，均同理包括在本发明的专利保护范围内。