CN106556405A - 一种基于智能手机传感器的车道检测方法 - Google Patents

一种基于智能手机传感器的车道检测方法 Download PDF

Info

Publication number
CN106556405A
CN106556405A CN201610969912.9A CN201610969912A CN106556405A CN 106556405 A CN106556405 A CN 106556405A CN 201610969912 A CN201610969912 A CN 201610969912A CN 106556405 A CN106556405 A CN 106556405A
Authority
CN
China
Prior art keywords
radius
vehicle
mobile phone
target track
reading
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.)
Pending
Application number
CN201610969912.9A
Other languages
English (en)
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.)
Nanjing Post and Telecommunication University
Nanjing University of Posts and Telecommunications
Original Assignee
Nanjing Post and Telecommunication 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 Nanjing Post and Telecommunication University filed Critical Nanjing Post and Telecommunication University
Priority to CN201610969912.9A priority Critical patent/CN106556405A/zh
Publication of CN106556405A publication Critical patent/CN106556405A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/3446Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种基于智能手机的车道检测方法,包括采样阶段和定位匹配阶段。采样阶段包括训练数据的采集、旋转矩阵R的获取以及目标车道对应阈值的获取,在已知的行驶路径上采集手机的三轴加速度传感器数据和陀螺仪数据,获得车辆的向心加速度和角速度及其半径‑时间特性曲线,阈值的选取为对应目标车道的半径的最大值;将车道与阈值的对应关系上传至服务器。定位匹配阶段将获得的半径‑时间特性曲线中半径的最大值与采样模块获得的车道与阈值的对应关系相匹配,确定目标车道。本发明不需要在车辆中添置额外的硬件设备,仅需要利用智能手机中的传感器就能实现,因此具有成本低、易普及的优势。

Description

