CN113043279B - 手术机器人的控制方法、控制器、系统、电子设备与介质 - Google Patents

手术机器人的控制方法、控制器、系统、电子设备与介质 Download PDF

Info

Publication number
CN113043279B
CN113043279B CN202110405955.5A CN202110405955A CN113043279B CN 113043279 B CN113043279 B CN 113043279B CN 202110405955 A CN202110405955 A CN 202110405955A CN 113043279 B CN113043279 B CN 113043279B
Authority
CN
China
Prior art keywords
motor
driving rod
platform
rod
surgical robot
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.)
Active
Application number
CN202110405955.5A
Other languages
English (en)
Other versions
CN113043279A (zh
Inventor
丁立
闫泳利
柳建飞
黄善灯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hangzhou Kunbo Biotechnology Co Ltd
Original Assignee
Noahtron Intelligence Medtech Hangzhou Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Noahtron Intelligence Medtech Hangzhou Co Ltd filed Critical Noahtron Intelligence Medtech Hangzhou Co Ltd
Priority to CN202110405955.5A priority Critical patent/CN113043279B/zh
Publication of CN113043279A publication Critical patent/CN113043279A/zh
Application granted granted Critical
Publication of CN113043279B publication Critical patent/CN113043279B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • 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
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • 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/1602—Programme controls characterised by the control system, structure, architecture
    • 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/1602—Programme controls characterised by the control system, structure, architecture
    • B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Medical Informatics (AREA)
  • Public Health (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Molecular Biology (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Biomedical Technology (AREA)
  • Veterinary Medicine (AREA)
  • Physics & Mathematics (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Manipulator (AREA)

Abstract

本发明提供了一种手术机器人的控制方法、控制器、系统、电子设备与介质，所述手术机器人的主操作手包括静平台、动平台、主动杆、从动杆与电机；所述主动杆转动连接所述静平台，所述主动杆还转动连接所述从动杆，所述从动杆还转动连接所述动平台；所述电机连接于所述主动杆与所述静平台的连接处，以驱动所述主动杆与所述静平台的相对转动；所述控制方法，包括：获取所述手术机器手当前的运动信息；其中的运动信息表征了所述主动杆、所述从动杆、所述静平台与所述动平台的至少部分运动过程；根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息；根据所述当前的转矩信息，控制所述电机。

Description

手术机器人的控制方法、控制器、系统、电子设备与介质
技术领域
本发明涉及医疗器械领域，尤其涉及一种手术机器人的控制方法、控制器、系统、电子设备与介质。
背景技术
近年来，随着微创外科手术机器人手术技术的发展，主从遥操作手术机器人在医疗领域的优势日益凸显。主操作手作为系统中的力觉交互设备是人机交互的载体。
手术机器人的机构中，可包含平台、传动杆等构件，机构自身(例如杆件、平台)的重力是影响其力反馈准确性和操作舒适性的主要因素，现有相关技术中，可采用改变配重、配置弹簧、滑轮等方式实现重力补偿，然而，该些机械方式大多补偿精度不高，且难以普遍适用于各种位姿下的重力补偿。
发明内容
本发明提供一种手术机器人的控制方法、控制器、系统、电子设备与介质，以解决补偿精度不高，且难以普遍适用于各种位姿下的重力补偿的问题。
根据本发明的第一方面，提供了一种手术机器人的控制方法；
所述手术机器人的主操作手包括静平台、动平台、主动杆、从动杆与电机；
所述主动杆转动连接所述静平台，所述主动杆还转动连接所述从动杆，所述从动杆还转动连接所述动平台；所述电机连接于所述主动杆与所述静平台的连接处，以驱动所述主动杆与所述静平台的相对转动；
所述控制方法，包括：
获取所述手术机器手当前的运动信息；其中的运动信息表征了所述主动杆、所述从动杆、所述静平台与所述动平台的至少部分运动过程；
根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息；
根据所述当前的转矩信息，控制所述电机。
以上方案中，基于手术机器手的运动信息，可适应性调整主动杆与静平台关节处的电机的输出转矩，从而保障输出转矩能准确匹配于手术机器手的实际运动，保障反馈的真实性，该过程中，可以无需引入弹簧、滑轮等机械构件，实现方式简单，补偿精度高，且能够普遍适用于各种位姿下的补偿。
可选的，根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息，具体包括：
根据所述当前的运动信息、以及运动信息与各电机转矩信息的量化关系，确定所述当前的转矩信息，其中，所述量化关系是根据所述动平台、所述主动杆与所述从动杆的重力虚功确定的。
可选的，所述运动信息包括各电机的驱动角变化、所述动平台的高度变化、所述主动杆的高度变化与所述从动杆的高度变化。
以上方案中，通过基于各构件重力作用的虚功，可实现对从手末端力的高速、实时反馈，为外科医生提供力感，增强医生手术过程中的沉浸感，保障医生和虚拟手术环境之间的交互。
可选的，在所述量化关系中：
所述电机的转矩信息正相关于所述动平台、所述主动杆、所述从动杆的重力势能变化；
所述电机的转矩信息负相关于所述主动杆的转角变化。
可选的，所述量化关系体现了：所述动平台的重力所做的虚功、所述主动杆的重力所做的虚功、所述从动杆重力所做的虚功、各电机所产生转矩的虚功是平衡的。
可选的，所述当前的转矩信息是根据以下公式确定的：
Figure BDA0003022287850000021
其中：
M表征了所述电机的转矩；
δP表征了所述动平台、所述主动杆与所述从动杆的重力势能变化；
δθ表征了所述主动杆的转角变化。
以上可选方案中，可在不考虑外力的作用下，充分考虑主动杆、从动杆、重力势能能变化与转角对电机转矩需求的影响，从而有效保障控制结果能够有效提供反馈性能，提高力反馈的真实性。
可选的，在所述量化关系中：
所述量化关系中，所述电机的转矩信息还正相关于外力的大小，以及所述手术机器人的质心位移变化。
可选的，所述量化关系体现了：所述动平台的重力所做的虚功、所述主动杆的重力所做的虚功、所述从动杆重力所做的虚功、各电机所产生转矩的虚功、外力所做的虚功是平衡的。
可选的，所述当前的转矩信息是根据以下公式确定的：
Figure BDA0003022287850000031
F＝(Fx，Fy，Fz)T
其中：
M表征了所述电机的转矩；
δP表征了所述动平台、所述主动杆与所述从动杆的重力势能变化；
Δθ表征了所述主动杆的转角变化；
Fx表征了所述外力F沿x轴方向的大小；
Fy表征了所述外力F沿y轴方向的大小；
Fz表征了所述外力F沿z轴方向的大小；
δX表征了所述主操作手的质心位移变化。
以上可选方案中，可在考虑外力的作用下，充分考虑主动杆、从动杆、重力势能能变化、驱动角变化，以及外力的大小对电机转矩需求的影响，从而有效保障控制结果能够有效提供反馈性能，提高力反馈的真实性。
根据本发明的第二方面，提供了一种手术机器人的控制器，
所述手术机器人的主操作手包括静平台、动平台、主动杆、从动杆与电机；
所述主动杆转动连接所述静平台，所述主动杆还转动连接所述从动杆，所述从动杆还转动连接所述动平台；所述电机连接于所述主动杆与所述静平台的连接处，以驱动所述主动杆与所述静平台的相对转动；
所述控制器，包括：
获取模块，用于获取所述手术机器手当前的运动信息；其中的运动信息表征了所述主动杆、所述从动杆、所述静平台与所述动平台的至少部分运动过程；
转矩确定模块，用于根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息；
电机控制模块，用于根据所述当前的转矩信息，控制所述电机。
根据本发明的第三方面，提供了一种手术机器人系统，包括：手术机器人与控制装置，所述手术机器人的主操作手包括静平台、动平台、主动杆、从动杆与电机；
所述电机被配置为能够直接或间接被所述控制装置控制；
所述主动杆转动连接所述静平台，所述主动杆还转动连接所述从动杆，所述从动杆还转动连接所述动平台；所述电机连接于所述主动杆与所述静平台的连接处，以驱动所述主动杆与所述静平台的相对转动；
所述控制装置用于执行第一方面及其可选方案涉及的控制方法。
根据本发明的第四方面，提供了一种电子设备，其特征在于，包括处理器与存储器，
所述存储器，用于存储代码；
所述处理器，用于执行所述存储器中的代码用以实现第一方面及其可选方案涉及的控制方法。
根据本发明的第五方面，提供了一种存储介质，其上存储有计算机程序，该程序被处理器执行时实现第一方面及其可选方案涉及的控制方法。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1是本发明一实施例中手术机器人的构造示意图；
图2是本发明一实施例中手术机器人的控制方法的流程示意图；
图3是本发明一实施例中步骤S22的流程示意图；
图4是本发明一实施例中静力学模型的示意图；
图5是本发明一实施例中重力补偿模型的示意图；
图6是本发明一实施例中手术机器人的控制器的程序模块示意图；
图7是本发明一实施例中电子设备的构造示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”“第四”等(如果存在)是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
下面以具体地实施例对本发明的技术方案进行详细说明。下面这几个具体的实施例可以相互结合，对于相同或相似的概念或过程可能在某些实施例不再赘述。
请参考图1，所述手术机器人的主操作手包括静平台102、动平台101、主动杆103、从动杆104、电机(传动连接于关节107的电机)。
所述主动杆103转动连接所述静平台102，所述主动杆103还转动连接所述从动杆106，例如，主动杆103的两端可分别转动连接静平台102与从动杆106，所述从动杆106还转动连接所述动平台101，例如，从动杆106的两端可分别转动连接主动杆103与动平台101。
其中的转动连接，可理解为：主动杆可绕垂直于该主动杆的一个轴心相对于静平台转动，主动杆可绕垂直于该主动杆，以及其所连接从动杆的一个轴心相对于从动杆旋转，从动杆可绕垂直于该从动杆的一个轴心相对于动平台旋转。
所述电机连接于所述主动杆103与所述静平台102的连接处(也可理解为关节105)，以驱动所述主动杆103与所述静平台102的相对转动，例如，主动杆103的一端(或静平台102)可设有转轴部，转轴部转动连接静平台102(或主动杆103)的轴孔部，该转轴部或轴孔部可直接或间接与电机传动连接，进而在电机的传动下发生转动。
在关节105发生相对转动时，可带动主动杆103与从动杆104之间的关节106发生相对转动(即主动杆103与从动杆104发生相对转动)，进而再带动从动杆104与动平台101之间的关节107发生相对转动(即从动杆104与动平台101发生相对转动)。
在图1的举例中，关节105、关节106、关节107、主动杆103、从动杆104的数量均可以为三个，其他举例中，其数量也不限于此。
在图1的举例中，平台(动平台与静平台)被示意为三角形，然而，其形状可以是任意规则或不规则图形，在图示的连接位置中，主动杆103可连接于静平台102的边缘处、从动杆104连接于动平台101的边缘，然而，其实际连接位置可以是任意的。
在后文的相关量化举例中，均是以图1所示的结构作为基础进行描述的，相同构思下的其他方案可参照该些举例理解。
所述控制方法，包括：
S21：获取所述手术机器手当前的运动信息；
S12：根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息；
S13：根据所述当前的转矩信息，控制所述电机。
其中的运动信息表征了所述主动杆、所述从动杆、所述静平台与所述动平台的至少部分运动过程；其可以为对运动过程进行描述的任意信息。
由于杆的运动与电机输出的旋转运动相关，故而，运动信息可以包括电机驱动角相关的信息，进而，运动信息可包括电机的驱动角变化。
由于杆的运动将会带来动平台、杆的高度变化，故而，运动信息可以包括所述动平台的高度变化、所述主动杆的高度变化与所述从动杆的高度变化。其中的高度，可理解为沿垂直于静平台的方向的尺寸。具体的，静平台可平行于x轴、y轴形成的xy平面，z轴垂直于xy平面，z轴方向的变化可理解为高度的变化。
此外，对以上驱动角变化、高度变化进行描述的任意信息，均可作为以上所描述的方案的一种可选手段。
以上方案中，基于手术机器手的运动信息，可适应性调整主动杆与静平台关节处的电机的输出转矩，从而保障输出转矩能准确匹配于手术机器手的实际运动，保障反馈的真实性，该过程中，无需引入弹簧、滑轮等机械构件，实现方式简单，补偿精度高，且能够普遍适用于各种位姿下的补偿。
其中一种实施方式中，请参考图3，步骤S22可以包括：
S221：根据所述当前的运动信息、以及运动信息与各电机转矩信息的量化关系，确定所述当前的转矩信息。
其中，所述量化关系是根据所述动平台、所述主动杆与所述从动杆的重力虚功确定的，具体可表征为关系式或关系式的组合。
为了对该量化关系的计算过程进行描述，以下将结合图4与图5所示的模型进行举例说明，其他举例可参照于此进行扩展。
请参考图4与图5，每个关节都安装力矩可调的电动机(即传动关节105转动的电机)，进而，可通过拉格朗日方程建立系统动力学模型，计算各部分重心在关节空间中所产生的转矩，并利用力矩电动机输出相应的转矩进行重力补偿，主操作手实现任意位姿静平衡，提高了操作性能，保证了手术的安全性。
请参考图4与图5，模型中：
模型中Ai,Bi,Ci(i＝1,2,3)表示运动关节，点O,P表示静、动平台的中心位置，la表示主动杆(AiBi)的有效长度，lb表示从动杆(BiCi)的有效长度，θi(i＝1,2,3)表示电机驱动角，也可用来表示主动杆的转角，R为静平台外接圆半径，r为动平台外接圆半径，Δr＝R-r为静、动平台外接圆半径差。
主手静力学问题可以描述为：主手机构自重包括动平台的重力G1，从动杆的重力G2i(i＝1,2,3)，主动杆的重力G3i(i＝1,2,3)，机构(主操作手)所受外力F＝(Fx,Fy,Fz)，各电机的输出平衡力矩力矩为M1,M2,M3，忽略关节摩擦力，在静力平衡条件下，求取各杆件作用力与反作用力。
重力补偿的目标是在机构的任意运动位置求解出平衡机构运动部件重力所需的电动机输出力矩。首先，零外力等于零，只存在机构自重，在静力状态下求解出电机所需输出的平衡力矩，并控制电机输出相应的力矩，消除机构运动部件的重力影响。如图5所示。
根据虚位移理论，主操作手在任意运动位置静力平衡的条件：
M1δθ1+M2δθ2+M3δθ3+FTδX+δP＝0 (1)
其中：δθ1,δθ2,δθ3为主动杆在驱动力矩作用下的虚转角位移，也可用来表征主动杆的转角变化，δX＝(δx,δy,δz)T为机构(主操作手)质心作用力下的虚位移向量，也可用来表征主操作手的质心的唯一变化，F为外力。P为机构的重力势能。忽略掉摩擦力等，只考虑机构的重力，则：
Figure BDA0003022287850000081
其中，δz2i，δz3i分别是第i(i＝1,2,3)支链的平行四边形、杆沿z方向运动的虚位移量。
以上方案中，通过基于各构件重力作用的虚功，可实现对从手末端力的高速、实时反馈，为外科医生提供力感，增强医生手术过程中的沉浸感，保障医生和虚拟手术环境之间的交互。
当不受外力影响的时候，即F＝0，运动部件重力和电机平衡力矩所作的虚功相等：
M1δθ1+M2δθ2+M3δθ3+δP＝0 (3)
可见，在不考虑外力的情况下，所述量化关系体现了：所述动平台的重力所做的虚功、所述主动杆的重力所做的虚功、所述从动杆重力所做的虚功、各电机所产生转矩的虚功是平衡的。
以下将对不受外力影响时的转矩求解逻辑进行描述。
当不受外力影响的时候，即F＝0，运动部件重力和电机平衡力矩所作的虚功相等：
M1δθ1+M2δθ2+M3δθ3+δP＝0 (4)
由于虚位移的任意性，另(δθ2,δθ3)为(0,0)，得到：
Figure BDA0003022287850000082
同理，另(δθ1,δθ3),(δθ1,δθ2)为(0,0)，得到：
Figure BDA0003022287850000096
Figure BDA0003022287850000091
此时，(δθ1,δθ2,δθ3)可以人为设定，则只需求解出已知(δθ1,δθ2,δθ3)下的重力所做的虚功δP，便可求出力矩的大小。
在此基础上，计算重力虚功时，根据主手各运动部件之间的位置约束关系可得：
Figure BDA0003022287850000092
由以上分析可得出各部件(主动杆、从动杆、动平台)所做的虚功：
Figure BDA0003022287850000093
则：
Figure BDA0003022287850000094
求解转矩时，所述电机的转矩信息正相关于所述动平台、所述主动杆、所述从动杆的重力势能变化；所述电机的转矩信息负相关于所述电机的驱动角主动杆的转角变化。
具体可基于以下公式确定：
Figure BDA0003022287850000095
其中：
M表征了所述电机的转矩；
δP表征了所述动平台、所述主动杆与所述从动杆的重力势能变化；
δθ表征了所述主动杆的转角变化。
具体的，由于关节105的数量为三个，故而：
Figure BDA0003022287850000101
Figure BDA0003022287850000102
Figure BDA0003022287850000103
以上可选方案中，可在不考虑外力的作用下，充分考虑主动杆、从动杆、重力势能能变化与转角对电机转矩需求的影响，从而有效保障控制结果能够有效提供反馈性能，提高力反馈的真实性。
当受外力影响的时候，即F＝(Fx，Fy，Fz)T，运动部件(即)重力、外力和电机平衡力矩所作的虚功相等：
M1δθ1+M2δθ2+M3δθ3+FTδX+δP＝0 (14)
可见，所述量化关系体现了：所述动平台的重力所做的虚功、所述主动杆的重力所做的虚功、所述从动杆重力所做的虚功、各电机所产生转矩的虚功、外力所做的虚功是平衡的。
其中δX＝(δx,δy,δz)T。由于虚位移的任意性，另(δθ2,δθ3)为(0,0)，得到：
Figure BDA0003022287850000104
同理，另(δθ1,δθ3),(δθ1,δθ2)为(0,0)，得到：
Figure BDA0003022287850000105
Figure BDA0003022287850000106
此时，(δθ1,δθ2,δθ3)可以人为设定，则只需求解出已知(δθ1,δθ2,δθ3)下的重力所做的虚功δP和FTδX，便可求出力矩的大小。
具体过程如下：
在此基础上，计算重力虚功时，根据主手各运动部件之间的位置约束关系可得：
Figure BDA0003022287850000111
由以上分析可得出各部件(主动杆、从动杆、动平台)所做的虚功：
Figure BDA0003022287850000112
则：
Figure BDA0003022287850000113
求解力矩时，所述电机的转矩信息正相关于所述动平台、所述主动杆、所述从动杆的重力势能变化；所述电机的转矩信息负相关于所述电机的驱动角主动杆的转角变化；所述电机的转矩信息还正相关于外力的大小，以及所述手术机器人的质心位移变化。
进一步的，所述当前的转矩信息是根据以下公式确定的：
Figure BDA0003022287850000114
F＝(Fx，Fy，Fz)T
其中：
M表征了所述电机的转矩；
δP表征了所述动平台、所述主动杆与所述从动杆的重力势能变化；
Δθ表征了所述主动杆的转角变化；
Fx表征了所述外力F沿x轴方向的大小；
Fy表征了所述外力F沿y轴方向的大小；
Fz表征了所述外力F沿z轴方向的大小；
δX表征了所述主操作手的质心位移变化，其具体可通过动平台的重心的位移变化来表征。
具体的，由于关节105的数量为三个，故而：
Figure BDA0003022287850000121
Figure BDA0003022287850000122
Figure BDA0003022287850000123
以上可选方案中，可在考虑外力的作用下，充分考虑主动杆、从动杆、重力势能能变化、驱动角变化，以及外力的大小对电机转矩需求的影响，从而有效保障控制结果能够有效提供反馈性能，提高力反馈的真实性。
在以上具体方案中：
基于虚功原理的计算模型，计算得到主操作手在任意位置下重力补偿所需的力矩；在主动臂上安装电机(即电机驱动主动杆与静平台之间的相对转动)，在操作过程中电机按照计算的力矩值输出相应的力矩，平衡机构运动部分自重。重力补偿能消除机构运动部件自重对力反馈的影响，提高力反馈性能，提高力反馈显示的真实性。
此外，根据虚功原理，得出反馈力与各关节电机的关系表达式，解得了各关节电机需要提供的转矩，实现对从手末端力的高速、实时反馈，为外科医生提供力感，增强医生手术过程中的沉浸感，保障医生和虚拟手术环境之间的交互。
请参考图6，本发明实施例还提供了一种手术机器人的控制器300，包括：
获取模块301，用于获取所述手术机器手当前的运动信息；其中的运动信息表征了所述主动杆、所述从动杆、所述静平台与所述动平台的至少部分运动过程；
转矩确定模块302，用于根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息；
电机控制模块303，用于根据所述当前的转矩信息，控制所述电机。
本发发明实施例所涉及的手术机器人的控制器300中相关过程的描述可参照前文实施例中控制方法的描述理解。
请参考图7，提供了一种电子设备40，包括：
处理器41；以及，
存储器42，用于存储所述处理器的可执行指令；
其中，所述处理器41配置为经由执行所述可执行指令来执行以上所涉及的方法。
处理器41能够通过总线43与存储器42通讯。
本发明实施例还提供了一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时实现以上所涉及的方法。
本领域普通技术人员可以理解：实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于一计算机可读取存储介质中。该程序在执行时，执行包括上述各方法实施例的步骤；而前述的存储介质包括：ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
最后应说明的是：以上各实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述各实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分或者全部技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。

Claims (10)

1.一种手术机器人的控制方法，其特征在于，
所述手术机器人的主操作手包括静平台、动平台、主动杆、从动杆与电机；
所述主动杆转动连接所述静平台，所述主动杆还转动连接所述从动杆，所述从动杆还转动连接所述动平台；所述电机连接于所述主动杆与所述静平台的连接处，以驱动所述主动杆与所述静平台的相对转动；
所述控制方法，包括：
获取所述手术机器手当前的运动信息；其中的运动信息表征了所述主动杆、所述从动杆、所述静平台与所述动平台的至少部分运动过程；
根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息；
根据所述当前的转矩信息，控制所述电机；
根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息，具体包括：
根据所述当前的运动信息、以及运动信息与各电机转矩信息的量化关系，确定所述当前的转矩信息，
其中，所确定的当前的转矩信息能够实现对从手末端力的反馈；
所述量化关系体现了：所述动平台的重力所做的虚功、所述主动杆的重力所做的虚功、所述从动杆重力所做的虚功、所述电机所需产生转矩的虚功、外力所做的虚功是平衡的。
2.根据权利要求1所述的手术机器人的控制方法，其特征在于，
其中，所述量化关系是根据所述动平台、所述主动杆与所述从动杆的重力虚功确定的。
3.根据权利要求2所述的手术机器人的控制方法，其特征在于，所述运动信息包括各电机的驱动角变化、所述动平台的高度变化、所述主动杆的高度变化与所述从动杆的高度变化。
4.根据权利要求3所述的手术机器人的控制方法，其特征在于，在所述量化关系中：
所述电机的转矩信息正相关于所述动平台、所述主动杆、所述从动杆的重力势能变化；
所述电机的转矩信息负相关于所述主动杆的转角变化。
5.根据权利要求4所述的手术机器人的控制方法，其特征在于，在所述量化关系中：
所述量化关系中，所述电机的转矩信息还正相关于外力的大小，以及所述手术机器人的质心位移变化。
6.根据权利要求1所述的手术机器人的控制方法，其特征在于，所述当前的转矩信息是根据以下公式确定的：
Figure FDA0003685579380000021
F＝(Fx，Fy，Fz)T
其中：
M表征了所述电机的转矩；
δP表征了所述动平台、所述主动杆与所述从动杆的重力势能变化；
Δθ表征了所述主动杆的转角变化；
Fx表征了所述外力F沿x轴方向的大小；
Fy表征了所述外力F沿y轴方向的大小；
Fz表征了所述外力F沿z轴方向的大小；
δX表征了所述主操作手的质心位移变化。
7.一种手术机器人的控制器，其特征在于，
所述手术机器人的主操作手包括静平台、动平台、主动杆、从动杆与电机；
所述主动杆转动连接所述静平台，所述主动杆还转动连接所述从动杆，所述从动杆还转动连接所述动平台；所述电机连接于所述主动杆与所述静平台的连接处，以驱动所述主动杆与所述静平台的相对转动；
所述控制器，包括：
获取模块，用于获取所述手术机器手当前的运动信息；其中的运动信息表征了所述主动杆、所述从动杆、所述静平台与所述动平台的至少部分运动过程；
转矩确定模块，用于根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息；
电机控制模块，用于根据所述当前的转矩信息，控制所述电机；
根据所述当前的运动信息，确定所述电机所需产生的当前的转矩信息，具体包括：
根据所述当前的运动信息、以及运动信息与各电机转矩信息的量化关系，确定所述当前的转矩信息；
其中，所确定的当前的转矩信息能够实现对从手末端力的反馈；
所述量化关系体现了：所述动平台的重力所做的虚功、所述主动杆的重力所做的虚功、所述从动杆重力所做的虚功、所述电机所需产生转矩的虚功、外力所做的虚功是平衡的。
8.一种手术机器人系统，其特征在于，包括：手术机器人与控制装置，所述手术机器人的主操作手包括静平台、动平台、主动杆、从动杆与电机；
所述电机被配置为能够直接或间接被所述控制装置控制；
所述主动杆转动连接所述静平台，所述主动杆还转动连接所述从动杆，所述从动杆还转动连接所述动平台；所述电机连接于所述主动杆与所述静平台的连接处，以驱动所述主动杆与所述静平台的相对转动；
所述控制装置用于执行权利要求1至6任一项所述的控制方法。
9.一种电子设备，其特征在于，包括处理器与存储器，
所述存储器，用于存储代码；
所述处理器，用于执行所述存储器中的代码用以实现权利要求1至6任一项所述的控制方法。
10.一种存储介质，其上存储有计算机程序，该程序被处理器执行时实现权利要求1至6任一项所述的控制方法。
CN202110405955.5A 2021-04-15 2021-04-15 手术机器人的控制方法、控制器、系统、电子设备与介质 Active CN113043279B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110405955.5A CN113043279B (zh) 2021-04-15 2021-04-15 手术机器人的控制方法、控制器、系统、电子设备与介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110405955.5A CN113043279B (zh) 2021-04-15 2021-04-15 手术机器人的控制方法、控制器、系统、电子设备与介质

Publications (2)

Publication Number Publication Date
CN113043279A CN113043279A (zh) 2021-06-29
CN113043279B true CN113043279B (zh) 2022-08-02

Family

ID=76520388

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110405955.5A Active CN113043279B (zh) 2021-04-15 2021-04-15 手术机器人的控制方法、控制器、系统、电子设备与介质

Country Status (1)

Country Link
CN (1) CN113043279B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023169306A1 (zh) * 2022-03-07 2023-09-14 诺创智能医疗科技(杭州)有限公司 主操作手的驱动力获取方法、装置及存储介质
CN117243701A (zh) * 2022-06-11 2023-12-19 深圳市精锋医疗科技股份有限公司 输入设备及手术机器人
CN114999296B (zh) * 2022-08-05 2023-01-31 上海华模科技有限公司 力反馈设备、提供反馈力的方法及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004114292A (ja) * 2002-09-23 2004-04-15 Honda Motor Co Ltd 人間アシスト・システムにおける重力補償方法および重力補償を備えた人間アシスト・システム
CN107028663A (zh) * 2017-04-18 2017-08-11 中国科学院重庆绿色智能技术研究院 一种新型主从式手术机器人控制方法
CN110175409A (zh) * 2019-05-28 2019-08-27 欣旺达电子股份有限公司 重力反馈补偿方法
CN111134847A (zh) * 2020-01-23 2020-05-12 诺创智能医疗科技(杭州)有限公司 操作组件及手术机器人
CN111216129A (zh) * 2020-01-07 2020-06-02 华南理工大学 一种主被动结合的混联式力反馈设备重力补偿方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004114292A (ja) * 2002-09-23 2004-04-15 Honda Motor Co Ltd 人間アシスト・システムにおける重力補償方法および重力補償を備えた人間アシスト・システム
CN107028663A (zh) * 2017-04-18 2017-08-11 中国科学院重庆绿色智能技术研究院 一种新型主从式手术机器人控制方法
CN110175409A (zh) * 2019-05-28 2019-08-27 欣旺达电子股份有限公司 重力反馈补偿方法
CN111216129A (zh) * 2020-01-07 2020-06-02 华南理工大学 一种主被动结合的混联式力反馈设备重力补偿方法
CN111134847A (zh) * 2020-01-23 2020-05-12 诺创智能医疗科技(杭州)有限公司 操作组件及手术机器人

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
三自由度平动手控器重力补偿研究;刘世平等;《电器与自动化》;20150420;第44卷(第2期);第155-171页 *
面向外科手术的力反馈型遥控操作主手研究;李长军;《哈尔滨工业大学》;20110515;第1-4章 *

Also Published As

Publication number Publication date
CN113043279A (zh) 2021-06-29

Similar Documents

Publication Publication Date Title
CN113043279B (zh) 手术机器人的控制方法、控制器、系统、电子设备与介质
JP6083145B2 (ja) ロボットの制御装置、およびロボット
JP2014144491A (ja) ロボットおよびロボット制御装置
Badeau et al. Intuitive physical human-robot interaction: Using a passive parallel mechanism
US9950427B2 (en) Robot, control apparatus, and robot system
JP5916583B2 (ja) 多関節ロボットのウィービング制御装置
CN112654467A (zh) 获得机器人臂的机器人关节齿轮的齿轮刚度
JP2016105686A (ja) モータ駆動装置の制御装置、複軸モータ駆動装置の制御装置、及びモータ駆動装置の制御方法
CN109760063B (zh) 并联机器人的控制方法、装置、设备及存储介质
KR20210141664A (ko) 다물체 제어기 및 로봇
Eppinger Modeling robot dynamic performance for endpoint force control
Zhu et al. Kinematic and dynamic modelling for real-time control of Tau parallel robot
Sato et al. Vibration mode and motion trajectory simulations of an articulated robot by a dynamic model considering joint bearing stiffness
JPH09123077A (ja) ロボットの剛性同定方法及びその装置
Stockić et al. Historical perspectives and state of the art in joint force sensory feedback control of manipulation robots
Saied et al. Actuator and friction dynamics formulation in control of pkms: From design to real-time experiments
Esfandiar et al. Large deformation modeling of flexible manipulators to determine allowable load
Tao et al. Optimization and control of cable tensions for hyper-redundant snake-arm robots
Kao et al. Singularity robustness of the 3RPS parallel manipulator by using the damped-rate resolved-acceleration control
JP6896824B2 (ja) ロボット装置、ロボットシステム、ロボット装置の制御方法、ロボット装置を用いた物品の製造方法、情報処理装置、情報処理方法、制御プログラム及び記録媒体
CN112512758B (zh) 挠曲量推断装置、机器人控制装置以及挠曲量推断方法
Kim et al. Development of 3D printed rapid omni-directional mecanum mobile manipulator
Tonan et al. Oscillation-free point-to-point motions of planar differentially flat under-actuated robots: a Laplace transform method
Li et al. Conceptual design and error analysis of a cable-driven parallel robot
RU2696508C1 (ru) Промышленный робот-манипулятор с системой двойных энкодеров и способ его позиционирования

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
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20240131

Address after: 310051 room 801, 8th floor, building 8, No. 88, Jiangling Road, Xixing street, Binjiang District, Hangzhou, Zhejiang

Patentee after: HANGZHOU KUNBO BIOTECHNOLOGY Co.,Ltd.

Country or region after: China

Address before: Room 342, 3 / F, building 2, No. 88, Jiangling Road, Xixing street, Binjiang District, Hangzhou City, Zhejiang Province

Patentee before: Nuo Chuang intelligent medical technology (Hangzhou) Co.,Ltd.

Country or region before: China