自主移动体的制作方法

本发明涉及由传感器计测自身位置并控制移动单元来向目标场所自主移动的自主移动体。

背景技术：

以往，已提出能够一边通过各种传感器来掌握自身位置一边向目标场所自主移动的自主移动体。这样的自主移动体在自身位置的取得失败时无法到达预先设定的场所，无法进行目标作业。

例如，在专利文献1中公开了如下自主飞行机器人：一边使用预先存储的包含建筑物等障碍物的地图信息和传感器的计测结果来取得自身位置,一边自主地进行移动。该自主飞行机器人在由于卡车等较大的障碍物出现而导致周围的环境发生较大变化、不再能取得自身位置的情况下，通过提高飞行高度并再次取得自身位置来进行目标作业。

现有技术文献

专利文献1：日本特开2014-149622号公报

技术实现要素：

发明要解决的技术问题

然而，对于所述自身位置的再次取得技术，无法适用于在地上行驶的自主移动体，另外，在高空存在桥或电线的情况下，有时也难以提高高度。

另外，由于是在地图信息和来自传感器的信息变得不一致的情况下再次取得自身位置，因此无法应对因其他原因导致不再能取得自身位置的情况。

本发明是鉴于上述问题而完成的，提供一种不管自身位置取得的方式和迷失自身位置的原因如何，都能够以高可靠度持续维持自身位置的自主移动体。

用于解决问题的技术方案

为了达成上述目的，本发明所涉及的自主移动体是由传感器计测自身位置并控制移动单元来向目标场所自主移动的自主移动体，所述自主移动体具备：传感器信息取得单元，其从所述传感器取得与自身位置有关的传感器信息；位置推定单元，其基于所述传感器信息取得单元取得的传感器信息来推定自身位置；可靠度算出单元，其算出由所述位置推定单元推定的自身位置的可靠度；位置可靠度记录单元，其将由所述可靠度算出单元算出的可靠度与由所述位置推定单元推定出的自身位置关联地进行记录；以及可靠度恢复行动控制单元，其在所述可靠度算出单元算出的可靠度满足预定条件的情况下，基于由所述位置可靠度记录单元记录的信息来控制所述移动单元以使得所述自主移动体移动到可靠度高的位置。

发明的效果

根据本发明，在掌握自身位置的可靠度而低于预定基准的情况下，能够基于实际成果移动到能够以高可靠度取得自身位置的位置，因此能够一边稳定地以高可靠度掌握自身位置一边自主地进行移动。

附图说明

图1是表示实施方式1涉及的自主移动体的外观的立体图。

图2是将控制单元所具备的功能部的一部分与机构部的一部分一起表示的框图。

图3是在视觉上示出存储部所存储的数据的一例的图。

图4是表示实施方式1涉及的可靠度恢复行动控制单元的处理的流程的流程图。

图5是以立体方式示出以自身位置为中心时的可靠度的位置分布的立体图。

图6是将实施方式2涉及的控制单元所具备的功能部的一部分与机构部的一部分一起表示的框图。

图7是表示在期待值算出单元算出期待值时所形成的区域的图像的立体图。

图8是表示进行桥梁检查作业的自主移动体的立体图。

标号说明

100自主移动体

101移动单元

103传感器

104控制装置

111旋翼

112马达

140存储部

141传感器信息取得单元

142位置推定单元

143可靠度算出单元

144位置可靠度记录单元

145可靠度恢复行动控制单元

146期待值算出单元

200桥梁

210gps卫星

具体实施方式

接着，参照附图对本发明涉及的自主移动体的实施方式进行说明。此外，以下的实施方式只不过示出本发明涉及的自主移动体的一例。因此，本发明是以以下的实施方式作为参考而通过权利要求书的记载划定了保护范围，而不是仅限定于以下的实施方式。由此，关于以下的实施方式中的构成要素中的未记载在表示本发明的最上位概念的独立权利要求中的构成要素，不一定是为了解决本发明的问题而必须的，而是作为构成更优选的实施方式的构成要素进行说明。

另外，附图是为了表达本发明而适当进行了强调、省略、比例调整的示意性的图，有时不同于实际的形状、位置关系、比例。

(实施方式1)

以下，作为自主移动体100的例子，使用自主飞行体即所谓的无人机(drone)对本发明的实施方式1进行说明。

图1是表示本实施方式涉及的自主移动体的外观的立体图。

图2是将控制单元所具备的功能部的一部分与机构部的一部分一起表示的框图。

如这些图所示，本实施方式中所利用的自主移动体100具备：作为移动单元101的多个旋翼111(螺旋桨)、分别单独地驱动旋翼111的多个马达112、用于取得自身位置的传感器103、以及取得来自传感器103的信号并控制马达112来掌管自立移动的控制装置104。

