首页> 中国专利> 移动物预测装置、假想活动物预测装置、程序模块、移动物预测方法以及假想活动物预测方法

移动物预测装置、假想活动物预测装置、程序模块、移动物预测方法以及假想活动物预测方法

摘要

本发明提供移动物预测装置、假想活动物预测装置、程序模块、移动物预测方法以及假想活动物预测方法。利用环境检测部(40)检测移动物的位置、动作状态以及移动状态,并且检测多个种类的道路划分的区域以及静止物的区域。利用映射图生成部(42)生成对检测到的道路划分的区域以及静止物的区域附加了存在可能度的存在可能度映射图。利用移动物生成部(44)基于检测到的移动物的位置、动作状态以及移动状态生成移动物的位置分布以及移动状态分布,并记录于存在可能度映射图。利用位置更新部(46)基于移动物的移动状态分布使移动物的位置分布移动,利用分布变更部(48)基于存在可能度映射图的存在可能度使移动了的位置分布变更,预测存在可能度映射图上的移动物的将来的位置。由此,能够在各种各样的状况下高精度地预测移动物的将来的位置。

著录项

  • 公开/公告号CN103155015A

    专利类型发明专利

  • 公开/公告日2013-06-12

    原文格式PDF

  • 申请/专利权人 丰田自动车株式会社;

    申请/专利号CN201180043108.3

  • 申请日2011-09-08

  • 分类号G08G1/16(20060101);B60R21/00(20060101);

  • 代理机构11227 北京集佳知识产权代理有限公司;

  • 代理人李洋;舒艳君

  • 地址 日本爱知县

  • 入库时间 2024-02-19 19:54:51

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2023-09-15

    未缴年费专利权终止 IPC(主分类):G08G 1/16 专利号:ZL2011800431083 申请日:20110908 授权公告日:20141231

    专利权的终止

  • 2014-12-31

    授权

    授权

  • 2013-07-17

    实质审查的生效 IPC(主分类):G08G1/16 申请日:20110908

    实质审查的生效

  • 2013-06-12

    公开

    公开

说明书

技术领域

本发明涉及移动物预测装置、假想活动物预测装置、程序模块、移 动物预测方法以及假想活动物预测方法,特别是涉及预测移动物的将来 的位置的移动物预测装置、程序模块以及移动物预测方法,以及预测假 想活动物的将来的位置的假想活动物预测装置、程序模块以及假想活动 物预测方法。

背景技术

以往,公知有如下的物体行驶路径预测装置:将物体随着时间的推 移所取得的位置的变化生成为时空间上的轨迹,并进行物体的行驶路径 的概率性的预测(日本特开2007-233646号公报)。在该物体行驶路径 预测装置中,即便在作为现实而发生的状况下,也生成能够确保安全性 的轨道。

并且,公开有如下的在线风险学习系统:该系统自主地学习实际环 境下的经验,从而能够针对多种多样的外界环境来识别危险度(日本特 开2008-238831号公报)。该在线风险学习系统通过自动提取图像的特 征量,并学习与驾驶者的驾驶操作之间的关系来实现。

并且,公知有如下的十字路口碰撞预防装置:当在十字路口、汇合 点处本车处于碰撞危险度高的状况下时,对驾驶者发出警告,由此来预 防本车的碰撞(日本特开2005-173703号公报)。该十字路口碰撞预防 装置在数据库中具有十字路口处的事故形式,通过基于传感信息进行检 索并进行打分来实现。

然而,在上述的日本特开2007-233646号公报所记载的技术中, 并未明确针对移动物所能够移动的区域的限制,移动物能够在任何位置 移动,因此存在无法高精度地预测移动物的将来的位置的问题。

并且,在上述的日本特开2008-238831号公报所记载的技术中, 只要驾驶者没有进行欲改变驾驶行动的操作的倾向就不进行风险评价, 因此存在具有无法预测移动物的将来的位置的情况的问题。

并且,在上述的日本特开2005-173703号公报所记载的技术中, 需要表示十字路口、汇合点处的各种各样的交通状况下的风险的数据 库,存在未必能够应对实际产生的所有状况的问题。并且,由于风险评 价是基于设计者的打分进行的,因此并不具有物理意义。

发明内容

本发明就是为了解决上述的问题点而做出的,其目的在于提供一种 能够在各种各样的状况下高精度地预测移动物的将来的位置的移动物 预测装置、程序模块以及移动物预测方法。

并且,本发明的目的还在于提供一种能够高精度地预测假想活动物 的将来的位置的假想活动物预测装置、程序模块以及假想活动物预测方 法。

为了达成上述目的,本发明的第一实施方式构成为包括:移动物检 测部,该移动物检测部从检测对象范围检测移动物的位置以及动作状态 或者移动状态;区域检测部,该区域检测部从上述检测对象范围检测多 个种类的道路划分的区域以及静止物的区域;映射图生成部,该映射图 生成部生成对由上述区域检测部检测到的上述道路划分的区域以及上 述静止物的区域附加了表示移动物的存在容易度或者存在困难度的存 在可能度的存在可能度映射图;移动物记录部,该移动物记录部基于由 上述移动物检测部检测到的上述移动物的位置以及动作状态或者移动 状态生成上述移动物的位置分布以及移动状态分布,并记录于上述存在 可能度映射图;以及预测部,该预测部基于上述移动物的移动状态分布 使上述移动物的位置分布移动,并且基于上述存在可能度映射图的存在 可能度变更上述移动的位置分布,从而预测上述存在可能度映射图上的 上述移动物的将来的位置分布。

并且,本发明的第二实施方式涉及一种程序模块,该程序模块用于使 计算机作为移动物检测部、区域检测部、映射图生成部、移动物记录部以 及预测部发挥功能,其中,上述移动物检测部从检测对象范围检测移动物 的位置以及动作状态或者移动状态;上述区域检测部从上述检测对象范围 检测多个种类的道路划分的区域以及静止物的区域;上述映射图生成部生 成对由上述区域检测部检测到的上述道路划分的区域以及上述静止物的 区域附加了表示移动物的存在容易度或者存在困难度的存在可能度的存 在可能度映射图;上述移动物记录部基于由上述移动物检测部检测到的 上述移动物的位置以及动作状态或者移动状态生成上述移动物的位置 分布以及移动状态分布,并记录于上述存在可能度映射图;上述预测部 基于上述移动物的移动状态分布使上述移动物的位置分布移动,并且基 于上述存在可能度映射图的存在可能度变更上述移动的位置分布,从而 预测上述存在可能度映射图上的上述移动物的将来的位置分布。

根据本发明的第一实施方式以及第二实施方式,利用移动物检测部 从监测对象范围检测移动物的位置以及动作状态或者移动状态。利用区 域检测部从监测对象范围检测多个种类的道路划分的区域以及静止物 的区域。

进而,利用映射图生成部生成对由区域检测部检测到的道路划分的 区域以及静止物的区域附加了表示移动物的存在容易度或存在困难度 的存在可能度的存在可能度映射图。利用移动物记录部基于由移动物检 测部检测到的移动物的位置以及动作状态或者移动状态生成移动物的 位置分布以及移动状态分布,并记录于存在可能度映射图。

进而,利用预测部基于移动物的移动状态分布使移动物的位置分布 移动,并且基于存在可能度映射图的存在可能度变更移动了的位置分 布,从而预测存在可能度映射图上的移动物的将来的位置分布。

这样,通过基于移动物的移动状态分布使位置分布移动,并且基于 对道路划分的区域以及静止物的区域附加了移动物的存在可能度的存 在可能度映射图变更位置分布,由此,在各种各样的状况下都能够高精 度地预测移动物的将来的位置分布。

根据本发明的第三实施方式,位置分布由多个移动物粒子表示,预 测部基于移动物的移动状态分布使表示移动物的位置分布的多个移动 物粒子分别移动,并且通过基于存在可能度映射图的存在可能度使移动 了的移动物粒子消失并复制其他的移动物粒子来变更移动物的位置分 布,从而预测存在可能度映射图上的移动物的将来的位置分布。

根据本发明的第四实施方式,位置分布由概率分布表示,预测部基 于移动物的移动状态分布使表示移动物的位置分布的概率分布移动,并 且通过基于存在可能度映射图的存在可能度对移动了的概率分布进行 加权来变更移动物的位置分布,从而预测存在可能度映射图上的移动物 的将来的位置分布。

根据本发明的第五实施方式,区域检测部还检测道路划分的种类以 及静止物的高度,映射图生成部对道路划分的区域附加与道路划分的种 类相应的存在可能度,并对静止物的区域附加与静止物的高度相应的存 在可能度,从而生成存在可能度映射图。

根据本发明的第六实施方式,移动物检测部从检测对象范围除了检 测移动物的位置以及动作状态或者移动状态之外,还检测移动物的种 类,映射图生成部生成对移动物的每个种类附加了存在可能度的存在可 能度映射图。

根据本发明的第七实施方式,预测部基于移动物的移动状态分布使 移动物的位置分布移动,并且基于对与位置分布对应的区域附加的存在 可能度的大小、或者基于对与位置分布对应的区域附加的存在可能度以 及与移动前的位置分布对应的区域附加的存在可能度两者之差或者两 者之比来变更移动了的位置分布,从而预测存在可能度映射图上的移动 物的将来的位置分布。

根据本发明的第八实施方式,移动物预测装置还包括危险度计算 部,该危险度计算部基于由预测部预测出的计算对象的移动物的位置分 布和计算对象的移动物以外的移动物的位置分布来计算计算对象的移 动物与计算对象的移动物以外的移动物的碰撞危险度。

根据本发明的第九实施方式,移动物记录部基于检测到的静止物的 区域和搭载本装置的移动物的位置确定从搭载本装置的移动物观察时 的因静止物而形成的死角区域,生成假定存在于确定的死角区域内的移 动物的位置分布以及移动状态分布,并且在存在可能度映射图中的确定 的死角区域内记录生成的移动物的位置分布以及移动状态分布。

