基于点云数据的位姿控制方法、装置、设备及存储介质
摘要:
本发明公开了一种基于点云数据的位姿控制方法、装置、设备及存储介质,其中基于点云数据的位姿控制方法包括:获取扫查部位的点云数据,将点云数据重构成stl后得到stl数据模型;根据stl数据模型确定顶点列表、面列表和边列表;根据顶点列表和边列表识别穿过切平面的边,并计算所有穿过切平面的边与切平面的交点,得到交点列表;利用所有穿过切平面的边与面列表建立面边对,将所有穿过切平面的边在面边对上迭代,得到轨迹方向;将交点列表中的各个交点按照轨迹方向进行排序,得到运动轨迹,可以基于获取的点云数据和切平面自动构建出运动轨迹,使得通过机械臂控制超声探头进行乳腺扫描时,扫描顺序准确、扫描路径标准,减少误查的概率。
0/0