CN112894802B - 多级并联手术机械臂的控制方法及多级并联手术机械臂 - Google Patents
多级并联手术机械臂的控制方法及多级并联手术机械臂 Download PDFInfo
- Publication number
- CN112894802B CN112894802B CN202011583062.1A CN202011583062A CN112894802B CN 112894802 B CN112894802 B CN 112894802B CN 202011583062 A CN202011583062 A CN 202011583062A CN 112894802 B CN112894802 B CN 112894802B
- Authority
- CN
- China
- Prior art keywords
- platform
- coordinate
- parallel
- parallel platform
- attitude vector
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 65
- 239000013598 vector Substances 0.000 claims abstract description 119
- 230000003068 static effect Effects 0.000 claims description 74
- 239000011159 matrix material Substances 0.000 claims description 35
- 230000009466 transformation Effects 0.000 claims description 25
- 238000006243 chemical reaction Methods 0.000 claims description 15
- 238000004590 computer program Methods 0.000 claims description 13
- 239000012636 effector Substances 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 14
- 238000004364 calculation method Methods 0.000 description 13
- 230000008859 change Effects 0.000 description 9
- 230000007246 mechanism Effects 0.000 description 9
- 238000004891 communication Methods 0.000 description 8
- 230000008569 process Effects 0.000 description 7
- 238000005516 engineering process Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 238000011161 development Methods 0.000 description 3
- 238000002324 minimally invasive surgery Methods 0.000 description 3
- OVSKIKFHRZPJSS-UHFFFAOYSA-N 2,4-D Chemical compound OC(=O)COC1=CC=C(Cl)C=C1Cl OVSKIKFHRZPJSS-UHFFFAOYSA-N 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000001356 surgical procedure Methods 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000008602 contraction Effects 0.000 description 1
- 230000006378 damage Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 210000000056 organ Anatomy 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
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
-
- 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/10—Computer-aided planning, simulation or modelling of surgical operations
-
- 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
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- 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/1679—Programme controls characterised by the tasks executed
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Robotics (AREA)
- Surgery (AREA)
- Medical Informatics (AREA)
- Biomedical Technology (AREA)
- Heart & Thoracic Surgery (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本申请涉及一种多级并联手术机械臂的控制方法及多级并联手术机械臂,其中,该控制方法包括:获取该执行杆上的远心不动点坐标,并获取该手术器具的末端坐标;根据该远心不动点坐标和该末端坐标,确定该第一并联平台的位置偏移量和第一姿态向量,并确定该第二并联平台的第二姿态向量;根据该位置偏移量、该第一姿态向量和该第二姿态向量,控制该第一并联平台移动至第一指定位姿;根据该第一姿态向量和该第二姿态向量,控制该第二并联平台移动至第二指定位姿。通过本申请,解决了手术机械臂的工作空间范围较小的问题,实现了对多级并联手术机械臂的精确控制。
Description
技术领域
本申请涉及医疗器械技术领域,特别是涉及一种多级并联手术机械臂的控制方法及多级并联手术机械臂。
背景技术
随着微创手术技术与人工智能技术的发展,机器人辅助微创外科手术逐渐成为微创外科手术的发展趋势之一。在相关技术中,Stewart六自由度并联平台具有自由度多、承载能力较强、没有积累误差等方面的特点,将该并联平台应用于手术机械臂,可以避免手术机器人的机械臂之间容易发生干涉的问题;然而,通过多级并联平台控制的手术机械臂通常反解运算较慢,且误差较大,导致控制多级并联手术机械臂的精度低。
针对相关技术中,多级并联手术机械臂的控制精度较低的问题,目前尚未提出有效的解决方案。
发明内容
本申请实施例提供了一种多级并联手术机械臂的控制方法及多级并联手术机械臂,以至少解决相关技术中多级并联手术机械臂的控制精度较低的问题。
第一方面,本申请实施例提供了一种多级并联手术机械臂的控制方法,其特征在于,所述多级并联手术机械臂包括第一并联平台、第二并联平台和执行组件,所述执行组件包括执行杆和手术器具;所述执行组件与所述第一并联平台连接,所述第一并联平台与所述第二并联平台连接;所述方法包括:
获取所述执行杆上的远心不动点坐标,并获取所述手术器具的末端坐标;
根据所述远心不动点坐标和所述末端坐标,确定所述第一并联平台的位置偏移量和第一姿态向量,并确定所述第二并联平台的第二姿态向量;
根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第一指定位姿;
根据所述第一姿态向量和所述第二姿态向量,控制所述第二并联平台移动至第二指定位姿,从而实现了对多级并联平台的精确控制。
在其中一些实施例中,控制所述第一并联平台和所述第二并联平台移动包括:
在所述手术器具的运动范围小于或等于第一区域的情况下,将所述第二并联平台设置为锁住状态,并控制所述第一并联平台移动至所述第一指定位姿;
在所述运动范围大于所述第一区域,且所述运动范围小于或等于第二区域的情况下,将所述第二并联平台设置为解锁状态,并控制所述第二并联平台移动移动至所述第二指定位姿,使得对多级并联平台的控制更加简便。
在其中一些实施例中,所述根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第一指定位姿包括:
根据所述远心不动点坐标和所述末端坐标,获取所述第一并联平台的第一动平台在绝对坐标系下的第一动原点坐标;并根据所述第一动原点坐标获取所述第一并联平台的位置偏移量;
根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,确定第一转换矩阵;
根据所述第一转换矩阵,并根据所述第一并联平台的第一铰接点在所述绝对坐标系下的坐标,计算得到所述第一并联平台的第一伸缩元件长度;
根据所述第一动原点坐标和所述第一伸缩元件长度,控制所述第一动平台移动至所述第一指定位姿,从而提高了手术精度。
在其中一些实施例中,所述根据所述第一动原点坐标获取所述第一并联平台的位置偏移量包括:
根据所述远心不动点坐标、所述末端坐标和所述第一动原点坐标,确定第一比例;
其中,所述第一比例为所述远心不动点坐标到第一静原点坐标的距离相对所述第二姿态向量的比例;所述第一静原点坐标为所述第一并联平台的第一静平台在绝对坐标系下的原点坐标;
根据所述第一比例、所述远心不动点和所述第二姿态向量,确定所述第一静平台的第一静原点坐标;
根据所述第一动原点坐标和所述第一静原点坐标,获取所述位置偏移量,从而避免了坐标偏移产生的误差。
在其中一些实施例中,所述根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,确定第一转换矩阵包括:
根据所述第一姿态向量和所述第二姿态向量,获取第一旋转角度,并获取第二旋转角度;其中,所述第一旋转角度为所述第一并联平台绕第一动坐标系的第一坐标轴旋转的角度,所述第二旋转角度为所述第一并联平台绕所述第一动坐标系的第二坐标轴旋转的角度;
根据所述第一并联平台的位置偏移量、所述第一旋转角度和所述第二姿态向量,确定所述第一转换矩阵,从而通过齐次坐标矩阵的求解提高了响应速度。
在其中一些实施例中,所述根据所述第一姿态向量和所述第二姿态向量,控制所述第二并联平台移动至第二指定位姿包括:
根据所述远心不动点坐标和所述第二姿态向量,获取所述第二并联平台的第二动平台在绝对坐标系下的第二动原点坐标;
根据所述绝对坐标系的第三坐标轴、所述第二姿态向量和所述第二动原点坐标,确定第二转换矩阵;
根据所述第二转换矩阵,并根据所述第二并联平台的第二铰接点在所述绝对坐标系下的坐标,计算得到所述第二并联平台的第二伸缩元件长度;
根据所述第二动原点坐标和所述第二伸缩元件长度,控制所述第二动平台移动至所述第二指定位姿,从而进一步提高了手术精度。
在其中一些实施例中,所述根据所述远心不动点坐标和所述第二姿态向量,获取所述第二并联平台的第二动平台在绝对坐标系下的第二动原点坐标包括:
根据所述远心不动点坐标、所述末端坐标和所述第一动原点坐标,确定第二比例;其中,所述第二比例为所述远心不动点坐标到第二动原点坐标的距离相对所述第二姿态向量的比例;
根据所述第二比例、所述远心不动点和所述第二姿态向量,确定所述第二动原点坐标,从而实时反解获取第二动原点,提高了控制精度。
在其中一些实施例中,所述根据所述绝对坐标系的第三坐标轴、所述第二姿态向量和所述第二动原点坐标,确定第二转换矩阵包括:
根据所述第三坐标轴和第二姿态向量,获取第三旋转角度,并获取第四旋转角度;其中,所述第三旋转角度为所述第二并联平台绕第二动坐标系的第一坐标轴旋转的角度,所述第四旋转角度为所述第二并联平台绕所述第二动坐标系的第二坐标轴旋转的角度;
根据所述第三旋转角度、所述第四旋转角度和所述第二动原点坐标,确定所述第二转换矩阵,从而进一步提高了响应速度。
在其中一些实施例中,所述控制所述第二并联平台移动至第二指定位姿之后,所述方法还包括:
根据所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第三指定位姿,从而完善了对机构的整体控制。
在其中一些实施例中,所述控制所述第一并联平台移动至第三指定位置之前,所述方法还包括:
根据所述远心不动点坐标和所述末端坐标,控制所述执行杆相对于所述远心不动点的伸长运动,从而实现了更加简便灵活的运动控制。
在其中一些实施例中,所述方法还包括:
第一虚拟轴和第二虚拟轴均通过所述远心不动点;
其中,所述第一虚拟轴为固连在所述第一并联平台中心,且垂直与所述第一并联平台的直线;所述第二虚拟轴为固连在所述第二并联平台中心,且垂直与所述第二并联平台的直线,从而提高了解算速度。
在其中一些实施例中,所述方法还包括:所述第一虚拟轴和所述第二虚拟轴处于同一平面内,从而避免了各级并联平台之间发生扭矩。
在其中一些实施例中,所述方法还包括:
在将所述执行杆的摆动角度由第一阈值遍历至第二阈值的情况下,确定所述第一并联平台和所述第二并联平台的最大参数值,从而进一步提高了手术精度。
第二方面,本申请实施例提供了一种多级并联手术机械臂,包括控制系统、第一并联平台、第二并联平台和执行组件,所述执行组件包括执行杆和手术器具;所述执行组件与所述第一并联平台连接,所述第一并联平台与所述第二并联平台连接;所述控制系统用于实现如上述第一方面所述的控制方法。
在其中一些实施例中,所述第一并联平台的第一平台半径小于所述第二并联平台的第二平台半径,且所述第一并联平台的第一平台间距小于所述第二并联平台的第二平台间距。
在其中一些实施例中,所述执行组件的摆动空间设置为球形工作空间。
在其中一些实施例中,所述第一并联平台的第一最大偏角,以及所述第二并联平台的第二最大偏角设置为20°。
第三方面,本申请实施例提供了一种计算机设备,包括存储器、处理器以及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如上述第一方面所述的控制方法。
第四方面,本申请实施例提供了一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如上述第一方面所述的控制方法。
相比于相关技术,本申请实施例提供的多级并联手术机械臂的控制方法及多级并联手术机械臂,通过获取该执行杆上的远心不动点坐标,并获取该手术器具的末端坐标;根据该远心不动点坐标和该末端坐标,确定该第一并联平台的位置偏移量和第一姿态向量,并确定该第二并联平台的第二姿态向量;根据该位置偏移量、该第一姿态向量和该第二姿态向量,控制该第一并联平台移动至第一指定位姿;根据该第一姿态向量和该第二姿态向量,控制该第二并联平台移动至第二指定位姿,解决了手术机械臂的工作空间范围较小的问题,实现了对多级并联手术机械臂的精确控制。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1为根据本申请实施例的多级并联手术机械臂的模型的示意图;
图2为根据本申请实施例的控制方法的流程图;
图3A为根据本申请实施例的远心操控组件的轴视图;
图3B为根据本申请实施例的远心操控组件的侧视图;
图4为根据本申请实施例的执行杆末端运动范围的示意图;
图5为根据本申请实施例的各级并联平台虚拟轴的示意图;
图6为本申请实施例的姿态向量位置关系的示意图;
图7为根据本申请实施例的第一并联平台铰链摆角的示意图;
图8A为根据本申请实施例的第一伸缩元件长度范围的示意图;
图8B为根据本申请实施例的第二伸缩元件长度范围的示意图;
图8C为根据本申请实施例的第一静铰接夹角范围的示意图;
图8D为根据本申请实施例的第二静铰接夹角范围的示意图;
图8E为根据本申请实施例的第一动铰接夹角范围的示意图;
图8F为根据本申请实施例的第二动铰接夹角范围的示意图;
图8G为根据本申请实施例的执行杆伸长量范围的示意图;
图9为根据本申请实施例的多级并联手术机械臂的结构框图;
图10为根据本申请实施例的工作空间的示意图;
图11为根据本申请实施例的计算机设备的硬件结构示意图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行描述和说明。应当理解,此处所描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。基于本申请提供的实施例,本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例,都属于本申请保护的范围。
显而易见地,下面描述中的附图仅仅是本申请的一些示例或实施例,对于本领域的普通技术人员而言,在不付出创造性劳动的前提下,还可以根据这些附图将本申请应用于其他类似情景。此外,还可以理解的是,虽然这种开发过程中所作出的努力可能是复杂并且冗长的,然而对于与本申请公开的内容相关的本领域的普通技术人员而言,在本申请揭露的技术内容的基础上进行的一些设计,制造或者生产等变更只是常规的技术手段,不应当理解为本申请公开的内容不充分。
在本实施例中,提供了一种手术机械臂的模型,图1为根据本申请实施例的多级并联手术机械臂模型的示意图,如图1所示。该多级并联手术机械臂包括执行组件12和远心操控组件14;该执行组件12包括驱动件122、执行杆124和手术器具126,执行杆124与手术器具126之间由转动关节连接,执行杆124与转动关节的边沿均为圆滑过渡,无棱角,避免对人体或器官造成伤害;执行杆124内部置有钢丝绳用于控制手术器具126的动作,该驱动件122用于驱动钢丝绳运动,从而驱动控制该执行杆124的三个自由度的转动,以及控制该手术器具126的夹取组织的动作。
该远心操控组件14是由一个具有多个方向运动的末端执行器通过铰链及可伸缩机构与机械系统的另一固定端相连接而构成的空间并联机构,该远心操控组件14可以是多级Stewart并联平台。
在本实施例中,该多级Stewart并联平台包括第一并联平台142和第二并联平台144;该第一并联平台142包括第一静平台1422、6个第一伸缩元件1424和第一动平台1426;该第一静平台1422与该6个第一伸缩元件1424采用U副铰接,该第一静平台1422可以在x轴和y轴方向转动,但是限制了z轴方向的自由度;该第一伸缩元件1424可以为驱动杆,该驱动杆由电极和丝杠组成,通过电极驱动丝杠可以使电缸自由伸缩,从而改变该第一动平台1426的运动状态,该6个第一伸缩元件1424按照一定规律排列,使该Stewart并联平台偏转角度较小,其中,该第一伸缩元件1424与z轴的偏转角度范围在±20°之间;该第一动平台1426的直径小于该第一静平台1422,该第一动平台1426的运动状态由该第一伸缩元件1424的长度变化来控制,该第一动平台1426与该第一伸缩元件1424采用球铰接的方法,可以实现在x轴、y轴和z轴三个方向转动;该第二并联平台144包括第二静平台1442、6个第二伸缩元件1444和第二动平台1446,该第二并联平台144内部结构的连接可以类似于该第一并联平台142。
在本实施例中,提供了一种多级并联手机机械臂的控制方法。图2为根据本申请实施例的控制方法的流程图,如图2所示,该流程包括如下步骤:
步骤S202,获取该执行杆124上的远心不动点坐标,并获取该手术器具126的末端坐标。其中,根据目标靶点计算得到该远心不动点,具体地,该目标靶点由操作者给出,通过医生主操作手的位置来给出该目标靶点的位置,通过该目标靶点位置与微创开口的距离计算得到该远心不动点在执行杆124上的位置;手术器具126末端轨迹点根据控制系统给出,故任意时刻末端坐标T已知表示为(tx,ty,tz)。
图3A为根据本申请实施例的远心操控组件的轴视图,图3B为根据本申请实施例的远心操控组件的侧视图,如图3A、3B所示,初始时刻器械杆垂直于动平台且其轴线通过平台中心,lh为初始时刻器械杆末端点T距远心不动点F的距离;lj为平台运动过程中器械杆上与远心点重合的部分,其中F1与F2为器械杆上这一部分的两个端点;h1为初始时刻第一动平台1426和第一静平台1422之间的垂直距;h12为初始时刻第一静平台1422所在平面与第二动平台1446所在平面之间的垂间距;h2为初始时刻第二动平台1446和第二静平台1442之间的垂直距;l为器械杆长度。
建立一级并联平台各坐标系如下:静坐标系O1S-X1SY1SZ1S固连于静平台,原点建立于初始位姿(即图3A、3B所示位姿,下同)时静铰接点分布圆的圆心O1S处,X1S轴沿角S5O1SS6的角平分线,Z1S轴垂直于静平台向上,Y1S轴符合右手定则;动坐标系O1M-X1MY1MZ1M固连于动平台,原点建立于初始位置时动铰接点分布圆的圆心O1M处,初始位姿时,各轴与静坐标系对应轴平行。静铰接坐标系Si-X1SiY1SiZ1Si(i=1,2,3…6)固连于静平台,原点位于对应标号的静铰接点中心处,X1Si轴由静铰接点分布圆的圆心OS指向Si,Z1Si轴垂直于静平台向上,Y1Si符合右手定则(图中只示出了S4-X1S4Y1S4Z1S4);动铰接坐标系Mi-X1MiY1MiZ1Mi固连于动平台,原点位于对应标号的动铰接点中心处,X1Mi轴由静铰接点分布圆的圆心O1M指向Mi,Z1Mi轴垂直于静平台向上,Y1Mi符合右手定则(图中只示出了M4-X1M4Y1M4Z1M4)。第二级并联平台建立方法与第一级并联平台中各坐标系建立方法相同。
步骤S204,根据该远心不动点坐标和该末端坐标,确定该第一并联平台142的位置偏移量和第一姿态向量,并确定该第二并联平台144的第二姿态向量。其中,对于手术任务,具有十二个自由度的双级平台是一冗余自由度机构。图5为根据本申请实施例的各级并联平台虚拟轴的示意图,如图5所示,为方便级数的扩展并保证解算的速度,规定固连在各级静平台坐标系中心并垂直于静平台的直线在运动过程中始终通过远心点,该轴称为该级并联平台的虚拟轴,并定义远心点到各级静平台中心的距离为转换器械杆长。在此基础上,远心点相对于二级动平台中心的距离始终保持固定值。此时二级并联平台只提供增加偏角的功能,运动的器械杆上和静止的远心点重合处的位置由第一级并联平台控制。从而对于每一级并联平台,都可以简化为单级并联平台的运动解算。同时,考虑到二级并联平台的转化器械杆长度长于一级并联平台的转化器械杆长度,该方案在一定程度上相对降低了二级并联平台的运动范围要求,均衡各级平台的摆角和伸长量。
已知执行杆124末端点T在全局坐标系下的坐标为(tx,ty,tz),远心不动点F在全局坐标系下的坐标为(fx,fy,fz),从而确定执行杆124在全局坐标系下的姿态向量该第一并联平台142的第一姿态向量即为该执行杆124的单位姿态向量,则该第一姿态向量为
则当末端姿态夹角确定时,各级平台偏角范围如表1所示:
表1双级并联平台角度分配
其中λ1,λ2为各级并联平台动平台相对静平台的摆角,λ1max与λ2max分别表示第一并联平台142和第二并联平台144中各动、静平台之间的相对最大摆角。
为确定各级动平台在绝对坐标系下的姿态向量,令k1表示在绝对坐标系下第二姿态向量在X、Y轴方向坐标占第一姿态向量在X、Y轴方向坐标的比例,如公式2所示:
以两级平台都存在偏角的情况为例,图6为本申请实施例的姿态向量位置关系的示意图,如图6所示,其中直线表示第一姿态向量在绝对坐标系下Z轴方向的分量,表示第二姿态向量在绝对坐标系下Z轴方向的分量。假设第一姿态向量相对于第二姿态向量的夹角为20°,即∠B1FB2=20°,则有∠Α2Β2F如公式3所示:
由于第一、第二姿态向量都是单位向量,从而可以得到公式5:
并且有公式6:
联立公式2、公式4和公式5,从而可以得到第二姿态向量的X,Y,Z分量,如公式7所示:
步骤S206,根据该位置偏移量、该第一姿态向量和该第二姿态向量,控制该第一并联平台142移动至第一指定位姿。其中,由于在多级并联平台运动反解计算中,第一并联平台142的坐标变化将受到第二并联平台144的影响,因此可以先确定第一并联平台142的动静坐标系之间的位置偏移量如公式8所示:
则根据该第一姿态向量和该第二姿态向量可以确定第一并联平台142绕第一动坐标系的x轴旋转的欧拉角,以及该第一并联平台142绕第一动坐标系y轴旋转的欧拉角;根据上述求得的两个欧拉角、位置偏移量和第二姿态向量,可以确定第一转换矩阵;根据该第一转换矩阵确定第一伸缩元件1424长度,从而控制该第一动平台1426的运动。
步骤S208,根据该第一姿态向量和该第二姿态向量,确定第二转换矩阵,从而确定第二伸缩元件1444长度,并根据该第二伸缩元件1444长度控制该第二并联平台144移动至第二指定位姿。
在相关技术中手术机器人通常在手术过程中工作空间较小,而本发明实施例通过上述步骤S202至步骤S208,采用了多级并联平台应用在手术机械臂上,从而大大增加了执行杆124的摆动角度,解决了手术机械臂的工作空间范围较小的问题;同时,由于双级并联平台机构是一个冗余机构,所以在求解的时候会有很多组解,本发明实施例根据执行杆124上远心不动点坐标和末端,实时反解计算多级并联平台的位姿,从而能够在多组解中寻找到一个最佳的路径,实现了对多级并联手术机械臂的精确控制,并通过计算实时确定第一并联平台142的位置偏移量,避免了多级并联平台中动、静平台的坐标偏移造成的反解运算误差,从而解决了多级并联手术机械臂的控制精度较小的问题。
在其中一些实施例中,控制该第一并联平台142和该第二并联平台144移动包括还包括如下步骤:
步骤S302,在该手术器具126的运动范围小于或等于第一区域的情况下,将该第二并联平台144设置为锁住状态,并控制该第一并联平台142移动至该第一指定位姿;在该运动范围大于该第一区域,且该运动范围小于或等于第二区域的情况下,将该第二并联平台144设置为解锁状态,并控制该第二并联平台144移动至该第二指定位姿。
其中,手术机器人包含两级并联平台,对应各平台的静平台中心处有一条相对静平台固连的垂直于静平台的直线,该直线可以表示各平台在绝对坐标系下的方位;同理,对应各平台的动平台中心处有一条相对动平台固连的垂直于动平台的直线,该直线可以表示该动平台在绝对坐标系下的方位。通过各级动静平台两直线的夹角可以确定动静平台的相对运动。根据单级并联平台的解算,初步设定一级平台的最大夹角为20°。
图4为根据本申请实施例的执行杆末端运动范围的示意图。如图4所示,在控制手术机器人运动时,设定执行杆124末端点相应运动范围;该运动范围位于第一区域内时,所需执行杆124摆动范围小,此时只需要控制第一并联平台142运动,第二并联平台144的动静平台保持初始相对位置且锁住状态;当运动到第二区域时,解锁第二并联平台144,第一并联平台142始终保持平台内动静平台相对最大摆动夹角即20°。运动过程中为保证各平台内部摆动角度和最小,要求两平台的摆角在同一方向,即前文所述固连在各平台上垂直于动平台和静平台的直线都在同一平面内。
通过上述步骤S302,通过执行杆124摆动范围设置多级并联平台中各级平台的运动范围边界,并在运动范围较小时锁定第二并联平台144,此时只需控制第一并联平台142,并且充分利用了该第一并联平台142的工作空间;同时在该运动范围较大时再解锁该第二并联平台144进行控制,使得对多级并联平台的控制更加简便,避免了多级并联平台中易造成的控制紊乱,进一步提高了对多级并联平台控制的精度。
在其中一些实施例中,提供了一种多级并联手术机械臂的控制方法,该方法还包括如下步骤:
步骤S402,根据该远心不动点坐标和该末端坐标,获取该第一并联平台142的第一动平台1426在绝对坐标系下的第一动原点坐标;其中,该第一动原点坐标表示为(mo1x,mo1y,mo1z);末端坐标、远心不动点坐标及第一动原点坐标满足的数量关系如公式10所示:
其中,定义p1表示远心点在器械杆上的位置比例,由于远心不动点和执行杆124末端点不重合,故p1≠0。由于末端坐标、远心不动点坐标均为已知,则该第一动原点坐标(mo2x,mo2y,mo2z),即第一并联平台142动坐标系原点的坐标如公式11所示:
因此末端坐标、远心不动点坐标及第一动原点坐标均为已知,则任意位置时,p1可通过公式12求得:
其中,l表示为执行杆124长度,该执行杆124长度即为末端坐标到第一动原点坐标的距离。
步骤S404,根据该第一动原点坐标获取该第一并联平台142的位置偏移量。在其中一些实施例中,上述步骤S404包括:
步骤S1:根据该远心不动点坐标、该末端坐标和该第一动原点坐标,确定第一比例;其中,该第一比例为该远心不动点坐标到第一静原点坐标的距离相对该第二姿态向量的比例;该第一静原点坐标为该第一并联平台142的第一静平台1422在绝对坐标系下的原点坐标。
步骤S2:根据该第一比例、该远心不动点和该第二姿态向量,确定该第一静平台1422的第一静原点坐标;其中,该远心不动点表示为(fx,fy,fz),该第二姿态向量表示为(D2x,D2y,D2z),则绝对坐标系中该第一静原点坐标可以由公式14所示:
步骤S3:根据该第一动原点坐标(mo1x,mo1y,mo1z)和该第一静原点坐标(so1x,so1y,so1z),获取该位置偏移量;其中,该第一并联平台142的坐标变化将受到该第二并联平台144的影响,绝对坐标系下一级平台的动静坐标系位置变换量如公式15所示:
转换到第一级并联平台静坐标系下,则位置变化量如公式16所示:
步骤S406,根据该位置偏移量、该第一姿态向量和该第二姿态向量,确定第一转换矩阵。在其中一些实施例中,上述步骤S406包括:
步骤S1:根据该第一姿态向量和该第二姿态向量,获取第一旋转角度,并获取第二旋转角度;其中,该第一旋转角度λ1x为该第一并联平台142绕第一动坐标系的第一坐标轴X轴旋转的角度,该第二旋转角度λ1y为该第一并联平台142绕该第一动坐标系的第二坐标轴Y轴旋转的角度。
具体地,在手术过程中,执行杆124没有绕O1M-Z1M轴方向和O2M-Z2M轴方向的旋转。如图6所示,其旋转运动可以描述成先后绕动坐标系X、Y两坐标轴旋转,旋转角度为λx、λy,则旋转转换矩阵如公式17所示:
相邻两级之间,第一姿态向量和第二姿态向量的关系如公式18所示:
其中,R1表示二级坐标系到一级坐标系的旋转矩阵;则根据公式17和公式18,可以得到公式19、20:
其中,λ1x,λ1y表示对应平台相对各自X、Y轴的欧拉角。
以公式20为例说明欧拉角计算过程。计算公式18左右第一行元素,并结合三角万能公式得到公式21:
从而得到相对Y轴的欧拉角,如公式22所示:
同理,计算公式19左右两边第二行元素,得到公式23:
从而得到相对于X轴的欧拉角,如公式24所示:
步骤S2:根据该第一并联平台142的位置偏移量、该第一旋转角度和该第二姿态向量,确定该第一转换矩阵;其中,该第一转换矩阵如公式25所示:
步骤S408,根据该第一转换矩阵,并根据该第一并联平台142的第一铰接点在该绝对坐标系下的坐标,计算得到该第一并联平台142的第一伸缩元件1424长度。
具体地,第一并联平台142中任意静铰接点S1i在静坐标系下的齐次坐标为(ss1ix,ss1iy,0,1),其对应动铰接点M1i在动坐标系下的坐标可表示为MM1i(mm1ix,mm1iy,0,1),则其在静坐标系下的齐次坐标SM1i=(sm1ix,sm1iy,0,1)的计算公式如公式26所示:
SM1i=T1 MM1i 公式26
其中,图3为根据本申请实施例的铰接点坐标的示意图;该铰接点可以看做铰接点分布圆和相应坐标轴X轴的交点A相对坐标系原点O旋转相应角度而获得,从而各铰接点的坐标值如公式27所示:
其中θi为各铰接点从点A旋转到现位置的旋转角,点A的坐标为(ri,0),ri为对应铰接点分布圆的半径。
各平台动静铰接点旋转变换角度由如表2、表3所示:
表2静铰接点相应变换角度(α取0°~60°)
表3动铰接点相应变换角度(β取0°~60°)
从而获得各平台上动静铰接点在各自坐标系下的坐标值(只标注出X轴,Y轴方向坐标),如表4所示:
表4动静铰接点在相应坐标系下的计算值(α取32°,β取44°)
通过空间两点间的距离公式计算任意一对动、静铰接点之间的距离,即该第一伸缩元件1424长度,如公式28所示:
其中,为满足第一伸缩元件1424伸长条件,任意时刻该第一伸缩元件1424长度满足公式29:
lmin≤l≤lmax 公式29
步骤S410,根据该第一动原点坐标和该第一伸缩元件1424长度,控制该第一动平台1426移动至该第一指定位姿。当需要调整该第一动平台1426至该第一指定位姿的时候,根据该第一动原点坐标和该第一伸缩元件1424长度,移动该第一动平台1426,该第一动平台1426调节执行杆124绕伪远心不动点偏转一定角度,其中,在调节时,保持六个第一伸缩元件1424均匀调整。
通过上述步骤S402至步骤S410,通过第一动原点坐标获取第一并联平台142的位置偏移量,并根据该位置偏移量确定第一转换矩阵,根据该第一转换矩阵和铰接点坐标,计算获取第一伸缩元件1424长度,从而根据该第一动原点坐标和该第一伸缩元件长度反解出在手术过程中该第一并联平台142的位姿,实现了在手术过程中对该第一并联平台142运动轨迹的实时确定,提高了手术精度。
在其中一些实施例中,提供了一种多级并联手术机械臂的控制方法,该方法还包括如下步骤:
步骤S502,根据该远心不动点坐标和该第二姿态向量,获取该第二并联平台144的第二动平台1446在绝对坐标系下的第二动原点坐标。在其中一些实施例中,上述步骤S502包括:
步骤S1:根据该远心不动点坐标、该末端坐标和该第一动原点坐标,确定第二比例;其中,该第二比例为该远心不动点坐标到第二动原点坐标的距离相对该第二姿态向量的比例;该第二比例p3的求解如公式30所示:
步骤S2:根据该第二比例、该远心不动点和该第二姿态向量,确定该第二动原点坐标;其中,该第二动原点坐标(mo2x,mo2y,mo2z)如公式31所示:
步骤S504,根据该绝对坐标系的第三坐标轴、该第二姿态向量和该第二动原点坐标,确定第二转换矩阵。在其中一些实施例中,上述步骤S504包括:
步骤S1:根据该第三坐标轴和第二姿态向量,获取第三旋转角度,并获取第四旋转角度;其中,该第三旋转角度λ2x为该第二并联平台144绕第二动坐标系的第一坐标轴X轴旋转的角度,该第四旋转角度λ2y为该第二并联平台144绕该第二动坐标系的第二坐标轴Y轴旋转的角度。根据公式18计算可得λ2x和λ2y,如公式32、33所示:
步骤S2:根据该第三旋转角度、该第四旋转角度和该第二动原点坐标,确定该第二转换矩阵。其中第二并联平台144静坐标系和绝对坐标系重合,从而第二并联平台144的位置变化如公式34所示:
相应的该第二转换矩阵如公式35所示:
步骤S506,根据该第二转换矩阵,并根据该第二并联平台144的第二铰接点在该绝对坐标系下的坐标,计算得到该第二并联平台144的第二伸缩元件1444长度;其中,该第二并联平台144中任意静铰接点S2i在静坐标系下的齐次坐标为(ss2ix,ss2iy,0,1),其对应动铰接点M2i在动坐标系下的坐标可表示为MM2i(mm2ix,mm2iy,0,1),则其在静坐标系下的齐次坐标SM2i=(sm2ix,sm2iy,0,1)的计算公式如公式36所示:
SM2i=T2 MM2i 公式36
通过空间两点间的距离公式计算任意一对动、静铰接点之间的距离,即该第二伸缩元件1444长度,如公式37所示:
步骤S508,根据该第二动原点坐标和该第二伸缩元件1444长度,移动该第二动平台1446,控制该第二动平台1446移动至该第二指定位姿,使得该第二动平台1446调节执行杆124绕伪远心不动点偏转一定角度;其中,在调节过程中保持六个第二伸缩元件1444均匀调整。
通过上述步骤S502至步骤S508,通过第二比例确定第二动原点坐标,并确定第二转换矩阵,根据该第二转换矩阵获取第二伸缩元件1444长度,根据该第二动原点坐标和该第二伸缩元件1444长度计算反解出第二并联平台144的位姿,进一步提高了手术精度。
在其中一些实施例中,提供了一种多级并联手术机械臂的控制方法,该方法还包括如下步骤:
步骤S602,根据该第一姿态向量和该第二姿态向量,控制该第一并联平台142移动至第三指定位姿。在控制该第一并联平台142移动至第三指定位置之前,由于该远心不动点可以在执行杆124上一定范围内移动,因此还可以根据该远心不动点坐标和该末端坐标,控制该执行杆124相对于该远心不动点的伸长运动。对于手术机器人正常工作情况下,可通过执行杆124末端坐标和远心不动点坐标计算得出执行杆124长度,计算公式如公式38所示:
要求计算得到的数值满足器械杆最大伸出量,该满足条件如公式39所示:
L≤Lmax 公式39
其中,Lmax为最大器械杆伸长量。
通过上述步骤S602,在解锁第二并联平台144进行运动控制之前,通过控制执行杆124的伸长量实现对手术器具126的控制,使得手术过程中手术器具126的运动控制更加简便灵活。
在其中一些实施例中,提供了一种多级并联手术机械臂的控制方法,该方法还包括如下步骤:
步骤S702,在将该述执行杆的摆动角度由第一阈值遍历至第二阈值的情况下,确定该第一并联平台142和该第二并联平台144的最大参数值;该第一阈值和该第二阈值均由用户进行设置;该第一阈值可以为0°,该第二阈值可以为40°。其中,首先计算待求解参数中的静铰接点摆动夹角,以第一并联平台142为例,在并联平台位于初始位置时,驱动杆处于收缩极限位置附近,则初始位置时动铰接点在静坐标系下的齐次坐标SMi0=(smix0,smiy0,smiz0,1),如公式40所示:
smix0=mmix,smiy0=mmiy,smiz0=h 公式40
从而得到初始位置时,驱动杆在第一静坐标系下的方向向量,如公式41所示:
其中动铰接点在该第一静坐标系中的坐标为SMi=(smix,smiy,smiz,1),则任意时刻静坐标系下从静铰接点指向动铰接点的向量为如公式42所示:
用φi(i=1~6)表示静铰接摆角。图7为根据本申请实施例的第一并联平台142铰链摆角的示意图,如图7所示,以i=4为例,此时该第一驱动杆静铰接处和初始位置的夹角φ4如公式43所示:
接着计算待求解参数中的动铰接摆动夹角;以第一并联平台142为例,对动铰接点摆动夹角大小进行计算。为计算动铰接处摆角大小,先计算初始位置时静铰接点在动坐标系下的齐次坐标MSi0=(msix0,msiy0,msiz0,1)如公式44所示:
msix0=ssix,msiy0=ssiy,msiz0=-h 公式44
从而得到初始位置时,第一审查元件驱动杆在动坐标系下的方向向量,如公式45所示:
利用前文求出的转换矩阵,可知静铰接点在动坐标系中的坐标MSi=(msix,msiy,msiz,1)如公式46所示:
其中Si为对应静铰接点在静坐标系下的坐标。任意时刻,动坐标系下动铰接点到指向静铰接点的向量如公式47所示:
然后将执行杆124在绝对坐标系下运动夹角变化范围设置为0-40°,对多级并联平台进行遍历;该遍历运动使用摆角、杆长及圆周三级循环:最外层即第一层循环为执行杆124相对于绝对坐标系Z轴的夹角,变化范围为0-40°;第二层循环为执行杆124长度循环,根据手术时远心点与执行杆124的相对位置要求,使远心点外执行杆124的伸长量(即图2中的TF段长度)为100mm-200mm;第三层循环即最内层循环,为圆周循环,在设定好器械杆摆角和伸长量后,执行杆124穿过远心点作整周“圆锥摆动”,“圆锥”的母线即是此时伸出远心点部分的执行杆124。设定上述三级循环的细分数分别为10、30与120,将前文所述的执行杆伸长长度、伸缩元件长度、静铰接点摆动夹角和动铰接点摆动夹角的计算方法编写为MATLAB解算程序,获取遍历运动中,每一个点对应的各级并联平台欧拉角、转换矩阵、驱动杆长、动静铰接副摆角数据。MATLAB计算输出图像如下图所示。
对计算数据进行摘取极值,如表5至表7所示:
表5各级并联平台驱动杆伸长量
表6各级并联平台静铰接夹角
表7各级并联平台动铰接夹角
根据图8G知,驱动杆长周期性从100mm伸长到200mm,符合遍历运动的设定要求。参考图8B、图8D和图8F得出,二级平台的杆长、静铰夹角、动铰夹角在大约遍历点时才发生变化,从而说明器械杆摆角较小时(0-20°),二级平台固定不进行位姿变换;同时参考图8A、图8C和图E发现,一级平台在约遍历点后,经历了一段平台期,此时一级平台只提供器械杆相对远心点的伸长运动,一级平台坐标系中器械杆和一级静平台Z轴的夹角大小不发生变化,证明了程序在初期阶段的正确性。大约在第8×104个遍历点开始,一级平台的数据增大,而此时二级平台的动静夹角已远远超过允许值,其中二级动铰接最大夹角已超过100°,从而该阶段已失去参考性。
通过上述步骤S702,通过遍历运动对各级并联平台运动数据进行计算,从而获取了各级平台的最大参数值,确定了多级并联平台的优化参数,使得在手术过程中各级并联平台的运动不会受到限制,进一步实现了对手术精度的提高。
在其中一些实施例中,第一虚拟轴和第二虚拟轴均通过该远心不动点;其中,该第一虚拟轴为固连在该第一并联平台142中心,且垂直与该第一并联平台142的直线;该第二虚拟轴为固连在该第二并联平台144中心,且垂直与该第二并联平台144的直线。并且,该第一虚拟轴和该第二虚拟轴处于同一平面内。通过上述实施例,通过对各级虚拟轴的位置限定,确定了远心不动点的约束条件,从而避免了各级并联平台之间发生扭矩。
需要说明的是,在上述流程中或者附图的流程图中示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。而且,上述流程中或者附图的流程图中的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
在本实施例中,提供了一种多级并联手术机械臂,图9为根据本申请实施例的多级并联手术机械臂的结构框图,如图9所示,该多级并联手术机械臂包括控制系统、第一并联平台142、第二并联平台144和执行组件12,该执行组件12包括执行杆124和手术器具126;该执行组件12与该第一并联平台142连接,该第一并联平台142与该第二并联平台144连接;该控制系统用于上述实施例中的任意一种多级并联手术机械臂的控制方法。
通过上述实施例,采用了多级并联平台应用在手术机械臂上,从而大大增加了执行杆124的摆动角度,解决了手术机械臂的工作空间范围较小的问题;同时,由于双级并联平台机构是一个冗余机构,所以在求解的时候会有很多组解,通过控制系统根据执行杆124上远心不动点坐标和末端,实时反解计算多级并联平台的位姿,从而能够在多组解中寻找到一个最佳的路径,实现了对多级并联手术机械臂的精确控制,并通过该控制系统计算实时确定第一并联平台142的位置偏移量,避免了多级并联平台中动、静平台的坐标偏移造成的反解运算误差,从而解决了多级并联手术机械臂的控制精度较小的问题。
在其中一些实施例中,考虑到第二并联平台144所受载荷大于第一并联平台142,因此设置该第一并联平台142的第一平台半径小于该第二并联平台144的第二平台半径,且该第一并联平台142的第一平台间距小于该第二并联平台144的第二平台间距;其中,动静平台相邻最近铰接点夹角和分布保持不变,则初始设定值如表8所示:
表8双级平台基本尺寸数值
同时,为确定两级平台的相对关系与手术机器人整体尺寸,设定各级平台距离和执行杆124长度,远心点相对执行杆124末端的运动范围;所需范围和尺寸如表9所示。
表9各级平台相对尺寸
在其中一些实施例中,该执行组件12的摆动空间设置为球形工作空间。其中,图10为根据本申请实施例的工作空间的示意图,如图10所示,需求中的工作空间为一锥形空间,该锥形空间的高度如公式50所示:
ls=l′·cosσ 公式50
其中,l’表示锥形空间的母线长度,锥形空间的高度1s表为100mm,σ表示目标空间的最大摆角范围,为75°。
故按照原定目标空间运动时,最大伸长量如公式51所示:
l′=100/cos 75°≈386.37 公式51
为使机构正常运转,器械伸长量的限定要求如公式52所示:
l′min≤l′≤l′max 公式52
其中,初始位置器械末端距远心点100mm,l′min=100;远心点在器械上的允许长度为100mm,故允许最大伸长量为200mm,l′max=200。
由此可见,最大伸长量不满足要求,双级并联平台无法满足工作空间的需求。因此,将双级并联平台饿运动空间设置球形运动空间,如图7所示。
在其中一些实施例中,该第一并联平台142的第一最大偏角,以及该第二并联平台144的第二最大偏角设置均为20°。
另外,结合图1描述的本申请实施例控制方法可以由计算机设备来实现。图8为根据本申请实施例的计算机设备的硬件结构示意图。
计算机设备可以包括处理器112以及存储有计算机程序指令的存储器114。
具体地,上述处理器112可以包括中央处理器(CPU),或者特定集成电路(Application Specific Integrated Circuit,简称为ASIC),或者可以被配置成实施本申请实施例的一个或多个集成电路。
其中,存储器114可以包括用于数据或指令的大容量存储器。举例来说而非限制,存储器114可包括硬盘驱动器(Hard Disk Drive,简称为HDD)、软盘驱动器、固态驱动器(Solid State Drive,简称为SSD)、闪存、光盘、磁光盘、磁带或通用串行总线(UniversalSerial Bus,简称为USB)驱动器或者两个或更多个以上这些的组合。在合适的情况下,存储器114可包括可移除或不可移除(或固定)的介质。在合适的情况下,存储器114可在数据处理装置的内部或外部。在特定实施例中,存储器114是非易失性(Non-Volatile)存储器。在特定实施例中,存储器114包括只读存储器(Read-Only Memory,简称为ROM)和随机存取存储器(RandomAccess Memory,简称为RAM)。在合适的情况下,该ROM可以是掩模编程的ROM、可编程ROM(Programmable Read-Only Memory,简称为PROM)、可擦除PROM(ErasableProgrammable Read-Only Memory,简称为EPROM)、电可擦除PROM(Electrically ErasableProgrammable Read-Only Memory,简称为EEPROM)、电可改写ROM(ElectricallyAlterable Read-Only Memory,简称为EAROM)或闪存(FLASH)或者两个或更多个以上这些的组合。在合适的情况下,该RAM可以是静态随机存取存储器(Static Random-AccessMemory,简称为SRAM)或动态随机存取存储器(Dynamic Random Access Memory,简称为DRAM),其中,DRAM可以是快速页模式动态随机存取存储器(Fast Page Mode DynamicRandom Access Memory,简称为FPMDRAM)、扩展数据输出动态随机存取存储器(ExtendedDate Out Dynamic Random Access Memory,简称为EDODRAM)、同步动态随机存取内存(Synchronous Dynamic Random-Access Memory,简称SDRAM)等。
存储器114可以用来存储或者缓存需要处理和/或通信使用的各种数据文件,以及处理器112所执行的可能的计算机程序指令。
处理器112通过读取并执行存储器114中存储的计算机程序指令,以实现上述实施例中的任意一种多级并联手术机械臂的控制方法。
在其中一些实施例中,计算机设备还可包括通信接口116和总线118。其中,如图11所示,处理器112、存储器114、通信接口116通过总线118连接并完成相互间的通信。
通信接口116用于实现本申请实施例中各模块、装置、单元和/或设备之间的通信。通信端口116还可以实现与其他部件例如:外接设备、图像/数据采集设备、数据库、外部存储以及图像/数据处理工作站等之间进行数据通信。
总线118包括硬件、软件或两者,将计算机设备的部件彼此耦接在一起。总线118包括但不限于以下至少之一:数据总线(Data Bus)、地址总线(Address Bus)、控制总线(Control Bus)、扩展总线(Expansion Bus)、局部总线(Local Bus)。举例来说而非限制,总线118可包括图形加速接口(Accelerated Graphics Port,简称为AGP)或其他图形总线、增强工业标准架构(Extended Industry Standard Architecture,简称为EISA)总线、前端总线(Front Side Bus,简称为FSB)、超传输(Hyper Transport,简称为HT)互连、工业标准架构(Industry Standard Architecture,简称为ISA)总线、无线带宽(InfiniBand)互连、低引脚数(Low Pin Count,简称为LPC)总线、存储器总线、微信道架构(Micro ChannelArchitecture,简称为MCA)总线、外围组件互连(Peripheral Component Interconnect,简称为PCI)总线、PCI-Express(PCI-X)总线、串行高级技术附件(Serial AdvancedTechnology Attachment,简称为SATA)总线、视频电子标准协会局部(Video ElectronicsStandards Association Local Bus,简称为VLB)总线或其他合适的总线或者两个或更多个以上这些的组合。在合适的情况下,总线80可包括一个或多个总线。尽管本申请实施例描述和示出了特定的总线,但本申请考虑任何合适的总线或互连。
该计算机设备可以基于获取到的远心不动点坐标和末端坐标,执行本申请实施例中的控制方法,从而实现结合图1描述的多级并联手术机械臂的控制方法。
另外,结合上述实施例中的多级并联手术机械臂的控制方法,本申请实施例可提供一种计算机可读存储介质来实现。该计算机可读存储介质上存储有计算机程序指令;该计算机程序指令被处理器执行时实现上述实施例中的任意一种控制方法。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。
Claims (18)
1.一种多级并联手术机械臂的控制方法,其特征在于,所述多级并联手术机械臂包括第一并联平台、第二并联平台和执行组件,所述执行组件包括执行杆和手术器具;所述执行组件与所述第一并联平台连接,所述第一并联平台与所述第二并联平台连接;所述方法包括:
获取所述执行杆上的远心不动点坐标,并获取所述手术器具的末端坐标;
根据所述远心不动点坐标和所述末端坐标,确定所述第一并联平台的位置偏移量和第一姿态向量,并确定所述第二并联平台的第二姿态向量;
根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第一指定位姿;
根据所述第一姿态向量和所述第二姿态向量,控制所述第二并联平台移动至第二指定位姿,包括:
在所述手术器具的运动范围小于或等于第一区域的情况下,将所述第二并联平台设置为锁住状态,并控制所述第一并联平台移动至所述第一指定位姿;
在所述运动范围大于所述第一区域,且所述运动范围小于或等于第二区域的情况下,将所述第二并联平台设置为解锁状态,并控制所述第二并联平台移动移动至所述第二指定位姿。
2.根据权利要求1所述的控制方法,其特征在于,所述根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第一指定位姿包括:
根据所述远心不动点坐标和所述末端坐标,获取所述第一并联平台的第一动平台在绝对坐标系下的第一动原点坐标;并根据所述第一动原点坐标获取所述第一并联平台的位置偏移量;
根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,确定第一转换矩阵;
根据所述第一转换矩阵,并根据所述第一并联平台的第一铰接点在所述绝对坐标系下的坐标,计算得到所述第一并联平台的第一伸缩元件长度;
根据所述第一动原点坐标和所述第一伸缩元件长度,控制所述第一动平台移动至所述第一指定位姿。
3.根据权利要求2所述的控制方法,其特征在于,所述根据所述第一动原点坐标获取所述第一并联平台的位置偏移量包括:
根据所述远心不动点坐标、所述末端坐标和所述第一动原点坐标,确定第一比例;
其中,所述第一比例为所述远心不动点坐标到第一静原点坐标的距离相对所述第二姿态向量的比例;所述第一静原点坐标为所述第一并联平台的第一静平台在绝对坐标系下的原点坐标;
根据所述第一比例、所述远心不动点和所述第二姿态向量,确定所述第一静平台的第一静原点坐标;
根据所述第一动原点坐标和所述第一静原点坐标,获取所述位置偏移量。
4.根据权利要求3所述的控制方法,其特征在于,所述根据所述位置偏移量、所述第一姿态向量和所述第二姿态向量,确定第一转换矩阵包括:
根据所述第一姿态向量和所述第二姿态向量,获取第一旋转角度,并获取第二旋转角度;其中,所述第一旋转角度为所述第一并联平台绕第一动坐标系的第一坐标轴旋转的角度,所述第二旋转角度为所述第一并联平台绕所述第一动坐标系的第二坐标轴旋转的角度;
根据所述第一并联平台的位置偏移量、所述第一旋转角度、所述第二旋转角度和所述第二姿态向量,确定所述第一转换矩阵。
5.根据权利要求2所述的控制方法,其特征在于,所述根据所述第一姿态向量和所述第二姿态向量,控制所述第二并联平台移动至第二指定位姿包括:
根据所述远心不动点坐标和所述第二姿态向量,获取所述第二并联平台的第二动平台在绝对坐标系下的第二动原点坐标;
根据所述绝对坐标系的第三坐标轴、所述第二姿态向量和所述第二动原点坐标,确定第二转换矩阵;
根据所述第二转换矩阵,并根据所述第二并联平台的第二铰接点在所述绝对坐标系下的坐标,计算得到所述第二并联平台的第二伸缩元件长度;
根据所述第二动原点坐标和所述第二伸缩元件长度,控制所述第二动平台移动至所述第二指定位姿。
6.根据权利要求5所述的控制方法,其特征在于,所述根据所述远心不动点坐标和所述第二姿态向量,获取所述第二并联平台的第二动平台在绝对坐标系下的第二动原点坐标包括:
根据所述远心不动点坐标、所述末端坐标和所述第一动原点坐标,确定第二比例;其中,所述第二比例为所述远心不动点坐标到第二动原点坐标的距离相对所述第二姿态向量的比例;
根据所述第二比例、所述远心不动点和所述第二姿态向量,确定所述第二动原点坐标。
7.根据权利要求5所述的控制方法,其特征在于,所述根据所述绝对坐标系的第三坐标轴、所述第二姿态向量和所述第二动原点坐标,确定第二转换矩阵包括:
根据所述第三坐标轴和第二姿态向量,获取第三旋转角度,并获取第四旋转角度;其中,所述第三旋转角度为所述第二并联平台绕第二动坐标系的第一坐标轴旋转的角度,所述第四旋转角度为所述第二并联平台绕所述第二动坐标系的第二坐标轴旋转的角度;
根据所述第三旋转角度、所述第四旋转角度和所述第二动原点坐标,确定所述第二转换矩阵。
8.根据权利要求1所述的控制方法,其特征在于,所述控制所述第二并联平台移动至第二指定位姿之后,所述方法还包括:
根据所述第一姿态向量和所述第二姿态向量,控制所述第一并联平台移动至第三指定位姿。
9.根据权利要求8所述的控制方法,其特征在于,所述控制所述第一并联平台移动至第三指定位置之前,所述方法还包括:
根据所述远心不动点坐标和所述末端坐标,控制所述执行杆相对于所述远心不动点的伸长运动。
10.根据权利要求1所述的控制方法,其特征在于,所述方法还包括:
第一虚拟轴和第二虚拟轴均通过所述远心不动点;
其中,所述第一虚拟轴为固连在所述第一并联平台中心,且垂直与所述第一并联平台的直线;所述第二虚拟轴为固连在所述第二并联平台中心,且垂直与所述第二并联平台的直线。
11.根据权利要求10所述的控制方法,其特征在于,所述方法还包括:所述第一虚拟轴和所述第二虚拟轴处于同一平面内。
12.根据权利要求1所述的控制方法,其特征在于,所述方法还包括:
在将所述执行杆的摆动角度由第一阈值遍历至第二阈值的情况下,确定所述第一并联平台和所述第二并联平台的最大参数值。
13.一种多级并联手术机械臂,其特征在于,包括控制系统、第一并联平台、第二并联平台和执行组件,所述执行组件包括执行杆和手术器具;所述执行组件与所述第一并联平台连接,所述第一并联平台与所述第二并联平台连接;所述控制系统用于实现如权利要求1至12中任一项所述的控制方法。
14.根据权利要求13所述的多级并联手术机械臂,其特征在于,所述第一并联平台的第一平台半径小于所述第二并联平台的第二平台半径,且所述第一并联平台的第一平台间距小于所述第二并联平台的第二平台间距。
15.根据权利要求13所述的多级并联手术机械臂,其特征在于,所述执行组件的摆动空间设置为球形工作空间。
16.根据权利要求13所述的多级并联手术机械臂,其特征在于,所述第一并联平台的第一最大偏角,以及所述第二并联平台的第二最大偏角设置为20°。
17.一种计算机设备,包括存储器、处理器以及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至12中任一项所述的控制方法。
18.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1至12中任一项所述的控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011583062.1A CN112894802B (zh) | 2020-12-28 | 2020-12-28 | 多级并联手术机械臂的控制方法及多级并联手术机械臂 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011583062.1A CN112894802B (zh) | 2020-12-28 | 2020-12-28 | 多级并联手术机械臂的控制方法及多级并联手术机械臂 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112894802A CN112894802A (zh) | 2021-06-04 |
CN112894802B true CN112894802B (zh) | 2022-07-01 |
Family
ID=76111814
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011583062.1A Active CN112894802B (zh) | 2020-12-28 | 2020-12-28 | 多级并联手术机械臂的控制方法及多级并联手术机械臂 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112894802B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113545851B (zh) * | 2021-06-11 | 2022-07-29 | 诺创智能医疗科技(杭州)有限公司 | 重建器械术野中心的控制方法、系统、设备和存储介质 |
CN114564050A (zh) * | 2022-03-03 | 2022-05-31 | 瑞龙诺赋(上海)医疗科技有限公司 | 手术平台定位系统、位姿信息确定方法以及装置 |
CN114711966A (zh) * | 2022-03-07 | 2022-07-08 | 诺创智能医疗科技(杭州)有限公司 | 机械臂、机器人、微创手术机器人系统及机械臂的位姿确定方法 |
CN114952806B (zh) * | 2022-06-16 | 2023-10-03 | 法奥意威(苏州)机器人系统有限公司 | 约束运动控制方法、装置、系统和电子设备 |
CN116190975B (zh) * | 2023-01-13 | 2023-10-27 | 中国科学院自动化研究所 | 用于大口径射电望远镜的容错位姿分配方法及系统 |
CN116277007B (zh) * | 2023-03-28 | 2023-12-19 | 北京维卓致远医疗科技发展有限责任公司 | 位姿控制方法、装置、存储介质及控制器 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111214291A (zh) * | 2020-01-23 | 2020-06-02 | 诺创智能医疗科技(杭州)有限公司 | 手术机械臂及手术机器人 |
CN111227943A (zh) * | 2020-01-23 | 2020-06-05 | 诺创智能医疗科技(杭州)有限公司 | 手术机械臂的控制方法、计算机设备及一种手术机械臂 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59194210A (ja) * | 1983-04-18 | 1984-11-05 | Fujitsu Ltd | ロボツトの軌道制御方法 |
WO2017151996A1 (en) * | 2016-03-04 | 2017-09-08 | Covidien Lp | Inverse kinematic control systems for robotic surgical system |
CN107336231B (zh) * | 2017-05-26 | 2020-03-24 | 山东科技大学 | 六自由度并联平台结构参数优化方法 |
CN108015750A (zh) * | 2018-01-15 | 2018-05-11 | 上海联影医疗科技有限公司 | 医用机械臂 |
US11957629B2 (en) * | 2019-02-14 | 2024-04-16 | Stryker Australia Pty Ltd | Systems and methods for assisting surgery |
CN110186661B (zh) * | 2019-05-14 | 2020-06-02 | 燕山大学 | 含up副支链的并联机构的运动学正解求解方法 |
-
2020
- 2020-12-28 CN CN202011583062.1A patent/CN112894802B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111214291A (zh) * | 2020-01-23 | 2020-06-02 | 诺创智能医疗科技(杭州)有限公司 | 手术机械臂及手术机器人 |
CN111227943A (zh) * | 2020-01-23 | 2020-06-05 | 诺创智能医疗科技(杭州)有限公司 | 手术机械臂的控制方法、计算机设备及一种手术机械臂 |
Also Published As
Publication number | Publication date |
---|---|
CN112894802A (zh) | 2021-06-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112894802B (zh) | 多级并联手术机械臂的控制方法及多级并联手术机械臂 | |
WO2021147265A1 (zh) | 手术机械臂的控制方法、计算机设备及一种手术机械臂 | |
Bonev et al. | A geometrical method for computing the constant-orientation workspace of 6-PRRS parallel manipulators | |
CN110370256B (zh) | 机器人及其路径规划方法、装置和控制器 | |
KR20160070006A (ko) | 간섭 회피 방법, 제어 장치 및 프로그램 | |
CN111123943B (zh) | 一种基于伪逆约束的超冗余机器人轨迹规划方法及系统 | |
Dong et al. | Geometric approach for kinematic analysis of a class of 2-DOF rotational parallel manipulators | |
CN115179297A (zh) | 手术机器人位置姿态控制联合避障关节极限的方法及系统 | |
CN115213905B (zh) | 冗余度机械臂位姿控制的方法、系统及机器人 | |
CN111113425B (zh) | 一种有寄生运动的五自由度串并联机器人运动学逆解求解方法 | |
CN112828862B (zh) | 并联平台的主从映射方法、机械臂系统和存储介质 | |
WO2022141138A1 (zh) | 混联主从映射方法、机械臂系统和计算机设备 | |
Bonev et al. | Workspace analysis of 6-PRRS parallel manipulators based on the vertex space concept | |
US20230347516A1 (en) | Master-slave mapping method for parallel platform, robotic arm system and storage medium | |
CN115805587A (zh) | 七轴机器人的运动解析方法、装置及电子设备 | |
Lacombe et al. | Singularity analysis of a kinematically redundant (6+ 2)-DOF parallel mechanism for general configurations | |
Zhang et al. | Preoperative planning for the multi-arm surgical robot using PSO-GP-based performance optimization | |
CN115890749A (zh) | Rcm约束下的内窥镜机器人视觉伺服与优化控制方法、系统及机器人 | |
CN112917479A (zh) | 五轴机器人的近似位姿计算方法、装置和存储介质 | |
Yang et al. | Preoperative planning of three axis intersection surgical laparoscopic arm system based on characteristic parameters | |
Lim et al. | Kinematic analysis and design optimization of a cable-driven universal joint module | |
Bian et al. | A class of spatial remote center-of-motion mechanisms and its forward kinematics | |
CN117428791B (zh) | 一种用于肩部四轴康复机器人的逆运动学求解方法及系统 | |
CN116673966B (zh) | 用于机器人的关节角度生成方法及机器人系统 | |
CN114290331B (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 |