一种基于智能手机传感器的车道检测方法
技术领域
本发明属于道路网络的导航技术领域,具体涉及一种基于智能手机的车道检测方法及其系统。
背景技术
随着无人驾驶汽车成为现实,与无人驾驶相关的技术已经成为当前的热点研究领域,其中就包括精确的车道定位技术。车道的精确定位在辅助驾驶系统技术和无人驾驶领域都有很重要的应用,因此已成为研究的热点。
已有的车道定位法尚存在如下不足:第一,某些方法需要利用特殊的增强的GPS定位设备,设备费用昂贵,且在车主之间的普及性极低,如公开号为CN105444770A、名称为“基于智能手机的车道级别地图生成和定位系统及方法”的发明,其提供了一种基于智能手机的车道级别地图生成和定位系统及方法,包括通过手机上内置的GPS、加速度传感器、方向传感器获取车辆的实时GPS、加速度、方向数据;然后手机客户端通过监测加速度传感器、方向传感器的变化,识别车辆变道和转弯时的动作点;手机客户端将获得的GPS数据上传至服务器;服务器将包含有车道信息的地图反馈给用户。该发明通过用户上传的GPS信息生成车道级别的地图,虽然提高了地图的精度,但成本较高。第二,某些方法通过摄像头拍摄路面标识,利用图像识别技术来定位车道,此类方法受外界因素的影响较大,比如前方被一些障碍车辆遮挡了,又或是恶劣的天气导致拍摄的影像辨识度不高。
发明内容
本发明的目的在于提供一种基于智能手机传感器的车道检测方法,当车辆在路口发生转弯行为时,就可较为精确的定位到车辆转弯后所在的车道。
为此,本发明提出一种基于智能手机传感器的车道检测方法,包括如下步骤:
步骤1—3为采样阶段:
步骤1:设置手机传感器的采样频率为5Hz-30Hz,手机放置在行驶的车辆中,获得静止时三轴加速度传感器的读数XG={xG,yG,zG}以及汽车变速时三轴加速度传感器的读数Xa={xa,ya,za};由XG和Xa可获得旋转矩阵R,继而将手机坐标系下的读数转化为车辆坐标系下的读数;
步骤2:将车辆转弯时的运动看作是圆周运动,采样时刻,获得车辆坐标系下X轴方向的加速度,即为向心加速度a;将陀螺仪的读数经过旋转矩阵的变换后获得车辆坐标系下绕Z轴旋转的角速度,即为圆周运动的角速度ω,求得采样时刻圆周半径
步骤3:在某一路口,对于从转弯道行驶至每一个不同的目标车道,根据不同采样时刻获得的圆周半径r,绘制半径-时间的特性曲线,参照半径的最大值获取区分目标车道的阈值δ1,δ2……δi,将本路口转弯行为的阈值和对应的目标车道的关系上传至服务器;
步骤4—5为定位匹配阶段:
步骤4:已知车辆在转弯前所处的转弯车道,使用手机中的位置服务定位车辆所在的路口,陀螺仪传感器检测车辆转弯行为;
步骤5:将转弯时获得的半径-时间变化特性曲线中半径的最大值与服务器端存储的阈值数据相比较,确定转弯后的目标车道,将确定后的车道位置上传至服务器。
进一步,上述步骤1中,车辆坐标系下各轴分量的获取又包括以下步骤:
步骤1-1:获得使手机坐标系与车辆坐标系相匹的旋转矩阵R, 其中k=[xk,yk,zk]T是重力在三个坐标轴方向的分量组成的向量,再通过标准化获得的单位向量,通过低通滤波器作用在三轴加速度传感器上可获得单一的重力作用下,三轴加速度传感器的读数;j=[xj,yj,zj]T是车辆发生变速或转向行为时,三轴加速度传感器获得的数值减去重力加速度在三轴上的分量,再通过标准化获得的单位向量;i=[xi,yi,zi]T,由j叉乘k获得;
步骤1-2:对于本发明使用到的陀螺仪或是三轴加速度传感器,它们的读数Xp={xp,yp,zp}乘上旋转矩阵R,就得到车辆坐标系下三轴的读数Xc={xc,yc,zc},即Xc=Xp×R。
上述步骤2中,对于圆周半径的获取,包括:
步骤2-1:车辆坐标系下的加速度读数Xca={xca,yca,zca},三轴加速度传感器的读数Xpa={xpa,ypa,zpa},Xca=Xpa×R;车辆坐标系下的角速度读数Xcg={xcg,ycg,zcg},陀螺仪读数Xpg={xpg,ypg,zpg},Xcg=Xpa×R。采样时刻向心加速度a的获取,即车辆坐标系下x轴的加速度读数xca;采样时刻角速度ω的获取,即陀螺仪读数转换到车辆坐标系下后绕z轴的读数zpg
步骤2-2:采样时刻的圆周半径其中a=xca,ω=zpg
上述步骤3中,根据半径-时间特性曲线中半径的最大值获取区分目标车道的阈值δ1,δ2……δi,i为目标车道数,是指δ1为采样时多次行驶至目标车道1的半径-时间特性曲线中半径的最大值,δ2为采样时多次行驶至目标车道2的半径-时间特性曲线中半径的最大值,依此类推,最后,将目标车道与所对应的阈值的关系上传至服务器。
上述步骤4中,使用手机中的位置服务定位车辆所在的路口,陀螺仪传感器检测车辆转弯行为包括:
步骤4-1:为路口设置接近警报,即在设备进入一个定义好的区域时会通知设备,检测车辆位于哪个路口,具体是将路口的经纬度坐标以及定义的距离半径存储在系统中,当手机通过位置服务检测到车辆已进入目标区域时,启用GPS位置服务来确定车辆所在路口,为了尽可能减少GPS的使用时间来优化电池寿命,在系统中需要使用手机的位置服务时,尽可能长时间地使用网络提供者,并且只有在网络提供者无法对设备与目标区域之间的距离做出准确预估的情况下,才会启用GPS提供者;
步骤4-2:陀螺仪传感器检测车辆转弯行为,车辆角速度的值在一段持续时间t1内积分,是左转弯,是右转弯,ω(t)是车辆的瞬时角速度,ω(t)=zcg
上述步骤5中,确定转弯后的目标车道具体包括:已知所在转弯车道和所在路口转弯车道的阈值与目标车道的关系,当检测到转弯事件时,将转弯时获得的半径-时间特性曲线中半径的最大值与服务器端存储的阈值数据相比较,按照规则,半径的最大值<δ1,则定位在目标车道1;δ1<半径的最大值<δ2,定位在目标车道2;δ2<半径的最大值<δ3,定位在目标车道3,依此类推,确定转弯后的目标车道。
本发明还提出一种基于上述智能手机传感器的车道检测方法中使用的车道检测系统,包括采样模块和定位匹配模块;
采样模块包括训练数据的采集、旋转矩阵R的获取以及目标车道对应阈值的获取;驾驶车辆,在已知的行驶路径上采集手机的三轴加速度传感器数据和陀螺仪数据;训练数据采集完成之后在旋转矩阵R的作用下,获得车辆的向心加速度和角速度;然后根据不同时刻车辆的向心加速度和角速度获得半径-时间特性曲线,阈值的选取为对应目标车道的半径的最大值;将车道与阈值的对应关系上传至服务器;
定位匹配模块包括需要检测的数据和匹配机制;真实检测到路口的转弯行为,由传感器获得需要检测的数据;在旋转矩阵R的作用下,获得车辆的向心加速度和角速度,然后根据不同时刻车辆的向心加速度和角速度获得半径-时间特性曲线;定位匹配模块将此时获得的半径-时间特性曲线中半径的最大值与采样模块获得的车道与阈值的对应关系相匹配,服务器会回传一个目标车道。
与现有技术相比,本发明具有以下有益效果:
1,本发明中提出的车道检测系统和方法不需要在车辆中添置额外的硬件设备,仅需要利用智能手机中的传感器就能实现,因此具有成本低、易普及的优点。并且相较于传统的基于计算机视觉的车道检测技术,此发明的检测精确度受外界因素的干扰更小,如道路标识模糊又或是天气状况不佳导致的辨识不清,此类情况均在本发明中得到了避免。
2,本发明提出了一种将手机传感器读数转换为车辆坐标系下的读数的方法,无论手机在车辆中的摆放位置是什么样,均可以处理后得到车辆坐标系下需要的物理量。
3,本发明还尽可能地减少了使用的传感器的数量,以及GPS的使用,因此在手机资源的占用和电量的能耗上有较好的表现。
附图说明
图1为本发明的系统示意图。
图2为本系统应用场景的一般示意图。
图3为车辆坐标系与手机坐标系示意图。
图4为车道检测系统的结构图。
具体实施方式
现结合说明书附图对本发明创造作进一步详细说明。在此之前现对本发明使用的符号及其含义说明如下:
本发明利用智能手机的位置服务功能,以及三轴加速度传感器和陀螺仪这两种传感器,无须借助其他的硬件设备。当车辆经过某个路口产生转弯事件时,在转弯这个过程中,将车辆运动看作阶段性的圆周运动。首先,在采样阶段,由于手机传感器的读数不能直接用于车辆坐标系,要将获取到的传感器读数经过处理后才能得到有用的汽车坐标系下的物理量:圆周运动的向心加速度和角速度。获得仅在重力作用下三轴加速度传感器的读数XG={xG,yG,zG},以及汽车变速时三轴加速度传感器的读数Xa={xa,ya,za},经过变换后获得旋转矩阵R;手机传感器读数经过R的变换获得车辆坐标系下的读数;获得车辆坐标系下三轴加速度传感器X轴的读数xa,即为向心加速度a;获得车辆坐标系下陀螺仪绕Z轴的读数zg,即为角速度ω;求得采样时刻圆周半径绘制半径-时间的特性曲线,获取区分目标车道的阈值δ1,δ2……δi;将车道与阈值的关系上传至服务器。定位匹配阶段,利用手机的位置服务定位所在路口,检测车辆在路口的转弯行为,绘制半径-时间特性曲线,将半径-时间特性曲线的半径的最大值与服务器上存储的阈值与车道的关系相匹配,定位到对应的车道。
现对方法的流程进行说明:
步骤1—3为采样阶段,如图1的上半部分所示,包含以下步骤:
步骤1:设置手机传感器的采样频率,通常为5Hz-30Hz,优选为10Hz,手机放置在行驶的车辆中。获得静止时三轴加速度传感器的读数XG={xG,yG,zG}以及汽车变速时三轴加速度传感器的读数Xa={xa,ya,za};由XG和Xa可获得旋转矩阵R,继而将手机坐标系下的读数转化为车辆坐标系下的读数。
步骤2:将车辆转弯时的运动看作是圆周运动,采样时刻,获得车辆坐标系下X轴方向的加速度,即为向心加速度a;将陀螺仪的读数经过旋转矩阵的变换后获得车辆坐标系下绕Z轴旋转的角速度,即为圆周运动的角速度ω,求得采样时刻圆周半径
步骤3:在某一路口,对于从转弯道行驶至每一个不同的目标车道,根据不同采样时刻获得的圆周半径r,绘制半径-时间的特性曲线,参照半径的最大值获取区分目标车道的阈值δ1,δ2……δi,将本路口转弯行为的阈值和对应的目标车道的关系上传至服务器。
步骤4—5为定位匹配阶段,如图1的下半部分所示:
步骤4:已知车辆在转弯前所处的转弯车道,使用手机中的位置服务定位车辆所在的路口,陀螺仪传感器检测车辆转弯行为。
步骤5:将转弯时获得的半径-时间变化特性曲线中半径的最大值与服务器端存储的阈值数据相比较,确定转弯后的目标车道。将确定后的车道位置上传至服务器。
上述步骤1中,车辆坐标系下各轴分量的获取,具体处理步骤包括:
步骤1-1:获得使手机坐标系与车辆坐标系相匹的旋转矩阵R, 其中k=[xk,yk,zk]T是重力在三个坐标轴方向的分量组成的向量,再通过标准化获得的单位向量,通过低通滤波器作用在三轴加速度传感器上可获得单一的重力作用下,三轴加速度传感器的读数;j=[xj,yj,zj]T是车辆发生变速或转向行为时,三轴加速度传感器获得的数值减去重力加速度在三轴上的分量,再通过标准化获得的单位向量;i=[xi,yi,zi]T,由j叉乘k获得。
步骤1-2:对于本发明使用到的陀螺仪或是三轴加速度传感器,它们的读数Xp={xp,yp,zp}乘上旋转矩阵R,就得到车辆坐标系下三轴的读数Xc={xc,yc,zc},即Xc=Xp×R。
上述步骤2中,获取采样时刻的圆周半径r,车辆坐标系下的加速度读数Xca={xca,yca,zca},三轴加速度传感器的读数Xpa={xpa,ypa,zpa},Xca=Xpa×R;车辆坐标系下的角速度读数Xcg={xcg,ycg,zcg},陀螺仪读数Xpg={xpg,ypg,zpg},Xcg=Xpa×R。采样时刻向心加速度a的获取,即车辆坐标系下x轴的加速度读数xca;采样时刻角速度ω的获取,即陀螺仪读数转换到车辆坐标系下后绕z轴的读数zpg
上述步骤3中,根据半径-时间特性曲线中半径的最大值获取区分目标车道的阈值δ1,δ2……δi(i为目标车道数)。δ1为采样时多次行驶至目标车道1的半径-时间特性曲线中半径的最大值,δ2为采样时多次行驶至目标车道1的半径-时间特性曲线中半径的最大值,依此类推。最后,将目标车道与所对应的阈值的关系上传至服务器。
上述步骤4中,使用手机中的位置服务定位车辆所在的路口,陀螺仪传感器检测车辆转弯行为,具体操作步骤包括:
步骤4-1:为路口设置接近警报,即在设备进入一个定义好的区域时会通知设备,检测车辆位于哪个路口。具体是将路口的经纬度坐标以及定义的距离半径存储在系统中,当手机通过位置服务检测到车辆已进入目标区域时,启用GPS位置服务来确定车辆所在路口。为了尽可能减少GPS的使用时间来优化电池寿命,在系统中需要使用手机的位置服务时,尽可能长时间地使用网络提供者,并且只有在网络提供者无法对设备与目标区域之间的距离做出准确预估的情况下,才会启用GPS提供者。
步骤4-2:陀螺仪传感器检测车辆转弯行为,车辆角速度的值在一段持续时间t1内积分,是左转弯,是右转弯,ω(t)是车辆的瞬时角速度,ω(t)=zcg
上述步骤5中,对所在路口转弯后目标车道的获取。已知所在转弯车道和所在路口转弯车道的阈值与目标车道的关系。当检测到转弯事件时,将转弯时获得的半径-时间特性曲线中半径的最大值与服务器端存储的阈值数据相比较,按照规则:半径的最大值<δ1,则定位在目标车道1;δ1<半径的最大值<δ2,定位在目标车道2;δ2<半径的最大值<δ3,定位在目标车道3,依此类推,确定转弯后的目标车道。
本发明还提供了一种基于智能手机传感器的车道检测系统,如图4所示,系统包括采样模块和定位匹配模块;
采样模块的功能是:获得将手机传感器的读数转化为车辆坐标系下可使用的读数的旋转矩阵R,进而获取车辆的向心加速度和加速度。车辆在某路口发生转弯行为后,获取目标车道对应的区分车道的半径阈值,将车道与阈值的对应关系上传至服务器。
定位匹配模块的功能是:真实检测到路口的转弯行为,绘制半径-时间特性曲线后将半径的最大值与服务器存储的车道和阈值关系相匹配,获得定位车道。
为便于本发明的具体实施,现提供一个本发明的实施例,其应用场景如图2所示,途中黑点代表车辆,车辆从车道4左转进入目标车道1、2或3。将路口称作路口1。流程具体如下:
步骤1:车辆坐标系下各轴分量的获取,具体操作步骤如下:
步骤1-1:设置手机传感器的采样频率为5Hz-30Hz,手机放置在行驶的车辆中。获得车辆静止三轴加速度传感器的读数XG={xG,yG,zG}以及汽车变速时三轴加速度传感器的读数Xa={xa,ya,za};
步骤1-2:获得使手机坐标系与车辆坐标系相匹的旋转矩阵R, 其中k=[xk,yk,zk]T是重力在三个坐标轴方向的分量组成的向量,再通过标准化获得的单位向量,通过低通滤波器作用在三轴加速度传感器上可获得单一的重力作用下,三轴加速度传感器的读数;j=[xj,yj,zj]T是车辆发生变速或转向行为时,三轴加速度传感器获得的数值减去重力加速度在三轴上的分量,再通过标准化获得的单位向量;i=[xi,yi,zi]T,由j叉乘k获得。如图3所示,车辆坐标系下,x轴正方向:沿车身向右;y轴正方向:车头方向;z轴正方向,垂直底盘向上。手机坐标系下,x轴正方向:沿屏幕向右;y轴正方向:沿屏幕向;z轴正方向,垂直屏幕向外;
步骤1-3:对于本发明使用到的陀螺仪或是三轴加速度传感器,它们的读数Xp={xp,yp,zp}乘上旋转矩阵R,就得到车辆坐标系下三轴的读数Xc={xc,yc,zc},即Xc=Xp×R。
步骤2中,对于转弯半径的获取,具体操作步骤包括:
车辆坐标系下的加速度读数Xca={xca,yca,zca},三轴加速度传感器的读数Xpa={xpa,ypa,zpa},Xca=Xpa×R;车辆坐标系下的角速度读数Xcg={xcg,ycg,zcg},陀螺仪读数Xpg={xpg,ypg,zpg},Xcg=Xpa×R。采样时刻向心加速度a的获取,即车辆坐标系下x轴的加速度读数xca;采样时刻角速度ω的获取,即陀螺仪读数转换到车辆坐标系下后绕z轴的读数zpg。圆周半径r,
步骤3中,在路口1,对于从转弯道行驶至每一个不同的目标车道,根据不同采样时刻获得的圆周半径r,绘制半径-时间的特性曲线,根据半径-时间特性曲线中半径的最大值获取区分目标车道的阈值δ1,δ2……δi。如图2所示的由车道4行驶至车道1、2或3。δ1为采样时多次行驶至目标车道1的半径-时间特性曲线中半径的最大值,δ2为采样时多次行驶至目标车道1的半径-时间特性曲线中半径的最大值,为采样时多次行驶至目标车道1的半径-时间特性曲线中半径的最大值。最后,将目标车道与所对应的阈值的关系上传至服务器。路口其余的转弯行为所获的目标车道与所对应的阈值的关系也上传至服务器。
步骤4中,使用手机中的位置服务定位车辆所在的路口,陀螺仪传感器检测车辆转弯行为,具体操作步骤包括:
步骤4-1:为路口设置接近警报,即在设备进入一个定义好的区域时会通知设备,检测车辆所在路口。具体是将路口的经纬度坐标以及定义的距离半径存储在系统中,当手机通过位置服务检测到车辆已进入目标区域时,启用GPS位置服务确定车辆所在路口。为了尽可能减少GPS的使用时间来优化电池寿命,在系统中需要使用手机的位置服务时,尽可能长时间地使用网络提供者,并且只有在网络提供者无法对设备与目标区域之间的距离做出准确预估的情况下,才会启用GPS提供者。如图2所示,当车辆的接近路口1时,启用GPS,确定车辆位于路口1。
步骤4-2:陀螺仪传感器检测车辆转弯行为,车辆角速度的值在一段持续时间t1内积分,是左转弯,是右转弯,ω(t)是车辆的瞬时角速度,ω(t)=zcg。如图2所示,检测到车辆的左转弯行为。
步骤5中,对所在路口转弯后目标车道的获取。已知车辆位于转弯道4,和所在路口1转弯车道的阈值与目标车道的关系。当检测到转弯事件时,将转弯时获得的半径-时间特性曲线中半径的最大值与服务器端存储的阈值数据相比较,按照步骤3中提出的规则,半径的最大值<δ1,则定位在目标车道1;δ1<半径的最大值<δ2,定位在目标车道2;δ2<半径的最大值,定位在目标车道3,即可确定转弯后的目标车道。