根据本发明的第十实施方式,确定上述的死角区域的移动物记录部 基于检测到的静止物的区域和搭载本装置的移动物的位置确定死角区 域,基于由检测检测对象范围的移动物的移动环境的移动环境检测部检 测到的上述移动环境中的确定的死角区域周边的移动环境,或者基于确 定的死角区域的位置推定假定存在于确定的死角区域内的移动物的种 类,生成死角区域内的移动物的位置分布以及移动状态分布,并且在存 在可能度映射图中的确定的死角区域内记录生成的移动物的位置分布 以及移动状态分布。

根据本发明的第十一实施方式,移动物预测装置还包括:物体位置检 测部,该物体位置检测部检测从搭载本装置的移动物观察到的存在于检测 对象范围的物体的位置;运动推定部,该运动推定部推定搭载本装置的移 动物的运动;地图更新部,该地图更新部基于由运动推定部推定出的搭载 本装置的移动物的当前的运动将前次更新了的地图信息反复更新成从当 前的上述搭载本装置的移动物观察到的地图信息;以及静止物记录部,每 当地图信息被地图更新部更新时,该静止物记录部在更新了的地图信息 中,在与由物体位置检测部检测到的当前的物体的位置对应的区块记录 静止物的存在,并且使与从搭载本装置的移动物到检测到的当前的物体 的位置之间对应的各区块中的静止物的存在的记录减少,区域检测部基 于地图信息检测静止物的区域。

本发明的第十二实施方式包括:从检测对象范围检测移动物的位置以 及动作状态或者移动状态,并且检测多个种类的道路划分的区域以及静止 物的区域的步骤;生成对检测到的上述道路划分的区域以及上述静止物的 区域附加了表示移动物的存在容易度或者存在困难度的存在可能度的存 在可能度映射图的步骤;基于检测到的上述移动物的位置以及动作状态或 者移动状态生成上述移动物的位置分布以及移动状态分布,进而,基于上 述移动物的移动状态分布使上述移动物的位置分布移动,并且基于上述存 在可能度映射图的存在可能度变更上述移动的位置分布,从而预测上述存 在可能度映射图上的上述移动物的将来的位置分布的步骤。

本发明的第十三实施方式构成为包括:区域检测部,该区域检测部从 检测对象范围检测多个种类的道路划分的区域以及静止物的区域;映射图 生成部,该映射图生成部生成对由上述区域检测部检测到的上述道路划分 的区域以及上述静止物的区域附加了表示移动物的存在容易度或者存在 困难度的存在可能度的存在可能度映射图;死角区域确定部,该死角区域 确定部从上述检测对象范围确定可能存在活动物的死角区域;假想活动 物生成部,该假想活动物生成部生成假定存在于由上述死角区域确定部 确定的死角区域内的假想活动物;假想活动物记录部,该假想活动物记 录部针对由上述假想活动物生成部生成的上述假想活动物,假定上述假 想活动物的位置以及动作状态或者移动状态,生成上述假想活动物的位 置分布以及移动状态分布,并记录于上述存在可能度映射图;以及预测 部,该预测部基于上述假想活动物的移动状态分布使上述假想活动物的 位置分布移动,并且基于上述存在可能度映射图的存在可能度变更上述 移动了的位置分布,从而预测上述存在可能度映射图上的上述假想活动 物的将来的位置分布。

本发明的第十四实施方式涉及一种程序模块,该程序模块用于使计算 机作为区域检测部、映射图生成部、死角区域确定部、假想活动物生成部、 假想活动物记录部以及预测部发挥功能,其中,上述区域检测部从检测对 象范围检测多个种类的道路划分的区域以及静止物的区域;上述映射图生 成部生成对由上述区域检测部检测到的上述道路划分的区域以及上述静 止物的区域附加了表示移动物的存在容易度或者存在困难度的存在可能 度的存在可能度映射图;上述死角区域确定部从上述检测对象范围确定可 能存在活动物的死角区域;上述假想活动物生成部生成假定存在于由上述 死角区域确定部确定的死角区域内的假想活动物;上述假想活动物记录部 针对由上述假想活动物生成部生成的上述假想活动物,假定上述假想活 动物的位置以及动作状态或者移动状态,生成上述假想活动物的位置分 布以及移动状态分布,并记录于上述存在可能度映射图;上述预测部基 于上述假想活动物的移动状态分布使上述假想活动物的位置分布移动, 并且基于上述存在可能度映射图的存在可能度变更上述移动了的位置 分布,从而预测上述存在可能度映射图上的上述假想活动物的将来的位 置分布。

根据本发明的第十三实施方式以及第十四实施方式,利用区域检测 部从监测对象范围检测多个种类的道路划分的区域以及静止物的区域。 利用映射图生成部生成对由上述区域检测部检测出的上述道路划分的 区域以及上述静止物的区域附加了表示移动物的存在容易度或者存在 困难度的存在可能度的存在可能度映射图。

进而,利用死角区域确定部从上述监测对象范围确定可能存在活动 物的死角区域。利用假想活动物生成部生成假定存在于由上述死角区域 确定部确定的死角区域内的假想活动物。利用假想活动物记录部针对由 上述假想活动物生成部生成的上述假想活动物,假定上述假想活动物的 位置以及动作状态或者移动状态,生成上述假想活动物的位置分布以及 移动状态分布,并记录于上述存在可能度映射图。

进而,利用预测部基于上述假想活动物的移动状态分布使上述假想 活动物的位置分布移动,并且基于上述存在可能度映射图的存在可能度 变更上述移动了的位置分布,从而预测上述存在可能度映射图上的上述 假想活动物的将来的位置分布。

这样,针对假定存在于死角区域内的假想活动物,基于假定的移动 状态分布使位置分布移动,并且基于对道路划分的区域以及静止物的区 域附加了移动物的存在可能度的存在可能度映射图变更位置分布,由 此,能够在各种各样的状况下高精度地预测假想活动物的将来的位置。

根据本发明的第十五实施方式,死角区域确定部确定上述死角区 域,并且基于上述死角区域的距离设定上述存在可能度映射图中的上述 死角区域的存在可能度。

根据本发明的第十六实施方式,针对由上述假想活动物生成部生成 的上述假想活动物,假想活动物记录部除了假定上述假想活动物的位置 以及动作状态或者移动状态之外,还基于上述死角区域的存在上述假想 活动物的距离假定上述假想活动物的种类,生成上述假想活动物的位置 分布以及移动状态分布,并记录于上述存在可能度映射图。

根据本发明的第十七实施方式,针对由上述假想活动物生成部生成 的上述假想活动物,上述假想活动物记录部以上述假想活动物从上述死 角区域突然出现时会与搭载本装置的移动物碰撞的方式假定上述假想 活动物的位置以及动作状态或者移动状态,生成上述假想活动物的位置 分布以及移动状态分布,并记录于上述存在可能度映射图。

根据本发明的第十八实施方式,针对由上述假想活动物生成部生成 的上述假想活动物,假想活动物记录部将上述死角区域内的最接近假定 当上述假想活动物从上述死角区域突然出现时与搭载本装置的移动物 碰撞的位置的位置假定为上述假想活动物的位置,并且以当上述假想活 动物从上述死角区域突然出现时会与搭载本装置的移动物碰撞的方式 假定上述假想活动物的动作状态或者移动状态,生成上述假想活动物的 位置分布以及移动状态分布,并记录于上述存在可能度映射图。

本发明的第十九实施方式包括:从检测对象范围检测多个种类的道路 划分的区域以及静止物的区域的步骤;生成对上述检测到的上述道路划分 的区域以及上述静止物的区域附加了表示移动物的存在容易度或者存在 困难度的存在可能度的存在可能度映射图的步骤;从上述检测对象范围确 定可能存在活动物的死角区域的步骤;生成假定存在于被确定的上述死角 区域内的假想活动物的步骤;针对上述生成的上述假想活动物,假定上述 假想活动物的位置以及动作状态或者移动状态,生成上述假想活动物的位 置分布以及移动状态分布,并记录于上述存在可能度映射图的步骤;以及 基于上述假想活动物的移动状态分布使上述假想活动物的位置分布移 动,并且基于上述存在可能度映射图的存在可能度变更上述移动了的位 置分布,从而预测上述存在可能度映射图上的上述假想活动物的将来的 位置分布的步骤。

如以上所说明了的那样,根据作为本发明的一个实施方式的移动物 预测装置、程序模块以及移动物预测方法,通过基于移动物的移动状态 分布使位置分布移动,并且基于对道路划分的区域以及静止物的区域附 加了移动物的存在可能度的存在可能度映射图变更位置分布,能够得到 能够在各种各样的状况下高精度地预测移动物的将来的位置的效果。

并且,根据作为本发明的一个实施方式的假想活动物预测装置、程 序模块以及假想活动物预测方法,针对假定存在于死角区域内的假想活 动物,通过基于假定的移动状态分布使位置分布移动,并且基于对道路 划分的区域以及静止物的区域附加了移动物的存在可能度的存在可能 度映射图变更位置分布,能够得到能够在各种各样的状况下高精度地预 测假想活动物的将来的位置的效果。

附图说明

图1是示出本发明的第一实施方式所涉及的碰撞危险判定装置的框 图。

图2A是示出行驶环境的例子的影像图。

图2B是示出初期状态下的局部地图信息的影像图。

图2C是示出记录有激光雷达的检测结果的局部地图信息的影像 图。

图3是示出行驶环境的例子的影像图。

图4A是示出表示行人的存在可能度的存在可能度映射图的例子的 影像图。

图4B是示出表示本车的存在可能度的存在可能度映射图的例子的 影像图。

图5是示出确定行人的存在可能度的数据表的离子的图。

图6是示出确定本车的存在可能度的数据表的例子的图。

图7A是示出在存在可能度映射图上配置移动物粒子后的情形的 图。

图7B是示出移动以及变更后的移动物粒子的配置的图。

图7C是示出移动以及变更后的移动物粒子的配置的图。

图8是示出确定与平均速度相应的速度协方差行列的数据表的例子 的图。

