CN115081147B - 用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法 - Google Patents
用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法 Download PDFInfo
- Publication number
- CN115081147B CN115081147B CN202210850604.XA CN202210850604A CN115081147B CN 115081147 B CN115081147 B CN 115081147B CN 202210850604 A CN202210850604 A CN 202210850604A CN 115081147 B CN115081147 B CN 115081147B
- Authority
- CN
- China
- Prior art keywords
- surgical tool
- axis
- unbiased
- transformation matrix
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/10—Geometric CAD
- G06F30/17—Mechanical parametric or variational design
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Geometry (AREA)
- General Physics & Mathematics (AREA)
- Evolutionary Computation (AREA)
- General Engineering & Computer Science (AREA)
- Computer Hardware Design (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法,将可变接口手术工具夹持器固定于无偏置七轴机械臂末端的第七轴;可变接口手术工具夹持器具有一个手术工具安装轴;手术工具安装轴不平行于无偏置七轴机械臂末端的第七轴的旋转轴;可变接口手术工具夹持器还包括用于夹持手术工具的限位装置;限位装置可让手术工具绕手术工具安装轴旋转若干个角度;根据限位装置让手术工具绕手术工具安装轴旋转不同的角度,可得在该特定角度时的手术工具旋转变换矩阵;基于给定的手术工具目标位姿变换矩阵,获得无偏置七轴机械臂末端坐标变换矩阵。本发明的方法可以扩展无偏置七轴机械臂6DOF瞄准的范围。
Description
技术领域
本发明涉及医学机械人技术领域,特别涉及一种用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法。
背景技术
在骨科机器人手术中,为方便医生操作和为术者提供良好的视野,手术工具大多固定于机械臂末端,手术工具安装轴与机械臂末端关节轴相互垂直。
当前市场上6~7自由度的无偏置机械臂,肩、肘、腕轴的活动角度都不超过正负130°。在机械臂末端手术工具与机械臂末端轴不平行的机器人系统中进行6DOF瞄准时,因为手术工具安装姿态和机械臂关节限位的限制,当手术工具需要进行小幅位姿变化时,机械臂有可能需要进行大幅度的运动,极端情况下可能导致机械臂运动幅度大于机械臂最末端连杆长度的手术工具运动范围;或可能导致机械臂进入奇异姿态,使得机械臂无法将手术工具运动到手术所需的位姿。
现有的解决方案多是对机械臂和患者的体位及摆位进行严格规定,最大限度地避免遇到相关的问题,而没有从根本上对这些缺陷进行处理。
并且,在实际手术应用中,由于在考虑机械臂对视线的遮挡、医生操作的便利性的同时,一定要兼顾机械臂运动路线对周围障碍物及患者非手术部位的规避等重要因素,现有的机械臂操控手术工具瞄准的技术方案有很大的局限性。
发明内容
本发明要解决的技术问题是为了克服现有技术存在的上述缺陷,提供一种用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法。
本发明是通过下述技术方案来解决上述技术问题:
一种用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法,将可变接口手术工具夹持器固定于无偏置七轴机械臂末端的第七轴;可变接口手术工具夹持器具有一个手术工具安装轴;手术工具安装轴不平行于无偏置七轴机械臂末端的第七轴的旋转轴;可变接口手术工具夹持器还包括用于夹持手术工具的限位装置;限位装置可让手术工具绕手术工具安装轴旋转若干个角度;用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法还包括以下步骤:
从可变接口手术工具夹持器获取手术工具安装轴在无偏置七轴机械臂末端第七轴的坐标变换矩阵 ;从可变接口手术工具夹持器上夹持的手术工具,获取手术工具在手术工具安装轴上旋转0°时的坐标变换矩阵 ;限位装置可让手术工具绕手术工具安装轴旋转 度固定,其中,n=0,1,2,...,N-1;N为任意整数。
根据限位装置让手术工具绕手术工具安装轴旋转不同的角度,可得在该特定角度时的手术工具旋转变换矩阵 ,其中n=0,1,2,...,N-1;由此 表示手术工具绕手术工具安装轴旋转 度时的手术工具旋转变换矩阵,其中,n=0,1,2,...,N-1;N为任意整数。
优选方案,N=8。
优选方案,手术工具安装轴垂直于无偏置七轴机械臂末端的第七轴的旋转轴。
本发明的有益效果在于:本发明的方法可以扩展无偏置七轴机械臂6DOF瞄准的范围,通过手术工具在机械臂末端安装时可以调整选择不同的旋转角度,使得安装于无偏置七轴机械臂末端的手术工具有着不同的可选初始位姿,从而使得机械臂可以通过计算获得更多的可选运动路径来使手术工具到达目标位姿,最终实现无偏置七轴机械臂既可以规避自身结构限制或者应用要求造成的各轴角度限制,又可以实现手术工具的6DOF瞄准;而且,本方法相对应的装置结构简单,成本低廉。
附图说明
图1为本发明较佳实施例的结构示意图。
图2为本发明较佳实施例的可变接口手术工具夹持器和无偏置七轴机械臂末端的连接状态示意图。
图3为无偏置七轴机械臂标准DH参数模型示意图。
图4为无偏置七轴机械臂使用状态示意图。
具体实施方式
下面举个较佳实施例,并结合附图来更清楚完整地说明本发明。
如图1、图2所示,一种用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法,将可变接口手术工具夹持器10固定于无偏置七轴机械臂20末端的第七轴27;可变接口手术工具夹持器10具有一个手术工具安装轴11;手术工具安装轴11所在直线垂直于无偏置七轴机械臂末端的第七轴27的旋转轴;可变接口手术工具夹持器10还包括用于夹持手术工具的限位装置12;限位装置12可让手术工具13绕手术工具安装轴11旋转0°、45°、90°、135°、180°、225°、270°和315°八个角度。
如图1所示,无偏置七轴机械臂20具有第一轴21、第二轴22、第三轴23、第四轴24、第五轴25、第六轴26和第七轴27。
如图3所示,无偏置七轴机械臂标准DH参数模型中,X0、Y0、Z0表示机械臂原点坐标系;X1、Y1、Z1表示第一轴的坐标系;X2、Y2、Z2表示第二轴的坐标系,X3、Y3、Z3表示第三轴的坐标系,X4、Y4、Z4表示第四轴的坐标系,X5、Y5、Z5表示第五轴的坐标系,X6、Y6、Z6表示第六轴的坐标系,X7、Y7、Z7表示第七轴的坐标系;d1表示机械臂原点到第二轴22距离;d3表示第二轴22到第四轴24的距离;d5表示第四轴24到第六轴26的距离;d7表示第六轴26到第七轴27的距离。
用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法还包括以下步骤:
S3、根据限位装置让手术工具绕手术工具安装轴旋转的角度,可得手术工具旋转变换矩阵 ,其中,令N=8,则n=0,1,2,3,4,5,6,7;由此 分别表示手术工具绕手术工具安装轴分别旋转0°、45°、90°、135°、180°、225°、270°、315°时的手术工具旋转变换矩阵;
其中,
该式子中,i=1,2,3,4,5,6,7;
cθ为cosθ缩写,sθ为sinθ缩写,θi为机械臂A1~A7各轴的旋转角度,ai、αi、di为DH参数表中的对应值。
采用标准D-H参数模型表示七轴机械臂,七轴机械臂的DH参数表,如下表所示:
七轴机械臂各轴的限位值,如下表所示:
七轴机械臂使用状态示意图,如图4所示。
图4中,An表示七轴机械臂的旋转轴,n为轴的编号,图中n=2,4,6。
dr为七轴机械臂连杆长度,dT为七轴机械臂到手术工具安装轴的距离。
θn为第n轴的旋转角度。T为手术工具位姿,T'为手术工具目标位姿。
如图2所示,当目标位姿与A2轴距离接近d3+d5-(d7+dT)时,七轴机械臂容易受到结构的约束,特别是当目标位姿要求d7+dT所在连杆朝向A2轴时,七轴机械臂因各关节轴的角度限制导致无法到达指定位姿。
接下来将通过一个具体的例子说明本发明的实际作用。
根据七轴机械臂DH参数模型,坐标系i与坐标系i-1的齐次变换矩阵为:
机械臂七轴的齐次变换矩阵为:
ɑ=-π,β=-π/3,γ=-π/2;
X=470.9994, Y=-282.0000,Z=473.9593;
其结果以欧拉角(ZYX)加位置的方式表示为:
ɑ=π/2,β=0,γ=-π2/3
X=648.5346, Y=0,Z=576.4593
将d1=360,d3=420,d5=400,d7=126代入七轴机械臂的DH参数表,对七轴机械臂进行逆运算,在不考虑七轴角度限制的情况下其中一组较优解,如下表所示:
An | A1 | A2 | A3 | A4 | A5 | A6 | A7 |
θ<sub>i</sub> | 0 | 60 | 0 | -20 | 0 | 160 | 90 |
上表中,θi的单位为度。
其中A6轴角度远超±120°的限制。
A1~A7角度验算:
根据七轴机械臂DH参数模型,坐标系i与坐标系i-1的齐次变换矩阵为:
七轴机械臂的齐次变换矩阵为:
将上述A1~A7的七个角度代入上述公式,根据
其中,手术工具旋转变换矩阵Tr,
ɑ=π/2,β=0,γ=-π/6
X=573.4994,Y=0,Z=296.4241。
对七轴机械臂进行逆运算,可得多组满足机械臂角度限制的解,其中一组为:
An | A1 | A2 | A3 | A4 | A5 | A6 | A7 |
θ<sub>i</sub> | 36.573 | 113.875 | 82.643 | 72.943 | -46.750 | -114.578 | 128.984 |
上表中,θi的单位为度。
将上述A1~A7代入
根据
本发明的优点为:本发明的方法可以扩展无偏置七轴机械臂6DOF瞄准的范围,通过手术工具在机械臂末端安装时可以调整选择不同的旋转角度,使得安装于无偏置七轴机械臂末端的手术工具有着不同的可选初始位姿,从而使得机械臂可以通过计算获得更多的可选运动路径来使手术工具到达目标位姿,最终实现无偏置七轴机械臂既可以规避自身结构限制或者应用要求造成的各轴角度限制,又可以实现手术工具的6DOF瞄准;而且,本方法相对应的装置结构简单,成本低廉。
虽然以上描述了本发明的具体实施方式,但是本领域的技术人员应当理解,这仅是举例说明,本发明的保护范围是由所附权利要求书限定的。本领域的技术人员在不背离本发明的原理和实质的前提下,可以对这些实施方式做出多种变更或修改,但这些变更和修改均落入本发明的保护范围。
Claims (5)
1.一种用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法,其特征在于,将可变接口手术工具夹持器固定于无偏置七轴机械臂末端的第七轴;可变接口手术工具夹持器具有一个手术工具安装轴;手术工具安装轴不平行于无偏置七轴机械臂末端的第七轴的旋转轴;可变接口手术工具夹持器还包括用于夹持手术工具的限位装置;限位装置可让手术工具绕手术工具安装轴旋转若干个角度;用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法还包括以下步骤:
4.如权利要求3所述的用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法,其特征在于,N=8。
5.如权利要求1所述的用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法,其特征在于,手术工具安装轴垂直于无偏置七轴机械臂末端的第七轴的旋转轴。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210850604.XA CN115081147B (zh) | 2022-07-20 | 2022-07-20 | 用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210850604.XA CN115081147B (zh) | 2022-07-20 | 2022-07-20 | 用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115081147A CN115081147A (zh) | 2022-09-20 |
CN115081147B true CN115081147B (zh) | 2022-11-11 |
Family
ID=83259274
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210850604.XA Active CN115081147B (zh) | 2022-07-20 | 2022-07-20 | 用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115081147B (zh) |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2845065B1 (en) * | 2012-05-04 | 2019-09-18 | Leoni Cia Cable Systems SAS | Imitation learning method for a multi-axis manipulator |
CN103536364A (zh) * | 2013-10-18 | 2014-01-29 | 江苏艾迪尔医疗科技股份有限公司 | 一种智能骨科系统 |
CN105147393B (zh) * | 2015-08-19 | 2017-06-20 | 哈尔滨工业大学 | 一种微创机器人持镜机械臂 |
CN107066645A (zh) * | 2016-12-01 | 2017-08-18 | 西北工业大学 | 一种七自由度偏置机械臂逆解方法 |
JP7191674B2 (ja) * | 2018-12-21 | 2022-12-19 | 川崎重工業株式会社 | エンドエフェクタとそれを備えたロボット |
CN111618859B (zh) * | 2020-06-03 | 2021-04-13 | 杭州键嘉机器人有限公司 | 一种对于静止或低速工况下机械臂高精度力反馈的方法 |
CN111673717B (zh) * | 2020-06-16 | 2022-07-05 | 东莞市摩克电子科技有限公司 | 仿真多臂机械手 |
CN112353453B (zh) * | 2021-01-12 | 2021-03-26 | 上海龙慧医疗科技有限公司 | 八档髓腔锉冲程保护定向敲击装置 |
CN113070877B (zh) * | 2021-03-24 | 2022-04-15 | 浙江大学 | 一种面向七轴机械臂视觉示教的可变姿态映射方法 |
CN114098961A (zh) * | 2021-12-16 | 2022-03-01 | 南京普爱医疗设备股份有限公司 | 一种标定手术机械臂导向器的工装装置及其工作方法 |
-
2022
- 2022-07-20 CN CN202210850604.XA patent/CN115081147B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN115081147A (zh) | 2022-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107589934B (zh) | 一种关节型机械臂逆运动学解析解的求取方法 | |
WO2023082990A1 (zh) | 一种确定机械臂工作位姿的方法和装置 | |
US10758313B2 (en) | Controlling roll for a device in a computer-assisted medical system | |
CN113715016B (zh) | 一种基于3d视觉的机器人抓取方法、系统、装置及介质 | |
CN110712203A (zh) | 一种7自由度机械臂逆运动学求解算法 | |
CN112716608A (zh) | 用于微创手术机器人的主从跟踪控制方法 | |
Li et al. | A novel constrained tendon-driven serpentine manipulator | |
JP2019155556A (ja) | ロボットの制御装置、ロボット、ロボットシステム、並びに、カメラの校正方法 | |
CN107038275B (zh) | 一种机械臂误差分析方法 | |
CN111546376A (zh) | 一种空间组合机械臂的快速自碰撞检测方法 | |
CN115081147B (zh) | 用于扩展无偏置七轴机械臂末端手术工具瞄准范围的方法 | |
CN109311155B (zh) | 一种工业机器人的工具坐标系原点的标定方法及装置 | |
CN111113425B (zh) | 一种有寄生运动的五自由度串并联机器人运动学逆解求解方法 | |
CN109366486B (zh) | 柔性机器人逆运动学求解方法、系统、设备、存储介质 | |
CN113070877B (zh) | 一种面向七轴机械臂视觉示教的可变姿态映射方法 | |
US20190125480A1 (en) | Roll control based on pitch and yaw inputs for a device in a computer-assisted medical system | |
Yu et al. | Mobility and singularity analysis of a class of 2-DOF rotational parallel mechanisms using a visual graphic approach | |
CN109866224A (zh) | 一种机器人雅可比矩阵计算方法、装置及存储介质 | |
CN112894752A (zh) | 一种移动加工机器人的寻位方法 | |
Li et al. | Master-slave arm heterogeneous mapping with link pose constraint in teleoperation system | |
CN114952806B (zh) | 约束运动控制方法、装置、系统和电子设备 | |
CN112589800B (zh) | 桌面机械臂标定方法及装置 | |
Li et al. | Design and kinematics of a novel continuum robot connected by unique offset cross revolute joints | |
CN112917479A (zh) | 五轴机器人的近似位姿计算方法、装置和存储介质 | |
Bulbul Chowdhury et al. | Development of a Self-Decoupled Wire-Driven Robotic Universal Joint Toward Medical Application |
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 |