专利名称：行驶支持用设备的制作方法
技术领域：
本公开主要涉及一种行驶支持设备，所述行驶支#^殳备设定运动体的 行驶中心并基于所述行驶中心的设定来为所iiit动体提供行驶支持.
背景技术：
基于道路的几何形状信息设定行驶位点以及执行对行驶于该ili洛上的
运动体的行驶控制的方法公开于例如日本专利文献JP-A-H07-248819中。 在以上文献中的行驶位点控制方法是关于基于以几何方式设定的位点的 方向盘的转向角以及相对于所述以几何方式设定的位点的交通工具的方 向。
但是，当基于几何形状信息设定驾驶员所驾驶的交通工具的行驶位点 时，该行^位点不一定与为交通工具的驾驶员提，适的预测行驶位点相 符。即，换言之，当驾驶员执行对交通工具的行驶控制时，根据道路几何 形状的行驶位点可能导致他/她的不适。
更具体地，如果驾驶员正在驾驶交通工具并由他/她自己转向，则当交 通工具行驶在弯曲ili^上时，交通工具被转向成朝向所述弯曲iii咯的"出 口"行驶。另一方面，当交通工具行驶于根据道路的几何形状信息设定的 行驶位点上时，交通工具未被充分转向成朝向所述弯曲道路的"出口"， 从而给驾驶员以交通工具将离开该道路的印象，这导致驾驶员的不适和/ 或不安全感。
发明内容
鉴于以上及其它问题，本发明提供了一种在不引起驾驶员的不适的情 况下能适当支持交通工具的驾驶员的行驶支#^殳备。
在本公开的一方面中，所述行驶支#^殳备包括凝视点设定单元，用 于设定运动体的驾驶员的凝视点；以及轨迹设定单元，用于基于由所述凝 视点设定单元所设定的凝视点来设定所述运动体的轨迹。通常，当运动体行驶于弯曲道路时，运动体的驾驶员在他/她注视着转
弯的所谓"出口"时，即，所述道路的弯曲部分的终点时，执行转向^Mt。 在本公开中，设定由驾驶员凝视的凝视点，并基于该凝视点来设定行驶位 点。因此，所设定的行驶位点与由他/她自己的转向操作所产生的行驶位点 相符，进而不会导致不适和/或不安全感。
此外，根据本公开的另一方面，所述行驶支持设备包括位置获取单 元，用于获取存在于运动体附近的对象的位置作为环境信息；运动获取单 元，用于获取所itit动体的运动作为运动信息；观测运动计算单元，用于 基于模拟所述运动体的驾驶员的视网膜的视网膜球模型连同所述环境信 息和运动信息来计算表示投影在视网膜上的对象的运动信息的观测运动； 以及轨迹设定单元，用于基于所述观测运动来设定所述运动体的轨迹。
通过具有以上元件，本公开的技术计算表示投影在驾驶员的视网膜球 模型上的对象的运动信息的观测运动。即，将观测运动限定为对象的运动 至由交通工具的驾驶员识别的运动量的转化。由此，通迚基于观测运动来 设定交通工具的行驶位点，由于行驶位点与来自驾驶员自己的转向^Mt的 行驶位点相符，因而防止了交通工具的行驶位点引起他的/她的不适和/或 不安全感.
从以下参照附图所进行的详细描述，本公开的目的、特征及优点将变 得更加明显，在所述附图中
图l是本发明的一实施方式中的行驶支持设备的结构的框图2是it^上的网格点的图示；
图3是视网膜^^型的图示；
图4是由计算单元计算的且由用于每个网格点的线段所表示的偏心角 变化的图示；
图5是在每个网格点线上的最小变化点以及凝视点的图示； 图6是转换至直角坐标的运动体的轨迹的图示； 图7A和7B是目标轨迹与当前轨迹之间的差异的图示；以及 图8是与凝视点和轨^目关的盲点的图示。
具体实施例方式
参照附图来描述本公开的实施方式。图l是; M^开的一实施方式中的 行驶支^i殳备l的结构的框图。行驶支持设备l为四轮交通工具(即，运 动对象)的行驶提供支持，并且包括环境信息获取单元(即，在权利要 求语言中的位置获取单元)10，用于获M在于运动体附近的对象的位置 作为环境信息；交通工具行为获取单元(即，运动获取单元)20，用于获 取运动体的运动作为运动信息；观测运动计算单元30,用于基于模拟运动 体的驾驶员的视网膜的视网膜,型连同环境信息和运动信息，计算表示 投影在视网膜上的对象的运动信息的观测运动；凝视点设定单元40，用于 设定运动体的驾驶员的凝视点；轨迹设定单元50，用于基于由凝视点设定 单元40所设定的凝视点来设定运动体的轨迹；以及轨迹控制单元60,用 于执行运动体的轨迹控制。这些元件中的每一个都由安装在所述交通工具 上的计算机来实现。
环境信息获^^单元10获取以下信息作为环境信息(a)存在于交通工 具周围的对象的位置以及(b)所iW象与所述交通工具的距离。交通工 具周围的对象包括当交通工具正在行驶时由该交通工具的驾驶员所观测 到的对象。在本实施方式中，交通工具周围的对象包括设定在该交通工具 所行驶的道路上的网格点。因此，获取单元10获取网格点的位置和距离。 此外，诸如il^上的障碍之类的对象可以包括在交通工具周围的对象中。
行驶道路上的网格点是交通工具轨迹的候选点，即，交通工具的预期 行驶位点。如图2所示，采用以均匀间隔正交地穿过道路的中心线的方式 在行驶ii^上沿着网格线L设置网格点。此外，如图2所示，网格线L本 身以均匀间隔画在该if^上。
网格点的位置和距离是通过例如用能够连续拍摄交通工具的前方图像 的前部摄像K 11拍摄交通工具前方的道路的图像来获取的，基于对交通工 具的前方图像的分析，能够获取位置和距离。此外，可以使用毫米波雷达 等来代替前部摄^*11。而且，网格点相对于交通工具的位置可以从存储 道路地图数据的地图数据库12获取。在这种情况下，可以首先确定交通工 具的当前位置。为了确定交通工具的当前位置，可以使用利用地图lt据库 12和GPS (全球定位系统)单元24的地图匹配方法。还可以基于道路地 图信息、交通工具的前方图像以及来自雷达等的信息的组合来确定交通工具的当前位置。
交通工具行为获取单元20获取关于交通工具运动的信息.交通工具运 动信息包括分别基于来自a传感器21和横摆率传感器22的信号所计 算和获取的速度V、横摆率Y等。速度V和横摆率Y两者或者这两个值中 的至少一个可以基于由GPS单元24检测到的当前交通工具的位置的改变 来获取。
此夕卜，交通工具行为获取单元20例如依据驾驶员头部的摆动来连续计 算驾驶员的头部角度的变化率0.即，通过使用交通工具中的驾驶员摄像 机23，连续拍摄驾驶员的面部图像，并基于对面部图像的分析来连续计算 驾驶员的头部角度。通过进一步分析驾驶员的头部角度，能够计算该头部 角度的变化率0。
观测运动计算装置30计算位置和距离由环境信息获取单元10计算的 对象(以下表示为观测运动)的运动量。更具体地，计算正被投影在视网 膜^型上的对象的观测运动。图3是近似驾驶员的视网膜的视网膜^ 型的图示。在视网膜球上，通过使用视网膜坐标系来表示对象的投影位置。
对象A在视网膜^^型上的图像"a"的位置能够通过使用将以方位
角e和俯仰角(j)为参数的函数(e， d))来表示。然后，观测运动计算装
置30计算偏心角o的绝对变化率。偏心角to的变化率的绝对值由下面的 等式1表示。在等式1中，使用了交通工具的速度V、对象A的距离R、 以及横摆率Y、驾驶员头部角度的变化率0。
(等式l)
<formula>formula see original document page 8</formula>
观测运动计算装置30由此通过使用等式1连续计算每个网格点的偏心 角的变化率。在这种情况下，尽管环境信息获取单元10获M"象在直角坐 标系(x， y， z)中的位置，但是通过^吏用下面的等式3和等式4，能够将 在直角坐标系中的位置转化成视网膜坐标系(0， 4>)。即，能够通过等式 3和等式4计算0和(|)的值。
偏心角的变化率0是通过使用视网膜^型来计算的。因此，驾驶员 的视觉感受是视网膜球模型来反映。即，换言之，观测运动计算单元30将ii^上的网格点的运动(例如，平移运动和转动)转换成驾驶员的视觉 感受中的运动。
以上描述中的等式1是以如下方式推导的。通过^f吏用如等式2中所示
的方位角e和俯仰角小来表示偏心角o。此外，如果直角坐标系定向成以
其Y轴对准交通工具的行驶方向，而且使其原点具有与如图3所示的视网
膜坐标系相同的位置，视网膜坐标系中的角度e、角度d)连同偏心角co与
所述直角坐标系中的坐标x、 y、 z之间的关系由以下的等式3至等式7来 表示。
(等式2)
w = cos一1 (COS # COS 0
(等式3)
广
9 = tan一1 (等式4)
、l
^ = tan—1
2
、P
(等式5)
(等式6)
(等式7)
z二^c2十j;2 - tan-
此外，当采用等式8所示的公式来对等式2求微分时，推导出等式9, (等式8)
lcos ' JC,=-
(等式9)<formula>formula see original document page 10</formula>
当考虑到交通工具的速度V、横摆率Y、驾驶员头部角度的变化率0 时，基于等式3和等式4计算出e和d)的微分值作为等式10和等式11。
(等式10)<formula>formula see original document page 10</formula>
(等式u)
<formula>formula see original document page 10</formula>
当将等式10和等式11代入等式9中时，推导出等式l。
凝视点设定单元40基于由观测运动计算单元30计算的每个网格点的 偏心角的变化率来连续地i殳定驾驶员的凝视点。更具体地，通it^所有的 偏心角的绝对变化率中找出最小值，将具有绝对变化率的最小值的网格点 设定作为凝视点。
如上所述，偏心角变化率表示视觉感受中的运动量。此外，基于心理学理论和其它发现以及经验知识，驾驶员公知为凝视在他的/她的视野中最
小移动点，此外，假设驾驶员在他/她驾驶交通工具时凝视iii^上的某处。 因此，观测运动，即，视觉感受中的运动量在驾驶员的视野中的他/她正在 "凝视"一一即他的/她的凝视停留的道路上的特定点处被并且应当被最小 化。即，使用具有偏心角的最小绝对变化率的点作为凝视点是合理的假设。
图4是网格点的偏心角变化率的图示，每个网格点都由具有比例长度
的线段来表示。如图所示，在下部(即，相对于交通工具的近侧)中的网 格点具有较大的变化率，在上部(即，相对于交通工具的远侧)中的网格 点具有较小的变化率。凝视点设定在右上位置的点一一转弯处或弯曲M 的所谓"出口"处。
轨迹设定单元50确定每条网格线中的具有绝对值最小的偏心角变化 率的网格点。然后，通过连接最小变化率网格点与由凝视点设定单元40 i更定的凝视点，画出交通工具的预期行驶位点，即，交通工具的"轨迹"。 在图5中，具有最小变化率的网格点在图示中由白色方框口图形表示，而 凝视点在图示中由黑色圆形 图形表示。通过连接这些图形能够画出交通 工具的行驶位点。
在这种情况下，偏心角的变化率最初在视网膜坐标系中计算，为了在 图示中绘图的目的，通过^f吏用等式5至等式7将该变化率转换至直角坐标 系。图6示出了在转换至直角坐标系中之后的轨迹。
在对正由轨迹设定单元50设定的目标轨迹进行限定时，轨迹控制单元 60基于交通工具的当前行驶^Hf来设定当前轨迹，然后，基于当前轨迹与 目标轨迹之间的对比，控制单元60控制交通工具的轨迹使得当前轨迹接近 目标轨迹。
当前轨迹A^于方向盘的当前转向角以及横摆率等，即，U于表示 交通工具的当前转向条件的^Hf来设定的，假设所述当前转向条件暂时保 持原样。可替代地，当前轨迹可以设定为在先轨迹的延伸。通过改变交通 工具的转向特性来执行轨迹控制。可以通过辅助方向盘的转向操作来执行 轨迹控制。
通过改变交通工具的前后负荷平衡能够改变转向特性。为了改善的转 向特性可以向前转变负荷平衡。因此，如图7A所示，通过朝向交通工具 的前部转变负荷可以调节大于目标轨迹的当前轨迹的曲率半径。另一方面，如果向后转变负荷平衡，则交通工具的稳定性得以改善。即，如图7B 所示，通过朝向交通工具的后部转变负荷可以调节小于目标轨迹的当前轨 迹的曲率半径。此夕卜，可以通过本领域中其它^^p的方法来转变负荷平衡。 即，例如，可以通过控制驱动力和制动力、或者通过管理稳定性因素等来 转变负荷平衡。
此外，当辅助转向操作时，在为了实现目标轨迹并将预测的交通工具 行为与目标轨迹上的交通工具的行为相匹配而谨慎地控制横摆率和转向 辅助扭矩的情况下，基于当前轨迹来预测交通工具的行为。
如上所详细表述，在本实施方式中，对象的观测运动被计算作为投影 在视网膜,型上的观测对象的偏心角的变化率。因此，通过由凝视点设 定单元设定的凝视点来准确地逼近道路上的实际被凝视的点。实现所述逼 近的准确性的原因在于对象的观测运动被转换成根据驾驶员的身体结构 在以物理方式模拟的视觉感受中的测量的量。
然后，根据以上述方式计算的凝视点来设定交通工具的行驶位点、或 轨迹。因此，由行驶支持设备实现的轨迹充分靠近由驾驶员的自转向实现 的轨迹。因而，防止交通工具的驾驶员在通过使用以上述方式设定的目标 轨迹来执行轨迹控制时具有不适或不安全感，
尽管已参照附图结合本公开的优选实施方式对本公开进行了充分描 述，但是应当注意，对本领域技术人员而言，各种变化和修改将变得明显。
，如，凝视点在以上实施方式中是基于偏心角的变化率来计算的。但
置的对面部图像的分析来计算凝视点。
此外，对象的运动表示为矢量，即，所述运动被计算作为光流，而驾 驶员的凝视点可以设定于最小光流点处.在这种情况下，就如同在以上实 施方式中的情况一样，可以Mil^上的点计算所述光流。
而且，以下方案可用于凝视点的预先计算。即，导航系统通常在引导 路径的计算期间预测交通工具的逸变V。因此，将预测的交通工具的i^JL V与存储在导航系统中的ii^形状和由此得到的横摆率一起用于等式1中 的偏心角的变化率的计算。在这种情况下，驾驶员的头部角度的变化率 可以是基于如下假设以可预测方式计算的驾驶员的头部角度与交通工具 的行驶方向一致，或者，驾驶员的头部角度指向引导路径上的前方点。同样，可以可预测方式来计算每个网格点的偏心角的变化率，并且所预测的 变化率可用于计算交通工具的轨迹。此外，可以在交通工具行驶期间计算 交通工具的轨迹时计算驾驶员的头部角度以及头部角度的变化率0。而且， 可基于得自外部信息提供者的信息来计算凝视点以及交通工具的偏心角 的变化率。
此外，当计算凝视点和轨迹时可以考虑驾驶员的视网膜中的盲点。即，
例如，如果驾驶员具有如图8所示能够映射在他的/她的视野中的盲点，则 在该驾驶员的视野中除盲点之外的区域中寻找绝对值最小的偏心角的变 化率。在图8中的图示中，在该驾驶员的盲点的映射的外部的除盲点之外 的区域中发现了新的凝视点。另外，在每条网格线中，通it^寻找区域排 除对应于驾驶员的盲点的区域，寻找具有最小的偏心角变化率的网格点。 盲点的排除可以基于由驾驶员自己输入的盲点的位置。
此外，在以上实施方式中，基于目标轨迹与当前轨迹之间的对比来执 行轨迹控制，但是，可以基于所述轨迹的对比来执行意识判定。例如，可 以通过当目标轨迹与当前轨迹之间的差异大时判定意识程度低来执行所 述意识判定。另外，如果意识程度低，则可以向交通工具的驾驶员发出警 告。
此外，可以在诸如平视显示器等显示单元上简单地显示目标轨迹，而 不执行轨迹控制以及对意识进行判定.
此外，代替如以上实施方式对网格线上的所有网格点计算偏心角变化 率，可以在不计算网格线上的轨迹候选点的情况下基于交通工具的位置和 凝视点来设定轨迹。即，例如^Ut过确定交通工具的位置和凝视点，能够
基于根据iti洛的曲率(例如，根据iii洛的中心线的曲率)的曲率半径画出 交通工具的轨迹，而不计算网格线上的每个网格点的偏心角的变化率。相 反，可以在不设定凝视点的情况下仅通过计算网格点的偏心角的变化率来 确定交通工具的轨迹。即，M过基于偏心角变化率来设定网格线上的"轨 迹点"，能够设定交通工具的轨迹。
而且，在以上实施方式中，4吏用汽车作为本公开的执行对象的示例。 但是，诸如飞行器、摩托车、轮椅等其它类型的交通工具也可以考虑为本 公开的执行对象。
这种变化、修改、以及概括方案应当理解为属于由所附权利要求限定的冲">开的范围内。
权利要求
1.一种行驶支持设备(1)，包括凝视点设定单元(40)，用于设定运动体的驾驶员的凝视点；以及轨迹设定单元(50)，用于基于由所述凝视点设定单元(40)所设定的凝视点来设定所述运动体的轨迹。
2. —种行驶支拷设备(l)，包括位置获取单元(IO)，用于获取存在于运动体附近的对象的位置作为环 境信息；运动获取单元(20)，用于获取所述运动体的运动作为运动信息；观测运动计算单元(30 )，用于基于模拟所述运动体的驾驶员的视网膜 的视网膜球模型连同所述环境信息和运动信息来计算表示投影在所述视 网膜上的对象的运动信息的观测运动；以及轨迹设定单元(50),用于基于所述观测运动来设定所it^动体的轨迹。
3. 如权利要求1所述的行驶支#^殳备(1),其中，分别包括权利要求2中的所述位置获取单元(10)和所述运动获取单 元(20 )，并且所述凝视点设定单元(40)基于由所述位置信息单元获取的环境信息 以及由所述运动获取单元(20)获取的所述运动体的运动信息来设定所述 驾驶员的凝视点。
4. 如权利要求3所述的行驶支^i更备(1)，其中，包括权利要求2中的所述观测运动计算单元(30)，并且所述凝视点设定单元(40)基于由所述观测运动计算单元(30)计算 出的观测运动来设定所述驾驶员的凝视点。
5. 如权利要求4所述的行驶支持设备(1 )，其中， 所i^动体行驶在道路上，所述观测运动计算单元(30)计算所述运动体所行驶的道路上的多个 点的观测运动，并且所述凝视点设定单元(40)将来自所述道路上的所述多个点中的使所 i^见测运动最小化的最小运动点设定为所述凝视点.
6. 如权利要求1所述的行驶支持设备(1),其中，包括用于拍摄所述运动体的驾驶员的驾驶员摄膝^ (23 )，以拍:摄至少 包括所述驾驶员的眼睛的图像的所述驾驶员的驾驶员图像，而且所述凝视点设定单元(40)通过分析由所述驾驶员摄H^ (23)拍摄 的驾驶员图像来设定所述凝视点。
7. 如权利要求1所述的行驶支持设备(1 )，其中，在所述运动体上设置用于拍摄在所述运动体的行驶方向上的前方图 4象的前部摄^^L (11)，并且所述凝视点设定单元(40)基于由所述前部摄^bu (11)拍摄的前方 图像中的光流来设定所述凝视点.
8. 如权利要求5所述的行驶支持设备(1),其中，通过以预设间隔在所行驶ifi咯上正交地穿过来绘制网格线，所述观测 运动计算单元(30)计算多个网格点中的每一个网格点的观测运动，所述 网格线由分别用作轨迹候选点的所述多个网格点形成，并且所述轨迹设定单元(50)连接所述凝视点与每条所述网格线上的确定 为具有最小观测运动的最小运动网格点，以设定所述运动体的轨迹。
9. 如权利要求1至8中任一项所述的行驶支持设备(1 )，进一步包括 轨迹控制单元(60 )，用于通过对由所述轨迹设定单元(50 )设定的所i^动体的目标轨迹与基于所述运动体的当前条件计算出的当前轨迹进行比 较来执行对所述运动体的轨迹控制。
10. 如权利要求9所述的行驶支#^殳备(1 )，其中， 所述运动体具有前轮和后轮，而且所述轨迹控制单元转变所述前轮和所述后轮之间的负荷平衡来执行 对所i^动体的轨迹控制。
11. 如权利要求9所述的行驶支^i殳备(1 )，其中， 所述轨迹控制单元改变转向辅助扭矩来执行所述轨迹控制。
12. 如权利要求1至8中任一项所述的行驶支持设备(1),进一步包 括意识判定单元以便通过对由所述轨迹设定单元(50)设定的所i^动体 的目标轨迹与基于所述运动体的当前条件计算出的当前轨迹进行比较来 执行对所述运动体的驾驶员的意识判定。
13. 如权利要求2、 4、 5、 8中任一项所述的行驶支持设备(1)，其中，所i^J见测运动计算单元(30)计算所述运动体的驾驶员的视网膜中除 盲点之外的区域中的观测运动。
全文摘要
一种行驶支持设备(1)，其基于交通工具的驾驶员的凝视点来设定交通工具的行驶位点。通过利用凝视点，以计算出的行驶位点逼近由驾驶员的转向操作产生的行驶位点的匹配方式，计算行驶位点并将其设定用于交通工具的行驶控制，尤其是用于道路的弯曲部分。因为交通工具的驾驶员在他/她在道路上将交通工具转向时通常凝视于该道路的弯曲部分的出口处，以上位点计算方案产生自然的行驶位点。由所述行驶支持设备(1)计算并设定的自然的行驶位点防止驾驶员在由所述设备(1)控制交通工具的行驶时具有不适和/或不安全感。
文档编号B60W10/20GK101644932SQ20091016188
公开日2010年2月10日 申请日期2009年8月5日 优先权日2008年8月6日
发明者伊能宽, 沢田护 申请人:株式会社电装