移动体以及计算机程序的制作方法

文档序号:20361000发布日期:2020-04-10 23:41阅读:来源:国知局

技术特征:

1.一种移动体,其具有:

至少1个马达;

驱动装置,其控制所述至少1个马达,使所述移动体移动;

第1传感器,其输出第1传感器数据,所述第1传感器数据表示通过第1感测方法根据所述移动体的移动而获取的感测结果;

第2传感器,其输出第2传感器数据,所述第2传感器数据表示通过与所述第1感测方法不同的第2感测方法根据所述移动体的移动而获取的感测结果;

第1测位装置,其利用所述第1传感器数据进行第1估计运算而估计所述移动体的位置;

第2测位装置,其利用所述第2传感器数据进行与所述第1估计运算不同的第2估计运算而估计所述移动体的位置;以及

运算电路,其根据可靠性数据是否与规定的条件一致,选择基于所述第1测位装置的估计结果以及基于所述第2测位装置的估计结果中的一方来作为所述移动体的位置,其中,所述可靠性数据表示基于所述第1测位装置的估计结果的准确程度。

2.根据权利要求1所述的移动体,其中,

所述第1传感器是激光测距仪,所述第2传感器是至少1个旋转编码器。

3.根据权利要求2所述的移动体,其中,

所述移动体还具有存储地图数据的存储装置,所述地图数据是预先根据从所述激光测距仪或其他激光测距仪周期性地输出的传感器数据制作而成的,

所述第1测位装置进行所述第1传感器数据与所述地图数据之间的核对,估计所述移动体的位置。

4.根据权利要求3所述的移动体,其中,

所述移动体还具有第1车轮以及第2车轮,

所述至少1个马达包含第1马达以及第2马达,

所述第1马达与所述第1车轮机械连接,

所述第2马达与所述第2车轮机械连接,

所述至少1个旋转编码器包含:第1旋转编码器,其测量从所述第1马达至所述第1车轮为止的动力传递机构的任一位置处的旋转;以及第2旋转编码器,其测量从所述第2马达至所述第2车轮为止的动力传递机构的任一位置处的旋转。

5.根据权利要求4所述的移动体,其中,

所述第1旋转编码器以及所述第2旋转编码器分别测量所述第1车轮以及所述第2车轮的旋转。

6.根据权利要求4或5所述的移动体,其中,

所述第2测位装置利用分别从所述第1旋转编码器以及所述第2旋转编码器输出的所述第2传感器数据,测量从所给予的初始位置起的相对位移量,估计从所述初始位置移动了所述位移量的位置来作为所述移动体的位置。

7.根据权利要求6所述的移动体,其中,

所述运算电路根据通过所述第1测位装置估计出的位置更新所述初始位置。

8.根据权利要求6或7所述的移动体,其中,

所述运算电路以规定的周期更新所述初始位置。

9.根据权利要求3至8中任意一项所述的移动体,其中,

所述第1测位装置输出表示所述第1传感器数据与所述地图数据之间的一致度的数据来作为第1可靠性数据。

10.根据权利要求9所述的移动体,其中,

所述运算电路在选择基于所述第1测位装置的估计结果来作为所述移动体的位置时,若所述第1可靠性数据的值为切换阈值以下,则选择基于所述第2测位装置的估计结果来作为所述移动体的位置。

11.根据权利要求9或10所述的移动体,其中,

所述运算电路输出以下两个位置之间的差来作为第2可靠性数据,

所述两个位置分别是:作为基于所述第1测位装置的估计结果得到的位置;以及作为基于所述第2测位装置的估计结果得到的位置。

12.根据权利要求11所述的移动体,其中,

所述运算电路在选择基于所述第1测位装置的估计结果来作为所述移动体的位置时,若所述第2可靠性数据的值为预先规定的容许值以上,则选择基于所述第2测位装置的估计结果来作为所述移动体的位置。

13.根据权利要求11或12所述的移动体,其中,

所述运算电路在选择基于所述第2测位装置的估计结果来作为所述移动体的位置时,若所述第1可靠性数据的值为预先规定的复原阈值以上并且所述第2可靠性数据的值小于预先规定的所述容许值,则选择基于所述第1测位装置的估计结果来作为所述移动体的位置。

14.根据权利要求9至13中任意一项所述的移动体,其中,

在所述运算电路选择基于所述第2测位装置的估计结果时,所述驱动装置使所述移动体以比所述运算电路选择基于所述第1测位装置的估计结果时慢的速度移动。

15.根据权利要求14所述的移动体,其中,

在所述运算电路选择基于所述第2测位装置的估计结果时,所述第1测位装置利用所述第1传感器数据和基于所述第2测位装置的估计结果来进行所述第1估计运算。

