CN112043395A - 手术器械、从操作设备及手术机器人 - Google Patents
手术器械、从操作设备及手术机器人 Download PDFInfo
- Publication number
- CN112043395A CN112043395A CN202011066540.1A CN202011066540A CN112043395A CN 112043395 A CN112043395 A CN 112043395A CN 202011066540 A CN202011066540 A CN 202011066540A CN 112043395 A CN112043395 A CN 112043395A
- Authority
- CN
- China
- Prior art keywords
- drive
- cable
- decoupling
- cables
- end effector
- 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.)
- Pending
Links
- 239000012636 effector Substances 0.000 claims abstract description 211
- 230000033001 locomotion Effects 0.000 claims abstract description 171
- 230000007246 mechanism Effects 0.000 claims abstract description 55
- 230000007423 decrease Effects 0.000 claims description 19
- 230000003247 decreasing effect Effects 0.000 claims description 15
- 238000010168 coupling process Methods 0.000 abstract description 36
- 238000005859 coupling reaction Methods 0.000 abstract description 36
- 230000008878 coupling Effects 0.000 abstract description 30
- 238000000034 method Methods 0.000 description 41
- 230000008859 change Effects 0.000 description 37
- 230000008569 process Effects 0.000 description 26
- 230000036961 partial effect Effects 0.000 description 18
- 230000002829 reductive effect Effects 0.000 description 14
- 238000004804 winding Methods 0.000 description 10
- 230000005540 biological transmission Effects 0.000 description 8
- 230000000694 effects Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000001514 detection method Methods 0.000 description 5
- 238000002324 minimally invasive surgery Methods 0.000 description 4
- 238000009434 installation Methods 0.000 description 3
- 230000000670 limiting effect Effects 0.000 description 3
- 230000009467 reduction Effects 0.000 description 3
- 238000001356 surgical procedure Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000009987 spinning Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000001154 acute effect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
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
- A61B34/37—Master-slave robots
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B17/00—Surgical instruments, devices or methods, e.g. tourniquets
- A61B17/00234—Surgical instruments, devices or methods, e.g. tourniquets for minimally invasive 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/70—Manipulators specially adapted for use in surgery
- A61B34/71—Manipulators operated by drive cable mechanisms
-
- 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
- A61B34/74—Manipulators with manual electric input means
-
- 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/301—Surgical robots for introducing or steering flexible instruments inserted into the body, e.g. catheters or endoscopes
-
- 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/302—Surgical robots specifically adapted for manipulations within body cavities, e.g. within abdominal or thoracic cavities
-
- 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
- A61B34/71—Manipulators operated by drive cable mechanisms
- A61B2034/715—Cable tensioning mechanisms for removing slack
Landscapes
- Health & Medical Sciences (AREA)
- Engineering & Computer Science (AREA)
- Surgery (AREA)
- Life Sciences & Earth Sciences (AREA)
- Heart & Thoracic Surgery (AREA)
- Biomedical Technology (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Medical Informatics (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Robotics (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种手术器械、应用该手术器械的从操作设备以及具有该从操作设备的手术机器人,其中手术器械包括末端执行器、驱动装置及缆绳,驱动装置被配置为通过该缆绳驱动末端执行器运动,缆绳包括用于驱动末端执行器偏航运动的第一对缆绳和用于驱动末端执行器执行俯仰运动的第二对缆绳,由于末端执行的俯仰运动和偏航运动正交,故第一对缆绳和第二对缆绳存在耦合关系,驱动装置还包括机械的解耦机构,所述解耦机构用于解除该耦合关系,使用机械解除操纵末端执行器俯仰运动的驱动缆绳与操纵末端执行器偏航运动的驱动缆绳之间的耦合关系,能非常精确的解除两者之间的耦合关系,使手术机器人的运行更加稳定。
Description
技术领域
本发明涉及医疗器械领域,特别是涉及一种手术器械以及应用该手术器械的从操作设备以及具有该从操作设备的手术机器人。
背景技术
微创手术是指利用腹腔镜、胸腔镜等现代医疗器械及相关设备在人体腔体内部施行手术的一种手术方式。相比传统手术方式微创手术具有创伤小、疼痛轻、恢复快等优势。
随着科技的进步,微创手术机器人技术逐渐成熟,并被广泛应用。微创手术机器人通常包括主操作控制台及从操作设备,主操作控制台用于根据医生的操作向从操作设备发送控制命令,以控制从操作设备,从操作设备用于响应主操作控制台发送的控制命令,并进行相应的手术操作。
从操作设备上连接有可以与从操作设备可拆卸的手术器械,手术器械包括驱动装置和用于执行手术的末端执行器,驱动装置用于将手术器械连接到从操作设备并接收来自从操作设备的驱动力以驱动末端执行器运动,驱动装置通过驱动缆绳与末端执行器连接,驱动装置通过驱动缆绳来操纵末端执行器的运动。末端执行器一般包括三个自由度的运动,即自转、俯仰运动和偏航运动,有些末端执行器还具有自转运动,其中偏航运动由一组的驱动缆绳控制的,俯仰运动的驱动缆绳是由另外一组的驱动缆绳控制的,由于末端执行器的俯仰运动和偏航运动正交,因此在末端执行器进行俯仰运动时,控制俯仰的驱动缆绳与控制偏航的驱动缆绳之间存在耦合关系,即控制俯仰的驱动缆绳的运动受限制于控制偏航的驱动缆绳,因此需要解除两者之间的这种耦合关系。现有技术采用的是软件解耦的方法,但软件解耦的方法的算法比较复杂,增加了系统控制程序的复杂度,而且软件解耦的方法会在数据采集的时候存在误差,因此不能精确的解除两者之间的耦合关系。
发明内容
基于此,为解决上述问题,本发明提供一种手术器械、应用该手术器械的从操作设备以及具有该从操作设备的手术机器人。
一种手术器械包括末端执行器、驱动装置及缆绳,驱动装置被配置为通过缆绳驱动末端执行器运动,缆绳包括用于驱动缆绳末端执行器执行偏航运动的第一对缆绳和用于驱动末端执行器执行俯仰运动的第二对缆绳,驱动装置包括:
驱动单元,第二对缆绳的一端连接在驱动单元上,驱动单元通过第二缆绳驱动末端执行器执行俯仰运动;
解耦机构,解耦机构包括主解耦件和从解耦件,主解耦件与驱动单元同轴设置,主解耦件用于与驱动单元同轴旋转并驱动从解耦件运动以增加或减少第一对缆绳在驱动装置内的长度,以使驱动单元驱动末端执行器执行俯仰运动。
优选地,上述主解耦件驱动从解耦件沿直线运动以增加或减少第一对缆绳在驱动装置内的长度。
优选地,上述第一对缆绳包括第一驱动缆绳和第二驱动缆绳,第一驱动缆绳和第二驱动缆绳配合驱动末端执行器偏航运动,第二对缆绳包括第三驱动缆绳和第四驱动缆绳,驱动单元旋转收拉第三驱动缆绳和第四驱动缆绳中的一驱动缆绳并释放其中另一驱动缆绳使得第一驱动缆绳和第二驱动缆绳在末端执行器上的长度同时增加或同时减少。
优选地,上述驱动单元和主解耦件沿第一方向旋转的驱动单元释放第三驱动缆绳并收拉第四驱动缆绳使得第一驱动缆绳和第二驱动缆绳在末端执行器上的长度增加,从解耦件在主解耦件的驱动下运动从而减少第一驱动缆绳和第二驱动缆绳在驱动装置内的长度。
优选地,上述驱动单元和主解耦件沿与第一方向相反的第二方向旋转的驱动单元收拉第三驱动缆绳并释放第四驱动缆绳使得第一驱动缆绳和第二驱动缆绳在末端执行器上的长度减少,同时从解耦件在主解耦件的驱动下运动沿增加第一驱动缆绳和第二驱动缆绳在驱动装置内的长度。
优选地,上述从解耦件包括滑架和导向部,导向部安装在滑架的一端,第一对缆绳经过导向部的导向后延伸到末端执行器,主解耦件与滑架连接并驱动滑架移动以改变第一对缆绳在驱动装置的长度。
优选地,上述从解耦件还包括第一解耦缆绳和第二解耦缆绳,主解耦件通过第一解耦缆绳和第二解耦缆绳与滑架相连,主解耦件用于通过第一解耦缆绳和第二解耦缆绳驱动滑架运动以改变第一对缆绳在驱动装置内的长度。
优选地,上述主解耦件沿第一方向旋转以释放第一解耦缆绳并收拉第二解耦缆绳使得滑架运动从而减少第一驱动缆绳和第二驱动缆绳在驱动装置内的长度。
优选地,上述主解耦件沿与第一方向相反的第二方向旋转收拉第一解耦缆绳并收拉第二解耦缆绳使得滑架沿减少第一驱动缆绳和第二驱动缆绳在驱动装置内的长度的方向移动。
优选地,上述驱动装置还包括第一导向轮,第一缆绳经过第一导向轮导向后再经过导向部后延伸到末端执行器,第一对缆绳在第一导向轮和导向部之间的部分与滑架运动的方向平行。
优选地,驱动单元和主解耦件同时旋转使得第一驱动缆绳或第三驱动缆绳在末端执行器上的长度变化量等于滑架在主解耦件的驱动下移动的距离的两倍。
优选地,上述驱动装置还包括第二导向轮,第一缆绳经过第一导向轮导向后再经过第二导向轮的导向后延伸到末端执行器,第一导向轮的轴与导向部的轴相互垂直。
优选地,上述驱动装置还包括第三导向轮和第四导向轮,第一解耦缆绳和第二解耦缆绳分别经过第三导向轮和第四导向轮的导向后连接到滑架,第一解耦缆绳在第三导向轮与滑架之间的部分以及第二解耦缆绳在第四导向轮与滑架之间的部分都与滑架运动的方向平行。
优选地,上述主解耦件具有凸轮结构,主解耦件用于旋转而带动凸轮结构抵触滑架从而驱动滑架运动。
优选地,上述主解耦件具有主动齿轮部,从解耦件具有与主动齿轮啮合的从动齿轮部,主解耦件用于旋转使主动齿轮部带动从动齿轮部运动从而驱动从解耦件运动。
一种从操作设备包括机械臂和如上述手术器械,手术器械安装在机械臂上,机械臂用于操纵手术器械运动。
一种手术机器人包括主操作控制台和上述从操作设备,从操作设备根据主操作控制台的指令执行相应操作。
本发明的手术器械使用机械结构解除操纵末端执行器俯仰运动的驱动缆绳与操纵末端执行器偏航运动的驱动缆绳之间的耦合关系,能非常精确可控地解除两者之间的耦合关系,使用机械解耦能减少了整个手术机器人的程序算法,使手术机器人的运行更加稳定。
附图说明
图1为本发明一实施例的手术机器人的从操作设备的结构示意图;
图2为本发明一实施例的手术机器人的主操作控制台的结构示意图;
图3为本发明一实施例的从操作设备的机械臂的结构示意图;
图4为本发明一实施例的手术器械的结构示意图;
图5A-5D为本发明一实施例的末端执行器的结构示意图;
图5E为本发明一实施例的驱动缆绳在长轴内的结构示意图;
图6A为本发明一实施例的末端执行器的第一支撑架的立体图;
图6B为本发明一实施例的末端执行器的第一支撑架的俯视图;
图6C为本发明另一实施例的末端执行器的第一支撑架的俯视图;
图7A-7C为本发明一实施例的末端执行器的俯仰状态下的示意图;
图8A为本发明一实施例的末端执行器的立体图;
图8B为图8A所示的末端执行器的爆炸图;
图8C为图8A中第二支架的俯视图;
图8D为图8A所示的末端执行器的俯仰状态示意图;
图8E为图8A所示的末端执行器的俯仰和偏航状态示意图;
图9A为本发明一实施例的驱动装置的示意图;
图9B和9C为图9A所示的驱动装置中的第一驱动缆绳和第二驱动缆绳在导向轮上绕线的局部示意图;
图9D-9E为图9A的驱动装置的解耦过程示意图;
图10A为本发明一实施例的驱动装置的示意图;
图10B为图10A所示的驱动装置的解耦过程示意图;
图11A为本发明一实施例的驱动装置的示意图;
图11B为图11A所示的驱动装置的解耦过程示意图;
图12A为本发明一实施例的驱动装置的立体图;
图12B为图12A的驱动装置的俯视图;
图12C为图12A所示的驱动装置的从解耦件与安装座立体图;
图12D为图12C所示的从解耦件与安装座的爆炸图;
图12E为图12A所示驱动装置的滑架的立体图;
图12F为图12A所示驱动装置的解耦过程的示意图。
图13A为本发明一实施例的驱动装置的立体图;
图13B为本发明图13A的俯视图;
图13C为图13A所示的实施例中的解耦机构和安装座的爆炸图;
图13D为图13A所示的实施例中的主解耦件的俯视图;
图13E为图13A所示的实施例的解耦过程示意图;
图14A为本发明一实施例的驱动装置的立体图;
图14B为图14A的驱动装置的俯视图;
图14C为图14A所示的安装座与从解耦件的爆炸图;
图14D为第一解耦滑块的立体图;
图14E为图14B所示的驱动装置的解耦过程示意图;
图15为本发明一实施例的驱动装置示意图;
图16A为用于图8A所示的实施例的驱动装置示意图;
图16B为图16A所示的驱动装置的解耦过程示意图。
具体实施方式
为了便于理解本发明,下面将参照相关附图对本发明进行更全面的描述。附图中给出了本发明的较佳实施方式。但是,本发明可以以许多不同的形式来实现,并不限于本文所描述的实施方式。相反地,提供这些实施方式的目的是使对本发明的公开内容理解的更加透彻全面。
需要说明的是,当元件被称为“设置于”另一个元件,它可以直接在另一个元件上或者也可以存在居中的元件。当一个元件被认为是“连接”另一个元件,它可以是直接连接到另一个元件或者可能同时存在居中元件。当一个元件被认为是“耦合”另一个元件,表明至少一个元件的变化会受另一个元件的限制,“解耦”即解除耦合关系,表明具有耦合关系的两个元件不再具有耦合关系,一个元件的变化不再受另一元件的限制。本文所使用的术语“垂直的”、“水平的”、“左”、“右”以及类似的表述只是为了说明的目的,并不表示是唯一的实施方式。本文所使用的术语“远端”、“近端”作为方位词,该方位词为介入医疗器械领域惯用术语,其中“远端”表示手术过程中远离操作者的一端,“近端”表示手术过程中靠近操作者的一端。
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施方式的目的,不是旨在于限制本发明。本文所使用的术语“和/或”包括一个或多个相关的所列项目的任意的和所有的组合。
微创手术机器人一般包括从操作设备和主操作控制台,图1所示为本发明一实施例的从操作设备100,图2为本发明一实施例的主操作控制台200,外科医生在主操作控制台200上进行对从操作设备100的相关控制操作,从操作设备100根据主操作控制台200的输入指令执行对人体的外科手术。主操作控制台200和从操作设备100可以置于一个手术室内,也可以置于不同的房间,甚至主操作控制台200和从操作设备100可以相距很远,例如主操作控制台200和从操作设备100分别位于不同的城市,主操作控制台200与从操作设备100可以通过有线的方式进行数据的传输,也可以通过无线方式进行数据的传输,例如主操作控制台200与从操作设备100位于一个手术室内,两者之间通过有线的方式进行数据的传输,又如主操作控制台200与从操作设备100分别在不同的城市,两者之间通过5G无线信号进行远距离数据传输。
如图1所示,从操作设备100包括多个机械臂110,每个机械臂110包括多个关节和一个持械臂130,多个关节联动以实现持械臂130的多个自由度的运动,持械臂130上安装有用于执行外科手术的手术器械120,手术器械120穿过固定在持械臂130远端的套管针140进入人体体内,机械臂110用于操纵手术器械120运动以执行手术。手术器械120可拆卸地安装在持械臂130上,从而可以随时更换不同类型的手术器械120或取下手术器械120以对手术器械120进行冲洗或消毒。如图3所示,持械臂130包括持械臂本体131和器械安装架132,器械安装架132用于安装手术器械120,器械安装架132可以在持械臂本体131上滑动,进而带动手术器械120沿持械臂本体131前进或退出。
如图4所示,手术器械120包括分别位于手术器械120近端的驱动装置170和远端的末端执行器150,以及位于驱动装置170和末端执行器150之间的长轴160,驱动装置170用于与持械臂130的器械安装架132相连接,器械安装架132内具有多个致动器(图未示出),多个致动器与驱动装置170进行接合,以将致动器的驱动力传输给驱动装置170。长轴160用于连接驱动装置170和末端器械150,长轴160是中空的,供驱动缆绳穿过,驱动装置170通过驱动缆绳操纵的末端执行器150的运动,以使末端执行器150执行相关手术操作。
图5A-图5D为本发明一实施例的末端执行器150的结构示意图,如图5A所示末端执行器150包括第一支架210和第二支架220,第一支架210的远端包括第一支柱314和第二支柱315,第一支架210的近端包括底架316,底架316的一端与长轴160相连接,从底架316的另一端朝末端执行器150的远端延伸形成第一支柱314和第二支柱315,第一支柱314、第二支柱315以及底架316形成大致U型夹的结构。
在第一支柱314与第二支柱315之间设置有第一销311和第二销312,第一销311一端固定连接在第一支柱314上,其另一端固定连接在第二支柱315上,同样的,第二销312的一端固定连接在第一支柱314上,其另一端固定连接在第二支柱315上,第二销312与第一销311并排地设置在第一支柱314和第二支柱315上,其中第一销311比第二销312更靠近第一支架210的底架316。
为更好的展示末端执行器150的近端的结构,在图5B和图5C中没有显示第一支架210,如图5B和图5C所示,第一销311上设置有第一滑轮组,第一滑轮组包括依次设置在第一销311上的第一滑轮211、第二滑轮212、第三滑轮213和第四滑轮214,第二销312上设置有第二滑轮组,第二滑轮组包括依次设置在第二销312上的第五滑轮215、第六滑轮216、第七滑轮217以及第八滑轮218,第一滑轮211至第八滑轮218都是用于引导驱动缆绳,由于用于引导驱动缆绳的滑轮都设置在第一支架上210,第二支架220上没有滑轮,因此第二支架220的体积可以制造的更小,使得末端执行器150的体积更小,并且不会存在滑轮脱落的风险。
第二支架210上设置有第三支柱317、第四支柱318以及俯仰轮319,从俯仰轮319上沿末端执行器150的远端延伸形成第三支柱317和第四支柱318,第三支柱317、第四支柱318以及俯仰轮319构成大致U型架的形状,第二支架220的俯仰轮319安装在第二销312上,第二支架220可以围绕经过第二销312的轴线的AA’旋转以实现末端执行器150的俯仰运动。
第二支架220的第三支柱317和第四支柱318之间设置有第三销313,第三销313一端固定连接在第三支柱317另一端固定连接在第四支柱318上,第三销313与第一销311、第二销312相互垂直。末端执行器150的夹持部包括第一夹持部230和第二夹持部240,第一夹持部230和第二夹持部240通过第三销313可转动地设置在第二支架220上,第一夹持部230和第二夹持部240可以围绕经过第三销313的轴线BB’旋转,以实现末端执行器150的开合和/或偏航运动,第一夹持部230和第二夹持部240可以是用于夹持组织的钳夹,或用于缝合的吻合器、或者用于电烧灼的烧灼器等。
如图5A-5D所示,图5A和5B所示中的方向标识是为了更方便描述驱动缆绳在末端执行器150上的绕线方式,标识中的远端和近端是指末端执行器150的远端和近端方向,前、后、左、右是指在图5A和5B是视角下末端执行器150的前部方向、后部方向、左部方向以及右部方向,其他如图虽然没有方向标识,但能根据图5A和5B较容易的推导出末端器械执行器150方向,设置在末端执行器150的驱动缆绳包括用于操纵末端执行器150开合和/或偏航运动第一对缆绳和第二对缆绳,用于操纵末端执行器150俯仰运动第三对缆绳,第一对缆绳包括第一驱动缆绳151A和第二驱动缆绳151B,其中第一驱动缆绳151A和第二驱动缆绳151B的一端可以是连在一起也可以是分开的,对于第二对缆绳和第三对缆绳是如此。第二对缆绳包括第三驱动缆绳152A和第四驱动缆绳152B,第三对缆绳包括第五驱动缆绳153A以及第六驱动缆绳153B。如图5E所示,每条驱动缆绳都包括3段,以第一驱动缆绳151A为例,第一驱动缆绳151A包括用于连接到驱动装置内的第一段缆绳151A1,用于连接到末端执行器的第二段缆绳151A2,第一段缆绳151A1和第二段缆绳151A2之间使用刚性的条形件151A3相连接,这样的结构相比使用整条驱动缆绳传输效率更高,而且也容易产生多条驱动缆绳在长轴160内交缠的情况。可以理解的是,在其他的一些实施例中,驱动缆绳也可以一条完整而未分段的缆绳。
在末端执行器150一侧上,第一对缆绳在第一滑轮组和第二滑轮组上的绕线方式与第二对缆绳在第一滑轮组和第二滑轮组上的绕线方式相反,第一对缆绳的第一驱动缆绳151A在第一滑轮组和第二滑轮组上的绕线方式与第二驱动缆绳151B在第一滑轮组和第二滑轮组上的绕线方式相同,第二对缆绳的第三驱动缆绳152A在第一滑轮组和第二滑轮组上的绕线方式相同与第四驱动缆绳152B在第一滑轮组和第二滑轮组上的绕线方式相同。具体地,第一驱动缆绳151A的近端连接到驱动装置170内的驱动单元上,第一驱动缆绳151A的远端经过第一滑轮211的前部的导向后朝末端执行器150的远端延伸,并经过第五滑轮215的后部后导向后继续沿末端器械150的远端延伸并最后固定在第一夹持部230上。第二驱动缆绳151B经过第四滑轮214的前部导向后朝末端执行器150的远端延伸,并经过第八滑轮218的后部导向后继续朝末端执行器150的远端延伸并最后固定在第一夹持部230上。第三驱动缆绳152A的远端经过第二滑轮212后部的导向后朝末端执行器150的远端延伸,并经过第六滑轮216的前部导向后继续朝末端器械150的远端延伸并固定在第二夹持部240上,第四驱动缆绳152B的远端经过第三滑轮213的后部导向后朝末端执行器150的远端延伸,并经过第七滑轮217的前部导向后继续朝末端器械150的远端延伸并过渡在第二夹持部240上。
第一驱动缆绳151A和第二驱动缆绳151B一起驱动第一夹持部230围绕轴线BB’旋转,第三驱动缆绳152A和第四驱动缆绳152B一起驱动第二夹持部240围绕轴线BB’旋转,进而第一驱动缆绳151A、第二驱动缆绳151B、第三驱动缆绳152A以及第四驱动缆绳152B一起驱动第一夹持部230和第二夹持部240执行开合和/或偏航运动。
第三对缆绳的第五驱动缆绳153A和第六驱动缆绳153B的近端到驱动装置170,两者的远端被容纳在俯仰轮319的环形槽内,两者的末端分别固定在第二支架220内,第五驱动缆绳153A和第六驱动缆绳153B一起驱动第二支架220沿轴线AA’旋转,进而第二支架220带动第一夹持部230和第二夹持部240一起沿轴线AA’进行俯仰运动。
本发明末端执行器150的结构和驱动缆绳的绕线方式都和现有的末端执行器不同,现有的末端执行器的第一滑轮组设置在末端执行器的第一支架上,第二滑轮组设置在第二支架上,第二滑轮组跟随第二支架的一起进行俯仰运动。另外本发明驱动缆绳的绕线方式也与现有技术不同,本发明的驱动缆绳经过上述的绕线方式后,如图5A-5D所示,第一对缆绳的第一驱动缆绳151A在第五滑轮215与第一夹持部230之间存在第一部分缆绳151Aa,第一对缆绳的第二驱动缆绳151B在第八滑轮218与第一夹持部230之间存在第二部分缆绳151Ba,第二对缆绳的第三驱动缆绳152A在第六滑轮216与第二夹持部240之间存在第三部分缆绳152Aa,第二对缆绳的第四驱动缆绳152B在第七滑轮217与第一夹持部240之间存在第四部分缆绳152Ba,其中,无论末端执行器150如何俯仰运动,第一部分缆绳151Aa与第二部分缆绳151Ba始终位于平面M的同侧,第三部分缆绳152Aa与第四部分缆绳152Ba始终位于平面M的另一侧的同侧,平面M为经过第二销312的轴线AA’并垂直第三销313的轴线BB’的平面。第一部分缆绳151Aa与第二部分缆绳151Ba始终位于平面M的同侧,第三部分缆绳152Aa与第四部分缆绳152Ba始终位于平面M的另一侧的同侧,使得第一对缆绳和第二对缆绳在末端执行器150上的绕线比较简单、工整,装配时也较容易。
如图5C、5D所示,第一驱动缆绳151A和第二驱动缆绳151B从第一支架210(图5C和图5D中为便于展示驱动缆绳未显示第一支架210)分别到第一滑轮211和第四滑轮214之间具有第五部分缆绳151Ab和第六部分缆绳151Bb,第三驱动缆绳152A和第四驱动缆绳151B从第一支架210分别到第二滑轮212和第三滑轮213之间具有第七部分缆绳152Ab和第八部分缆绳152Bb,第五部分缆绳151Ab和第六部分缆绳151Bb都位于平面P的同侧,平面P是指同时经过第一销311的轴线和第二销312的轴线平面,第七部分缆绳152Ab和第八部分缆绳152Bb都位于平面P的另一侧的同侧。
如图6A和6B所述,第一支架210的底架316上具有多个用于为驱动缆绳穿过的通孔,多个通孔包括用于为第一驱动缆绳151A的第五部分缆绳151Ab的通过第一通孔219a,用于第二驱动缆绳151B的第六部分缆绳151Bb通过的第二通孔219b,用于第三驱动缆绳152A的七部分缆绳152Ab通过的第三通孔219c、用于第四驱动缆绳152B的第八部分缆绳152Bb通过的第四通孔219d、用于第五驱动缆绳153A通过的第五通孔219e以及用于第六驱动缆绳153B通过的第六通孔219f。为了使第一驱动缆绳151A和第二驱动缆绳151B、第三驱动缆绳152A和第四驱动缆绳152B在末端执行器150俯仰运动时能同时进行相同的变化(例如长度同时增加或减少),第一通孔219a和第二通孔219b位于平面P的同一侧,第三通孔219c和第四通孔位于平面P的另一侧,而且即经过第一通孔219a又经过第二通孔219b的圆心的直线与即经过第三通孔219c的圆心又经过第四通孔219d的圆心的直线平行,由于存在这种平行关系,可以使得驱动缆绳能穿过第一支架210的底架316上的通孔笔直延伸至第一滑轮组,从而使驱动缆绳驱动效率比较高。
如图6B所示,第一通孔219a、第二通孔219b、第三通孔219c以及第四通孔219d分别位于梯形的四个顶点上,使得第一驱动缆绳151A和第二驱动缆绳151B分别通过外侧的第一滑轮211和第四滑轮214,第三驱动缆绳152A和第四驱动缆绳152B分别通过位于内侧的第二滑轮212和第三滑轮213,为了使在驱动末端执行器150俯仰运动时第五驱动缆绳153A和第六驱动缆绳153B的驱动力损失较小,第五通孔219e和第六通孔219f都位于第一通孔219a、第二通孔219b、第三通孔219c、第四通孔219d组成的梯形的外部。
另一实施例如图6C所示位于第一支架310中的第一通孔319a第二通孔319b、第三通孔319c以及第四通孔319d分别位于平行四边形的四个顶点上,第五通孔319e和第六通孔319f都位于第一通孔319a、第二通孔319b、第三通孔319c、第四通孔319d组成的平行四边形的外部。
现有技术的第一驱动缆绳的第五部分缆绳和第二驱动缆绳的六部分缆绳分别位于平面P的异侧,第三驱动缆绳的七部分缆绳和第四驱动缆绳的第八部分缆绳也分别位于平面P的异侧,反映在第一支架上的供驱动缆绳通过的通孔分布上则供第一对缆绳的第一驱动缆绳和第二驱动缆绳通过的两通孔分别位于平面P的异侧,供第二对缆绳的第三驱动缆绳和第四驱动缆绳通过的两通孔也分别位于平面P的异侧。由于本发明的末端执行器和现有的末端执行器存在整个结构和绕线方式的不同,使得本发明的末端执行器相对于现有技术更安全,驱动缆绳和滑轮相对现有技术不容易脱落,末端器械的装配也更加容易,整个末端器械的体积也更小。虽然本发明的末端器械相对于现有技术存在上述优点,但本发明的末端器械也带来了新的挑战,即现有的末端执行器的驱动装置无法驱动本发明的末端执行器,更具体地,现有的末端执行的驱动装置使用的解耦第三对缆绳和第一对缆绳、第二对缆绳的耦合关系的方法不再适用本发明的末端执行器。
以下详细说明末端器械150的第三对缆绳和第一对缆绳和/或第二对缆绳之间的耦合关系,如图5所示,第一部分缆绳151Aa、第二部分缆绳151Ba、第三部分缆绳152Aa以及第四部分缆绳152Ba分别离开第五滑轮215、第八滑轮218、第六滑轮216和第七滑轮217的切点都为位于平面a上,平面a为经过第一轴线AA’并垂直上述平面P的平面。
当欲使末端执行器150执行俯仰运动时,则需驱动装置170收拉第三对缆绳的第五驱动缆绳153A或第六驱动缆绳153B,使得第二支架220带动第一夹持部230和第二夹持部240一起围绕第一轴线AA’俯仰运动,如图7A和7B所示,驱动装置170收拉第六驱动缆绳153B,使得第二支架220以及第一夹持部230和第二夹持部240围绕第一轴线AA’俯仰运动,若末端执行器150只执行俯仰运动,则需要维持第一部分缆绳151Aa、第二部分缆绳151Ba、第三部分缆绳152Aa以及第四部分缆绳153Ba的长度恒定不变,否则会引起末端执行器150的偏航或开合运动。
在末端执行器150从图5A-5D所示的笔直状态旋转到图7A-7B所示的俯仰状态的过程中,在驱动装置170收拉第六驱动缆绳153B时,假若末端执行器150需要转过的目标俯仰角度是α,则平面a需要从图5D中的位置也旋转α角度到图7A的平面b的位置,假若第一滑轮组和第二滑轮组的半径均为r1,为了使末端执行器150成功旋转目标的俯仰角度α,此时必须使得第一驱动缆绳151A和第二驱动缆绳151B分别在第五滑轮215和第八滑轮218上的包角长度同时增加长度L,其中L=α*r1,而相应的第三驱动缆绳152A和第四驱动缆绳152B分别在在第六滑轮216和第七滑轮217上的包角长度同时减少了长度L。而如图8A所示,在驱动装置170内,第一驱动缆绳151A和第二驱动缆绳151B以相反方向绕在可旋转的第一驱动单元171上,第三驱动缆绳152A和第四驱动缆绳152B以相反方向绕在可旋转的第二驱动单元172上,而第一驱动单元171和第二驱动单元172是旋转地固定在其旋转轴线上的,故第一驱动单元171和第二驱动单元172是无法平移的,因此仅依靠旋转第一驱动单元171无法使得第一驱动缆绳151A和第二驱动缆绳151B的长度同时增加或减少,同样地,旋转第二驱动单元172也无法使得第三驱动缆绳152A和第四驱动缆绳152B的长度同时增加或减少,而如上所述,若要成功使末端执行器150的执行俯仰运动又必须要使得第一驱动缆绳151A和第二驱动缆绳151B的在末端执行器150上的长度同时增加或减少,第三驱动缆绳152A和第四驱动缆绳152B的在末端执行器上的长度必须同时减少或增加,故第三对缆绳的运动受限制于第一对缆绳、第二对缆绳。
将这种一个元件的变化受另一个元件的限制的关系称之为耦合关系,即一个元件与另一元件之间存在耦合关系。对于第一对缆绳、第二对缆绳以及第三对缆绳而言这种受限制的关系即可以是第三对缆绳由于受限制于第一对缆绳和/或第二对缆绳,从而导致第三对缆绳完全无法运动,使得末端执行器无法实现俯仰运动,也可以是第三对缆绳由于受限制于第一对缆绳和/或第二对缆绳,从而第一对缆绳、第二对缆绳和第三对缆绳之间的任一条缆绳运动,都会引发其他缆绳不期望的运动,从而导致末端执行器也发生不期望的运动而无法执行期望的操作,例如,当第三对缆绳在操纵末端执行器俯仰运动时,由于第三对缆绳与第一对缆绳和/或第二对缆绳之间存在耦合关系,第三对缆绳的运动会同时导致第一对缆绳和/或第二对缆绳的运动,从而末端执行器在俯仰运动的同时会引起末端执行器的开合和/或偏航运动,导致末端执行器的俯仰运动与开合和/或偏移运动相互影响,末端执行器的俯仰运动与开合和/或偏移运动相互不独立,使得末端执行器150无法正确的执行手术操作。因此需要解除第三对缆绳和第一对缆绳和/或第二对缆绳之间的这种耦合关系,使第三对缆绳的运动不再受限制于第一对缆绳和/或第二对缆绳,两者之间的运动能相互独立、互不干扰或影响,将这种解除第三对缆绳和第一对缆绳和/或第二对缆绳之间这种耦合关系称之为解耦。
本发明另一实施例的末端执行器如图8A、8B所示,本实施例中的末端执行器250为单极烧灼器械,末端执行器250包括第一支架410、第二支架420以及执行部430,第一支架410和第二支架420大致呈U型结构。第一支架410包括底架411以及从底架411上沿末端执行器250的远端延伸的第一支柱412和第二支柱413,底架410的近端用于连接长轴160,第二支架420安装在第一支架410的第一支柱412和第二支柱413之间。第二支架420包括俯仰轮421和从俯仰轮421上沿末端执行器250的远端延伸的第三支柱423和第四支柱424,执行部430安装在第三支柱423和第四支柱424之间,本实施例中执行部430为单极烧灼工具,可以理解的是,在其他的一些实施例中,执行部430也可以是其他的执行工具,例如切刀。
第一支架410的第一支柱412和第二支柱413之间设置有第一销414和第二销415分别设置有用于驱动缆绳导向的第一滑轮组和第二滑轮组,第一滑轮组包括依次设置在第一销414上的第一滑轮441和第二滑轮442,第二滑轮组包括依次设置在第二销415上的第三滑轮443和第四滑轮444,第二支架420的俯仰轮421设置在第二销414上,俯仰轮421能围绕第二销414的轴线AA’旋转以实现末端执行器250的俯仰运动。第二支架420的第三支柱423和第四支柱424之间设置有第三销431,执行部430设置在第三销431上并能围绕第三销431的轴线BB’旋转以实现末端执行器250的偏航运动,第三销431与第一销412、第二销413相互垂直。
用于操纵末端执行器250偏航运动的第一对缆绳包括第一驱动缆绳251A和第二驱动缆绳251B,第一驱动缆绳251A的远端经过第一滑轮441后部导向然后继续延伸经过第三滑轮443的前部导向后继续往末端执行器250的远端延伸并最后固定在执行部430上,第二驱动缆绳251B的远端经过第二滑轮442的后部导向然后继续延伸经过第四滑轮444的前部导向后继续往末端执行器250的远端延伸并最后固定在执行部430上。
用于操纵末端执行器250俯仰运动的第二对缆绳包括第三驱动缆绳252A和第四驱动缆绳252B,俯仰轮241上具有容纳并引导第三驱动缆绳252A和第四驱动缆绳252B的环形槽,第三驱动缆绳252A和第四驱动缆绳252B的远端容纳在俯仰轮421的环形槽中并且末端的都固定在第二支架420内。
如图8B所示,末端执行器250还包括为执行部430提供电力的电缆253,第二滑轮442具有引导电缆253的第一导向凸台442A,第四滑轮444具有引导电缆253的第二导凸台443A,电缆253的远端经过第二滑轮442的第一导向凸台442A和第四滑轮444的第二导向凸台444A后连接与执行部430连接。
执行部430包括电钩432和用于防止电钩和电缆253烧灼到不期望的部位的第一绝缘件433、第二绝缘件434以及第三绝缘件435,电钩432的近端和电缆的253的远端在第一绝缘件433内相连接,第二绝缘件434连接在第一绝缘件433的远端,电钩432的端部固定在第二绝缘件434内,电缆253的远端收容在第三绝缘件435内并延伸进入第一绝缘件433内与电钩432的近端相连。
如图8C所示,第一支架410的底架上具有分别用于为第一驱动缆绳251A和第二驱动缆绳251B通过的第一通孔411a和第二通孔411b,用于为第三驱动缆绳252A和第四驱动缆绳252B通过的第三通孔411c和第四通孔411d,以及用于为电缆253第五通孔411e,和上一实施例类似,第一通孔441a和第二通孔411b位于通过第一销414和第二销415的轴线的平面P同侧,第三通孔411c和的第四通孔411d位于该平面P的异侧,第三通孔411c和的第四通孔411d位于该平面P的同侧从而使得第一对缆绳在末端执行器250上的绕线方式简单,装配容易。
如图8D所示,当末端执行器250的驱动装置收拉第四驱动缆绳252B并释放第三驱动缆绳252A时,末端执行器250执行如图8D所示的俯仰运动,当收拉第四驱动缆绳252B的同时收拉第一驱动缆绳251A并释放第二驱动缆绳251B时,末端执行器250执行如图8E所示俯仰同时偏航运动,和前一个实施例一样,用于操纵末端执行器250俯仰运动的第二对缆绳和用于操纵末端执行器250偏航运动的第一对缆绳也存在耦合关系,即第三驱动缆绳252A和四驱动缆绳252B的运动受第一驱动缆绳251A和第三驱动缆绳251B的限制。
对于如何解除上述两个实施例中驱动缆绳之间的耦合关系,以图5A所示的实施例中的末端执行器为例,一种现有的解耦方法是使用软件算法进行解耦,主操作控制台200控制第三驱动单元驱动第三对缆绳运动的同时,也控制第一驱动单元和第二驱动单元驱动第一对缆绳和第二对缆绳运动,以使第一对缆绳和第二对缆绳随第三对缆绳的运动在滑轮上的包角长度增加或减少,但这种解耦方法需要使末端执行器上的第一对缆绳的第一部分缆绳151Aa和第二部分缆绳151Ba分别位于平面M的异侧,第二对缆绳的第三部分缆绳152Aa和第四部分缆绳152Ba也分别位于平面M的异侧,以使第一对缆绳的第一驱动缆绳151A和第二驱动缆绳151B形成一条跨越平面M的回路,第二对缆绳的第三驱动缆绳152A和第四驱动缆绳152B也形成一条跨越平面M的回路,才有可能通过实现通过软件控制驱动单元的运动而实现解耦。然而本发明图5A所示的实施例的末端执行器上的第一对缆绳的第一部分缆绳151Aa和第二部分缆绳151Ba位于平面M的同侧,第二对缆绳的第三部分缆绳153Aa和第四部分缆绳153Ba也位于平面M的同侧,因此现有的软件解耦方法是无法解耦本发明这种类型的末端执行器的。另外使用软件算法解耦的方法会导致手术机器人的控制程序复杂,容易出错,而且这种软件算法解耦的方法会使得手术器械的驱动机构的每个驱动单元失去独立性,具体而言,驱动装置内具有分别驱动三对缆绳的三个驱动单元,理想的状况各驱动单元的控制是彼此对立的,然而当使用软件算法解耦时,需要同时控制上述三个驱动单元一起运动,从而导致三个驱动单元失去了独立性,容易出现控制错误。
本发明提出了机械解耦的方案,在手术器械120的驱动装置170中设置一种机械解耦机构,从而避免上述软件算法解耦的弊端。
如图9A所示为本发明一实施例的驱动装置170的示意图,该驱动装置170适用于驱动图5A所示的末端执行器。驱动装置170包括用于驱动末端执行器150执行开合和/或偏航运动的第一驱动单元171和第二驱动单元172,用于驱动末端执行器150俯仰运动的第三驱动单元173,以及用于驱动长轴160自转运动的第四驱动单元174。第一对缆绳的第一驱动缆绳151A和第二驱动缆绳151B分别以相反的缠绕方式绕在第一驱动单元171上,第二对缆绳的第三驱动缆绳152A和第四驱动缆绳152B分别以相反的缠绕方式绕在第二驱动单元172上,第三对缆绳的第五驱动缆绳153A和第六驱动缆绳153B分别以相反的缠绕方式绕在第三驱动单元173上,第七驱动缆绳154A和第八驱动缆绳154B分别以相反的缠绕方式绕在第四驱动单元174上。
当器械安装架132内的致动器驱动轴171A旋转带动第一驱动单元171随其轴旋转时,第一驱动单元171收拉或释放第一驱动缆绳151A或第二驱动缆绳151B以使第一夹持部230围绕其第三销313旋转,当器械安装架132内的致动器驱动第二驱动单元172随其轴172A旋转时,第二驱动单元172收拉或释放第二驱动缆绳152A或第三驱动缆绳152B以使第二夹持部240围绕第三销313旋转,第一夹持部230与第二夹持部240围绕第三销313运动使得末端执行器150执行开合和/或偏航运动。当器械安装架132内的致动器驱动轴173A旋转带动第三驱动单元173旋转时,第三驱动单元173收拉或者释放第五驱动缆绳153A或第六驱动缆绳153B时以使第二支架220围绕第二销312的轴线AA’旋转从而实现末端执行器150执行俯仰运动。当器械安装架132内的致动器驱动第四驱动单元174随其轴174A旋转时,第四驱动单元174收拉或释放第七驱动缆绳154A或第八驱动缆绳154B实现驱动长轴160的自转运动。
驱动装置170还包括用于解除第三对缆绳与第一对缆绳、第二对缆绳之间在末端执行器150一侧的耦合关系的解耦机构,解耦机构包括主解耦件1761和从解耦件176,从解耦件176包括滑架1762和连接在滑架1762两端的第一导向部1763、第二导向部1764,主解耦件1761通过第一解耦缆绳1767和第二解耦缆绳1768与滑架1762连接,主解耦件1761通过驱动第一解耦缆绳1767和第二解耦缆绳1768进而操纵从解耦件的运动。第一解耦缆绳1767和第二解耦缆绳1768以相反方式绕在主解耦件1761上,主解耦件1761与第三驱动单元173以相同的角速度运动,主解耦件1761与第三驱动单元173可以设置在同一轴173A上,因此主解耦件1761是与第三驱动单元173随轴173A同轴旋转,其他一些实施例中,主解耦件1761与第三驱动单元173也可以分别设置在不同的旋转轴上。主解耦件1761和第三驱动单元173具有不同的半径,主解耦件1761的半径为r2,第三驱动单元173的半径为R2,其中r2<R2,主解耦件1761通过收拉或释放第一解耦缆绳1767或第二解耦缆绳1768实现从解耦件的运动。主解耦件1761与第三驱动单元173可以接收来自相同的动力源驱动,动力源即为上述的从操作设备中的致动器,在其他实施例中主解耦件与第三驱动单元设置在不同的旋转轴上,但主解耦件依然接收所述与第三驱动单元同源的驱动力,例如相同的致动器上通过不同的方式的分别连接并驱动主解耦件和第三驱动单元,使用同一动力源来同时驱动第三驱动单元和主解耦件可以使解耦的控制更加简单,解耦机构不要需要单独再检测耦合状态,主解耦件和耦合源(即第三驱动单元)接收的是相同的控制信息,而在传动侧的结构不同。
如图9A,第一驱动缆绳151A和第二驱动缆绳151B先后通过第三导向轮177A、第一导向部1763以及第三导向轮177C的导向后进入长轴内后一直延伸连接到末端执行器150。第三驱动缆绳152A和第四驱动缆绳152B先后通过第二导向轮177B、第二导向部1764以及第四导向轮177D的导向后进入长轴内后一直延伸连接到末端执行器150。第五驱动缆绳153A和第六驱动缆绳153B分别通过第五导向轮177E和六导向轮177F的导向后进入长轴内后一直延伸连接到末端执行器150,至于第一驱动缆绳151A至第六驱动缆绳153B如何于末端执行器150连接,前面已经详细描述过,这里不再赘述。
解耦过程如图9D所示,当第三驱动单元173随其轴173A沿逆时针(第一方向)旋转时,第三驱动单元173收拉第六驱动缆绳153B并同时释放第五驱动缆绳153A,使得末端执行器150的第二支架220如图7A和7B围绕第二销312的轴线AA’旋转,整个末端执行器150执行俯仰运动。如上所述,此时第一驱动缆绳151A和第二驱动缆绳151B分别在第五滑轮215和第八滑轮218上的包角长度需要同时增加L,与此同时,第三驱动缆绳152A和第四驱动缆绳152B在第六滑轮216和第七滑轮217上的包角长度需要同时减少L才能使末端执行器150顺利地执行俯仰运动。由于解耦机构的主解耦件1761与第三驱动单元173同轴173旋转,因此在第三驱动单元173随轴173A逆时针旋转的同时,主解耦件1761也同样随轴173A逆时针旋转,此时主解耦件1761收拉第一解耦缆绳1767并同时释放第二解耦缆绳1768,假如主解耦件1761转过的弧长为L/2,则从解耦件在第一解耦缆绳1767的拉动下沿A方向运动L/2距离,此时由于从解耦件的运动,使得第一驱动缆绳151A和第二驱动缆绳151B在驱动装置170内的长度将同时减少L,即第一对缆绳在驱动装置170内的长度减少2L,相应地,第三驱动缆绳152A和第四驱动缆绳152B在驱动装置170内的长度将同时增加L,即第二对缆绳在驱动装置170内的长度增加2L。
由此第一驱动缆绳151A和第二驱动缆绳151B在驱动装置170内的长度减少量与第一驱动缆绳151A和第二驱动缆绳151B分别在第五滑轮215和第八滑轮218上包角长度需要的增加量相等,第三驱动缆绳152A和第四驱动缆绳152B在驱动装置170内的长度增加量与第三驱动缆绳152A和第四驱动缆绳152B在第六滑轮216和第七滑轮217上的包角长度需要的减少量相等。相反地,如图9E所示,当第三驱动单元173和主解耦件1761一起顺时针(第二方向)旋转时,第一驱动缆绳151A和第二驱动缆绳151B在驱动装置170内的长度增加量与第一驱动缆绳151A和第二驱动缆绳151B分别在第五滑轮215和第八滑轮218上包角长度需要的减少量相等,第三驱动缆绳152A和第四驱动缆绳152B在驱动装置170内的长度减少量与第三驱动缆绳152A和第四驱动缆绳152B在第六滑轮216和第七滑轮217上的包角长度需要的增加量相等。由此第一对缆绳和第二缆绳在因末端执行器俯仰运动而引起的在末端执行器一侧上长度变化量全部由第一对缆绳和第二缆绳在驱动装置内的长度变化提供,因此第三对缆绳的运动将不再受第一对缆绳、第二对缆绳的限制,解耦机构实现了解除第三对缆绳与第一对缆绳、第二对缆绳之间的耦合关系。
为了使在解耦机构能精确可控地解除第一对缆绳与第二对缆绳、第三对缆绳之间的耦合关系,解耦机构的主解耦件1761驱动从解耦件176始终沿直线运动,并且使得从解耦件176运动引起的第一驱动缆绳151A、第二驱动缆绳151B、第三驱动缆绳152A以及第四缆绳152B的长度变化始终是线性的。如9A-9C所示,第一解耦缆绳1767通过第七导向轮1765重新定向后沿从解耦件176的运动方向固定到从解耦件176一端,同样地,第二解耦缆绳1768通过第八导向轮1766重新定向后沿从解耦件176的运动方向固定到从解耦件176的另一端,因此主解耦件1761的运动将使得从解耦件176沿直线运动。并且第一解耦缆绳1767在第七导向轮1765与从解耦件176之间的部分以及第二解耦缆绳1768在第八导向轮1766与从解耦件176之间的部分都与从解耦件176的运动方向平行,在解耦的过程中,第一解耦缆绳1767和第二解耦缆绳1768的长度改变速度与主解耦件1761的旋转线速度成正比例关系,因此,从解耦件176的运动速度与主解耦件1761和第三驱动单元173的旋转线速度也成正比例关系,从而使解耦过程精确可控。
如图9B-9C所示,第一导向轮177A、第一导向部1763以及第三导向轮177C都是具有并排的两个滑轮的结构,两个滑轮分别用于引导第一驱动缆绳151A和第二驱动缆绳151B,第一驱动缆绳151A在第三导向轮177C和第一导向部1763之间形成有第一解耦部分缆绳151Ac,在第一导向部1763和第一导向轮177A之间形成有第三解耦部分缆绳151Ad,第二驱动缆绳151B在第三导向轮177C和第一导向部1763之间形成有第二解耦部分缆绳151Bc,在第一导向部1763和第一导向轮177A形成有第四解耦部分缆绳151Bd,同样的,第二导向部1764、第二导向轮177B以及第四导向轮177D也都是具有并排两个滑轮的结构,第三驱动缆绳152A和第四驱动缆绳152B分别在第四导向轮177D和第二导向部1764之间具有第五解耦部分缆绳152Ac和第六解耦部分缆绳152Bc,在第二导向部1764和第三导向轮177B之间具有第七解耦部分缆绳152Ad和第八解耦部分缆绳(图9A中被第七解耦部分缆绳152Ad遮挡不可见),为使能更精确的解耦,需要在解耦过程中使第一解耦部分缆绳151Ac的长度变化量与第二解耦部分缆绳151Bc的长度变化量相等,因此第一解耦部分缆绳151Ac和第二解耦部分缆绳151Bc分别与经过第三导向轮177C中心处且垂直第三导向轮177C的轴线c1的平面形成大小相等的夹角θ,第五解耦部分缆绳152Ac和第七解耦部分缆绳152Bc与第七导向轮177D也具有相同的设置,这样可以使得在解耦过程中第一解耦部分缆绳151Ac和第二解耦部分缆绳151Bc的长度变化量相同,第五解耦部分缆绳152Ac和第七解耦部分缆绳152Bc的长度变化量相同。另外由于θ比较小使得第一解耦部分缆绳151Ac和第二解耦部分缆绳151Bc与第一导向轮1764和第四导向轮177B的轴间距H1大致相等,在解耦过程中,第一解耦部分缆绳151Ac和第二解耦部分缆绳151Bc与从解耦件运动方向大致平行,从而使得由于第一解耦部分缆绳151Ac和第二解耦部分缆绳151Bc引起的解耦过程中第一解耦部分缆绳151Ac和第二解耦部分缆绳151Bc非线性变化较小,实现更精确的解耦。
如图9C所示,第三解耦部分缆绳151Ad、第四解耦部分缆绳151Bd、第七解耦部分缆绳152Ad以及第八解耦部分缆绳与从解耦件176运动方向平行,这样可以使得在解耦过程中由于从解耦件运动引起的第三解耦部分缆绳151Ad、第四解耦部分缆绳151Bd、第七解耦部分缆绳152Ad以及第八解耦部分缆绳的长度的变化的速度与从解耦件176运动的速度成正比例关系,故在解耦过程中,第一驱动缆绳151A至第四驱动缆绳152B中的任一条驱动缆绳在驱动装置170内的长度变化速度与从解耦件176的移动速度成正比例关系,由上所述,从解耦件176的移动速度与主解耦件1761及第三驱动单元173的旋转线速度成正比例关系。故在解耦过程中,第一驱动缆绳151A至第四驱动缆绳152B中的任一条驱动缆绳在驱动装置170内的长度变化速度与主解耦件1761及第三驱动单元173的旋转线速度也成正比例关系,从而通过主解耦件173及第三驱动单元173精确控制第一对缆绳和第二对缆绳在末端执行器150上的长度变化量,实现精确可控地解耦。
如图9D所示为本实施例的解耦过程,相对于9A所示的状态,主解耦件1761逆时针旋转L/2弧长,从解耦件176相应地沿A方向运动L/2距离,第一解耦部分缆绳151Ac、第三解耦部分缆绳151Ad、第二解耦部分缆绳151Bc以及第四解耦部分缆绳151Bd的长度同时减少L/2,从而第一驱动缆绳151A和第二驱动缆绳151B同时在驱动装置170内同时减少长度L,即第一对缆绳在驱动装置内长度减少2L。同样的,第五解耦部分缆绳152Ac、第六解耦部分缆绳152Ad、第七解耦部分缆绳152Bc以及第八解耦部分缆绳的长度同时增加L/2,从而第三驱动缆绳152A和第四驱动缆绳152B同时在驱动装置170内同时增加长度L,即第二对缆绳在驱动装置内的长度增加2L。
再次回到图7A,若本实施例中第二滑轮组的半径都为r1,第二支架220的俯仰轮319上用于容纳并引导第五驱动缆绳153A和第六驱动缆绳153B的环形槽319A的槽底半径为R1,当末端执行器150俯仰运动时,第五驱动缆绳153A或第六驱动缆绳153B的能在该环形槽中形成包角。当末端执行器150从图5D所示的零位状态旋转到图7A所示状态的过程中,若末端执行器150俯仰的角度为α时,第五驱动缆绳153A在俯仰轮319上的环形槽319A中的包角长度增加了L1,第六驱动缆绳153B在俯仰轮319上的环形槽319A中的包角长度同时减少了L1,其中L1=α*R1,由于末端执行器150的俯仰运动是由驱动装置170内的第三驱动单元173驱动的,如图9D所示,此时假若第三驱动单元173为使末端执行器150俯仰运动的角度为α沿逆时针(第一方向)所转过的角度为β,第三驱动单元173释放第五驱动缆绳153A并同时收拉第六驱动缆绳153B,使得第五驱动缆绳153A绕在第三驱动单元173上的长度减少了L1,第六驱动缆绳153B绕在第三驱动单元173的长度增加了L1,其中L1=β*R2。由于主解耦件1761和第三驱动单元173同轴旋转,此时相应地,主解耦件1761释放第一解耦缆绳1767并同时收拉第二解耦缆绳1768,使得第一解耦缆绳1767绕在主解耦件1761上的长度减少了L/2,即第一解耦缆绳1767被释放了L/2,第二解耦缆绳1768绕在主解耦件1761上的长度增加了L/2,其中L/2=β*r2,从而滑架1762沿A方向移动了L/2距离,使第一驱动缆绳151A和第二驱动缆绳151B在驱动装置170内长度都分别减少L,第三驱动缆绳152A和第四驱动缆绳152B在驱动装置170内的长度都分别增加L,由前面所述可知,L=α*r1。综上所述,通过以上四个式子:L1=α*R1,L1=β*R2,L/2=β*r2,L=α*r1可以得到以下关系:
上述关系式表明第三驱动单元173的半径与主解耦件1761的半径之比为俯仰轮319的的环形槽319A的槽底半径与第二滑轮组半径之比的2倍,引起该2倍的关系是因为从解耦件具有2个导向部,即第一导向部1763和第二导向部1764。在其他实施例中,从解耦件176的导向部个数也可以为其他数量,从而第三驱动单元的半径与主解耦件的半径之比和俯仰轮的半径与第二滑轮组半径之比的关系也与之发生变化,例如从解耦件可以具有N个导向部,第三驱动单元的半径与主解耦件的半径之比为俯仰轮的环形槽的槽底半径与第二滑轮组半径之比的N倍,即:但是从解耦件的导向部个数的增加相应的从解耦件的体积也相应的增加,比较优选的是上述实施例中从解耦件使用2个导向部。可以理解的是,上述驱动单元的半径和主解耦件的半径都是指驱动缆绳或解耦缆绳绕在其上面的部分的半径,例如绞盘的半径,滑轮的半径是指滑轮的槽底半径,以次方能计算驱动缆绳绕在滑轮上的包角长度,尽管在不同的文献中对滑轮的半径有着不同的解释(例如底槽半径、槽底半径),但发明中的滑轮半径都是用来衡量驱动缆绳绕在滑轮上的包角长度的参数。
由此末端执行器150俯仰运动所需要第一对缆绳、第二对缆绳在末端执行器150一侧的长度变化量全部由解耦机构176引起第一对缆绳、第二对缆绳在驱动装置170内长度变化量准确提供,使得第三对缆绳的运动不再受第一对缆绳、第二对缆绳的限制,实现第三对缆绳和第一对缆绳、第二对缆绳之间的精确解耦。在整个解耦过程中可以始终维持第一部分缆绳151Aa、第二部分缆绳151Ba、第三部分缆绳152Aa以及第四部分缆绳153Ba的长度都是恒定不变的,整个第一对缆绳、第二对缆绳的张紧度也始终维持不变,而且由于整个解耦过程中,只有第三驱动单元173的轴173A运动,第一驱动单元171和第二驱动单元172与第三驱动单元173完全独立。另外,由于主解耦件1761与与引起耦合关系的耦合源即第三驱动单元173同轴旋转运动,从而主解耦件1761与耦合源第三驱动单元173同角速度运动,两者物理上完全同步运动,不要需要主操作设置给与信号控制解耦机构,解耦机构的运动与耦合源的运动同步运转,解耦机构同步第三驱动单元进行解耦,没有任何延迟,而且由耦合源第三驱动单元173引起的第一对缆绳和第二对缆绳在末端执行器150一侧的长度变化量,可以完全地、精确地映射到第一对缆绳和第二对缆绳在解耦机构176上的长度变化量,从而解耦机构176可以完全地、精确地解除掉第三对缆绳与第一对缆绳、第二对缆绳之间的耦合关系,所谓精确地解耦是指第三驱动单元旋转多少度,从解耦件则会移动多少距离,两者之间的关系是确定的,上述各半径比例等式已经给出。另外,由于从解耦件176始终是被主解耦件1761驱动而移动到相应位置,而不是由第一对缆绳或第二对缆绳带动的,整个解耦过程中第一对缆绳和第二对缆绳在从解耦件上基本上是不受力的,故第一对缆绳和第二对缆绳在解耦过程中的张力基本不变,增加了第一对缆绳和第二对缆绳的使用寿命与对末端执行器150控制的精确度。
图10A和10B示出了本发明的另一实施例的驱动装置270,驱动装置270B包括第一驱动单元271、第二驱动单元272、第三驱动单元273、第三驱动单元274以及解耦机构276,第一驱动单元271随其轴271A旋转时,第一驱动单元271收拉或释放第一驱动缆绳151A或第二驱动缆绳151B以使第一夹持部230围绕第三销313旋转,当器械安装架132内的致动器驱动第二驱动单元272随其轴272A旋转时,第二驱动单元272收拉或释放第二驱动缆绳152A或第三驱动缆绳152B以使第二夹持部240围绕第三销313旋转,第一夹持部230与第二夹持部240围绕第三销313运动使得末端执行器150执行开合和/或偏航运动。当器械安装架132内的致动器驱动第三驱动单元273随其轴273A旋转时,第三驱动单元173收拉或者释放第五驱动缆绳153A或第六驱动缆绳153B时以使第二支架220围绕第二销的轴线AA’旋转从而实现末端执行器150执行俯仰运动。
解耦机构276包括主解耦件2761和从解耦件,主解耦件2761为与第三驱动单元273同轴旋转的齿轮,从解耦件包括齿条2762和连接在齿条2762两端的第一导向部2763和导向部第二导向部2764,第一驱动缆绳151A和第二驱动缆绳151B通过从解耦件的第一导向部2763后进入长轴160内,第二驱动缆绳152A和第二驱动缆绳152B通过从解耦件的第二导向部2764后进入长轴160内。
如图10B所示,当第三驱动单元273和主解耦件273一起随轴273A逆时针旋转时,第三驱动单元273收拉第六驱动缆绳153B同时释放第五驱动缆绳153A,末端执行器150如图7A、7B所示执行俯仰运动,与此同时,如果主解耦件2761逆时针转过的弧长为L/2,从解耦件在主解耦件2761驱动下沿A方向运动的长度也为L/2,第一驱动缆绳151A和第二驱动缆绳151B在第一导向部2763和第一导向轮277A之间的长度、以及在第一导向部2763和第三导向轮277C之间的长度都同时减少L/2,第三驱动缆绳152A和第四驱动缆绳152B在第二导向部2764和第二导向轮277B之间的长度、以及在第二导向部2764和第四导向轮277D之间的长度同时增加L/2,从而第一驱动缆绳151A和第二驱动缆绳151B在驱动装置270内的长度整体减少L,第三驱动缆绳152A和第四驱动缆绳152B在驱动装置270内的长度整体增加L。由此驱动装置270内的解耦机构276提供了末端执行器150俯仰运动所需要的第一驱动缆绳151A至第四驱动缆绳152B在末端执行器150一侧的长度的变化量,从而解除了第三对缆绳与第一对缆绳、第二对缆绳之间的耦合关系,第三对缆绳的运动不再受第一对缆绳和/或第二对缆绳的限制。
图11A、11B示出了本发明的另一实施例的驱动装置370,驱动装置270B包括第一驱动单元371、第二驱动单元372、第三驱动单元373、第四驱动单元374以及解耦机构376,除解耦机构376结构与两个实施例不同以外,其他部件与上述两个实施例基本相同,这里不再赘述。解耦机构376包括与第三驱动单元373同轴旋转的主解耦件3761,与主解耦件3761固定连接或一体成型的解耦凸轮3762,解耦凸轮3762两端分别连接由第一导向部3763和第二导向部3764。
如图11B所示,当主解耦件3761与第三驱动单元373一起随轴373A逆时针旋转时,第三驱动单元373收拉第六驱动缆绳153B并同时释放第五驱动缆绳153A,末端执行器150如图7A-7C所示执行俯仰运动,与此同时,解耦凸轮3762在主解耦件3761的驱驶下也随轴373A逆时针旋转,从而使得第一驱动缆绳151A和第二驱动缆绳151B在第一导向轮377A和第三导向轮377C之间的长度减少了L,同时第三驱动缆绳152A和第四驱动缆绳152B在第二导向轮377B和第四导向轮377D之间的长度增加了L,因此驱动装置370内的解耦机构376可以提供末端执行器150因俯仰运动所需要的第一驱动缆绳151A至第四驱动缆绳152B在末端执行器150一侧的长度变化量,从而解除了第三对缆绳与第一对缆绳、第二对缆绳之间的耦合关系,第三对缆绳的运动不再受第一对缆绳和/或第二对缆绳的限制。
图12A-12F示出了本发明另一实施例的驱动装置,驱动装置470包括本体478,本体478上设置有第一驱动单元471、第二驱动单元472、第三驱动单元473和第四驱动单元474,长轴160通过轴承与本体478连接,解耦机构476包括主解耦件4761和从解耦件4762,主解耦件4761和第三驱动单元473都连接在轴476A上,主解耦件4761与第三驱动单元473一起随轴473A同轴旋转,主解耦件4761设置在第三驱动单元473的下部,即主解耦件4761比第三驱动单元473更靠近驱动装置的远端。从解耦件4762包括滑架4765和设置在滑架4765两端的第一导向部4763和第二导向部4764,滑架4765滑动地连接在安装座477上,安装座477固定安装在本体478上,安装座477上设置有与滑架4765配合的第一引导轮476A、第二引导轮476B、第三引导轮476C以及第四引导轮476D,第一引导轮476A、第二引导轮476B、第三引导轮476C以及第四引导轮476D形成一个供滑架4765在其中滑动的滑动区域,由此滑架4765可以被限制在安装座477上的滑动区域内滑动。
第一驱动缆绳151A和第二驱动缆绳151B以相反绕线方式绕在第一驱动单元471上,第一驱动缆绳151A和第二驱动缆绳151B经过设置在安装座477第一导向轮477A的导向再经过设置在滑架4765上的第一导向部4763的导向然后经过设置在安装座477上的第三导向轮477C的导向后进入长轴160内,并一直沿长轴160远端延伸最后固定到末端执行器150上的第一夹持部230上。第三驱动缆绳152A和第四驱动缆绳152B以相反绕线方式绕在第二驱动单元472上,第三驱动缆绳152A和第四驱动缆绳152B经过设置在安装座上的第二导向轮477B的导向后再经过设置再滑架4765上的第二导向部4764的导向然后经过设置在安装座477上的第四导向轮477D的导向后进入长轴160内,并一直沿长轴160远端延伸最后固定到末端执行器150的第二夹持部240上。五驱动缆绳153A和第六驱动缆绳153B经过第五导向轮477E的导向后进入长轴160内,并一直沿长轴160的远端延伸最后固定到第二支架220上。绕在第四驱动单元474上的第七驱动缆绳154A和第八驱动缆绳154B的另一端绕在长轴160的近端,和上面的几个实施例一样,第三对缆绳和第一对缆绳、第二对缆绳在末端执行器一侧同样存在着耦合关系。
安装座477包括第一凸台4771,安装座477通过第一凸台4771固定到本体478上,第一凸台4771上设置有第二凸台4772、第三凸台4773以及第四凸台4774。第二凸台4772上具有第一安装孔4791和第二安装孔4792,第二引导轮476B和第三引导轮476C分别通过第二安装孔4792和第一安装孔4791安装到第二凸台4772上。第三凸台4773上具有第三安装孔4793和第四安装孔4794,第一导向轮477A和第二导向轮477B分别通过第三安装孔4793和第四安装孔4794安装到第三凸台4773。第四凸台4774上具有第五安装孔4795,第一引导轮476A和位于第一引导轮4796A下方的第六导向轮4769通过同一根轴安装到第六安装孔4796中,第六导向轮4796用于为第一解耦缆绳4767和第二解耦缆绳4768导向。第五凸台4775上具有第七安装孔4797,第四引导轮476D通过第九安装孔4799安装到第五凸台4775上。为了保持第一引导轮476A和第四引导轮476D安装到安装座477上后可以位于同一高度,第四凸台4774和第五凸台4775具有一定的高度差,该高度差大致等于第六导向轮4769的高度。
安装座477上还具有第一安装柱4776和第二安装柱4777,第一安装柱4776上和第二安装柱4777斜对着设置,第一安装柱4776和第二安装柱4777上设置有第六安装孔4796和第七安装孔4797,第五导向轮477E通过第六安装孔4796安装到第一安装柱4776和第二安装柱4777上,用于防止第五驱动缆绳153A和第六驱动缆绳153B从第五导向轮477E中脱离的限位销477F通过第七安装孔4797安装到第一安装柱4776和第二安装柱4777上,第一安装柱4776上和第二安装柱4777斜对着设置可以使得第五导向轮477E能引导从斜向方向上过来的驱动缆绳。
第一安装柱4776和第二安装柱4777与第三凸台4773之间具有安装槽4798和过线孔4775,第三导向轮477C和第四导向轮477D通过安装槽4795安装到安装座477上,过线孔4775位于安装槽4798为安装到安装座477上的第三导向轮477C和第四导向轮477D之间,过线孔4775与长轴160联通用于将驱动缆绳引导入长轴160内。
如图12C和图12E所示,从解耦件4762的滑架4765两侧设有第一滑轨4766A和第二滑轨4766B,滑架4765连接到安装座477后,第一滑轨4766A和第二滑轨4766B可以在第一引导轮476A、第二引导轮476B、第三引导轮476C以及第四引导轮476D形成的滑动区域内滑动,第一滑轨4766A滑动设置在对齐的第二引导轮476B和第三引导轮476C上,第二滑轨滑动设置在对齐的第一引导轮476A和第四引导轮476D上。滑架4765的两端分别具有第一安装空间4767和第二安装空间4768,第一导向部4763和第二导向部4764分别安装到第一安装空间4767和第二安装空间4768内。滑架4765还具有中心开口4781,中心开口4781用于容纳第一安装柱4776、第二安装柱4777以及第三凸台4773,并和第一安装柱4776、第二安装柱4777以及第三凸台4773配合以限制滑架4765在安装座477上滑动区域内的滑动行程。
滑架4765一端具有第一引导槽4684和第一固定孔4782,另一端具有第二引导槽4685和第二固定孔4783,第一引导槽4784用于引导第一解耦缆绳4767固定到第一固定孔4782中,第二引导槽4785用于引导第二解耦缆绳4768固定到第二固定孔4783中。第一引导槽4684和第二引导槽4685在滑架4765的高度方向相互错开,以使第一解耦缆绳4767和第二解耦缆绳4768能不相互干涉的固定到滑架4765上。
本实施例的解耦过程如图12F所示,当第三驱动单元473随轴473A受致动器驱动逆时针(第一方向)旋转时,由于主解耦件4761和第三驱动单元473通过同一轴473A连接到致动器,此时主解耦件4761与第三驱动单元473以相同角速度随轴473A逆时针旋转,第三驱动单元473收拉第六驱动缆绳153B并同时释放第五驱动缆绳153A,使得末端执行器150执行如图7A和7B所示的俯仰运动,与此同时,主解耦件4761收拉第二解耦缆绳4768并同时释放第一解耦缆绳4767,从而使得从解耦件4762沿图12F所示A方向运动,若图12F中的从解耦件4762相对于图11B中的从解耦件4762所在的零位状态沿A方向运动了距离L/2,则第一驱动缆绳151A和第二驱动缆绳151B在第一导向部4763和第一导向轮477A之间的长度,以及在第一导向部4763和第三导向轮477C之间的长度都同时减少了L/2,从而使得第一驱动缆绳151A和第二驱动缆绳在驱动装置470内的长度减少L,第一对缆绳在驱动装置内长度减少2L。相应地,第三驱动缆绳152A和第四驱动缆绳152B在第二导向部4764和第二导向轮477B之间的长度,以及在第二导向部4764和第四导向轮477D之间的长度都同时增加了L/2,从而使得第三驱动缆绳152A和第四驱动缆绳152B分别在驱动装置内的长度增加了L,第一对缆绳在驱动装置内的长度增加了2L。由此驱动装置370内的解耦机构276提供了末端执行器150俯仰运动所需要的第一驱动缆绳151A、第二驱动缆绳151B、第三驱动缆绳152A以及四驱动缆绳152B在末端执行器150一侧的长度的变化量,从而解除了第三对缆绳和第一对缆绳、第二对缆绳的耦合关系,第三对缆绳的运动不再受第一对缆绳、第二对缆绳的限制,从而使得末端执行器150能顺利的执行俯仰操作。
当第三驱动单元473和主解耦件4761沿与第一方向相反的第二方向(顺时针)旋转时,使得第一驱动缆绳151A和第二驱动缆绳在驱动装置470内的长度增加L,第三驱动缆绳152A和第四驱动缆绳152B分别在驱动装置内的长度减少了L,具体过程和上述沿第一方向旋转刚刚相反,此处不再赘述。
图13A-13E是本发明的一实施例的驱动装置570,驱动装置570上设置有第一驱动装置570包括本体578,和设置在本体778上的第一驱动单元571、第二驱动单元572、第三驱动单元573以及第四驱动单元774,第一驱动缆绳151A和第二驱动缆绳151B的近端以相反方式缠绕在第一驱动单元571,第三驱动缆绳152A和第四驱动缆绳152B的近端以相反方式缠绕在第二驱动单元572,第五驱动缆绳153A和第六驱动缆绳153B的近端以相反方式缠绕在第三驱动单元573。
为更好的展示主解耦件5761与从解耦件5762之间的关系,图13B未显示出第三驱动单元,如图13B所示,驱动装置570还包括安装座577和设置在安装座577上的解耦机构,解耦机构包括主解耦件5761和从解耦件5762,主解耦件5761和第三驱动单元5762设置在同一旋转轴573A,主解耦件5761为与第三驱动单元5762同角速度旋转的凸轮,从解耦件5762包括滑架5765和安装在滑架5765上的第一导向部5763和第二导向部5764,和上一实施例类似地,驱动装置570还包括设置安装座577上的第一导向轮576A、第二导向轮576B、第三导向轮576C以及第四导向轮576D。第一导向轮576A的旋转轴线与第一导向部5763的旋转轴线平行,第四导向轮576D的旋转轴线与第一导向轮576A的旋转轴线、第一导向部5763的旋转轴线垂直。第二导向轮576B的旋转轴线与第二导向部5764的旋转轴线平行,第三导向轮576C的旋转轴线与第二导向轮576B的旋转轴线、第二导向部5764的旋转轴线垂直。第一驱动缆绳151A和第二驱动缆绳151B经过第一导向轮576A重新定向后再经过从解耦件5762的第一导向部5763的导向后通过第三导向576C导向后离开驱动装置570进入长轴160内,第三驱动缆绳152A和第四驱动缆绳152B经过第一导向轮576A重新定向后经过从解耦件5762后再经过第三导向576C导向后离开驱动装置570进入长轴160内,第五驱动缆绳153A和第六驱动缆绳153B经过第五导向轮576E重定向后进入长轴160内。
如图13C所示,安装座577包括第一凸台5771和第二凸台5772,安装座577通过第一凸台5771安装到主体578上,第一导向轮576A、第二导向轮576B、第三导向轮576C、第四导向轮576D以及第五导向轮576E都安装第二凸台5772上。从解耦件5762包括滑架5765和安装在滑架5765上的第一导向部5763和第二解耦5764,第一导向部5763用于将第一驱动缆绳151A、第二驱动缆绳151B与从解耦件5762相连接,第二导向部5764用于将第三驱动缆绳152A、第四驱动缆绳152B与从解耦件5762相连接。滑架5765包括5766和第二开口5767,第一开口5766用于容纳主解耦件5761,第二开口5767用于容纳安装座577的第二凸台5771,第二凸台5771的侧壁与第二开口5767的侧壁配合限制滑架5765垂直滑动方向的移动。
再回到图13B,滑架5765往第一开口5766内延伸有第一凸体5768和第二凸体5769,主解耦件5761在第一开口5766内与第一凸体5768、第二凸体5769相抵接,第一凸体5768、第二凸体5769能在主解耦件5761旋转时在主解耦件5761的外轮廓上移动,使得滑架5765在安装座577上滑动。如图13D所示,主解耦件5761包括固定在旋转轴573A上的第一凸轮5761A和第二凸轮5761B,第一凸轮5761A和第二凸轮5761B均半心形凸轮,第二凸轮5761B和第一凸轮4761在垂直轴573A的平面上具有相同的外轮廓,第一凸轮5761A在垂直轴573A的平面上的外轮廓包括心形渐开线S1和位于渐开线S1两端的第一圆弧S2以及第二圆弧S3,第一圆弧S2与第二圆弧S3的半径不同,渐开线S1到旋转轴473A的轴心的距离具有从第一圆弧S2开始往第二圆弧S3方向逐渐增加,而且渐开线S1具有如下曲线:即渐开线S1到旋转轴473A的轴线的距离的变化量P与第一凸轮5761A随轴473A旋转的角度θ1之间是线性关系,P=K1*θ1+K2,其中K1和K2为常数,这样使得当主解耦件5761均速转动时,第一凸体5768与第一凸轮5761的渐开线S1的接触点到旋转轴573A的距离及第二凸体5768与第二凸轮的渐开线S1’的接触点到旋转轴573A的距离也匀速线性变化凸体。第一凸轮5761A和第二凸轮5761B一起形成心形的凸轮式主解耦件5761,第一凸轮5761A和第二凸轮5761B在凸轮的轴向上上下错开,第一凸轮5761A与滑架5761的第一凸体5768配合运动,第二凸轮5761B与滑架5761的第二凸体5768配合运动,以实现主解耦件5761驱动从解耦件5762的运动从而解除第一对缆绳与第二对缆绳、第三对缆绳之间的耦合关系。
驱动装置570的解耦过程如图13E所示,第三驱动单元473(图13E未显示)从图13B的零位位置被致动器驱动逆时针(第一方向)旋转至图13E的极限位置的过程中,第三驱动单元473收拉第六驱动缆绳153B并同时释放第五驱动缆绳153A,此时末端执行器150如图7A、7B所示的俯仰运动。由于主解耦件4761与第三驱动单元473设置在同一旋转轴473A上,因此主解耦件4761也逆时针运动,主解耦件4761的第一凸轮4761A逆时针旋转使得第一凸体5768在第一凸轮4761A的渐开线S1上沿渐开线S1上到旋转轴473A的距离增大的方向移动,与之相反地,主解耦件4761的第二凸轮4761B逆时针旋转使得第一凸体5768在第二凸轮4761B的渐开线S1上沿渐开线S1上到旋转轴473A的距离减少的方向移动,由于滑架5765的第二开口5767的内壁与安装座577配合限制滑架5765沿垂直A方向的方向移动,因此,滑架5765被主解耦件4761驱动沿A方向直线运动。
滑架5765上还具有连接第一对缆绳的第一导向部5763,连接第二对缆绳的第二导向部5764,为了使滑架5765在运动引起的第一对缆绳和第二对缆绳在驱动装置内的长度变化是线性的,和图9B、图9C所示的实施例类似地,滑架5765的运动方向与第一对缆绳在第一导向轮576A和第一导向部5763之间的部分平行,滑架5765的运动方向与第二对缆绳在第二导向轮576B和第二导向部5764之间的部分平行。第一驱动缆绳151A和第二驱动缆绳151B在第一导向部5763和第四导向轮576D之间的部分缆绳与沿A方向的直线的夹角相等,同样地,第三驱动缆绳152A和第四驱动缆绳152B在第二导向部5764和第三导向轮576C之间的部分缆绳与沿A方向的直线的夹角相等,若在图13E位置时滑架5765在主解耦件5761的驱动下沿A方向移动了L/2的距离,则第一驱动缆绳151A和第二驱动缆绳151B在第一导向轮576A与第一导向部5763之间的长度减少上述了L/2,在第一导向部5763与第四导向轮576D之间的长度也减少上述了L/2,从而第一驱动缆绳151A和第二驱动缆绳151B在驱动装置570内的长度减少了L,即第一对缆绳在驱动装置570内的长度减少了2L。第三驱动缆绳152A和第四驱动缆绳152B在第二导向轮576B和第二导向部5764之间的长度增加了L/2,在第二导向部5764与第三导向轮576C之间的长度也增加了L/2,从而第三驱动缆绳152A和第四驱动缆绳152B在驱动装置570内的长度增加了L,即第二对缆绳在驱动装置570内的长度增加了2L。由此驱动装置570内的解耦机构提供了末端执行器150俯仰运动所需要的第一驱动缆绳151A、第二驱动缆绳151B、第三驱动缆绳152A以及四驱动缆绳152B在末端执行器150一侧的长度的变化量,从而解除了第三对缆绳和第一对缆绳、第二对缆绳的耦合关系,第三对缆绳的运动不再受第一驱动缆绳、第二驱动缆绳的限制,使得末端执行器150能顺利的执行俯仰操作。
若主解耦件5761继续旋转使得滑架5765移动到极限位置,此时第一凸体5798离开第一凸轮5761A的渐开线S1进入第二圆弧S3,第二凸体5769离开第二凸轮5761B的渐开线S1’进入第一圆弧S2’,而由于第一凸体5798在第一凸轮5761A的第一圆弧S1和第二圆弧S2上移动时第一凸体5798与第一凸轮5761A的接触点到旋转轴573A的距离不再改变,同样地,第二凸体5798在第二凸轮5761B的第一圆弧S1’和第二圆弧S2’上移动时第一凸体5798的与第一凸轮5761A的接触点到旋转轴573A的距离不再改变,因此滑架5765沿A方向不再移动,滑架5765此时处于沿A方向运动的极限位置,因此由于主解耦件5761的存在第一圆弧S1、S1’和第二圆弧S2、S2’使得主解耦件5761旋转到极限位置是仍继续旋转而使滑架继续运动。相反的,当主解耦件5761顺时针旋转时,第一凸轮5761A、第二凸轮5761B以及滑架的运动与主解耦件5761逆时针运动相反,这里不再赘述。
图14A-14E是本发明的一实施例的驱动装置670,驱动装置670包括本体678,及设置在本体678上的第一驱动单元671、第二驱动单元672、第三驱动单元473以及第四驱动单元674,第一驱动单元671上绕有第一对缆绳一端,第一驱动缆绳151A和第二驱动缆绳151B的近端以相反方式缠绕在第一驱动单元671,第三驱动缆绳152A和第四驱动缆绳152B的近端以相反方式缠绕在第二驱动单元672,第五驱动缆绳153A和第六驱动缆绳153B的近端以相反方式缠绕在第三驱动单元673。
驱动装置670还包括安装座677和解耦机构676,安装座677安装在本体678上,解耦机构176安装在安装座677上。解耦机构包括主解耦件6761和从解耦件,主解耦件6761为和第三驱动单元673同轴旋转的齿轮,从解耦件包括传动轮6762和解耦滑块,解耦滑块包括第一解耦滑块6764以及第二解耦滑块6765,第一解耦滑块6764与第二解耦滑块6765是相互分离相互独立运动的,传动轮6762通过第一解耦缆绳6766与第一解耦滑块6764相连,传动轮6762通过第二解耦缆绳6767与第二解耦滑块6765相连,第一解耦滑块6764与第二解耦滑块6765能相对彼此运动,第一解耦滑块6764的运动方向与第二解耦滑块6765的运动方向大于九十度。传动轮6762包括同轴设置的绞盘6762A和传动齿轮6762B,传动齿轮6762B与主解耦件6761通过中间齿轮6763啮合,传动轮6762受主解耦件6761的驱动并通过第一解耦缆绳6766和第二解耦缆绳6767操纵第一解耦滑块6764和第二解耦滑块6765的运动。其他一些实施例中,传动轮6762与主解耦件6761之间也可以不设置中间齿轮6763,传动轮6762与主解耦件6761直接齿轮啮合。
第一驱动缆绳151A和第二驱动缆绳151B经过第一导向轮677A重定向后穿过第一解耦滑块6764后再经过第三导向轮677C导向后进入长轴160内,第三驱动缆绳152A和第四驱动缆绳152B经过二导向轮677B重定向后穿过第二解耦滑块6765导向后再经过第四导向轮677D后进入长轴160内,第五驱动缆绳153A和第六驱动缆绳153B通过第五导向轮677E重定向后直接进入长轴160内。
第一解耦缆绳6766的一端固定在绞盘6762A上,另一端经过第六导向轮6768重定向后连接到第一解耦滑块6764,第二解耦缆绳6767的一端与第一解耦缆绳6776以相反的绕线方式固定在绞盘6762A上,另一端经过第七导向轮6769重定向后连接到第二解耦滑块6765,第一解耦缆绳6766和第二解耦缆绳6764分别操纵第一解耦滑块6764和第二解耦滑块6765在安装座677上滑动以改变第一对缆绳和第二对缆绳在驱动装置670内的长度,从而实现解除第三对缆绳与第一对缆绳、第二对缆绳之间的耦合关系。可以理解的是,在其他的一些实施例中第一解耦缆绳和第二对缆绳也可以通过不经过导向轮连接到第一解耦滑块和第二解耦块,而是采用其他的重定向部件,例如弯曲的导管。
图14C为安装座677与从解耦件的爆炸图,图14C更清楚的展示了从解耦件与安装座477之间的安装关系,安装座477具有第一凸台4771,安装座477通过第一凸台4771安装到本体478上,第一凸台4771上具有第二凸台6772和第三凸台6773,第二凸台6772上具有第一安装孔6781和第二安装孔6782,从解耦件的传动轮6762的旋转轴安装在第一安装孔6781内,中间齿轮6763的旋转轴安装在第二安装孔6782内,传动轮6762通过传动齿轮6762B与中间齿轮6763啮合以接收来自主解耦件6761的驱动力。第三凸台6773上具有第三安装孔6783、第四安装孔6784、第五安装孔6785以及第六安装孔6786,第三安装孔6783用于将第六导向轮6768安装到第三凸台6773上,第四安装孔6784用于第七导向轮6769安装到第三凸台6773上,第五安装孔6785用于将第一导向轮677A安装到第三凸台6773上,第六安装孔6786用于将第二导向轮677B安装到第三凸台6773上。第三凸台6773上还具有第一滑槽6791和第二滑槽6792,第一滑槽6791和第二滑槽6792具有呈锐角的夹角,以减少安装座677所占的体积,第一滑槽6791和第二滑槽6792分别用于收容第一解耦滑块6764和第二解耦滑块6795,第一解耦滑块6764和第二解耦滑块6795可以在第一滑槽6791和第二滑槽6792内滑动。第三凸台6773上还具有第一凸台6775、第二凸台6776以及第三凸台6777,第一凸台6775、第二凸台6776以及第三凸台6777围成一个引导通孔,该引导通孔用于将驱动缆绳引导进入长轴160内,凸台6775与第二凸台6776中间形成有用于安装第五导向轮677E安装槽,第二凸台6776与第三凸台6777之间形成有用于安装第四导向轮677D,第一凸台6775与第三凸台6777之间形成有用于安装第三导向轮677C的安装槽,第三导向轮677C、第四导向轮677D以及第五导向轮677E分别用于引导第一对缆绳、第二对缆绳和第三对缆绳进入引导通孔内。
从解耦件的第一解耦滑块6764包括第一滑块主体6764A和安装在第一滑块主体6764A上的第一导向部6764B以及第一固定件6764C,第一导向部6764B用于引导第一驱动缆绳151A和第二对缆绳151B,第一固定件6764C用于将第一解耦缆绳6766固定到第一解耦滑块6764,以使传动轮6762能通过第一解耦缆绳6766操纵第一解耦滑块6764运动。第二解耦滑块6765包括第二滑块主体6765A和安装在第二滑块主体6765A上的第二导向部6765B以及第二固定件6764C,除第二解耦滑块6765的第九导向轮6764B用于引导第三驱动缆绳152A和第四驱动缆绳152B以及第二固定件用于固定第二解耦缆绳6767外,第二解耦滑块6765和第一解耦滑块6764的解耦基本相同,图14D进一步展示了第一解耦滑块的细节,如图14D所示第一解耦滑块6764的第一滑块主体6764A包括第一凸体6793和与第一凸体6793相对设置的第二凸体6794,第一导向部6764B安装在第一凸体6793和第二凸体6794之间,和上述的实施例一样,第一导向部6764B也是具有并排设置的两个滑轮,两个滑轮分别用于引导第一驱动缆绳151A和第二驱动缆绳151B。第一解耦滑块6764上与的第一凸体6793和第二凸体6794的相对一侧还具有第三凸体6795,第三凸体6795用于安装第一固定件6764C,第一解耦缆绳6766被第一固定件6764C固定在第一固定件6764C与第三凸体6795中间。
本实施例的解耦过程如图14E所示,当第三驱动单元673受致动器驱动随轴673A逆时针旋转时,由于主解耦件6761和第三驱动单元673通过同一轴673A连接到致动器(图14E中主解耦件6761被第三驱动单元673遮挡不可见),此时主解耦件6761与第三驱动单元673以相同角速度随轴473A逆时针(第一方向)旋转,第三驱动单元473收拉第六驱动缆绳153B并同时释放第五驱动缆绳153A,使得末端执行器150执行如图7A和7B所示的俯仰运动,与此同时,主解耦件6761通过与其啮合的中间齿轮6763驱动传动轮6762逆时针旋转,从而从动轮6762释放第一解耦缆绳6767并同时收拉第二解耦缆绳6768,使得第一解耦滑块6764相对图14B所示的零位位置沿A方向运动了距离L/2,同样的,第二解耦滑块6765相对于零位位置沿B方向运动了距离L/2。和前面的实施例类似,第一解耦滑块676的运动方向与第一驱动缆绳151A和第二驱动缆绳151B在第二导向轮677B与第一解耦滑块6764之间的部分缆绳平行,第一驱动缆绳151A和第二驱动缆绳151B在第二导向轮677B与第一解耦滑块6764之间的长度变化量与第一解耦滑块6764的运动距离的变化量呈线性关系,从而第一驱动缆绳151A和第二驱动缆绳151B在第二导向轮677B与第一解耦滑块6764之间的长度减少了L/2,同样的,在第三导向轮677C与第一解耦滑块6764之间的长度同样减少了L/2,使得第一驱动缆绳151A和第二驱动缆绳151B在驱动装置670内的长度减少了L,即第一对缆绳在驱动装置内的长度减少2L。类似地,第三驱动缆绳152A和第四驱动缆绳152B在第一导向轮677A与第二解耦滑块6765之间的部分缆绳与第二解耦滑块6765的运动方向平行,第三驱动缆绳152A和第四驱动缆绳152B在第一导向轮677A与第二解耦滑块6765之间的长度增加了L/2,在第四导向轮677D与第二解耦滑块6765之间的长度同样增加了L/2,使得第三驱动缆绳152A和第四驱动缆绳152B在驱动装置670内的长度增加了L,即第二对驱动缆绳在驱动装置内的长度增加了2L。由此驱动装置670内的解耦机构676提供了末端执行器150俯仰运动所需要的第一驱动缆绳151A、第二驱动缆绳151B、第三驱动缆绳152A以及四驱动缆绳152B在末端执行器150一侧的长度的变化量,从而解除了第三对缆绳和第一对缆绳、第二对缆绳的耦合关系,第三对缆绳的运动不再受第一驱动缆绳、第二驱动缆绳的限制,使得末端执行器150能顺利的执行俯仰操作。
图15是本发明一实施例的驱动装置770,驱动装置770包括的第一驱动单元771、第二驱动单元772、第三驱动单元773以及第四驱动单元774,的第一驱动缆绳151A和第二驱动缆绳151B的近端以相反方式缠绕在第一驱动单元771,第三驱动缆绳152A和第四驱动缆绳152B的近端以相反方式缠绕在第二驱动单元772,第五驱动缆绳153A和第六驱动缆绳153B的近端以相反方式缠绕在第三驱动单元773上。
驱动装置770的解耦机构包括主解耦件7761和从解耦件7762,主解耦件7761用于驱动从解耦件7762运动以解除上述耦合关系。和上面几个实施例不同的是,本实施例中的主解耦件7761不和第三驱动单元773直接连接的,主解耦件7761与第三驱动单元773非同轴设置,主解耦件7761是与第三驱动单元773独立运动的,即主解耦件7761不像前面几个实施例那样是接收来自驱动第三驱动单元773的致动器的驱动力来驱动从解耦件7762,主解耦件7761根据能表征末端执行器150的俯仰装置的俯仰指示信息来驱动从解耦件7762运动。
解耦机构还包括检测单元和控制单元,检测单元包括分别设置在第一驱动缆绳151A、第二驱动缆绳152B、第三驱动缆绳152A、第四驱动缆绳152B上的并用于检测其张力变化的第一张力传感器TS1、第二张力传感器TS2、第三张力传感器TS3、第四张力传感器TS4。第一张力传感器TS1、第二张力传感器TS2、第三张力传感器TS3、第四张力传感器TS4将检测到的张力变化信息传输给控制单元(图未示出),控制单元接收检测单元的信号输入并处理后输出控制信号控制主解耦件7761的运动。可以理解的是控制单元不限定设置在驱动装置内,也可以设置在机械臂内或主控制台中,只要其能实现和检测单元通信并控制主解耦件运动即可。
驱动装置770的其他部分和图8A所示的实施例类似,具体地,驱动装置770还包括第一导向轮777A、第二导向轮777B、第三导向轮777C以及第四导向轮777D,从解耦件7762包括两个导向部,即第一导向部7767和第二导向部7765,第一导向部7767和第二导向部7765中间通过滑架7763连接,主解耦件7761通过第一解耦缆绳1768和第二解耦缆绳1769连接到从解耦件7762。第一驱动缆绳151A和第二驱动缆绳151B先经过第一导向轮777A重新定向后再经过从解耦件7762的第一导向部7764的导向最后通过第三导向轮777C进入长轴160内,第三驱动缆绳152A和第四驱动缆绳152B经过第二导向轮777B重新定向后再经过从解耦件7762的第二导向部7765最后通过第四导向轮777D进入长轴160内。
驱动装置770的解耦过程如图15所示,第三驱动单元773逆时针(第一方向)旋转时,第三驱动缆绳773收拉第四驱动缆绳153B并同时释放第三驱动缆绳153A,此时末端执行器150如图7A、7B执行俯仰运动。由于第三对缆绳与第一对缆绳、第二对缆绳之间存在耦合关系,因此末端执行器150在如图7A、7B所示的俯仰运动的过程中将使第一驱动缆绳151A和第二驱动缆绳151B的张力迅速增加,控制单元接收来自第一张力传感器TS1、第二张力传感器TS2、第三张力传感器TS3以及第四张力传感器TS4的输入信号并对其进行处理,由于第一驱动缆绳151A和第二驱动缆绳151B的张力增加,第三驱动缆绳152A和第四驱动缆绳152B的减少,控制单元将输出控制信号控制主解耦件7761旋转,以平衡第一驱动缆绳151A至第四驱动缆绳152B的张力。
具体地,控制单元控制主解耦件7761逆时针旋转,此时主解耦件7761将收拉第二解耦缆绳7769并释放第一解耦缆绳7768,此时若平衡因末端执行器150俯仰运动引起的第一对缆绳和第二对缆绳的张力变化需使主解耦件单元7762将沿A方向运动运动距离L/2,若主解耦件单元7762将沿A方向运动了L/2距离,和上面的几个实施例类似地,由于第一对缆绳在第一导向轮777A和第一导向部7764之间的部分缆绳与从解耦件7762运动方向平行,在第一导向部7764和第三导向轮777C之间的部分缆绳大致与从解耦件7762的运动方向平行,同样地,第二对缆绳在第二导向轮777B和第二导向部7765之间的部分缆绳与从解耦件7762的运动方向平行,第二对缆绳在第二导向部7765和第四导向轮777D之间的部分缆绳大致与从解耦件7762的运动方向平行。因此,第一驱动缆绳151A和第二驱动缆绳151B在第一导向轮777A和第一导向部7764之间的距离以及在第一导向部7764和第三导向轮777C之间的距离减少了L/2,从而第一驱动缆绳151A和第二驱动缆绳151B在驱动装置内的长度减少了L,即第一对缆绳在驱动装置770内的长度减少了2L,相反地,第三驱动缆绳152A和第四驱动缆绳152B在驱动装置内的长度增加了2L,即第二对缆绳在驱动装置770内的距离增加了2L。引起从解耦件7765移动距离L/2,则第一驱动缆绳至第四驱动缆绳在驱动装置内的长度变化L的原因是从解耦件7765上连接第一对缆绳和/或第二对缆绳的导向部的数量,本实施例中导向部的数量为2个,则第一驱动缆绳和/或第三驱动缆绳在驱动装置内的长度变化量是相应的从解耦件7765的移动距离的两倍。可以理解的是,在其他一些实施例中从解耦件上的导向部的也可以是其他数量,若从解耦件上的导向部数量为N,则第一对缆绳和/或第二对缆绳在驱动装置内的长度变化量是相应的从解耦件7765的移动距离。
由此驱动装置770内的解耦机构提供了末端执行器150俯仰运动所需要的第一驱动缆绳151A、第二驱动缆绳151B、第三驱动缆绳152A以及四驱动缆绳152B在末端执行器150一侧的长度的变化量,从而解除了第三对缆绳和第一对缆绳、第二对缆绳的耦合关系,第三对缆绳的运动不再受第一驱动缆绳、第二驱动缆绳的限制,使得末端执行器150能顺利的执行俯仰操作。
由于驱动缆绳在使用过程中总会存在磨损,而且张力传感器的检测也会存在相应误差,因此以驱动缆绳的张力作为末端执行器150的俯仰指示信息可能会存在不能非常精确解耦的情况,例如,理论上需要从解耦件7762运动L/2的距离实现完全解耦,但是由于张力传感器存在误差,控制单元根据张力传感器的数据可能控制从解耦件7762的运动距离不是L/2。因此,一实施例中,以第三驱动单元773的旋转状态作为末端执行器150的俯仰状态指示信息。驱动装置770的检测单元为与第三驱动单元773连接的编码器,编码器可以精确检测第三驱动单元773的旋转角度,使得控制单元能实时精确获取第三驱动单元773旋转角度,进而可以精确计算出末端执行器150俯仰角度来控制从解耦件7762运动,从而和图9A-14A各实施例一样,使得驱动装置770内的解耦机构能精确提供末端执行器150俯仰运动所需要的第一驱动缆绳151A、第二驱动缆绳151B、第三驱动缆绳152A以及四驱动缆绳152B在末端执行器150一侧的长度的变化量,从而解除了第三对缆绳和第一对缆绳、第二对缆绳的耦合关系,第三对缆绳的运动不再受第一驱动缆绳、第二驱动缆绳的限制,使得末端执行器150能顺利的执行俯仰操作。在其他的一些实施例中,解耦机构不需要设置检测单元,解耦机构的控制单元和第三驱动单元同时接收来自主操控台的控制信号,以来自主操控台的控制信号作为末端执行器150的俯仰状态指示信息,控制单元通过来自主操控台的控制信号可以控制主解耦件与第三驱动单元同步运转。
本发明一实施例适用于驱动图8A-8E所示的末端执行器250的驱动装置如图16A、16B所示,驱动装置870包括用于驱动末端执行器250偏航运动的第一驱动单元871,用于驱动末端执行器250俯仰运动的第二驱动单元872,用于驱动末端执行器250自转运动的第三驱动单元873。用于操纵末端执行器250偏航运动的第一对缆绳的第一驱动缆绳251A和251B以相反的方式缠绕在第一驱动单元871上,用于操纵末端执行器250俯仰运动的第二对缆绳的第二驱动缆绳252A和第三驱动缆绳252B的近端以相反方式缠绕在第二驱动单元872上,第三驱动单元873上缠绕有用于驱动长轴160旋转的第四驱动缆绳253A。由上述关于图8A-8E所述可知,第二对缆绳和第一对缆绳之间也存在耦合关系,驱动装置870还包括用于解除第二对缆绳与第一对缆绳之间的该耦合关系的解耦机构。
解耦机构包括主解耦件8761和从解耦件8762,主解耦件8761与第二驱动单元872设置同在同一旋转轴872A上,主解耦件8761与第二驱动单元872随旋转轴872A同角速度运动,主解耦件8761接收来自与第二驱动单元872相同的驱动动力并驱动从解耦件8762运动以实现解除上述耦合关系。从解耦件8762包括导向部8763和滑架8764,主解耦件8761通过第一解耦缆绳8765连接到滑架8764一端并通过第二解耦缆绳8766连接到滑架8764的另一端,驱动装置870通过第一解耦缆绳8765和第二解耦缆绳8766驱动从解耦件8763沿直线运动。
驱动装置还包括第一导向轮877A和第二导向轮877B、第三导向轮8767和第四导向轮8768,第一对缆绳先经过第一导向轮877A重新定向后再经过导向部8763最后通过第二导向轮877B进入长轴160内。第一解耦缆绳8765经过第三导向轮8767重新定向后连接到滑架8764,第二解耦缆绳8766经过第四导向轮8768重新定向后连接到滑架8764,第一解耦缆绳8765在第三导向轮8767与滑架8764之间的部分与滑架8764的运动方向平行,第二解耦缆绳8766在第四导向轮8768与滑架8764之间的部分也与滑架8764的运动方向平行。因此在解耦的过程中,滑架8764的运动速度与主解耦件8761的旋转线速度成正比例关系。可以理解的是,在其他的一些实施例中,主解耦件也可以如前面几个实施例一样通过齿轮或凸轮与从解耦件相连接,具体的参照上述齿轮连接或凸轮连接的实施例,此处不再赘述。
第一驱动缆绳251A和第二驱动缆绳251B在第一导向轮877A和导向部8763之间的部分缆绳与滑架8764的运动方向平行,第一驱动缆绳251A和第二驱动缆绳251B在导向部8763与第二导向轮877B的部分缆绳与滑架8764的运动方向大致平行,因此在解耦的过程中,第一驱动缆绳251A和第二驱动缆绳251B在驱动装置内的长度变化的速度与滑架8764的直线运动速度成正比例关系,如上所述,滑架8764的运动速度与主解耦件8761的旋转线速度及第二驱动单元872的旋转线速度成正比例关系,故第一驱动缆绳251A和第二驱动缆绳251B在驱动装置内的长度变化的速度与主解耦件8761的旋转线速度及第二驱动单元872的旋转线速度成正比例关系,使解耦过程更精确可控。本实施例中,第一驱动缆绳251A和第二驱动缆绳251B在驱动装置内的长度变化的速度为主解耦件8761的旋转线速度的2倍。
解耦机构的解耦过程如图16B所示,当第二驱动单元872逆时针(第一方向)旋转时,第二驱动单元收拉第四驱动缆绳252B并同时释放第三驱动缆绳252A,由于主解耦件8761和第二驱动单元872同角速旋转,因此主解耦件8761同时收拉第二解耦缆绳8766并释放第一解耦缆绳8765,使得从解耦件8762沿A方向移动,从而使得第一对缆绳在驱动装置870内长度减少,第一对缆绳在末端执行器250上的长度增加。若驱动单元8762沿A的方向移动距离为L/2,和前面几个实施例类似的,第一驱动缆绳251A和第二驱动缆绳251B在驱动装置870内的长度都分别减少了长度L。
如图8D及图16B所示,若第三滑轮443和第四滑轮444的半径都为r1,俯仰轮421上用于容纳第二对缆绳的环形槽421A槽底半径为R1,主解耦件8761的半径为r2,第二驱动单元872的半径为R2,为了实现精确的解耦,第三滑轮443和第四滑轮444的半径r1、环形槽421A的槽底半径R1、主解耦件8761的半径r2以及第二驱动单元872的半径R2满足以下关系:
具体推导过程和上述图7A所示的实施例相同,这里不再赘述。在其他实施例中,从解耦件的导向部个数也可以为其他数量,从而第三驱动单元的半径与主解耦件的半径之比和俯仰轮的半径与第二滑轮组半径之比的关系也与之发生变化,例如从解耦件可以具有N个导向轮,第三驱动单元的半径与主解耦件的半径之比为俯仰轮的半径与第二滑轮组半径之比的2*N倍,即:但是从解耦件的导向部个数的增加相应的从解耦件的体积也相应的增加,比较优选的是上述实施例中从解耦件使用一个导向部,导向部为从解耦件上第一驱动缆绳经过的滑轮。
由此驱动装置870内的解耦机构提供了末端执行器250俯仰运动所需要的第一驱动缆绳251A、第二驱动缆绳251B在末端执行器250一侧的长度的变化量,从而解除了第三对缆绳和第一对缆绳、第二对缆绳的耦合关系,第三对缆绳的运动不再受第一驱动缆绳、第二驱动缆绳的限制,使得末端执行器250能顺利的执行俯仰操作,末端执行器250能实现图8D、8E所示的俯仰运动。
主解耦件8761与第二驱动单元872同轴顺时针旋转时,所引起驱动缆绳的变化与逆时针旋转相反,此时第二驱动单元872收拉第三驱动缆绳252A并释放第四驱动缆绳252B,主解耦件8761收拉第一解耦缆绳8765并释放第二解耦缆绳8766驱动从解耦件8762沿与A方向相反方向运动,从而同时增加第一驱动缆绳251A和251B在驱动装置内的长度,该增加的长度刚好等于第一驱动缆绳251A和第二驱动缆绳251B在末端执行器250的第二滑轮组上的减少量,第一驱动缆绳251A和第二驱动缆绳251B不会再末端执行器250上松弛,从而使得末端执行器250顺利执行器与图8D所示相反方向的俯仰运动,
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种手术器械,包括末端执行器、驱动装置及缆绳,所述驱动装置被配置为通过所述缆绳驱动所述末端执行器运动,所述缆绳包括用于驱动所述末端执行器执行偏航运动的第一对缆绳和用于驱动所述末端执行器执行俯仰运动的第二对缆绳,其特征在于,所述驱动装置包括:
驱动单元,所述第二对缆绳的一端连接在所述驱动单元上,所述驱动单元通过所述第二对缆绳驱动所述末端执行器执行俯仰运动;
解耦机构,解耦机构包括主解耦件和从解耦件,所述主解耦件与所述驱动单元同轴设置,所述主解耦件用于与所述驱动单元同轴旋转并驱动所述从解耦件运动以增加或减少所述第一对缆绳在所述驱动装置内的长度,以使所述驱动单元驱动所述末端执行器执行俯仰运动。
2.如权利要求1所述的手术器械,其特征在于,所述主解耦件驱动所述从解耦件沿直线运动以增加或减少所述第一对缆绳在所述驱动装置内的长度。
3.如权利要求2所述的手术器械,其特征在于,所述第一对缆绳包括第一驱动缆绳和第二驱动缆绳,所述第一驱动缆绳和所述第二驱动缆绳配合驱动所述末端执行器偏航运动,所述第二对缆绳包括第三驱动缆绳和第四驱动缆绳,所述驱动单元用于旋转以收拉所述第三驱动缆绳和所述第四驱动缆绳中的一驱动缆绳并释放其中另一驱动缆绳使所述第一驱动缆绳和所述第二驱动缆绳在所述末端执行器上的长度同时增加或同时减少。
4.如权利要求3所述的手术器械,其特征在于,所述驱动单元和所述主解耦件用于沿第一方向旋转所述驱动单元释放所述第三驱动缆绳并收拉所述第四驱动缆绳使所述第一驱动缆绳和所述第二驱动缆绳在所述末端执行器上的长度增加,所述从解耦件在所述主解耦件的驱动下运动从而减少所述第一驱动缆绳和所述第二驱动缆绳在所述驱动装置内的长度。
5.如权利要求4所述的手术器械,其特征在于,所述驱动单元和所述主解耦件沿与所述第一方向相反的第二方向旋转所述的驱动单元收拉所述第三驱动缆绳并释放所述第四驱动缆绳使得所述第一驱动缆绳和所述第二驱动缆绳在所述末端执行器上的长度减少,同时所述从解耦件在所述主解耦件的驱动下运动沿增加所述第一驱动缆绳和所述第二驱动缆绳在所述驱动装置内的长度。
6.如权利要求5所述的手术器械,其特征在于,所述从解耦件包括滑架和导向部,所述导向部安装在所述滑架的一端,所述第一对缆绳经过所述导向部的导向后延伸到所述末端执行器,所述主解耦件与所述滑架连接并驱动滑架移动以改变所述第一对缆绳在所述驱动装置的长度。
7.如权利要求6所述的手术器械,其特征在于,所述从解耦件还包括第一解耦缆绳和第二解耦缆绳,所述主解耦件通过所述第一解耦缆绳和所述第二解耦缆绳与所述滑架相连,所述主解耦件用于通过所述第一解耦缆绳和所述第二解耦缆绳驱动所述滑架运动以改变所述第一对缆绳在所述驱动装置内的长度。
8.如权利要求7所述的手术器械,其特征在于,所述主解耦件沿所述第一方向旋转以释放所述第一解耦缆绳并收拉所述第二解耦缆绳使得所述滑架运动从而减少所述第一驱动缆绳和所述第二驱动缆绳在所述驱动装置内的长度。
9.一种从操作设备,其特征在于,所述从操作设备包括机械臂和如权利要求1-8任一项所述的手术器械,所述手术器械安装在所述机械臂上,所述机械臂用于操纵所述手术器械运动。
10.一种手术机器人,其特征在于,所述手术机器人包括主操作控制台和如权利要求9所述的从操作设备,所述从操作设备根据所述主操作控制台的指令执行相应操作。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011066540.1A CN112043395A (zh) | 2020-09-30 | 2020-09-30 | 手术器械、从操作设备及手术机器人 |
EP20956056.4A EP4223249A4 (en) | 2020-09-30 | 2020-12-04 | SURGICAL INSTRUMENT, SLAVE OPERATING DEVICE AND SURGICAL ROBOT |
PCT/CN2020/133722 WO2022068039A1 (zh) | 2020-09-30 | 2020-12-04 | 手术器械、从操作设备及手术机器人 |
US18/029,629 US20230372041A1 (en) | 2020-09-30 | 2020-12-04 | Surgical instrument, slave operating device, and surgical robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011066540.1A CN112043395A (zh) | 2020-09-30 | 2020-09-30 | 手术器械、从操作设备及手术机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112043395A true CN112043395A (zh) | 2020-12-08 |
Family
ID=73606001
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011066540.1A Pending CN112043395A (zh) | 2020-09-30 | 2020-09-30 | 手术器械、从操作设备及手术机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112043395A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113729968A (zh) * | 2021-09-23 | 2021-12-03 | 上海卓昕医疗科技有限公司 | 手术器械引导设备及医疗机器人 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102143719A (zh) * | 2008-07-16 | 2011-08-03 | 直观外科手术操作公司 | 四线缆腕的后端机构 |
CN110198681A (zh) * | 2016-11-21 | 2019-09-03 | 直观外科手术操作公司 | 线缆长度持恒的医疗器械 |
CN212853622U (zh) * | 2020-09-30 | 2021-04-02 | 深圳市精锋医疗科技有限公司 | 手术器械、从操作设备及手术机器人 |
-
2020
- 2020-09-30 CN CN202011066540.1A patent/CN112043395A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102143719A (zh) * | 2008-07-16 | 2011-08-03 | 直观外科手术操作公司 | 四线缆腕的后端机构 |
CN110198681A (zh) * | 2016-11-21 | 2019-09-03 | 直观外科手术操作公司 | 线缆长度持恒的医疗器械 |
CN212853622U (zh) * | 2020-09-30 | 2021-04-02 | 深圳市精锋医疗科技有限公司 | 手术器械、从操作设备及手术机器人 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113729968A (zh) * | 2021-09-23 | 2021-12-03 | 上海卓昕医疗科技有限公司 | 手术器械引导设备及医疗机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112043394A (zh) | 手术器械、从操作设备及手术机器人 | |
CN112043393A (zh) | 手术器械、从操作设备及手术机器人 | |
CN112043390A (zh) | 手术器械、从操作设备及手术机器人 | |
EP4223248A1 (en) | Surgical instrument, slave operating equipment, and surgical robot | |
CN112043389A (zh) | 手术器械、从操作设备及手术机器人 | |
CN212996719U (zh) | 手术器械、从操作设备及手术机器人 | |
CN212853621U (zh) | 手术器械、从操作设备及手术机器人 | |
CN113367796B (zh) | 后端传动装置、医疗器械和手术机器人 | |
CN112274251A (zh) | 手术器械、从操作设备及手术机器人 | |
CN112274254A (zh) | 手术器械、从操作设备及手术机器人 | |
CN212853622U (zh) | 手术器械、从操作设备及手术机器人 | |
CN213156405U (zh) | 手术器械、从操作设备及手术机器人 | |
CN212438836U (zh) | 手术器械、从操作设备及手术机器人 | |
CN213310266U (zh) | 手术器械、从操作设备及手术机器人 | |
CN112043395A (zh) | 手术器械、从操作设备及手术机器人 | |
CN212788688U (zh) | 手术器械、从操作设备及手术机器人 | |
CN212996717U (zh) | 手术器械、从操作设备及手术机器人 | |
CN212996718U (zh) | 手术器械、从操作设备及手术机器人 | |
CN213156403U (zh) | 手术器械、从操作设备及手术机器人 | |
CN213641171U (zh) | 手术器械、从操作设备及手术机器人 | |
CN212788689U (zh) | 手术器械、从操作设备及手术机器人 | |
CN213156404U (zh) | 手术器械、从操作设备及手术机器人 | |
CN214104617U (zh) | 手术器械、从操作设备及手术机器人 | |
CN112043392A (zh) | 手术器械、从操作设备及手术机器人 | |
CN214805337U (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: 518000 2b1901, phase II, smart home, 76 Baohe Avenue, Baolong community, Baolong street, Longgang District, Shenzhen City, Guangdong Province Applicant after: Shenzhen Jingfeng Medical Technology Co.,Ltd. Address before: 518000 301, building 39, Dayun software Town, 8288 Longgang Avenue, heao community, Yuanshan street, Longgang District, Shenzhen City, Guangdong Province Applicant before: SHENZHEN JINGFENG MEDICAL TECHNOLOGY Co.,Ltd. |