CN106997688A - 基于多传感器信息融合的停车场停车位检测方法 - Google Patents

基于多传感器信息融合的停车场停车位检测方法 Download PDF

Info

Publication number
CN106997688A
CN106997688A CN201710431169.6A CN201710431169A CN106997688A CN 106997688 A CN106997688 A CN 106997688A CN 201710431169 A CN201710431169 A CN 201710431169A CN 106997688 A CN106997688 A CN 106997688A
Authority
CN
China
Prior art keywords
parking
moment
mobile platform
represent
dolly
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201710431169.6A
Other languages
English (en)
Other versions
CN106997688B (zh
Inventor
孙棣华
黄肖丞蔚
忽晓阳
章芳
章一芳
赵敏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Liyang Smart City Research Institute Of Chongqing University
Original Assignee
Chongqing University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Chongqing University filed Critical Chongqing University
Priority to CN201710431169.6A priority Critical patent/CN106997688B/zh
Publication of CN106997688A publication Critical patent/CN106997688A/zh
Application granted granted Critical
Publication of CN106997688B publication Critical patent/CN106997688B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/14Traffic control systems for road vehicles indicating individual free spaces in parking areas
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/01Detecting movement of traffic to be counted or controlled
    • G08G1/04Detecting movement of traffic to be counted or controlled using optical or ultrasonic detectors

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种基于多传感器信息融合的停车场停车位检测方法,包括如下步骤:步骤1:将激光雷达、陀螺仪和加速度计安置于移动平台上,并驱动移动平台在停车场移动;步骤2:在移动平台移动过程中,获取激光雷达的检测数据并对检测数据进行预处理;步骤3:利用预处理后的检测数据依次进行特征提取和模式匹配,识别停车场中的局部车位信息;步骤4:分析陀螺仪和加速度计获取的数据,确定移动平台的位置和姿态,通过移动平台的位姿推算对局部车位信息进行校正;步骤5:通过对多个局部环境进行叠加生成停车场空车位的场景地图。本发明可适用于室内停车场、室外停车场以及路边停车场等对于停车位的智能识别。

Description

基于多传感器信息融合的停车场停车位检测方法
技术领域
本发明涉及一种停车场停车位检测方法,具体的为一种基于多传感器信息融合的停车场停车位检测方法,可适用于室内停车场、室外停车场以及路边停车场等对于停车位的智能识别。
背景技术
近几年城市车辆的不断增加,时有发生驾驶人员在停车场停车难、找车难的情况,使停车场的服务质量大打折扣。同时,现有停车场管理***的使用和维护,以及人员的管理成本较高,***的稳定性也有待加强,如何高效的利用现有的停车位成为了城市发展中必须要解决的问题。
通过查阅相关专利和论文,发现现有车位管理主要有:
通过布设地感线圈检测车辆;地感线圈检测法施工困难,需要挖开路面,容易对路面造成破坏,并且线圈易损坏,难以维护;
利用超声波、红外线等传感手段进行空车位检测;超声波、红外线等检测手段受天气、环境、温度和气流变化的影响,不适合于室外停车场及全天候使用,且非车辆物体经过检测区域时容易产生干扰导致检测结果不准确;
基于摄像头的视觉检测方法,即对采集的图像进行分析处理;视频车辆检测法受光照环境影响大,且检测的准确率与摄像头的安放位置有关,是静止检测,不能灵活机动,同时,由于需要一定数量的摄像头覆盖停车场,因此成本较高;
基于ZigBee无线传感网络和调制红外检测技术的停车场车位实时检测;基于ZigBee无线传感网络和调制红外检测技术解决了温度、天气的影响,并且采用无线通信的手段避免对地面的损坏,但是它仍然需要在各个车位安装传感器,加大停车场的固定资产投入,并且由于要考虑环境中种种因素对信号检测、传输的干扰,无疑加大了技术难度、提高维护成本。
发明内容
有鉴于此,为了解决现有技术中存在的不足,本发明的目的在于提供一种基于多传感器信息融合的停车场停车位检测方法,可适用于室内停车场、室外停车场以及路边停车场等对于停车位的智能识别。
为达到上述目的,本发明提供如下技术方案:
一种基于多传感器信息融合的停车场停车位检测方法,包括如下步骤:
步骤1:将激光雷达、陀螺仪和加速度计安置于移动平台上,并驱动移动平台在停车场移动;
步骤2:在移动平台移动过程中,获取激光雷达的检测数据并对检测数据进行预处理;
步骤3:利用预处理后的检测数据依次进行特征提取和模式匹配,识别停车场中的局部车位信息;
步骤4:分析陀螺仪和加速度计获取的数据,确定移动平台的位置和姿态,通过移动平台的位姿推算对局部车位信息进行校正;
步骤5:通过对多个局部环境进行叠加生成停车场空车位的场景地图。
进一步,所述步骤2中,采用中值滤波法对获取的激光雷达数据(p1,p2…pi)进行滤波预处理。
进一步,所述步骤3中,对检测数据进行特征提取的方法如下:
步骤31:将采集到距离信息(p1,p2…pi)转换为极坐标(θ1,p1),(θ2,p2)...(θi,pi)的形式,并以极坐标系的坐标原点作为直角坐标系的坐标原点,将极坐标形式转换为直角坐标(x1,y1),(x2,y2)...(xi,yi)的形式;
步骤32:采用给定的阈值theta将数据分割成区域(D1,D2...Dm),其中Di是(x1,y1),(x2,y2)...(xi,yi)的集合,数据分割的标准是同一区域内相邻点的间距小于上述给定的阈值theta;
步骤33:将区域Di的起始点(x1,y1)和终止点(xn,yn)相连构造辅助线,计算区域Di内各点(xi,yi)到该辅助线的距离;
若存在某点到辅助线的距离di大于所给定的阈值β,则认为区域中存在角点;则重复步骤32,并以角点为分界线重新对区域Di进行二次分割,直到分割得到的区域内不存在角点为止;
若区域中不存在角点,则进入步骤34;
步骤34:用最小二乘法将区域中的点拟合为线段,得到线段集合(L1,L2...Ln);拟合的直线方程为:
y=a*x+b
其中a为直线的斜率,且
b为直线在y坐标轴上的截距,且
进一步,所述步骤3中,将所得特征与车辆轮廓特征进行模式匹配的方法如下:
步骤35:根据与角点相邻的线段集合(L1,L2...Ln),求取相邻边之间的夹角α;
步骤36:当夹角α落在设定的夹角区间范围时,则记录两相邻边相夹的角点Ci的位置si,并计算该角点Ci到相邻边各点原始数据的距离,若大于给定的阈值β,则排除相似物体干扰,并根据该角点Ci的位置si在停车场中的位置,确定已停放车辆的停车位置(s1,s2...sn);反之,若某停车位不存在符合上述特征描述的物体,则认为该停车位空闲。
进一步,所述步骤4中,通过移动平台的位姿推算对局部车位信息进行校正的方法如下:
步骤41:以(x,y)坐标形式表示移动平台的位置,但由于移动平台的位置状态是变化的,则在H时刻移动平台的位置状态需要用(xH,yHH)进行描述;
其中:xH=xH-1+vHsin(θHHΔt);
yH=yH-1+vHcos(θHHΔt);
θH=θH-1HΔt;
其中,Δt为H时刻与H-1时刻之间的时间间隔;
步骤42:引入状态变量LH,以L* H=(xH,yH,vx,vy)来标识小车的初始状态;更新后的移动平台的位置状态变量为PH=(xH,yH),表示优化后的小车的位姿信息;
其中,vx表示移动平台在X方向上的速度;vy表示移动平台在Y方向上的速度;
采用滤波算法校正车位信息的方法为:
(1)对H-1到H时刻的状态进行预测,得到先验概率;
(2)根据观察量对预测状态进行修正,得到后验概率,也就是最优值;
在这个过程中,每个状态可以由高斯分布概率来表示,将其定义为:
其中,P为高斯分布的均值,即最优值;σ是高斯分布的方差,也就是噪音;即将一个概率最高的最优值近似为最终的精确解;
故据此设立状态转移方程:
LH=AL* H+CHΔt
其中:A为修正矩阵,在匀速变化情况下设为1;L* H表示H时刻观测到的小车位置状态,LH表示H时刻的紧邻时刻的小车位置状态;
同时,存在以下映射关系:
z(ρH)=(xH 2+yH 2)
(xH,yH)=(ρHcosθHHsinθH)
其中:ρH为极坐标下H时刻的极径;z(ρH)表示H时刻在极坐标下的小车坐标;
设立噪音状态转移方程:
N* H=AHN* H-1AH T+U
其中:N* H表示H时刻修正后的噪音状态;AH表示H时刻的修正矩阵;AH T表示H时刻的修正矩阵的转置;
则卡尔曼增益为:
KH=NHWT(WNH-WT+G)-1
其中:W表示直角坐标向极坐标转化的映射矩阵。WT为W的转置;KH表示H时刻的卡尔曼增益;
状态变量修正方程:
PH=P* H+KH(zH-WP* H)
其中:P* H表示修正后的状态变量;zH表示极坐标下的H时刻的小车坐标;
噪音修正方程:
NH=(E-KHW)NH
其中,E为单位矩阵;噪音变量N用来描述计算误差;NH为H时刻的噪音变量。
zH=W*LH
其中,zH表示极坐标下的H时刻的小车坐标。
控制变量C=(v,ω),用来记录小车的实时线速度和角速度;H时刻的控制变量CH=(vHH);
噪音增量U,用来修正由于小车状态变化导致的噪音的变化;
观测矩阵G,用来表示实际噪音情况;
步骤43:利用步骤41和步骤42对步骤3中得到的已停放车辆的停车位置(s1,s2...sn)进行校正,得到校正后的停车位信息(S1,S2...Sn),并以校正后的停车位信息作为最终确认的车位信息。
本发明的有益效果在于:
本发明基于多传感器信息融合的停车场停车位检测方法,可快速精确地识别停车场中的空车位,该方法的优点是结构简单,易于实现,受环境影响较小,可适用于室内停车场、室外停车场以及路边停车场等多种环境。
附图说明
为了使本发明的目的、技术方案和有益效果更加清楚,本发明提供如下附图进行说明:
图1为本发明基于多传感器信息融合的停车场停车位检测方法实施例的流程图;
图2为区域分割的流程图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明,以使本领域的技术人员可以更好的理解本发明并能予以实施,但所举实施例不作为对本发明的限定。
如图1所示,本实施例基于多传感器信息融合的停车场停车位检测方法,包括如下步骤:
步骤1:将激光雷达、陀螺仪和加速度计安置于移动平台上,并驱动移动平台在停车场移动。
步骤2:在移动平台移动过程中,获取激光雷达的检测数据并对检测数据进行预处理;本实施例采用中值滤波法对获取的激光雷达数据(p1,p2…pi)进行滤波预处理,所取的滤波长度参考值为5,即选取5个周期的数据,然后取其中位数,以消除干扰,增加数据的可靠性。
步骤3:利用预处理后的检测数据依次进行特征提取和模式匹配,识别停车场中的局部车位信息。具体的,本实施例对检测数据进行特征提取的方法如下:
步骤31:将采集到距离信息(p1,p2…pi)转换为极坐标(θ1,p1),(θ2,p2)...(θi,pi)的形式,并以极坐标系的坐标原点作为直角坐标系的坐标原点,将极坐标形式转换为直角坐标(x1,y1),(x2,y2)...(xi,yi)的形式;计算直角坐标系各坐标的坐标值的计算公式如下:
步骤32:采用给定的阈值theta将数据分割成区域(D1,D2...Dm),其中Di是(x1,y1),(x2,y2)...(xi,yi)的集合,如图2所示。其中p=5mm,表明若激光雷达返回的数据小于5mm,认为该数据识读错误,故丢弃;dist为两相邻点间距离,数据分割的标准是同一区域内相邻点的间距小于上述给定的阈值theta。本实施例的阈值theta=200mm。
步骤33:对区域分割后,需要根据数据进行特征提取。在本实施例中,需要获取的特征包括两个,一方面需要判断区域中是否存在角点,如果存在需要进行标定;另一方面,需要对区域中的线段进行拟合。
将区域Di的起始点(x1,y1)和终止点(xn,yn)相连构造辅助线,计算区域Di内各点(xi,yi)到该辅助线的距离;
其中,辅助线通过两点式构造,其直线方程为:
计算区域Di内各点(xi,yi)到该辅助线的距离为:
若存在某点到辅助线的距离di大于所给定的阈值β,则认为区域中存在角点;则重复步骤32,并以角点为分界线重新对区域Di进行二次分割,直到分割得到的区域内不存在角点为止;同时将到辅助线距离最远的点标定为角点Ci,得到角点集合(C1,C2...Cn)。本实施例的阈值β=150mm。
若区域中不存在角点,则进入步骤34;
步骤34:用最小二乘法将区域中的点拟合为线段,得到线段集合(L1,L2...Ln);拟合的直线方程为:
y=a*x+b
其中a为直线的斜率,且
b为直线在y坐标轴上的截距,且
本实施例将所得特征与车辆轮廓特征进行模式匹配的方法如下:
步骤35:应用模式匹配算法将所得特征与车辆轮廓特征进行匹配,识别并得到车辆位置信息。考虑到停车环境中,车辆与其他物体相区别的主要特征表现为车辆轮廓具有近似垂直的相邻的边,并且在车灯处存在一定弧度。因此,
根据与角点相邻的线段集合(L1,L2...Ln),求取相邻边之间的夹角α;假设两相邻边直线方程分别为y=a1*x+b1和y=a2*x+b2,则它们之间的夹角为α为:
步骤36:当夹角α落在设定的夹角区间范围时,则记录两相邻边相夹的角点Ci的位置si,考虑到停车场中可能有立柱或其他具有相似特征的物体的干扰,因此对于干扰进行排除。计算该角点Ci到相邻边各点原始数据的距离,即若大于所给阈值β,表示在角点附近存在一定弧度,因此能够排除立柱等相似物体。根据该角点位置在停车场中的位置,确定已停放车辆的停车位置(s1,s2...sn);反之,若某停车位不存在符合上述特征描述的物体,则认为该停车位空闲。
步骤4:分析陀螺仪和加速度计获取的数据,确定移动平台的位置和姿态,通过移动平台的位姿推算对局部车位信息进行校正。
以激光雷达测得的距离信息、步骤3中识别的车辆位置信息(s1,s2...sn)作为校正输入,以更新后的在全局坐标中的移动平台的位置与停车位信息作为输出。其中,通过位姿推算可获得每一时刻移动平台的位姿;将激光雷达测得的距离信息、传感器之间的相对位置信息与当前时刻的机器人位姿三者相结合,可以计算出停车位在全局坐标系下的坐标,再用特征提取与车位识别等方法判断车位状态、构建环境地图并实时更新,从而完成局部的停车位识别与地图构建。
具体的,本实施例通过移动平台的位姿推算对局部车位信息进行校正的方法如下:
步骤41:以(x,y)坐标形式表示移动平台的位置,但由于移动平台的位置状态是变化的,则在H时刻移动平台的位置状态需要用(xH,yHH)进行描述;
其中:xH=xH-1+vHsin(θHHΔt);
yH=yH-1+vHcos(θHHΔt);
θH=θH-1HΔt;
其中,Δt为H时刻与H-1时刻之间的时间间隔;
上式仅能大致描述移动平台的位置,但是随着时间的推进,误差会被累计。因此,该方案引入滤波算法消除误差的影响。
步骤42:引入状态变量LH,以L* H=(xH,yH,vx,vy)来标识小车的初始状态;更新后的移动平台的位置状态变量为PH=(xH,yH),表示优化后的小车的位姿信息;
其中,vx表示移动平台在X方向上的速度;vy表示移动平台在Y方向上的速度;
采用滤波算法校正车位信息的方法为:
(1)对H-1到H时刻的状态进行预测,得到先验概率;
(2)根据观察量对预测状态进行修正,得到后验概率,也就是最优值;
在这个过程中,每个状态可以由高斯分布概率来表示,将其定义为:
其中,P为高斯分布的均值,即最优值;σ是高斯分布的方差,也就是噪音;即将一个概率最高的最优值近似为最终的精确解;
故据此设立状态转移方程:
LH=AL* H+CHΔt
其中:A为修正矩阵,在匀速变化情况下设为1;L* H表示H时刻观测到的小车位置状态,LH表示H时刻的紧邻时刻的小车位置状态。
同时,存在以下映射关系:
zH)=(xH 2+yH 2)
(xH,yH)=(ρHcosθHHsinθH)
其中:ρH为极坐标下H时刻的极径;z(ρH)表示H时刻在极坐标下的小车坐标。
设立噪音状态转移方程:
N* H=AHN* H-1AH T+U
其中:N* H表示H时刻修正后的噪音状态;AH表示H时刻的修正矩阵。AH T表示H时刻的修正矩阵的转置。
则卡尔曼增益为:
KH=NHWT(WNH-WT+G)-1
其中:W表示直角坐标向极坐标转化的映射矩阵。WT为W的转置;KH表示H时刻的卡尔曼增益。
状态变量修正方程:
PH=P* H+KH(zH-WP* H)
其中:P* H表示修正后的状态变量;zH表示极坐标下的H时刻的小车坐标。
噪音修正方程:
NH=(E-KHW)NH
其中,E为单位矩阵;噪音变量N用来描述计算误差;NH为H时刻的噪音变量。
zH=W*LH
其中,zH表示极坐标下的H时刻的小车坐标。
控制变量C=(v,ω),用来记录小车的实时线速度和角速度;H时刻的控制变量CH=(vHH);
噪音增量U,用来修正由于小车状态变化导致的噪音的变化;
观测矩阵G,用来表示实际噪音情况;
步骤43:利用步骤41和步骤42对步骤3中得到的已停放车辆的停车位置(s1,s2…sn)进行校正,得到校正后的停车位信息(S1,S2…Sn),并以校正后的停车位信息作为最终确认的车位信息。
步骤5:通过对多个局部环境进行叠加生成停车场空车位的场景地图。
以上所述实施例仅是为充分说明本发明而所举的较佳的实施例,本发明的保护范围不限于此。本技术领域的技术人员在本发明基础上所作的等同替代或变换,均在本发明的保护范围之内。本发明的保护范围以权利要求书为准。