具备多个旋翼111的无人机式的自主移动体100通过对各个旋翼111的转速进行单独地控制，能够进行自主移动体100向各种方向(例如，前后左右上下)的移动和/或姿势的调节。在本实施方式的情况下，控制装置104也从移动单元101取得基于旋翼111的转速的控制状态的信息来作为传感器信息，并用作推定自身位置的信息之一。

传感器103只要是能够通过计测来取得用于推定自身位置的信息的装置，并没有特别限定。具体而言，作为传感器103，可以例示检测3轴方向的角度和/或各速度以及3轴方向的加速度的惯性计测装置(imu：inertialmeasurementunit)、压力计(高度计)、流量计(风速计)、gps(globalpositioningsystem，全球定位系统)接收机、lrf(laserrangefinder，激光测距机)、深度摄像头等。另外，自主移动体100装配有多种传感器103中的一种或多种传感器103。另外，所装配的传感器103根据自主移动体100的种类、移动目的、和/或移动场所来适当选择。

如图2所示，控制装置104是基于从传感器103等取得的信息控制移动单元101来使自主移动体100移动的装置，是具备通过执行存储部140等所存储的程序来进行各种处理的所谓cpu等的计算机。控制装置104具备传感器信息取得单元141、位置推定单元142、可靠度算出单元143、位置可靠度记录单元144和可靠度恢复行动控制单元145来作为通过程序执行的处理部。

存储部140是rom(readonlymemory，只读存储器)、hdd(harddiskdrive，硬盘驱动器)等信息存储装置，存储与各处理部对应的程序和/或自身位置等。另外，存储部140也存储示出目的地的位置信息、路线和/或障碍物等的地图信息等。

传感器信息取得单元141是取得传感器103所计测到的信号来作为用于自身位置推定的传感器信息的处理部。另外，传感器信息取得单元141也取得从移动单元101获得的信息、例如多个旋翼111各自的转速等控制信息来作为传感器信息。

位置推定单元142是基于传感器信息来推定与自主移动体100当前的位置有关的自身位置的处理部。在本实施方式的情况下，位置推定单元142基于多个传感器信息来算出实际上传感器103测定出的结果即测定位置。接着，位置推定单元142对多个测定位置进行整合并进行推定自身位置的处理。推定自身位置的方法没有特别限定，例如对于基于从gps卫星接收到的信号而算出的测定位置和基于来自惯性计测装置的传感器信息而算出的测定位置等，也可以通过卡尔曼滤波器来推定自身位置。另外，对于通过对来自深度摄像头的传感器信息与存储在存储部140中的地图信息进行对照而算出的测定位置、和基于来自惯性计测装置的传感器信息而算出的测定位置等，也可以通过slam(simultaneouslocalizationandmapping，同步定位与地图构建)来推定。

在作为位置推定单元142采用了卡尔曼滤波器的情况下，自身位置表现为正态分布。正态分布的方差根据从最后观测绝对位置起的经过时间或移动量而增加，通过观测绝对位置而减小。也就是说，可靠度根据从最后观测绝对位置起的经过时间或移动量而降低，通过观测绝对位置而增加(恢复)。绝对位置的观测通过基于gps的测位和/或位置已知的路标的观测来进行。

可靠度算出单元143是基于进行计测的传感器103自身的可靠度、历时降低的可靠度、推定自身位置时已使用的传感器信息的误差等来算出自身位置的可靠度的处理部。例如，可靠度算出单元143使用在位置推定单元142推定自身位置时所使用的分布(例如正态分布)，将方差的倒数算出为可靠度。

位置可靠度记录单元144是将由位置推定单元142推定出的自身位置与由可靠度算出单元143算出的可靠度关联地记录于存储部140的处理部。在本实施方式的情况下，如图3所示，位置可靠度记录单元144对已关联的自身位置和可靠度进一步关联时刻信息并记录于存储部140。在此，时刻信息例如是表示由位置推定单元142推定了自身位置时的时刻的信息。此外，在图3中，对于与可靠度以外的时刻和坐标有关的信息，记载有用于互相区分的识别记号，它们并没有具体的含义。

可靠度恢复行动控制单元145是在可靠度算出单元143算出的可靠度满足预定条件的情况下，基于由位置可靠度记录单元144记录的信息来控制移动单元101以使得移动到可靠度高的位置的处理部。

图4是表示可靠度恢复行动控制单元的处理的流程的流程图。

如该图所示，可靠度恢复行动控制单元145判定可靠度是否满足预定条件(s101)。在可靠度不满足预定条件的情况下(s101：否)，维持通常作业。在此，通常作业例如是指自主移动体100向目标位置移动的作业、在目标位置进行检查等作业。

