CN112790864A - 一种柔性展开臂的参数优化设计方法 - Google Patents
一种柔性展开臂的参数优化设计方法 Download PDFInfo
- Publication number
- CN112790864A CN112790864A CN202011621986.6A CN202011621986A CN112790864A CN 112790864 A CN112790864 A CN 112790864A CN 202011621986 A CN202011621986 A CN 202011621986A CN 112790864 A CN112790864 A CN 112790864A
- Authority
- CN
- China
- Prior art keywords
- arm
- unfolding
- deployment
- distance
- continuum
- 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
Images
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/70—Manipulators specially adapted for use in surgery
Landscapes
- Health & Medical Sciences (AREA)
- Surgery (AREA)
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Biomedical Technology (AREA)
- Robotics (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Heart & Thoracic Surgery (AREA)
- Medical Informatics (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Manipulator (AREA)
Abstract
本公开提供了一种柔性展开臂的参数优化设计方法,属于医疗器械设计技术领域,该设计方法包括如下过程:建立操作臂运动学模型,分析操作臂工作空间和双臂公共工作空间,根据医学需求空间确定操作臂展开距离上限。通过分析医学需求空间内执行器末端夹角分布关系,确定夹角极值坐标。通过分析执行器末端夹角极值点与操作臂长度关系确定操作臂长度。通过操作臂长度确定展开臂展开距离,进而通过展开臂通过性确定展开臂关节参数。
Description
技术领域
本公开属于医疗器械设计技术领域,具体是涉及一种柔性展开臂的参数优化设计方法。
背景技术
这里的陈述仅提供与本公开相关的背景技术,而不必然地构成现有技术。
经自然腔道的手术机器人,因其无需在人体表面切口,因而具有术后人体表面无疤痕、术中病人痛苦小、术后恢复时间快、术后感染几率低等优点。通过自然腔道实施的手术多通过内窥镜的工作通道将手术操作臂送达病变部位,完成各种手术操作。由于自然腔道空间限制,内窥镜直径多为15mm以下,因此双臂之间的间距非常小。操作臂之间过小的间距,导致了内窥镜视野的遮挡、双臂无法形成操作三角、双臂之间容易产生干涉和双臂工作空间重叠等问题。使用柔性折展臂是解决操作臂间距过小的一种方案,但是如何确定柔性折展臂的关节尺寸、柔性折展臂的展开距离和操作臂的长度,需要一种综合的优化方法。
发明人发现,许多学者采用不同的方法对自然腔道手术操作臂距离的拓展问题进行了研究。如采用末端“Y”形通道,使操作臂在内窥镜内末端呈放射状分布逐步增加双臂距离;如在内窥镜末端使用折叠的端盖,内镜到达病变部位时打开端盖,形成“Y”形引导通道;如使用多段独立自由度连续体,形成“S”形弯曲增加操作臂之间的间距等等。这些方法主要存在以下问题:一是没有考虑操作臂多个自由度之间的耦合关系;二是没有考虑公共工作空间与医学需求工作空间的关系;三是没有考虑末端执行器间的夹角与展开臂展开距离之间的关系。
发明内容
针对现有技术存在的技术问题,本公开提供了一种柔性展开臂的参数优化设计方法。
本公开至少一实施例提供了一种柔性展开臂的参数优化设计方法,包括依次相互连接的展开臂、连续体操作臂以及末端执行器,该方法包括如下过程:
对连续体操作臂建立偏转角度、弯曲角度和操作臂末端位置关系的正运动学模型,根据所述正运动学模型确定连续体操作臂的公共工作空间,在医学需求工作空间的约束条件下建立展开臂展开距离与连续体操作臂长度之间的关系;
通过分析医学需求空间内执行器末端夹角分布关系,确定夹角极值坐标;通过夹角极值点与连续体操作臂长度关系确定连续体操作臂的长度;
通过连续体操作臂长度确定展开臂展开距离,进而通过展开臂通过性约束条件确定展开臂关节参数。
进一步地,连续体操作臂末端位置坐标(x y z)与连续体操作臂的弯曲角度、偏转角度间的关系可表达为:
其中l表示连续体操作臂的长度,θ∈[0 π/2]表示连续体操作臂弯曲的角度,α∈[-π/2 π/2]表示连续体操作臂偏转角度,h表示末端夹持器的长度,hy表示展开臂展开距离,de表示内窥镜工作通道之间的距离,d表示操作臂相对内窥的平移距离。
进一步地,连续体操作臂工作空间的半径可表示为rw=2l/π+h,双连续体操作臂公共工作空间的长轴表示为:
其短轴表示为:
进一步地,医学需求工作空间的直径表示为dreq.min,则展开臂的展开距离上限表示为:
进一步地,对医学需求工作区间的球形区域过圆心在水平面上进行网格划分,得到网格点处的坐标值。通过正运动学模型求反函数,得到连续体操作臂逆运动学的解公式。将网格点的坐标值带入连续体操作臂逆运动学公式得到末端执行器到达该点时的弯曲角度和偏转角度:
进一步地,通过坐标变换得到末端执行器的姿态向量,末端执行器的姿态向量表示为:
进一步地,通过末端执行器的姿态向量确定末端执行器夹角极大值坐标为[0 ±dreq.min/2 d+hz+lsinθ/θ]与极小值的坐标[±dreq.min/2 0 d+hz+lsinθ/θ];展开臂展开距离最大值约束条件表示为hy=2l/π+h4-dreq.min-de/2。
进一步地,根据两个连续体展开臂的几何结构确定展开臂的展开距离为
其中2n表示展开臂的关节数量,n必须为正整数,ψ表示展开臂关节转动角度,lm表示展开臂关节铰链轴心之间的距离。
进一步地,根据连续体展开臂的通过能力对展开臂关节的约束表示为:
进一步地,通过验证展开臂关节数量的取值,确定展开臂关节的侧面边长、展开臂关节铰链轴心之间的距离和展开臂关节转动角度。
本公开的有益效果如下:
(1)、本公开提供的展开臂的参数优化设计方法在综合考虑了双臂公共工作区间与医疗工作区间、末端执行器夹角以及展开臂通过能力的基础上,得出了展开臂关节的设计参数和连续体臂的设计长度。
(2)、本公开提供的展开臂的参数优化设计方法在医疗工作区间约束下,分析自然腔道手术操作臂末端执行器夹角的方法;通过对医疗工作区间中心平面进行网格划分得到网格点坐标,通过自然腔道手术机器人逆运动学公式得到虚拟关节角度,根据自然腔道手术机器人的正运动学得到末端执行器的向量表达,进而得到末端执行器之间夹角及夹角分布情况。
附图说明
构成本公开的一部分的说明书附图用来提供对本公开的进一步理解,本公开的示意性实施例及其说明用于解释本公开,并不构成对本公开的不当限定。
图1为本公开提供的一种双斜拉索柔性展开臂的参数优化设计方法流程图;
图2为本公开实施例提供的双斜拉索柔性折展臂与连续体操作臂整体坐标示意图;
图3为本公开实施例提供的连续体操作臂的正运动学分析坐标系示意图;
图4为本公开实施例提供的双臂公共工作区间投影示意图;
图5为本公开实施例提供的医学工作区间剖面网格示意图;
图6为本公开实施例提供的医学工作区间内末端执行器夹角分布图;
图7为本公开实施例提供的操作臂长度与执行器夹角极值关系图;
图8为本公开实施例提供的展开臂展开距离示意图;
图9为本公开实施例提供的展开臂通过性约束示意图。
图中:1、执行臂支撑杆,2、展开臂,2-1、斜拉索,3、连续体操作臂,-1、中心支撑杆,3-2、卡线盘,3-3、驱动丝,4、末端执行器。
具体实施方式
应该指出,以下详细说明都是例示性的,旨在对本公开提供进一步的说明。除非另有指明,本公开使用的所有技术和科学术语具有与本公开所属技术领域的普通技术人员通常理解的相同含义。
首先本公开实施例提供了一种内镜手术机器人执行臂如图1所示,该执行臂主要包含4个部分,具有包括执行臂支撑杆1、展开臂2、连续体操作臂3和末端执行器4。展开臂2由奇数个铰链关节组成,在斜拉索2-1未施加锁紧力时,展开臂为柔性可以通过内镜弯曲的工作通道;在斜拉索2-1施加锁紧力时,展开臂变为刚性为连续体操作臂提供稳定支撑,并增大了连续体操作臂之间的距离,为手术操作三角创建了条件。连续体操作臂3由中心支撑杆3-1、卡线盘3-2和驱动丝3-3组成,通过驱动丝的驱动连续体操作臂具备2个自由度,加上操作臂相对内窥镜的整体平移,整个操作臂具备三个自由度。
下面开始详细说明一下基于上述内镜手术机器人执行臂中展开臂的参数优化设计方法:包括如下步骤:
一、公共工作空间约束下展开臂展开距离与连续体操作臂长度间关系
如图2所示,按照常曲率建模假设,通过几何分析可以得知,连续体操作臂的弯曲角度、弯曲方向与其末端位置之间的关系可表达为:
其中l表示连续体操作臂的长度,θ∈[0 π/2]表示连续体操作臂弯曲的角度,α∈[-π/2 π/2]表示连续体操作臂偏转角度,h表示末端夹持器的长度,hy表示展开臂展开距离,de表示内窥镜工作通道之间的距离,d表示操作臂相对内窥的平移距离。左侧连续体操作臂的运动学模型与右侧类似,在此不再赘述。
通过公式(1)可知连续体操作臂工作空间的半径可表示为rw=2l/π+h。
通过仿真可得到如图3所示的公共工作区间投影示意图。如图3所示,双臂公共工作空间投影的长轴dl可表示为:
其短轴ds可表示为:
医学需求工作空间的直径表示为dreq.min,双臂的公共工作空间应包括医学需求工作空间,因此通过不等式变换可得到展开臂展开距离的上限:
二、末端执行器夹角最优条件下连续体操作臂长度确定
末端执行器夹角如图5中角β所示,对医学需求工作区间的球形区域过圆心在水平面上进行网格划分,得到网格点处的坐标值。通过对公式(1)求反函数,得到操作臂逆运动学的解公式(5)。将网格点的坐标值带入公式(5)得到末端执行器到达该点时的弯曲角度和偏转角度。
如图2所示,通过建立基础坐标系X0Y0Z0、展开臂坐标系X1Y1Z1、连续体坐标系X2Y2Z2和夹钳末端坐标系X3Y3Z3,通过坐标变换得到末端执行器的姿态向量,其中末端执行器的姿态向量可表示为:
展开臂只对连续体操作臂进行了水平和垂直方向的平移,没有改变连续体操作臂的姿态。因此将公式(5)得到的角度带入公式(6)可得到各坐标点处末端执行器的姿态向量。通过计算末端执行器向量间的夹角,得出末端执行器间夹角在分析平面的分布关系如图5所示,可以得到末端执行器夹角极大值坐标[0 ±dreq.min/2 d+hz+lsinθ/θ]与极小值的坐标[±dreq.min/2 0 d+hz+lsinθ/2]。通过图5可知道末端执行器夹角随展开臂展开距离增大而增大,因此取展开距离最大值,公式(4)约束条件转换为
通过约束条件公式(7)及夹角极值坐标,计算连续体操作臂长度与末端执行器夹角极值的关系,其关系图如图6所示。在已知末端执行器夹角最佳角度范围为[90° 180°]条件下,根据图6末端执行器夹角极值可确定连续体操作臂长度l。根据公式(7)可确定展开臂最大展开距离hy。
三、内窥镜工作通道通过能力确定展开臂关节参数
结合图7与图8,根据双斜拉索展开臂的几何结构可以得知展开臂的展开距离表示为:
其中2n表示展开臂的关节数量,n必须为正整数。ψ表示展开臂关节转动角度,lm表示展开臂关节铰链轴心之间的距离。
如图8所示展开臂的通过能力对展开臂关节的约束可表示为:
其中ls表示展开臂关节的侧面边长,λ表示展开臂关节的直径,ρ表示内窥镜工作通道的最小曲率半径,δ表示胃镜工作通道的直径。n为大于等于2的正整数,通过对公式(8)验证n的取值,结合公式(9)与公式(10)的约束条件可以确定展开臂关节的侧面边长ls、展开臂关节铰链轴心之间的距离lm和展开臂关节转动角度ψ。
最后说明的是,以上实施例仅用以说明本公开的技术方案而非限制,尽管参照较佳实施例对本公开进行了详细说明,本领域的普通技术人员应当理解,可以对本公开的技术方案进行修改或者等同替换,而不脱离本技术方案的宗旨和范围,其均应涵盖在本公开的权利要求范围当中。
上述虽然结合附图对本公开的具体实施方式进行了描述,但并非对本公开保护范围的限制,所属领域技术人员应该明白,在本公开的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本公开的保护范围以内。
Claims (10)
1.一种柔性展开臂的参数优化设计方法,包括依次相互连接的展开臂、连续体操作臂以及末端执行器,其特征在于,包括如下过程:
对连续体操作臂建立偏转角度、弯曲角度和操作臂末端位置关系的正运动学模型,根据所述正运动学模型确定连续体操作臂的公共工作空间,在医学需求工作空间的约束条件下建立展开臂展开距离与连续体操作臂长度之间的关系;
通过分析医学需求空间内执行器末端夹角分布关系,确定夹角极值坐标;通过夹角极值点与连续体操作臂长度关系确定连续体操作臂的长度;
通过连续体操作臂长度确定展开臂展开距离,进而通过展开臂通过性约束条件确定展开臂关节参数。
10.如权利要求1所述的一种柔性展开臂的参数优化设计方法,其特征在于,通过验证展开臂关节数量的取值,确定展开臂关节的侧面边长、展开臂关节铰链轴心之间的距离和展开臂关节转动角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011621986.6A CN112790864B (zh) | 2020-12-30 | 2020-12-30 | 一种柔性展开臂的参数优化设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011621986.6A CN112790864B (zh) | 2020-12-30 | 2020-12-30 | 一种柔性展开臂的参数优化设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112790864A true CN112790864A (zh) | 2021-05-14 |
CN112790864B CN112790864B (zh) | 2022-03-08 |
Family
ID=75807488
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011621986.6A Active CN112790864B (zh) | 2020-12-30 | 2020-12-30 | 一种柔性展开臂的参数优化设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112790864B (zh) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090138025A1 (en) * | 2007-05-04 | 2009-05-28 | Hansen Medical, Inc. | Apparatus systems and methods for forming a working platform of a robotic instrument system by manipulation of components having controllably rigidity |
WO2013025831A2 (en) * | 2011-08-15 | 2013-02-21 | Intuitive Surgical Operations, Inc. | Medical instrument with flexible jaw and/or flexible wrist mechanisms |
CN103417298A (zh) * | 2012-05-25 | 2013-12-04 | 三星电子株式会社 | 臂单元及具有该臂单元的机器人 |
CN105902313A (zh) * | 2016-04-07 | 2016-08-31 | 上海交通大学 | 球囊式可分离多臂软体机器人 |
EP3087901A1 (en) * | 2005-12-27 | 2016-11-02 | Intuitive Surgical Operations, Inc. | Articulate and swapable endoscope for a surgical robot |
US20170071687A1 (en) * | 2014-09-04 | 2017-03-16 | Memic Innovative Surgery Ltd. | Device and system including mechanical arms |
CN107049494A (zh) * | 2017-05-09 | 2017-08-18 | 深圳市罗伯医疗机器人研究所 | 一种基于消化内镜的医疗装置 |
CN109291046A (zh) * | 2017-07-25 | 2019-02-01 | 中国科学院沈阳自动化研究所 | 一种七自由度拟人构型机械臂逆运动学规划方法 |
CN109700537A (zh) * | 2018-12-29 | 2019-05-03 | 天津大学 | 柔性手术器械、操作臂系统及微创手术机器人从手系统 |
CN110744547A (zh) * | 2019-11-08 | 2020-02-04 | 山东大学 | 一种基于分段常曲率的连续体机械臂逆运动学建模方法 |
CN110744548A (zh) * | 2019-11-08 | 2020-02-04 | 山东大学 | 一种多线驱连续体机械臂驱动线耦合关系的统一解耦方法 |
CN111658152A (zh) * | 2020-07-10 | 2020-09-15 | 山东大学 | 一种手术机械臂及内窥镜系统 |
-
2020
- 2020-12-30 CN CN202011621986.6A patent/CN112790864B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3087901A1 (en) * | 2005-12-27 | 2016-11-02 | Intuitive Surgical Operations, Inc. | Articulate and swapable endoscope for a surgical robot |
US20090138025A1 (en) * | 2007-05-04 | 2009-05-28 | Hansen Medical, Inc. | Apparatus systems and methods for forming a working platform of a robotic instrument system by manipulation of components having controllably rigidity |
WO2013025831A2 (en) * | 2011-08-15 | 2013-02-21 | Intuitive Surgical Operations, Inc. | Medical instrument with flexible jaw and/or flexible wrist mechanisms |
CN103417298A (zh) * | 2012-05-25 | 2013-12-04 | 三星电子株式会社 | 臂单元及具有该臂单元的机器人 |
US20170071687A1 (en) * | 2014-09-04 | 2017-03-16 | Memic Innovative Surgery Ltd. | Device and system including mechanical arms |
CN105902313A (zh) * | 2016-04-07 | 2016-08-31 | 上海交通大学 | 球囊式可分离多臂软体机器人 |
CN107049494A (zh) * | 2017-05-09 | 2017-08-18 | 深圳市罗伯医疗机器人研究所 | 一种基于消化内镜的医疗装置 |
CN109291046A (zh) * | 2017-07-25 | 2019-02-01 | 中国科学院沈阳自动化研究所 | 一种七自由度拟人构型机械臂逆运动学规划方法 |
CN109700537A (zh) * | 2018-12-29 | 2019-05-03 | 天津大学 | 柔性手术器械、操作臂系统及微创手术机器人从手系统 |
CN110744547A (zh) * | 2019-11-08 | 2020-02-04 | 山东大学 | 一种基于分段常曲率的连续体机械臂逆运动学建模方法 |
CN110744548A (zh) * | 2019-11-08 | 2020-02-04 | 山东大学 | 一种多线驱连续体机械臂驱动线耦合关系的统一解耦方法 |
CN111658152A (zh) * | 2020-07-10 | 2020-09-15 | 山东大学 | 一种手术机械臂及内窥镜系统 |
Non-Patent Citations (3)
Title |
---|
俞晓瑾: "《柔性机械臂的运动学和动力学建模及视觉伺服控制》", 《中国优秀硕士学位论文全文数据库》 * |
李贻斌等: "基于JOGL的关节机器人仿真", 《苏州市职业大学学报》 * |
辛亚先等: "腿-轮复合机器人全方位运动控制器的设计与仿真", 《无人系统技术》 * |
Also Published As
Publication number | Publication date |
---|---|
CN112790864B (zh) | 2022-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2021147265A1 (zh) | 手术机械臂的控制方法、计算机设备及一种手术机械臂 | |
Li et al. | A novel constrained wire-driven flexible mechanism and its kinematic analysis | |
Bedell et al. | Design optimization of concentric tube robots based on task and anatomical constraints | |
EP3834752B1 (en) | Wrist and jaw assemblies for robotic surgical systems | |
EP3733108A1 (en) | Surgical robot terminal | |
CN107595392B (zh) | 使用零空间回避操纵器臂与患者碰撞 | |
Lum et al. | Optimization of a spherical mechanism for a minimally invasive surgical robot: theoretical and experimental approaches | |
CN108309454B (zh) | 用于通过在零垂直空间内进行咬合同时发生零空间移动而定位操纵器臂的系统和方法 | |
CN104717935A (zh) | 利用零空间取消关节运动的系统和方法 | |
KR20150133756A (ko) | 영공간을 이용하여 카테시안 좌표의 에지에의 액세스를 조장하기 위한 시스템 및 방법 | |
CN112932676A (zh) | 用于管理多个零空间目标和饱和sli行为的系统和方法 | |
CN105050529A (zh) | 用于使用零空间来各向异性地增强操纵器接头运动的系统和方法 | |
CN110744547B (zh) | 一种基于分段常曲率的连续体机械臂逆运动学建模方法 | |
US20220143816A1 (en) | Parallel mechanism with kinematically redundant actuation | |
Li et al. | Configuration transition control of a continuum surgical manipulator for improved kinematic performance | |
WO2022166024A1 (zh) | 一种腔镜手术机器人的手术臂初始位姿规划方法及装置 | |
CN113742992B (zh) | 基于深度学习的主从控制方法及应用 | |
Kim et al. | Cable-movable rolling joint to expand workspace under high external load in a hyper-redundant manipulator | |
CN112790864B (zh) | 一种柔性展开臂的参数优化设计方法 | |
Trejos et al. | Port placement for endoscopic cardiac surgery based on robot dexterity optimization | |
EP2153946A1 (en) | Multiple articulation arm | |
CN114098958A (zh) | 机械臂、从操作设备以及手术机器人 | |
CN114098955A (zh) | 机械臂、从操作设备以及手术机器人 | |
Wang et al. | Design and analysis of a snake-like surgical robot with continuum joints | |
Chen et al. | Design and analysis of a haptic master manipulator for minimally invasive surgery |
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 |