专利名称：自动移动体及其控制方法
技术领域：
本发明涉及在例如存在被预计会突然出现的危险区域的环境中自动地移动的自动移动体及其控制方法。
背景技术：
开发了在环境中自动地移动的机器人。在机器人移动的环境中存在例如交叉路口等被预计会突然出现人或者移动障碍物的危险区域。当机器人进入这样的危险区域时，通过安装在机器人自身的外界传感器检测人或移动障碍物，并在检测出后开始减速以避免碰撞，但有可能来不及进行避免碰撞动作而与突然出现的人或者移动障碍物发生碰撞。因此，自动移动机器人被要求在预计会突然出现的危险区域进行避免碰撞的安全的移动控制。在专利文献I中，公开了在窄小的通道上移动时防止因其周围的墙壁而减速的技 术。在专利文献I中，基于预先设置在接近交叉路口的部分的基础设施信息，使用于判断减速的必要性的传感器监视范围动态地变化。另外，作为与本发明相关的其他技术，具有被专利文献2至5公开的技术。例如在专利文献2中公开了按照预定的预测时间检测障碍物的危险度、并在根据该危险度来避开危险的同时向目的地行进的障碍物避开装置。另外，在专利文献3中公开了以如下方式控制行驶的无人自动行驶体的防止碰撞运转方法判定其他的无人自动行驶体的位置数据是否被包含在区域中，当位置数据被包含在停止区域中时使无人自动行驶体停止，当位置数据被包含在减速区域中时使无人自动行驶体减速。在先技术文献专利文献专利文献I :日本专利文献特开2009-042845号公报；专利文献2 日本专利文献特开平06-138941号公报；专利文献3 日本专利文献特开平05-127747号公报；专利文献4 :日本专利文献特开2002-287824号公报；专利文献5 :日本专利文献特开平06-265637号公报。
发明内容
发明所要解决的问题但是，在被专利文献I等公开的现有技术中，为了检测出交叉路口等的危险区域而将标识器等基础设施预先设置在环境中，并使用该基础设施信息进行危险区域的识别。即，并不是通过自动移动机器人自身的功能检测出被预计会突然出现的危险区域，而是需要预先在环境中设置标识器等基础设施。因此，在实际使用时，存在在基础设施设置上需要很大的成本的问题。本发明的目的在于提供以下的自动移动体及其控制方法即使在被预计会突然出现人或移动障碍物等的危险区域也不需要设置基础设施等，而能够稳定地进行避免碰撞动作。用于解决问题的手段本发明提供一种自动移动体，所述自动移动体在环境中自动地从移动起点向移动终点移动，其特征在于，包括测距传感器，所述测距传感器测定到存在于所述环境中的物体的距离；距离信息获取部，所述距离信息获取部获取所述测距传感器的距离测定值作为测定点的距离信息；以及危险区域提取部，所述危险区域提取部将彼此接近的测定点根据所述测定点间的距离差而辨别为同一物体，当所述辨别出的物体自身具有预定的阈值以上的大小且物体的端点间所形成的开口部具有预定的阈值以上的宽度时，所述危险区域提取部提取所述物体的端点作为危险区域，所述自动移动体以避免在所述提取出的危险区域碰撞的方式移动。由此，使用测距传感器的测定值预测突然出现危险区域，当进入危险区域时，进行避免碰撞动作，即降低速度、或者生成避开危险区域的路径而移动等，从而即使在突然出现危险区域，也不需要设置标识器等，能够稳定地避免与移动障碍物的碰撞。
另外，也可以采用以下方式所述危险区域提取部判定彼此接近的测定点间的距离差是否为根据距所述自动移动体的距离而变大的阈值以上，当所述距离差比所述阈值小时，将所述彼此接近的测定点辨别为同一物体。由此，能够更好地进行物体的辨别，因此能够抑制不需要的避开动作的发生，能够更稳定地进行移动。并且，也可以采用以下方式所述危险区域提取部将作为所述危险区域而提取出的所述物体的端点作为危险候选区域，判定以所述危险候选区域为基点连结同一物体的另一端点的直线与所述自动移动体的行进方向所成的角度是否为预定的阈值以上，当所述角度为预定的阈值以上时，提取所述危险候选区域作为危险区域。由此，能够更好地进行危险区域的判定，因此能够抑制不需要的避开动作的发生，能够更稳定地进行移动。另外，也可以采用以下方式还包括安全速度选定部，当所述自动移动体进入由所述危险区域提取部提取出的危险区域时，所述安全速度选定部选定根据所述危险区域和所述自动移动体的位置的相对距离而减速的移动速度，所述自动移动体按照由所述安全速度选定部选定的移动速度进入所述危险区域。由此，即使在进入危险区域的情况下，也能够更安全地避免碰撞。并且，也可以采用以下方式还包括路径计划部，所述路径计划部生成从所述移动起点到所述移动终点的路径，当所述自动移动体避开由所述危险区域提取部提取出的危险区域而移动时，所述路径计划部使用反映了所述危险区域的地图信息来生成避开所述危险区域的路径，所述自动移动体在所述生成的路径上移动。由此，能够避开危险区域，并更安全且有效率地移动。另外，也可以采用以下方式还包括安全速度选定部，所述安全速度选定部选定根据由所述危险区域提取部提取出的危险区域和所述自动移动体的位置的相对距离而减速的移动速度；以及路径计划部，所述路径计划部生成从所述移动起点到所述移动终点的路径，当所述自动移动体接近所述危险区域时，所述自动移动体按照由所述安全速度选定部选定的移动速度进入所述危险区域，或者所述自动移动体在由所述路径计划部生成的避开所述危险区域的路径上移动。由此，在提取了危险区域的情况下，能够更良好地进行避开动作。
本发明提供一种自动移动体的控制方法，所述自动移动体具有测定到存在于环境中的物体的距离的测距传感器，所述控制方法包括以下步骤获取所述测距传感器的距离测定值作为测定点的距离信息；将彼此接近的测定点根据所述测定点间的距离差而辨别为同一物体；当所述辨别出的物体自身具有预定的阈值以上的大小且物体的端点间所形成的开口部具有预定的阈值以上的宽度时，提取所述物体的端点作为危险区域；以及进行移动控制，以避免在所述提取出的危险区域碰撞。由此，使用测距传感器的测定值预测突然出现危险区域，当进入危险区域时通过进行避免碰撞动作，即降低速度、或者生成避开危险区域的路径来移动等，从而即使在突然出现危险区域，也不需要设置标识器等，能够稳定地避免与移动障碍物的碰撞。发明的效果根据本发明，能够提供以下的自动移动体及其控制方法即使在被预计会突然出现人或移动障碍物等的危险区域也不需要设置基础设施等，能够稳定地进行避免碰撞动作。
图IA是表示实施方式I涉及的自动移动体的构成的图；图IB是实施方式I涉及的自动移动体的侧面图；图2是表示实施方式I涉及的控制部的功能构成的框图；图3是表示由实施方式I涉及的测距传感器16进行的环境的测定(距离测定)的情况的图；图4是表示通过实施方式I涉及的测距传感器16获取的测定点的图；图5是说明实施方式I涉及的测定点的分类的图；图6是表示在实施方式I涉及的测定点的分类上使用的阈值的变化的图；图7是表示实施方式I涉及的物体的起点和终点的图；图8是表示实施方式I涉及的危险区域的判别的图；图9是说明实施方式I涉及的危险区域判定的具体例子的图；图10是表示实施方式I涉及的被提取出的危险区域的图；图IlA是说明实施方式I涉及的从逆向的危险区域的识别处理的图；图IlB是说明实施方式I涉及的从逆向的危险区域的识别处理的图；图12是表示在实施方式I涉及的安全速度的选定上使用的减速表的图；图13是在实施方式I涉及的危险区域设定电位的图；图14是表示实施方式I涉及的使用了网格地图的路径计划的图；图15是表示实施方式I涉及的使用了反映危险区域的网格地图的路径计划的图；图16是表示其他实施方式涉及的自动移动体的构成的图；图17是表示限定其他实施方式涉及的危险区域的监视范围的情况的图。
具体实施例方式实施方式I.
下面，参考附图对本发明的实施方式进行说明。图IA和图IB示出了作为本实施方式的自动移动体的车辆。图IA是表示车辆10的简要的功能构成的图，图IB是车辆10的侧面图。在车辆10的移动环境内存在已知的固定障碍物和通过测距传感器检测出的固定障碍物以及移动障碍物等，车辆10需要避开这些障碍物。如图IA所示，车辆10是具有箱型的车辆主体10a、一对相向的左右驱动轮11、以及滚轮(caster) 12的相向两轮型的车辆。通过这些左右驱动轮11和辅助轮12水平地支承车辆主体10a。并且，在车辆主体IOa的内部配置有分别驱动左右驱动轮11的驱动部(马达)13、用于检测驱动轮的转速的编码器14、以及生成用于对驱动轮进行驱动的控制信号并向驱动部13发送该控制信号的控制部15。并且，在控制部15内部所具有的作为存储部的存储器等的存储区域15a中记录有控制程序，所述控制程序用于基于控制信号来控制车辆10的移动速度、移动方向、移动距离等。所述移动速度、移动距离等基于由编码器14检测出的左右驱动轮11的转速而求出。另外，在车辆主体IOa的前表面固定有非接触式的测距传感器16，所述非接触式的测距传感器16用于识别出现在移动方向上的障碍物等，通过该测距传感器16识别出的物体等的信息被输入到控制部15，其结果是按照控制程序决定车辆10移动的方向、速度等。测距传感器16例如能够由检测在障碍物等中被反射的激光的光扫描型的传感器(激光测距仪等)构成。另外，测距传感器16不限于激光测距仪，也可以使用红外线传感器、超声波传感器等非接触式的传感器。在车辆主体IOa的前表面上方，如图IB所示配置有作为测距传感器16的激光测距仪。在本实施方式中，测距传感器16按照要照射的激光LI的方向大致为水平方向的方式被配置。测距传感器16测量存在于车辆10周边的检测区域中的物体和车辆10之间的距离。测距传感器16向车辆10的前方的检测区域呈放射状放射激光，并接收来自该检测区域内的物体的反射光，由此能够测定到该物体的距离。如此被构成的车辆10通过分别独立地控制一对左右驱动轮11的驱动量，能够进行直进、曲线移动(转弯)、后退、原地旋转(以两驱动轮的中点为中心的转弯)等移动动作。并且，车辆10按照来自指定外部的移动场所的控制部15的指令生成到移动环境内被指定的目的地的移动路径，并追随该移动路径来移动，由此到达目的地。在控制部15内部所具有的存储区域15a中存储有地图信息。这里作为地图信息存储了网格地图，所述网格地图是通过在地面上的移动环境整体的形状上虚拟地描绘网格线而得到的，所述网格线连结被配置成大致一定间隔d(例如IOcm)的格子点。表示是否存在障碍物的障碍物信息预先或者实时地被设定在各个网格上。控制部15以在网格地图中被确定的自身位置为移动起点，生成到作为目的地的移动终点的移动路径，并按照所生成的移动路径来进行移动。图2是表示控制部的功能构成的框图。如图所示，控制部15包括距离信息获取 部21、危险区域提取部22、安全速度选定部23、路径计划部24、以及车轮速度输出部25。距离信息获取部21获取通过测距传感器16测定的、到物体的距离测定值作为各测定点的距离信息。危险区域提取部22基于由距离信息获取部21获取的距离信息提取危险区域。更具体地说，将彼此接近的测定点根据该测定点间的距离差辨别为同一物体。并且，当所关注的物体自身具有预定阈值以上的大小、并且该关注的物体的端点和其他物体的端点间形成的开口部具有预定阈值以上的宽度时，提取该关注的物体的端点作为危险区域。此外，作为危险区域除了交叉路口以外，还有室内的出入口、打开了的门的影子的部分、拐角的里侧从车辆10不能看到的区域等，是能够预料到人等移动障碍物会突然出现的场所。对于危险区域提取处理的详细情况如后所述。当车辆10进入由危险区域提取部22提取出的危险区域时，安全速度选定部23选定安全的移动速度。如后所述，选定根据危险区域和车辆10的位置的相对距离而减速的移动速度作为安全的移动速度。路径计划部24生成从移动起点到移动终点的路径。另外，路径计划部24如后所述在避开由危险区域提取部22提取出的危险区域而移动的情况下，使地图信息反映危险区域，并生成从移动起点到移动终点的避开路径。车轮速度输出部25基于由安全速度选定部23选定的速度和由路径计划部24生成的路径来控制左右驱动轮11的驱动。如后所述，当车辆10在沿所生成的路径向移动终 点移动的中途提取出了危险区域的情况下，通过随着接近危险区域而减速来避免在危险区域的碰撞。或者，车辆10也可以在提取出了危险区域的情况下，生成避开危险区域的路径，并在该路径上移动。并且，还可以在将上述方式组合来生成避开路径之后，使车辆加速或者减速。参考图3和图4对使用了测距传感器16的距离信息的获取处理进行说明。图3是表示由测距传感器16进行的环境的测定(距离测定)的情况的图。图4是表示测距传感器16所获取的距离测定点的图。首先，车辆10使用测距传感器16来进行环境的测定。图3示出了环境测定的情况。通过斜线示出的区域30表示基于测距传感器16的检测区域。车辆10以车辆10的位置为基准，获取由测距传感器16得到的测定值来作为各测定点的距离信息。由此，墙壁等障碍物上的各测定点具有以车辆10为基准的距离数据。图4示出各测定点。测定点41、42、42、……的位置表示车辆10的行进方向的特定平面中的、距车辆10的距离。各测定点具有一度左右的角度分辨率。参考图5至图11A、图IlB对危险区域的提取处理进行说明。图5是说明测定点的分类的图。图6是表示在测定点的分类上使用的阈值的变化的图。图7是表示物体的起点和终点的图。图8是表示危险区域的判别的图。图9是说明危险区域判定的具体例子的图。图10是表示被提取出的危险区域的图。图IlA和图IlB是说明来自逆向的危险区域的识别处理的图。车辆10对从测距传感器16获取的各测定点进行基于其测定值的分类(物体辨别)。具体地说，判别从测距传感器16获取的各测定点是否是对同一物体连续测定出的点，当是对同一物体测定出的点时，将这些测定点的集合判别为一个物体。这里，如图5所示，沿物体判别的处理方向50，依次地判定彼此相邻的测定点之间的距离，如果测定点之间的距离为预定的阈值以下，则判定为是对同一物体的测定点。并且，对于各测定点，对相同物体的测定点标注同一物体的编号。此外，在图中，使用标号51来统称被赋予物体编号I的测定点的集合。同样分别使用标号52、53、54、55来统称物体编号2、物体编号3、物体编号
4、物体编号5。
关于测定点之间的距离的预定阈值可以设为固定值，也可以是根据距车辆10的距离(测定距离)而变化的值。例如，如图6所示,对于车辆10附近的测定点，使用阈值Lth (n)，对于远处的测定点使用阈值Lth (m)，并将阈值Lth (m)设定得比阈值Lth (n)大。另夕卜，例如可以将预定的阈值设为与到测定点的距离单纯成比例的值，也可设为在距车辆10超过了一定的距离之前使阈值与到测定点的距离成比例的值，在超过了一定的距离的情况下使阈值不再改变而设为一定的值。测距传感器16的测定精度依赖于角度分辨率，因此越是远方的物体的测定点，彼此相邻的测定点之间的距离越大。其结果是，在将使用在分类上的预定的阈值设为固定值的情况下，实际上尽管是关于同一物体的测定点，但是也有可能错误地判定为是关于不同的物体的测定点。因此，通过使用于测定点的分类上的阈值根据距离而变化，由此在以后的危险区域判定处理中，即使对于远方的物体的测定点也能够更准确地进行判别。由此，能够抑制提取错误的危险区域的情况。因此，能够抑制实际上尽管不是危险区域、但使车辆10减速或者沿避开路径移动的不必要的情况，能够更稳定地进行移动。
接着，车辆10对通过分类而被辨别的各个物体求出作为起点的测定点和作为终点的测定点。这里，如图7所示，对于位于各物体的两端的测定点，将测定编号小的测定点设为起点，将测定标号大的测定点设为终点。在图中，示出了被赋予物体编号I的测定点(在图中由标号51统称的测定点的集合)中以测定点511为起点、以测定点512为终点。另外，示出了被赋予物体编号5的测定点(在图中由标号55统称的测定点的集合)中以测定点551为起点、以测定点552为终点。另外，对各测定点，如图4所例示的那样，按照所获取的顺序赋予测定编号。接着，车辆10使用各物体的起点和终点进行危险区域的判别。危险区域的判别针对各个物体来进行，这里，按照被赋予的物体编号从小到大的顺序进行(从物体编号I依次进行)。具体地说，对于关注的物体编号的物体，着眼于该物体的终点和下一物体编号的物体的起点，在以下所有的条件⑴ ⑷成立的情况下，将该物体的端点判别为危险区域。条件I :对于物体编号为n的物体(n)，物体(n)的长度为阈值以上。物体(n)的长度通过物体(n)的起点和终点之间的距离来计算出。此外，作为例外，对于物体编号是I的物体(n)，假设条件I总是成立的。在条件I不成立的情况下，表示关注的物体的长度短。这样的物体由于因突然出现而产生的危险性少，因此能够从作为危险区域的提取对象中除去。条件2 :物体(n)的终点和物体(n+1)的起点的距离差为预定的阈值以上。在条件2不成立的情况下，表示物体间的开口部的宽度窄。对于这样的开口部，由于难以设想人或移动障碍物的突然出现，因此可以不作为危险区域而提取。条件3 :物体(n)的终点和物体(n+2)的起点的距离差为预定的阈值以上。在条件3不成立的情况下，表示以物体(n)的终点为基准的其他的开口部的宽度也窄。在考虑以同一物体(n)的终点为基准的多个开口部的情况下，虽然物体(n)和物体(n+1)间的开口部的宽度宽，但是也假定物体(n)和物体(n+2)之间的开口部的宽度窄。即使在这样的状况下，对于宽度窄的开口部由于难以设想人或移动障碍物的突然出现，因此可以不作为危险区域而提取。即，除了判定物体(n)的终点与物体(n+1)的起点的距离差之外，也判定与物体(n+2)的起点的距离差，由此对于以物体(n)的终点为基准的开口部，在即使其一部分包含有宽度窄的开口部的情况下，可以不将物体(n)的终点作为危险区域而提取。接着，在车辆10对于各物体的起点和终点判定了上述条件I 3是否成立后，从满足了条件I 3的各物体的终点和起点提取危险区域候选点。这里，将物体(n)的终点和物体(n+1)的起点中与车辆10的距离近的点提取为危险区域候选点。此外，在条件I 3中使用的预定的阈值考虑了车辆10的大小、人或移动障碍物等的大小而设定。接着，对于作为危险区域候选点而提取出的点，车辆10考虑包含该点的物体与车辆10的相对的角度来提取危险区域。具体地说，对于满足条件I 3并且作为危险区域候选点而被提取的点，还在以下的条件4成立了的情况下判别为危险区域。条件4:对于以危险区域候选点为基点而连结同一物体的另一端点的直线，该直线与车辆10的行进方向所成的角度为预定的阈值以上。例如，将预定的阈值设定为45度，根据条件4的成立判定危险区域候选点是相对于车辆10位于跟前侧的物体的端点、还是相对于车辆10位于里侧的物体的端点。在条件4不成立的情况下，危险区域候选点表示是 相对于车辆10位于里侧的物体的端点。例如，在交叉路口，在相对于车辆10的跟前侧的端点存在人等移动障碍物突然出现的危险性，车辆10和人彼此不能看见，因此需要特别注意。与此相对，关于里侧的端点，由于彼此接近时容易看见，因此也能够采取与接近相应的应对，认为比跟前侧的端点相比注意的必要性更低。因此，对于危险区域候选点，通过还判定从车辆10看时是跟前侧的端点还是里侧的端点，由此能够仅将更危险的区域提取出。例如如图8所示，在形成通道等开口部70的终点71和起点72提取为危险区域候选点的情况下，对于不是更危险的里侧的点72不作为危险区域提取出，而是将更危险的跟前侧的点71作为危险区域提取出。由此，对于里侧的端点不需要判断为危险区域，因此，在以后的移动中，能够避免无用的减速或避开动作。参考图9，对危险区域判定的具体例子进行说明。在图中例示了物体编号n是I的情况。条件I :对于物体编号I的物体(在图中使用标号51示出。)，物体的长度LI为预定的阈值以上(此外，对于n = I的情况总是成立。)。条件2 :物体编号I的物体的终点和物体编号2的物体(在图中使用标号52示出。)的起点的距离差L2为预定的阈值以上。条件3 :物体编号I的物体的终点和物体编号3的物体(在图中使用标号53示出。)的起点的距离差L3为预定的阈值以上。条件4 :对于连结物体编号I的物体的终点和起点的直线，该直线与车辆10的行进方向60所成的角度0 I为预定的阈值以上。在图9所示的例子中，上述所有的条件I 4成立，物体编号I的终点作为危险区域被提取。并且，接着物体编号I的物体的终点的危险区域判定而着眼于物体编号2的物体的终点和物体编号3的物体的起点的一对。于是，由于满足上述条件I 3，因此将更接近车辆10的物体编号3的物体的起点提取为危险区域候选点。但是，根据条件4的判定，物体编号3的物体的方向和车辆10的行进方向所成的角度小于预定的阈值，因此条件4不成立。因此，物体编号3的物体的起点不作为危险区域提取。图10示出图3的环境中的危险区域的提取结果。在如图所示的例子中，危险区域81、82、83被提取出。如此，车辆10通过判定上述条件I 4的成立来进行危险区域的提取。成为危险区域的场所是突然出现的人等移动障碍物对车辆10来说难以看见的区域，并且是具有能够假定移动障碍物的突然出现的程度的宽度的区域。因此，对于被检测出的环境中的各物体，在物体自身具有某种程度的大小并且物体间的开口部具有某种程度的宽度的情况下，将该物体的端点提取为危险区域的候补。此外，上述条件可以设为仅进行I 3的判定来提取危险区域，但是还通过对条件4的成立进行判定，能够进一步抑制无用的减速或者避开动作。此外，上述I 4的条件的判定如图5所示沿着物体判别的处理方向50按照被赋予的物体编号从小到大的顺序进行(即从物体编号I开始依次进行)了说明，但是可以按照被赋予的物体标号从大到小的顺序再次对各物体进行上述I 4的条件判定。由此，能够更准确地提取危险区域。下面参考图IA和图IlB对其理由进行说明。图IlB是表示针对图IlA所示的实际环境的危险区域候选点的提取结果。在图示的例子中，在沿物体判别的处理方向92提取危险区域候选点的情况下，由于端点94不满足条件1(L1比预定的阈值小)，因此不作为危险区域被提取。与此相对，在沿物体判别的处理方向91提取了危险区域候选点的情况下，端点94满足条件I 4全部，因此能够作为危险 区域进行提取。此外，在沿物体判别的处理方向92提取危险区域候选点的情况下，将物体的起点和终点分别置换为终点和起点来进行判别处理。参考图12对安全速度的选定处理进行说明。图12是表示用于安全速度的选定的减速表的图。车辆10考虑在所提取出的危险区域中车辆10与位于距车辆10最近的危险区域的距离，选定即使是在人等移动障碍物突然出现的情况下也能够避免碰撞的安全速度。这里，例如能够使用图12所示的减速表计算安全速度。在图12中，将安全速度作为纵轴，将车辆10与危险区域的相对距离作为横轴，示出了安全速度V0、相对距离D1、D2。相对距离Dl是将危险区域设为基准位置并考虑移动障碍物与车辆10的大小而设定的值，车辆10在相对距离Dl将速度设为0而停止。相对距离D2是在相对距离Dl使车辆10停止以能够到达速度0所需要的距离，根据车辆10的性能而设定。即，在相对距离D2以速度VO行驶中的车辆10随着接近危险区域而减速并在相对距离Dl停止。车辆10参考图12所示的减速表选定与跟危险区域的相对距离对应的安全速度。此外，如后所述，车辆10在提取出了危险区域的情况下，通过生成避开危险区域的路径并使车辆10在该路径上移动，由此也能够避免在突然出现的区域的碰撞。因此，在所生成的避开路径上移动的情况下，取代随着接近危险区域而使车辆减速，可以使车辆10在避开路径上加速移动。由此，能够更快地移动到目的地。参考图13至图15对路径计划处理进行说明。图13是对危险区域设定电位的图。图14是示出使用了网格地图的路径计划的图。图15是表示使用了反映危险区域的网格地图的路径计划的图。车辆10进行避开所提取出的危险区域的路径计划。这里，以避开所提取出的危险区域来进行路径计划。具体地说，以所提取出的危险区域为中心，在周围的坐标设定电位(potential)。设定了电位的电位区域与其他区域比较更大的电位值被加权在坐标上，越是其区域的中心越是设定更高的电位值。由此，危险区域难以作为路径采用，因此能够在路径计划中生成容易避开危险区域的路径。如图13所示，车辆10在未考虑危险区域(100、101、102)的情况下，通过路径计划而生成由虚线所示的路径103。与此相对，在考虑了危险区域102来进行路径计划的情况下，能够生成实线所示的路径104。路径104与路径103相比是在危险区域102的附近以大的角度转弯的路径，是对于车辆10来说容易避免碰头碰撞的路径。即，在路径103中在车辆10将要左转之前或者刚左转之后需要进行避免碰撞动作，与此相对，在路径104中能够在预先确认左转移动的方向之后通过危险区域102，因此能够更安全地移动。此外，路径计划的方法能够采用公知的方法，例如，能够使用图14所示的网格地图200进行路径计划。在图中，针对各个网格设定沿其一个网格移动而需要的成本。例如如图的右下所示，通过三个网格时的成本为3。车辆10基于成本搜索最短路径。在路径计划中，计算出连接移动起点201到移动终点202的路径上的网格的成本的总和，在多个路径中采用成本最小的路径。在未提取出危险区域的情况下，如图14所示，生成具有最小成本的路径203。在提取出危险区域的情况下，例如如图15所示，将所提取出的危险区域204和 其周边的网格的成本值与其他网格相比设定大的值，由此使成为最小成本的路径变化，能够生成避开了危险区域204的路径205。如以上说明，根据本发明，使用测距传感器16的测定值预测突然出现的危险区域，在进入危险区域时减速或者生成避开危险区域的路径来移动，由此即使在突然出现的危险区域也不需要设置标识器等，能够稳定地避免与移动障碍物的碰撞。另外，在本发明中，由于不需要对地图信息的危险区域的事前设定、标识器配备等的事前准备，因此针对各种环境也能够容易开展。此外，本发明并不限于上述实施方式，能够在不脱离主旨的范围内适当变更。例如，在上述的实施方式中，作为自动移动体以图I所示的车辆10为例进行了说明，但是作为自动移动体的构成，只要是能够使用所安装的测距传感器16检测出危险区域即可，不需要特别地限定。例如，可以是具有图16所示的构成的倒立两轮性的自动移动体。如图16所示的自动移动体包括作为测距传感器16的激光测距仪310、作为控制部15的CPU320、车轮340、以及驱动车轮340的马达330。CPU 320包括危险区域提取部321、安全速度选定部322、以及车轮速度输出部323，它们具有与由上述的实施方式说明的各功能部同样的功能。另外，如图17所示，也可以限定危险区域的监视范围。在根据所提取出的危险区域中与最靠近车辆10的危险区域的相对距离来使车辆10减速的构成的情况下，对于与距车辆10最近的危险区域相比稍远距离的危险区域也将要减速，因此车辆10有时无法提高移动速度。因此，对于所提取出的危险区域，对于其距离某种程度远的危险区域，不加入到使用减速表选定速度的对象中。即，仅将被包含在图17中以斜线所示的区域410和区域420中的危险区域，设为减速对象。这样，通过限定确定作为减速对象的危险区域的监视区域，减少判定为危险区域的区域，抑制进行减速动作的频率。由此，能够提供对以避免更容易碰头的碰撞为特性的避免碰撞功遗。产业上的可利用性本发明能够利用于在存在例如被预计会突然出现的危险区域的环境中自动地移动的自动移动体及其控制方法。
标号说明10车辆、IOa车辆主体、11左右驱动轮、12滚轮、13驱动部(马达)、14编码器、15控制部、15a存储区域、16测距传感器、21距离信息获取部、22危险区域提取部、23安全速度选定部、24路径计划部、25车轮速度输出部、30检测区域、41、42、43测定点、50,60物体判别的处理方向、51被赋予物体编号I的测定点的集合、
511 起点、512 终点、52被赋予物体编号2的测定点的集合、53被赋予物体编号3的测定点的集合、54被赋予物体编号4的测定点的集合、55被赋予物体编号5的测定点的集合、551 起点、552 终点、70开口部、71终点、72起点、81、82、83危险区域、100、101、103 危险区域、102、103 路径、200网格地图、201移动起点、202移动终点、203路径、204危险区域、205路径、310激光测距仪、320CPU、330马达、340车轮、321危险区域提取部、322安全速度选定部、323车轮速度输出部、410、420 监视区域。
权利要求
1.一种自动移动体，所述自动移动体在环境中自动地从移动起点向移动终点移动，其特征在于，包括 测距传感器，所述测距传感器测定到存在于所述环境中的物体的距离； 距离信息获取部，所述距离信息获取部获取所述测距传感器的距离测定值作为测定点的距离信息；以及 危险区域提取部，所述危险区域提取部将彼此接近的测定点根据所述测定点间的距离差而辨别为同一物体，当所述辨别出的物体自身具有预定的阈值以上的大小且物体的端点间所形成的开口部具有预定的阈值以上的宽度时，所述危险区域提取部提取所述物体的端点作为危险区域， 所述自动移动体以避免在所述提取出的危险区域碰撞的方式移动。
2.如权利要求I所述的自动移动体，其特征在于， 所述危险区域提取部判定彼此接近的测定点间的距离差是否为根据距所述自动移动体的距离而变大的阈值以上，当所述距离差比所述阈值小时，将所述彼此接近的测定点辨别为同一物体。
3.如权利要求I或2所述的自动移动体，其特征在于， 所述危险区域提取部将作为所述危险区域而提取出的所述物体的端点作为危险候选区域，判定以所述危险候选区域为基点连结同一物体的另一端点的直线与所述自动移动体的行进方向所成的角度是否为预定的阈值以上，当所述角度为预定的阈值以上时，提取所述危险候选区域作为危险区域。
4.如权利要求I所述的自动移动体，其特征在于， 还包括安全速度选定部，当所述自动移动体进入由所述危险区域提取部提取出的危险区域时，所述安全速度选定部选定根据所述危险区域和所述自动移动体的位置的相对距离而减速的移动速度， 所述自动移动体按照由所述安全速度选定部选定的移动速度进入所述危险区域。
5.如权利要求I所述的自动移动体，其特征在于， 还包括路径计划部，所述路径计划部生成从所述移动起点到所述移动终点的路径， 当所述自动移动体避开由所述危险区域提取部提取出的危险区域而移动时， 所述路径计划部使用反映了所述危险区域的地图信息来生成避开所述危险区域的路径，所述自动移动体在所述生成的路径上移动。
6.如权利要求I所述的自动移动体，其特征在于， 还包括 安全速度选定部，所述安全速度选定部选定根据由所述危险区域提取部提取出的危险区域和所述自动移动体的位置的相对距离而减速的移动速度；以及 路径计划部，所述路径计划部生成从所述移动起点到所述移动终点的路径， 当所述自动移动体接近所述危险区域时， 所述自动移动体按照由所述安全速度选定部选定的移动速度进入所述危险区域，或者所述自动移动体在由所述路径计划部生成的避开所述危险区域的路径上移动。
7.一种自动移动体的控制方法，所述自动移动体具有测定到存在于环境中的物体的距离的测距传感器，所述控制方法包括以下步骤获取所述测距传感器的距离测定值作为测定点的距离信息； 将彼此接近的测定点根据所述测定点间的距离差而辨别为同一物体； 当所述辨别出的物体自身具有预定的阈值以上的大小且物体的端点间所形成的开口部具有预定的阈值以上的宽度时，提取所述物体的端点作为危险区域；以及进行移动控制，以避免在所述提取出的危险区域碰撞。
8.如权利要求7所述的自动移动体的控制方法，其特征在于， 在所述危险区域的提取中， 判定彼此接近的测定点间的距离差是否为根据距所述自动移动体的距离而变大的阈值以上， 当所述距离差比所述阈值小时，将所述彼此接近的测定点辨别为同一物体。
9.如权利要求7或8所述的自动移动体的控制方法，其特征在于， 在所述危险区域的提取中， 将作为所述危险区域而提取出的所述物体的端点作为危险候选区域，判定以所述危险候选区域为基点连结同一物体的另一端点的直线与所述自动移动体的行进方向所成的角度是否为预定的阈值以上， 当所述角度为预定的阈值以上时，提取所述危险候选区域作为危险区域。
10.如权利要求7所述的自动移动体的控制方法，其特征在于， 当所述自动移动体进入所述危险区域时， 选定根据所述危险区域和所述自动移动体的位置的相对距离而减速的移动速度，并按照所述选定的移动速度移动。
11.如权利要求7所述的自动移动体的控制方法，其特征在于， 当所述自动移动体避开所述危险区域而移动时， 使用反映了所述危险区域的地图信息来生成避开所述危险区域的路径，并在所述生成的路径上移动。
12.如权利要求7所述的自动移动体的控制方法，其特征在于， 当所述自动移动体接近所述危险区域时， 根据所述危险区域和所述自动移动体的位置的相对距离而减速，或者在避开所述危险区域的路径上移动。
全文摘要
即使在被预计会突然出现的危险区域也不需要设置标识器等，能够稳定地进行避免碰撞动作。本发明的自动移动体包括测距传感器(16)，测定到存在于环境中的物体的距离；距离信息获取部(21)，获取测距传感器(16)的距离测定值作为测定点的距离信息；以及危险区域提取部(22)，所述危险区域提取部(22)将彼此接近的测定点根据所述测定点间的距离差而辨别为同一物体，当所述辨别出的物体自身具有预定的阈值以上的大小且物体的端点间所形成的开口部具有预定的阈值以上的宽度时，提取物体的端点作为危险区域，所述自动移动体以避免在提取出的危险区域碰撞的方式移动。
文档编号G08G1/16GK102782600SQ20098016074
公开日2012年11月14日 申请日期2009年11月27日 优先权日2009年11月27日
发明者大林壮一, 小仓崇, 薮下英典 申请人:丰田自动车株式会社