16.根据权利要求15所述的移动体,其中,

在所述第1测位装置进行所述第1估计运算而输出的所述第1可靠性数据的值为预先规定的复原阈值以上时,

所述驱动装置进一步降低所述移动体的速度,

所述第1测位装置再次进行所述第1估计运算。

17.根据权利要求16所述的移动体,其中,

在所述第1测位装置再次进行所述第1估计运算而再次输出的所述第1可靠性数据的值维持所述复原阈值以上时,

所述驱动装置增加所述移动体的速度。

18.根据权利要求16或17所述的移动体,其中,

在所述第1测位装置再次进行所述第1估计运算而再次输出的所述第1可靠性数据的值未维持所述复原阈值以上时,

所述驱动装置增加所述移动体的速度,

在经过规定时间之后,所述第1测位装置再次进行所述第1估计运算。

19.根据权利要求1至18中任意一项所述的移动体,其中,

所述运算电路在以下情况下,选择基于所述第2测位装置的估计结果来作为所述移动体的位置,

所述情况是:

根据基于所述第1测位装置的估计结果来估计出的所述移动体在一定时间内的移动距离与根据基于所述第2测位装置的估计结果来估计出的所述移动体在所述一定时间内的移动距离之差比第1阈值大的情况;或者

根据基于所述第1测位装置的估计结果来估计出的所述移动体在所述一定时间内的角度变化量与根据基于所述第2测位装置的估计结果来估计出的所述移动体在所述一定时间内的角度变化量之差比第2阈值大的情况。

20.根据权利要求1至19中任意一项所述的移动体,其中,

所述运算电路从外部接收目的地的指示,利用选择出的所述移动体的位置来控制所述驱动装置,使所述移动体朝所述目的地移动。

21.根据权利要求1至20中任意一项所述的移动体,其中,

所述运算电路在使所述移动体移动时,输出表示选择了基于所述第1测位装置的估计结果以及基于所述第2测位装置的估计结果中的哪一个的信号。

22.根据权利要求21所述的移动体,其中,

所述移动体还具有显示器,

所述运算电路将所述信号输出到所述显示器,

所述显示器接收所述信号,显示表示选择了所述第1测位装置以及所述第2测位装置中的哪一个的测位方式的信息。

23.根据权利要求21所述的移动体,其中,

所述运算电路将所述信号发送到所述移动体的外部的装置,

所述外部的装置接收所述信号,并作为光、声音或文字的信息来提示选择了所述第1测位装置以及所述第2测位装置中的哪一个的测位方式。

24.一种计算机程序,其通过移动体中的运算电路来执行,

所述移动体具有:

至少1个马达;

驱动装置,其控制所述至少1个马达,使所述移动体移动;

第1传感器,其输出第1传感器数据,所述第1传感器数据表示通过第1感测方法根据所述移动体的移动而获取的感测结果;

第2传感器,其输出第2传感器数据,所述第2传感器数据表示通过与所述第1感测方法不同的第2感测方法根据所述移动体的移动而获取的感测结果;

第1测位装置,其利用所述第1传感器数据进行第1估计运算来估计所述移动体的位置;

第2测位装置,其利用所述第2传感器数据进行与所述第1估计运算不同的第2估计运算来估计所述移动体的位置;以及

所述运算电路,

所述计算机程序使所述运算电路根据可靠性数据是否与规定的条件一致,选择基于所述第1测位装置的估计结果以及基于所述第2测位装置的估计结果中的一方来作为所述移动体的位置,其中,所述可靠性数据表示基于所述第1测位装置的估计结果的准确程度。


技术总结
使具有不同的感测方法的两种测位装置的移动体的行驶稳定化。移动体具有:马达;驱动装置,控制所述马达而使所述移动体移动;第1传感器以及第2传感器,分别输出第1传感器数据以及第2传感器数据,所述第1传感器数据以及第2传感器数据表示通过互不相同的感测方法并根据所述移动体的移动来获取的感测结果;第1测位装置,利用所述第1传感器数据进行第1估计运算来估计所述移动体的位置;第2测位装置,利用所述第2传感器数据进行第2估计运算来估计所述移动体的位置;以及运算电路,根据可靠性数据是否与规定的条件一致,选择基于所述第1测位装置的估计结果以及基于所述第2测位装置的估计结果中的一方来作为所述移动体的位置,所述可靠性数据表示基于所述第1测位装置的估计结果的准确程度。

技术研发人员:宫崎伊知朗;横山知好;清水仁
受保护的技术使用者:日本电产新宝株式会社
技术研发日:2018.07.26
技术公布日:2020.04.10
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1