- 专利标题: 一种遥操作用超声仿型探头姿态自校准方法、系统及装置
-
申请号: CN202110968185.5申请日: 2021-08-23
-
公开(公告)号: CN113768535B公开(公告)日: 2024-06-28
- 发明人: 闫琳 , 李淼 , 韩冬 , 付中涛 , 张少华 , 邓兆兴 , 刘辰 , 万志林 , 龙会才 , 马天阳
- 申请人: 武汉库柏特科技有限公司
- 申请人地址: 湖北省武汉市东湖新技术开发区高新大道999号未来科技城E2栋301、负201单元
- 专利权人: 武汉库柏特科技有限公司
- 当前专利权人: 武汉库柏特科技有限公司
- 当前专利权人地址: 湖北省武汉市东湖新技术开发区高新大道999号未来科技城E2栋301、负201单元
- 代理机构: 北京轻创知识产权代理有限公司
- 代理商 陈晓斌
- 主分类号: A61B8/00
- IPC分类号: A61B8/00
摘要:
本发明涉及一种遥操作用超声仿型探头姿态自校准方法、系统及装置,其方法包括,超声仿型探头在触控板上摆动,获取IMU传感器的实时姿态数据和触控板感应的实时平移数据;将实时姿态数据转换成欧拉角形式;根据实时平移数据计算出平移方向向量;根据欧拉角形式的实时姿态数据以及平移方向向量判断出摆动轴、摆动方向以及平移方向向量所在的象限;利用摆动轴、摆动方向以及平移方向向量所在的象限对应的姿态校准模型,对IMU传感器的航向角进行自校准。本发明可以对IMU传感器的航向角的漂移进行抑制,从而保证了使超声仿型探头到机器人末端超声探头的位置和姿态映射精度,进而提高了获取的超声图像质量。
公开/授权文献
- CN113768535A 一种遥操作用超声仿型探头姿态自校准方法、系统及装置 公开/授权日:2021-12-10