- 专利标题: 基于光纤应变传感器与单目相机融合的体内SLAM方法、系统
-
申请号: CN202111575033.5申请日: 2021-12-21
-
公开(公告)号: CN114463433B公开(公告)日: 2024-09-20
- 发明人: 王贺升 , 单纪伟 , 李乐天
- 申请人: 上海交通大学深圳研究院 , 上海交通大学
- 申请人地址: 广东省深圳市南山区粤海街道高新区南区虚拟大学园楼B202;
- 专利权人: 上海交通大学深圳研究院,上海交通大学
- 当前专利权人: 上海交通大学深圳研究院,上海交通大学
- 当前专利权人地址: 广东省深圳市南山区粤海街道高新区南区虚拟大学园楼B202;
- 代理机构: 上海段和段律师事务所
- 代理商 李佳俊
- 主分类号: G06T7/80
- IPC分类号: G06T7/80 ; G06T7/11 ; G06T7/20 ; G06T7/73 ; G06T17/05 ; A61B34/30 ; A61B90/00
摘要:
本发明提供了一种基于光纤应变传感器与单目相机融合的体内SLAM方法和系统,包括:视觉光纤时空对齐步骤;数据预处理步骤;系统初始化步骤;软组织运动形变剔除步骤;位姿计算与优化步骤。本发明还提供相应的计算机存储介质与手术机器人。本发明能适应动态、光照不足以及存在大量无纹理区域的体内环境,在使用相机图像进行位姿估计失败或者图像特征点不足时,能够使用光纤数据进行末端位姿估计,避免重定位环节。此外,光纤数据能够提供图像帧间的位姿约束,得到更加精确的位姿和地图点坐标,完成体内环境下对连续体机器人进行精确的末端定位和体内环境建图的任务。
公开/授权文献
- CN114463433A 基于光纤应变传感器与单目相机融合的体内SLAM方法、系统 公开/授权日:2022-05-10