[发明专利]相对位置测量装置、相对位置测量方法、以及相对位置测量程序

权利要求书

1.一种相对位置测量装置，其中，具备：

传感器，具有对图像进行拍摄的单眼摄像头、以及测量测量点的以传感器位置为基准的三维相对位置的测距部；以及

运算部，根据所述测量点的三维相对位置，来确定所述图像内的指定的对象点的以所述传感器位置为基准的三维相对位置。

2.根据权利要求1所述的相对位置测量装置，其中，

所述测距部对从所述传感器位置到所述测量点的测量点距离、以所述传感器位置为基准的测量点方位角、以及以所述传感器位置为基准的测量点仰角进行测量，

所述运算部根据所述图像，来计算以所述传感器位置为基准的对象点方位角、以及以所述传感器位置为基准的对象点仰角，根据所述对象点方位角以及所述对象点仰角和所述测量点方位角以及所述测量点仰角，来计算从所述传感器位置到所述对象点的对象点距离，从而确定所述对象点的所述三维相对位置。

3.根据权利要求2所述的相对位置测量装置，其中，

所述运算部使用所述测量点距离、所述对象点方位角与所述测量点方位角之差、以及所述对象点仰角与所述测量点仰角之差中的至少一个条件，从所述测距部所检测到的多个测量点中提取候补点，从所述候补点中确定与所述对象点对应的所述测量点。

4.根据权利要求1至3中任一项所述的相对位置测量装置，其中，

所述对象点是安装有相对位置测量装置的船舶的靠岸原点。

5.根据权利要求4所述的相对位置测量装置，其中，

所述运算部具备：

靠岸原点确定部，确定所述靠岸原点的以所述传感器位置为基准的三维相对位置；

岸壁线确定部，确定通过所述靠岸原点的岸壁线的以所述传感器位置为基准的三维相对位置；以及

相对位置计算部，使用所述靠岸原点和所述岸壁线，来计算从己方船舶位置到所述靠岸原点的与所述岸壁线平行的距离以及从所述己方船舶位置到所述靠岸原点的与所述岸壁线垂直的距离。

6.根据权利要求5所述的相对位置测量装置，其中，

所述运算部具备：

预测触发指定部，接受预测时刻的指定；

己方船舶位置预测部，以所述传感器位置为基准，预测所述预测时刻的己方船舶的三维相对位置；以及

相对位置预测部，使用所述靠岸原点和所述岸壁线，来计算所述预测时刻的从所述己方船舶的三维相对位置到所述靠岸原点的与所述岸壁线平行的距离、以及所述预测时刻的从所述己方船舶的三维相对位置到所述靠岸原点的与所述岸壁线垂直的距离。

7.根据权利要求6所述的相对位置测量装置，其中，

所述预测触发指定部使用时间间隔或移动距离间隔，来指定所述预测时刻。

8.根据权利要求6所述的相对位置测量装置，其中，

所述预测触发指定部通过从所述己方船舶位置到所述靠岸原点的距离，来指定所述预测时刻。

9.根据权利要求6所述的相对位置测量装置，其中，

所述预测触发指定部使用所述己方船舶的过去的移动信息，来指定所述预测时刻。

10.根据权利要求5至9中任一项所述的相对位置测量装置，其中，

所述岸壁线确定部使用所述靠岸原点，来确定所述岸壁线。

11.根据权利要求5至9中任一项所述的相对位置测量装置，其中，

所述靠岸原点确定部使用所述岸壁线以及以所述传感器位置为基准的对象点方位角，来确定所述靠岸原点。

12.根据权利要求1至11中任一项所述的相对位置测量装置，其中，具备：

位置姿态测量部，对所述传感器的位置以及姿态进行测量，

所述运算部使用所述位置以及所述姿态，来计算将所述对象点的所述三维相对位置变换为世界坐标系的坐标变换矩阵，使用所述坐标变换矩阵，在所述世界坐标系中计算所述对象点的所述三维相对位置。