CN109124769A - 手术机器人的坐标系标定、控制的方法及系统 - Google Patents
手术机器人的坐标系标定、控制的方法及系统 Download PDFInfo
- Publication number
- CN109124769A CN109124769A CN201811050374.9A CN201811050374A CN109124769A CN 109124769 A CN109124769 A CN 109124769A CN 201811050374 A CN201811050374 A CN 201811050374A CN 109124769 A CN109124769 A CN 109124769A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- arm tooling
- attitude angle
- power
- force snesor
- 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
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/20—Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/70—Manipulators specially adapted for use in surgery
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/20—Surgical navigation systems; Devices for tracking or guiding surgical instruments, e.g. for frameless stereotaxis
- A61B2034/2046—Tracking techniques
- A61B2034/2059—Mechanical position encoders
Abstract
本发明公开了一种手术机器人的坐标系标定、控制的方法及系统,所述手术机器人的机械臂端设有力传感器和末端工具,力传感器和末端工具紧贴设置,末端工具的中心点系有一已知重量的测量物,坐标系标定方法包括:获取末端工具的末端工具坐标系相对手术机器人的机器坐标系的第一姿态角,末端工具坐标系以中心点为原点;根据第一姿态角将重力转换至末端工具坐标系得到第一转换力;获取力传感器在受到重力作用后在力传感器坐标系下的检测力;根据第一转换力和检测力得到力传感器坐标系相对末端工具坐标系的第二姿态角;第二姿态角用于表征力传感器坐标系与末端工具坐标系的转换关系。本发明无需外置设备即可完成本身坐标系标定,方法简单实用。
Description
技术领域
本发明属于手术机器人的控制领域,特别涉及一种手术机器人的坐标系标定、控制的方法及系统。
背景技术
手术机器人系统作为一种高精尖的医疗设备,人机协同控制依赖于力传感准确获知人力的大小及方位信息,为了实现对末端工具的控制,必须构建末端工具与机器人位姿之间的转换关系,而工具坐标系的创建与标定将直接关系到机器人的工作和精度,在市面上,关于坐标系标定的方法,其主要是集中在机器人工作坐标系的标定以及不同物体之间位姿关系的标定,例如不同设备间位置关系配准多采用在设备间安装Marker(标记)点,通过激光跟踪仪确定不同设备间的坐标转换关系,但设备标定过程复杂,需要较长时间的设备校准工作,存在效率不足;而针对传感器内部坐标系相对于其他设备的位置关系的配准方法多采用依赖于安装位置精度的方法来保证,而通过安装位置精度来确保传感器的位置本身的误差具有不确定性,对于有精度要求的机器人系统不适用。
发明内容
本发明要解决的技术问题是为了克服现有技术中手术机器人的坐标系标定效率低、精度低的缺陷,提供一种手术机器人的坐标系标定、控制的方法及系统。
本发明是通过下述技术方案来解决上述技术问题:
一种手术机器人的坐标系标定方法,所述手术机器人的机械臂端设有力传感器和末端工具,所述力传感器和所述末端工具紧贴设置,所述末端工具的中心点系有一已知重量的测量物,所述坐标系标定方法包括:
获取所述末端工具的末端工具坐标系相对所述手术机器人的机器坐标系的第一姿态角,所述末端工具坐标系以所述中心点为原点;
根据所述第一姿态角将重力转换至所述末端工具坐标系得到第一转换力;
获取所述力传感器在受到所述重力作用后在力传感器坐标系下的检测力;
根据所述第一转换力和所述检测力得到所述力传感器坐标系相对所述末端工具坐标系的第二姿态角;
所述第二姿态角用于表征所述力传感器坐标系与所述末端工具坐标系的转换关系。
较佳地,所述根据所述第一转换力和所述检测力得到所述力传感器坐标系相对所述末端工具坐标系的第二姿态角的步骤具体包括:
预设一转换矩阵,所述转换矩阵中的参数为未知的,所述转换矩阵用于表征所述力传感器坐标系和所述末端工具坐标系的转换关系;
根据所述转换矩阵将所述第一转换力转换至所述力传感器坐标系得到第二转换力;
令所述第二转换力等于所述检测力求解得到所述转换矩阵;
根据所述转换矩阵得到所述第二姿态角。
较佳地,所述获取所述末端工具的末端工具坐标系相对所述手术机器人的机器坐标系的第一姿态角的步骤之前,所述坐标系标定方法还包括:
设置所述手术机器人的机器坐标系与世界坐标系平行。
较佳地,根据以下公式计算所述坐标系标定方法中的所述第二姿态角:
其中,为第一转换力,(Fx,Fy,Fz)为检测力,为第一姿态角,RTtoW为末工具坐标系转换到世界坐标系的转换矩阵,(α,β,γ)为第二姿态角,RStoT为预设的力传感器坐标系转换到末端工具坐标系的转换矩阵,G为测量物的重力。
一种手术机器人控制方法,所述手术机器人控制方法包括:
利用如上所述手术机器人的坐标系标定方法得到所述力传感器坐标系相对于所述末端工具坐标系的第二姿态角;
通过所述力传感器实时获取所述手术机器人的机械臂在受到外部操作力时所述力传感器坐标系下的实时作用力;
根据所述第二姿态角将所述实时作用力由所述力传感器坐标系转换至所述末端工具坐标系得到第一转换作用力;
获取所述末端工具坐标系相对所述手术机器人的机器坐标系的实时姿态角;
根据所述实时具姿态角将所述第一转换作用力由所述末端工具坐标系转换至所述机器坐标系得到第二转换作用力;
根据所述第二转换作用力控制所述机械臂带动所述末端工具运动。
一种手术机器人的坐标系标定系统,所述坐标系标定系统包括姿态角获取模块、转换模块、力传感器和计算模块,所述手术机器人的机械臂端设有所述力传感器和末端工具,所述力传感器和所述末端工具紧贴设置,所述末端工具的中心点系有一已知重量的测量物;
所述姿态角获取模块用于获取所述末端工具的末端工具坐标系相对所述手术机器人的机器坐标系的第一姿态角,所述末端工具坐标系以所述中心点为原点;
所述转换模块用于根据所述第一姿态角将重力转换至所述末端工具坐标系得到第一转换力;
所述力传感器用于获取所述力传感器在受到所述重力作用后在力传感器坐标系下的检测力;
所述计算模块用于根据所述第一转换力和所述检测力得到所述力传感器坐标系相对所述末端工具坐标系的第二姿态角;
所述第二姿态角用于表征所述力传感器坐标系与所述末端工具坐标系之间的转换关系。
较佳地,所述计算模块包括预设单元;
所述预设单元用于预设一转换矩阵,所述转换矩阵中的参数为未知的,所述转换矩阵用于表征所述力传感器坐标系和所述末端工具坐标系的转换关系;
所述转换模块还用于根据所述转换矩阵将所述第一转换力转换至所述力传感器坐标系得到第二转换力;
所述计算模块用于令所述第二转换力等于所述检测力求解得到所述转换矩阵,并根据所述转换矩阵得到所述第二姿态角。
较佳地,所述手术机器人的机器坐标系与世界坐标系是平行的。
较佳地,所述坐标系标定系统根据以下公式计算所述第二姿态角:
其中,为第一转换力,(Fx,Fy,Fz)为检测力,为第一姿态角,RTtoW为末工具坐标系转换到世界坐标系的转换矩阵,(α,β,γ)为第二姿态角,RStoT为预设的力传感器坐标系转换到末端工具坐标系的转换矩阵,G为测量物的重力。
一种手术机器人控制系统,所述手术机器人控制系统包括控制器和如上所述的手术机器人的坐标系标定系统,所述控制器包括第二姿态角获取单元、转换单元、实时姿态角获取单元和运动控制单元;
所述第二姿态角获取单元用于利用所述手术机器人的坐标系标定系统获取所述力传感器坐标系相对于所述末端工具的坐标系的第二姿态角;
所述力传感器用于实时获取所述手术机器人的机械臂受到外部操作力时所述力传感器坐标系下的实时作用力;
所述转换单元用于根据所述第二姿态角将所述实时作用力由所述力传感器坐标系转换至所述末端工具坐标系得到第一转换作用力;
所述实时姿态角获取单元用于获取所述末端工具坐标系相对所述手术机器人的机器坐标系的实时姿态角;
所述转换单元还用于根据所述实时姿态角将所述第一转换作用力由所述末端工具坐标系转换至所述机器坐标系得到第二转换作用力;
所述运动控制单元用于根据所述第二转换作用力控制所述机械臂带动所述刀头运动。
本发明的积极进步效果在于:本发明在降低了基于安装位置确认坐标系方位的误差不确定性风险,在保证了力传感器坐标系标定准确性的同时提高了标定效率,无需外置设备即可完成本身坐标系标定,方法简单实用。
附图说明
图1为本发明实施例1中的手术机器人的部分结构示意图。
图2为本发明实施例1的手术机器人的坐标系标定方法的流程图。
图3为本发明实施例2的手术机器人的坐标系标定方法中步骤140的具体流程图。
图4为本发明实施例3的手术机器人控制方法的流程图。
图5本发明实施例4的手术机器人的坐标系标定系统的模块示意图。
图6本发明实施例5的手术机器人的坐标系标定系统的模块示意图。
图7本发明实施例6的手术机器人控制系统的模块示意图。
具体实施方式
下面通过实施例的方式进一步说明本发明,但并不因此将本发明限制在所述的实施例范围之中。
实施例1
一种手术机器人的坐标系标定方法,如图1所示,所述手术机器人的机械臂端设有力传感器和末端工具,所述力传感器和所述末端工具紧贴设置,所述末端工具的中心点系有一已知重量的测量物,测量物可以使用砝码,如图2所示,所述坐标系标定方法包括:
步骤110、获取末端工具的末端工具坐标系相对手术机器人的机器坐标系的第一姿态角;所述末端工具坐标系以所述中心点为原点;
步骤120、根据第一姿态角将重力转换至末端工具坐标系得到第一转换力;
步骤130、获取力传感器在受到重力作用后在力传感器坐标系下的检测力;
步骤140、根据第一转换力和检测力得到力传感器坐标系相对末端工具坐标系的第二姿态角;所述第二姿态角用于表征力传感器坐标系与末端工具坐标系的转换关系;
另外,步骤110之前,所述坐标系标定方法还包括:
步骤100、设置手术机器人的机器坐标系与世界坐标系平行。
本实施例中,手术机器人可以直接获取末端工具的姿态角,基于此,通过转转换关系进一步得到力传感器与末端工具之间的转换关系,从后准确得知末端工具上的作用力数据,本实施例降低了基于安装位置确认坐标系方位的误差不确定性风险,在保证了力传感器坐标系标定准确性的同时提高了标定效率,无需外置设备即可完成本身坐标系标定,方法简单实用。
实施例2
本实施例的手术机器人的坐标系标定方法是在实施例1的基础上进一步改进,如图3所示,步骤140具体包括:
步骤1401、预设一转换矩阵;所述转换矩阵中的参数为未知的,所述转换矩阵用于表征所述力传感器坐标系和所述末端工具坐标系的转换关系;
步骤1402、根据转换矩阵将第一转换力转换至力传感器坐标系得到第二转换力;
步骤1403、令第二转换力等于检测力求解得到转换矩阵;
步骤1404、根据转换矩阵得到第二姿态角。
举一具体示例,使用20N的砝码作为测量物,获取到末端工具的第一姿态角为(3.04532°,1.57058°,3.04259°),通过力传感器读取到的检测力(Fx,Fy,Fz)为(18.6163044,5.312244,0),假设第二姿态角为(α,β,γ),进一步根据以下公式计算所述坐标系标定方法中的所述第二姿态角:
其中,为第一转换力,(Fx,Fy,Fz)为检测力,为第一姿态角,RTtoW为末工具坐标系转换到世界坐标系的转换矩阵,(α,β,γ)为第二姿态角,RStoT为预设的力传感器坐标系转换到末端工具坐标系的转换矩阵,G为测量物的重力;
为了便于计算,可以构建误差向量:
根据最小二乘法分别对α,β,γ角求偏导取0,求解得到(α,β,γ)的值,为(1.3316°,-165.3054°,-0.6644°)。
需要说明的是,为了确保计算得到的第二姿态角更加精准,可以使手术机器人运动到多个不同位姿,取多次数据进行计算验证。
实施例3
一种手术机器人控制方法,如图4所示,所述手术机器人控制方法包括:
步骤210、利用如实施例1或2的手术机器人的坐标系标定方法得到力传感器坐标系相对于末端工具坐标系的第二姿态角;
步骤220、通过力传感器实时获取手术机器人的机械臂在受到外部操作力时力传感器坐标系下的实时作用力;
步骤230、根据第二姿态角将实时作用力由力传感器坐标系转换至末端工具坐标系得到第一转换作用力;
步骤240、获取末端工具坐标系相对手术机器人的机器坐标系的实时姿态角;
步骤250、根据实时具姿态角将第一转换作用力由末端工具坐标系转换至机器坐标系得到第二转换作用力;
步骤260、根据第二转换作用力控制机械臂带动末端工具运动。
本实施例中,获取到力传感器与末端工具的转换关系后,当用户操作手术机器人时,力传感器可以检测到力传感器坐标系下的力,然后根据上述的转换关系将其转换至施加到末端工具上的力,进而由控制器实现对末端工具的控制,或者,若需要操控机械臂往某一个方向运动或施加某一个力,也可以将力传感器检测的值实时反馈至控制器,并根据坐标系的转换关系,获取用户在机器坐标系下需要施加的操控力的大小或者方向。
实施例4
一种手术机器人的坐标系标定系统,如图5所示,所述坐标系标定系统包括姿态角获取模块11、转换模块12、力传感器13和计算模块14,所述手术机器人的机械臂端设有所述力传感器13和末端工具,所述力传感器13和所述末端工具紧贴设置,所述末端工具的中心点系有一已知重量的测量物,测量物可以使用砝码;
所述姿态角获取模块11用于获取所述末端工具的末端工具坐标系相对所述手术机器人的机器坐标系的第一姿态角,所述末端工具坐标系以所述中心点为原点;其中,所述手术机器人的机器坐标系与世界坐标系是平行的;
所述转换模块12用于根据所述第一姿态角将所述重力转换至所述末端工具坐标系得到第一转换力;
所述力传感器13用于获取所述力传感器13在受到所述重力作用后在力传感器坐标系下的检测力;
所述计算模块14用于根据所述第一转换力和所述检测力得到所述力传感器坐标系相对所述末端工具坐标系的第二姿态角;
所述第二姿态角用于表征所述力传感器坐标系与所述末端工具坐标系之间的转换关系。
本实施例中,手术机器人可以直接获取末端工具的姿态角,基于此,通过转转换关系进一步得到力传感器13与末端工具之间的转换关系,从后准确得知末端工具上的作用力数据,本实施例降低了基于安装位置确认坐标系方位的误差不确定性风险,在保证了力传感器坐标系标定准确性的同时提高了标定效率,无需外置设备即可完成本身坐标系标定,方法简单实用。
实施例5
本实施例的手术机器人的坐标系标定系统是在实施例4的基础上进一步改进,如图6所示,所述计算模块14包括预设单元141;
所述预设单元141用于预设一转换矩阵,所述转换矩阵中的参数为未知的,所述转换矩阵用于表征所述力传感器坐标系和所述末端工具坐标系的转换关系;
所述转换模块12还用于根据所述转换矩阵将所述第一转换力转换至所述力传感器坐标系得到第二转换力;
所述计算模块14用于令所述第二转换力等于所述检测力求解得到所述转换矩阵,并根据所述转换矩阵得到所述第二姿态角。
举一具体示例,使用20N的砝码作为测量物,获取到末端工具的第一姿态角为(3.04532°,1.57058°,3.04259°),通过力传感器读取到的检测力(Fx,Fy,Fz)为(18.6163044,5.312244,0),假设第二姿态角为(α,β,γ),进一步根据以下公式计算所述第二姿态角:
其中,为第一转换力,(Fx,Fy,Fz)为检测力,为第一姿态角,RTtoW为末工具坐标系转换到世界坐标系的转换矩阵,(α,β,γ)为第二姿态角,RStoT为预设的力传感器坐标系转换到末端工具坐标系的转换矩阵,G为测量物的重力;
为了便于计算,可以构建误差向量:
根据最小二乘法分别对α,β,γ角求偏导取0,求解得到(α,β,γ)的值,为(1.3316°,-165.3054°,-0.6644°)。
需要说明的是,为了确保计算得到的第二姿态角更加精准,可以使手术机器人运动到多个不同位姿,取多次数据进行计算验证。
实施例6
一种手术机器人控制系统,如图7所示,所述手术机器人控制系统包括控制器2和如实施例4或5所述的手术机器人的坐标系标定系统1,所述控制器2包括第二姿态角获取单元21、转换单元22、实时姿态角获取单元23和运动控制单元24;
所述第二姿态角获取单元21用于利用所述手术机器人的坐标系标定系统获取所述力传感器坐标系相对于所述末端工具的坐标系的第二姿态角;
所述力传感器用于实时获取所述手术机器人的机械臂受到外部操作力时所述力传感器坐标系下的实时作用力;
所述转换单元22用于根据所述第二姿态角将所述实时作用力由所述力传感器坐标系转换至所述末端工具坐标系得到第一转换作用力;
所述实时姿态角获取单元23用于获取所述末端工具坐标系相对所述手术机器人的机器坐标系的实时姿态角;
所述转换单元22还用于根据所述实时姿态角将所述第一转换作用力由所述末端工具坐标系转换至所述机器坐标系得到第二转换作用力;
所述运动控制单元24用于根据所述第二转换作用力控制所述机械臂带动所述刀头运动。
本实施例中,获取到力传感器与末端工具的转换关系后,当用户操作手术机器人时,力传感器可以检测到力传感器坐标系下的力,然后根据上述的转换关系将其转换至施加到末端工具上的力,进而由控制器实现对末端工具的控制,或者,若需要操控机械臂往某一个方向运动或施加某一个力,也可以将力传感器检测的值实时反馈至控制器,并根据坐标系的转换关系,获取用户在机器坐标系下需要施加的操控力的大小或者方向。
虽然以上描述了本发明的具体实施方式,但是本领域的技术人员应当理解,这仅是举例说明,本发明的保护范围是由所附权利要求书限定的。本领域的技术人员在不背离本发明的原理和实质的前提下,可以对这些实施方式做出多种变更或修改,但这些变更和修改均落入本发明的保护范围。
Claims (10)
1.一种手术机器人的坐标系标定方法,其特征在于,所述手术机器人的机械臂端设有力传感器和末端工具,所述力传感器和所述末端工具紧贴设置,所述末端工具的中心点系有一已知重量的测量物,所述坐标系标定方法包括:
获取所述末端工具的末端工具坐标系相对所述手术机器人的机器坐标系的第一姿态角,所述末端工具坐标系以所述中心点为原点;
根据所述第一姿态角将重力转换至所述末端工具坐标系得到第一转换力;
获取所述力传感器在受到所述重力作用后在力传感器坐标系下的检测力;
根据所述第一转换力和所述检测力得到所述力传感器坐标系相对所述末端工具坐标系的第二姿态角;
所述第二姿态角用于表征所述力传感器坐标系与所述末端工具坐标系的转换关系。
2.如权利要求1所述的手术机器人工作坐标系的标定方法,其特征在于,所述根据所述第一转换力和所述检测力得到所述力传感器坐标系相对所述末端工具坐标系的第二姿态角的步骤具体包括:
预设一转换矩阵,所述转换矩阵中的参数为未知的,所述转换矩阵用于表征所述力传感器坐标系和所述末端工具坐标系的转换关系;
根据所述转换矩阵将所述第一转换力转换至所述力传感器坐标系得到第二转换力;
令所述第二转换力等于所述检测力求解得到所述转换矩阵;
根据所述转换矩阵得到所述第二姿态角。
3.如权利要求1所述的手术机器人工作坐标系的标定方法,其特征在于,所述获取所述末端工具的末端工具坐标系相对所述手术机器人的机器坐标系的第一姿态角的步骤之前,所述坐标系标定方法还包括:
设置所述手术机器人的机器坐标系与世界坐标系平行。
4.如权利要求2所述的手术机器人工作坐标系的标定方法,其特征在于,根据以下公式计算所述坐标系标定方法中的所述第二姿态角:
其中,为第一转换力,(Fx,Fy,Fz)为检测力,为第一姿态角,RTtoW为末工具坐标系转换到世界坐标系的转换矩阵,(α,β,γ)为第二姿态角,RStoT为预设的力传感器坐标系转换到末端工具坐标系的转换矩阵,G为测量物的重力。
5.一种手术机器人控制方法,其特征在于,所述手术机器人控制方法包括:
利用如权利要求1-4中任意一项所述的手术机器人的坐标系标定方法得到所述力传感器坐标系相对于所述末端工具坐标系的第二姿态角;
通过所述力传感器实时获取所述手术机器人的机械臂在受到外部操作力时所述力传感器坐标系下的实时作用力;
根据所述第二姿态角将所述实时作用力由所述力传感器坐标系转换至所述末端工具坐标系得到第一转换作用力;
获取所述末端工具坐标系相对所述手术机器人的机器坐标系的实时姿态角;
根据所述实时具姿态角将所述第一转换作用力由所述末端工具坐标系转换至所述机器坐标系得到第二转换作用力;
根据所述第二转换作用力控制所述机械臂带动所述末端工具运动。
6.一种手术机器人的坐标系标定系统,其特征在于,所述坐标系标定系统包括姿态角获取模块、转换模块、力传感器和计算模块,所述手术机器人的机械臂端设有所述力传感器和末端工具,所述力传感器和所述末端工具紧贴设置,所述末端工具的中心点系有一已知重量的测量物;
所述姿态角获取模块用于获取所述末端工具的末端工具坐标系相对所述手术机器人的机器坐标系的第一姿态角,所述末端工具坐标系以所述中心点为原点;
所述转换模块用于根据所述第一姿态角将重力转换至所述末端工具坐标系得到第一转换力;
所述力传感器用于获取所述力传感器在受到所述重力作用后在力传感器坐标系下的检测力;
所述计算模块用于根据所述第一转换力和所述检测力得到所述力传感器坐标系相对所述末端工具坐标系的第二姿态角;
所述第二姿态角用于表征所述力传感器坐标系与所述末端工具坐标系之间的转换关系。
7.如权利要求6所述的手术机器人的坐标系标定系统,其特征在于,所述计算模块包括预设单元;
所述预设单元用于预设一转换矩阵,所述转换矩阵中的参数为未知的,所述转换矩阵用于表征所述力传感器坐标系和所述末端工具坐标系的转换关系;
所述转换模块还用于根据所述转换矩阵将所述第一转换力转换至所述力传感器坐标系得到第二转换力;
所述计算模块用于令所述第二转换力等于所述检测力求解得到所述转换矩阵,并根据所述转换矩阵得到所述第二姿态角。
8.如权利要求6所述的手术机器人的坐标系标定系统,其特征在于,所述手术机器人的机器坐标系与世界坐标系是平行的。
9.如权利要求7所述的手术机器人的坐标系标定系统,其特征在于,所述坐标系标定系统根据以下公式计算所述第二姿态角:
其中,为第一转换力,(Fx,Fy,Fz)为检测力,为第一姿态角,RTtoW为末工具坐标系转换到世界坐标系的转换矩阵,(α,β,γ)为第二姿态角,RStoT为预设的力传感器坐标系转换到末端工具坐标系的转换矩阵,G为测量物的重力。
10.一种手术机器人控制系统,其特征在于,所述手术机器人控制系统包括控制器和如权利要求6-9中任意一项所述的手术机器人的坐标系标定系统,所述控制器包括第二姿态角获取单元、转换单元、实时姿态角获取单元和运动控制单元;
所述第二姿态角获取模块用于利用所述手术机器人的坐标系标定系统获取所述力传感器坐标系相对于所述末端工具的坐标系的第二姿态角;
所述力传感器用于实时获取所述手术机器人的机械臂受到外部操作力时所述力传感器坐标系下的实时作用力;
所述转换单元用于根据所述第二姿态角将所述实时作用力由所述力传感器坐标系转换至所述末端工具坐标系得到第一转换作用力;
所述实时姿态角获取单元用于获取所述末端工具坐标系相对所述手术机器人的机器坐标系的实时姿态角;
所述转换单元还用于根据所述实时姿态角将所述第一转换作用力由所述末端工具坐标系转换至所述机器坐标系得到第二转换作用力;
所述运动控制单元用于根据所述第二转换作用力控制所述机械臂带动所述刀头运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811050374.9A CN109124769B (zh) | 2018-09-10 | 2018-09-10 | 手术机器人的坐标系标定、控制的方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811050374.9A CN109124769B (zh) | 2018-09-10 | 2018-09-10 | 手术机器人的坐标系标定、控制的方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109124769A true CN109124769A (zh) | 2019-01-04 |
CN109124769B CN109124769B (zh) | 2021-06-04 |
Family
ID=64824046
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811050374.9A Active CN109124769B (zh) | 2018-09-10 | 2018-09-10 | 手术机器人的坐标系标定、控制的方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109124769B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109806003A (zh) * | 2019-01-30 | 2019-05-28 | 杭州键嘉机器人有限公司 | 执行杆、采用该执行杆的手术机器人及机器人定位方法 |
CN109822574A (zh) * | 2019-03-20 | 2019-05-31 | 华中科技大学 | 一种工业机器人末端六维力传感器标定的方法 |
CN110811808A (zh) * | 2019-11-15 | 2020-02-21 | 北京积水潭医院 | 杆状手持操作装置及其力和位置同步测量的方法 |
CN111110351A (zh) * | 2020-01-10 | 2020-05-08 | 北京天智航医疗科技股份有限公司 | 用于检测关节置换手术机器人系统精度的组件和方法 |
CN111374740A (zh) * | 2020-04-22 | 2020-07-07 | 张家港汇致机电设备有限公司 | 一种房间隔穿刺术用增强现实辅助穿刺系统 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20010006087A1 (en) * | 1999-12-24 | 2001-07-05 | Bielomatik Leuze Gmbh & Co. | Device and method for heated tool welding |
ES2315130A1 (es) * | 2006-11-03 | 2009-03-16 | Universidad De Jaen | Dispositivo para la estimacion de fuerzas y pares de contacto en robots manipuladores industriales y procedimiento de implementacion del mismo. |
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
CN106945040A (zh) * | 2017-03-24 | 2017-07-14 | 北京理工大学 | 一种用于单自由度柔性末端的机械臂控制算法 |
WO2017132696A1 (en) * | 2016-01-28 | 2017-08-03 | Transenterix Surgical, Inc. | Force estimation using robotic manipulator force torque sensors |
CN107443377A (zh) * | 2017-08-10 | 2017-12-08 | 埃夫特智能装备股份有限公司 | 传感器‑机器人坐标系转换方法及机器人手眼标定方法 |
CN108056819A (zh) * | 2016-12-02 | 2018-05-22 | 王健 | 一种用于医疗机器人的手术跟踪定位导航方法 |
CN108064197A (zh) * | 2016-12-30 | 2018-05-22 | 深圳配天智能技术研究院有限公司 | 确定码垛点位置信息的方法、装置及机器人 |
US20180154519A1 (en) * | 2016-12-02 | 2018-06-07 | National Taipei University Of Technology | Robot teaching system and control method thereof |
CN108312144A (zh) * | 2017-12-25 | 2018-07-24 | 北京航天测控技术有限公司 | 基于机器视觉的机器人自动锁付控制系统及方法 |
CN108406725A (zh) * | 2018-02-09 | 2018-08-17 | 华南理工大学 | 基于电磁理论与移动跟踪的力反馈人机交互系统及方法 |
-
2018
- 2018-09-10 CN CN201811050374.9A patent/CN109124769B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20010006087A1 (en) * | 1999-12-24 | 2001-07-05 | Bielomatik Leuze Gmbh & Co. | Device and method for heated tool welding |
ES2315130A1 (es) * | 2006-11-03 | 2009-03-16 | Universidad De Jaen | Dispositivo para la estimacion de fuerzas y pares de contacto en robots manipuladores industriales y procedimiento de implementacion del mismo. |
CN103600354A (zh) * | 2013-11-08 | 2014-02-26 | 北京卫星环境工程研究所 | 航天器机械臂柔性随动控制重力补偿方法 |
WO2017132696A1 (en) * | 2016-01-28 | 2017-08-03 | Transenterix Surgical, Inc. | Force estimation using robotic manipulator force torque sensors |
CN108056819A (zh) * | 2016-12-02 | 2018-05-22 | 王健 | 一种用于医疗机器人的手术跟踪定位导航方法 |
US20180154519A1 (en) * | 2016-12-02 | 2018-06-07 | National Taipei University Of Technology | Robot teaching system and control method thereof |
CN108064197A (zh) * | 2016-12-30 | 2018-05-22 | 深圳配天智能技术研究院有限公司 | 确定码垛点位置信息的方法、装置及机器人 |
CN106945040A (zh) * | 2017-03-24 | 2017-07-14 | 北京理工大学 | 一种用于单自由度柔性末端的机械臂控制算法 |
CN107443377A (zh) * | 2017-08-10 | 2017-12-08 | 埃夫特智能装备股份有限公司 | 传感器‑机器人坐标系转换方法及机器人手眼标定方法 |
CN108312144A (zh) * | 2017-12-25 | 2018-07-24 | 北京航天测控技术有限公司 | 基于机器视觉的机器人自动锁付控制系统及方法 |
CN108406725A (zh) * | 2018-02-09 | 2018-08-17 | 华南理工大学 | 基于电磁理论与移动跟踪的力反馈人机交互系统及方法 |
Non-Patent Citations (1)
Title |
---|
KONSTANTIN MIRONOV: "Processing and forecasting the trajectory of a thrown object measured by the stereo vision system", 《IFAC-PAPERSONLINE》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109806003A (zh) * | 2019-01-30 | 2019-05-28 | 杭州键嘉机器人有限公司 | 执行杆、采用该执行杆的手术机器人及机器人定位方法 |
CN109822574A (zh) * | 2019-03-20 | 2019-05-31 | 华中科技大学 | 一种工业机器人末端六维力传感器标定的方法 |
CN110811808A (zh) * | 2019-11-15 | 2020-02-21 | 北京积水潭医院 | 杆状手持操作装置及其力和位置同步测量的方法 |
CN110811808B (zh) * | 2019-11-15 | 2021-04-06 | 北京积水潭医院 | 杆状手持操作装置及其力和位置同步测量的方法 |
CN111110351A (zh) * | 2020-01-10 | 2020-05-08 | 北京天智航医疗科技股份有限公司 | 用于检测关节置换手术机器人系统精度的组件和方法 |
CN111374740A (zh) * | 2020-04-22 | 2020-07-07 | 张家港汇致机电设备有限公司 | 一种房间隔穿刺术用增强现实辅助穿刺系统 |
CN111374740B (zh) * | 2020-04-22 | 2021-10-08 | 重庆市江津区中心医院 | 一种房间隔穿刺术用增强现实辅助穿刺系统 |
Also Published As
Publication number | Publication date |
---|---|
CN109124769B (zh) | 2021-06-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109124769A (zh) | 手术机器人的坐标系标定、控制的方法及系统 | |
CN107042528B (zh) | 一种工业机器人的运动学标定系统及方法 | |
CN110238845B (zh) | 最优标定点选取和误差自测量的自动手眼标定方法及装置 | |
CN109822574A (zh) | 一种工业机器人末端六维力传感器标定的方法 | |
CN104390612B (zh) | 用于Stewart平台构型的六自由度并联机器人基准位姿标定方法 | |
WO2019233227A1 (zh) | 一种基于视觉导航的牙科机器人路径规划系统及方法 | |
CN107152911A (zh) | 基于psd反馈的点激光传感器与机器人相对位置的标定方法 | |
CN105588525B (zh) | 一种工具在机器人法兰坐标系上的标定方法及装置 | |
CN104408299B (zh) | 基于距离识别冗余运动学参数的机器人位置误差补偿方法 | |
Miller et al. | Integration of vision, force and tactile sensing for grasping | |
CN109848983A (zh) | 一种高顺应性人引导机器人协同作业的方法 | |
CN106546170B (zh) | 一种机器人运动轨迹关键点误差测量方法 | |
CN102825602A (zh) | 一种基于psd的工业机器人自标定方法及装置 | |
JP2014151427A (ja) | ロボットシステム及びロボットシステムの制御方法 | |
CN108324373A (zh) | 一种基于电磁定位系统的穿刺手术机器人精确定位实现方法 | |
CN105643641A (zh) | 力传感器标定装置、标定方法及力控制机器人 | |
CN103659806A (zh) | 一种工业机器人零位标定方法 | |
CN109794963A (zh) | 一种面向曲面构件的机器人快速定位方法 | |
JP2019042834A (ja) | 制御装置およびロボットシステム | |
CN103878770A (zh) | 基于速度估计的空间机器人视觉时延误差补偿方法 | |
CN103720514A (zh) | 针对手术空间的医疗外科机器人的参数优化方法 | |
CN113211431A (zh) | 基于二维码修正机器人系统的位姿估计方法 | |
Mishani et al. | Real-time non-visual shape estimation and robotic dual-arm manipulation control of an elastic wire | |
CN105459116A (zh) | 一种基于磁强计的机器人遥操作装置及方法 | |
CN110900608B (zh) | 基于最优测量构型选择的机器人运动学标定方法 |
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 |