一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

地图创建设备、地图创建方法和程序与流程

2021-10-19 20:01:00 来源:中国专利 TAG:创建 地图 公开 程序 方法


1.本公开涉及地图创建设备、地图创建方法和程序。


背景技术:

2.近年来,在移动体例如机器人设备、无人机或机动车中,通过识别移动体周围的环境来创建移动规划并通过遵循所创建的移动规划来进行移动的能力变得重要。
3.在这样的移动体中,例如,通过创建反映与周围环境有关的信息的环境地图并检测障碍物区域和可以移动通过其的区域来创建移动规划。因此,为了更有效地创建高精度的移动规划,已经考虑了用于更有效地创建环境地图的技术。
4.例如,以下专利文献1公开了以下技术:该技术用于减少与由占用网格地图表示的环境地图的保持和更新有关的成本,以便有效地使用机器人设备等中的有限的计算资源和内存资源。
5.[引用列表]
[0006]
[专利文献]
[0007]
[专利文献1]jp 2003

266349a


技术实现要素:

[0008]
[技术问题]
[0009]
借助于上述专利文献1中公开的技术,可以针对移动体周围的有限范围创建环境地图。然而,例如,结合近年来移动体的较高移动速度,需要进一步增加所创建的环境地图的范围。
[0010]
因此,本公开内容提出了以下新的且改进的地图创建设备、地图创建方法和程序:其使得能够创建适于移动规划并且针对更广泛范围的环境地图,同时抑制了内存消耗和处理负荷的增加。
[0011]
[解决问题的技术方案]
[0012]
借助于本公开内容,提供了一种地图创建设备,该地图创建设备包括:地图内位置控制单元,该地图内位置控制单元基于与移动体或环境有关的信息来设置移动体的位置坐标,位置坐标被设置在地图空间上,其中,对空间划界的边界和在与该边界相对的一侧的边界连接;以及感测反映单元,该感测反映单元通过使由移动体感测到的环境信息被反映到地图空间来创建与移动体周围的环境对应的环境地图。
[0013]
另外,借助于本公开内容,提供了一种地图创建方法,该方法包括:通过算术设备:基于与移动体或环境有关的信息来设置移动体的位置坐标,位置坐标被设置在地图空间上,其中,对空间划界的一个边界和在与该一个边界相对的一侧的另一边界连接;以及通过使由移动体感测到的环境信息被反映到地图空间来创建与移动体周围的环境对应的环境地图。
[0014]
此外,借助于本公开内容,提供了一种用于使计算机用作地图内位置控制单元和
感测反映单元的程序,该地图内位置控制单元基于与移动体或环境有关的信息来设置移动体的位置坐标,位置坐标被设置在地图空间上,其中,对空间划界的一个边界和在与该一个边界相对的一侧的另一边界连接;该感测反映单元通过使由移动体感测到的环境信息被反映到地图空间来创建与移动体周围的环境对应的环境地图。
附图说明
[0015]
[图1]图1是用于描述根据本公开内容的一个实施方式的包括地图创建设备的控制设备的内部配置的框图。
[0016]
[图2]图2是用于描述根据实施方式的地图创建单元的内部配置的框图。
[0017]
[图3a]图3a是示出理想传感器模型中的距离感测结果的曲线图。
[0018]
[图3b]图3b是示出立体摄像机中的距离感测结果的曲线图。
[0019]
[图4]图4是用于描述根据实施方式的在地图空间中对移动体的位置控制的说明视图。
[0020]
[图5]图5是用于描述将距离信息反映到地图空间的方法的说明视图。
[0021]
[图6a]图6a是示出用于确定网格单元的占用区域或空闲区域的占用概率阈值的示例的图形视图。
[0022]
[图6b]图6b是示出更新网格单元占用概率的示例的图形视图。
[0023]
[图7]图7是用于描述三维地图空间中的环形缓冲区的说明视图。
[0024]
[图8]图8是用于描述在三维地图空间中反映距离信息的说明视图。
[0025]
[图9]图9是用于描述根据实施方式的地图创建单元的操作流程的示例的流程图。
[0026]
[图10a]图10a是示出由地图创建单元的变型例创建的环境地图中的每一个以及与移动体周围的环境的对应性的示例的说明视图。
[0027]
[图10b]图10b是示出由地图创建单元的变型例创建的环境地图中的每一个以及与移动体周围的环境的对应性的示例的说明视图。
[0028]
[图10c]图10c是示出由地图创建单元的变型例创建的环境地图中的每一个以及与移动体周围的环境的对应性的示例的说明视图。
[0029]
[图10d]图10d是示出由地图创建单元的变型例创建的环境地图中的每一个以及与移动体周围的环境的对应性的示例的说明视图。
[0030]
[图11]图11是用于描述根据变型例的地图创建单元的操作流程的示例的流程图。
[0031]
[图12]图12是用于描述在其中显示环境地图的控制器的配置的框图。
[0032]
[图13a]图13a是示出在移动体低速移动的情况下环境地图的显示示例的说明视图。
[0033]
[图13b]图13b是示出在移动体高速移动的情况下环境地图的显示示例的说明视图。
[0034]
[图14]图14是用于描述用于创建占用网格地图的流程的流程图。
[0035]
[图15]图15是用于描述更新占用网格地图中的信息的方法的说明视图。
具体实施方式
[0036]
参照附图,下面详细给出关于本公开内容的优选实施方式的描述。注意,在本说明
书和附图中,相同的附图标记应用于具有基本相同的功能配置的部件,从而省略重复的描述。
[0037]
注意,将以以下顺序给出描述。
[0038]
1.与本公开内容有关的背景技术
[0039]
2.控制设备的配置
[0040]
3.地图创建单元的配置
[0041]
4.地图创建单元的操作
[0042]
5.变型例
[0043]
5.1变型例的配置
[0044]
5.2变型例的操作
[0045]
6.显示示例
[0046]
<1.与本公开内容有关的背景技术>
[0047]
根据本公开内容的一个实施方式的地图创建设备使用占用网格地图来创建反映关于移动体周围的环境的信息的环境地图。首先,参照图14,给出关于占用网格地图的描述。
[0048]
占用网格地图是一种移动体检测可以移动通过其的区域和障碍物区域的技术的示例。具体地,占用网格地图是以下技术:通过将空间划分成正方形的网格单元来检测可以移动通过其的空闲区域和其中存在障碍物的占用区域并且基于来自移动体的感测结果针对每个网格单元设置目标占用概率。
[0049]
例如,可以通过图14中所示的流程来创建占用网格地图。图14是用于描述用于创建占用网格地图的流程的流程图。根据图14中所示的流程,首先,设置地图空间,该地图空间通过正方形的网格单元表示移动体周围的环境并以移动体为中心(s10)。
[0050]
接下来,限定观察移动体周围的环境的距离传感器的传感器模型(s20)。这是因为,观察移动体周围的环境的距离传感器根据感测距离的方法而具有不同的观察结果特性。例如,使用立体摄像机的距离传感器距物体的距离越大,观察结果中包括的误差越大。因此,通过限定适于所使用的距离传感器的传感器模型,可以提高要创建的环境地图的精度和可靠性。
[0051]
随后,距离传感器被用于观察(感测)移动体周围的环境(s30),并且将感测结果反映到地图空间(s40)。具体地,对于每个网格单元,设置表示在网格单元中存在物体的概率的占用概率,并且基于关于所观察的移动体与物体之间的距离的信息来增加包括物体的网格单元的占用概率。同时,在移动体与物体之间的网格单元不包括物体,并且因此占用概率减小。
[0052]
此外,在反映感测结果之后,更新每个网格单元的占用概率(s50)。通过针对每个感测结果根据s40增加或减小占用概率,包括物体的网格单元的占用概率逐渐增大,并且不包括物体的网格单元的占用概率逐渐减小。通过这样,可以将其占用概率已经增加到高于用于确定障碍物区域的阈值的网格单元确定为障碍物区域。另外,可以将其占用概率已经变得低于用于确定可以移动通过其的区域的阈值的网格单元确定为可以移动通过其的区域。
[0053]
通过重复上述步骤s30至步骤s50的操作,直到移动体停机,移动体可以创建反映
关于周围环境的信息的环境地图,并基于所创建的环境地图来创建移动规划。
[0054]
此处,对于占用网格地图的参考坐标系,可以考虑两种模式:固定的世界坐标系和固定的体坐标系。
[0055]
固定的世界坐标系是将占用网格地图的坐标系固定到环境。在使用固定的世界坐标系的情况下,可以通过考虑到移动体的位置/取向将从移动体观察到的每个感测结果反映到地图空间来创建占用网格地图。例如,可以通过将移动体的坐标映射到世界坐标系中的地图空间并且另外将来自移动体的观察结果添加到地图空间来创建占用网格地图。
[0056]
然而,通过作为固定的世界坐标系的占用网格地图来表示大规模环境的情况会导致创建包括关于整体环境的信息的占用网格地图,并且因此,需要大容量的存储器来保持占用网格地图。在三维占用地图网格中,考虑一种通过将关于每个网格单元的信息保持在树结构中来抑制内存消耗的方法(通常称为octomap),但是该方法在读出关于每个网格单元的信息时会跟踪树形结构,并且因此,处理负荷增加。
[0057]
相比之下,固定的体坐标系是将占用网格地图的坐标系固定到移动体的位置/取向的坐标系。在使用固定的体坐标系的情况下,可以通过根据移动体的位置/取向的变化使关于占用网格地图的过去信息经受坐标转换、将过去信息反映到地图空间并且另外将从移动体观察到的感测结果反映到地图空间,来创建占用网格地图。例如,可以通过早前根据移动体的位置的变化对体坐标系占用网格地图执行一次反向转换并且将当前观察结果添加到反向转换后的占用网格地图,来创建占用网格地图。
[0058]
然而,在固定的体坐标系占用网格地图的情况下,因为每当移动体的位置/取向变化时关于占用网格地图的信息都会经受坐标转换,所以处理负荷变高。因此,在固定的体坐标系的情况下,已经考虑了通过环形缓冲区配置地图空间来降低理负荷的方法。参照图15,给出了关于通过环形缓冲区配置的占用网格地图的描述。图15是用于描述更新占用网格地图中的信息的方法的说明图。
[0059]
环形缓冲区是以下缓冲区:在该缓冲区中,通过连接线性缓冲区的两端,在超出末端写入信息的情况下,在返回开头之后写入超出末端的信息。换句话说,地图空间g是其中一个边界与在相对侧的另一边界连接的空间。
[0060]
如图15所示,时间t处的移动体的位置坐标mt被设置在由占用网格地图表示的地图空间g上,并且给出关于在时间t 1处移动体已经移动到位置坐标mt 1的情况的考虑。
[0061]
在地图空间不是环形缓冲区(面向图15时的上侧)的情况下,可以通过结合移动体的移动在移动体的移动方向上的最靠前的一行网格单元之前添加被设置为尚待观察的未知区域的一行网格单元格gfw并且删除在与移动体的移动方向相反的方向上的最靠后的一行网格单元gbw,来更新环境地图。通过这样,即使在移动体已经移动时,也可以创建支持移动体周围的环境的环境地图。
[0062]
相比之下,在地图空间g是环形缓冲区(面向图15时的下侧)的情况下,可以通过结合移动体的移动将与移动体的移动方向相反的方向上的最靠后一行的网格单元gbw重置为尚待观察的未知区域,来更新环境地图。换句话说,在环形缓冲区中,在移动体的移动方向上的最靠前的一行中的网格单元前面的网格单元成为与移动体的移动方向相反的方向上的最靠后一行中的网格单元gbw。因此,通过重复使用最靠后的一行网格单元gbw(其使用频率可以认为是低的)作为结合移动体的移动而添加的未知区域的网格单元,可以减少由地
图空间g消耗的存储量。
[0063]
然而,在固定的体坐标系占用网格地图中,创建的环境地图的范围仅是围绕移动体的范围。在这样的情况下,移动体难以创建沿长距离进行移动的移动规划。另外,在移动体高速移动的情况下,移动体将有可能会经历障碍物发现方面的延迟。
[0064]
如上面所描述的,尽管已经考虑了各种技术,但是在要用于创建移动体的移动规划的占用网格地图中,难以创建适合低内存消耗量和低处理符合的环境地图。
[0065]
特别地,与移动体的移动速度改变为较高速度以及移动规划的复杂性增加相结合,在针对较广的范围创建移动规划的情况下,请求针对较广的范围创建环境地图同时抑制内存消耗和处理负荷的增加。
[0066]
例如,在移动体是飞行器例如无人机的情况下,由于占用网格地图和移动体的移动规划将是三维的,因此移动规划的复杂性和占用网格地图的信息量显著增加,并且内存消耗和处理负荷也显著增加。因此,在诸如此的情况下,在创建环境地图和移动规划时抑制内存消耗和处理负荷变得重要。
[0067]
基于上面描述的情况,发明人已经构思了根据本公开内容的技术。下面给出关于根据本公开内容的技术的详细描述,该技术使得能够创建适于移动规划并且针对更广范围的环境地图,同时抑制内存消耗和处理负荷的增加。
[0068]
<2.控制设备的配置>
[0069]
首先,参照图1,给出关于根据本公开内容的一个实施方式的包括地图创建设备的控制设备的描述。图1是用于描述根据本实施方式的包括地图创建设备的控制设备的内部配置的框图。
[0070]
如图1中所示,控制设备100基于根据从传感器200获得的信息而创建的环境地图来创建移动体的移动规划,并且基于所创建的移动规划来控制移动体的移动。控制设备100设置有例如自身位置计算单元110、地图创建单元120、障碍物检测单元130、移动规划单元140、动作规划单元150和动作控制单元160。
[0071]
自身位置计算单元110基于从安装在移动体上的传感器200获得的信息来计算移动体的位置/取向。具体地,自身位置计算单元110首先获得由安装至移动体的图像传感器210——该图像传感器210是rgb摄像机、灰度摄像机等——捕获的图像信息,并且从imu(惯性测量单元)220获得与移动体的位置/取向有关的信息,该imu(惯性测量单元)220包括加速度传感器、陀螺仪传感器、磁传感器等。接下来,自身位置计算单元110基于由移动体捕获的图像信息以及与移动体的位置/取向有关的信息来计算移动体的位置、取向、速度、角速度等(在下文中,与这些参数有关的信息可以统称为自身信息)。由于对于由自身位置计算单元110计算移动体的位置、取向、速度、角速度等的方法,可以使用公知的方法,因此此处省略详细描述。注意,自身位置计算单元110还可以根据需要从安装至移动体的另一传感器获得与感测结果有关的信息,以计算移动体的位置、取向、速度、角速度等。
[0072]
地图创建单元120对应于根据本实施方式的地图创建设备,并且基于从安装至移动体的传感器200(具体地,距离传感器230)获得的关于物体的距离信息和由自身位置计算单元110计算的移动体的自身信息来创建与移动体周围的环境对应的环境地图。由地图创建单元120创建的环境地图是固定的体坐标系环形缓冲区占用网格地图,并且环境地图的每个网格单元被设置为其占用概率高的占用区域、其占用概率低的空闲区域和尚待观察的
未知区域中的任何一个。参照图2,下面给出关于地图创建单元120的详细配置和操作的描述。
[0073]
障碍物检测单元130检测在由地图创建单元120创建的环境地图中存在的障碍物。具体地,障碍物检测单元130通过根据移动体的体特性或动作特性评估环境地图中的每个占用区域和每个空闲区域来检测障碍物相对于移动体的存在或不存在。注意,例如,可以基于由自身位置计算单元110计算的移动体的自身信息来确定移动体的体特性或动作特性。
[0074]
例如,在移动体是通过车轮移动的机动车的情况下,障碍物检测单元130可以确定具有车轮不能驶过的高度的物体是障碍物。另外,在移动体是通过腿部移动的机器人设备的情况下,障碍物检测单元130可以确定具有可以被腿部跨过的高度的物体不是障碍物。此外,在移动体是飞行器例如无人机的情况下,障碍物检测单元130可以确定在低于移动体可以飞行的高度的位置处存在的物体不是障碍物。
[0075]
移动规划单元140基于移动体的自身信息和由地图创建单元120创建的环境地图来为移动体规划至目的地的路线。具体地,移动规划单元140可以通过将图搜索算法例如dijkstra的算法或a*算法应用于环境地图来规划最优路线,该环境地图是占用网格地图并且由地图创建单元120创建。此时,移动规划单元140可以在基于由障碍物检测单元130检测到的障碍物的存在或不存在而确定环境地图中的障碍物区域和可以移动通过其的区域之后,应用图搜索算法。
[0076]
动作规划单元150基于移动体的自身信息、移动规划单元140的移动规划以及与由障碍物检测单元130检测到的障碍物有关的信息,来为移动体规划动作。具体地,基于例如来自用户的指令、移动体的自身信息、移动规划或与障碍物有关的信息,动作规划单元150创建与移动体除了移动以外的动作有关的动作规划。例如,动作规划单元150可以创建动作规划,该动作规划包括由安装至移动体的图像传感器210捕获环境。另外,动作规划单元150可以创建动作规划,该动作规划包括向移动体或进入或离开移动体的人装载货物或者从移动体或进入或离开移动体的人卸载货物。
[0077]
动作控制单元160基于移动体的自身信息、移动规划和由动作规划单元150创建的动作规划来控制移动体的实际动作。具体地,动作控制单元160将根据移动体的自身信息确定的移动体的状态与根据移动规划或动作规划规划的移动体的状态进行比较,并且将用于使移动体的状态接近规划的状态的驱动命令输出至移动体的驱动单元(例如,马达等)。注意,动作控制单元160可以以分层的方式生成输出至移动体的驱动单元的控制命令。
[0078]
<3.地图创建单元的配置>
[0079]
接下来,参照图2,给出关于包括在控制设备100中的地图创建单元120的具体配置的描述。图2是用于描述地图创建单元120的内部配置的框图。
[0080]
如图2所示,地图创建单元120设置有位置/取向更新单元121、速度矢量获得单元122、传感器模型应用单元123、地图内位置控制单元124和感测反映单元125。
[0081]
位置/取向更新单元121基于与移动体的位置/取向有关的信息来计算环境地图中移动体的坐标。具体地,位置/取向更新单元121基于与环境地图中移动体的过去坐标、移动体的过去位置/取向有关的信息以及与移动体的当前位置/取向有关的信息,来计算环境地图中移动体的当前坐标。换句话说,位置/取向更新单元121计算移动体过去与现在之间的位置/取向的变化量,并且基于所计算的变化量来计算环境地图中移动体的当前坐标。
[0082]
速度矢量获得单元122从自身位置计算单元110获得与移动体的速度矢量有关的信息。具体地,速度矢量获得单元122从自身位置计算单元110获得移动体的速度矢量,该速度矢量包括移动速度和移动方向。
[0083]
传感器模型应用单元123将基于距离传感器230的感测方法而选择的传感器模型应用于物体的距离信息。
[0084]
此处,参照图3a和图3b,给出关于距离传感器230中的传感器模型的描述。图3a是示出理想传感器模型中对距离的感测结果的曲线图,并且图3b是示出立体摄像机中对距离的感测结果的曲线图。
[0085]
如图3a所示,在理想传感器模型中,在距离(distance)zt处存在物体的情况下,可以获得存在物体的概率(probability)作为在距离zt处具有脉冲状峰的感测结果。另外,在理想传感器模型中,感测结果中的误差是恒定的,并且不依赖于至物体的距离。
[0086]
相比之下,如图3b中所示,对于立体摄像机等的传感器模型,在距离(distance)zt处存在物体的情况下,可以获得存在物体的概率(probability)作为在距离zt处具有分布式峰的感测结果。另外,在立体摄像机等的传感器模型中,至物体的距离越大,感测结果的误差越大。
[0087]
因此,传感器模型应用单元123可以通过校正由于距离传感器230的感测方法而发生的感测结果的特性差异,来使关于距离信息的可靠性提高。换句话说,传感器模型应用单元230可以通过将距离传感器230的传感器模型应用于物体的距离信息,来使关于距离信息的可靠性提高。通过这样,地图创建单元120可以针对占用区域和空闲区域的设置来创建具有更高可靠性的环境地图。
[0088]
地图内位置控制单元124基于环境地图中的移动体的坐标和移动体的速度矢量来控制地图空间中移动体的位置坐标。
[0089]
此处,参照图4,给出关于在地图空间中移动体的坐标的移动的更具体描述。图4是用于描述在地图空间中对移动体的位置控制的说明视图。
[0090]
如图4中所示,地图内位置控制单元124首先基于环境地图中移动体的坐标来更新环境地图,使得移动体m被放置在地图空间g的中心处。随后,地图内位置控制单元124基于移动体m的速度矢量v使移动体m的坐标从地图空间g的中心移动。具体地,地图内位置控制控制单元124使移动体m的坐标从地图空间g的中心沿与移动体m的速度矢量v的方向相反的方向(换句话说,沿移动体m的移动方向)移动。通过这样,地图内位置控制单元124可以在移动体的移动方向上扩大创建环境地图的范围,并且因此,通过移动规划单元140更平滑地创建移动规划变为可能。例如,可以基于移动体的速度矢量v的大小来决定移动体从地图空间g的中心的移动量ss。
[0091]
地图内位置控制单元124可以根据移动体m的速度矢量v的大小来控制移动体m从地图空间g的中心的移动量ss。换句话说,地图内位置控制单元124可以控制移动体m的坐标,使得移动体m的速度矢量v的大小越大,从地图空间g的中心的移动量ss越大。另外,在移动体m的速度矢量v的大小大于或等于阈值的情况下,地图内位置控制单元124可以使移动体m的坐标从地图空间g的中心沿与移动体m的速度矢量v的方向相反的方向仅移动预定量或根据移动体m的速度矢量v的大小的量。
[0092]
另外,地图内位置控制单元124可以基于移动体的移动规划而不是移动体的速度
矢量来使移动体的坐标从地图空间的中心移动。具体地,地图内位置控制单元124可以使移动体的坐标从地图空间的中心沿与移动体的移动规划中的移动体的目的地(或到达位置)方向相反的方向移动。此时,移动体的坐标的移动量可以是预定量,并且可以是例如基于移动体的移动速度的大小的量。通过这样,地图内位置控制单元124可以在至移动体的目的地的方向上扩大创建环境地图的范围,并且因此移动规划单元140可以创建更长距离或更复杂的移动规划。
[0093]
此外,地图内位置控制单元124可以基于与环境有关的信息而不是移动体的速度矢量,来使移动体的坐标从地图空间的中心移动。具体地,地图内位置控制单元124可以使移动体的坐标从地图空间的中心沿与由麦克风检测到人的语音的方向相反的方向或沿与由图像捕获设备检测到人或障碍物的方向相反的方向移动。此时,移动体的坐标的移动量可以是预定量,并且可以是例如基于移动体的移动速度的大小的量。通过这样,地图内位置控制单元124可以在人或障碍物存在的可能性高并且发现需要更仔细的移动的方向上扩大创建环境地图的范围。因此,地图内位置控制单元124可以使由移动规划单元140创建的移动规划的安全性提高。
[0094]
因此,根据本实施方式的地图创建设备可以通过由地图内位置控制单元124使地图空间中移动体的位置移动来动态地改变创建环境地图的范围。通过这样,根据本实施方式的地图创建设备可以在不使内存消耗或处理负荷增加的情况下,针对更期望聚焦的范围创建环境地图。
[0095]
此外,根据本实施方式的地图创建设备可以通过从多个移动体收集移动体的位置和在这些位置处创建的环境地图并且将所收集的环境地图粘贴在一起来创建较大规模的固定的世界坐标系环境地图。
[0096]
感测反映单元125通过基于向其应用传感器模型的距离信息和与地图空间中移动体的坐标/取向有关的信息将关于从移动体到物体的距离的信息反映到地图空间来创建环境地图。可以例如通过使用布雷森汉姆(bresenham)的直线绘制算法等来执行由感测反映单元125将感测结果反映到地图空间。
[0097]
此处,参照图5至图6b,给出关于由感测反映单元125创建环境地图的描述。图5是用于描述将距离信息反映到地图空间的方法的说明视图。
[0098]
图6a是示出用于确定网格单元是占用区域还是空闲区域的占用概率阈值的示例的图形视图,并且图6b是示出更新网格单元占用概率的示例的图形视图。
[0099]
如图5中所示,感测反映单元125通过将关于从安装在移动体上的传感器so到物体ob的距离的信息反映到地图空间g,来更新网格单元占用概率并创建环境地图。
[0100]
具体地,感测反映单元125基于关于从传感器so到物体ob的距离的信息在地图空间g中绘制连接传感器so和物体ob的线段。此时,感测反映单元125使包括物体ob的网格单元go的占用概率仅上升预定值,并且使包括连接传感器so和物体ob的线段的网格单元gf的占用概率仅减小预定值。相比之下,连接传感器so和物体ob的线段未穿过的网格单元gu是尚待观察的未知区域,并且因此,不会使其占用概率改变。
[0101]
感测反映单元125通过分别使关于到观察物体的距离的信息被反映到地图空间来更新每个网格单元的占用概率,以从而增大或减小网格单元的占用概率。例如,可以使用二进制贝叶斯滤波算法来执行网格单元的占用概率的增大或减小。利用二进制贝叶斯滤波算
法,可以通过对数表示特定时间处的占用概率,并且因此,可以通过将占用概率的对数(log_odds)相加在一起来组合随时间的占用概率。
[0102]
例如,如图6a中所示,对于占用概率的对数,可以将最大值(max)设置为“3.5”,将用于确定占用区域的阈值(th_occ)设置为“0.85”,将用于确定空闲区域的阈值(th_free)设置为
“‑
0.4”,并将最小值(min)设置为
“‑
2.0”。注意,基于传感器模型,可以将占用概率的对数的初始值(ini)设置为用于确定占用区域的阈值(0.85)与用于确定空闲区域的阈值(

0.4)之间的适当值。。
[0103]
通过这样,对于其中存在物体的网格单元,可以看到,如由图6b中的情况1所示,由于占用概率逐渐升高,占用概率超过了在其处确定占用区域的阈值(th_occ),并且达到最大值(max)。另外,对于其中不存在物体的网格单元,可以看到,如由图6b中的情况2所示,由于占用概率逐渐减小,占用概率超过了在其处确定空闲区域的阈值(th_free),并且达到最小值(min)。此外,对于移动物体穿过的网格单元,可以看到,如由图6b中的情况3所示,当物体穿过其时占用概率暂时升高,但是在物体已经穿过其之后占用概率减小并且最终达到最小值(min)。
[0104]
因此,感测反映单元125可以基于距离信息来针对地图空间的每个网格单元设置占用概率,并且基于所设置的占用概率来确定占用区域和空闲区域。因此,感测反映单元125可以创建环境地图,在该环境地图中,地图空间的每个网格单元被分类为占用区域、空闲区域或未知区域中的任何一个。
[0105]
在上述实施方式中,已经例示了地图空间和环境地图是二维矩阵网格的情况,但是根据本实施方式的地图创建设备可以应用于三维空间。参照图7和图8,给出关于将根据本实施方式的地图创建设备应用于三维空间的描述。图7是用于描述三维地图空间中的环形缓冲区的说明视图。图8是用于描述在三维地图空间中反映距离信息的说明视图。
[0106]
如图7中所示,在三维地图空间3dg的环形缓冲区中,一个边界表面与相对侧的另一边界表面连接。因此,例如,在时间t处存在于坐标mt处的移动体沿y方向移动1以在时间t 1处到达坐标mt 1的情况下,通过将在

