US Patent 11263774 Three-dimensional position estimation device and program

A three-dimensional position estimation device includes: a feature point detection unit detecting feature points from images captured by an image capturing device mounted in a moving object; a position-posture change amount calculation unit calculating change amounts of a position and a posture of the moving object; a feature point association unit associating feature points using a feature amount indicating a feature of the feature point; a three-dimensional position acquisition unit acquiring three-dimensional positions of the feature points and acquires a position and a posture of the image capturing device; a graph structure data generation unit generating graph structure data configured with feature point and image nodes, and a feature point and image capturing edges; an error function setting unit setting first and second error functions; and a graph structure data optimizing unit optimizing the three-dimensional position and the position and the posture of the image capturing device.