一种基于卡尔曼滤波和聚类算法的车辆定位方法及系统技术方案

本发明专利技术涉及一种基于卡尔曼滤波和聚类算法的车辆定位方法及系统，包括：获取车辆移动端的状态矢量，并构建车辆移动端系统状态方程和观测方程；利用卡尔曼滤波对车辆移动端的观测序列进行滤波，对车辆平均误差进行优化；采用DBSCAN聚类算法对滤波后的车辆移动端的观测序列进行进一步处理，得到优化后的车辆位置预测结果。本发明专利技术可以仅使用标准的数据输出格式，对定位精度进行优化，提高港口码头码垛车、游乐园娱乐车辆、无人送货车、共享单车等车辆监控系统的准确性。监控系统的准确性。监控系统的准确性。

【技术实现步骤摘要】
一种基于卡尔曼滤波和聚类算法的车辆定位方法及系统


[0001]本专利技术涉及车辆定位
，具体涉及一种基于卡尔曼滤波和聚类算法的车辆定位方法及系统。

技术介绍

[0002]车辆位置的监控与调度需要依赖全球定位系统。
[0003]全球定位系统(GPS)提供两种精度服务：其一是精密定位服务(PPS)，使用P码(或Y码)，只供美国及其盟国军事部门使用；其二是标准定位服务(SPS)，使用C/A码，对全世界开放。
[0004]美国为了自身利益，采取选择可用性(SA)措施，人为降低了SPS精度。有SA时，SPS的水平误差为100m(2dRMS)，垂直误差为156m(2o)。
[0005]为了提高C/A码GPS的静态定位精度，以往的方法大多对各种误差源分别建立各自的误差模型，然后应用卡尔曼滤波器或者其他一些相关的技术进行消除。但是这种处理需要用到GPS接收机内部处理的各种原始参数，如各颗星的伪距、载波的相位、卫星星历和历书等，而对于绝大多数商用GPS接收机或接收模块(如OEM板)来说，数据的标准输出格式为NMEA
‑...

【技术保护点】

【技术特征摘要】
1.一种基于卡尔曼滤波和聚类算法的车辆定位方法，其特征在于，包括：获取车辆移动端的状态矢量，并构建车辆移动端系统状态方程和观测方程；利用卡尔曼滤波对车辆移动端的观测序列进行滤波，对车辆平均误差进行优化；采用DBSCAN聚类算法对滤波后的车辆移动端的观测序列进行进一步处理，得到优化后的车辆位置预测结果。2.根据权利要求1所述的车辆定位方法，其特征在于，所述车辆移动端系统状态方程和观测方程如下：其中，A是状态系数转移矩阵，W(t)是噪声向量，H(t)是预测输出矩阵，V(t)为对应经纬度上的高斯白噪声。3.根据权利要求1所述的车辆定位方法，其特征在于，采用DBSCAN聚类算法对滤波后的车辆移动端的观测序列进行进一步处理，包括：输入邻域半径ε和该邻域半径内包含的最少点数量Minpts两个参数来获得数据中的簇；选取区域中的任意一点作为起始点，若该点同时满足DBSCAN所需的两个参数，则该点被归类为核心点；对该核心点邻域内其他点依次进行判断，若某点邻域内依然满足Minpts参数，则其继续被标记为核心点并加入簇中，否则判定为边界点加入簇中，直到没有符合条件的点为止。4.根据权利要求3所述的车辆定位方法，其特征在于，邻域半径ε的确定方法包括：根据下式计算每个点到其他点的欧氏距离，以欧式距离为x轴绘制概率密度分布图，取概率最高时对应的x轴坐标为ε的值...

【专利技术属性】
技术研发人员：种玉祥，邹清全，方强，刘奋，张志军，曹洲，
申请(专利权)人：上海中海庭数智技术有限公司，
类型：发明
国别省市：