y方向上的地图空间3dg的最外表面处的网格(在三维的情况下也被称为体素)gu重置为尚待观察的未知区域,来更新环境地图。因此,即使在三维地图空间3dg的情况下,也可以与二维地图空间类似地使用环形缓冲区。
[0107]
另外,如图8中所示,即使在三维地图空间3dg中,感测反映单元125也可以通过使用例如布雷森汉姆的直线绘制算法将感测结果反映到地图空间3dg。具体地,感测反映单元125可以基于关于从传感器so到物体ob1和ob2的距离的信息,在地图空间3dg中绘制连接传感器so与物体ob1和ob2的线段。
[0108]
因此,感测反映单元125可以使包括物体ob1和物体ob2p的体素的占用概率仅上升预定值,并且使包括连接传感器so与物体ob1和ob2p的线段的体素的占用概率仅减小预定值。注意,由于包括物体ob2的体素存在于地图空间3dg的外部,因此使用地图空间3dg的侧面与连接传感器so和物体ob2的线段之间的交点ob2p代替物体ob2来执行上面描述的处理。通过这样,即使在三维地图空间3dg的情况下,也可以类似于二维地图空间来反映感测结果。
[0109]
可以通过硬件和软件之间的协作来实现根据上述本实施方式的地图创建单元120或包括地图创建单元的控制设备100。例如,可以通过使用cpu、rom和ram作为硬件来实现地
图创建单元120或控制设备100。
[0110]
cpu用作算术处理设备,并根据存储在rom中的各种类型的程序来控制控制设备100或地图创建单元120的整体操作。rom存储由cpu使用的算术参数和程序。ram临时存储由cpu进行的执行中使用的程序、在该执行中适当改变的参数等。
[0111]
另外,还可以创建用于使这些硬件部件执行与根据上述本实施方式的控制设备100或地图创建单元120的相应配置等同的功能的计算机程序。另外,还可以提供一种使该计算机程序被存储在其中的存储介质。
[0112]
<4.地图创建单元的操作>
[0113]
接下来,参照图9,给出关于控制设备100中包括的地图创建单元120的操作的示例的描述。图9是用于描述地图创建单元120的操作流程的示例的流程图。
[0114]
如图9中所示,首先,在地图创建单元120中,获得移动体的速度矢量(s101),并且确定移动体的速度矢量的大小是否大于或等于阈值(s103)。在速度矢量的大小大于或等于阈值的情况下(s103/是),在使移动体的坐标沿与速度矢量的方向相反的方向从地图空间的中心移动之后,设置移动体的坐标(s105)。同时,在速度矢量的大小小于阈值的情况下(s103/否),将移动体的坐标设置为地图空间的中心(s106)。随后,通过将对距离信息的感测结果反映到地图空间,创建环境地图(s107)。
[0115]
作为上述这样的操作的结果,地图创建单元120可以动态地改变所创建的环境地图的范围。因此,地图创建单元120可以在不使内存消耗或处理负荷增加的情况下针对更期望聚焦的范围创建环境地图。
[0116]
<5.变型例>
[0117]
(5.1.变型例的配置)
[0118]
接下来,参照图10a至图10d,给出关于地图创建单元120的变型例的描述。图10a至图10d是分别示出由地图创建单元120的变型例创建的环境地图以及与移动体周围的环境的对应性的示例的说明视图。
[0119]
如图10a至图10d中所示,在本变形例中,地图空间包括基本地图空间g和扩展地图空间g
e
。基本地图空间g是在其中设置了移动体的坐标的地图空间g。具体地,在基本地图空间g中,移动体的坐标被设置为已经从中心沿与移动体的移动方向相反的方向移动了的坐标。另外,扩展地图空间g
e
是与基本地图空间g相邻或交叠设置的地图空间。基本地图空间g和扩展地图空间g
e
整体上用作一个环形缓冲区。注意,扩展地图空间g
e
可以是具有与基本地图空间g的大小相似的大小的占用网格地图。
[0120]
在本变形例中,基于与环境或移动体有关的信息来控制相对于基本地图空间g沿其设置扩展地图空间g
e
的方向。注意,可以基于移动体的速度矢量的大小是否大于或等于阈值来决定是否相对于基本地图空间g设置扩展地图空间g
e