Claims (5)

1.一种基于多传感器信息融合的停车场停车位检测方法,其特征在于:包括如下步骤:
步骤1:将激光雷达、陀螺仪和加速度计安置于移动平台上,并驱动移动平台在停车场移动;
步骤2:在移动平台移动过程中,获取激光雷达的检测数据并对检测数据进行预处理;
步骤3:利用预处理后的检测数据依次进行特征提取和模式匹配,识别停车场中的局部车位信息;
步骤4:分析陀螺仪和加速度计获取的数据,确定移动平台的位置和姿态,通过移动平台的位姿推算对局部车位信息进行校正;
步骤5:通过对多个局部环境进行叠加生成停车场空车位的场景地图。
2.根据权利要求1所述的基于多传感器信息融合的停车场停车位检测方法,其特征在于:所述步骤2中,采用中值滤波法对获取的激光雷达数据(p1,p2…pi)进行滤波预处理。
3.根据权利要求2所述的基于多传感器信息融合的停车场停车位检测方法,其特征在于:所述步骤3中,对检测数据进行特征提取的方法如下:
步骤31:将采集到距离信息(p1,p2…pi)转换为极坐标(θ1,p1),(θ2,p2)...(θi,pi)的形式,并以极坐标系的坐标原点作为直角坐标系的坐标原点,将极坐标形式转换为直角坐标(x1,y1),(x2,y2)...(xi,yi)的形式;
步骤32:采用给定的阈值theta将数据分割成区域(D1,D2...Dm),其中Di是(x1,y1),(x2,y2)...(xi,yi)的集合,数据分割的标准是同一区域内相邻点的间距小于上述给定的阈值theta;
步骤33:将区域Di的起始点(x1,y1)和终止点(xn,yn)相连构造辅助线,计算区域Di内各点(xi,yi)到该辅助线的距离;
若存在某点到辅助线的距离di大于所给定的阈值β,则认为区域中存在角点;则重复步骤32,并以角点为分界线重新对区域Di进行二次分割,直到分割得到的区域内不存在角点为止;
若区域中不存在角点,则进入步骤34;
步骤34:用最小二乘法将区域中的点拟合为线段,得到线段集合(L1,L2...Ln);拟合的直线方程为:
y=a*x+b
其中a为直线的斜率,且
b为直线在y坐标轴上的截距,且
C = Σ k = 1 n ( x k - x ‾ ) 2 ;
x ‾ = 1 n * Σ k = 1 n x k ;
y ‾ = 1 n * Σ k = 1 n y k .
4.根据权利要求3所述的基于多传感器信息融合的停车场停车位检测方法,其特征在于:所述步骤3中,将所得特征与车辆轮廓特征进行模式匹配的方法如下:
步骤35:根据与角点相邻的线段集合(L1,L2...Ln),求取相邻边之间的夹角α;
步骤36:当夹角α落在设定的夹角区间范围时,则记录两相邻边相夹的角点Ci的位置si,并计算该角点Ci到相邻边各点原始数据的距离,若大于给定的阈值β,则排除相似物体干扰,并根据该角点Ci的位置si在停车场中的位置,确定已停放车辆的停车位置(s1,s2...sn);反之,若某停车位不存在符合上述特征描述的物体,则认为该停车位空闲。
5.根据权利要求4所述的基于多传感器信息融合的停车场停车位检测方法,其特征在于:所述步骤4中,通过移动平台的位姿推算对局部车位信息进行校正的方法如下:
步骤41:以(x,y)坐标形式表示移动平台的位置,但由于移动平台的位置状态是变化的,则在H时刻移动平台的位置状态需要用(xH,yHH)进行描述;
其中:xH=xH-1+vHsin(θHHΔt);
yH=yH-1+vHcos(θHHΔt);
θH=θH-1HΔt;
其中,Δt为H时刻与H-1时刻之间的时间间隔;
步骤42:引入状态变量LH,以L* H=(xH,yH,vx,vy)来标识小车的初始状态;更新后的移动平台的位置状态变量为PH=(xH,yH),表示优化后的小车的位姿信息;
其中,vx表示移动平台在X方向上的速度;vy表示移动平台在Y方向上的速度;
采用滤波算法校正车位信息的方法为:
(1)对H-1到H时刻的状态进行预测,得到先验概率;
(2)根据观察量对预测状态进行修正,得到后验概率,也就是最优值;
在这个过程中,每个状态可以由高斯分布概率来表示,将其定义为:
η ( x ) = N ‾ ( P , σ )
其中,P为高斯分布的均值,即最优值;σ是高斯分布的方差,也就是噪音;即将一个概率最高的最优值近似为最终的精确解;
故据此设立状态转移方程:
LH=AL* H+CHΔt
其中:A为修正矩阵,在匀速变化情况下设为1;L* H表示H时刻观测到的小车位置状态,LH表示H时刻的紧邻时刻的小车位置状态;
同时,存在以下映射关系:
z(ρH)=(xH 2+yH 2)
(xH,yH)=(ρHcosθHHsinθH)
其中:ρH为极坐标下H时刻的极径;z(ρH)表示H时刻在极坐标下的小车坐标;
设立噪音状态转移方程:
N* H=AHN* H-1AH T+U
其中:N* H表示H时刻修正后的噪音状态;AH表示H时刻的修正矩阵;AH T表示H时刻的修正矩阵的转置;
则卡尔曼增益为:
KH=NHWT(WNH-WT+G)-1
其中:W表示直角坐标向极坐标转化的映射矩阵;WT为W的转置;KH表示H时刻的卡尔曼增益;
状态变量修正方程:
PH=P* H+KH(zH-WP* H)
其中:P* H表示修正后的状态变量;zH表示极坐标下的H时刻的小车坐标;
噪音修正方程:
NH=(E-KHW)NH
其中,E为单位矩阵;噪音变量N用来描述计算误差;NH为H时刻的噪音变量;
zH=W*LH
其中,zH表示极坐标下的H时刻的小车坐标;
控制变量C=(v,ω),用来记录小车的实时线速度和角速度;H时刻的控制变量CH=(vHH);
噪音增量U,用来修正由于小车状态变化导致的噪音的变化;
观测矩阵G,用来表示实际噪音情况;
步骤43:利用步骤41和步骤42对步骤3中得到的已停放车辆的停车位置(s1,s2...sn)进行校正,得到校正后的停车位信息(S1,S2...Sn),并以校正后的停车位信息作为最终确认的车位信息。
CN201710431169.6A 2017-06-08 2017-06-08 基于多传感器信息融合的停车场停车位检测方法 Active CN106997688B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710431169.6A CN106997688B (zh) 2017-06-08 2017-06-08 基于多传感器信息融合的停车场停车位检测方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710431169.6A CN106997688B (zh) 2017-06-08 2017-06-08 基于多传感器信息融合的停车场停车位检测方法

