专利名称:一种计算前方道路弯度/坡度的预估方法
技术领域:
本发明涉及一种计算前方道路弯度/坡度的预估方法,属于道路导航技术领域。
背景技术:
近几年来,我国的机动车数量一直处于快速增长状态,目前保有量已超过2亿辆。 随着越来越多的汽车进入家庭,人们对于道路导航的需求也日益增加。因此,很多研究机构和企业都在道路自动导航技术上投入了很大的人力物力开展研究,已经取得了一定的研究成果。例如在申请号为200910146468.0的中国发明专利申请中,英华达股份有限公司提出了一种辅助导航的转向判断方法。它是在沿一弯曲路径行进,且无法有效接收全球卫星定位系统的定位资讯时,撷取道路背景为多个影像,并加以处理运算,以相减比对的手法求出差异处的偏移方向,或捕捉特定物体影像作为定位标的,藉以判断转向以持续提供导航画面。另外,在申请号为201010195063. 9的中国发明专利申请中,上海交通大学提出了一种道路坡度的检测方法,包括以下步骤获取待检测区域的等高线图和道路规划图;进行扫描和空间配准,得到等高线栅格分布图和道路规划栅格分布图;进行数字化处理,得到等高线矢量分布图和道路规划矢量分布图,并进行不规则三角网格转换处理,得到等高线不规则三角网格;提取所有节点,得到高程散点图,并进行空间插值处理,得到高程分布图; 提取道路高程信息,添加到道路规划矢量分布图中,并进行扩充和均值平滑处理,得到扩充后的道路高程分布图;提取栅格的高程差和水平距离,从而得到每条道路的坡度信息。但是,现有的道路导航技术依赖业已固定的数字地图,往往只能提供大致的前进方向或者对汽车当前所处位置的弯度/坡度进行测量计算,无法对前方道路的弯度/坡度做出提前预估。这一技术缺陷不利于汽车自动驾驶技术以及主动防碰撞技术的进一步发展。
发明内容
本发明所要解决的技术问题在于提供一种计算前方道路弯度/坡度的预估方法。为实现上述的发明目的,本发明采用下述的技术方案一种计算前方道路弯度/坡度的预估方法,其特征在于包括如下步骤首先,以行驶中的汽车当前所在位置为原点建立二维动态方位坐标系,搜索原点及周围的道路情况;其次,按照汽车的长度和道路拥堵程度确定弧长间隔,在道路前后按照相邻两点间隔预定时间选择多个点(例如m个点),根据各点的地理参数得到其在二维动态方位坐标系的坐标值,记为两个列向量叉=(巧,…,XfJ/ = U,---,^)';再次,基于已知列向量进行拟合得到如下的3维多项式及其一阶、二阶导函数y = a0+alx+a2x2+a:ix3, γ = αλ+ Ia1X + 3a3x2,y = Ia2 + 6a3x
曲率半径
权利要求
1. 一种计算前方道路弯度/坡度的预估方法,其特征在于包括如下步骤 首先,以行驶中的汽车当前所在位置为原点建立二维动态方位坐标系,搜索原点及周围的道路情况;其次,按照汽车的长度和道路拥堵程度确定弧长间隔,在道路前后按照相邻两点间隔预定时间选择多个点,根据各点的地理参数得到其在二维动态方位坐标系的坐标值,记为列向量;再次,基于已知列向量进行拟合得到如下的3维多项式及其一阶、二阶导函数
2.如权利要求1所述的计算前方道路弯度/坡度的预估方法,其特征在于 当需要预估前方道路的弯度时,所述地理参数为经纬度参数。
3.如权利要求1所述的计算前方道路弯度/坡度的预估方法,其特征在于 当需要预估前方道路的坡度时,所述地理参数为海拔高度参数。
全文摘要
本发明公开了一种计算前方道路弯度/坡度的预估方法。首先,以行驶中的汽车当前所在位置为原点建立二维动态方位坐标系,搜索原点及周围的道路情况;其次,按照汽车的长度和道路拥堵程度确定弧长间隔,在道路前后按照相邻两点间隔预定时间选择多个点,根据各点的地理参数得到其在二维动态方位坐标系的坐标值,记为列向量;再次,基于已知列向量进行拟合得到3维多项式及其一阶、二阶导函数;最后,计算每一点相对上一点的地理参数改变量,根据该地理参数改变量预估前方道路的弯度/坡度。利用本发明,可以对前方道路的弯度/坡度做出提前预估,从而提前采取相对应的技术措施,避免碰撞类交通事故的发生。
文档编号G06F19/00GK102201035SQ20111012206
公开日2011年9月28日 申请日期2011年5月12日 优先权日2011年5月12日
发明者李明航, 李智斌, 邵奕 申请人:北京星河易达科技有限公司