图9是示出IF-THEN规则的例子的图。

图10是示出本发明的第一实施方式所涉及的碰撞危险判定装置中 的局部地图生成处理程序的内容的流程图。

图11是示出本发明的第一实施方式所涉及的碰撞危险判定装置中 的危险判定处理程序的内容的流程图。

图12是示出本发明的第二实施方式所涉及的碰撞危险判定装置的 框图。

图13A是示出位置分布的例子的影像图。

图13B是示出速度分布的例子的影像图。

图14是示出位置分布移动的情形的影像图。

图15是用于对相对于移动后的位置分布的加权进行说明的图。

图16是示出本发明的第三实施方式所涉及的碰撞危险判定装置中 的危险判定处理程序的内容的流程图。

图17是示出进行定点观测的情形的图。

图18是示出数据库的例子的图。

图19是示出收纳有周边信息输入和假定输出的数据表的图。

图20是示出神经网络的图。

图21是示出本发明的第七实施方式所涉及的碰撞危险判定装置的 框图。

图22是用于对死角区域进行说明的图。

图23是示出死角距离与存在可能度之间的对应的图。

图24是示出死角距离与假想活动物的种类之间的对应的图。

图25是用于对计算假定的假想活动物的位置以及速度的方法进行 说明的图。

图26是示出本发明的第七实施方式所涉及的碰撞危险判定装置中 的危险判定处理程序的内容的流程图。

图27是用于对计算假定的假想活动物的位置以及速度的方法进行 说明的图。

具体实施方式

以下,参照附图对本发明的实施方式进行详细说明。另外,在本实 施方式中,以将本发明应用于搭载于车辆的碰撞危险判定装置的情况为 例进行说明。

如图1所示,第一实施方式所涉及的碰撞危险判定装置10具备: 激光雷达12边一维(水平方向)地扫描边朝作为判定对象范围的本车 的前方照射激光,通过激光的反射来检测激光所照射的物体的二维位 置;运动传感器14,该运动传感器14检测本车的运动状态;照相机18, 该照相机18拍摄本车的前方;GPS装置20,该GPS装置20检测作为 判定对象物的本车的位置;以及计算机22,该计算机22基于上述部件 的检测结果生成记录有从当前的本车观察到的前方的静止物的存在的 局部地图信息,并判定与移动物碰撞的危险性,当存在碰撞的危险性的 情况下,利用警报装置24发出警报。

并且,激光雷达12设置在车辆前方,是检测以装置作为基准的到 存在于车辆前方的物体为止的距离的装置。激光雷达12能够通过使输 出的激光沿水平方向进行扫描从而借助激光的反射检测存在于本车前 方的多个物体表面上的多个点的位置。激光雷达12的检测结果是表示 存在于本车前方的物体表面的某一点的位置的二维坐标的集合。由激光 雷达12进行的检测处理按照一定的循环执行。激光雷达12朝计算机22 输出表示各时刻的存在于本车前方的物体表面的多个点的二维位置的 数据。另外,激光雷达12是物体位置检测部的一例。

运动传感器14由计测本车的速度的车速传感器、计测偏航率的陀 螺仪、或者是计测本车的加速度的加速度传感器构成。

照相机18由小型的CCD照相机或者CMOS照相机构成,且安装 在车辆的前窗玻璃上部等以便拍摄车辆的前方。由照相机18拍摄到的 前方的道路状况等的图像数据被输入计算机22。

计算机22构成为包括CPU、存储有用于执行后述的局部地图生成 处理程序以及危险判定处理程序的各程序的程序模块的ROM、存储数 据等的RAM以及连接这些部件的总线。按照基于硬件和软件确定的每 个功能实现单元分割后的功能模块对该计算机22进行说明,则如图1 所示,具备:取得由激光雷达12检测到的物体的二维位置的物体位置 取得部30;基于由运动传感器14检测到的车速、偏航率或者加速度推 定本车的运动的本车运动推定部32;基于本车的运动将到上一时刻为止 的局部地图信息更新成从当前的本车观察的坐标系的局部地图信息的 局部地图更新部34;以及基于检测到的当前的物体的二维位置变更更新 后的局部地图信息中的静止物的存在概率的存在概率变更部36。另外, 存在概率变更部36是静止物记录部的一例。

本车运动推定部32基于从局部地图信息上次被更新起到当前为止 的期间中的由运动传感器14检测到的车速、偏航率、或者加速度来推 定从局部地图信息上次被更新起到当前为止的本车的运动。

局部地图更新部34通过根据所推定出的本车的运动将更新到上一 时刻的局部地图信息转换成从当前的本车观察到的坐标系来生成表示 从当前的本车观察到的前方区域的局部地图信息。并且,局部地图更新 部34反复进行局部地图信息的更新。局部地图信息如图2B所示是由利 用一定大小的格子(区块)对本车前方的一定区域内进行分割而得到的 多个区块表示的地图。在各区块记录有在该位置存在静止物的概率,在 初期状态下,如图2B所示,作为存在概率记录有作为初始值的0.5(中 间值)。

每当利用局部地图更新部34对局部地图信息进行更新时,存在概 率变更部36就基于由物体位置取得部30取得的当前的物体的各个二维 位置在更新后的局部地图信息中使与该物体的位置对应的区块的存在 概率增加。并且,存在概率变更部36使存在于从本车到该物体的二维 位置为止的直线上的各区块的存在概率减少。通过以这种方式变更存在 概率,一定期间以上在对应的位置检测到物体的区块的存在概率变高, 仅临时地检测到物体的区块存在概率变低。在如图2A所示的行驶环境 的情况下,如图2C所示,例如在确实存在静止物的位置的区块中作为 存在概率记录1(最大值),在不存在静止物的位置的区块中作为存在概 率记录0(最小值)。并且,在因由其他物体遮挡等原因而无法得到该位 置的信息的区块(死角区域的区块)作为存在概率记录作为初始值的0.5 (中间值)。

结果,即便是在存在多个移动物的行驶环境中,也能够稳定地仅检 测比较长时间在相同位置观测到的路边物体等静止物。并且,对于到现 在为止无法利用激光雷达12观测的部分(不可视区域),能够作为存在 概率保持为初始值(0.5)的区块检测。并且,在几乎得不到激光雷达 12的计测点的远方区域,不会从初始值变化,因此能够看做死角区域。

并且,计算机22具备:存储电子地图的地图数据库38;基于由照 相机18拍摄到的前方图像、生成的局部地图信息、存储的电子地图、 以及由GPS装置20检测到的本车的位置,检测本车周边的移动物、移 动物的状态亦即行驶环境的状况的环境检测部40;基于检测到的行驶环 境的状况针对移动物的每个类别生成表示存在可能度的存在可能度映 射图的映射图生成部42;生成多个作为表示移动物的数据的移动物粒 子,对各移动物粒子附加与移动物的移动状态分布相应的移动状态,并 以表示检测到的移动物的位置的分布的方式配置在存在可能度映射图 上的移动物生成部44;基于移动状态使各移动物粒子移动的位置更新部 46;基于存在可能度映射图进行消失以及复制从而变更移动物粒子的配 置的分布变更部48;以及基于各移动物的移动物粒子的配置判定本车与 移动物碰撞的危险性,并利用警报装置24输出判定结果的危险判定部 50。

由位置更新部46、分布变更部48以及危险判定部50进行的一系列 的处理反复执行。另外,环境检测部40是移动物检测部、区域检测部 以及移动环境检测部的一例。并且,位置更新部46以及分布变更部48 是预测部的一例。危险判定部50是危险度计算部的一例。

在存储于地图数据库38的电子地图中收纳有与道路形状、标识显 示、建筑物相关的信息。

环境检测部40基于由GPS装置20检测到的本车位置从地图数据库 38的电子地图检测与本车周边的道路划分(车道、人行道、人行横道等) 以及道路划分的区域、标识显示(信号、临时停止等)、建筑物相关的 信息。并且,从地图数据库38的电子地图检测本车的周边地域类别(学 校区域、商店街、住宅街等)、道路属性(车道数、车道宽度、有无中 央分隔带等)。

并且,环境检测部40从局部地图信息检测存在静止物(护栏、植 物、建筑物、驻停车车辆等)的区域。并且,从由照相机18拍摄到的 前方图像检测各静止物的高度。

并且,环境检测部40在局部地图信息中基于本车位置和静止物的 位置确定从本车观察的因静止物的存在而形成的死角区域。

并且,环境检测部40借助学习型的图案识别技术(例如SVM)从 由照相机18拍摄到的前方图像检测存在于前方的移动物的位置、大小、 移动物的种类(例如行人、二轮车、汽车等)、动作状态(方向、行走 方式等)以及移动状态(速度等),并且检测前方的道路的各种道路划 分的类别(车道、人行道、人行横道、信号灯、临时停止线等)以及区 域。另外,环境检测部40通过取得连续的局部地图信息的时间差分来 识别正在移动的活动物和静止的活动物,从而确定移动物所存在的区 域,并使所确定的移动物所存在的区域和检测到的移动物的种类对应。

映射图生成部42基于检测到的道路划分的区域、静止物的区域、 道路属性等针对移动物的每个类别生成存在可能度映射图。例如,在如 图3所示的行驶环境(车道为单向一车道、人行道和车道由高度0.2[m] 的路缘石分隔)、且在人行道存在步行的行人的状况下,映射图生成部 42生成如图4A所示的针对行人的存在可能度映射图。并且,映射图生 成部42生成如图4B所示的针对本车的存在可能度映射图。

在存在可能度映射图中,针对各种道路划分的区域以及静止物的区 域附加存在可能度。此处,存在可能度利用从0.0到1.0的数字表示对 象区域中的行人、本车的存在容易度。道路划分的存在可能度例如根据 道路划分以及道路属性的组合确定,且预先作为数据表准备。例如,作 为行人的存在可能度,准备如图5所示的数据表,并且,作为本车的存 在可能度,准备如图6所示的数据表。

