基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法
专利汇可以提供基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法专利检索，专利查询，专利分析的服务。并且基于 立体视觉 的 机器人 辅助穿刺手术末端工具中心标定方法，属于机器人控制领域，为实现机器人对针尖的精确控制，本本 发明 方法：对两个相机进行单目视觉标定，再进行双目系统视觉标定，进而建立视觉测量空间 坐标系 ；穿刺针在视觉测量空间范围内分别进行单平移和旋转平移运动；对移动操作中采集的 图像处理 生成封闭区域及该封闭区域的最小外接矩形；循环检测最小外接矩形的短边与封闭区域的交点，获取单平移运动过程中针尖在视觉测量空间坐标系中的 位置 变化描述及旋转平移运动过程中针尖在视觉测量空间坐标系中的位置变化描述；得到视觉测量空间坐标系和机器人基坐标系的 姿态 旋转关系；获取针尖相对于 机械臂 末端的位置描述，完成对针尖的位置标定。，下面是基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法专利的具体信息内容。
1.基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法，其特征在于，该方法包括以下步骤：
步骤一、对两个相机进行单目视觉标定，每个相机分别建立各自的像平面坐标系；
所述两个相机均用于采集机器人辅助穿刺手术末端工具的图像，且两个相机的光轴垂直；
步骤二、进行双目系统视觉标定，进而建立视觉测量空间坐标系；
步骤三、拍摄视觉测量空间内无异物状态下的背光图像，以作为后期图像差分处理的背景；
步骤四、控制机械臂移动，将其末端的穿刺针放入视觉测量空间范围内，分别进行单平移运动和旋转平移运动，并拍摄图像；
步骤五、对移动操作中采集的所有图像依次进行与背景的差分运算、大津法阈值提取、开运算平滑边界、图像二值化，生成封闭区域及该封闭区域的最小外接矩形；
所述封闭区域为单平移运动形成的封闭区域或旋转平移运动形成的封闭区域；
步骤六、循环检测最小外接矩形的短边与封闭区域的交点，其所有交点的位置的均值即为针尖在两个像平面坐标系的位置，进而获取单平移运动过程中针尖在视觉测量空间坐标系中的位置变化描述及旋转平移运动过程中针尖在视觉测量空间坐标系中的位置变化描述；
步骤七、通过单平移运动过程中针尖在视觉测量空间坐标系中的位置变化描述与机械臂末端在机器人基坐标系中的位置变化描述的旋转矩阵，通过最小二乘法得到视觉测量空间坐标系和机器人基坐标系的姿态旋转关系；
步骤八、通过旋转平移运动过程中针尖在视觉测量空间坐标系中的位置变化描述、机械臂末端在机器人基坐标系中的位置变化描述及视觉测量空间坐标系和机器人基坐标系的姿态旋转关系，获取针尖相对于机械臂末端的位置描述，完成对针尖的位置标定。
2.根据权利要求1所述基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法，其特征在于，步骤一建立像平面坐标系，两个相机的像平面坐标系与像素坐标的关系分别为：
和
其中L表示a相机，R表示b相机，(XL,YL)表示a相机像平面坐标系下某点的坐标，(XR,YR)表示b相机像平面坐标系下某点的坐标；
SxL、SyL表示a相机像平面坐标系中单个像素在x方向和y方向代表的实际物理尺寸，SxR、SyR表示b相机像平面坐标系中单个像素在x方向和y方向代表的实际物理尺寸；
(u0L,v0L)表示a相机像素坐标系下的中心点坐标，(u0R,v0R)表示b相机像素坐标系下的中心点坐标；
(uL,vL)表示a相机像素坐标系下的某点坐标，(uR,vR)表示b相机像素坐标系下的某点坐标。
3.根据权利要求2所述基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法，其特征在于，步骤二建立视觉测量空间坐标系下的某点坐标(x,y,z)表示为：
其中，fL和fR分别表示a相机和b相机的镜头焦距；
r1～r9构建了a相机和b相机两个像平面坐标系的相对姿态转换关系矩阵该相对姿态转换关系矩阵 存在如下关系式：
式中：(xR,yR,zR)表示b相机的相机坐标系R下的某点坐标；
tx、ty、tz构建了a.相机的相机坐标系L和b相机的相机坐标系R两个坐标系的相对位置关系矩阵
根据相对姿态转换关系矩阵 相对位置关系矩阵 构建a相机和b相机两个相机坐标系的相对位姿关系矩阵
4.根据权利要求3所述基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法，其特征在于，步骤七的具体过程为：
将单平移运动获取的所有针尖在视觉测量空间坐标代入公式
中，
再通过最小二乘法获取觉测量空间坐标系V和机器人基坐标系B的转换关系式中：
第i次运动针尖在视觉测量空间中的三维坐标记作[PVi 1]Τ，
Τ
第i+1次运动针尖在视觉测量空间中的三维坐标记作[PVi+1 1] ，
表示第i次运动机械臂末端坐标系E与机器人基坐标系B的齐次空间相对位置关系，表示第i+1次运动机械臂末端坐标系E与机器人基坐标系B的齐次空间相对位置关系。
5.根据权利要求4所述基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法，其特征在于，步骤八的具体过程为：
将旋转平移运动获取的所有针尖在视觉测量空间坐标代入公式
中，
再通过最小二乘法获取针尖相对于机械臂末端位置在机械臂末端坐标系E中的三维坐Τ
标[PE 1] 。
基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法
技术领域
背景技术
发明内容
具体实施方式
表示第i次运动机器人末端法兰坐标系V与机器人基坐标系B的齐次空间
位姿转换关系，由 和 两部分组成分别描述第i次运动的姿态转换关系和相对位置关系。
| 标题 | 发布/更新时间 | 阅读量 |
|---|---|---|
| 一种基于深度感知的虚拟现实系统空间定位方法 | 2020-05-12 | 733 |
| 一种显示边缘图像的方法和电子设备 | 2020-05-11 | 984 |
| 智能清扫车多层次立体避障控制方法及装置 | 2020-05-11 | 81 |
| 一种头戴式助视装置 | 2020-05-11 | 35 |
| 古典影相中“雾”状印相方法 | 2020-05-11 | 196 |
| 一种基于个体化HRTF立体声的视觉辅助方法与设备 | 2020-05-11 | 15 |
| 测量系统中视觉图像传感器与光点测距传感器测量坐标系的统一方法 | 2020-05-12 | 438 |
| 一种基于编码结构光和双目的3D成像方法 | 2020-05-11 | 907 |
| 基于轨迹特征配准的多光谱立体相机自标定算法 | 2020-05-08 | 191 |
| 一种基于裸眼三维的近红外人脸识别方法 | 2020-05-08 | 109 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台，是提供专利分析，专利查询，专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据，免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析，涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度，系统通过AI智能系统对图表进行解读，只需1分钟，一键生成行业专利分析报告。
