同时场景构建和定位算法是机器人自主导航的重要组成部分。针对传统算法不能应用于室外环境和缺乏定量分析的缺点,提出了一种单摄像机恢复场景三维结构和摄像机位姿的新算法。提出了视频序列关键帧提取方法,降低了运算复杂度; 利用特征点对和摄像机内参量计算场景三维结构和关键帧的位姿并提出一种估计关键帧位姿的简便方法; 最后,提出一种兼顾优化效果和运算复杂度的自适应光束法平差算法优化场景结构和摄像机位姿,并生成适于机器人导航的数字高程图。室内和室外多种场景下的定量和定性实验结果表明,绕行误差低于4%,该算法能够