Publications (2)

Publication Number Publication Date
CN106997688A true CN106997688A (zh) 2017-08-01
CN106997688B CN106997688B (zh) 2020-03-24

Family

ID=59436143

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710431169.6A Active CN106997688B (zh) 2017-06-08 2017-06-08 基于多传感器信息融合的停车场停车位检测方法

Country Status (1)

Country Link
CN (1) CN106997688B (zh)

Cited By (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107610524A (zh) * 2017-11-02 2018-01-19 济南浪潮高新科技投资发展有限公司 一种利用激光雷达进行停车场车位智能识别的方法及装置
CN108088446A (zh) * 2017-12-01 2018-05-29 合肥优控科技有限公司 移动机器人航向角检测方法、装置与计算机可读存储介质
CN108399754A (zh) * 2018-03-09 2018-08-14 上海畅停信息科技有限公司 一种共享车位锁中的车辆智能检测方法
CN109001757A (zh) * 2018-05-31 2018-12-14 重庆大学 一种基于2d激光雷达的车位智能检测方法
CN109186586A (zh) * 2018-08-23 2019-01-11 北京理工大学 一种面向动态泊车环境的同时定位及混合地图构建方法
CN109253731A (zh) * 2018-08-06 2019-01-22 百度在线网络技术(北京)有限公司 停车场地图生成方法、装置、设备及可读存储介质
CN109389013A (zh) * 2017-08-10 2019-02-26 纵目科技(上海)股份有限公司 基于车位主方向及模板响应点的车位组合算法和介质
CN109493633A (zh) * 2018-12-20 2019-03-19 广州小鹏汽车科技有限公司 一种可停车位的检测方法及装置
CN110444044A (zh) * 2019-08-27 2019-11-12 纵目科技(上海)股份有限公司 基于超声波传感器的车辆位姿检测***、终端和存储介质
CN111190169A (zh) * 2019-12-31 2020-05-22 智车优行科技(北京)有限公司 雷达数据滤波方法和装置、电子设备和存储介质
CN111681451A (zh) * 2020-06-12 2020-09-18 苏州博众机器人有限公司 一种停车数据处理方法、***和停车场
CN111856611A (zh) * 2019-04-17 2020-10-30 阿里巴巴集团控股有限公司 触发检测方法、装置及***
WO2021035669A1 (zh) * 2019-08-30 2021-03-04 深圳市大疆创新科技有限公司 位姿预测方法、地图构建方法、可移动平台及存储介质
CN112598922A (zh) * 2020-12-07 2021-04-02 安徽江淮汽车集团股份有限公司 车位检测方法、装置、设备及存储介质
CN112863234A (zh) * 2021-01-05 2021-05-28 广州小鹏自动驾驶科技有限公司 一种车位显示方法、装置、电子设备及存储介质
CN113624929A (zh) * 2021-10-12 2021-11-09 成都千嘉科技有限公司 一种气体传感器全量程自动标定方法
CN113920782A (zh) * 2021-10-08 2022-01-11 安徽江淮汽车集团股份有限公司 应用于车位检测的多传感器融合方法
CN114023102A (zh) * 2021-11-16 2022-02-08 厦门市万云智能科技有限公司 一种基于多模式检测的停车位感应方法
CN114783207A (zh) * 2022-06-22 2022-07-22 车位管家(深圳)科技有限公司 一种基于物联网的互联网智能停车场管理***

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105973145A (zh) * 2016-05-19 2016-09-28 深圳市速腾聚创科技有限公司 移动式三维激光扫描***及移动式三维激光扫描方法
CN106409003A (zh) * 2016-10-24 2017-02-15 深圳普智联科机器人技术有限公司 一种基于复合检测机制的路边车位检测装置及其检测方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105973145A (zh) * 2016-05-19 2016-09-28 深圳市速腾聚创科技有限公司 移动式三维激光扫描***及移动式三维激光扫描方法
CN106409003A (zh) * 2016-10-24 2017-02-15 深圳普智联科机器人技术有限公司 一种基于复合检测机制的路边车位检测装置及其检测方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
冯刘中: "基于多传感器信息融合的移动机器人导航定位技术研究", 《中国优秀硕士学位论文全文数据库(电子期刊)》 *
李红: "自动泊车***路径规划与跟踪控制研究", 《中国博士学位论文全文数据库(电子期刊)》 *

Cited By (26)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109389013A (zh) * 2017-08-10 2019-02-26 纵目科技(上海)股份有限公司 基于车位主方向及模板响应点的车位组合算法和介质
CN109389013B (zh) * 2017-08-10 2024-02-09 纵目科技(上海)股份有限公司 基于车位主方向及模板响应点的车位组合算法和介质
CN107610524A (zh) * 2017-11-02 2018-01-19 济南浪潮高新科技投资发展有限公司 一种利用激光雷达进行停车场车位智能识别的方法及装置
CN108088446A (zh) * 2017-12-01 2018-05-29 合肥优控科技有限公司 移动机器人航向角检测方法、装置与计算机可读存储介质
CN108399754B (zh) * 2018-03-09 2020-11-03 上海畅停信息科技有限公司 一种共享车位锁中的车辆智能检测方法
CN108399754A (zh) * 2018-03-09 2018-08-14 上海畅停信息科技有限公司 一种共享车位锁中的车辆智能检测方法
CN109001757A (zh) * 2018-05-31 2018-12-14 重庆大学 一种基于2d激光雷达的车位智能检测方法
CN109253731A (zh) * 2018-08-06 2019-01-22 百度在线网络技术(北京)有限公司 停车场地图生成方法、装置、设备及可读存储介质
CN109186586A (zh) * 2018-08-23 2019-01-11 北京理工大学 一种面向动态泊车环境的同时定位及混合地图构建方法
CN109186586B (zh) * 2018-08-23 2022-03-18 北京理工大学 一种面向动态泊车环境的同时定位及混合地图构建方法
CN109493633A (zh) * 2018-12-20 2019-03-19 广州小鹏汽车科技有限公司 一种可停车位的检测方法及装置
CN111856611A (zh) * 2019-04-17 2020-10-30 阿里巴巴集团控股有限公司 触发检测方法、装置及***
CN110444044A (zh) * 2019-08-27 2019-11-12 纵目科技(上海)股份有限公司 基于超声波传感器的车辆位姿检测***、终端和存储介质
WO2021035669A1 (zh) * 2019-08-30 2021-03-04 深圳市大疆创新科技有限公司 位姿预测方法、地图构建方法、可移动平台及存储介质
CN111190169A (zh) * 2019-12-31 2020-05-22 智车优行科技(北京)有限公司 雷达数据滤波方法和装置、电子设备和存储介质
CN111681451A (zh) * 2020-06-12 2020-09-18 苏州博众机器人有限公司 一种停车数据处理方法、***和停车场
CN111681451B (zh) * 2020-06-12 2022-10-14 苏州博众智能机器人有限公司 一种停车数据处理方法、***和停车场
CN112598922A (zh) * 2020-12-07 2021-04-02 安徽江淮汽车集团股份有限公司 车位检测方法、装置、设备及存储介质
CN112863234A (zh) * 2021-01-05 2021-05-28 广州小鹏自动驾驶科技有限公司 一种车位显示方法、装置、电子设备及存储介质
CN112863234B (zh) * 2021-01-05 2022-07-01 广州小鹏自动驾驶科技有限公司 一种车位显示方法、装置、电子设备及存储介质
CN113920782B (zh) * 2021-10-08 2022-08-09 安徽江淮汽车集团股份有限公司 应用于车位检测的多传感器融合方法
CN113920782A (zh) * 2021-10-08 2022-01-11 安徽江淮汽车集团股份有限公司 应用于车位检测的多传感器融合方法
CN113624929A (zh) * 2021-10-12 2021-11-09 成都千嘉科技有限公司 一种气体传感器全量程自动标定方法
CN114023102A (zh) * 2021-11-16 2022-02-08 厦门市万云智能科技有限公司 一种基于多模式检测的停车位感应方法
CN114023102B (zh) * 2021-11-16 2024-02-27 厦门市万云智能科技有限公司 一种基于多模式检测的停车位感应方法
CN114783207A (zh) * 2022-06-22 2022-07-22 车位管家(深圳)科技有限公司 一种基于物联网的互联网智能停车场管理***

Also Published As

Publication number Publication date
CN106997688B (zh) 2020-03-24

Similar Documents

Publication Publication Date Title
CN106997688A (zh) 基于多传感器信息融合的停车场停车位检测方法
CN106441319B (zh) 一种无人驾驶车辆车道级导航地图的生成***及方法
CN105270410B (zh) 用于自主驾驶车辆的路径规划的精确曲率估计算法
Du et al. Autonomous reverse parking system based on robust path generation and improved sliding mode control
US11321950B2 (en) Apparatus and method for detecting lane information, and computer-readable recording medium storing computer program programmed to execute same method
US20210229280A1 (en) Positioning method and device, path determination method and device, robot and storage medium
CN107422730A (zh) 基于视觉导引的agv运输***及其驾驶控制方法
CN110296713A (zh) 路侧自动驾驶车辆定位导航***及单个、多个车辆定位导航方法
CN107272008A (zh) 一种带惯性补偿的agv激光导航***
CN108445503A (zh) 基于激光雷达与高精度地图融合的无人驾驶路径规划算法
EP3842751B1 (en) System and method of generating high-definition map based on camera
WO2016013095A1 (ja) 自律移動装置
CN106595630A (zh) 一种基于激光导航变电站巡检机器人的建图***与方法
CN110807412B (zh) 一种车辆激光定位的方法、车载设备和存储介质
CN113071518B (zh) 一种自动无人驾驶方法、小巴、电子设备以及存储介质
CN205121338U (zh) 基于图像识别与无线网络的agv导航***
US10921137B2 (en) Data generation method for generating and updating a topological map for at least one room of at least one building
CN108549383A (zh) 一种实时多传感器的社区机器人导航方法
CN106647729A (zh) 基于图像识别与无线网络的agv导航***及导航方法
KR101510745B1 (ko) 차량의 무인 자율주행 시스템
CN113252051A (zh) 一种地图构建方法及装置
CN116337045A (zh) 一种基于karto和teb的高速建图导航方法
CN112462762A (zh) 一种基于路侧二维码单元的机器人室外自主移动***及其方法
CN111208820B (zh) 人工智能大数据下粒子化无人车组、控制方法及介质
CN211427151U (zh) 一种应用于封闭场地无人驾驶货运车辆上的自动引导***

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20230224

Address after: 213399 room 5025, building B, 218 Hongkou Road, Kunlun Street, Liyang City, Changzhou City, Jiangsu Province

Patentee after: Liyang Smart City Research Institute of Chongqing University

Address before: 400044 No. 174, positive street, Shapingba District, Chongqing

Patentee before: Chongqing University

TR01 Transfer of patent right