[发明专利]三维位置估计装置以及程序

摘要

本发明能够精度良好地估计特征点的三维位置。图形结构数据生成部(390)生成由规定特征点的三维位置的特征点节点、规定拍摄装置的位置以及姿势的拍摄节点、规定拍摄节点上的特征点节点的位置的特征点边缘、以及规定拍摄节点间的移动体的位置以及姿势的变化量的拍摄边缘构成的图形结构数据，误差函数设定部(400)设定表示使用拍摄节点对特征点节点的特征点进行投影时的投影误差的第一误差函数，并且将表示拍摄边缘规定的位置以及姿势的变化量的误差的第二误差函数设定为表示与该拍摄边缘对应的该移动体的姿势的变化量越小越包含较大的权重，图形结构数据优化部(410)优化图形结构数据，以使第一误差函数与第二误差函数之和最小。