并且,在静止物区域中存在行人的存在可能度根据静止物的高度h ([m])计算,例如根据下述的(1)式计算存在可能度。

存在可能度=1.0-min(h,1.0)······(1)

其中,min(a,b)是返回a、b中的较小值的函数。

并且,作为在静止物区域中存在本车的存在可能度,例如附加0.0。

移动物生成部44在存在可能度映射图中将所确定的移动物存在的 区域作为粒子生成候补区域,将死角区域也作为粒子生成候补区域。并 且,将本车存在的区域也作为粒子生成候补区域。并且,移动物生成部 44以成为预先设计的粒子总数的方式使用随机数生成器如图7A所示针 对各粒子生成候补区域生成并配置多个移动物粒子。

并且,移动物生成部44基于检测到的移动物的动作状态以及移动 状态将移动物的移动状态设定成分布。作为当成移动状态使用的物理 量,移动物生成部44设定方向、速度、加速度中的任一个或者两个。

例如,行人的速度越大、直进性越强,则认为移动的不确定性越低, 因此,移动物生成部44例如如图8所示的与行人的平均速度相应的方 差/协方差的数据表设定移动物的移动状态的分布。并且,当行人的动 作状态为溜溜达达/东张西望的情况下,以速度方差变大的方式设定移 动状态的分布。

并且,移动物生成部44基于由运动传感器44检测到的车速以及方 向生成本车的移动状态分布。

此处,作为相对于本车不存在移动的不确定性的物体,将移动状态 (速度)的协方差行列设定为0行列。并且,行人的移动状态(速度) 的协方差行列表示行人的移动的不确定性。

并且,基于以上述方式设定的移动物的移动状态的分布来分别决定 各移动物粒子的移动状态。

对配置在粒子生成候补区域的移动物粒子一并分配汽车、二轮车、 行人等移动物的种类的检测结果的标记或基于设定了的移动状态的分 布决定的移动状态的信息。另外,粒子总数可以根据计算机22的处理 能力预先设定。

并且,对移动物粒子分配用于识别移动物的识别信息。例如,相对 于针对一个移动物生成的粒子生成候补区域,生成分配了相同的识别信 息的移动物粒子。

基于环境检测部40的检测结果以及如图9所示的预先确定的IF- THEN规则对从死角区域生成的粒子生成候补区域的移动物粒子分配 汽车、二轮车、行人等表示移动物的种类的标记。此外,对移动物粒子 分配表示基于根据移动物的种类预先确定的方向/速度/加速度等移动状 态分布决定的移动状态的信息。例如,在道路形状为单向一车道道路、 死角区域是因驻车车辆而形成的、且死角区域包含人行横道的情况下, 配置分配了行人的标记的移动物粒子。

位置更新部46基于对移动物粒子附加的移动状态使各移动物粒子 的位置移动,从而将各移动物粒子的配置更新一步。

在使各移动物粒子移动之后,分布变更部48根据对移动地点的区 域附加的存在可能度使移动物粒子消失/复制,从而进行移动物粒子的 再选择,并变更移动物的位置分布(根据存在容易度对移动物的移动附 加制约)。

在进行移动物粒子的再选择时,也可以并不使用对移动地点的区域 附加的存在可能度,而是使用对移动前后的区域附加的存在可能度之差 或者二者之比。

此处,对分布变更部48再选择各移动物粒子的原理进行说明。

首先,通过更新处理,各移动物粒子基于对各移动物粒子分配的移 动状态迁移。

进而,迁移目标的存在可能度越低,则分布变更部48越使较高的 概率使该移动物粒子消失。其次,分布变更部48复制消失了的量的移 动物粒子,并以与并未消失的其他的移动物粒子的位置重复的方式进行 配置、或者配置在并未消失的其他的移动物粒子的位置的周边的位置 (乘以随机数后的位置)。由此,能够以存在可能度高的区域为中心新 生成移动物粒子。并且,以总粒子数一定的方式进行上述的消失以及复 制。

例如,在为稳定的步伐的步行者、且速度方差小的情况下,以移动 目标的存在可能度低的区域为中心使移动物粒子消失,并以移动目标的 存在可能度高的区域为中心新生成移动物粒子,由此,如图7B所示, 移动物粒子的配置变更,表示并未经过人行横道。另一方面,当为溜溜 达达/东张西望的行人、且速度方差大的情况下,以移动目标的存在可 能度低的区域为中心使移动物粒子消失,并以移动目标的存在可能读高 的区域为中心新生成移动物粒子,由此,如图7C所示,移动物粒子的 配置变更,表示经过人行横道。

危险判定部50基于由分布变更部48变更后的各移动物的移动物粒 子的分布对本车的移动物粒子与其他移动物的移动物粒子重复的数量 进行计数,并基于计数而得的数量计算与该其他移动物碰撞的碰撞概 率。当计算出的碰撞概率超过阈值时,危险判定部50判定为存在碰撞 的危险性,利用警报装置24借助声音、图像等方法对驾驶员报告重复 的对象移动物粒子的移动物的种类以及位置。例如,当存在在本车的右 前方与行人碰撞的危险性的情况下,通过声音对驾驶员报告“注意右前 方行人”。另外,也可以利用警报装置24对重复的对象移动物粒子的移 动物发出警报。

另外,为了模拟本车以外的移动物彼此的避免碰撞的行动,可以在 计算与本车碰撞的碰撞概率之前,判定本车以外的移动物彼此的碰撞 (移动物粒子的重复),当发生碰撞的情况下,变更发生碰撞的移动物 的位置分布(移动物粒子的配置)。并且,也可以预备下一时刻的移动 以及碰撞判定,在计算本车与移动物碰撞的碰撞概率之后,变更发生碰 撞的本车以及移动物的位置分布(移动物粒子的配置)。

其次,对本实施方式所涉及的碰撞危险判定装置10的作用进行说 明。

首先,利用激光雷达12水平方向朝本车的前方扫描激光,计测到 沿扫描方向排列的作为激光照射位置的物体的各自的二维位置为止的 距离,并检测存在于本车的前方的物体的二维位置。利用激光雷达12 检测的二维位置能够在每次使激光进行扫描时得到。

进而,利用计算机22执行图10所示的局部地图生成处理程序。

首先,在步骤100中,计算机22从激光雷达12取得表示存在于前 方的物体的二维位置(到沿扫描方向排列的各二维位置为止的计测距 离)的数据。在步骤102中,计算机22取得从上一时刻到当前位置为 止的期间中的由运动传感器14检测到的车速、偏航率或者加速度,并 基于所取得的车速、偏航率或者加速度推定从上一时刻到当前为止的本 车的运动。

进而,在步骤104中,计算机22根据在上述步骤102中推定出的 本车的运动将在后述的步骤106中前次更新了的局部地图信息更新成由 从当前的本车观察的坐标系表示的局部地图信息。

在随后的步骤106中,计算机22基于在上述步骤100中取得的存 在于本车前方的物体的二维位置,在上述步骤104中更新了的局部地图 信息中,使与存在于本车前方的物体的二维位置对应的区块的存在概率 增加,并且使存在于从本车到物体的二维位置为止的直线上的各区块的 存在概率减少。由此,计算机22在地图上记录当前不存在物体的位置。 进而,计算机22返回上述步骤100。

如上所述,通过反复执行局部地图生成处理程序来随时推定从当前 的本车观察的静止物的位置。

另外,也可以在上述局部地图生成处理程序反复执行了规定次数时 使所生成的局部地图信息有效。

并且,利用计算机22执行图11所示的危险判定处理程序。首先, 在步骤120中,计算机22取得由照相机18拍摄到的前方图像以及由 GPS装置20检测到的本车位置。在随后的步骤122中,计算机22基于 在上述步骤120中取得的前方图像、本车位置以及地图数据库38的电 子地图检测包括本车周边的各种道路划分的区域以及道路属性的行驶 环境的状况,并且检测周边的移动物、移动物的动作状态、移动状态、 移动物的种类、以及静止物的高度。

进而,在步骤124中,计算机22取得通过上述的局部地图生成处 理程序得到的当前的局部地图信息。在随后的步骤125中,计算机22 从在上述步骤124中取得的局部地图信息检测存在静止物的区域。

进而,在步骤126中,计算机22针对在上述步骤122中检测到的 道路划分的区域、道路属性以及在上述步骤125中检测到的存在静止物 的区域和移动物的每个种类,基于与道路划分的种类、道路属性以及静 止物相应的确定了存在可能度的数据表生成存在可能度映射图。

在步骤130中,计算机22在上述步骤126中生成的存在可能度映 射图中设定相对于在上述步骤122中检测到的移动物以及本车的移动物 粒子生成候补区域,并且以成为预先设定的粒子总数的方式生成包含本 车的各移动物的移动物粒子,并配置在对应的移动物粒子生成候补区 域。并且,计算机22针对各移动物基于检测到的动作状态以及移动状 态求出移动状态分布,并基于求出的移动状态分布分别决定各移动物粒 子的移动状态,并对各移动物粒子分配移动状态。

在随后的步骤132中,计算机22将对预测次数进行计数而得的变 量n设定初始值1。

进而,在步骤134中,计算机22使各移动物粒子根据所分配的移 动状态移动。在随后的步骤136中,计算机22根据存在可能度映射图 的存在可能度进行通过上述步骤134移动后的移动物粒子的消失以及复 制,变更移动物粒子的配置。在步骤138中,计算机22基于在上述步 骤136中变更后的其他移动物的移动物粒子与本车的移动物粒子的重复 频率而作为碰撞危险度分别计算与其他移动物碰撞的碰撞概率。

进而,在步骤140中,计算机22判定是否存在上述步骤138中计 算出的碰撞概率在阈值以上的移动物。当不存在该移动物的情况下,计 算机22朝步骤144过渡。另一方面,当存在该移动物的情况下,在步 骤142中,计算机22使警报装置24显示该移动物的将来预测位置以及 警告信息,并朝步骤144过渡。