[0121]
如图10a至图10d中所示,可以基于移动体的移动方向来控制相对于基本地图空间g沿其设置扩展地图空间g
e
的方向。具体地,在移动体m以速度矢量v
a
至v
d
移动的情况下,可以相对于基本地图空间g沿速度矢量v
a
至v
d
的方向与基本地图空间g相邻地设置扩展地图空间g
e
。作为其结果,针对地图空间创建的环境地图成为以下地图:该地图拥有在移动体m的移动方向上存在的物体ob
a
和ob
b
两者。因此,通过使用这样的环境地图创建移动规划,可以实现移动体m的更平滑的移动。
[0122]
例如,在移动体m的速度矢量v
a
的方向如图10a中所示的向前的情况下,可以在基本地图空间g的前方设置扩展地图空间g
e
。在移动体m的速度矢量v
a
和v
b
的方向如图10b和图10c中所示的斜向前的情况下,可以在基本地图空间g的斜前方设置扩展地图空间g
e
。例如,在移动体m的速度矢量v
d
的方向如图10d中所示的向左的情况下,可以在基本地图空间g的左侧设置扩展地图空间g
e
。借助于根据本变形例的地图创建单元120,可以创建具有在更期望聚焦的范围的方向上扩展的地图空间的环境地图,同时抑制内存消耗和处理负荷的增加。
[0123]
另外,可以基于移动体的移动规划来控制相对于基本地图空间g沿其设置扩展地图空间g
e
的方向。具体地,相对于基本地图空间g,可以沿移动体的移动规划中的目的地(或到达位置)的方向与基本地图空间g相邻或交叠地设置扩展地图空间g
e
。因此,地图创建单元120可以创建具有在更期望聚焦的范围的方向上扩展的地图空间的环境地图,同时抑制存内存消耗和处理负荷的增加。
[0124]
此外,可以基于与环境有关的信息来控制相对于基本地图空间g沿其设置扩展地图空间g
e
的方向。具体地,相对于基本地图空间g,可以沿由麦克风检测到人的语音的方向或者沿由图像捕获设备检测到人或障碍物的方向,与基本地图空间g相邻或交叠地设置扩展地图空间g
e
。作为其结果,地图创建单元120可以创建具有在人或障碍物存在的可能性高并且发现需要更仔细的移动的方向上扩展的地图空间的环境地图。因此,地图创建单元120可以使基于环境地图创建的移动规划的安全性提高。
[0125]
借助于本变型例,基于与环境或移动体有关的信息,可以动态地扩展所创建的环境地图的范围。因此,地图创建单元120可以创建环境地图,该环境地图使得能够创建移动体的更平滑的移动规划,同时抑制内存消耗和处理负荷。
[0126]
(5.2.变型例的操作)
[0127]
接下来,参照图11,给出关于根据本变型例的地图创建单元120的操作的示例的描述。图11是用于描述根据本变型例的地图创建单元120的操作流程的示例的流程图。
[0128]
如图11中所示,首先,在地图创建单元120中,获得移动体的速度矢量(s201)。接下来,确定移动体的速度矢量的大小是否大于或等于阈值(s203)。在速度矢量的大小大于或等于阈值的情况下(s203/是),还沿速度矢量的方向相对于基本地图空间设置扩展地图空间(s209)。接下来,在使移动体的坐标从基本地图空间的中心沿与速度矢量的方向相反的方向移动之后,设置移动体的坐标(s205)。随后,通过将对距离信息的感测结果反映到基本地图空间和扩展地图空间,创建环境地图(s207)。
[0129]
同时,在速度矢量的大小小于阈值的情况下(s203/否),将移动体的坐标设置为基本地图空间的中心(s206)。随后,通过将对距离信息的感测结果反映到基本地图空间,创建环境地图(s208)。
[0130]
通过如上的操作,地图创建单元120可以更动态地改变所创建的环境地图的范围。因此,地图创建单元120可以针对更期望聚焦的范围创建环境地图,同时抑制内存消耗和处理负荷。
[0131]
<6.显示示例>
[0132]
参照图12至图13b,下面给出关于显示由根据本实施方式的地图创建设备创建的环境地图的示例的描述。图12是用于描述在其中显示环境地图的控制器的配置的框图。图
13a和图13b是示出显示环境地图的示例的说明视图。
[0133]
如图12所示,包括根据本实施方式的地图创建设备的控制设备100是控制移动体10的操作的控制设备。具体地,控制设备100通过基于从传感器200获得的信息创建环境地图并基于根据环境地图创建的移动规划控制致动器400来控制移动体10的移动等。例如,移动体10可以是飞行器例如无人机,并且致动器400可以是例如用于使飞行器的转子等旋转的马达。
[0134]
此处,可以通过能够彼此进行无线通信的通信设备310和320将移动体10的移动的目的地等输入至控制器20。控制器20是例如无线地操纵移动体10的发送/接收设备,并且设置有显示设备500和输入设备600。
[0135]
输入设备600包括用户可以向其输入信息的输入机构例如按钮、开关或操纵杆以及输入控制电路,该输入控制电路用于基于输入的信息生成输入信号并且将输入信号输出至通信设备320。显示设备500包括诸如液晶显示设备或oled(有机发光二极管)显示设备的显示设备。例如,显示设备500可以显示由移动体10的控制设备100创建的环境地图等。用户可以通过视觉识别由控制设备100创建的环境地图来以更高的精度操纵移动体10。
[0136]
例如,如图13a和图13b中所示,控制器20设置有显示设备500和输入设备600,并且由移动体10捕获的捕获图像510以及由控制设备100创建的环境地图的图像520可以显示在控制器20的显示设备500上。
[0137]
图13a中所示的显示设备500的显示示例是针对移动体10低速移动的情况的显示示例。因此,在环境地图的图像520中,将移动体m的坐标设置为地图空间g的中心,并且示出了均匀地包括移动体m周围的环境的环境地图。因此,在环境地图的图像520的地图空间g中仅包括物体ob
a
。然而,参考捕获图像510,可以确认在物体ob
a
后面存在在地图空间g中未示出的物体ob
b
。当移动体10低速移动时,物体ob
b
影响移动体10的移动规划的概率低,并且因此,显示设备500可以显示均匀地指示移动体10周围的环境的环境地图。
[0138]
图13b中所示的显示设备500的显示示例是针对移动体10高速移动的情况的显示示例。因此,在环境地图的图像520中,在移动体m的坐标从地图空间g的中心沿与速度矢量v
h
的方向相反的方向移动之后设置移动体m的坐标,并且示出了更广泛地包括在移动体m的移动方向侧的环境的环境地图。因此,图像520的环境地图的地图空间g包括捕获图像510中的物体ob
a
和被确认在物体ob
a
后面的物体ob
b
二者。当移动体10高速移动时,物体ob
b
影响移动体10的移动规划的概率高,并且因此,显示设备500可以显示广泛地示出在移动体10的移动方向上的环境的环境地图。
[0139]
上面已经参照附图给出了关于本公开内容的优选实施方式的详细描述,但是本公开内容的技术范围不限于对应示例。明显的是,在本公开内容的技术领域中的普通技术人员可以想到在权利要求中阐述的技术构思的范畴内的各种修改或修正,并且应当理解,这些修改或修正无可非议地属于本公开内容的技术范围。
[0140]
另外,本说明书中描述的效果仅是描述性或说明性的,而不是限制性的。换句话说,除了上述效果或者代替上述效果,根据本公开内容的技术可以实现对于本领域技术人员而言根据本说明书的描述清楚的其他效果。
[0141]
注意,诸如以下的配置也属于本公开内容的技术范围。
[0142]
(1)一种地图创建设备,包括:
[0143]
地图内位置控制单元,其基于与移动体或环境有关的信息来设置所述移动体的位置坐标,所述位置坐标被设置在地图空间上,其中,对空间划界的边界和在与所述边界相对的一侧的边界连接;以及
[0144]
感测反映单元,其通过使由所述移动体感测到的环境信息被反映到所述地图空间来创建与所述移动体周围的环境对应的环境地图。
[0145]
(2)根据上述(1)所述的地图创建设备,其中,
[0146]
所述地图内位置控制单元基于所述移动体的移动规划或移动速度来在所述地图空间中设置所述移动体的位置坐标。
[0147]
(3)根据上述(2)所述的地图创建设备,其中,
[0148]
所述地图内位置控制单元将所述移动体的位置坐标设置为由于使所述移动体的位置坐标从所述地图空间的中心沿与所述移动体的移动方向相反的方向或者沿与所述移动规划中的到达位置的方向相反的方向移动而产生的坐标。
[0149]
(4)根据上述(3)所述的地图创建设备,其中,
[0150]
所述地图内位置控制单元将所述移动体的位置坐标设置为由于使所述移动体的位置坐标从所述地图空间的中心仅移动根据所述移动体的移动速度的距离而产生的坐标。
[0151]
(5)根据上述(3)所述的地图创建设备,其中,
[0152]
所述地图空间包括基本地图空间和扩展地图空间,并且
[0153]
所述地图内位置控制单元将所述移动体的位置坐标设置为由于使所述移动体的位置坐标从所述基本地图空间的中心沿与所述移动体的移动方向相反的方向或者沿与所述移动规划中的到达位置的方向相反的方向移动而产生的坐标。
[0154]
(6)根据上述(5)所述的地图创建设备,其中,
[0155]
沿所述移动体的移动方向或者沿所述移动规划中的到达位置的方向与所述基本地图空间相邻地设置所述扩展地图空间。
[0156]
(7)根据上述(5)或(6)所述的地图创建设备,其中,
[0157]
所述扩展地图空间的大小等于所述基本地图空间的大小。
[0158]
(8)根据上述(1)至(7)中任一项所述的地图创建设备,其中,
[0159]
所述地图内位置控制单元基于与来自环境的音频有关的信息在所述地图空间中设置所述移动体的位置坐标。
[0160]
(9)根据上述(1)至(8)中任一项所述的地图创建设备,其中,
[0161]
所述环境信息包括与从所述移动体到环境中存在的各个物体的距离有关的信息。
[0162]
(10)根据以上(9)所述的地图创建设备,其中,
[0163]
所述地图空间被划分成每个均具有预定大小的网格单元,并且
[0164]
所述感测反映单元基于各个物体对所述网格单元的占用概率来确定所述网格单元是占用区域还是空闲区域。
[0165]
(11)根据上述(10)所述的地图创建设备,其中,
[0166]
所述感测反映单元基于由所述移动体感测到的所述环境信息,使包括各个物体的网格单元的占用概率增加。
[0167]
(12)根据上述(10)或(11)所述的地图创建设备,其中,
[0168]
在所述移动体的移动范围超出所述网格单元的情况下,所述感测反映单元通过将
所述环境地图中的在与所述移动体的移动方向相反的一侧的网格单元改变为未知区域来更新所述环境地图。
[0169]
(13)根据上述(1)至(12)中任一项所述的地图创建设备,其中,
[0170]
所述地图空间包括环形缓冲区。
[0171]
(14)根据上述(1)至(13)中任一项所述的地图创建设备,其中,
[0172]
设置所述地图空间的取向,使得所述移动体的取向相对于所述地图空间是固定的。
[0173]
(15)根据上述(1)至(14)中任一项所述的地图创建设备,其中,
[0174]
所述地图空间包括三维空间,并且
[0175]
所述移动体包括飞行器。
[0176]
(16)根据上述(1)至(15)中任一项所述的地图创建设备,其中,
[0177]
通过无线地操纵所述移动体的发送/接收设备显示所述环境地图。
[0178]
(17)根据上述(16)所述的地图创建设备,其中,
[0179]
所述发送/接收设备与所述环境地图一起显示由所述移动体捕获的环境的捕获图像。
[0180]
(18)一种地图创建方法,包括:
[0181]
通过算术设备:
[0182]
基于与移动体或环境有关的信息来设置所述移动体的位置坐标,所述位置坐标被设置在地图空间上,其中,对空间划界的一个边界和在与所述一个边界相对的一侧的另一边界连接;以及
[0183]
通过使由所述移动体感测到的环境信息被反映到所述地图空间来创建与所述移动体周围的环境对应的环境地图。
[0184]
(19)一种使计算机用作以下的程序:
[0185]
地图内位置控制单元,其基于与移动体或环境有关的信息来设置所述移动体的位置坐标,所述位置坐标被设置在地图空间上,其中,对空间划界的一个边界和在与所述一个边界相对的一侧的另一边界连接;以及
[0186]
感测反映单元,其通过使由所述移动体感测到的环境信息被反映到所述地图空间来创建与所述移动体周围的环境对应的环境地图。
[0187]
[附图标记列表]
[0188]
10 移动体
[0189]
20 控制器
[0190]
100 控制设备
[0191]
110 自身位置计算单元
[0192]
120 地图创建单元
[0193]
121 位置/取向更新单元
[0194]
122 速度矢量获得单元
[0195]
123 传感器模型应用单元
[0196]
124 地图内位置控制单元
[0197]
125 感测反映单元
[0198]
130 障碍物检测单元
[0199]
140 移动规划单元
[0200]
150 动作规划单元
[0201]
160 动作控制单元
[0202]
200 传感器
[0203]
210 图像传感器
[0204]
220 imu
[0205]
230 距离传感器
[0206]
310、320 通信设备
[0207]
400 致动器
[0208]
500 显示设备
[0209]
600 输入设备
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献

  • 日榜
  • 周榜
  • 月榜