八月瓜首页 > 专利查询 > G01测量;测试 >正文

基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法

基本信息

  • 申请号 CN201811377485.0 
  • 公开号 CN109490923A 
  • 申请日 2018/11/19 
  • 公开日 2019/03/19 
  • 申请人 西安交通大学  
  • 优先权日期  
  • 发明人 马小博 李琛良 张立群 冯燎原 毛蔚轩  
  • 主分类号 G01S19/42 
  • 申请人地址 710049 陕西省西安市碑林区咸宁西路28号 
  • 分类号 G01S19/42 
  • 专利代理机构 西安通大专利代理有限责任公司 61200 
  • 当前专利状态 发明专利申请公布 
  • 代理人 徐文权 
  • 有效性 审查中-实审 
  • 法律状态 审查中-实审
  •  

摘要

本发明公开了一种基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法。
该方法可以实时精确计算出车辆行驶中每一个位置的弯度角,由此可得到车辆驾驶时转弯的转弯程度和直行时候的偏转程度,可以用来判断一个人的驾驶行为是否符合规定。
该方法的实现是通过拟合轨迹计算车辆后向方向和车辆前向方向,最终得到转弯角度。
本发明依托于最小二乘法的思想,对此思想进行了一些创新,自适应地找寻每一个点周围的点集,并根据找到的点集计算这一个点的转弯角度。
本方法具有极低的复杂度和误差,大大提高了检测的实时性和准确性。
展开

权利要求书


1.基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,其特征在于,包括以下步骤:步骤1,将车辆原始GPS数据经过坐标序列投影得到k个二元组;步骤2,设定阈值,对步骤1中的k个二元组通过最小二乘拟合得到两条拟合直线的截距和斜率;步骤3,计算拟合直线的损失值,若损失值大于阈值则进行下一步,通过截距和斜率分别计算两条直线的方向向量;若损失值小于阈值则回到步骤2重新计算;步骤4,计算两条直线方向向量的夹角,判断转弯方向,通过对两条直线的方向向量做点积,若其值大于0,则表示逆时针旋转,若其值小于0,则表示顺时针旋转返;若为0则表示为不转弯。
2.根据权利要求1所述的基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,其特征在于,步骤1中,将原始GPS数据(x′[1],y′[1]),(x′[2],y′[2]),(x′[3],y′[3])……(x′[k],y′[k])经过坐标序列投影得到(x[1],y[1]),(x[2],y[2])……(x[n],y[n])……(x[k],y[k])这k个二元组。
3.根据权利要求1所述的基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,其特征在于,步骤2中,计算后向方向直线的截距和斜率:设定一个参数阈值threshold;使用a,b来表示拟合直线的截距和斜率,设定两个变量numerator和denominator来表示斜率的分子和分母;q来表示参与拟合的点的个数;q初始化为2,根据最小二乘拟合,得到numertor和denominator的计算公式如下: 再计算b和a:b=numerator/denominatora=y[n]-b*x[n]。
4.根据权利要求1所述的基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,其特征在于,步骤3中,计算后向方向直线向量:使用error用来表示每次拟合直线的损失值,这个值和原始点到拟合直线的距离成正相关,而当损失值超过阈值,就说明所拟合的直线与原来的GPS数据点差距过大,拟合时不应加入更多的点;根据距离公式计算损失值 若error小于threshold,q的值加1,并且重复步骤二,就会使使(x[n+q],y[n+q])这个点参与拟合;若error大于等于threshold,则直线是已经符合误差范围内的后向方向直线,得到后向直线的方向向量
5.根据权利要求1所述的基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,其特征在于,步骤2中,计算前向方向直线的截距和斜率:设定threshold′为阈值,a′,b′表示直线的截距和斜率,numerator′和denominator′表示斜率的分子和分母;p,error′来表示参与拟合的点的个数和损失值;初始化:p=2,a′=0,b′=0,error′=0
6.根据权利要求1所述的基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,其特征在于,步骤3中,计算前向方向直线向量:使用error用来表示拟合前向直线的损失值,根据距离公式计算损失值 若error′小于threshold′,p的值加1,并且重复步骤四,就会使(x[n-p],y[n-p])这个点参与拟合;若error′大于等threshold′,则直线是已经符合误差范围内的前向方向直线,得到前向直线的方向向量
7.根据权利要求1所述的基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,其特征在于,步骤4中,通过arccos函数以及求得两个方向的夹角,从而得到第n个点的弯度弯度角为an 展开

