CN106725861A - 一种手术机器人末端工具碰撞位置检测方法 - Google Patents
一种手术机器人末端工具碰撞位置检测方法 Download PDFInfo
- Publication number
- CN106725861A CN106725861A CN201710081187.6A CN201710081187A CN106725861A CN 106725861 A CN106725861 A CN 106725861A CN 201710081187 A CN201710081187 A CN 201710081187A CN 106725861 A CN106725861 A CN 106725861A
- Authority
- CN
- China
- Prior art keywords
- collision
- axis
- operating robot
- force sensor
- robot end
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Manipulator (AREA)
Abstract
本发明公开一种手术机器人末端工具碰撞位置检测方法,包括末端工具的重力校准、动态误差补偿和碰撞点坐标求解,在基本的力学公式M=F×L的基础上,结合碰撞物体的三位点云信息,最终搜索出误差最小的碰撞点坐标,并将其显示在三维导航图像上。本发明使用六维腕力传感器结合术前三维手术设计信息来计算碰撞位置,既可以在没有视觉系统的条件下实现碰撞位置检测,又可以结合视觉系统完成更精确的术中碰撞位置检测,方法合理实用。
Description
技术领域
本发明涉及骨科手术机器人领域,尤其涉及一种手术机器人末端工具碰撞位置检测方法。
背景技术
碰撞检测是手术机器人系统的基本要素和重要安全保障。目前,手术机器人末端碰撞检测主要还是依靠视觉的方式,通过图像导航系统来辅助检测碰撞位置,这种方式除了存在一定的延时以外,其主要的缺陷是无法检测视觉不可见或有遮挡的区域。而在骨科手术中,大部分碰撞都发生在不可见的区域。
发明内容
本发明的目的在于克服现有技术的不足,提供一种手术机器人末端工具碰撞位置检测方法,通过六维腕力传感器检测到的力和力矩并结合所把持的骨块表面的三维点云信息,可以反求出碰撞点的位置信息,与图像导航信息结合,提供更为精确和完整的碰撞位置检测信息。
为实现上述目的,本发明采用下述技术方案:
一种手术机器人末端工具碰撞位置检测方法,包括末端工具的重力校准、动态误差补偿和碰撞点坐标求解,具体包括以下步骤:
步骤1在手术机器人末端通过法兰盘安装六维腕力传感器,所述的六维腕力传感器上安装能够连接多种骨科手术器械的特制法兰;所述的特制法兰安装在六维腕力传感器的原点,其轴线方向为六维腕力传感器的Z轴方向;
步骤2手术机器人末端工具通过六维腕力传感器采集力F和力矩M的值;
步骤3手术机器人末端工具的重力校准,即在术前手术设计和机器人路径规划阶段,计算出在整个路径中的各位置处,六维腕力传感器的力F和力矩M的预测值F’和M’;当手术机器人末端位置不发生移动,且F和M的真实值不断增加,并与预测值之间的插值超过一定阈值即视为发生碰撞;
步骤4当发生碰撞时,连续采集3组以上的F和M的值,并计算出相邻两组值之间的差值ΔF和ΔM,即力和力矩的导数,并将ΔF和ΔM用于力学公式“M=F×L”中,构成方程组:
及
其中,Fx、Fy、Fz分别为六维腕力传感器检测碰撞位置X、Y、Z方向的力,Mx、My、Mz分别为X、Y、Z方向的力矩;Fx1……Fxn,Fy1……Fyn,Fz1……Fzn分别为采集n组X、Y、Z方向的力;Mx1……Mxn,My1……Myn,Mz1……Mzn分别为采集n组X、Y、Z方向的力矩;
根据碰撞点三维坐标解算方法,在术前设计中预测的碰撞点云范围内,搜索上述方程组误差最小的点坐标,即为所求出的碰撞位置坐标;在基本的力学公式M=F×L的基础上,结合碰撞物体的三位点云信息,最终搜索出误差最小的碰撞点坐标,并将其显示在三维导航图像上。
步骤5将碰撞位置坐标及时的反馈到术中三维导航的图像上,实现于图像导航结合的碰撞位置检测及引导功能。
所述的六维腕力传感器的力F和力矩M的真实值为六维腕力传感器的读数值,预测值F’和M’为通过对六维腕力传感器及所有负载做完重力补偿后的理论值。
所述的碰撞点三维坐标解算方法,是通过碰撞物体的表面点云信息或者表面几何曲面信息作为约束条件,用以求解多解方程组的唯一解。
所述的能够连接多种骨科手术器械的特制法兰,是可以通过螺丝或者是插拔接口安装不同手术器械的法兰盘。
所述的手术机器人是任意结构的能够安装末端法兰的机械结构,通常为具有6或7自由度的机械臂,或者具有3个以上自由度的并联机构手术机器人。
本发明的有益效果:
(1)本发明使用六维力传感器结合术前三维手术设计信息来计算碰撞位置,既可以在没有视觉系统的条件下实现碰撞位置检测,又可以结合视觉系统完成更精确的术中碰撞位置检测,方法合理实用;
(2)尤其适用于骨科辅助手术机器人系统中,可以与图像导航系统结合,实时检测出碰撞发生的位置,使机器人及时做出相应的反应,更好的实现机器人与医生的有效交互,起到更加有效和智能的手术辅助作用。
附图说明
图1为本发明的手术机器人末端工具的结构图;
其中,1-特制法兰,2-六维腕力传感器,3-法兰盘。
具体实施方式
下面结合附图对本发明进行详细说明:
一种手术机器人末端工具碰撞位置检测方法,包括末端工具的重力校准、动态误差补偿和碰撞点坐标求解,具体包括以下步骤:
步骤1在手术机器人末端通过法兰盘3安装六维腕力传感器2,所述的六维腕力传感器2上安装能够连接多种骨科手术器械的特制法兰1;所述的特制法兰1安装在六维腕力传感器2的原点,其轴线方向为六维腕力传感器2的Z轴方向;
步骤2手术机器人末端工具通过六维腕力传感器2采集力F和力矩M的值;
步骤3手术机器人末端工具的重力校准,即在术前手术设计和机器人路径规划阶段,计算出在整个路径中的各位置处,六维腕力传感器的力F和力矩M的预测值F’和M’;当手术机器人末端位置不发生移动,且F和M的真实值不断增加,并与预测值之间的插值超过一定阈值即视为发生碰撞;
步骤4当发生碰撞时,连续采集3组以上的F和M的值,并计算出相邻两组值之间的差值ΔF和ΔM,即力和力矩的导数,并将ΔF和ΔM用于力学公式“M=F×L”中,构成方程组:
及
其中,Fx、Fy、Fz分别为六维腕力传感器检测碰撞位置X、Y、Z方向的力,Mx、My、Mz分别为X、Y、Z方向的力矩;Fx1……Fxn,Fy1……Fyn,Fz1……Fzn分别为采集n组X、Y、Z方向的力;Mx1……Mxn,My1……Myn,Mz1……Mzn分别为采集n组X、Y、Z方向的力矩;
根据碰撞点三维坐标解算方法,在术前设计中预测的碰撞点云范围内,搜索上述方程组误差最小的点坐标,即为所求出的碰撞位置坐标;在基本的力学公式M=F×L的基础上,结合碰撞物体的三位点云信息,最终搜索出误差最小的碰撞点坐标,并将其显示在三维导航图像上。
步骤5将碰撞位置坐标及时的反馈到术中三维导航的图像上,实现于图像导航结合的碰撞位置检测及引导功能。
所述的六维腕力传感器的力F和力矩M的真实值为六维腕力传感器的读数值,预测值F’和M’为通过对六维腕力传感器及所有负载做完重力补偿后的理论值。
所述的碰撞点三维坐标解算方法,是通过碰撞物体的表面点云信息或者表面几何曲面信息作为约束条件,用以求解多解方程组的唯一解。
所述的能够连接多种骨科手术器械的特制法兰2是可以通过螺丝或者是插拔接口安装不同手术器械的法兰盘,如图1所示。
所述的手术机器人是任意结构的能够安装末端法兰的机械结构,通常为具有6或7自由度的机械臂,或者具有3个以上自由度的并联机构手术机器人。
本发明使用六维力传感器结合术前三维手术设计信息来计算碰撞位置,既可以在没有视觉系统的条件下实现碰撞位置检测,又可以结合视觉系统完成更精确的术中碰撞位置检测,方法合理实用;本发明尤其适用于骨科辅助手术机器人系统中,可以与图像导航系统结合,实时检测出碰撞发生的位置,使机器人及时做出相应的反应,更好的实现机器人与医生的有效交互,起到更加有效和智能的手术辅助作用。
上述虽然结合附图对本发明的具体实施方式进行了描述,但并非对本发明保护范围的限制,所属领域技术人员应该明白,在本发明的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。
Claims (7)
1.一种手术机器人末端工具碰撞位置检测方法,其特征在于,包括以下步骤:
步骤1 在手术机器人末端通过法兰盘安装六维腕力传感器,所述的六维腕力传感器上安装能够连接多种骨科手术器械的特制法兰;所述的特制法兰安装在六维腕力传感器的原点,其轴线方向为六维腕力传感器的Z轴方向;
步骤2 手术机器人末端工具通过六维腕力传感器采集力F和力矩M的值;
步骤3 手术机器人末端工具的重力校准,即在术前手术设计和机器人路径规划阶段,计算出在整个路径中的各位置处,六维腕力传感器的力F和力矩M的预测值F’和M’;
步骤4 当发生碰撞时,连续采集3组以上的F和M的值,并计算出相邻两组值之间的差值ΔF和ΔM,即力和力矩的导数,求出的碰撞位置坐标;
步骤5 将碰撞位置坐标及时的反馈到术中三维导航的图像上,实现于图像导航结合的碰撞位置检测及引导功能。
2.如权利要求1所述的一种手术机器人末端工具碰撞位置检测方法,其特征在于,所述的步骤3中当手术机器人末端位置不发生移动,且F和M的真实值不断增加,并与预测值之间的插值超过一定阈值即视为发生碰撞。
3.如权利要求2所述的一种手术机器人末端工具碰撞位置检测方法,其特征在于,所述的六维腕力传感器的力F和力矩M的真实值为六维腕力传感器的读数值,预测值F’和M’为通过对六维腕力传感器及所有负载做完重力补偿后的理论值。
4.如权利要求1所述的一种手术机器人末端工具碰撞位置检测方法,其特征在于,所述的步骤4中,将ΔF和ΔM用于力学公式“M=F×L”中,构成方程组:
及
其中,Fx、Fy、Fz分别为六维腕力传感器检测碰撞位置X、Y、Z方向的力,Mx、My、Mz分别为X、Y、Z方向的力矩;Fx1……Fxn,Fy1……Fyn,Fz1……Fzn分别为采集n组X、Y、Z方向的力;Mx1……Mxn,My1……Myn,Mz1……Mzn分别为采集n组X、Y、Z方向的力矩;
根据碰撞点三维坐标解算方法,在术前设计中预测的碰撞点云范围内,搜索上述方程组误差最小的点坐标,即为所求出的碰撞位置坐标。
5.如权利要求4所述的一种手术机器人末端工具碰撞位置检测方法,其特征在于,所述的碰撞点三维坐标解算方法,是通过碰撞物体的表面点云信息或者表面几何曲面信息作为约束条件,用以求解多解方程组的唯一解。
6.如权利要求1所述的一种手术机器人末端工具碰撞位置检测方法,其特征在于,所述的能够连接多种骨科手术器械的特制法兰,是可以通过螺丝或者是插拔接口安装不同手术器械的法兰盘。
7.如权利要求1所述的一种手术机器人末端工具碰撞位置检测方法,其特征在于,所述的手术机器人是能够安装末端法兰的机械结构,所述的机械结构为具有6自由度或7自由度的机械臂,或者具有3个以上自由度的并联机构手术机器人。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710081187.6A CN106725861B (zh) | 2017-02-15 | 2017-02-15 | 一种手术机器人末端工具碰撞位置检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710081187.6A CN106725861B (zh) | 2017-02-15 | 2017-02-15 | 一种手术机器人末端工具碰撞位置检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106725861A true CN106725861A (zh) | 2017-05-31 |
CN106725861B CN106725861B (zh) | 2019-12-10 |
Family
ID=58957151
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710081187.6A Expired - Fee Related CN106725861B (zh) | 2017-02-15 | 2017-02-15 | 一种手术机器人末端工具碰撞位置检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106725861B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108972623A (zh) * | 2018-07-27 | 2018-12-11 | 武汉理工大学 | 基于力控传感器的机器人末端装夹误差自动修正方法 |
CN109620410A (zh) * | 2018-12-04 | 2019-04-16 | 微创(上海)医疗机器人有限公司 | 机械臂防碰撞的方法及系统、医疗机器人 |
CN109968377A (zh) * | 2017-12-27 | 2019-07-05 | 韩华精密机械株式会社 | 机器人控制系统和控制机器人的方法 |
CN111110351A (zh) * | 2020-01-10 | 2020-05-08 | 北京天智航医疗科技股份有限公司 | 用于检测关节置换手术机器人系统精度的组件和方法 |
CN112548986A (zh) * | 2021-03-01 | 2021-03-26 | 国网瑞嘉(天津)智能机器人有限公司 | 带电作业机器人碰撞检测方法及带电作业机器人 |
CN112704564A (zh) * | 2020-12-22 | 2021-04-27 | 上海微创医疗机器人(集团)股份有限公司 | 手术机器人系统、碰撞检测方法、系统及可读存储介质 |
CN112790866A (zh) * | 2021-04-07 | 2021-05-14 | 珠海维尔康生物科技有限公司 | 一种用于外科辅助手术机器人的快速接口 |
RU2777566C1 (ru) * | 2018-12-04 | 2022-08-08 | Шанхай Майкропорт Медбот (Груп) Ко., Лтд. | Способ и система для предотвращения столкновения между механическими руками и медицинский робот |
CN114888810A (zh) * | 2022-06-06 | 2022-08-12 | 南京佗道医疗科技有限公司 | 一种末端仪器的防碰撞方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101432103A (zh) * | 2006-07-04 | 2009-05-13 | 松下电器产业株式会社 | 机器人手臂的控制装置及控制方法、机器人、及机器人手臂的控制程序 |
CN102426391A (zh) * | 2011-09-05 | 2012-04-25 | 华南理工大学 | 一种判断机器人运行是否发生碰撞的方法 |
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN104626171A (zh) * | 2015-01-07 | 2015-05-20 | 北京卫星环境工程研究所 | 基于六维力传感器的机械臂碰撞检测与响应方法 |
WO2015154172A1 (en) * | 2014-04-10 | 2015-10-15 | Quanser Consulting Inc. | Robotic systems and methods of operating robotic systems |
CN104985598A (zh) * | 2015-06-24 | 2015-10-21 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人碰撞检测方法 |
WO2016176755A1 (en) * | 2015-05-01 | 2016-11-10 | Titan Medical Inc. | Instrument collision detection and feedback |
CN106182087A (zh) * | 2015-05-04 | 2016-12-07 | 中国科学院沈阳自动化研究所 | 基于六维力传感器的碰撞位置感知方法 |
-
2017
- 2017-02-15 CN CN201710081187.6A patent/CN106725861B/zh not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101432103A (zh) * | 2006-07-04 | 2009-05-13 | 松下电器产业株式会社 | 机器人手臂的控制装置及控制方法、机器人、及机器人手臂的控制程序 |
CN102426391A (zh) * | 2011-09-05 | 2012-04-25 | 华南理工大学 | 一种判断机器人运行是否发生碰撞的方法 |
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
WO2015154172A1 (en) * | 2014-04-10 | 2015-10-15 | Quanser Consulting Inc. | Robotic systems and methods of operating robotic systems |
CN104626171A (zh) * | 2015-01-07 | 2015-05-20 | 北京卫星环境工程研究所 | 基于六维力传感器的机械臂碰撞检测与响应方法 |
WO2016176755A1 (en) * | 2015-05-01 | 2016-11-10 | Titan Medical Inc. | Instrument collision detection and feedback |
CN106182087A (zh) * | 2015-05-04 | 2016-12-07 | 中国科学院沈阳自动化研究所 | 基于六维力传感器的碰撞位置感知方法 |
CN104985598A (zh) * | 2015-06-24 | 2015-10-21 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人碰撞检测方法 |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109968377A (zh) * | 2017-12-27 | 2019-07-05 | 韩华精密机械株式会社 | 机器人控制系统和控制机器人的方法 |
CN109968377B (zh) * | 2017-12-27 | 2023-09-01 | 韩华株式会社 | 机器人控制系统和控制机器人的方法 |
CN108972623A (zh) * | 2018-07-27 | 2018-12-11 | 武汉理工大学 | 基于力控传感器的机器人末端装夹误差自动修正方法 |
CN109620410A (zh) * | 2018-12-04 | 2019-04-16 | 微创(上海)医疗机器人有限公司 | 机械臂防碰撞的方法及系统、医疗机器人 |
WO2020114233A1 (zh) * | 2018-12-04 | 2020-06-11 | 微创(上海)医疗机器人有限公司 | 机械臂防碰撞的方法及系统、医疗机器人 |
RU2777566C1 (ru) * | 2018-12-04 | 2022-08-08 | Шанхай Майкропорт Медбот (Груп) Ко., Лтд. | Способ и система для предотвращения столкновения между механическими руками и медицинский робот |
CN111110351A (zh) * | 2020-01-10 | 2020-05-08 | 北京天智航医疗科技股份有限公司 | 用于检测关节置换手术机器人系统精度的组件和方法 |
CN112704564A (zh) * | 2020-12-22 | 2021-04-27 | 上海微创医疗机器人(集团)股份有限公司 | 手术机器人系统、碰撞检测方法、系统及可读存储介质 |
CN112548986A (zh) * | 2021-03-01 | 2021-03-26 | 国网瑞嘉(天津)智能机器人有限公司 | 带电作业机器人碰撞检测方法及带电作业机器人 |
CN112790866A (zh) * | 2021-04-07 | 2021-05-14 | 珠海维尔康生物科技有限公司 | 一种用于外科辅助手术机器人的快速接口 |
CN114888810A (zh) * | 2022-06-06 | 2022-08-12 | 南京佗道医疗科技有限公司 | 一种末端仪器的防碰撞方法 |
CN114888810B (zh) * | 2022-06-06 | 2024-02-06 | 佗道医疗科技有限公司 | 一种末端仪器的防碰撞方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106725861B (zh) | 2019-12-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106725861A (zh) | 一种手术机器人末端工具碰撞位置检测方法 | |
US20170042625A1 (en) | Robotic interface positioning determination systems and methods | |
CN104408299B (zh) | 基于距离识别冗余运动学参数的机器人位置误差补偿方法 | |
CN105082160B (zh) | 一种具有防碰撞功能的移动式机器人手术系统 | |
CN102768006B (zh) | 一种用于大曲率曲面零件法向自动测量和调整的方法 | |
CN112706158B (zh) | 基于视觉和惯导定位的工业人机交互系统及方法 | |
CN107553475A (zh) | 一种用于工件加工的工件坐标标定方法 | |
CN114347033B (zh) | 机器人物品抓取方法、装置、机器人及存储介质 | |
CN103472434B (zh) | 一种机器人声音定位方法 | |
CN102331873A (zh) | 一种触摸点跟踪定位校正方法及其系统 | |
CN104714473B (zh) | 一种管路柔性装焊的导管余量切割位置计算方法 | |
Beyl et al. | Multi kinect people detection for intuitive and safe human robot cooperation in the operating room | |
CN110193830A (zh) | 基于rbf神经网络的踝关节步态预测方法 | |
Han et al. | Grasping control method of manipulator based on binocular vision combining target detection and trajectory planning | |
Kim et al. | Image-based force estimation of deformable tissue using depth map for single-port surgical robot | |
CN104227733A (zh) | 人体感应机械臂 | |
Claasen et al. | High-bandwidth low-latency tracking using optical and inertial sensors | |
CN103737603B (zh) | 一种流水线上机械臂精确控制系统及控制方法 | |
JP5983506B2 (ja) | 把持対象物の把持パターン検出方法およびロボット | |
Zhang et al. | Gesture-based human-robot interface for dual-robot with hybrid sensors | |
JP5275967B2 (ja) | 干渉チェック装置 | |
CN111390421A (zh) | 焊接方法 | |
CN107139192A (zh) | 一种用于五指灵巧手自适应抓取的触滑觉传感网 | |
Guo et al. | Design a novel of path planning method for the vascular interventional surgery robot based on DWA model | |
Ma et al. | A framework for interactive work design based on digital work analysis and simulation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20191210 Termination date: 20220215 |