CN110559083A - 手术机器人及其末端器械的控制方法、控制装置 - Google Patents
手术机器人及其末端器械的控制方法、控制装置 Download PDFInfo
- Publication number
- CN110559083A CN110559083A CN201910854118.3A CN201910854118A CN110559083A CN 110559083 A CN110559083 A CN 110559083A CN 201910854118 A CN201910854118 A CN 201910854118A CN 110559083 A CN110559083 A CN 110559083A
- Authority
- CN
- China
- Prior art keywords
- pose information
- information
- coordinate system
- arm
- mechanical arm
- 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
- 238000000034 method Methods 0.000 title claims abstract description 86
- 230000000712 assembly Effects 0.000 claims abstract description 13
- 238000000429 assembly Methods 0.000 claims abstract description 13
- 230000001133 acceleration Effects 0.000 claims description 14
- 239000013598 vector Substances 0.000 claims description 12
- 238000004590 computer program Methods 0.000 claims description 11
- 230000007246 mechanism Effects 0.000 description 53
- 238000013507 mapping Methods 0.000 description 31
- 230000008569 process Effects 0.000 description 10
- 238000012937 correction Methods 0.000 description 9
- 238000004364 calculation method Methods 0.000 description 8
- 238000012545 processing Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000001356 surgical procedure Methods 0.000 description 5
- 239000011159 matrix material Substances 0.000 description 4
- 238000002324 minimally invasive surgery Methods 0.000 description 4
- 230000009466 transformation Effects 0.000 description 4
- 230000004913 activation Effects 0.000 description 3
- 239000012636 effector Substances 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 210000004247 hand Anatomy 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000000452 restraining effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 230000008733 trauma Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
- 210000000707 wrist Anatomy 0.000 description 1
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/00234—Surgical instruments, devices or methods, e.g. tourniquets for minimally invasive surgery
-
- 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
- A61B34/37—Master-slave 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
-
- 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
- A61B34/74—Manipulators with manual electric input means
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B90/00—Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
- A61B90/36—Image-producing devices or illumination devices not otherwise provided for
- A61B90/361—Image-producing devices, e.g. surgical cameras
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B2017/00017—Electrical control of surgical instruments
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/00234—Surgical instruments, devices or methods, e.g. tourniquets for minimally invasive surgery
- A61B2017/00353—Surgical instruments, devices or methods, e.g. tourniquets for minimally invasive surgery one mechanical instrument performing multiple functions, e.g. cutting and grasping
-
- 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
- A61B2034/302—Surgical robots specifically adapted for manipulations within body cavities, e.g. within abdominal or thoracic cavities
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B90/00—Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
- A61B90/50—Supports for surgical instruments, e.g. articulated arms
Landscapes
- Health & Medical Sciences (AREA)
- Surgery (AREA)
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Medical Informatics (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Biomedical Technology (AREA)
- Heart & Thoracic Surgery (AREA)
- Robotics (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Oral & Maxillofacial Surgery (AREA)
- Pathology (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种手术机器人及其末端器械的控制方法、控制装置。该控制方法包括:获取机械臂远端在第一坐标系的第一目标位姿信息及各受控操作末端器械在第一坐标系的当前位姿信息;在机械臂远端到达第一目标位姿信息对应的目标位姿的条件下,分别换算各受控操作末端器械在第一坐标系的当前位姿信息获得相应受控操作末端器械在第二坐标系的第二目标位姿信息;根据第一目标位姿信息控制机械臂中各关节组件联动以使机械臂远端到达与第一目标位姿信息对应的目标位姿,并分别根据各第二目标位姿信息控制相应操作臂中各关节组件联动使相应受控操作末端器械保持当前位置及/或姿态不变。本发明能够在术中容易且安全地对机械臂实现调整。
Description
技术领域
本发明涉及医疗器械领域,特别是涉及一种手术机器人及其末端器械的控 制方法、控制装置。
背景技术
微创手术是指利用腹腔镜、胸腔镜等现代医疗器械及相关设备在人体腔体 内部施行手术的一种手术方式。相比传统手术方式微创手术具有创伤小、疼痛 轻、恢复快等优势。
随着科技的进步,微创手术机器人技术逐渐成熟,并被广泛应用。微创手 术机器人通常包括主操作台及从操作设备,主操作台包括手柄,医生通过操作 手柄向从操作设备发送控制命令,从操作设备包括机械臂及安装于机械臂远端 的多个操作臂,操作臂具有末端器械,在工作状态时,末端器械跟随手柄移动, 以实现远程手术操作。
手术过程中,调整机械臂远端往往会带着具有末端器械的操作臂一起移动, 而末端器械中尤其是操作末端器械这样的类型,其位置及/或姿态的变化容易对 患者造成不适或意外创伤的安全性问题。
发明内容
基于此,有必要提供一种在手术过程中安全且易于调整机械臂的手术机器 人中末端器械的控制方法,及基于该方法的控制装置、计算机可读存储介质和 手术机器人。
一方面,提供一种手术机器人中末端器械的控制方法,所述手术机器人包 括机械臂,所述机械臂远端装设有一个以上具有末端器械的操作臂,所述末端 器械中有一个以上被配置为受控末端器械,所述控制方法包括如下步骤:获取 所述机械臂远端在第一坐标系的第一目标位姿信息及各所述受控末端器械在第 一坐标系的当前位姿信息,第一坐标系指所述机械臂的基坐标系;在所述机械 臂远端到达所述第一目标位姿信息对应的目标位姿的条件下,分别换算各所述 受控末端器械在第一坐标系的当前位姿信息获得相应所述受控末端器械在第二 坐标系的第二目标位姿信息,第二坐标系指所述机械臂的工具坐标系;根据所 述第一目标位姿信息控制所述机械臂中各关节组件联动以使所述机械臂远端到 达与所述第一目标位姿信息对应的目标位姿,并分别根据各所述第二目标位姿 信息控制相应所述操作臂中各关节组件联动使相应所述受控末端器械保持当前 位置及/或姿态不变。
其中,在获取各受控末端器械在第一坐标系的当前位姿信息的步骤之前, 包括:获取操作人员输入的选择指令,并根据所述选择指令从所述末端器械中 选择一个以上作为所述受控末端器械。
其中,在换算各所述受控末端器械在第一坐标系的当前位姿信息获得相应 所述受控末端器械在第二坐标系的第二目标位姿信息的步骤之后,包括:判断 各所述第二目标位姿信息是否均为有效;如果判断均为有效,进入根据所述第 一目标位姿信息控制所述机械臂中各关节组件联动以使所述机械臂远端到达与 所述第一目标位姿信息对应的目标位姿,并分别根据各所述第二目标位姿信息 控制相应所述操作臂中各关节组件联动使相应所述受控末端器械保持当前位置 及/或姿态不变的步骤。
其中,在判断各所述第二目标位姿信息是否均为有效的步骤之中,包括: 对各所述第二目标位姿信息是否有效进行判断,并分别获取相应的判断结果; 根据获取的判断结果判断各所述第二目标位姿信息是否均为有效。
其中,在对各所述第二目标位姿信息是否有效进行判断的步骤之中,包括: 对各所述第二目标位姿信息进行解析,以分别获取对应的各所述操作臂中各关 节组件的目标运动状态参数;将各所述操作臂中各关节组件的目标运动状态参 数分别与所述操作臂中各关节组件的运动状态阈值进行比较;如果相应所述操 作臂中各关节组件的目标运动状态参数均未超过所述操作臂中各关节组件的运 动状态阈值,判断相应所述第二目标位姿信息为有效;否则,判断相应所述第 二目标位姿信息为无效。
其中,所述运动状态参数包括位置参数、速度参数及加速度参数,所述运 动状态阈值包括位置参数阈值、速度参数阈值及加速度参数阈值。
其中,在获取机械臂远端在第一坐标系的第一目标位姿信息的步骤之中, 包括:获取所述机械臂远端的任务自由度的配置信息;根据所述机械臂远端的 任务自由度的配置信息获取所述机械臂远端在第一坐标系的、且关联于相应任 务自由度的第一目标位姿信息。
其中,所述机械臂远端的任务自由度的配置信息关联于位置信息及/或姿态 信息。
其中,在获取各受控末端器械在第一坐标系的当前位姿信息的步骤之中, 包括:获取各所述受控末端器械的任务自由度的配置信息;根据各所述受控末 端器械的任务自由度的配置信息获取各受控末端器械在第一坐标系的、且关联 于相应任务自由度的当前位姿信息。
其中,所述受控末端器械被配置为两个以上时,各所述受控末端器械的任 务自由度的配置信息是相同的,所述任务自由度的配置信息关联于位置自由度 及/或姿态自由度。
其中,在获取机械臂远端在第一坐标系的第一目标位姿信息的步骤之中, 包括:获取施加于所述机械臂上用以拖动所述机械臂远端运动的外力的六维力/ 力矩矢量;将所述外力的六维力/力矩矢量解析为所述机械臂远端在第一坐标系 的增量位姿信息;获取所述机械臂远端在第一坐标系的当前位姿信息;根据所 述机械臂远端在第一坐标系的增量位姿信息及当前位姿信息计算出所述第一目 标位姿信息。
其中,在获取机械臂远端在第一坐标系的第一目标位姿信息的步骤之中, 包括:获取运动输入设备输入的运动信息;将所述运动信息解析为所述机械臂 远端在第一坐标系的增量位姿信息;获取所述机械臂远端在第一坐标系的当前 位姿信息;根据所述机械臂远端在第一坐标系的增量位姿信息及当前位姿信息 计算出所述第一目标位姿信息。
其中,在获取机械臂远端在第一坐标系的第一目标位姿信息及各所述受控 末端器械在第一坐标系的当前位姿信息的步骤之前,包括:获取描述所述机械 臂及装设于所述机械臂远端且具有所述受控末端器械的所述操作臂的结构特征 的描述信息,并根据所述描述信息生成模拟所述机械臂及相应所述操作臂的结 构的模型图像。
其中,在对各所述第二目标位姿信息是否有效进行判断,并分别获取相应 的判断结果的步骤之后,包括:改变所述模型图像中第二目标位姿信息被判断 为无效的相应所述受控末端器械对应的所述操作臂的色彩。
另一方面,提供一种计算机可读存储介质,所述计算机可读存储介质存储 有计算机程序,所述计算机程序被配置为由一个以上的处理器执行实现如上述 任一项实施例所述的控制方法的步骤。
另一方面,提供一种手术机器人中末端器械的控制装置,包括:存储器, 用于存储计算机程序;处理器,用于加载并执行所述计算机程序;其中,所述 计算机程序由所述处理器加载并执行实现如上述任一项实施例所述的控制方法 的步骤。
另一方面,提供一种手术机器人,包括:机械臂;装设于所述机械臂远端 的一个以上的具有末端器械的操作臂,所述末端器械包括图像末端器械及/或操 作末端器械;及控制装置;所述控制装置用于执行实现如上述任一项实施例所 述的控制方法的步骤。
本发明具有如下有益效果:
根据机械臂远端在第一坐标系的第一目标位姿信息及各受控末端器械在第 一坐标系的当前位姿信息计算出各受控末端器械在第二坐标系的第二目标位姿 信息,进而利用机械臂远端的第一目标位姿信息及各受控末端器械的第二目标 位姿信息控制它们联动,能够在调整机械臂远端的同时保持各受控末端器械的 当前位姿不变,其使用方便、安全。
附图说明
图1为本发明手术机器人一实施例的结构示意图;
图2为图1所示手术机器人的局部示意图;
图3为图1所示手术机器人的局部示意图;
图4为本发明手术机器人的控制方法一实施例的流程图;
图5为本发明手术机器人一实施例使用状态下的简易示意图;
图6为本发明手术机器人的控制方法一实施例的流程图;
图7为本发明手术机器人的控制方法一实施例的流程图;
图8为本发明手术机器人的控制方法一实施例的流程图;
图9为图1所示手术机器人臂体机构中机械臂的原理示意图;
图10为本发明手术机器人的控制方法中对空间运动角度的解析示意图;
图11为本发明手术机器人的控制方法一实施例的流程图;
图12为本发明手术机器人的控制方法一实施例的流程图;
图13为本发明手术机器人的控制方法在一对一操作模式下的流程图;
图14为本发明手术机器人的控制方法在一对一操作模式下的操作示意图;
图15为本发明手术机器人的控制方法在二对一操作模式下一实施例的流程 图;
图16为本发明手术机器人的控制方法在二对一操作模式下的操作示意图;
图17为本发明手术机器人的控制方法一实施例的流程图;
图18为本发明手术机器人的控制方法一实施例的流程图;
图19为本发明手术机器人的控制方法在二对一操作模式下另一实施例的操 作示意图;
图20为本发明手术机器人另一实施例的结构示意图。
具体实施方式
为了便于理解本发明,下面将参照相关附图对本发明进行更全面的描述。 附图中给出了本发明的较佳实施方式。但是,本发明可以以许多不同的形式来 实现,并不限于本文所描述的实施方式。相反地,提供这些实施方式的目的是 使对本发明的公开内容理解的更加透彻全面。
需要说明的是,当元件被称为“设置于”另一个元件,它可以直接在另一 个元件上或者也可以存在居中的元件。当一个元件被认为是“连接”另一个元 件,它可以是直接连接到另一个元件或者可能同时存在居中元件。当一个元件 被认为是“耦合”另一个元件,它可以是直接耦合到另一个元件或者可能同时 存在居中元件。本文所使用的术语“垂直的”、“水平的”、“左”、“右”以及类 似的表述只是为了说明的目的,并不表示是唯一的实施方式。本文所使用的术 语“远端”、“近端”作为方位词,该方位词为介入医疗器械领域惯用术语,其 中“远端”表示手术过程中远离操作者的一端,“近端”表示手术过程中靠近操 作者的一端。在本发明中,“各”包括一个及以上。
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术 领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术 语只是为了描述具体的实施方式的目的,不是旨在于限制本发明。本文所使用 的术语“及/或”包括一个或多个相关的所列项目的任意的和所有的组合。
如图1至图3所示,其分别为本发明手术机器人一实施例的结构示意图, 及其局部示意图。
手术机器人包括主操作台1及从操作设备2。主操作台1具有运动输入设备 11及显示器12,医生通过操作运动输入设备11向从操作设备2发送控制命令, 以令从操作设备2根据医生操作运动输入设备11的控制命令执行相应操作,并 通过显示器12观察手术区域。其中,从操作设备2具有臂体机构,臂体机构具 有机械臂21及可拆卸地装设于机械臂21远端的操作臂31。机械臂21包括依次 连接的基座及连接组件,连接组件具有多个关节组件。操作臂31包括依次连接 的连杆32、连接组件33及末端器械34,其中,连接组件33具有多个关节组件, 操作臂31通过调节关节组件调节末端器械34的姿态;末端器械34具有图像末 端器械34A及操作末端器械34B。其中,机械臂21及/或操作臂31可跟随运动 输入设备11运动。
例如,运动输入设备11可以通过连线与主操作台1连接,或通过旋转的连 杆与主操作台1相连接。运动输入设备11可以被配置为手持式或穿戴式(常佩 戴于手腕远端如手指或手掌处),其具有多个有效自由度。示例性的,该运动输 入设备11被配置为图3所示的手柄形式。一种情况下,运动输入设备11的有 效自由度的数量被配置为低于定义于臂体机构远端任务自由度的数量;另一种 情况下,运动输入设备11的有效自由度的数量被配置为不低于臂体机构远端的 任务自由度的数量。为了可以不受约束地跟随医生手部自由移动及转动,运动 输入设备11示例性地被配置为具有6个有效自由度,其中,运动输入设备11的有效自由度指可跟随手部运动的有效自由度,令医生具有较大的操作空间, 且可以通过对各有效自由度的解析产生更多有意义的数据,满足对几乎所有构 型的机械臂21的控制。
该运动输入设备11跟随医生手部运动,实时采集手部运动造成的运动输入 设备自身运动的运动信息。利用这些运动信息可以解析出位置信息、姿态信息、 速度信息及加速度信息等。运动输入设备11包括但不限于磁导航定位传感器、 光学定位传感器、或者连杆式主操作手等。
一实施例中,提供一种手术机器人中末端器械的控制方法。如图4所示, 该控制方法包括如下步骤:
步骤S1,获取机械臂远端在第一坐标系的第一目标位姿信息及各受控末端 器械在第一坐标系的当前位姿信息。
该第一坐标系指机械臂的基坐标系。受控末端器械是指定的为保持当前位 置及/或姿态不变而需要受到被动控制的末端器械。末端器械中还包括非受控操 作末端器,非受控末端器械是未指定的跟随机械臂远端运动而无需保持当前位 置及/或姿态不变而不需要受到被动控制的末端器械。在步骤S1之前,包括获取 操作人员输入的选择指令,并根据选择指令从末端器械中选择一个以上作为受 控末端器械。当然,系统也可以默认一个以上(包括全部)的末端器械为受控 末端器械。
步骤S2,在机械臂远端到达第一目标位姿信息对应的目标位姿的条件下, 分别换算各受控末端器械在第一坐标系的当前位姿信息获得相应受控末端器械 在第二坐标系的第二目标位姿信息。
该第二坐标系指机械臂的工具坐标系。
步骤S3,根据第一目标位姿信息控制机械臂中各关节组件联动以使机械臂 远端到达与第一目标位姿信息对应的目标位姿,并分别根据各第二目标位姿信 息控制相应操作臂中各关节组件联动使相应受控末端器械保持当前位置及/或姿 态不变。
通过上述步骤S1~S3,即根据机械臂21远端在第一坐标系的第一目标位姿 信息及各受控末端器械34在第一坐标系的当前位姿信息计算出各受控末端器械 34在第二坐标系的第二目标位姿信息,进而利用机械臂21远端的第一目标位姿 信息及各受控末端器械34的第二目标位姿信息控制它们联动,能够在调整机械 臂21远端的同时保持各受控末端器械34的当前位姿不变,其使用方便、安全。
一实施例中,具体在步骤S2之中,示例性地可以通过如下公式计算出各受 控末端器械34在第二坐标系的第二目标位姿信息:
公式(1):
其中,是受控末端器械An在第二坐标系的第二目标位姿信息,是机 械臂远端在第一坐标系的当前位姿信息,是受控末端器械An在第一坐标系 的第一目标位姿信息,B是机械臂的基坐标系,T是机械臂的工具坐标系。实质 上,这个公式可以通过这样的文字描述来理解,即在机械臂21远端到达机械臂 21远端在第一坐标系的第一目标位姿信息对应的目标位姿的条件下,换算受控 末端器械34在第一坐标系的当前位姿信息获得该受控末端器械34在第二坐标 系的第二目标位姿信息。
应当理解的是,这里的推导主要是从原理方面着手进行分析论证的,忽略 了机械臂21及操作臂31各自关节组件的矩阵变换关系,本领域技术人员根据 该方法应当极其容易获得受控末端器械34在第二坐标系的第二目标位姿信息。
在如图5所示的单孔手术机器人一实施例使用状态下的简易示意图中,机 械臂21远端举例装设有3个具有操作末端器械34B的操作臂31,假设该三个操 作臂31的操作末端器械A1、A2及A3均被配置为受控末端器械,由于它们拥 有共同的第一坐标系,因此分别可以采用上述公式(1)生成各自的计算公式,具 体如下:
公式(2):
公式(3):
公式(4):
进而,根据公式(2)~(4)可以分别求解出受控末端器械A1、A2及A3在第 二坐标系的第二目标位姿信息。
一实施例中,继续参阅图4,在步骤S2之后,包括:
步骤S4,判断各受控末端器械的第二目标位姿信息是否均为有效(即是否 为有效解)。
其中,如果在判断得到各第二目标位姿信息均为有效时,进入前述步骤S3; 而如果在判断得到有一个以上的第二目标位姿信息为无效时,进入步骤S5。
步骤S5,结束控制。
也即,只有在计算出的各第二目标位姿信息均是有效解的情况下才被允许 实现上述的联动控制目的。而在任何一个第二目标位姿信息没有有效解的情况 下则通常不允许对机械臂21及操作臂31进行前述的联动控制。
在一些实施例中,也可以在上述步骤S4中,允许判断为有效的受控末端器 械34在调节机械臂21时保持位置及/或姿态不变,而判断为无效的受控末端器 械34跟随机械臂21运动。
在一些实施例中,也可以在多个第二目标位姿信息被判断为无效时,可以 先调整其中一个为有效,然后根据被调整为有效的第二目标位姿信息及受控末 端器械34在第一坐标系的当前位姿信息重新计算机械臂21在第一坐标系的第 一目标位姿信息,之后,再根据调整后的机械臂21在第一坐标系的第一目标位 姿信息及其余未调整的受控末端器械34在第一坐标系的当前位姿信息利用如上 述公式(1)计算其各自在第二坐标系的第二目标位姿信息。可以重复上述步骤 进行循环计算,直至计算出的各第二目标位姿信息均为有效;或者,可以设置 重复上述步骤进行循环计算的次数,若仍不能满足各第二目标位姿信息均为有 效,则结束控制。
一实施例中,如图6所示,具体在上述步骤S4之中,包括:
步骤S41,对各受控末端器械的第二目标位姿信息是否有效分别进行判断。
步骤S42,根据对各受控末端器械的第二目标位姿信息的判断结果来判断是 否均为有效。
具体而言,如图7所示,在上述步骤S41之中,包括:
步骤S411,对相应受控末端器械的第二目标位姿信息进行解析以获取其对 应的操作臂中各关节组件的目标运动状态参数。
其中,该运动状态参数可以是位置参数、速度参数及/或加速度参数。其中, 位置参数可以由相应的目标位姿信息直接解析得到,速度参数及/或加速度参数 均可以由这些位置参数及产生这些位置参数所经过的时间计算得到,或者相应 也可以借助速度传感器、加速度传感器测量得到。
步骤S412,将操作臂中各关节组件的目标运动状态参数分别与操作臂中各 关节组件的运动状态阈值进行比较以确定相应第二目标位姿信息是否有效。
在控制机械臂21和操作臂31的联动过程考虑到平滑性和可靠性,该运动 状态参数通常所指为位置参数、速度参数及加速度参数,那么在该步骤S422中, 具体即将相应操作臂31中每个关节组件的位置参数、速度参数及加速度参数分 别与该相应关节组件的位置参数阈值、速度参数阈值及加速度参数阈值分别进 行比较。当然,在一些实施例中,该运动状态参数还可指位置参数、速度参数 及加速度参数中的一个或两个,比如,该运动状态参数仅包括位置参数。
通过将操作臂31各关节组件的运动状态参数与基于调整对象结构特征和性 能参数及/或自定义设置的各关节组件的运动状态阈值进行逐一比较,来确定操 作臂31的第二目标位姿信息是否有效,能够有效保护操作臂31,提高其使用寿 命。示例性的,即使通过比较调整对象中各关节组件的位置参数(即运动行程) 在其相应关节组件的位置参数阈值(即运动行程范围)以内,然而其速度参数 及/或加速度参数超过速度参数阈值及/或加速度参数阈值,反映了其调节速度过 快及/或速度变化过快,进而有可能影响安全使用而被判定为无效。
其中,如果操作臂31中各关节组件的目标运动状态参数均未超过操作臂31 中各关节组件的运动状态阈值,则判断该第二目标位姿信息为有效;而如果操 作臂31中各关节组件的目标运动状态参数中有一项以上超过操作臂31中各关 节组件的运动状态阈值,则判断该第二目标位姿信息为无效。
值得注意的是,在某些使用场景下,机械臂21运动时,需要确保机械臂21 运动时使机械臂21远端绕不动点(远端运动中心,Remote Center of Motion)运 动,即做RCM约束运动,具体可以通过对机械臂远端的任务自由度进行设置来 确保实现,该任务自由度仅与姿态自由度相关。
该不动点与机械臂远端具有一个相对固定的位置关系。根据具体的控制目 的,一些实施例中第二坐标系的原点可以是该不动点,其他实施例中第二坐标 系的原点也可以是机械臂远端上的某一点。
可以在机械臂21远端与操作臂31连接处设置与处理系统连接的检测单元, 该检测单元用于在穿刺器可靠连接于机械臂21远端时产生令机械臂21远端绕 不动点运动的触发信号。处理系统在检测到触发信号时自动设置相应任务自由 度以控制机械臂21远端进行RCM约束运动。当然,也可以由医生等操作人员 通过主动设置相应任务自由度以控制机械臂21远端进行RCM约束运动。此外, 该触发信号也可以由操作人员通过输入装置如按钮输入。
另外,根据设定,操作臂31远端也可以具有不动点,操作臂31的不动点 不同于机械臂21的不动点,操作臂31所具有的末端器械34经配置也可以绕操 作臂31的不动点运动,即进行RCM约束运动。
根据对机械臂远端及/或操作臂远端任务自由度的配置,可以对机械臂远端 及/或操作臂远端进行RCM约束控制,以适用于多种使用场景。
一实施例中,处理系统经配置可选择性地控制受控末端器械34保持位置不 变及/或姿态不变。处理系统具体对受控末端器械34进行何种控制可以根据医生 输入的控制指令来进行选择。该控制指令实质上体现了医生对受控末端器械34 的任务自由度所进行的配置。
上述对于机械臂21及各操作臂31的控制可以在缺少视野也即缺少具有图 像末端器的操作臂31的情况下进行。更优地,上述的控制可以在存在装设于机 械臂21远端的具有图像末端器械34A的操作臂31的情况下进行,且这也与实 际手术过程更相符合。通常,该方法不需要对具有图像末端器械34A的操作臂 31进行如上述相同原理的控制,而是让该具有图像末端器械34A的操作臂31 直接跟随机械臂21远端的运动而运动,这样可以让医生能够非常直观地观察到 由于机械臂21被调整而导致的视野的变化,也即,医生可以通过控制机械臂21 远端运动而调整视野,并利用该视野对具有受控操作末端器械34B的操作臂31 进行安全、准确地控制。在一些实施例中,由于调整图像末端器械34A的同时 可以保持各受控操作末端器械34B位姿不变,通过间歇性先后分别对图像末端 器械34A及对各受控操作末端器械34B进行调整,可以起到便利地扩大手术操 作空间的作用。
一实施例中,假设只可以对操作末端器械34B进行如上宗旨的控制而让图 像末端器械34A跟随机械臂21远端移动以提供实时变化的视野,也即只可以将 操作末端器械34B配置为上述的受控末端器械的情况下,在上述步骤S1之前, 包括:
识别装设于机械臂远端的各操作臂所具有的末端器械的类型,并在识别出 相应操作臂具有受控操作末端器械之后,进入步骤S1。
具体而言,需要在操作臂31安装于机械臂21远端时先获取相应操作臂31 的描述信息,该描述信息包括其上所设置的末端器械34的类型信息;之后,再 根据获取的这些描述信息来识别出具有受控操作末端器械34B的操作臂31,据 此进入步骤S1,以自动对具有受控操作末端器械34B的操作臂31进行本发明 期望实现的目的那样的控制。其中,该描述信息通常还包括操作臂31的连杆参 数。处理系统对于该描述信息的获取举例可以通过数据接口或感应装置来实现, 相应的,这些描述信息存储于操作臂31的芯片(包括存储器、电子标签等)中。
一实施例中,具体在上述步骤S1中,对于如何获取各受控末端器械34在 第一坐标系的当前位姿信息举例可以通过获取相应操作臂31各关节组件的关节 角等信息并利用正运动学求解出来。
一实施例中,具体在上述步骤S1中,对于如何获取机械臂21远端的第一 目标位姿信息可以通过如图8所示的步骤进行:
步骤S11,获取医生对机械臂的操作信息,并将操作信息解析并映射为机械 臂远端在第一坐标系的增量位姿信息。
其中,该操作信息可以是由医生施加于机械臂远端以拖动机械臂远端运动 的外力所产生的外力信息(如六维力/力矩矢量);或者,该操作信息可以是运动 输入设备11遥操作机械臂远端运动输入的其自身的运动信息。
步骤S12,获取机械臂远端在第一坐标系的当前位姿信息。
步骤S13,根据机械臂远端在第一坐标系的增量位姿信息及当前位姿信息计 算出其目标位姿信息。
应当理解的是,上述步骤S11~S13所记载的方法同样适合对各操作臂31 进行遥操作,比如可以让机械臂21不动,而只控制操作臂31运动;或者将机 械臂21和操作臂31视为一串联结构的臂体机构而进行整体控制。这两种示例 实现与本发明不同的发明目的。
本发明主要以操作信息为运动信息为例进行详细说明。
进而上述步骤S11具体为:
获取运动输入设备输入的运动信息,并将运动信息解析并映射为机械臂远 端在第一坐标系的增量位姿信息。
该步骤主要是对前后时刻的运动信息进行解析,该前后时刻可以是前后相 邻的时刻,或前后相间隔一定时长的时刻。一种方式中,通过计算出后一时刻 的运动信息相对于前一时刻的运动信息在固定坐标系的位姿变化,即增量位姿 信息。然后将固定坐标系的增量位姿信息映射为末端器械34在参考坐标系的增 量位姿信息。示例性的,该固定坐标系举例可以定义在显示器处,当然,该固 定坐标系也可以定义在手术机器人中其它部位,该部位至少在工作时不可动。 其中,“映射”表示一种对应转换的关系。
进而上述步骤S12可以包括:
首先,获取机械臂各关节组件的位置信息。具体可通过装设于关节组件处 的位置传感器如编码器获取相应的位置信息。在以图1及图9示意的实施例中, 该机械臂21具有5个自由度,借助各位置传感器能够采集到这样一组位置信息 (d1,θ2,θ3,θ4,θ5)。
然后,根据各关节组件的位置信息计算出机械臂的当前位姿信息。其中, 通常可以结合正运动学来进行计算。建立机械臂21的不动点(即C点处,机械 臂21的工具坐标系的原点在不动点上)至机械臂21的基座的运动学模型,输 出C点与基座的模型转换矩阵计算方法为
根据C点与基座的模型转换矩阵获取C点在固定坐标系的位姿信息。 假设在不改变C点位置的情况下,旋转C点的坐标系,使其达到模型转换矩阵 所描述的姿态,可得到旋转轴角度[θx0,θy0,θz0],如图10所示。θx0为滚动角, θy0为偏航角,θz0为俯仰角,而在图9所示的机械臂21中,缺乏滚动角的自 由度进而实际上θx0不可调。
一实施例中,如图11所示,可以通过位置控制方法实现机械臂21远端和 受控末端器械34的联动。具体而言,在步骤S3之中,包括:
步骤S31,根据臂体机构的目标位姿信息计算出臂体机构各关节组件的目标 位置信息。
其中,通常可以结合逆运动学来进行计算。
步骤S32,根据各关节组件的目标位置信息控制臂体机构各关节组件联动以 使臂体机构远端运动至目标位姿。
应当理解的是,这里的臂体机构可以是机械臂21及/或操作臂31,对于机 械臂21和操作臂31均按照步骤S31~S32进行。
进一步地,如图12所示,为了反映对于臂体机构的主动控制是医生的真实 意图,可以在步骤S1之前,进行:
步骤S100,检测是否获取到开始主动控制的启动命令。
其中,该启动命令可以由主动控制开关输入。在检测获取到该启动命令之 后进入上述的步骤S1。
并且,在步骤S3之后,进行:
步骤S101,检测是否获取到停止主动控制的结束命令。
其中,该结束命令同样可以由该主动控制开关输入。在检测获取到该结束 命令之后,结束对臂体机构的控制;否则,重新进入到步骤S1~步骤S101。
上述的主动控制开关可被配置为脚踏开关,按键开关,主操作手开关等。
进一步地,为了更加贴合医生对于臂体机构的主动控制的真实意图,可以 在步骤S1之前,进行:
检测手术机器人是否处于医生的操作状态中。
该步骤可以通过在主操作台设置检测头部是否贴近的接近开关来实现。在 贴近开关检测到头部靠近后,满足启动条件,进入步骤S1。或者,也可以通过 设置语音识别模块,根据医生的启动语音指令来确认启动,从而进入步骤S1。
一实施例中,可以为机械臂21远端和各受控末端器械34分别进行任务自 由度的配置以生成配置信息,且各受控末端器械34的任务自由度的配置信息通 常被配置为相同。
对于机械臂21远端的任务自由度的配置可被理解为使能功能,即允许机械 臂21远端运动的自由度。举例可以在前述步骤S11中,结合机械臂21远端的 任务自由度的配置信息对操作信息(即外力信息或运动信息)进行解析并映射 为机械臂21在第一坐标系的增量位姿信息,其中,任务自由度由操作人员根据 使用场景进行设定,即操作人员根据需求设定机械臂远端可调节的位置及/或姿 态。
而对于受控末端器械34的任务自由度的配置可被理解为禁用功能,即禁止 末端器械34可以运动的自由度,结合前文,通过该配置可以保持受控末端器械 34的位置及/或姿态不变。举例可以在前述步骤S12中,结合受控末端器械34 的任务自由度的配置信息分别计算出各第二目标位姿信息。
应当理解的是,在其它实施例中,比如,在前文所描述的间歇性先后控制 机械臂21及操作臂31运动的情况下,尤其是单独对各操作臂31进行遥操作时, 可以重新为各受控末端器械34配置相同或不同的任务自由度,以实现不同的发 明目的,此时,为了确保安全,通常要求医生在具有视野的条件下来对这些操 作臂31进行遥操作。
上述对于机械臂21远端及末端器械34的任务自由度的配置,举例可以由 医生自由地配置,比如通过预先生成的含有可供配置的任务自由度的人机交互 界面来设置。
具体而言,臂体机构(机械臂21及/或操作臂31)远端的任务自由度可被 理解为臂体机构远端在笛卡尔空间允许运动的自由度,其至多为6个。臂体机 构远端在笛卡尔空间实际具有的自由度为有效自由度,臂体机构远端的有效自 由度与其构型(即结构特征)相关,臂体机构远端的有效自由度可被理解为臂 体机构远端在笛卡尔空间内可实现的自由度。末端器械34可供配置的任务自由 度与机械臂21及操作臂31总的有效自由度相关联,该机械臂21和操作臂31 可以视为一个串联臂体机构,两者共同作用以提供可供末端器械34配置的任务 自由度,其同样至多为6个。臂体机构远端的任务自由度的配置信息即为配置臂体机构远端被允许在哪些自由度进行运动。
对于臂体机构远端的任务自由度的配置信息的利用,在步骤S11可以被解 释成在解析时利用,或者在映射时利用。比如其被配置为允许位姿信息中的[x,y,z] 这三个自由度运动,无论以何种形式被利用,主要是在最后的目标位姿信息中 得到体现,即[x,y,z]这三个自由度跟随操作信息如运动信息或外力信息变化,[α, β,γ]这三个自由度并不跟随运动信息或外力信息变化。其中,x为水平移动任 务自由度、y为竖直移动任务自由度、z为前后移动任务自由度、α为偏航角任 务自由度、β为俯仰角任务自由度、及γ为滚动角任务自由度。
在如图9所示的机械臂21中,机械臂21的有效自由度包括[x,y,z,α,β], 根据机械臂21中关节组件210~214的结构特性,其在滚动角γ上不具备自由 度,连接于机械臂21远端且用于安装和驱动具有末端器械34的操作臂31的动 力机构22的任务自由度从机械臂21的有效自由度中进行选择:
若配置动力机构22的任务自由度(即机械臂21远端的任务自由度)的配 置信息为[x,y,z,α,β],则动力机构22的任务自由度的配置信息与机械臂21的 有效自由度的信息完全匹配,此时对动力机构22进行的是自由控制,能够控制 动力机构22大范围移动以适应手术室布置;
若配置动力机构22的任务自由度的配置信息为[x,y,z,α]或[x,y,z]等时,则动力机构22的任务自由度的配置信息包含于机械臂21的有效自由度的信息内、 且不完全匹配,在控制动力机构22时,只可以在[x,y,z,α]或[x,y,z]这几个对应的 自由度进行调节,此时对动力机构22进行的是约束控制,能够在限定的范围内 对动力机构22进行控制。
尤其是,若配置动力机构22的任务自由度的配置信息为只包括[α,β]时, 这属于约束控制中的RCM约束控制,即绕远程运动中心(即不动点)运动,只 可以对偏航角和俯仰角进行调节,能够满足手术过程中的微调。
当然,若机械臂21的有效自由度的信息包括[x,y,z,α,β,γ],通过对动力机 构22的任务自由度的配置,RCM约束控制可总共包括仅对偏航角、仅对俯仰 角、仅对滚动角、对偏航角和俯仰角、对偏航角和滚动角、对俯仰角和滚动角、 和对偏航角、俯仰角及滚动角进行调节的这多种类型。
在一种配置中,若动力机构22的任务自由度的配置信息只部分包含于机械 臂21的有效自由度的信息中,一种较佳的选择是提示配置错误的信息,另一种 选择是可以仅允许包含于机械臂21的有效自由度的信息的部分自由度可调。仍 以图9所示的机械臂21为例,若动力机构22的任务自由度的配置信息为[y,z, α,β,γ]或[x,y,z,α,β,γ],一方面可以提示配置错误的信息,另一方面可以允 许[y,z,α,β]或[x,y,z,α,β]中进行相应的自由度的调节。这可以根据实际需要进 行配置。
手术机器人可以提供一个或多个运动输入设备11。一实施例中,手术机器 人提供两个运动输入设备11。为便于操作,两个运动输入设备11提供给两个手 来操作,可以是一个人来操作,也可以是两个人来操作。机械臂21可选择性地 跟随一个运动输入设备或两个运动输入设备运动,也即机械臂21可以跟随该两 个运动输入设备11中的任一个或两个运动,定义一对一操作模式为用一个运动 输入设备11来控制一个机械臂21运动,定义二对一操作模式为用两个运动输 入设备11来一起控制一个机械臂21运动。在控制一个机械臂21运动时,可以 选择采用一对一操作模式或二对一操作模式。对于一对一操作模式而言,可以 进一步选择采用哪一个运动输入设备来进行控制。
一实施例中,对于一对一操作模式,举例可以通过公式Pn=KPn获得相应被 选择操作的一个运动输入设备11在第n时刻的位姿信息P,其中,K是比例系 数,通常,K>0,更佳的,1≥K>0,以实现对位姿的缩放,便于控制。
一实施例中,对于二对一操作模式,举例可以通过公式Pn=K1PnL+K2PnR获 得相应被选择操作的两个运动输入设备11在第n时刻的位姿信息P,其中,K1和K2分别表示不同运动输入设备11的比例系数,通常,K1>0,K2>0;更佳的, 1≥K1>0,1≥K2>0。
计算某前后时刻一对一操作模式或二对一操作模式对应的运动输入设备11 的增量位姿信息Δpn_n-1时,根据如下公式计算即可:
Δpn_n-1=Pn-Pn-1
当然,通常可以结合机械臂21远端的任务自由度来实现固定坐标系的增量 位姿信息到机械臂21远端在第一坐标系的增量位姿信息的映射。
在一实施例中,如图13和图14所示,对于一对一操作模式而言,获取运 动输入设备输入的运动信息,并将运动信息解析并映射为机械臂远端在第一坐 标系的增量位姿信息的步骤包括:
步骤S111,获取前一时刻运动输入设备的第一位姿信息。
步骤S112,获取后一时刻运动输入设备的第二位姿信息。其中,后一时刻 通常可以被理解为当前时刻,而随着时间的变化,这里的后一时刻又相对成为 更后一时刻的前一时刻。步骤S111及步骤S112,获取的均是被选择用于一对一 操作模式的运动输入设备输入的位姿信息。
步骤S113,根据运动输入设备的第一位姿信息、第二位姿信息计算获取运 动输入设备在固定坐标系的增量位姿信息。
步骤S114,将运动输入设备在固定坐标系的增量位姿信息映射为机械臂远 端在第一坐标系的增量位姿信息。
增量位姿信息增量位姿信息在一实施例中,结合图15和图16参阅,对于 二对一操作模式而言,获取运动输入设备输入的运动信息,并将运动信息解析 并映射为机械臂远端在第一坐标系的增量位姿信息的步骤包括:
步骤S111’,分别获取前一时刻两个运动输入设备各自的第一位姿信息。
步骤S112’,分别获取后一时刻两个运动输入设备各自的第二位姿信息。
步骤S113’,结合比例系数及两个运动输入设备各自的第一位姿信息、第二 位姿信息计算获取两个运动输入设备在固定坐标系的增量位姿信息。
其中,对于步骤S113’,具体可通过如下步骤实现:
计算一运动输入设备的第一位姿信息和第二位姿信息在固定坐标系的增量 位姿信息,并计算另一运动输入设备的第一位姿信息和第二位姿信息在固定坐 标系的增量位姿信息;
结合比例系数计算一运动输入设备在固定坐标系的增量位姿信息和另一运 动输入设备在固定坐标系的增量位姿信息分别得到该两个运动输入设备在固定 坐标系的增量位姿信息。
步骤S114’,将该两个运动输入设备在固定坐标系的增量位姿信息映射为机 械臂远端在第一坐标系的增量位姿信息。
其中,在二对一操作模式种,示例性的,该比例系数K1和K2均取值为0.5, 则获取的增量位姿信息表示的是该两个运动输入设备之间连线的中心点的增量 位姿信息。根据实际情况,可以对K1和K2进行另外的赋值。
进一步地,若需结合机械臂21远端的任务自由度的配置信息进行考虑。一 方面,可以在步骤S113(或步骤S113’)中仅获取运动输入设备11与机械臂21 远端的任务自由度相关联的自由度的位姿信息,然后进行步骤S114(或步骤 S114’)。另一方面,也可以在步骤S113(或步骤S113’)中获取运动输入设备全 部有效自由度的位姿信息,但在步骤S114(或步骤S114’)中将固定坐标系的增 量位姿信息中与机械臂21远端的任务自由度相关联的自由度的位姿信息映射为 机械臂21远端在第一坐标系的增量位姿信息,而保持与机械臂21远端的任务 自由度不相关联的自由度的位姿信息。
一实施例中,可以在实现步骤S114或步骤S114’之中,进行如下步骤:
根据获取到的增量位姿信息中所包含参数的类型(跟任务自由度相关)的 不同,对不同参数进行不同方式的修正。如通过设置不同的修正系数来对不同 类型的参数进行修正,修正前后的参数可表示为乘除的关系;或可设置不同的 补偿值来对不同类型的参数进行修正,修正前后的参数可表示为加减的关系; 或者,可以结合设置修正系数和补偿值的方式共同对不同类型的参数进行修正, 修正前后的参数可表示为包括乘除和加减的关系。
对不同参数进行不同方式的修正的步骤可以在步骤S111~S114(步骤 S111’~S114’)之间的任意步骤内进行。例如可建议在步骤S114(或步骤S114’) 中进行。该步骤能够更准确地反映医生的操作意图降低误操作的影响,并且能 够对由于手部灵活性因素造成的部分转动角度不可达的问题进行补偿,实现任 意角度可调。
值得注意的是,由于一对一操作模式和二对一操作模式在习惯或灵活性上 有所不同,即使采用相同的修正方式对增量位姿信息中不同类型的参数进行修 正,可以为这两种操作模式设置不同的修正系数及/或补偿值。
一对一操作模式和二对一操作模式均适用于机械臂远端不同任务自由度的 情况。而从便捷性和准确性的角度考虑,一对一操作模式比较适合于机械臂远 端任务自由度较多(如4任务自由度以上)的情况,二对一操作模式比较适合 于机械臂远端任务自由度较少(如3任务自由度以内)的情况。
比如,采用二对一操作模式时,可便捷准确地进行RCM约束控制,此时只 需要解析运动信息所包含的位置信息并映射为机械臂21的姿态信息即可,易于 利用该两个运动输入设备11进行控制。
举例而言,可以将两个运动输入设备11在水平方向上的平移运动信息解析 并映射为机械臂21在第一坐标系的偏航角增量信息,将两个运动输入设备11 在竖直方向上的平移运动信息解析并映射为机械臂21在第一坐标系的俯仰角增 量信息,将两个运动输入设备11在任意平面如竖直平面上的转动运动信息解析 并映射为机械臂21在第一坐标系的滚动角增量信息,示例性的,如图17所示, 该两个运动输入设备11在固定坐标系的水平移动增量信息、竖直移动增量信息 及转动增量信息可通过如下步骤进行:
步骤S231,分别获取前一时刻两个运动输入设备各自的第一位置信息。
步骤S232,分别获取后一时刻两个运动输入设备各自的第二位置信息。
步骤S233,结合比例系数及两个运动输入设备各自的第一位置信息、第二 位置信息计算获取两个运动输入设备在固定坐标系的水平移动增量信息、竖直 移动增量信息及转动增量信息。
其中,在步骤S233中,固定坐标系的水平移动增量信息和竖直移动增量信 息可以参照前文方法计算获取,而固定坐标系的转动增量信息举例可以通过如 下方式计算获取,具体如图18及图19所示:
步骤S2331,建立前一时刻两个运动输入设备之间的第一位置向量。
步骤S2332,建立后一时刻两个运动输入设备之间的第二位置向量。
步骤S2333,结合比例系数计算第一位置向量与第二位置向量之间的夹角进 而获取该两个运动设备在固定坐标系的转动增量信息。
步骤S2334,将该两个运动设备在固定坐标系的水平移动增量信息、竖直移 动增量信息及转动增量信息一对一映射为机械臂远端的偏航角增量信息、俯仰 角增量信息及滚动角增量信息。
其中,可以在主操作台及/或从操作设备中配置一输入装置,该输入装置用 于输出切换映射关系的控制命令。例如,映射关系包括自然映射关系和非自然 映射关系。
其中,可以定义自然映射关系为将由运动信息解析获取的在固定坐标系的 增量位姿信息按照其参数的类型一对一的映射至机械臂21远端在第一坐标系的 增量位姿信息,具体即将固定坐标系的水平移动增量信息映射为机械臂21在第 一坐标系的水平移动增量信息、将固定坐标系的竖直移动增量信息映射为机械 臂21在第一坐标系的竖直移动增量信息、将固定坐标系的前后移动增量信息映 射为机械臂21在第一坐标系的前后移动增量信息、将固定坐标系的偏航角增量 信息映射为机械臂21在第一坐标系的偏航角增量信息、将固定坐标系的俯仰角 增量信息映射为机械臂21在第一坐标系的俯仰角增量信息、及将固定坐标系的 滚动角增量信息映射为机械臂21在第一坐标系的滚动角增量信息。这些均可以 根据机械臂21的任务自由度的配置信息进行择取。
非自然映射关系为自然映射关系之外的映射关系,一实例中,该非自然映 射关系包括但不限于转换映射关系,其包括但不限于前述的将固定坐标系的水 平移动增量信息、竖直移动增量信息及转动增量信息一对一映射为机械臂21的 偏航角增量信息、俯仰角增量信息及滚动角增量信息。配置成非自然映射关系 能够在如二对一操作模式等某些情况下较容易地对机械臂21进行控制。
结合获取的机械臂21远端的任务自由度的配置信息、及/或操作模式的类型 信息、及/或映射关系的类型信息,解析运动信息并映射为机械臂21远端在第一 坐标系的增量位姿信息。进而,医生能够根据自身习惯设置易于理解和方便操 作的方式。
在一些实施例中,运动输入设备11的有效自由度也可能小于6,然而,只 要运动输入设备11的有效自由度不小于机械臂21的任务自由度,就可以采用 前述的一种或多种方法来解析运动信息并映射为机械臂21远端在第一坐标系的 增量位姿信息,以达到控制目的。
一实施例中,按照对臂体机构(例如机械臂)调整过程的精确度,可以分 为粗调模式和精调模式。该两个调整模式均适用于前述的控制方法。在粗调模 式中,医生可以先控制臂体机构远端运动至大概的目标位姿,然后由医生切换 至精调模式,进而控制臂体机构远端运动至精确的目标位姿。更具体地,粗调 模式与精调模式之间的区别在于,从对臂体机构的调节幅度或速度上来看,精 调模式相较于粗调模式而言表现在其幅度更小或其速度更慢,以易于医生的精 确调节。具体地,无论是一对一操作模式还是二对一操作模式,可以在上述步 骤S2011的根据操作模式及固定坐标系下的增量位姿信息中参数信息类型(与自由度关联)的不同进行相应的修正的子步骤中,对用于修正固定坐标系下的 增量位姿信息各参数信息的修正系数及/或补偿值进行重新配置,其中,该在精 调模式中的修正系数及/或补偿值相对于在粗调模式中的修正系数及/或补偿值 通常要更小。
同样,要实现粗调模式与精调模式之间的切换,可以在主操作台及/或从操 作设备上配置一个输入装置,该输入装置用于输出切换调整模式的切换指令。
较佳的,如果医生在调节臂体机构远端运动至目标位姿的过程中,发现一 个以上的矢量已经达到了目标位姿,可以对臂体机构远端的任务自由度进行重 新配置,以仅调节未达到目标位姿的矢量。示例性的,手术机器人包括一输入 装置,输入装置经配置用于产生重新配置臂体机构远端的任务自由度的控制命 令。处理系统经配置在获取到控制命令时,重新生成可供自由配置的臂体机构 远端的任务自由度的信息。其中,所生成的可供自由配置的臂体机构远端的任 务自由度的信息与前一时刻被配置的臂体机构的任务自由度的配置信息完全匹 配。也即,假设本来可供臂体机构远端的任务自由度的信息为[x,y,z,α,β],然 而前一时刻被使用的臂体机构远端的任务自由度的配置信息只为[x,y,z,α],则根 据该控制命令生成的新的可供自由配置的臂体机构远端的任务自由度的信息只 为[x,y,z,α]。
举例而言,目标位姿需要对[x,y,z,α,β,γ]进行调节,如果医生发现x,y这 两个矢量已经达到期望,则可以触发上述的控制命令并根据生成的新的可供配 置的臂体机构的任务自由度信息来重新配置臂体机构远端的任务自由度为[z,α, β,γ],以利用前述对臂体机构的控制方法对z,α,β,γ继续进行调节,进一步 地,如果一并对[z,α,β,γ]进行调节存在困难,可以再配置臂体机构远端的任务 自由度进而利用前述对臂体机构的控制方法逐一地对[z,α,β,γ]进行调节,直至 最终臂体机构远端完全运动至目标位姿。前文所提及的配置于主操作台(包括 运动输入设备11)及/或从操作设备的各类用途的输入装置包括但不限于触摸屏、 按键、旋钮、脚踏及语音识别模块。他们可以组合使用,也可以单独使用;他 们可以采用同一个,也可以采用多个。举例而言,输入装置大多配置于主操作 台处,方便医生无需离开当前位置来操作。举例而言,输入装置大多可以采用 语音识别模块,根据识别医生的语音来产生并输出相应控制命令进而选择相应 的模式,这样手术机器人的结构相对比较简单,而且解放了双手和双脚,能够 实现更多连续性(即不中断当前操作)的操作。
上述实施例所描述的方法适用于对图像末端器械34A和操作末端器械34B 进行控制,以使受控末端器械保持当前位置及/或姿态不变。
上述实施例适用于对如图1所示类型的手术机器人中的末端器械进行控制。 该类型的手术机器人包括一个机械臂21及装设于该机械臂21远端的一个以上 的具有末端器械34的操作臂31,该机械臂21及操作臂31均具有若干自由度。
上述实施例同样适用于对如图20所示类型的手术机器人中的末端器械进行 控制。该类型的手术机器人包括一个主臂32’、装设于主臂32’远端的一个以上 的调整臂30’及装设于调整臂30’远端的一个以上的具有末端器械的操作臂31’, 该主臂32’、调整臂30’及操作臂31’均具有若干自由度。如图20所示,该手术 机器人中,调整臂30’可以设置为四个,每个调整臂30’可以仅设置一个操作臂 31’。根据实际使用场景,可以将如图20所示类型的手术机器人的三段式臂体结 构配置为如图1所示类型的手术机器人的两段式臂体结构从而实现控制。一实 施例中,在该两种类型的手术机器人中的操作臂的概念为一致的情况下,例如, 根据配置,可以将如图20所示类型的手术机器人中的各调整臂30’视为如图1所示类型的手术机器人中的机械臂21进行控制;又例如,根据配置,也可以将 如图20所示类型的手术机器人中的任一调整臂30’及主臂32’的整体视为如图1 所示类型的手术机器人中的机械臂21进行控制。一实施例中,可以将如图20 所示类型的手术机器人中的主臂32’视为如图1所示类型的手术机器人中的机械 臂21、并将如图20所示类型的手术机器人中的调整臂30’及其对应的操作臂31’ 的整体视为如图1所示类型的手术机器人中的操作臂31进行控制。
一实施例中,上述手术机器人的控制方法通常被配置为在手术机器人的控 制装置中来实现,该控制装置包括存储器和一个以上的处理器,存储器用于存 储计算机程序,处理器用于加载并执行计算机程序以实现如上述任一项实施例 所述的控制方法。
一实施例中,提供一种计算机可读存储介质,计算机可读存储介质存储有 计算机程序,该计算机程序被配置为由一个以上的处理器执行实现上述任一项 实施例所述的控制方法的步骤。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对 上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技 术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细, 但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的 普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改 进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权 利要求为准。
Claims (10)
1.一种手术机器人中末端器械的控制方法,所述手术机器人包括机械臂,所述机械臂远端装设有一个以上具有末端器械的操作臂,所述末端器械中有一个以上被配置为受控末端器械,其特征在于,所述控制方法包括如下步骤:
获取所述机械臂远端在第一坐标系的第一目标位姿信息及各所述受控末端器械在第一坐标系的当前位姿信息,第一坐标系指所述机械臂的基坐标系;
在所述机械臂远端到达所述第一目标位姿信息对应的目标位姿的条件下,分别换算各所述受控末端器械在第一坐标系的当前位姿信息获得相应所述受控末端器械在第二坐标系的第二目标位姿信息,第二坐标系指所述机械臂的工具坐标系;
根据所述第一目标位姿信息控制所述机械臂中各关节组件联动以使所述机械臂远端到达与所述第一目标位姿信息对应的目标位姿,并分别根据各所述第二目标位姿信息控制相应所述操作臂中各关节组件联动使相应所述受控末端器械保持当前位置及/或姿态不变。
2.根据权利要求1所述的控制方法,其特征在于,在获取各受控末端器械在第一坐标系的当前位姿信息的步骤之前,包括:
获取操作人员输入的选择指令,并根据所述选择指令从所述末端器械中选择一个以上作为所述受控末端器械。
3.根据权利要求1所述的控制方法,其特征在于,在换算各所述受控末端器械在第一坐标系的当前位姿信息获得相应所述受控末端器械在第二坐标系的第二目标位姿信息的步骤之后,包括:
判断各所述第二目标位姿信息是否均为有效;
如果判断均为有效,进入根据所述第一目标位姿信息控制所述机械臂中各关节组件联动以使所述机械臂远端到达与所述第一目标位姿信息对应的目标位姿,并分别根据各所述第二目标位姿信息控制相应所述操作臂中各关节组件联动使相应所述受控末端器械保持当前位置及/或姿态不变的步骤。
4.根据权利要求3所述的控制方法,其特征在于,在判断各所述第二目标位姿信息是否均为有效的步骤之中,包括:
对各所述第二目标位姿信息是否有效进行判断,并分别获取相应的判断结果;
根据获取的判断结果判断各所述第二目标位姿信息是否均为有效。
5.根据权利要求4所述的控制方法,其特征在于,在对各所述第二目标位姿信息是否有效进行判断的步骤之中,包括:
对各所述第二目标位姿信息进行解析,以分别获取对应的各所述操作臂中各关节组件的目标运动状态参数;
将各所述操作臂中各关节组件的目标运动状态参数分别与所述操作臂中各关节组件的运动状态阈值进行比较;
如果相应所述操作臂中各关节组件的目标运动状态参数均未超过所述操作臂中各关节组件的运动状态阈值,判断相应所述第二目标位姿信息为有效;否则,判断相应所述第二目标位姿信息为无效;
其中,所述运动状态参数包括位置参数、速度参数及加速度参数,所述运动状态阈值包括位置参数阈值、速度参数阈值及加速度参数阈值。
6.根据权利要求1所述的控制方法,其特征在于:
在获取机械臂远端在第一坐标系的第一目标位姿信息的步骤之中,包括:
获取所述机械臂远端的任务自由度的配置信息;
根据所述机械臂远端的任务自由度的配置信息获取所述机械臂远端在第一坐标系的、且关联于相应任务自由度的第一目标位姿信息;
其中,所述机械臂远端的任务自由度的配置信息关联于位置自由度及/或姿态自由度;
在获取各受控末端器械在第一坐标系的当前位姿信息的步骤之中,包括:
获取各所述受控末端器械的任务自由度的配置信息;
根据各所述受控末端器械的任务自由度的配置信息获取各受控末端器械在第一坐标系的、且关联于相应任务自由度的当前位姿信息;
其中,所述受控末端器械的任务自由度的配置信息关联于位置信息及/或姿态信息。
7.根据权利要求1所述的控制方法,其特征在于,在获取机械臂远端在第一坐标系的第一目标位姿信息的步骤之中,包括方式一或方式二:
方式一包括如下步骤:
获取施加于所述机械臂上用以拖动所述机械臂远端运动的外力的六维力/力矩矢量;
将所述外力的六维力/力矩矢量解析为所述机械臂远端在第一坐标系的增量位姿信息;
获取所述机械臂远端在第一坐标系的当前位姿信息;
根据所述机械臂远端在第一坐标系的增量位姿信息及当前位姿信息计算出所述第一目标位姿信息;
方式二包括如下步骤:
获取运动输入设备输入的运动信息;
将所述运动信息解析为所述机械臂远端在第一坐标系的增量位姿信息;
获取所述机械臂远端在第一坐标系的当前位姿信息;
根据所述机械臂远端在第一坐标系的增量位姿信息及当前位姿信息计算出所述第一目标位姿信息。
8.根据权利要求4所述的控制方法,其特征在于:
在获取机械臂远端在第一坐标系的第一目标位姿信息及各所述受控末端器械在第一坐标系的当前位姿信息的步骤之前,包括:
获取描述所述机械臂及装设于所述机械臂远端且具有所述受控末端器械的所述操作臂的结构特征的描述信息,并根据所述描述信息生成模拟所述机械臂及相应所述操作臂的结构的模型图像;
在对各所述第二目标位姿信息是否有效进行判断,并分别获取相应的判断结果的步骤之后,包括:
改变所述模型图像中第二目标位姿信息被判断为无效的相应所述受控末端器械对应的所述操作臂的色彩。
9.一种手术机器人中末端器械的控制装置,其特征在于,包括:
存储器,用于存储计算机程序;
处理器,用于加载并执行所述计算机程序;
其中,所述计算机程序由所述处理器加载并执行实现如权利要求1~8任一项所述的控制方法的步骤。
10.一种手术机器人,其特征在于,包括:
机械臂;
装设于所述机械臂远端的一个以上的具有末端器械的操作臂,所述末端器械包括图像末端器械及/或操作末端器械;
及控制装置;
所述控制装置用于执行实现如权利要求1~8任一项所述的控制方法的步骤。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910854118.3A CN110559083B (zh) | 2019-09-10 | 2019-09-10 | 手术机器人及其末端器械的控制方法、控制装置 |
PCT/CN2020/114115 WO2021047522A1 (zh) | 2019-09-10 | 2020-09-08 | 手术机器人及其末端器械的控制方法、控制装置 |
US17/640,910 US20220257326A1 (en) | 2019-09-10 | 2020-09-08 | Surgical robot, and control method and control device for end instrument thereof |
EP20863119.2A EP4029467A4 (en) | 2019-09-10 | 2020-09-08 | SURGICAL ROBOT, AND CONTROL METHOD AND CONTROL DEVICE FOR ASSOCIATED DISTAL INSTRUMENT |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910854118.3A CN110559083B (zh) | 2019-09-10 | 2019-09-10 | 手术机器人及其末端器械的控制方法、控制装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110559083A true CN110559083A (zh) | 2019-12-13 |
CN110559083B CN110559083B (zh) | 2020-08-25 |
Family
ID=68779009
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910854118.3A Active CN110559083B (zh) | 2019-09-10 | 2019-09-10 | 手术机器人及其末端器械的控制方法、控制装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20220257326A1 (zh) |
EP (1) | EP4029467A4 (zh) |
CN (1) | CN110559083B (zh) |
WO (1) | WO2021047522A1 (zh) |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111568558A (zh) * | 2020-04-13 | 2020-08-25 | 上海市胸科医院 | 电子设备、手术机器人系统及其控制方法 |
WO2021047522A1 (zh) * | 2019-09-10 | 2021-03-18 | 深圳市精锋医疗科技有限公司 | 手术机器人及其末端器械的控制方法、控制装置 |
CN112603546A (zh) * | 2020-12-24 | 2021-04-06 | 哈尔滨思哲睿智能医疗设备有限公司 | 一种基于腹腔镜手术机器人的远程手术系统及控制方法 |
CN112643678A (zh) * | 2020-12-29 | 2021-04-13 | 北京配天技术有限公司 | 机械臂及其控制装置、机械臂的控制系统和控制方法 |
CN113040912A (zh) * | 2021-03-02 | 2021-06-29 | 上海微创医疗机器人(集团)股份有限公司 | 手术装置、手术系统及手术系统的工作方法 |
CN113263498A (zh) * | 2021-04-12 | 2021-08-17 | 万勋科技(深圳)有限公司 | 机械臂移动控制方法、装置、终端设备及存储介质 |
CN113274138A (zh) * | 2021-05-25 | 2021-08-20 | 上海微创医疗机器人(集团)股份有限公司 | 机械臂运动空间增强显示方法、手术机器人系统和存储介质 |
CN113288358A (zh) * | 2021-05-21 | 2021-08-24 | 中国医学科学院生物医学工程研究所 | 位姿信息确定方法、装置、电子设备及存储介质 |
CN113334390A (zh) * | 2021-08-06 | 2021-09-03 | 成都博恩思医学机器人有限公司 | 一种机械臂的控制方法、系统、机器人及存储介质 |
CN113349939A (zh) * | 2021-07-12 | 2021-09-07 | 哈尔滨思哲睿智能医疗设备有限公司 | 被动主手式主从控制手术机器人的性能测试方法及系统 |
CN113768626A (zh) * | 2020-09-25 | 2021-12-10 | 武汉联影智融医疗科技有限公司 | 手术机器人控制方法、计算机设备及手术机器人系统 |
CN113855256A (zh) * | 2021-10-27 | 2021-12-31 | 哈尔滨思哲睿智能医疗设备有限公司 | 主从手术机器人的控制方法、控制装置及主从手术机器人 |
WO2022002155A1 (zh) * | 2020-07-01 | 2022-01-06 | 北京术锐技术有限公司 | 主从运动的控制方法、机器人系统、设备及存储介质 |
WO2022037356A1 (zh) * | 2020-08-19 | 2022-02-24 | 北京术锐技术有限公司 | 机器人系统以及控制方法 |
CN114288025A (zh) * | 2021-12-14 | 2022-04-08 | 苏州微创畅行机器人有限公司 | 骨科机器人 |
WO2022242493A1 (zh) * | 2021-05-17 | 2022-11-24 | 上海微创医疗机器人(集团)股份有限公司 | 位姿调整方法、手术机器人系统和存储介质 |
CN116058975A (zh) * | 2021-11-01 | 2023-05-05 | 深圳市精锋医疗科技股份有限公司 | 手术机器人及其控制方法、控制装置 |
WO2023202291A1 (zh) * | 2022-04-23 | 2023-10-26 | 深圳市精锋医疗科技股份有限公司 | 手术机器人系统及其控制装置 |
WO2024021855A1 (zh) * | 2022-07-28 | 2024-02-01 | 深圳市精锋医疗科技股份有限公司 | 手术机器人及其控制方法、控制装置 |
WO2024045695A1 (zh) * | 2022-08-31 | 2024-03-07 | 深圳市精锋医疗科技股份有限公司 | 导管机器人及其检测方法、计算机可读存储介质 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114147701B (zh) * | 2021-10-29 | 2023-12-01 | 中山大学 | 一种机器人的远程定点校正方法 |
CN116115451A (zh) * | 2023-02-06 | 2023-05-16 | 深圳瀚维智能医疗科技有限公司 | 体表贴合作业平台 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103761996A (zh) * | 2013-10-18 | 2014-04-30 | 中广核检测技术有限公司 | 基于虚拟现实技术的无损检测机器人智能检测方法 |
CN104720887A (zh) * | 2006-06-13 | 2015-06-24 | 直观外科手术操作公司 | 微创手术系统 |
CN104739519A (zh) * | 2015-04-17 | 2015-07-01 | 中国科学院重庆绿色智能技术研究院 | 一种基于增强现实的力反馈手术机器人控制系统 |
CN105616007A (zh) * | 2010-05-14 | 2016-06-01 | 直观外科手术操作公司 | 具有联动式控制模式的医疗机器人系统 |
WO2016201303A1 (en) * | 2015-06-12 | 2016-12-15 | The Johns Hopkins University | Cooperatively-controlled surgical robotic system with redundant force sensing |
CN107662195A (zh) * | 2017-09-22 | 2018-02-06 | 中国东方电气集团有限公司 | 一种具有临场感的机器手主从异构遥操作控制系统及控制方法 |
CN108927801A (zh) * | 2018-03-21 | 2018-12-04 | 北京猎户星空科技有限公司 | 一种机械臂末端姿态调整方法及装置 |
CN109965982A (zh) * | 2018-09-30 | 2019-07-05 | 深圳市精锋医疗科技有限公司 | 手术机器人的启动方法、可读取存储器及手术机器人 |
CN110192919A (zh) * | 2014-03-17 | 2019-09-03 | 直观外科手术操作公司 | 用于保持工具姿态的系统和方法 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102530353B1 (ko) * | 2012-06-01 | 2023-05-09 | 인튜어티브 서지컬 오퍼레이션즈 인코포레이티드 | 하드웨어 제한형 원격 중심 로봇 매니퓰레이터용 여유 축 및 자유도 |
DE102013002818A1 (de) * | 2013-02-19 | 2014-08-21 | Rg Mechatronics Gmbh | Haltevorrichtung für ein chirurgisches Instrument und eine Schleuse sowie Verfahren zum Betreiben eines Roboters mit einer solchen Haltevorrichtung |
KR102188100B1 (ko) * | 2013-03-15 | 2020-12-07 | 삼성전자주식회사 | 로봇 및 그 제어방법 |
KR20150017129A (ko) * | 2013-08-06 | 2015-02-16 | 삼성전자주식회사 | 수술 로봇 시스템 및 그 제어 방법 |
CN105014677B (zh) * | 2015-07-07 | 2016-07-20 | 西安交通大学 | 基于Camshift视觉跟踪和D-H建模算法的视觉机械臂控制方法 |
PL3146930T3 (pl) * | 2015-09-22 | 2018-10-31 | Fundacja Rozwoju Kardiochirurgii Im. Prof. Zbigniewa Religi | Zespół ramion narzędziowych robota chirurgicznego |
KR102414405B1 (ko) * | 2016-06-09 | 2022-06-30 | 인튜어티브 서지컬 오퍼레이션즈 인코포레이티드 | 컴퓨터 보조 원격 조작 수술 시스템 및 방법 |
US10647007B2 (en) * | 2016-09-16 | 2020-05-12 | Verb Surgical Inc. | Capacitor sensor including two plates having both conductive and non conductive regions |
CN108210070B (zh) * | 2017-12-29 | 2020-04-10 | 微创(上海)医疗机器人有限公司 | 机械臂及其工作方法与手术机器人 |
KR102206647B1 (ko) * | 2018-06-12 | 2021-01-22 | (주)미래컴퍼니 | 로봇 암 구조물 및 이를 포함하는 수술 로봇의 매니퓰레이터 |
WO2020014737A1 (en) * | 2018-07-16 | 2020-01-23 | Fastbrick Ip Pty Ltd | Backup tracking for an interaction system |
CN109974584B (zh) * | 2019-04-12 | 2020-03-20 | 山东大学 | 一种辅助激光截骨手术机器人的标定系统及标定方法 |
CN110169825A (zh) * | 2019-05-22 | 2019-08-27 | 哈尔滨工业大学 | 一种适用于微创手术机器人的九自由度串联主操作手 |
CN110559083B (zh) * | 2019-09-10 | 2020-08-25 | 深圳市精锋医疗科技有限公司 | 手术机器人及其末端器械的控制方法、控制装置 |
-
2019
- 2019-09-10 CN CN201910854118.3A patent/CN110559083B/zh active Active
-
2020
- 2020-09-08 US US17/640,910 patent/US20220257326A1/en active Pending
- 2020-09-08 EP EP20863119.2A patent/EP4029467A4/en active Pending
- 2020-09-08 WO PCT/CN2020/114115 patent/WO2021047522A1/zh unknown
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104720887A (zh) * | 2006-06-13 | 2015-06-24 | 直观外科手术操作公司 | 微创手术系统 |
CN105616007A (zh) * | 2010-05-14 | 2016-06-01 | 直观外科手术操作公司 | 具有联动式控制模式的医疗机器人系统 |
CN103761996A (zh) * | 2013-10-18 | 2014-04-30 | 中广核检测技术有限公司 | 基于虚拟现实技术的无损检测机器人智能检测方法 |
CN110192919A (zh) * | 2014-03-17 | 2019-09-03 | 直观外科手术操作公司 | 用于保持工具姿态的系统和方法 |
CN104739519A (zh) * | 2015-04-17 | 2015-07-01 | 中国科学院重庆绿色智能技术研究院 | 一种基于增强现实的力反馈手术机器人控制系统 |
WO2016201303A1 (en) * | 2015-06-12 | 2016-12-15 | The Johns Hopkins University | Cooperatively-controlled surgical robotic system with redundant force sensing |
CN107662195A (zh) * | 2017-09-22 | 2018-02-06 | 中国东方电气集团有限公司 | 一种具有临场感的机器手主从异构遥操作控制系统及控制方法 |
CN108927801A (zh) * | 2018-03-21 | 2018-12-04 | 北京猎户星空科技有限公司 | 一种机械臂末端姿态调整方法及装置 |
CN109965982A (zh) * | 2018-09-30 | 2019-07-05 | 深圳市精锋医疗科技有限公司 | 手术机器人的启动方法、可读取存储器及手术机器人 |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021047522A1 (zh) * | 2019-09-10 | 2021-03-18 | 深圳市精锋医疗科技有限公司 | 手术机器人及其末端器械的控制方法、控制装置 |
CN111568558A (zh) * | 2020-04-13 | 2020-08-25 | 上海市胸科医院 | 电子设备、手术机器人系统及其控制方法 |
WO2022002155A1 (zh) * | 2020-07-01 | 2022-01-06 | 北京术锐技术有限公司 | 主从运动的控制方法、机器人系统、设备及存储介质 |
WO2022037356A1 (zh) * | 2020-08-19 | 2022-02-24 | 北京术锐技术有限公司 | 机器人系统以及控制方法 |
CN113768626A (zh) * | 2020-09-25 | 2021-12-10 | 武汉联影智融医疗科技有限公司 | 手术机器人控制方法、计算机设备及手术机器人系统 |
CN113768626B (zh) * | 2020-09-25 | 2024-03-22 | 武汉联影智融医疗科技有限公司 | 手术机器人控制方法、计算机设备及手术机器人系统 |
CN112603546A (zh) * | 2020-12-24 | 2021-04-06 | 哈尔滨思哲睿智能医疗设备有限公司 | 一种基于腹腔镜手术机器人的远程手术系统及控制方法 |
CN112643678A (zh) * | 2020-12-29 | 2021-04-13 | 北京配天技术有限公司 | 机械臂及其控制装置、机械臂的控制系统和控制方法 |
CN113040912A (zh) * | 2021-03-02 | 2021-06-29 | 上海微创医疗机器人(集团)股份有限公司 | 手术装置、手术系统及手术系统的工作方法 |
CN113263498A (zh) * | 2021-04-12 | 2021-08-17 | 万勋科技(深圳)有限公司 | 机械臂移动控制方法、装置、终端设备及存储介质 |
WO2022242493A1 (zh) * | 2021-05-17 | 2022-11-24 | 上海微创医疗机器人(集团)股份有限公司 | 位姿调整方法、手术机器人系统和存储介质 |
CN113288358A (zh) * | 2021-05-21 | 2021-08-24 | 中国医学科学院生物医学工程研究所 | 位姿信息确定方法、装置、电子设备及存储介质 |
CN113274138A (zh) * | 2021-05-25 | 2021-08-20 | 上海微创医疗机器人(集团)股份有限公司 | 机械臂运动空间增强显示方法、手术机器人系统和存储介质 |
CN113349939A (zh) * | 2021-07-12 | 2021-09-07 | 哈尔滨思哲睿智能医疗设备有限公司 | 被动主手式主从控制手术机器人的性能测试方法及系统 |
CN113334390B (zh) * | 2021-08-06 | 2021-11-09 | 成都博恩思医学机器人有限公司 | 一种机械臂的控制方法、系统、机器人及存储介质 |
CN113334390A (zh) * | 2021-08-06 | 2021-09-03 | 成都博恩思医学机器人有限公司 | 一种机械臂的控制方法、系统、机器人及存储介质 |
CN113855256A (zh) * | 2021-10-27 | 2021-12-31 | 哈尔滨思哲睿智能医疗设备有限公司 | 主从手术机器人的控制方法、控制装置及主从手术机器人 |
CN113855256B (zh) * | 2021-10-27 | 2023-07-07 | 哈尔滨思哲睿智能医疗设备股份有限公司 | 主从手术机器人的控制方法、控制装置及主从手术机器人 |
CN116058975A (zh) * | 2021-11-01 | 2023-05-05 | 深圳市精锋医疗科技股份有限公司 | 手术机器人及其控制方法、控制装置 |
CN116058975B (zh) * | 2021-11-01 | 2023-11-24 | 深圳市精锋医疗科技股份有限公司 | 手术机器人及其控制方法、控制装置 |
CN114288025B (zh) * | 2021-12-14 | 2024-03-15 | 苏州微创畅行机器人有限公司 | 骨科机器人 |
CN114288025A (zh) * | 2021-12-14 | 2022-04-08 | 苏州微创畅行机器人有限公司 | 骨科机器人 |
WO2023202291A1 (zh) * | 2022-04-23 | 2023-10-26 | 深圳市精锋医疗科技股份有限公司 | 手术机器人系统及其控制装置 |
WO2024021855A1 (zh) * | 2022-07-28 | 2024-02-01 | 深圳市精锋医疗科技股份有限公司 | 手术机器人及其控制方法、控制装置 |
WO2024045695A1 (zh) * | 2022-08-31 | 2024-03-07 | 深圳市精锋医疗科技股份有限公司 | 导管机器人及其检测方法、计算机可读存储介质 |
Also Published As
Publication number | Publication date |
---|---|
US20220257326A1 (en) | 2022-08-18 |
EP4029467A1 (en) | 2022-07-20 |
CN110559083B (zh) | 2020-08-25 |
WO2021047522A1 (zh) | 2021-03-18 |
EP4029467A4 (en) | 2023-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110559083B (zh) | 手术机器人及其末端器械的控制方法、控制装置 | |
CN110559082B (zh) | 手术机器人及其机械臂的控制方法、控制装置 | |
CN110464473B (zh) | 手术机器人及其控制方法、控制装置 | |
CN110464472B (zh) | 手术机器人及其末端器械的控制方法、控制装置 | |
US11622822B2 (en) | Surgery supporting apparatus for controlling motion of robot arm, control method of the same, and non-transitory computer-readable storage medium | |
CN110464470B (zh) | 手术机器人及其臂体的控制方法、控制装置 | |
CN107921623B (zh) | 机器人系统 | |
US9901411B2 (en) | Control device and method for controlling a robot with a system by means of gesture control | |
CN110464471B (zh) | 手术机器人及其末端器械的控制方法、控制装置 | |
KR101941844B1 (ko) | 로봇 및 그 제어방법 | |
KR20150007020A (ko) | 수술 로봇 시스템 및 그 제어 방법 | |
CN112618020B (zh) | 手术机器人及其控制方法、控制装置 | |
JP2016519813A (ja) | 補足的な回転コントローラを有する3d入力装置 | |
CN110464469B (zh) | 手术机器人及末端器械的控制方法、控制装置、存储介质 | |
CN114098981B (zh) | 一种双臂协作的头颈部辅助牵拉手术机器人及其控制方法 | |
TWI544891B (zh) | 用於腹腔鏡手術之俱有直覺式操控的輔助性機器人內視鏡系統及其方法 | |
WO2021047520A1 (zh) | 手术机器人及其末端器械的控制方法、控制装置 | |
CN112674875A (zh) | 机械臂力反馈系统、方法、控制方法及控制终端 | |
CN118105174A (zh) | 手术机器人系统的控制方法、装置及存储介质 | |
CN113040911B (zh) | 一种手术系统、手术系统控制及手术系统的控制方法 | |
JP2022157110A (ja) | ロボット遠隔操作制御装置、ロボット遠隔操作制御システム、ロボット遠隔操作制御方法、およびプログラム | |
Xie et al. | Development of stereo vision and master-slave controller for a compact surgical robot system | |
WO2023220291A1 (en) | Techniques for controlling a computer-assisted system | |
GB2625105A (en) | Control system for a surgical robotic system | |
CN117752424A (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 |