以下列举可靠度满足预定条件的情况下的具体的判定方法的例子(pattern，模式)。

1-1.可靠度恢复行动控制单元145逐次取得由可靠度算出单元143算出的可靠度，在所取得的可靠度低于预先确定的第二阈值的情况下，视为可靠度低下而执行恢复控制(s103)。

1-2.可靠度恢复行动控制单元145在存储部140所存储的可靠度内对所回溯的预定期间的可靠度进行统计处理来逐次算出统计可靠度。然后，可靠度恢复行动控制单元145算出从可靠度算出单元143逐次取得的可靠度与所述统计可靠度的差分，在差分为第三阈值以上的情况下，视为可靠度急剧降低而执行恢复控制(s103)。

1-3.可靠度恢复行动控制单元145从当前开始回溯并调查存储部140所存储的可靠度，在可靠度持续降低的期间比预先确定的第四阈值长的情况下，视为可靠度低下而执行恢复控制(s103)。

接着，以下列举用于恢复的具体的控制方法的例子(模式)。

2-1.可靠度恢复行动控制单元145基于存储部140所记录的可靠度，控制移动单元101以使得追寻存储部140所记录的自身位置进行逐次移动直到可靠度成为第一阈值以上为止。

具体基于图3所示的数据进行说明。作为前提，当前时刻是6，第一阈值是0.8。可靠度恢复行动控制单元145控制移动单元101来使自主移动体100移动，以使得追寻当前位置g(可靠度0.3)→f(可靠度0.5)→e(可靠度0.6)→d(可靠度0.8)的坐标。也就是说，使自主移动体100沿着来的路线后退，直到可靠度为第四阈值以上的坐标为止。

根据以上所述，在可靠度高的坐标位置再次推动自身位置，过渡到用于实施通常作业的行动。

这样的恢复行动在自主移动体100在初次空间中移动和/或由于突然产生的风等导致可靠度急剧降低等情况下有效。

2-2.可靠度恢复行动控制单元145控制移动单元101，以使得移动到存储部140所存储的可靠度为第一阈值以上且与当前的自身位置最接近的位置。

具体而言，如图5所示，从存储部140中提取以可靠度满足预定条件时(当前时刻6)的自主移动体100的自身位置为中心而位于其周围(上下、前后、左右)且可靠度为第一阈值(0.8)以上的坐标(a、c、d)。进而，算出各坐标与当前的自身位置之间的欧几里得距离，控制移动单元101以使得向欧几里得距离最小的坐标(d)以直线方式移动，使自主移动体100移动到坐标d。

根据以上所述，能够以较短的时间到达可靠度高的坐标位置，能够在该坐标再次推定自身位置，以较短的时间过渡到用于实施通常作业的行动。

这样的恢复行动在自主移动体100在狭窄的范围内进行诸如检查作业等情况下有效。

2-3.可靠度恢复行动控制单元145控制移动单元101，以使得移动到可靠度为第一阈值以上、且与最接近当前时刻的时刻信息关联的位置。

具体基于图3所示的数据进行说明。作为前提，当前时刻是6，第四阈值是0.8。可靠度恢复行动控制单元145按5(可靠度0.5)→4(可靠度0.6)→3(可靠度0.8)回溯时间并检查可靠度，控制移动单元101以使得向可靠度为第四阈值以上的坐标即坐标(d)以直线方式移动，使自主移动体100移动到坐标d。

根据以上所述，能够以较短的时间到达可靠度高的坐标位置，能够在该坐标再次推定自身位置，以较短的时间过渡到用于实施通常作业的行动。

这样的恢复行动在自主移动体100在障碍物少的宽阔空间内移动等情况下有效。

(实施方式2)

接着，对自主移动体100的其他实施方式进行说明。此外，对具有与所述实施方式1同样的作用和/或功能、同样的形状、机构和/或构造的部分标注相同的标号，有时省略说明。另外，以下以与实施方式1不同之处为中心来进行说明，有时对相同的内容省略说明。

图6是将本实施方式涉及的控制单元所具备的功能部的一部分与机构部的一部分一起表示的框图。

本实施方式涉及的控制装置104除了追加有期待值算出单元146之外，与实施方式1同样。

期待值算出单元146是如下处理部：以自主移动体100的自身位置为中心对空间进行分割，基于存储在存储部140中的、且分割后的各区域所包含的可靠度，按区域来算出期待值。