说明书

技术领域
本发明涉及车辆行驶安全辅助领域,特别涉及基于自适应最小二乘拟合的车辆行驶弯 度角实时检测方法。
背景技术
检测车辆的转向角度对车辆和驾驶员的安全至关重要,因为致命的事故往往是由危 险转向造成的。
根据统计,导致死亡的道路交通事故中,23.1%与变道有关,7.7%与掉头 有关,总计30.8%与车辆的转向动作有关。
现有的计算车辆转弯角度的方法有使用转向角 传感器计算、使用磁力传感器计算和使用智能手机的前后摄像头进行计算。
然而这些方法 都有着各自的局限性,并不能很好的在现实中使用。
车辆的转向角传感器可以检测方向盘的旋转角度和旋转速度,以此为依据再进一步 计算车辆实际的转弯角度。
该方法算出的转弯角度误差较小,但该传感器的位置在方向盘 下方的方向柱内,因此普通乘客使用该传感器十分不便,并且没有安装该传感器的行驶工 具则无法使用该方法。
磁力传感器可以直接得出转弯的角度,但是该方法稳定性差,易受干扰。
该方法的 原理是磁力传感器可以直接读出手机Y轴与地磁场北极之间的夹角,因此根据此夹角的 变化即可直接得到转弯角度。
但是当磁力传感器附近有较强的磁场时,磁力传感器就会受 到极大影响,因此得到的角度就会经常出现异常值。
对于需要计算转弯角度的现实场景而 言,绝大多数情况中这种不可控的异常值都是不能够被允许的。
使用智能手机的前后摄像头进行计算的方法是先通过摄像头来捕获道路物体,然后 利用图像处理对其进行分析得出转弯角度。
但是该方法受环境影响较大,在光线不足的地 方,尤其是夜间该方法会基本完全失效,此外还受天气,路面状况等因素的影响。
这些都 限制了该方法在现实中的应用。
发明内容
本发明的目的在于提供基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法, 以解决上述问题。
为实现上述目的,本发明采用以下技术方案:基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,包括以下步骤:步骤1,将车辆原始GPS数据经过坐标序列投影得到k个二元组;步骤2,设定阈值,对步骤1中的k个二元组通过最小二乘拟合得到两条拟合直线的 截距和斜率;步骤3,计算拟合直线的损失值,若损失值大于阈值则进行下一步,通过截距和斜率 分别计算两条直线的方向向量;若损失值小于阈值则回到步骤2重新计算;步骤4,计算两条直线方向向量的夹角,判断转弯方向,通过对两条直线的方向向量 做点积,若其值大于0,则表示逆时针旋转,若其值小于0,则表示顺时针旋转返;若为 0则表示为不转弯。
进一步的,步骤1中,将原始GPS数据(x′[1],y′[1]),(x′[2],y′[2]),(x′ [3],y′[3])……(x′[k],y′[k])经过坐标序列投影得到 (x[1],y[1]),(x[2],y[2])……(x[n],y[n])……(x[k],y[k])这k个二元组。
进一步的,步骤2中,计算后向方向直线的截距和斜率:设定一个参数阈值threshold;使用a,b来表示拟合直线的截距和斜率,设定两个变量 numerator和denominator来表示斜率的分子和分母;q来表示参与拟合的点的个数;q 初始化为2,根据最小二乘拟合,得到numertor和denominator的计算公式如下: 再计算b和a:b=numerator/denominatora=y[n]-b*x[n]。
进一步的,步骤3中,计算后向方向直线向量:使用error用来表示每次拟合直线的损失值,这个值和原始点到拟合直线的距离成 正相关,而当损失值超过阈值,就说明所拟合的直线与原来的GPS数据点差距过大,拟合 时不应加入更多的点;根据距离公式计算损失值 若error小于threshold,q的值加1,并且重复步骤二,就会使使(x[n+q],y[n+q]) 这个点参与拟合;若error大于等于threshold,则直线是已经符合误差范围内的后向方 向直线,得到后向直线的方向向量进一步的,步骤2中,计算前向方向直线的截距和斜率:设定threshold′为阈值,a′,b′表示直线的截距和斜率,numerator′和 denominator′表示斜率的分子和分母;p,error′来表示参与拟合的点的个数和损失 值;初始化:p=2,a′=0,b′=0,error′=0 进一步的,步骤3中,计算前向方向直线向量:使用error用来表示拟合前向直线的损失值,根据距离公式计算损失值 若error小于threshold,p的值加1,并且重复步骤四,就会使(x[n-p],y[n-p]) 这个点参与拟合;若error′大于等threshold′,则直线是已经符合误差范围内的前 向方向直线,得到前向直线的方向向量进一步的,步骤4中,通过arccos函数以及求得两个方向的夹角,从而得到第n个 点的弯度弯度角为a[n]; 与现有技术相比,本发明有以下技术效果:本发明通过拟合轨迹计算车辆后向方向和车辆前向方向,最终得到转弯角度,依托 于最小二乘法的思想,自适应地找寻每一个点周围的点集,并根据找到的点集计算这一个 点的转弯角度。
本发明能够在仅有GPS数据的情况下,快速并准确的计算出车辆转弯时 的弯度角,并可以用来判断车辆何时转弯。
有利于在安全事故或治安事件发生之后,较为 准确的提取出车辆的转弯特征以及判断司机的心理状态。
本发明准确度高,基本不受环境影响,并且基于最小二乘计算成本极低。
附图说明
图1表示拟合在实际中的效果图;图2是计算转弯角度的流程图。
具体实施方式
以下结合附图对本发明进一步说明:基于自适应最小二乘拟合的车辆行驶弯度角实时检测方法,包括以下步骤:步骤1,将车辆原始GPS数据经过坐标序列投影得到k个二元组;步骤2,设定阈值,对步骤1中的k个二元组通过最小二乘拟合得到两条拟合直线的 截距和斜率;步骤3,计算拟合直线的损失值,若损失值大于阈值则进行下一步,通过截距和斜率 分别计算两条直线的方向向量;若损失值小于阈值则回到步骤2重新计算;步骤4,计算两条直线方向向量的夹角,判断转弯方向,通过对两条直线的方向向量 做点积,若其值大于0,则表示逆时针旋转,若其值小于0,则表示顺时针旋转返;若为 0则表示为不转弯。
步骤1中,将原始GPS数据(x′[1],y′[1]),(x′[2],y′[2]),(x′[3],y′ [3])……(x′[k],y′[k])经过坐标序列投影得到 (x[1],y[1]),(x[2],y[2])……(x[n],y[n])……(x[k],y[k])这k个二元组。
步骤2中,计算后向方向直线的截距和斜率:设定一个参数阈值threshold;使用a,b来表示拟合直线的截距和斜率,设定两个变量 numerator和denominator来表示斜率的分子和分母;q来表示参与拟合的点的个数;q 初始化为2,根据最小二乘拟合,得到numertor和denominator的计算公式如下: 再计算b和a:b=numerator/denominatora=y[n]-b*x[n]。
步骤3中,计算后向方向直线向量:使用error用来表示每次拟合直线的损失值,这个值和原始点到拟合直线的距离成 正相关,而当损失值超过阈值,就说明所拟合的直线与原来的GPS数据点差距过大,拟合 时不应加入更多的点;根据距离公式计算损失值 若error小于threshold,q的值加1,并且重复步骤二,就会使使(x[n+q],y[n+q]) 这个点参与拟合;若error大于等于threshold,则直线是已经符合误差范围内的后向方 向直线,得到后向直线的方向向量步骤2中,计算前向方向直线的截距和斜率:设定threshold′为阈值,a′,b′表示直线的截距和斜率,numerator′和 denominator′表示斜率的分子和分母;p,error′来表示参与拟合的点的个数和损失 值;初始化:p=2,a′=0,b′=0,error′=0 步骤3中,计算前向方向直线向量:使用error用来表示拟合前向直线的损失值,根据距离公式计算损失值 若error小于threshold,p的值加1,并且重复步骤四,就会使(x[n-p],y[n-p]) 这个点参与拟合;若error′大于等threshold′,则直线是已经符合误差范围内的前 向方向直线,得到前向直线的方向向量步骤4中,通过arccos函数以及求得两个方向的夹角,从而得到第n个点的弯度弯 度角为a[n]; 展开

查看更多专利详情信息请先登录或注册会员

相关专利类别推荐

获取手机验证码,即可注册成为会员

专利详情咨询

咨询内容

姓名

手机

验证码

用户登录

手机号

手机验证码

提示

不能再减了!!!

提交成功

八月瓜客服中心已经收到您的信息,正在为您派遣知识产权顾问。知识产权顾问会携带贴心的服务以闪电搬的速度与您联系。

扫一扫关注八月瓜微信 创业一手掌握