CN113974835B - 一种基于远心不动点约束的手术机器人运动控制方法 - Google Patents

一种基于远心不动点约束的手术机器人运动控制方法 Download PDF

Info

Publication number
CN113974835B
CN113974835B CN202111154994.9A CN202111154994A CN113974835B CN 113974835 B CN113974835 B CN 113974835B CN 202111154994 A CN202111154994 A CN 202111154994A CN 113974835 B CN113974835 B CN 113974835B
Authority
CN
China
Prior art keywords
surgical
surgical tool
robot
point
rotation
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
CN202111154994.9A
Other languages
English (en)
Other versions
CN113974835A (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.)
Beijing Kepeng Medical Equipment Co ltd
Original Assignee
Beijing Kepeng Medical Equipment 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 Beijing Kepeng Medical Equipment Co ltd filed Critical Beijing Kepeng Medical Equipment Co ltd
Priority to CN202111154994.9A priority Critical patent/CN113974835B/zh
Publication of CN113974835A publication Critical patent/CN113974835A/zh
Application granted granted Critical
Publication of CN113974835B publication Critical patent/CN113974835B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/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/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/70—Manipulators specially adapted for use in surgery
    • 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
    • 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/37—Surgical systems with images on a monitor during operation
    • 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
    • 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/305—Details of wrist mechanisms at distal ends of robotic arms
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Surgery (AREA)
  • Engineering & Computer Science (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Medical Informatics (AREA)
  • Public Health (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Veterinary Medicine (AREA)
  • Molecular Biology (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Biomedical Technology (AREA)
  • Robotics (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Pathology (AREA)
  • Gynecology & Obstetrics (AREA)
  • Radiology & Medical Imaging (AREA)
  • Manipulator (AREA)

Abstract

一种基于远心不动点约束的手术机器人运动控制方法，所述方法采用一种手术机器人实施，所述方法包括：手术工具位姿的标定；手术工具结合手术目标位置初始位姿的校准；远心不动点约束方法；控制手术工具运动。所述手术机器人包括工控机(1)、人机交互设备(2)和机械臂台车(3)；所述机械臂台车(3)包括7轴冗余机械臂(31)、末端执行器(32)和手术工具(33)。由于采用运动控制算法实现远心不动点约束，避免了采用复杂的机械结构，也就解决了采用复杂机械结构实现远心不动点约束带来的种种问题。

Description

一种基于远心不动点约束的手术机器人运动控制方法
技术领域
本发明属于自动控制技术领域。具体涉及一种基于远心不动点约束的手术机器人运动控制方法。
背景技术
在微创手术中引入手术机器人能够为外科医生提供准确性和舒适性方面的重要支持，可以提高手术质量、缩短患者恢复时间。在机器人辅助微创手术中，手术机器人的机械臂搭载手术工具在通过患者体表的小切口进入体内后，手术工具的运动必须围绕该切口孔进行，不能在该切口处产生非轴线方向的平移，否则会对患者造成损伤。更具体地说，固定有手术工具的机器人连杆只能沿其轴线平移并以该切口孔作为支点进行旋转。该手术工具轴线上与切口重合的支点即所谓的远程运动中心(“RCM”)。到目前位置，微创手术机器人通常使用机械结构实现远心不动点RCM，即不动点是以特殊设计的机械结构来实现的。但是特殊设计的机械结构设计复杂，其精度性能、可操作性等存在不确定性，并且新的结构需要重新考虑其奇异位型防止造成机械结构的瞬间卡死或失灵。
发明内容
针对上述技术问题，本发明提出一种基于远心不动点约束的手术机器人运动控制方法。本发明与已有技术的最大不同点是采用运动控制算法实现。由于采用运动控制算法实现远心不动点约束，避免了采用复杂的机械结构，也就解决了采用复杂机械结构实现远心不动点约束带来的种种问题。
本发明的实施例提供一种手术机器人，所述手术机器人包括工控机(1)、人机交互设备(2)和机械臂台车(3)；所述机械臂台车(3)包括7轴冗余机械臂(31)、末端执行器(32)和手术工具(33)；
其中，工控机(1)包括显示屏，所述显示屏配置为：将手术工具的视觉传感器获得的二维或三维图像进行展示，提供查看病灶部位的相关的影像；
人机交互设备(2)配置为：按照操作的动作，人机交互设备(2)产生其X、Y和Z轴相应的旋转变化角度和位移变化数值，即6维位姿的增量(α,β,γ,dx,dy,dz)。
根据本发明的一种实施方式，例如，7轴冗余机械臂(31)配置为：满足机器人运动学中的Pieper准则，即机器人的三个相邻关节轴交于一点或三轴线平行，机器人存在封闭的逆解；
末端执行器(32)配置为：提供特定设计的夹具，作为手术工具的基座，末端执行器(32)接收控制信号，根据信号执行手术工具(33)的相应规定的动作；
手术工具(33)配置为：根据手术目的采用视觉传感器，电切装置等，完成特定的手术动作和功能。
本发明的实施例还提供一种基于远心不动点约束的手术机器人运动控制方法，所述方法采用如上所述的手术机器人实施，所述方法包括：手术工具位姿的标定；手术工具结合手术目标位置初始位姿的校准；远心不动点约束方法；控制手术工具运动。
由于本发明采用运动控制算法实现远心不动点约束，避免了采用复杂的机械结构，避免了由于复杂机械结构带来的一系列问题，例如精度性能、可操作性等方面存在的不确定性、新的机械结构需要重新考虑其奇异位型防止造成机械结构的瞬间卡死或失灵等。此外，由于手术机器人不再依赖复杂的机械结构实现远心不动点约束，本发明也有成本方面的优势。
附图说明
图1是本发明实施例提供的一种手术机器人结构示意图。
图2是本发明实施例提供的一种基于远心不动点约束的手术机器人运动控制方法步骤(9)中坐标系变换关系图。
图3是本发明实施例提供的一种基于远心不动点约束的手术机器人运动控制方法步骤(10)中坐标系变换关系图。
图4是本发明实施例提供的一种基于远心不动点约束的手术机器人运动控制方法步骤(11)中坐标系变换关系图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白，以下结合具体实施例，并参照附图，对本发明进一步详细说明。但本领域技术人员知晓，本发明并不局限于附图和以下实施例。
在发明的描述中，需要说明的是，对于方位词，如术语“长度”、“宽度”、“上”、“下”、“远”、“近”等所指示的方位或位置关系是基于附图所示的方位或位置关系，仅是为了便于叙述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定方位构造和操作，不能理解为限制本发明的具体保护范围。此外，术语“第一”、“第二”仅用于描述目的，用以区别技术特征，不具有实质含义，不能理解为指示或暗示相对重要性或隐含指明技术特征的数量。
本发明实施例提供的基于远心不动点约束的手术机器人运动控制方法的基本原理是：利用运动变换顺序Z,Y,X轴，3个轴方向的运动都需要满足远心不动点RCM(RemoteCenter of Motion)点的约束。
本发明的实施例提供一种手术机器人，所述手术机器人包括工控机1、人机交互设备2和机械臂台车3。所述机械臂台车3包括7轴冗余机械臂31、末端执行器32和手术工具33。
其中，工控机1包括显示屏，所述显示屏配置为：将手术工具的视觉传感器获得的图像(二维或三维)进行展示，提供查看病灶部位的相关的影像。
人机交互设备2配置为：按照操作的动作，人机交互设备2产生其X、Y和Z轴相应的旋转变化角度和位移变化数值，即6维位姿的增量(α,β,γ,dx,dy,dz)；
机械臂台车3包括7轴冗余机械臂31、末端执行器32和手术工具33。其中，7轴冗余机械臂31配置为：满足机器人运动学中的Pieper准则，即机器人的三个相邻关节轴交于一点或三轴线平行，机器人存在封闭的逆解。
末端执行器32配置为：提供特定设计的夹具，作为手术工具的基座，末端执行器32接收控制信号，根据信号执行手术工具33的相应规定的动作。
手术工具33配置为：根据手术目的采用视觉传感器，电切装置等，完成特定的手术动作和功能。
本发明的实施例还提供一种基于远心不动点约束的手术机器人运动控制方法，所述方法采用上述手术机器人实施。所述方法包括：
(1)标定末端执行器32和手术工具33在机器人坐标系中的位姿。首先将末端执行器32和手术工具33安装在手术机器人上，然后标定末端执行器32在手术机器人坐标系中的位姿，最后标定手术工具33在手术机器人坐标系中的位姿，通过标定末端执行器32和手术工具33的位姿，从而得到手术工具33前端中心点在手术机器人坐标下的位置
(2)手术目标位置和手术工具33结合处截面中心点初始位姿的校准。首先确认手术目标位置，迅速将末端执行器32安装上手术工具33，然后使用量尺(例如游标卡尺)在平行于手术工具33方向测量出手术目标位置相对于手术工具33末端的距离，采用在手术工具33上取6个点相应测量距离，最后计算算术平均值得到手术工具33在手术目标位置横截面中心点相对于手术工具末端的距离值。并将此值作为偏移量相对于/>点的转换进行远心中心点/>点的设置。
(3)本发明实施例提供的基于远心不动点约束的手术机器人控制方法可以描述为手术工具刚体在特定点远心不动点点的约束下运动，即旋转以/>点和沿手术工具径向的位移经过/>点作为手术机器人运动的几何约束。手术机器末端即手术工具的前端中心点的运动从当前位姿到目标位姿的变换矩阵表示为特殊欧式变换群其中/>为4×4的齐次变换矩阵，分别包含手术工具3×3矩阵的旋转分量R和3×1向量的位移分量T，其中，SO(3)为三维旋转群，R4×4和R3为实数空间。
(4)通过人机交互设备2获取的六维运动增量(α,β,γ,dx,dy,dz)，分别表示为人机交互设备2沿其三个轴X、Y和Z的旋转角度变化量α,β,γ和位移变化量dx,dy,dz。
(5)由上一步获得的六维运动增量(α,β,γ,dx,dy,dz)，手术机器人末端即手术工具33前端中心点的运动依次分解为沿其前端中心点所在坐标系Z、Y和X轴的旋转和平移。手术工具33以远心不动点点条件下从当前位姿到目标位姿的齐次变换矩阵可以表示为表达式Hzyx＝Hz×Hy×Hx，其中齐次变换矩阵Hz，Hy，Hx分别表示手术工具33前端点确认的坐标系以Z、Y和X轴进行的旋转和位移，表达式分别为：/>和其中手术工具33的3×3矩阵旋转分量Rz,γ，Ry,β和Rx,α分别表示为沿手术工具的Z、Y和X轴旋转了γ,β和α角度，其表达式分别为
和/>
(6)而3×1向量位移分量Tyxyz、Tzxyz和Tzxyz是在远心不动点点条件下分别表示为沿Z、Y和X轴运动时在三个轴相应平移距离的分量，其表达式分别为Tzxyz＝[dzx dzydzz]T、Tyxyz＝[dyx dyy dyz]T和Txxyz＝[dxx dxy dxz]T。
(7)按照手术机器人的运动方式，将手术机器人末端即手术工具33前端设置为后，手术机器人的运动将以此/>作为运动坐标系的原点。上一步从人机交互设备获得的运动增量将相对于此坐标系进行相对的旋转和位移。
(8)从人机交互设备2获得的旋转和位移增量，根据手术机器人的运动和/>点的约束，进行几何关系的分解。根据手术机器人运动顺序分别沿Z，Y，X轴进行，将/>点的几何约束逐步进行分解。/>为/>和/>的距离，计算表达式为/>
(9)沿着的Z轴的运动，分为旋转和位移两部分，其中旋转部分关系式为沿着Z轴旋转后如图2所示，坐标系由X-Y-Z变换为X’-Y’-Z’，由于和/>两点共线并且和X-Y轴构成的平面垂直，两点之间X,Y分量相同，Z分量不同，因此在/>沿Z轴旋转时，/>点的X,和Y分量保持不变。/>径向位移部分|dz|,则对/>运动补偿Tzxyz＝[0,0,-dz]T后，/>依然保持不变，且位于手术工具33径向方向上一点。
(10)沿着的Y轴的运动的同时需要受到/>点的约束，将手术机器人的运动分为旋转和位移两部分，其中旋转部分关系式为/>沿着Y轴旋转后如图3所示，坐标系由X-Y-Z变换为X’-Y’-Z’，且Y/Y’轴重合，手术机器人末端的手术工具33沿/>点旋转带来了/>的位移，/>移动到了/>将/>分别投影在/>旋转前的坐标系X-Y-Z中，分解后在X方向产生了/>的位移分量，Z轴方向产生了/>的位移分量，Y轴方向仅旋转没有位移分量。为保持/>位置不变，则需要对/>点做运动位移补偿向量为/>经过对/>运动补偿后，点移动到/>点使得/>始终在手术工具上并且其X,Y,Z分量保持不变。
(11)沿着的X轴的运动的同时需要受到/>点的约束，将手术机器人的运动分为旋转和位移两部分，旋转部分关系式为/>沿着X轴旋转后如图4所示，坐标系由X-Y-Z变换为X’-Y’-Z’，手术机器人末端的手术工具33沿/>旋转带来了的位移，移动到了/>将/>分别投影在/>旋转前的坐标系中，分解后在Y方向产生了/>的位移分量，Z轴方向产生了/>的位移分量，X轴方向仅旋转没有位移分量。为保持/>位置不变，则需要对/>点做运动位移补偿向量为/>经过对/>运动补偿后，点移动到/>点使得/>始终在手术工具上并且其X,Y,Z分量保持不变。
(12)经过上述步骤得到机器人手术工具33前端点从当前位姿到目标位姿的齐次变换矩阵Hzyx后，采用机器人逆解的方法得到机械臂各关节的角度，从而控制机械臂末端的手术工具33进行远心不动点约束的运动。

Claims (3)

1.一种基于远心不动点约束的手术机器人运动控制方法，其特征在于，所述手术机器人包括工控机(1)、人机交互设备(2)和机械臂台车(3)；所述机械臂台车(3)包括7轴冗余机械臂(31)、末端执行器(32)和手术工具(33)；
其中，工控机(1)包括显示屏，所述显示屏配置为：将手术工具的视觉传感器获得的二维或三维图像进行展示，提供查看病灶部位的相关的影像；
人机交互设备(2)配置为：按照操作的动作，人机交互设备(2)产生其X、Y和Z轴相应的旋转变化角度和位移变化数值，即6维位姿的增量(α,β,γ,dx,dy,dz)；
7轴冗余机械臂(31)配置为：满足机器人运动学中的Pieper准则，即机器人的三个相邻关节轴交于一点或三轴线平行，机器人存在封闭的逆解；
末端执行器(32)配置为：提供特定设计的夹具，作为手术工具的基座，末端执行器(32)接收控制信号，根据信号执行手术工具(33)的相应规定的动作；
手术工具(33)配置为：根据手术目的采用视觉传感器，电切装置等，完成特定的手术动作和功能；
所述方法包括：手术工具位姿的标定；手术工具结合手术目标位置初始位姿的校准；远心不动点约束方法；控制手术工具运动；
(1)标定末端执行器(32)和手术工具(33)在机器人坐标系中的位姿；首先将末端执行器(32)和手术工具(33)安装在手术机器人上，然后标定末端执行器(32)在手术机器人坐标系中的位姿，最后标定手术工具(33)在手术机器人坐标系中的位姿，通过标定末端执行器(32)和手术工具(33)的位姿，从而得到手术工具(33)前端中心点在手术机器人坐标下的位置
(2)手术目标位置和手术工具(33)结合处截面中心点初始位姿的校准；首先确认手术目标位置，迅速将末端执行器(32)安装上手术工具(33)，然后使用量尺在平行于手术工具(33)方向测量出手术目标位置相对于手术工具(33)末端的距离，采用在手术工具(33)上取6个点相应测量距离，最后计算算术平均值得到手术工具(33)在手术目标位置横截面中心点相对于手术工具末端的距离值，并将此值作为偏移量相对于/>点的转换进行远心中心点/>点的设置；
(3)所述方法描述为手术工具刚体在特定点远心不动点点的约束下运动，即旋转以/>点和沿手术工具径向的位移经过/>点作为手术机器人运动的几何约束；手术机器末端即手术工具的前端中心点的运动从当前位姿到目标位姿的变换矩阵表示为特殊欧式变换群/>其中/>为4×4的齐次变换矩阵，分别包含手术工具3×3矩阵的旋转分量R和3×1向量的位移分量T，其中，SO(3)为三维旋转群，R4×4和R3为实数空间；
(4)通过人机交互设备2获取的六维运动增量(α,β,γ,dx,dy,dz)，分别表示为人机交互设备2沿其三个轴X、Y和Z的旋转角度变化量α,β,γ和位移变化量dx,dy,dz；
(5)由上一步获得的六维运动增量(α,β,γ,dx,dy,dz)，手术机器人末端即手术工具33前端中心点的运动依次分解为沿其前端中心点所在坐标系Z、Y和X轴的旋转和平移；手术工具33以远心不动点点条件下从当前位姿到目标位姿的齐次变换矩阵表示为表达式Hzyx＝Hz×Hy×Hx，其中齐次变换矩阵Hz，Hy，Hx分别表示手术工具33前端点确认的坐标系以Z、Y和X轴进行的旋转和位移，表达式分别为：/>和/>其中手术工具33的3×3矩阵旋转分量Rz,γ，Ry,β和Rx,α分别表示为沿手术工具的Z、Y和X轴旋转了γ,β和α角度，其表达式分别为
和/>
(6)而3×1向量位移分量Tyxyz、Tzxyz和Tzxyz是在远心不动点点条件下分别表示为沿Z、Y和X轴运动时在三个轴相应平移距离的分量，其表达式分别为Tzxyz＝[dzx dzy dzz]T、Tyxyz＝[dyx dyy dyz]T和Txxyz＝[dxx dxy dxz]T；
(7)按照手术机器人的运动方式，将手术机器人末端即手术工具(33)前端设置为后，手术机器人的运动将以此/>作为运动坐标系的原点；上一步从人机交互设备获得的运动增量将相对于此坐标系进行相对的旋转和位移；
(8)从人机交互设备(2)获得的旋转和位移增量，根据手术机器人的运动和/>点的约束，进行几何关系的分解；根据手术机器人运动顺序分别沿Z，Y，X轴进行，将/>点的几何约束逐步进行分解；/>为/>和/>的距离，计算表达式为/>
2.根据权利要求1所述的方法，其特征在于，所述方法进一步包括：
(9)沿着的Z轴的运动，分为旋转和位移两部分，其中旋转部分关系式为沿着Z轴旋转后，坐标系由X-Y-Z变换为X’-Y’-Z’，由于/>和/>两点共线并且和X-Y轴构成的平面垂直，两点之间X,Y分量相同，Z分量不同，因此在/>沿Z轴旋转时，/>点的X,和Y分量保持不变；/>径向位移部分|dz|,则对/>运动补偿Tzxyz＝[0,0,-dz]T后，/>依然保持不变，且位于手术工具33径向方向上一点；
(10)沿着的Y轴的运动的同时需要受到/>点的约束，将手术机器人的运动分为旋转和位移两部分，其中旋转部分关系式为/>沿着Y轴旋转后，坐标系由X-Y-Z变换为X’-Y’-Z’，且Y/Y’轴重合，手术机器人末端的手术工具(33)沿/>点旋转带来了/>的位移，/>移动到了/>将/>分别投影在/>旋转前的坐标系X-Y-Z中，分解后在X方向产生了/>的位移分量，Z轴方向产生了/>的位移分量，Y轴方向仅旋转没有位移分量；为保持/>位置不变，则需要对/>点做运动位移补偿向量为经过对/>运动补偿后，/>点移动到/>点使得/>始终在手术工具上并且其X,Y,Z分量保持不变。
3.根据权利要求2所述的方法，其特征在于，所述方法进一步包括：
(11)沿着的X轴的运动的同时需要受到/>点的约束，将手术机器人的运动分为旋转和位移两部分，旋转部分关系式为/>沿着X轴旋转后，坐标系由X-Y-Z变换为X’-Y’-Z’，手术机器人末端的手术工具(33)沿/>旋转带来了/>的位移，移动到了/>将/>分别投影在/>旋转前的坐标系中，分解后在Y方向产生了的位移分量，Z轴方向产生了/>的位移分量，X轴方向仅旋转没有位移分量；为保持/>位置不变，则需要对/>点做运动位移补偿向量为经过对/>运动补偿后，/>点移动到/>点使得/>始终在手术工具上并且其X,Y,Z分量保持不变；
(12)经过上述步骤得到机器人手术工具(33)前端点从当前位姿到目标位姿的齐次变换矩阵Hzyx后，采用机器人逆解的方法得到机械臂各关节的角度，从而控制机械臂末端的手术工具(33)进行远心不动点约束的运动。
CN202111154994.9A 2021-09-29 2021-09-29 一种基于远心不动点约束的手术机器人运动控制方法 Active CN113974835B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111154994.9A CN113974835B (zh) 2021-09-29 2021-09-29 一种基于远心不动点约束的手术机器人运动控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111154994.9A CN113974835B (zh) 2021-09-29 2021-09-29 一种基于远心不动点约束的手术机器人运动控制方法

Publications (2)

Publication Number Publication Date
CN113974835A CN113974835A (zh) 2022-01-28
CN113974835B true CN113974835B (zh) 2023-09-29

Family

ID=79737284

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111154994.9A Active CN113974835B (zh) 2021-09-29 2021-09-29 一种基于远心不动点约束的手术机器人运动控制方法

Country Status (1)

Country Link
CN (1) CN113974835B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114886567B (zh) * 2022-05-12 2023-06-23 苏州大学 一种面向具有远心不动点约束的手术机器人手眼标定方法
CN114952806B (zh) * 2022-06-16 2023-10-03 法奥意威(苏州)机器人系统有限公司 约束运动控制方法、装置、系统和电子设备
CN117503365A (zh) * 2022-07-28 2024-02-06 深圳市精锋医疗科技股份有限公司 手术机器人及其控制方法、控制装置
CN118303982B (zh) * 2024-04-26 2024-08-27 北京天智航医疗科技股份有限公司 基于力交互的机器人远心运动控制方法、系统及存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018059036A1 (zh) * 2016-09-27 2018-04-05 微创（上海）医疗机器人有限公司 腹腔镜手术系统
CN113180828A (zh) * 2021-03-25 2021-07-30 北京航空航天大学 基于旋量理论的手术机器人约束运动控制方法
CN113334357A (zh) * 2021-06-17 2021-09-03 北京航空航天大学 混联机器人系统及虚拟rcm运动控制方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20120226145A1 (en) * 2011-03-03 2012-09-06 National University Of Singapore Transcutaneous robot-assisted ablation-device insertion navigation system
CN114269279A (zh) * 2019-08-02 2022-04-01 奥瑞斯健康公司 用于调节医疗规程中的远程中心距离的系统和方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018059036A1 (zh) * 2016-09-27 2018-04-05 微创（上海）医疗机器人有限公司 腹腔镜手术系统
CN113180828A (zh) * 2021-03-25 2021-07-30 北京航空航天大学 基于旋量理论的手术机器人约束运动控制方法
CN113334357A (zh) * 2021-06-17 2021-09-03 北京航空航天大学 混联机器人系统及虚拟rcm运动控制方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
机器人辅助下腹腔镜泌尿外科手术;刘承;《腹腔镜外科杂志》;157-159 *
鼻内镜手术辅助机器人设计与实验研究;戴新新;《中国优秀硕士学位论文全文数据库信息科技辑》;41-42 *

Also Published As

Publication number Publication date
CN113974835A (zh) 2022-01-28

Similar Documents

Publication Publication Date Title
CN113974835B (zh) 一种基于远心不动点约束的手术机器人运动控制方法
CN112971993B (zh) 定位手术用手术机器人系统及其控制方法
CN107753106B (zh) 定位手术用手术机器人及其控制方法
US9517560B2 (en) Robot system and calibration method of the robot system
CN110236853B (zh) 用于配准到手术台的系统及方法
CN106859742B (zh) 一种穿刺手术导航定位系统和方法
US10470838B2 (en) Surgical system for spatial registration verification of anatomical region
US20200016758A1 (en) Method for calibrating a manipulator of a diagnostic and/or therapeutic manipulator system
JP4191080B2 (ja) 計測装置
CN108994876B (zh) 示教位置修正装置和示教位置修正方法
CN114343847B (zh) 基于光学定位系统的手术机器人的手眼标定方法
JP2013086206A (ja) 操作入力装置および操作入力装置の初期化方法
KR20160133515A (ko) 원격동작 의료 시스템 내의 기구의 화면외 표시를 위한 시스템 및 방법
US10800034B2 (en) Method for tracking a hand-guided robot, hand-guided robot, computer program, and electronically readable storage medium
WO2022141153A1 (zh) 超声定位穿刺系统和存储介质
EP4252969A1 (en) Hybrid master-slave mapping method, robotic arm system, and computer device
CN112043382A (zh) 一种外科手术导航系统及其使用方法
JP7258516B2 (ja) キャリブレーション方法および把持システム
CN114795496A (zh) 一种被动式手术机器人导航定位系统
CN116035705A (zh) 一种手术机器人整体运动学空间定位方法
CN114521131A (zh) 用于臂间配准的系统和方法
US20230110248A1 (en) Stereoscopic visualization camera and integrated robotics platform with force/torque sensor non-linearity correction
CN110123452A (zh) 机器人的导航方法及系统
CN115887011A (zh) 一种机械臂末端构件标定方法
CN113876433A (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
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20230526

Address after: Room 401, 4th Floor, Building 11, No. 98 Lianshihu West Road, Mentougou District, Beijing, 102308

Applicant after: Beijing Kepeng Medical Equipment Co.,Ltd.

Address before: 100730 Department of Urology, Peking Union Medical College Hospital, Dongcheng District, Beijing

Applicant before: Li Hanzhong

Applicant before: Bai Yun

GR01 Patent grant
GR01 Patent grant