具体而言，如图7中的图像所示，期待值算出单元146以可靠度满足预定条件时的自主移动体100的自身位置为中心呈放射状来分割区域，从存储部140中提取各区域所包含的可靠度。然后，对各区域所包含的多个可靠度分别进行统计处理，按区域算出期待值。在本实施方式的情况下，对已关联的自身位置和可靠度不一定需要关联时刻。

在本实施方式的情况下，可靠度恢复行动控制单元145的具体的判定方法如下。

2-4.在可靠度满足预定条件的情况下，可靠度恢复行动控制单元145从期待值算出单元146取得按区域的期待值。进而，进行期待值的比较，控制移动单元101以使得向期待值最大的区域的方向以直线方式移动，使自主移动体100移动到坐标d。另外，可靠度恢复行动控制单元145使自主移动体100移动，直到最靠近可靠度为第一阈值以上的坐标位置。

根据以上所述，能够以高的概率到达可靠度高的坐标位置，能够在该坐标再次推定自身位置，更切实地过渡到用于实施通常作业的行动。

这样的恢复行动在自主移动体100大范围地移动、长期地在同一区域内进行多次作业等情况下有效。

(实施例)

接着，说明自主移动体100的具体的实施例。

图8是表示进行桥梁检查作业的自主移动体的立体图。

如该图所示，在本实施例的情况下，自主移动体100是无人机。另外，自主移动体100要实施的作业是桥梁200下表面的检查，是自主移动体100通过搭载于上部的检查用摄像头对桥梁200的下表面大范围地进行拍摄的作业。此外，基于由自主移动体100拍摄到的影像和进行了拍摄的位置，进行构造部件的裂纹的检测等。

在这样的作业中，自主移动体100从预定的位置a开始飞行，在时刻3到达作为经过位置的位置d。位置d是能够以高灵敏度接收来自gps卫星210的信号的位置，可靠度成为0.8。

接着，自主移动体100一边基于来自imu或gps等传感器103的传感器信息使用卡尔曼滤波器来推定自身位置，一边在时刻4到达桥梁200的下方即位置e并开始桥梁200的拍摄。对于桥梁200的下方，不容易接收到来自gps卫星210的信号，但可基于来自imu等传感器103的传感器信息推定自身位置，其可靠度成为0.6。

接着，一边在桥梁200的下方移动一边进行桥梁200的拍摄，从位置e前进到位置f，从位置f前进到位置g。在从位置e经过位置f朝向位置g的过程中，自主移动体100无法取得来自gps卫星210的信号，因此自身位置的可靠度随着时间而不断降低。

在到达了位置g的阶段可靠度低于了预先确定的第二阈值(0.3)，因此可靠度恢复行动控制单元145控制移动单元101，以使得移动到存储部140所存储的可靠度为第一阈值(0.7)以上且与当前的自身位置g最接近的位置即位置d。

通过移动单元101的控制，以直线方式移动到位置d的自主移动体100，自身位置的可靠度得到了恢复，因此以直线方式返回到开始执行恢复行动的位置g，再次进行桥梁200的拍摄。

通过如上述那样使自主移动体100移动，能够一边将自身位置的可靠度维持在高可靠度的状态一边高效地进行作业。

此外，本发明并不限定于上述实施方式。例如，可以对本说明书中记载的构成要素进行任意组合，另外也可以将除去几个构成要素而实现的其他的实施方式作为本发明的实施方式。另外，在不脱离本发明的主旨即权利要求书中记载的语言所表示的意思的范围内对上述实施方式实施本领域技术人员想到的各种变形而得到的变形例也包含在本发明中。

例如，在上述实施方式中，作为自主移动体100例示了能够在三维方向自由移动的自主飞行体即所谓的能够在空中飞行的无人机，但自主移动体100并不限定于此。作为自主移动体100，例如也可以列举在地面行驶的自主行驶车、在水面航行的自主船等。

另外，传感器103只要能够对有助于推定自身位置的信息进行测定，并不特别限定，包括已经列举的传感器以外的所有传感器。

另外，设为了将所有的处理部由一个控制装置104来实现，但也可以由多个控制单元来分担各处理，并通过相互的通信来收发信息。

另外，期待值算出单元146在放射状的区域中算出了期待值，但并不限定于此，也可以对图5所示那样的块状的区域算出期待值等任意地分割区域。

另外，结束恢复行动的条件也可以是：在恢复行动中也逐次算出自身位置和可靠度，通过获得的可靠度高于预定值来结束恢复行动。另外，也可以在目的地与自身位置一致的情况下结束。

另外，在可靠度恢复之后，可以返回到开始恢复行动的地点，也可以从可靠度已恢复的位置直接去往目的地。

产业上的可利用性

本发明能够利用于自主移动的车辆、火车、船舶、航空器、吸尘器等。