[发明专利]位置估计装置，跟踪器，位置估计方法和程序

权利要求书

1.一种位置估计装置，包括：

点云存储部分，其存储使用公共坐标系表示位置的公共点云；以及

估计部分，其估计第一跟踪器在所述公共坐标系中的位置或方向，以及第二跟踪器在所述公共坐标系中的位置或方向，其中

所述估计部分基于所述公共点云和第一特征点数据估计所述第一跟踪器在所述公共坐标系中的所述位置或方向，所述第一特征点数据指示多个特征点的相对位置，并且是基于由所述第一跟踪器获取的第一感测数据生成的，并且

所述估计部分基于所述公共点云和第二特征点数据估计所述第二跟踪器在所述公共坐标系中的所述位置或方向，所述第二特征点数据指示多个特征点的相对位置，并且是基于由所述第二跟踪器获取的第二感测数据生成的。

2.根据权利要求1所述的位置估计装置，还包括：

发送部分，其中

所述发送部分将指示所述第一跟踪器在所述公共坐标系中的所述位置或方向的数据发送给所述第一跟踪器，并且

所述发送部分将指示所述第二跟踪器在所述公共坐标系中的所述位置或方向的数据发送给所述第二跟踪器。

3.根据权利要求2所述的位置估计装置，其中，

所述发送部分还将指示所述第二跟踪器在所述公共坐标系中的所述位置或方向的数据发送给所述第一跟踪器，并且

所述发送部分还将指示所述第一跟踪器在所述公共坐标系中的所述位置或方向的数据发送到所述第二跟踪器。

4.根据权利要求1至3中任一项所述的位置估计装置，还包括：

添加部分，其基于所述公共点云和所述第一特征点数据，向所述公共点云添加在所述公共坐标系中的一个或多个位置处布置的一个或多个点，所述一个或多个位置与包含在所述第一特征点数据中的一个或多个所述特征点的一个或多个位置相关联。

5.根据权利要求1至3中任一项所述的位置估计装置，其中，

所述点云存储部分还存储使用不同于所述公共坐标系的单独坐标系表示位置的单独点云，

所述位置估计装置还包括：

添加部分，当确定包含在所述公共点云中的多个点中的一些与包含在所述单独点云中的一些点一致时，将与包含在所述单独点云中的所述一些点相对应的点添加到所述公共点云中，

在执行将与包含在所述单独点云中的所述一些点相对应的所述点添加到所述公共点云中之前，所述估计部分基于所述单独点云和所述第一特征点数据估计所述第一跟踪器在所述单独坐标系中的位置或方向，并且

在执行将与包含在所述单独点云中的所述一些点相对应的所述点添加到所述公共点云中之后，所述估计部分基于所述公共点云和所述第一特征点数据估计所述第一跟踪器在所述公共坐标系中的位置或方向。

6.根据权利要求1至5中任一项所述的位置估计装置，还包括：

接收部分，其中

所述接收部分从所述第一跟踪器接收所述第一特征点数据，

所述接收部分从所述第二跟踪器接收所述第二特征点数据，

所述估计部分基于由所述接收部分接收到的所述第一特征点数据，估计所述第一跟踪器在所述公共坐标系中的所述位置或方向，并且

所述估计部分基于由所述接收部分接收到的所述第二特征点数据，估计所述第二跟踪器在所述公共坐标系中的所述位置或方向。

7.根据权利要求1至5中任一项所述的位置估计装置，还包括：

接收部分；以及

特征点数据生成部分，其生成所述第一特征点数据和所述第二特征点数据，其中

所述接收部分从所述第一跟踪器接收所述第一感测数据，

所述接收部分从所述第二跟踪器接收所述第二感测数据，

所述特征点数据生成部分基于所述接收到的第一感测数据生成所述第一特征点数据，

所述特征点数据生成部分基于所述接收到的第二感测数据生成所述第二特征点数据，

所述估计部分基于由所述特征点数据生成部分生成的所述第一特征点数据，估计所述第一跟踪器在所述公共坐标系中的所述位置或方向，并且

所述估计部分基于由所述特征点数据生成部分生成的所述第二特征点数据，估计所述第二跟踪器在所述公共坐标系中的所述位置或方向。