在步骤144中,计算机22判定表示预测次数的变量n是否达到与 将来预测时间对应的次数N。当变量n并未达到常数N的情况下,在步 骤146中,计算机22使变量n加一,返回上述步骤134,并反复进行 上述步骤134以后的处理。另一方面,当变量n到达常数N的情况下, 计算机22结束危险判定处理程序。

如以上说明了的那样,根据第一实施方式所涉及的碰撞危险判定装 置,基于移动物的移动状态分布使各移动物粒子移动,并且,基于对道 路划分的区域以及静止物的区域附加了移动物的存在可能度的存在可 能度映射图变更各移动物粒子的配置,从而预测各移动物的位置分布。 由此,碰撞危险判定装置能够在各种各样的状况下高精度地预测移动物 的将来的位置。

在推定与其他物体碰撞的碰撞危险度时,移动物的将来位置预测十 分重要。移动物根据所处的交通环境(静止障碍物、人行道、车道、人 行横道等道路划分等)而其移动受到制约。并且,驾驶员根据移动物的 状态(方向、行走方式等)改变将来位置的预测。这样,为了在各种各 样的交通状况中实现移动物的将来位置预测,应当假定的交通环境/移 动物的状态的组合较多,难以预先准备这些组合。因此,本实施方式的 碰撞危险判定装置独立地设定仅由环境因素决定的“相对于场所的移动 物的存在可能度”和仅由移动物的状态决定的“移动物的移动的不确定 性(移动状态分布)”,并在存在可能度映射图上基于移动物的移动状态 分布使移动物移动。由此,碰撞危险判定装置能够进行考虑了各种各样 的交通环境/移动物的状态的组合的移动物的将来位置预测。并且,碰 撞危险判定装置能够通过预测与本车碰撞的程度来推定各种各样的交 通状况(由道路环境和移动物状态的组合构成)下的碰撞危险度。

并且,通过以交通环境的信息作为线索在本来无法得到传感信息的 死角区域也生成移动物粒子,能够进行考虑了存在于死角区域的移动物 的存在的危险判定。

并且,通过使粒子的总数可变,能够根据进行处理的计算机的能 力调整危险判定的精度。

并且,由于粒子总数始终为一定值,因此能够确保不依赖于行驶 环境的状况的复杂度的计算效率。

其次,对第二实施方式所涉及的碰撞危险判定装置进行说明。另 外,对形成为与第一实施方式相同的结构的部分标注相同标号并省略说 明。

在第二实施方式中,与第一实施方式的主要不同点在于,在路边 的装置中预测移动物的将来分布,并判定碰撞的危险性。

第二实施方式所涉及的碰撞危险度判定装置固定设置于路边,例 如主要设置于十字路口。如图12所示,碰撞危险度判定装置210具备: 激光雷达12边一维(水平方向)地进行扫描边朝作为判定对象范围的 本装置的前方照射激光,通过激光的反射来检测激光所照射的物体的二 维位置;照相机18,该照相机18拍摄本装置的前方;GPS装置20,该 GPS装置20检测本装置的位置;以及计算机222,该计算机222基于 上述部件的检测结果生成记录有从当前的本装置观察到的前方的静止 物的存在的局部地图信息,并预测移动物的将来的位置,当根据预测结 果判定为存在碰撞的危险性的情况下,并使通信装置224发送在搭载有 显示警告信息的显示装置的车辆中显示警告信息的指令。

计算机222具备物体位置取得部30和存在概率变更部236,存在 概率变更部236基于检测到的当前的物体的二维位置变更从本装置观察 的坐标系的局部地图信息中的静止物的存在概率。

并且,计算机222具备:地图数据库38;检测本装置周边的移动 物以及行驶环境的状况的环境检测部40;映射图生成部42;移动物生 成部44;位置更新部46;分布变更部48;以及危险判定部250,该危 险判定部250基于各移动物的移动物粒子的配置针对各移动物判定与其 他移动物碰撞的危险性,并利用通信装置224发送在搭载有显示装置的 车辆中显示判定结果的指令。

其次,在第二实施方式所涉及的局部地图信息处理程序中,计算 机222从激光雷达12取得表示存在于前方的物体的二维位置的数据。 其次,计算机222基于所取得的存在于本装置前方的物体的二维位置, 在局部地图信息中,使与存在于本装置前方的物体的二维位置对应的区 块的存在概率增加,并且使存在于从本装置到物体的二维位置为止的直 线上的各区块的存在概率减少。由此,计算机222在地图上记录当前不 存在物体的位置。进而,计算机222返回最初的处理。

如上所述,通过反复执行局部地图生成处理程序来随时推定从当 前的本装置观察的静止物的位置。

并且,在第二实施方式所涉及的危险判定处理程序中,首先,计 算机222取得由照相机18拍摄到的前方图像以及由GPS装置20检测 到的本装置位置。其次,计算机222基于上述取得了的前方图像、本装 置位置以及地图数据库38的电子地图检测包括本装置周边的各种道路 划分的区域以及道路属性的行驶环境的状况,并且检测周边的移动物、 移动物的动作状态、移动状态、移动物的种类以及静止物的高度。

进而,计算机222取得通过上述的局部地图生成处理程序得到的 当前的局部地图信息。其次,计算机222基于所取得的局部地图信息检 测静止物的区域,并基于上述检测出的各种道路划分的区域、道路属性、 以及上述检测出的静止物的区域生成对静止物的区域以及道路划分的 区域附加了存在可能度的存在可能度映射图。

进而,计算机222在上述生成的存在可能度映射图中设定相对于 上述检测出的移动物的移动物粒子生成候补区域,并且以成为预先设定 的粒子总数的方式生成各移动物的移动物粒子,并配置在对应的移动物 粒子生成候补区域。并且,计算机222针对各移动物求出移动状态分布, 并基于求出的移动状态分布决定各移动物粒子的移动状态,并对各移动 物粒子分配移动状态。

其次,计算机222将对预测次数进行计数而得的变量n设定为初 始值1。进而,计算机222使各移动物粒子根据所分配的移动状态移动。 其次,计算机222根据存在可能度映射图的存在可能度进行上述移动了 的移动物粒子的消失以及复制,变更移动物粒子的配置。进而,计算机 222以各移动物作为对象,基于上述变更了的判定对象的移动物的移动 物粒子与其他移动物的移动物粒子的重复频率而作为碰撞危险度分别 计算与其他移动物碰撞的碰撞概率。

其次,计算机222判定是否存在上述计算出的碰撞概率在预支以 上的移动物。当不存在该移动物的情况下,计算机222利用通信装置224 朝该判定对象的移动物发送使搭载于判定对象的移动物的显示装置显 示该移动物的将来预测位置以及警告信息的指令。

直到表示预测次数的变量n达到与将来预测时间对应的次数N为 止,计算机222反复进行上述的处理,当变量n达到常数N的情况下, 结束危险判定处理程序。

如以上说明了的那样,根据第二实施方式所涉及的碰撞危险判定 装置,能够利用路边的装置针对各种各样的状况高精度地预测周边的各 移动物的将来的位置。并且,碰撞危险判定装置能够通过预测周边的移 动物彼此之间的碰撞的程度来推定各种各样的交通状况下的碰撞危险 度。

其次,对第三实施方式所涉及的碰撞危险判定装置进行说明。另 外,由于第三实施方式所涉及的碰撞危险判定装置形成为与第一实施方 式相同的结构,因此标注相同标号并省略说明。

在第三实施方式中,与第一实施方式的主要不同点在于,用正规 分布来表示各移动物的位置分布以及移动状态的分布。

在第三实施方式所涉及的碰撞危险判定装置中,如图13A所示, 利用移动物生成部44,基于由环境检测部40检测到的移动物的位置以 及大小,用本车中心x-y坐标空间中的二维正规分布(平均向量和方 差行列)表现移动物的位置,生成表示移动物的位置分布的移动物数据。 移动物生成部44将所生成的移动物数据记录在存在可能度映射图上。 另外,移动物生成部44作为位置的平均向量而使用观测值(检测到的 移动物的位置)基于检测到的移动物的大小设定位置的协方差行列。

并且,如图13B所示,移动物生成部44基于利用环境检测部40 检测到的移动物的动作状态以及移动状态,利用本车中心x-y坐标空 间中的二维正规分布(平均向量和方差行列)表现移动物的速度,并分 配给记录在存在可能度映射图上的移动物数据。另外,移动物生成部44 作为速度的平均向量使用从由环境检测部40检测到的行人检测结果(动 作状态、移动状态)推定的量。并且,移动物生成部44利用与行人的 平均速度相应的上述图8所示的方差/协方差的数据表设定速度的协方 差行列。

并且,移动物生成部44基于利用运动传感器14检测到的车速生 成本车的速度分布,生成表示本车的位置分布以及速度分布的移动物数 据,并记录于存在可能度映射图上的本车位置。

移动物的位置分布由以下的(2)式表示。

[数学式1]

Pos(μpos,Σpos)=12π|Σpos|12exp{-12(x-μpos)TΣpos-1(x-μpos)}...(2)

其中,μpos是位置平均向量,由以下的(3)式表示,∑pos是位 置协方差行列,由以下的(4)式表示。

[数学式2]

μpos=μxμy...(3)

Σpos=σx2σxyσxyσy2...(4)

并且,速度分布由以下的(5)式表示。

[数学式3]

Vel(μvel,Σvel)=12π|Σvel|12exp{-12(x-μvel)TΣvel-1(x-μvel)}...(5)

其中,μvel是速度平均向量,由以下的(6)式表示,∑vel是速度 协方差行列,由以下的(7)式表示。

[数学式4]

μvel=μvxμvy...(6)

Σvel=σvx2σvxvyσvxvyσvy2...(7)

移动物生成部44在存在可能度映射图中,在利用环境检测部40 确定的死角区域内也记录移动物数据。

基于环境检测部40的检测结果和如上述图9所示的预先确定的 IF-THEN规则对记录在死角区域内的动物数据分配汽车、二轮车、行 人等表示移动物的种类的标记。此外,对移动物数据分配根据移动物的 种类预先确定的位置分布以及速度分布。

