摘要
本发明提供一种水下机器人定位方法及系统,该方法包括:获取水下机器人采集到的相机图像和事件数据流;对所述事件数据流中的事件帧进行事件运动补偿,得到运动补偿后的事件帧;获取多个第一候选特征和多个第二候选特征,并分别对多个所述第一候选特征和多个所述第二候选特征进行多帧跟踪,确定第一永久地标和第二永久地标;根据标准帧重投影误差、事件帧重投影误差、惯性测量单元误差和多普勒速度仪速度误差,构建所述水下机器人的联合优化函数,并根据所述联合优化函数的求解结果,得到所述水下机器人的定位状态信息。本发明实现了弱光的水下环境中准确、鲁棒的水下机器人自主定位。
技术关键词
水下机器人
运动补偿
地标
误差
多普勒
三维坐标信息
三角测量原理
速度
相机
图像
金字塔光流法
非暂态计算机可读存储介质
像素
特征点
矩阵
系统为您推荐了相关专利信息
特征数据库
压载舱
船舶压载管
布置设计方法
三维模型
在线调控方法
航空发动机模型
航空发动机健康管理
参数
误差加权