局部无线波通讯定位方法、系统、设备及存储介质技术方案

本发明专利技术提供了局部无线波通讯定位方法、系统、设备及存储介质，该方法包括：获得两个定位通讯单元与定位通讯传感器三者的距离和定位通讯传感器的离地高度，以第一定位通讯单元为坐标系原点，建立空间坐标系和建立平面坐标系，根据观测方程，获得在平面坐标内车辆的中心的坐标；建立平面坐标系中表示车辆的中心在预测方程；在当前时刻根据观测方程得到的车辆的中心的坐标根据正态分布公式随机分布n个粒子；获得t时刻下n个粒子各自的预测坐标和观测坐标；根据权重更新公式更新n个粒子的权重；将权重的值最大的粒子的坐标作为t时刻下车辆的中心的预测坐标。本发明专利技术能够在遮挡比较严重，GPS基本失效的地方能够给自动驾驶的汽车坐标位置方向。

【技术实现步骤摘要】
局部无线波通讯定位方法、系统、设备及存储介质
本专利技术涉及车辆定位领域，具体地说，涉及局部无线波通讯定位方法、系统、设备及存储介质。
技术介绍
随着科技的不断进步，自动驾驶技术也变得越来越平民化，可以实现。车辆的定位在自动驾驶里尤为重要，然而GPS这种全局定位的精准度是有限制，而在码头岸桥还有轮胎吊下抓放箱，对于定位的要求都是厘米级别的，GPS在岸桥或者龙门吊下由于严重的遮挡，很可能是没有卫星数据的。在这种情况下，精准的局部定位就显得很重要。
技术实现思路
针对现有技术中的问题，本专利技术的目的在于提供局部无线波通讯定位方法、系统、设备及存储介质，能够在遮挡比较严重，GPS基本失效的地方能够给自动驾驶的汽车坐标位置方向。本专利技术的实施例提供一种局部无线波通讯定位方法，包括以下步骤：S101、一车辆设有一定位通讯传感器，通过第一定位通讯单元和第二定位通讯单元分别实时与所述定位通讯传感器进行通讯，获得所述定位通讯传感器到第一定位通讯单元的第一距离L2和第二定位通讯单元的第二距离L3，测得所述第一定位通讯单元和第二定位通讯单元的间距为L1、所述定位通讯传感器与所述车辆的中心的距离为L4、所本文档来自技高网...

【技术保护点】
1.一种局部无线波通讯定位方法，其特征在于，包括以下步骤：S101、一车辆设有一定位通讯传感器，通过第一定位通讯单元和第二定位通讯单元分别实时与所述定位通讯传感器进行通讯，获得所述定位通讯传感器到第一定位通讯单元的第一距离L2和第二定位通讯单元的第二距离L3，测得所述第一定位通讯单元和第二定位通讯单元的间距为L1、所述定位通讯传感器与所述车辆的中心的距离为L4、所述定位通讯传感器的离地高度为h；S102、以第一定位通讯单元为坐标系原点，建立空间坐标系，第二定位通讯单元位于Y轴，获得所述定位通讯传感器的坐标为(xm，ym，h)，其中，ym＝(L1

【技术特征摘要】
1.一种局部无线波通讯定位方法，其特征在于，包括以下步骤：S101、一车辆设有一定位通讯传感器，通过第一定位通讯单元和第二定位通讯单元分别实时与所述定位通讯传感器进行通讯，获得所述定位通讯传感器到第一定位通讯单元的第一距离L2和第二定位通讯单元的第二距离L3，测得所述第一定位通讯单元和第二定位通讯单元的间距为L1、所述定位通讯传感器与所述车辆的中心的距离为L4、所述定位通讯传感器的离地高度为h；S102、以第一定位通讯单元为坐标系原点，建立空间坐标系，第二定位通讯单元位于Y轴，获得所述定位通讯传感器的坐标为(xm，ym，h)，其中，ym＝(L12+L32-L22)/(2*L1)；S103、以第一定位通讯单元为坐标系原点，建立平面坐标系，第二定位通讯单元位于Y轴，设所述定位通讯传感器与车辆的中心的连线与Y轴方向的夹角为θ1，所述车辆的行驶方向与Y轴方向的夹角为θ2；根据观测方程：获得在平面坐标内所述车辆的中心的坐标(xc，yc)；S104、建立所述平面坐标系中表示车辆的中心在预测方程：其中；xt为t时刻的X轴坐标，xt-1为t-1时刻的X轴坐标，yt为t时刻的Y轴坐标，yt-1为(t-1)时刻的Y轴坐标；S105、在当前时刻根据所述观测方程得到的所述车辆的中心的坐标(xc，yc)根据正态分布公式随机分布n个粒子，所述粒子的坐标为(x，y)，每一个粒子的权重为所述正态分布公式为其中，f(x)代表是粒子基于X轴坐标的概率，其中的μx代表的是当前粒子在X轴上随机分布之前的坐标值，σx代表的是该粒子在X轴上随机分布的标准差stdx；f(y)代表是粒子基于Y轴坐标的概率，其中的μy代表的是当前粒子在Y轴上随机分布之前的坐标值，σy代表的是该粒子在Y轴上随机分布的标准差stdy；S106、根据预测方程获得t时刻下n个粒子各自的预测坐标(xt，yt)；S107、根据观测方程获得t时刻下n个粒子各自的观测坐标(xc，yc)；S108、根据权重更新公式：更新n个粒子的权重；S109、将权重的值最大的粒子的坐标(x，y)作为t时刻下车辆的中心的预测坐标；S110、将n个粒子根据权重进行重采样；以及S111、将n个粒子的权重全部恢复为返回步骤S105，进入(t+1)时刻。2.根据权利要求1所述的局部无线波通讯定位方法，其特征在于：所述步骤S110中，包括：步骤S1101、将n个粒子的权重生成n个依次连续的区间，每个区间的大小与每个粒子的权重值呈正比；步骤S1102、在所有区间的最大值和最小值之间生成n个随机数；步骤S1103、保留包含n个所述随机数的区间所对应的所有粒子的坐标(x，y)。3.根据权利要求1所述的局部无线波通讯定位方法，其特征在于：所述步骤S105中n等于100，或者等于1000，或者等于10000。4.根据权利要求1所述的局部无线波通讯定位方法，其特征在于：所述步骤S101中的间距L1、距离为L4以及离地高度h都是预先测得的，第一距离L2是根据所述定位通讯传感器与第一定位通讯单元的信号强弱实时测得的，第二距离L3是根据所述定位通讯传感器与第二定位通讯单元的信号强弱实时测得的。5.根据权利要求1所述的局部无线波通讯定位方法，其特征在于：所述步骤S103中夹角θ1是通过车辆上的转弯角度传感器实时获得的，夹角θ2是预设的。6.根据权利要求1所...

【专利技术属性】
技术研发人员：张波，杨旭东，
申请(专利权)人：上海西井信息科技有限公司，
类型：发明
国别省市：上海,31