如图14所示,位置更新部46使用移动物的位置分布以及速度分 布,通过线性预测求出△t秒后的移动物的位置分布。

更新后的位置分布的位置平均向量μpos’以及位置协方差行列∑ pos’由以下的(8)式、(9)式表示。

[数学式5]

μpos=μpos+Δt·μvel=μx+Δt·μvxμy+Δt·μvy...(8)

Σpos=Σpos+Δt2·Σvel=σx2+Δt2·σvx2σxy+Δt2·σvxvyσxy+Δt2·σvxvyσy2+Δt2·σvy2...(9)

为而来进行后面的危险判定部50中的碰撞概率的急速那,如图 15所示,分布变更部48利用附加于对应的区域的存在可能度对移动后 的位置分布的各点(位置)的概率分布进行加权。另外,在进行基于存 在可能度的加权时,也可以并不使用对移动地点的区域附加的存在可能 度,而是使用对移动前后的区域附加的存在可能度之差或者二者之比进 行加权。

例如,将移动后的行人的位置分布设定为以下的(10)式,将位 置x处的行人的存在可能度设定为Existped(x)。

[数学式6]

Ped(x)=12π|Σpos|12exp{-12(x-μpos)TΣpos-1(x-μpos)}...(10)

此时,利用存在可能度进行加权后的位置分布Ped’用以下的(11) 式表示。

[数学式7]

Ped(x)=Existped(x)·Ped(x)

=Existped(x)·12π|Σpos|12exp{-12(x-μpos)TΣpos-1(x-μpos)}...(11)

在上述(11)式的情况下,由于存在在对象区域整体对经过位置 分布进行积分而得的值不是1的情况,因此,如下述(12)式那样进行 正规化,以使积分值成为1。

[数学式8]

Ped(x)=Ped(x)DPed(x)dx=Kped·Ped(x)=Kped·Existped(x)·Ped(x)...(12)

其中,Kped=1DPed(x)dx=常数。

上述求出的变更后的位置分布仅在碰撞判定时使用,在下一时刻 的移动物的移动时,使用变更前的位置分布。

危险判定部50使用本车的位置分布和其他的移动物的位置分布 计算碰撞概率来作为危险度。碰撞概率是在同一将来时刻存在于同一位 置的概率(同时概率),按照以下方式求出。

同时概率(碰撞概率)能够作为遍及碰撞范围对使本车与其他的 移动物的位置分布相乘而得的值进行积分而得的值求出(通常该积分值 通过数值积分求出)。在本实施例中,作为积分范围使用存在可能度映 射图。

移动物的位置分布移动以及变更的结果是,与上述(12)式同样, 如以下的(13)式所示,使利用存在可能度进行加权后的位置分布正规 化来表示本车的位置分布。

[数学式9]

Ego(x)=Ego(x)DEgo(x)dx=Kego·Ego(x)=Kego·Existego(x)·Ego(x)...(13)

其中,Ego(x)是以与上述(2)式同样的方式表示的本车的位 置分布。并且,Existego(x)是位置x处的本车的存在可能度。

并且,其他的移动物的位置分布由上述(12)式表示,求出的积 分值作为本车与其他的移动物的位置分布的所有的组合的积分值之和 而根据以下的(14)式求出。

[数学式10]

Probcol=DPed(x)·Ego(x)dx

=D{Kped·Existped(x)·Ped(x)}·{Kego·Existego(x)·Ego(x)}dx

=Kped·KegoDExistped(x)·Existego(x)·Ped(x)·Ego(x)dx...(14)

其中,D是积分范围(二维区域),是存在可能度映射图的整个区 域。

并且,危险判定部50判定所计算出的碰撞概率是否在阈值以上。 当存在碰撞概率在阈值以上的移动物的情况下,危险判定部50使警报 装置24显示该移动物的将来预测位置以及警告信息等,唤起驾驶员的 注意。

由位置更新部46、分布变更部48以及危险判定部50进行的一系 列的处理反复执行预先设定的预测时间的量,在各预测步骤中,针对各 移动物,使位置分布移动,并且根据存在可能度进行位置分布的变更。 并且,在各预测步骤中欧诺个,计算本车与各移动物碰撞的碰撞概率, 当碰撞概率在阈值以上的情况下,利用警报装置24表示该预测步骤中 的该移动物的将来预测位置以及危险度信息等。

其次,对第三实施方式所涉及的碰撞危险度判定装置的作用进行 说明。

首先,利用激光雷达12沿水平方向朝本车的前方扫描激光,检测 存在于本车的前方的物体的二维位置,进而,利用计算机22执行上述 图10所示的局部地图生成处理程序。通过反复执行局部地图生成处理 程序,随时推定从当前的本车观察的静止物的位置。

并且,利用计算机22执行图16所示的危险判定处理程序。另外, 对与第一实施方式同样的处理标注相同标号并省略说明。

首先,在步骤120中,计算机22取得由照相机18拍摄到的前方 图像以及由GPS装置20检测到的本车位置。在随后的步骤122中,计 算机22检测包含本车周边的各种道路划分的区域以及道路属性的行驶 环境的状况,并且检测周边的移动物、移动物的动作状态、移动状态、 移动物的种类以及静止物的高度。

进而,在步骤124中,计算机22取得当前的局部地图信息。在随 后的步骤125中,计算机22检测存在静止物的区域。进而,在步骤126 中,计算机22生成存在可能度映射图。

在步骤300中,计算机22基于在上述步骤122中检测到的移动物 的动作状态、移动状态以及运动传感器14的检测结果生成表示包含本 车的移动物的位置分布以及速度分布的移动物数据,并记录在存在可能 度映射图上。

在随后的步骤132中,计算机22将对预测次数进行计数的变量n 设定为初始值1。

进而,在步骤302中,计算机22基于在上述步骤300或者上次步 骤302中得到的位置分布以及速度分布,针对包含本车的各移动物预测 预测次数为n时的移动物的位置分布,并使各移动物的位置分布移动。

在随后的步骤304中,计算机22根据存在可能度映射图的存在可 能度变更通过上述步骤302移动后的各移动物的位置分布。在步骤306 中,计算机22基于在上述步骤304中变更后的其他的移动物的位置分 布和本车的位置分布分别计算与其他移动物碰撞的碰撞概率来作为碰 撞危险度。

进而,在步骤140中,计算机22判定是否存在上述步骤306中计 算出的碰撞概率在阈值以上的移动物。当不存在该移动物的情况下,计 算机22过渡至步骤144。另一方面,当存在该移动物的情况下,在步骤 142中,计算机22使警报装置24显示该移动物的将来预测位置以及警 告信息,并过渡至步骤144。

在步骤144中,计算机22判定表示预测次数的变量n是否达到与 将来预测时间对应的次数N。当变量n尚未达到常数N的情况下,在步 骤146中,计算机22使变量n加一,返回上述步骤302,反复进行上 述步骤302以后的处理。另一方面,当变量n达到常数N的情况下,计 算机22结束危险判定处理程序。

如以上说明了的那样,根据第三实施方式所涉及的碰撞危险度判 定装置,基于移动物的移动状态分布使移动物的位置分布移动,并且, 基于对道路划分的区域以及静止物的区域附加了移动物的存在可能度 的存在可能度映射图变更移动物的位置分布,从而预测移动物的位置分 布。由此,碰撞危险度判定装置能够在各种各样的状况下高精度地预测 移动物的将来的位置。并且,碰撞危险度判定装置能够通过预测与本车 碰撞的程度来推定各种各样的交通状况(由道路环境和移动物状态的组 合构成)下的碰撞危险度。

其次,对第四实施方式所涉及的碰撞危险判定装置进行说明。另 外,第四实施方式所涉及的碰撞危险判定装置的结构形成为与第二实施 方式相同的结构,因此标注相同标号并省略说明。

在第四实施方式中,与第三实施方式的主要不同点在于,在路边 的装置中预测移动物的将来分布,并判定碰撞的危险性。

第四实施方式所涉及的碰撞危险度判定装置210固定设置于路 边,例如主要设置于十字路口。

计算机222的移动物生成部46、位置更新部46以及分布变更部 48与上述的第三实施方式相同。并且,危险判定部250基于各移动物的 位置分布,针对各移动物判定与其他移动物碰撞的危险性,并使通信装 置224发送在搭载有显示装置的车辆中显示判定结果的指令。

其次,第四实施方式所涉及的局部地图信息处理程序与上述的第 二实施方式所涉及的局部地图信息处理程序相同,因此省略说明。

并且,在第四实施方式所涉及的危险判定处理程序中,首先,计 算机222取得由照相机18拍摄到的前方图像以及由GPS装置20检测 到的本装置位置。其次,计算机222基于上述取得的前方图像、本装置 位置以及地图数据库38的电子地图检测包含本装置周边的各种道路划 分的区域以及道路属性的行驶环境的状况,并且检测周边的移动物、移 动物的动作状态、移动物的种类以及静止物的高度。

进而,计算机222取得利用上述的局部地图生成处理程序得到的 当前的局部地图信息。其次,计算机222基于所取得的局部地图信息检 测静止物的区域。计算机222基于上述检测到的各种道路划分的区域、 道路属性以及上述检测到的静止物的区域生成对静止物的区域以及道 路划分的区域附加了存在可能度的存在可能度映射图。

进而,计算机222生成表示上述检测到的各移动物的位置分布以 及速度分布的移动物数据,并记录在上述生成了的存在可能度映射图 上。

其次,计算机222将对预测次数进行计数的变量n设定成初始值 1。进而,计算机222根据所分配的速度分布使各移动物的位置分布移 动。其次,计算机222通过根据存在可能度映射图的存在可能度进行加 权来变更上述移动了的移动物的位置分布。进而,计算机222以各移动 物作为判定对象,基于上述变更了的判定对象的移动物的位置分布和其 他移动物的位置分布分别计算与其他移动物碰撞的碰撞概率来作为碰 撞危险度。