Claims (7)

1.一种基于智能手机传感器的车道检测方法,其特征在于,所述方法包括如下步骤:
步骤1—3为采样阶段:
步骤1:设置手机传感器的采样频率为5Hz-30Hz,手机放置在行驶的车辆中,获得静止时三轴加速度传感器的读数XG={xG,yG,zG}以及汽车变速时三轴加速度传感器的读数Xa={xa,ya,za};由XG和Xa可获得旋转矩阵R,继而将手机坐标系下的读数转化为车辆坐标系下的读数;
步骤2:将车辆转弯时的运动看作是圆周运动,采样时刻,获得车辆坐标系下X轴方向的加速度,即为向心加速度a;将陀螺仪的读数经过旋转矩阵的变换后获得车辆坐标系下绕Z轴旋转的角速度,即为圆周运动的角速度ω,求得采样时刻圆周半径
步骤3:在某一路口,对于从转弯道行驶至每一个不同的目标车道,根据不同采样时刻获得的圆周半径r,绘制半径-时间的特性曲线,参照半径的最大值获取区分目标车道的阈值δ1,δ2……δi,将本路口转弯行为的阈值和对应的目标车道的关系上传至服务器;
步骤4—5为定位匹配阶段:
步骤4:已知车辆在转弯前所处的转弯车道,使用手机中的位置服务定位车辆所在的路口,陀螺仪传感器检测车辆转弯行为;
步骤5:将转弯时获得的半径-时间变化特性曲线中半径的最大值与服务器端存储的阈值数据相比较,确定转弯后的目标车道,将确定后的车道位置上传至服务器。
2.根据权利要求1所述的一种基于智能手机传感器的车道检测方法,其特征在于,所述步骤1中,车辆坐标系下各轴分量的获取,包括:
步骤1-1:获得使手机坐标系与车辆坐标系相匹的旋转矩阵R,其中k=[xk,yk,zk]T是重力在三个坐标轴方向的分量组成的向量,再通过标准化获得的单位向量,通过低通滤波器作用在三轴加速度传感器上可获得单一的重力作用下,三轴加速度传感器的读数;j=[xj,yj,zj]T是车辆发生变速或转向行为时,三轴加速度传感器获得的数值减去重力加速度在三轴上的分量,再通过标准化获得的单位向量;i=[xi,yi,zi]T,由j叉乘k获得;
步骤1-2:对于本发明使用到的陀螺仪或是三轴加速度传感器,它们的读数Xp={xp,yp,zp}乘上旋转矩阵R,就得到车辆坐标系下三轴的读数Xc={xc,yc,zc},即Xc=Xp×R。
3.跟据权利要求1所述的一种基于智能手机传感器的车道检测方法,其特征在于,所述步骤2中,对于圆周半径的获取,包括:
步骤2-1:车辆坐标系下的加速度读数Xca={xca,yca,zca},三轴加速度传感器的读数Xpa={xpa,ypa,zpa},Xca=Xpa×R;车辆坐标系下的角速度读数Xcg={xcg,ycg,zcg},陀螺仪读数Xpg={xpg,ypg,zpg},Xcg=Xpa×R,采样时刻向心加速度a的获取,即车辆坐标系下x轴的加速度读数xca;采样时刻角速度ω的获取,即陀螺仪读数转换到车辆坐标系下后绕z轴的读数zpg
步骤2-2:采样时刻的圆周半径其中a=xca,ω=zpg
4.根据权利要求1所述的一种基于智能手机传感器的车道检测方法,其特征在于,所述步骤3中,根据半径-时间特性曲线中半径的最大值获取区分目标车道的阈值δ1,δ2……δi,i为目标车道数,是指δ1为采样时多次行驶至目标车道1的半径-时间特性曲线中半径的最大值,δ2为采样时多次行驶至目标车道2的半径-时间特性曲线中半径的最大值,依此类推,最后,将目标车道与所对应的阈值的关系上传至服务器。
5.根据权利要求1所述的一种基于智能手机传感器的车道检测方法,其特征在于,所述步骤4中,使用手机中的位置服务定位车辆所在的路口,陀螺仪传感器检测车辆转弯行为包括:
步骤4-1:为路口设置接近警报,即在设备进入一个定义好的区域时会通知设备,检测车辆位于哪个路口,具体是将路口的经纬度坐标以及定义的距离半径存储在系统中,当手机通过位置服务检测到车辆已进入目标区域时,启用GPS位置服务来确定车辆所在路口,为了尽可能减少GPS的使用时间来优化电池寿命,在系统中需要使用手机的位置服务时,尽可能长时间地使用网络提供者,并且只有在网络提供者无法对设备与目标区域之间的距离做出准确预估的情况下,才会启用GPS提供者;
步骤4-2:陀螺仪传感器检测车辆转弯行为,车辆角速度的值在一段持续时间t1内积分,是左转弯,是右转弯,ω(t)是车辆的瞬时角速度,ω(t)=zcg
6.根据权利要求1所述的一种基于智能手机传感器的车道检测方法,其特征在于,所述步骤5中,确定转弯后的目标车道具体包括:已知所在转弯车道和所在路口转弯车道的阈值与目标车道的关系,当检测到转弯事件时,将转弯时获得的半径-时间特性曲线中半径的最大值与服务器端存储的阈值数据相比较,按照规则,半径的最大值<δ1,则定位在目标车道1;δ1<半径的最大值<δ2,定位在目标车道2;δ2<半径的最大值<δ3,定位在目标车道3,依此类推,确定转弯后的目标车道。
7.一种如权利要求1所述的一种基于智能手机传感器的车道检测方法中使用的车道检测系统,其特征在于:所述系统包括采样模块和定位匹配模块;
采样模块包括训练数据的采集、旋转矩阵R的获取以及目标车道对应阈值的获取;驾驶车辆,在已知的行驶路径上采集手机的三轴加速度传感器数据和陀螺仪数据;训练数据采集完成之后在旋转矩阵R的作用下,获得车辆的向心加速度和角速度;然后根据不同时刻车辆的向心加速度和角速度获得半径-时间特性曲线,阈值的选取为对应目标车道的半径的最大值;将车道与阈值的对应关系上传至服务器;
定位匹配模块包括需要检测的数据和匹配机制;真实检测到路口的转弯行为,由传感器获得需要检测的数据;在旋转矩阵R的作用下,获得车辆的向心加速度和角速度,然后根据不同时刻车辆的向心加速度和角速度获得半径-时间特性曲线;定位匹配模块将此时获得的半径-时间特性曲线中半径的最大值与采样模块获得的车道与阈值的对应关系相匹配,服务器会回传一个目标车道。
CN201610969912.9A 2016-10-28 2016-10-28 一种基于智能手机传感器的车道检测方法 Pending CN106556405A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610969912.9A CN106556405A (zh) 2016-10-28 2016-10-28 一种基于智能手机传感器的车道检测方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610969912.9A CN106556405A (zh) 2016-10-28 2016-10-28 一种基于智能手机传感器的车道检测方法

