专利汇可以提供基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法专利检索,专利查询,专利分析的服务。并且基于 立体视觉 的 机器人 辅助穿刺手术末端工具中心标定方法,属于机器人控制领域,为实现机器人对针尖的精确控制,本本 发明 方法:对两个相机进行单目视觉标定,再进行双目系统视觉标定,进而建立视觉测量空间 坐标系 ;穿刺针在视觉测量空间范围内分别进行单平移和旋转平移运动;对移动操作中采集的 图像处理 生成封闭区域及该封闭区域的最小外接矩形;循环检测最小外接矩形的短边与封闭区域的交点,获取单平移运动过程中针尖在视觉测量空间坐标系中的 位置 变化描述及旋转平移运动过程中针尖在视觉测量空间坐标系中的位置变化描述;得到视觉测量空间坐标系和机器人基坐标系的 姿态 旋转关系;获取针尖相对于 机械臂 末端的位置描述,完成对针尖的位置标定。,下面是基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法专利的具体信息内容。
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] 。
标题 | 发布/更新时间 | 阅读量 |
---|---|---|
一种利用双目立体相机构建栅格地图的方法 | 2020-05-11 | 975 |
基于立体视觉的机器人辅助穿刺手术末端工具中心标定方法 | 2020-05-13 | 574 |
一种基于网络一体化和双目视觉技术的投掷物弹道轨迹测算系统 | 2020-05-14 | 386 |
一种基于同名标记点的双目视觉立体匹配方法及装置 | 2020-05-12 | 717 |
直线移动PTZ相机辅助双目PTZ视觉系统的主从跟踪方法 | 2020-05-13 | 398 |
一种用于虚拟定位的方法及设备 | 2020-05-13 | 532 |
一种基于虚拟现实与手势识别的远程呈现交互方法和系统 | 2020-05-14 | 254 |
一种基于编码结构光和双目的3D成像方法 | 2020-05-11 | 152 |
一种面向电力巡检任务的无人机双目视觉障碍物感知方法 | 2020-05-13 | 829 |
基于双目视觉的自动消防水炮的火焰检测方法 | 2020-05-13 | 242 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。