其次,计算机222判定是否存在上述计算出的碰撞概率在阈值以 上的移动物。当存在该移动物的情况下,计算机222利用通信装置224 朝该判定对象的移动物发送使搭载于判定对象的移动物的显示装置显 示该移动物的将来预测位置以及警告信息的指令。

直到表示预测次数的变量n达到与将来预测时间对应的次数N为 止,计算机222反复进行上述的处理,当变量n达到常数N的情况下, 结束危险判定处理程序。

如以上说明了的那样,根据第四实施方式所涉及的碰撞危险判定 装置,能够利用路边的状态针对各种各样的状况而高精度地预测移动物 的将来的位置。并且,碰撞危险判定装置能够通过预测周边的移动体彼 此的碰撞的程度来推定各种各样的交通状况下的碰撞危险度。

其次,对第五十实施方式所涉及的碰撞危险判定装置进行说明。 另外,第五实施方式所涉及的碰撞危险判定装置的结构形成为与第一实 施方式相同的结构,因此标注相同标号并省略说明。

第五实施方式与第一实施方式的不同点在于,基于死角区域的位 置推定配置在死角区域内的移动物粒子的移动物的种类。

在第五实施方式所涉及的碰撞危险判定装置的移动物生成部44 中,如下所示,基于死角区域的位置对从死角区域生成的粒子生成候补 区域的移动物粒子分配汽车、二轮车、行人等表示移动物的种类的标记。

例如,预先通过定点观测记录并积蓄该场所的移动物的出现频率。 在事故多发的十字路口等,如图17所示,利用照相机拍摄等方法、按 照季节/时间段等进行分层,记录自顾自地通过或者横穿车道/人行道的 移动物的种类,并如图18所示针对各位置生成收纳有移动方向、移动 物的种类以及频率的数据库。

移动物生成部44基于针对死角区域的位置生成的数据库确定出 现频率高的移动物的种类,并对在死角区域内生成的粒子生成候补区域 的移动物粒子分配表示所确定的移动物的种类的标记。并且,移动物生 成部44基于根据所确定的移动物的种类预先确定的移动状态分布决定 移动状态,并分配给移动物粒子。

另外,第五实施方式所涉及的碰撞危险判定装置的其他的结构以 及作用均与第一实施方式相同,因此省略说明。

并且,也可以将在上述的实施方式中说明了的在死角区域内假定 的移动物的种类的推定方法应用于上述的第三实施方式。在该情况下, 只要对记录在死角区域内的移动物数据所推定出的移动物的种类、或与 移动物的种类相应的位置分布以及速度分布即可。

其次,对第六实施方式所涉及的碰撞危险判定装置进行说明。另 外,第六实施方式所涉及的碰撞危险判定装置的结构形成为与第一实施 方式相同的结构,因此标注相同标号并省略说明。

在第六实施方式中,与第一实施方式的不同点在于,基于学习模 型根据死角区域的周边信息推定配置在死角区域内的移动物粒子的移 动物的种类。

在第六实施方式所涉及的碰撞危险判定装置的移动物生成部44 中,如下所述,基于学习模型,对从死角区域生成的粒子生成候补区域 的移动物粒子分配汽车、二轮车、行人等表示移动物的种类的标记。

首先,使学习模型学习死角区域的周边信息与应当假定的移动物 的种类之间的映射关系。例如,对专业人员(例如驾驶指导员)提示交 通场面的照片/影像等,或者通过同乘进行访问调查,得到应当假定死 角区域存在何物的回答,时候汇集传感信息求出死角区域的周边信息。 进而,制作如图19所示的由周边信息输入的各种项目(死角生成物、 本车与死角区域之间的位置关系、有无人行横道、有无信号灯、有无临 时停止线、有无超车限制、限速、道路规模、有无十字路口、有无人行 道、有无隔离带、道路线形、本车速度等)和假定输出的项目(假定应 当存在于死角区域的移动物的种类)构成的数据表。

进而,如图20所示,使用神经网络预先学习死角区域的周边信息 的各种项目与假定应当存在于死角区域的移动物的种类之间的映射关 系。另外,也可以使用固定构造的线性回归模型、决定树、贝叶斯网络 等进行学习。

移动物生成部44输入根据环境检测部40的检测结果得到的死角 区域的周边信息,取得从神经网络输出的、假定应当存在于死角区域的 移动物的种类,并对在死角区域内生成的粒子生成候补区域的移动物粒 子分配表示该移动物的种类的标记。并且,移动物生成部44基于根据 所确定的移动物的种类预先确定的移动状态分布决定移动状态,并分配 给移动物粒子。

另外,第六实施方式所涉及的碰撞危险判定装置的其他的结构以 及作用与第一实施方式相同,因此省略说明。

并且,也可以将在上述实施方式中说明了的假定存在于死角区域 内的移动物的种类的推定方法应用于上述的第三实施方式。在该情况 下,只要对记录于死角区域内的移动物数据分配所推定出的移动物的种 类、或是与移动物的种类相应的位置分布以及速度分布即可。

其次,对第七实施方式所涉及的碰撞危险判定装置进行说明。另 外,对形成为与第一实施方式相同的结构的部分标注相同标号并省略说 明。

在第七实施方式中,与第一实施方式的不同点在于,在可能存在 活动物的死角区域内假定假想活动物,并配置移动物粒子。

如图21所示,第七实施方式所涉及的碰撞危险判定装置710的计 算机722具备:物体位置取得部30;本车运动推定部32;局部地图更 新部34;存在概率变更部36、地图数据库38;环境检测部40;映射图 生成部42;确定可能存在移动物的死角区域的死角区域确定部742;假 想活动物生成部743,在所确定的死角区域内生成多个作为表示假想活 动物的数据的移动物粒子,并对各移动物粒子附加与假定的假想活动物 的移动状态分布相应的移动状态,从而以表示假定的假想活动物的位置 的分布的方式在存在可能度映射图上配置移动物粒子;移动物生成部 44;位置更新部46;分布变更部48;以及危险判定部50。另外,假想 活动物生成部743是假想活动物生成部以及假想活动物记录部的一例。

如图22所示,死角区域确定部742基于由环境检测部40检测到 的局部地图信息中的从本车观察的因静止物的存在而形成的死角区域、 和地图数据库确定可能存在活动物的死角区域。并且,如图23所示, 死角区域确定部742在存在可能度映射图中基于该死角区域的死角距离 d(在死角区域为道路的情况下,死角区域表示道路宽度)针对所确定 的死角区域设定行人的存在可能度以及车辆的存在可能度。即当死角距 离d在阈值Dx1以下的情况下,死角区域确定部742将行人的存在可能 度设定为1.0,当死角距离d大于阈值Dx1的情况下,将行人的存在可 能度设定为0.8。由此,死角距离d越小,死角区域确定部742能够将 行人的存在可能度设定得越高。并且,当死角距离d在阈值Dx1以下的 情况下,死角区域确定部742将车辆的存在可能度设定为0.2,当死角 距离d大于阈值Dx1的情况下,将车辆的存在可能度设定为1.0。由此, 死角距离d越大,死角区域确定部742能够将车辆的存在可能度设定得 越高。另外,关于死角区域的死角距离d,可以使用导航系统的道路宽 度信息数据库求出。

假想活动物生成部743在存在可能度映射图中将所确定的可能存 在活动物的死角区域作为粒子生成候补区域。假想活动物生成部743以 使得粒子数量成为预先设定的粒子总数的方式使用随机数发生器对死 角区域的粒子生成候补区域生成并配置多个移动物粒子。另外,移动物 粒子的配置位置是根据后述的假想活动物的位置决定的。

并且,如图24所示,假想活动物生成部743基于上述的死角距离 d,针对从死角区域生成的粒子生成候补区域的移动物粒子决定假想活 动物的种类(例如行人、车辆),并对移动物粒子分配表示所决定的假 想活动物的种类的标记。例如当死角距离d在阈值Dx2以下的情况下, 假想活动物生成部743决定假想活动物的种类为行人,当死角距离大于 阈值Dx2的情况下,假想活动物生成部743决定假想活动物的种类为车 辆。

并且,假想活动物生成部743假设假定存在于死角区域内的假想 活动物会突然出现并与本车碰撞,计算假想活动物的位置、动作状态以 及移动状态,并基于计算出的假想活动物的动作状态以及移动状态,将 假想活动物的移动状态设定成分布。

例如,如图25所示,将假想活动物(例如行人)突然出现的位置 固定为Wp,将突然出现的速度固定为Vp,将本车的当前速度设定为v, 将到假定与本车碰撞的交叉点为止的距离设定为d,则本车到达交叉点 的时间t为t=d/v。并且,以速度vp移动的过程中的假想活动物能够在 时间t的期间到达交叉点的距离dp为dp=vp×t=vp×d/v。

因而,当本车在死角区域周边行驶时,假想活动物生成部743在 各运算时刻始终基于死角区域的位置(dp、Wp)配置假想活动物的移 动物粒子,并且基于速度Vp设定假想活动物的移动物粒子的移动状态 的分布。

总之,始终假定与本车在交叉点碰撞的移动物会突然出现的最坏 的情况来设定假想活动物的位置以及移动装填。

但是,在假想活动物的假定位置(dp、Wp)来到相比死角区域 靠近的位置的时刻,停止假定假想活动物,假想活动物生成部743使该 假想活动物的移动物粒子消失。

并且,对移动物粒子分配用于识别假想活动物的识别信息。例如, 相对于针对一个假想活动物生成的粒子生成候补区域,生成分配了相同 的识别信息的移动物粒子。

其次,使用图26对第七实施方式所涉及的危险判定处理程序进行 说明。另外,对与第十实施方式为相同处理的部分标注相同标号并省略 详细说明。

首先,在步骤120中,计算机722取得由照相机18拍摄到的前方 图像以及由GPS装置20检测到的本车位置。在随后的步骤122中,计 算机722检测包含本车周边的各种道路划分的区域以及道路属性的行驶 环境的状况,并且检测周边的移动物、移动物的动作状态、移动状态、 移动物的种类以及静止物的高度。