Publications (1)

Publication Number Publication Date
CN106556405A true CN106556405A (zh) 2017-04-05

Family

ID=58443938

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610969912.9A Pending CN106556405A (zh) 2016-10-28 2016-10-28 一种基于智能手机传感器的车道检测方法

Country Status (1)

Country Link
CN (1) CN106556405A (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107505639A (zh) * 2017-10-10 2017-12-22 小花互联网金融服务(深圳)有限公司 基于陀螺仪的弯道行驶过程中gps抓包时间间隔确定方法
CN108394457A (zh) * 2017-02-07 2018-08-14 福特全球技术公司 自主车辆的方向盘控制机构
CN110967035A (zh) * 2020-02-28 2020-04-07 杭州云动智能汽车技术有限公司 一种提高车载v2x车道匹配度方法
CN111736142A (zh) * 2019-03-25 2020-10-02 通用汽车环球科技运作有限责任公司 用于雷达交叉交通跟踪和操纵风险评估的系统和方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104359493A (zh) * 2014-11-18 2015-02-18 浙江工商大学 智能手机车载情况下的高精度方向校正方法
CN104463244A (zh) * 2014-12-04 2015-03-25 上海交通大学 基于智能移动终端的异常驾驶行为监测和识别方法及系统
CN105374212A (zh) * 2015-12-14 2016-03-02 上海交通大学 基于智能终端传感的高速公路车辆车道识别方法及系统
CN105758404A (zh) * 2016-01-26 2016-07-13 广州市香港科大霍英东研究院 智能设备的实时定位方法及系统

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104359493A (zh) * 2014-11-18 2015-02-18 浙江工商大学 智能手机车载情况下的高精度方向校正方法
CN104463244A (zh) * 2014-12-04 2015-03-25 上海交通大学 基于智能移动终端的异常驾驶行为监测和识别方法及系统
CN105374212A (zh) * 2015-12-14 2016-03-02 上海交通大学 基于智能终端传感的高速公路车辆车道识别方法及系统
CN105758404A (zh) * 2016-01-26 2016-07-13 广州市香港科大霍英东研究院 智能设备的实时定位方法及系统

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
ALY ETAL.: ""LaneQuest: An Accurate and Energy-Efficient Lane Detection System"", 《IEEE INTERNATIONAL CONFERENCE ON PERCASIVE COMPUTING AND COMMUNICATIONS,PERCOM 2015》 *
YAN WANG ETAL.: ""Sensing Vehicle Dynamics for Determining Driver Phone Use"", 《ACM PROCEEDING OF THE INTERNATIONAL CONFERENCE ON MOBILE SYSTEMS, APPLICATIONS, AND SERVICES》 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108394457A (zh) * 2017-02-07 2018-08-14 福特全球技术公司 自主车辆的方向盘控制机构
CN107505639A (zh) * 2017-10-10 2017-12-22 小花互联网金融服务(深圳)有限公司 基于陀螺仪的弯道行驶过程中gps抓包时间间隔确定方法
CN107505639B (zh) * 2017-10-10 2019-11-12 小花互联网金融服务(深圳)有限公司 基于陀螺仪的弯道行驶过程中gps抓包时间间隔确定方法
CN111736142A (zh) * 2019-03-25 2020-10-02 通用汽车环球科技运作有限责任公司 用于雷达交叉交通跟踪和操纵风险评估的系统和方法
CN110967035A (zh) * 2020-02-28 2020-04-07 杭州云动智能汽车技术有限公司 一种提高车载v2x车道匹配度方法
CN110967035B (zh) * 2020-02-28 2020-09-04 杭州云动智能汽车技术有限公司 一种提高车载v2x车道匹配度方法

Similar Documents

Publication Publication Date Title
JP6644742B2 (ja) 頑健で効率的な車両測位用のアルゴリズム及びインフラ
US11531110B2 (en) LiDAR localization using 3D CNN network for solution inference in autonomous driving vehicles
KR102335389B1 (ko) 자율 주행 차량의 lidar 위치 추정을 위한 심층 학습 기반 특징 추출
US11364931B2 (en) Lidar localization using RNN and LSTM for temporal smoothness in autonomous driving vehicles
CN109931944B (zh) 一种ar导航方法、装置、车端设备、服务端及介质
CN101907714B (zh) 基于多传感器数据融合的gps辅助定位方法
CN103162689B (zh) 辅助车载定位系统及车辆的辅助定位方法
CN110377025A (zh) 用于自动驾驶车辆的传感器聚合框架
JP2018128456A (ja) ウォルシュ・カーネル・投影技術に基づく自動運転車両の位置決め
CN109429518A (zh) 基于地图图像的自动驾驶交通预测
CN109937343A (zh) 用于自动驾驶车辆交通预测中的预测轨迹的评估框架
CN108995657A (zh) 操作自动驾驶车辆的方法和数据处理系统
CN109435955B (zh) 一种自动驾驶系统性能评估方法、装置、设备及存储介质
CN106556405A (zh) 一种基于智能手机传感器的车道检测方法
CN108137015A (zh) 用于自动驾驶车辆的侧滑补偿控制方法
CN111959495B (zh) 车辆的控制方法、装置及车辆
CN104952278B (zh) 一种基于地图的停车场车辆定位系统及方法
Zhao et al. Vetrack: Real time vehicle tracking in uninstrumented indoor environments
CN104296756A (zh) 运行机动车的方法和机动车
CN112240767A (zh) 车辆定位识别
Xu et al. Leveraging smartphones for vehicle lane-level localization on highways
US20210048819A1 (en) Apparatus and method for determining junction
CN112964261A (zh) 一种车辆定位校验方法、系统及装置
CN109313847A (zh) 用于错路驾驶员识别的方法、设备和系统
Kang et al. Road gradient estimation using smartphones: Towards accurate estimation on fuel consumption and air pollution emission on roads

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
RJ01 Rejection of invention patent application after publication

Application publication date: 20170405

RJ01 Rejection of invention patent application after publication