- 专利标题: 基于点云数据的位姿控制方法、装置、设备及存储介质
-
申请号: CN202011615474.9申请日: 2020-12-30
-
公开(公告)号: CN112734830B公开(公告)日: 2022-05-03
- 发明人: 曹吉文 , 诸晓明 , 李禾源 , 赵明昌
- 申请人: 无锡祥生医疗科技股份有限公司
- 申请人地址: 江苏省无锡市新吴区硕放工业园五期51、53号地块长江东路228号
- 专利权人: 无锡祥生医疗科技股份有限公司
- 当前专利权人: 无锡祥生医疗科技股份有限公司
- 当前专利权人地址: 江苏省无锡市新吴区硕放工业园五期51、53号地块长江东路228号
- 代理机构: 北京三聚阳光知识产权代理有限公司
- 代理商 沈惠娟
- 主分类号: G06T7/70
- IPC分类号: G06T7/70 ; A61B8/00
摘要:
本发明公开了一种基于点云数据的位姿控制方法、装置、设备及存储介质,其中基于点云数据的位姿控制方法包括:获取扫查部位的点云数据,将点云数据重构成stl后得到stl数据模型;根据stl数据模型确定顶点列表、面列表和边列表;根据顶点列表和边列表识别穿过切平面的边,并计算所有穿过切平面的边与切平面的交点,得到交点列表;利用所有穿过切平面的边与面列表建立面边对,将所有穿过切平面的边在面边对上迭代,得到轨迹方向;将交点列表中的各个交点按照轨迹方向进行排序,得到运动轨迹,可以基于获取的点云数据和切平面自动构建出运动轨迹,使得通过机械臂控制超声探头进行乳腺扫描时,扫描顺序准确、扫描路径标准,减少误查的概率。
公开/授权文献
- CN112734830A 基于点云数据的位姿控制方法、装置、设备及存储介质 公开/授权日:2021-04-30