进而,在步骤124中,计算机722取得通过上述的局部地图生成 处理程序得到的当前的局部地图信息。在随后的步骤125中,计算机722 根据在上述步骤124中取得的局部地图信息检测存在静止物的区域。进 而,在步骤126中,计算机722生成存在可能度映射图。

在随后的步骤760中,计算机722确定可能存在活动物的死角区 域,并且设定存在可能度映射图上的该死角区域的存在可能度。进而, 在步骤762中,计算机722将存在可能度映射图上的该死角区域设定成 移动物粒子生成候补区域。并且,计算机722基于在上述步骤760中确 定的死角区域的死角距离决定假想活动物的种类,并且计算假想活动物 的位置以及移动状态。计算机722以使得粒子数量为预先设定的粒子总 数的方式生成假想活动物的移动物粒子,并根据计算出的假想活动物的 位置在移动物粒子生成候补区域配置移动物粒子。并且,计算机722针 对假想活动物基于所计算出的移动状态求出移动状态分布,并基于所求 出的移动状态分布分别决定各移动物粒子的移动状态,并对各移动物粒 子分配移动状态。

在步骤130中,计算机722在存在可能度映射图中设定相对于移 动物以及本车的移动物粒子生成候补区域,生成包含本车的移动物的移 动物粒子,并配置在对应的移动物粒子生成候补区域。并且,计算机722 针对各移动物求出移动状态分布,并基于所求出的移动状态分布对各移 动物粒子分配移动状态。

在随后的步骤132中,计算机722将对预测次数进行计数的变量 n设定成初始值1。

进而,在步骤134中,计算机722使包含相对于假想活动物的移 动物粒子的各移动物粒子根据分配的移动状态移动。在随后的步骤136 中,计算机722根据存在可能度映射图的存在可能度进行通过上述步骤 134移动了的移动物粒子的消失以及复制,变更移动物粒子的配置。在 步骤138中,计算机722基于在上述步骤136中变更了的其他移动物的 移动物粒子与本车的移动物粒子之间的重复频率分别计算与其他的移 动物碰撞的碰撞概率来作为碰撞危险度。

进而,在步骤140中,计算机722判定是否存在上述步骤138中 计算出的碰撞概率在阈值以上的移动物。当不存在该移动物的情况下, 计算机722过渡至步骤144。另一方面,当存在该移动物的情况下,在 步骤142中,计算机722使警报装置24显示该移动物的将来预测位置 以及警告信息,并过渡至步骤144。

在步骤144中,计算机722判定表示预测次数的变量n是否达到 与将来预测时间对应的次数N。当变量n尚未达到常数N的情况下,在 步骤146中使变量n加以,并返回上述步骤134,反复进行上述步骤134 以后的处理。另一方面,当变量n达到了常数N的情况下,结束危险判 定处理程序。

另外,第七实施方式所涉及的碰撞危险判定装置710的其他结构 以及作用与第一实施方式相同,因此省略说明。

如以上说明了的那样,根据第七实施方式所涉及的碰撞危险判定 装置,针对假定存在于死角区域内的假想活动物,基于假定的移动状态 分布使位置分布移动,并且基于对道路划分的区域、静止物的区域以及 死角区域附加了移动物的存在可能度的存在可能度映射图变更位置分 布。由此,碰撞危险判定装置能够在各种各样的状况下高精度地预测假 想活动物的将来的位置。

并且,碰撞危险判定装置通过将相对于假想活动物的移动物粒子 配置在死角区域,能够判定通过实际上并不明显的死角时的碰撞危险。

另外,在上述的实施方式中,在使突然出现速度固定的情况下, 按照以在交叉点与本车碰撞的方式计算假想活动物的位置的情况为例 进行了说明,但并不限定于此。例如,如图27所示,也可以在各运算 时刻相对于死角区域始终假定从最接近交叉点的位置突然出现来计算 假想活动物的位置。例如,当将死角区域与交叉点之间的距离设定为 dp、将突然出现的位置设定为Wp时,计算位置(dp、Wp)来作为假 想活动物的位置。

并且,也可以将在上述的实施方式中说明了的生成、预测假定存 在于死角区域内的假想活动物的方法应用于上述的第二实施方式。在该 情况下,只要确定从路边的装置观察因静止物的存在而形成的死角区 域、即可能存在活动物的死角区域,并生成假定存在于所确定的死角区 域内的假想活动物即可。

并且,也可以将在上述的实施方式中说明了的生成、预测假定存 在于死角区域内的假想活动物的方法应用于上述的第三实施方式。在该 情况下,假想活动物生成部743在存在可能度映射图上在所确定的可能 存在活动物的死角区域内记录假想活动物数据。并且,利用假想活动物 生成部743计算所假定的假想活动物的位置以及移动状态,用本车中心 x-y坐标空间上的二维正规分布表现假想活动物的位置,生成表示假想 活动物的位置分布的假想活动物数据,并记录在存在可能度映射图上。 另外,作为位置的平均向量使用所假定的假想活动物的位置,位置的协 方差行列基于预先求出的假想活动物的大小设定。并且,假想活动物生 成部743基于所假定的假想活动物的移动状态使用本车中心x-y坐标 空间上的二维正规分布表现移动物的速度,并分配给记录在存在可能度 映射图上的假想活动物数据。另外,作为速度的平均向量,使用所计算 出的假想活动物的速度。并且,利用与行人的平均速度相应的如上述图 8所示的方差/协方差的数据表设定速度的协方差行列。

并且,在上述第一实施方式~第八实施方式中,以基于所检测到 的移动物的动作状态或者移动状态求出移动状态分布的情况为例进行 了说明,但是并不限定于此。也可以检测并使用移动物的移动状态分布。 并且,也可以使用针对移动物的每个种类而预先由设计者确定的移动状 态分布。并且,也可以使用观测行人而得的结果(方向、行走方式等动 作状态)设定移动状态的方差、方向,并且使用针对移动物的每个种类 预先确定的平均速度求出移动状态分布。

并且,以存在可能度表示移动物的存在容易度的情况为例进行了 说明,但是,也可以使用表示移动物的存在困难度的存在可能度生成存 在可能度映射图。

并且,以使用运动传感器的检测结果推定本车的运动的情况为例 进行了说明,但是并不限定于此,也可以利用激光雷达的检测结果的时 间差分推定本车的运动。并且,例如也可以使用GPS装置的对本车位 置的检测结果推定本车的运动。并且,也可以组合激光雷达、运动传感 器以及GPS装置的检测结果推定本车的运动。

并且,以利用激光雷达朝前方扫描激光从而检测物体的位置的情 况为例进行了说明,但是并不限定于此,也可以朝前方扫描毫米波等电 磁波从而检测物体的位置。

并且,以利用激光雷达检测本车前方的物体的位置的情况为例进 行了说明,但是并不限定于此,例如也可以从由摄像机拍摄的前方图像 检测本车前方的物体的位置。

并且,也可以借助使用照相机的摄像技术确定从本车观察的死角 区域。

能够将本发明的程序模块收纳于记录介质来提供。

本发明所涉及的计算机可读介质存储有用于使计算机作为移动物检 测部、区域检测部、映射图生成部、移动物记录部以及预测部发挥功能, 其中,上述移动物检测部从检测对象范围检测移动物的位置以及动作状态 或者移动状态;上述区域检测部从上述检测对象范围检测多个种类的道路 划分的区域以及静止物的区域;上述映射图生成部生成对由上述区域检测 部检测到的上述道路划分的区域以及上述静止物的区域附加了表示移动 物的存在容易度或者存在困难度的存在可能度的存在可能度映射图;上述 移动物记录部基于由上述移动物检测部检测到的上述移动物的位置以 及动作状态或者移动状态生成上述移动物的位置分布以及移动状态分 布,并记录于上述存在可能度映射图;上述预测部基于上述移动物的移 动状态分布使上述移动物的位置分布移动,并且基于上述存在可能度映 射图的存在可能度变更上述移动的位置分布,从而预测上述存在可能度 映射图上的上述移动物的将来的位置分布。

并且,本发明所涉及的计算机可读介质存储有用于使计算机作为区 域检测部、映射图生成部、死角区域确定部、假想活动物生成部、假想活 动物记录部以及预测部发挥功能,其中,上述区域检测部从检测对象范围 检测多个种类的道路划分的区域以及静止物的区域;上述映射图生成部生 成对由上述区域检测部检测到的上述道路划分的区域以及上述静止物的 区域附加了表示移动物的存在容易度或者存在困难度的存在可能度的存 在可能度映射图;上述死角区域确定部从上述检测对象范围确定可能存在 活动物的死角区域;上述假想活动物生成部生成假定存在于由上述死角区 域确定部确定的死角区域内的假想活动物;上述假想活动物记录部针对 由上述假想活动物生成部生成的上述假想活动物,假定上述假想活动物 的位置以及动作状态或者移动状态,生成上述假想活动物的位置分布以 及移动状态分布,并记录于上述存在可能度映射图;上述预测部基于上 述假想活动物的移动状态分布使上述假想活动物的位置分布移动,并且 基于上述存在可能度映射图的存在可能度变更上述移动了的位置分布, 从而预测上述存在可能度映射图上的上述假想活动物的将来的位置分 布。

通过参考,将日本出愿2010-201214的公开的整体取入本说明 书。

对于本说明书中记载的所有的文献、特许出愿、以及技术标准, 以与通过参考而包括各个文献、特许出愿、以及技术标准的具体地且分 别记载的情况相同的程度,在本说明书中也通过参考而包含上述内容。

标号说明:

10、210、710:碰撞危险判定装置;12:激光雷达;14:运动传 感器;18:照相机;20:GPS装置;22、222、722:计算机;32:本车 运动推定部;34:局部地图更新部;36、236:存在概率变更部;38: 地图数据库;40:环境检测部;42:映射图生成部;44:移动物生成部; 46:位置更新部;46:移动物生成部;48:分布变更部;50、250:危 险判定部;742:死角区域确定部;743:假想活动物生成部。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号