[发明专利]一种实现自动化机械操作臂路径规划的方法有效
申请号: | 201910595114.8 | 申请日: | 2019-07-03 |
公开(公告)号: | CN110215339B | 公开(公告)日: | 2022-01-07 |
发明(设计)人: | 黄凯;白善荣;夏俊 | 申请(专利权)人: | 中山大学 |
主分类号: | A61F9/008 | 分类号: | A61F9/008;A61B34/30 |
代理公司: | 广州粤高专利商标代理有限公司 44102 | 代理人: | 陈伟斌 |
地址: | 510275 广东*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 实现 自动化 机械 操作 路径 规划 方法 | ||
1.一种自动化机械操作臂,包括机器操作臂和安装于所述机器操作臂上的手术刀(1),所述机器操作臂包括夹持所述手术刀(1)的夹持装置(2)和驱动所述夹持装置(2)摆动的驱动臂;所述驱动臂上设置有第一线性马达(3)和第二线性马达(4),所述夹持装置(2)装有第三线性马达(5),其特征在于,还包括显微镜摄像系统,所述机械操作臂的通过以下步骤运行:
步骤一:使用显微镜摄像系统以a毫米垂直位移拍摄两幅眼部图像;
步骤二:对每幅图像进行预处理,转换为具有灰度值的图像,并对第一幅图像进行角点检测,得到若干候选角点,并且得到所述角点的坐标;
步骤三:若干所述角点以各自为中心,Rj为半径,求出相对于角点的黑点和白点,并且黑点位于角点白色像素区域和白点位于角点的黑色区域,且黑点的像素灰度0.5且白点的像素灰度0.5,则该角点为手术刀点P′i,黑点和白点位置的计算公式如下:
其中,Xblacki和Yblacki分别为黑点的坐标值,Xwhitei和Ywhitei分别白点的坐标值,Xj和Yj是以角点为中心,Rj为半径的范围内所有像素点的各自坐标,I为该点的灰度值,range为选取的半径最大值;Xi、Yi分别为手术刀点P′i的坐标值;
步骤四:对第一幅图像的P′i向第二幅图像进行匹配,得到匹配点P″i、P′i和P″i之间的像素距离;
步骤五:手术刀点的深度计算公式如下:
其中,r为手术刀点P′i与显微镜放大中心之间的距离,Δr为P′i和P″i之间的像素距离,称为视差;
步骤六:获取目标点后所述机器操作臂沿着设定的路径运动。
2.根据权利要求1所述的一种自动化机械操作臂,其特征在于,在所述步骤四中,匹配的方法为在P′i建立一个以P′i为中心的基础点方块区域,定义P′i以外的点为邻近点,定义每个邻近点相对于P′i的深度一致;在对方块区域所有的基础点进行匹配,计算分别在第二幅图像对应的匹配点,匹配点和对应的视差通过选择使得代价函数数值最小的视差来计算得出,其中,代价函数公式为:
C(P′ij,Δr)=min{d(P′ij,P′ij-Δr,IZ,Iz-a),d(P′ij-Δr,P′ij,IZ-a,Iz}
d(P′ij,P′ij-Δr,Iz,Iz-a)=minP′ij-Δr-0.5
≤P′ij-Δr+0.5{|Iz(P′ij)-Iz-a(P″ij)|}
其中,P′ij为对应基础点的像素位置,P″ij为对应匹配点的像素位置,Iz为第一幅图像中每个像素的灰度值,Iz-a为第二幅图像中每个图像的灰度值,Iz(P′ij)为P′ij的灰度值,Iz-a(P″ij)为P″ij的灰度值。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中山大学,未经中山大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910595114.8/1.html,转载请声明来源钻瓜专利网。