Surgical instruments, operating equipment and surgical robots
By introducing a decoupling mechanism into the driving device of the minimally invasive surgical robot, the coupling problem between the movements of the end effector is solved, the independence and precise control of the movement are achieved, and the stability and controllability of the surgical robot are improved.
Patent Information
- Application Number
- CN202011066540.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2020-09-30
- Publication Date
- 2025-06-06
- Estimated Expiration
- 2040-09-30
AI Technical Summary
In existing minimally invasive surgical robots, there is a coupling relationship between the pitch motion and yaw motion of the end effector, which leads to the independence of the movement and is difficult to accurately control.
A surgical instrument is designed, and its driving device includes a decoupling mechanism to disconnect the coupling relationship of the cable through a mechanical structure to ensure the independence of pitch and yaw motion.
Accurate control of the movement of the end effector is achieved, reducing the complexity of the system and data acquisition errors, and improving the stability and controllability of the surgical robot.
Smart Images

Figure CN112043395B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of medical instruments, and in particular to a surgical instrument, a slave operating device using the surgical instrument, and a surgical robot having the slave operating device. Background Art
[0002] Minimally invasive surgery refers to a surgical method that uses modern medical devices such as laparoscopes and thoracoscopes and related equipment to perform surgery inside the human body cavity. Compared with traditional surgical methods, minimally invasive surgery has the advantages of less trauma, less pain, and faster recovery.
[0003] With the advancement of science and technology, minimally invasive surgical robot technology has gradually matured and has been widely used. Minimally invasive surgical robots usually include a master operating console and a slave operating device. The master operating console is used to send control commands to the slave operating device according to the doctor's operation to control the slave operating device. The slave operating device is used to respond to the control commands sent by the master operating console and perform corresponding surgical operations.
[0004] A surgical instrument that can be detached from the slave operating device is connected to the slave operating device. The surgical instrument includes a driving device and an end effector for performing surgery. The driving device is used to connect the surgical instrument to the slave operating device and receive a driving force from the slave operating device to drive the end effector to move. The driving device is connected to the end effector through a driving cable, and the driving device manipulates the movement of the end effector through the driving cable. The end effector generally includes three degrees of freedom, namely rotation, pitching and yaw. Some end effectors also have rotation, wherein the yaw movement is controlled by a group of driving cables, and the driving cables for the pitch movement are controlled by another group of driving cables. Since the pitch movement and yaw movement of the end effector are orthogonal, when the end effector performs a pitch movement, there is a coupling relationship between the driving cables controlling the pitch and the driving cables controlling the yaw, that is, the movement of the driving cables controlling the pitch is restricted by the driving cables controlling the yaw, so it is necessary to release this coupling relationship between the two. The prior art adopts a software decoupling method, but the algorithm of the software decoupling method is relatively complex, which increases the complexity of the system control program. In addition, the software decoupling method may have errors during data collection, and therefore cannot accurately release the coupling relationship between the two. Summary of the invention
[0005] Based on this, in order to solve the above problems, the present invention provides a surgical instrument, a slave operating device using the surgical instrument, and a surgical robot having the slave operating device.
[0006] A surgical instrument includes an end effector, a driving device and a cable, wherein the driving device is configured to drive the end effector to move through the cable, the cable includes a first pair of cables for driving the cable end effector to perform a yaw motion and a second pair of cables for driving the end effector to perform a pitch motion, and the driving device includes:
[0007] a driving unit, one end of the second pair of cables being connected to the driving unit, and the driving unit driving the end effector to perform a pitch motion through the second cables;
[0008] The decoupling mechanism includes a main decoupling member and a slave decoupling member. The main decoupling member is coaxially arranged with the driving unit. The main decoupling member is used to rotate coaxially with the driving unit and drive the slave decoupling member to move to increase or decrease the length of the first pair of cables in the driving device, so that the driving unit drives the end actuator to perform a pitch motion.
[0009] Preferably, the master decoupling member drives the slave decoupling member to move in a straight line to increase or decrease the length of the first pair of cables in the driving device.
[0010] Preferably, the first pair of cables includes a first drive cable and a second drive cable, and the first drive cable and the second drive cable cooperate to drive the yaw movement of the end effector. The second pair of cables includes a third drive cable and a fourth drive cable, and the drive unit rotates to retract one of the third drive cable and the fourth drive cable and releases the other drive cable so that the lengths of the first drive cable and the second drive cable on the end effector increase or decrease simultaneously.
[0011] Preferably, the drive unit and the main decoupling component rotate along the first direction to release the third drive cable and pull the fourth drive cable so that the length of the first drive cable and the second drive cable on the end actuator increases, and the decoupling component moves under the drive of the main decoupling component to reduce the length of the first drive cable and the second drive cable in the drive device.
[0012] Preferably, the driving unit and the main decoupling member rotate in a second direction opposite to the first direction, and the driving unit retracts the third driving cable and releases the fourth driving cable so that the lengths of the first driving cable and the second driving cable on the end effector are reduced, and at the same time, the decoupling member moves under the drive of the main decoupling member to increase the lengths of the first driving cable and the second driving cable in the driving device.
[0013] Preferably, the above-mentioned slave decoupling component includes a slide and a guide portion, the guide portion is installed at one end of the slide, the first pair of cables extend to the end actuator after being guided by the guide portion, and the main decoupling component is connected to the slide and drives the slide to move to change the length of the first pair of cables in the driving device.
[0014] Preferably, the above-mentioned slave decoupling component also includes a first decoupling cable and a second decoupling cable, and the main decoupling component is connected to the slide via the first decoupling cable and the second decoupling cable, and the main decoupling component is used to drive the slide to move via the first decoupling cable and the second decoupling cable to change the length of the first pair of cables in the driving device.
[0015] Preferably, the main decoupling member rotates in a first direction to release the first decoupling cable and pull the second decoupling cable to move the carriage to reduce the lengths of the first drive cable and the second drive cable in the drive device.
[0016] Preferably, the main decoupling member rotates in a second direction opposite to the first direction to retract the first decoupling cable and retract the second decoupling cable so that the carriage moves in a direction that reduces the lengths of the first drive cable and the second drive cable in the drive device.
[0017] Preferably, the driving device further comprises a first guide wheel, the first cable is guided by the first guide wheel and then extends to the end effector after passing through the guide portion, and the portion of the first pair of cables between the first guide wheel and the guide portion is parallel to the direction of movement of the slide.
[0018] Preferably, the driving unit and the main decoupling member rotate simultaneously so that the length change of the first driving cable or the third driving cable on the end effector is equal to twice the distance moved by the carriage under the drive of the main decoupling member.
[0019] Preferably, the driving device further comprises a second guide wheel, the first cable is guided by the first guide wheel and then by the second guide wheel before extending to the end effector, and the axis of the first guide wheel is perpendicular to the axis of the guide portion.
[0020] Preferably, the above-mentioned driving device also includes a third guide wheel and a fourth guide wheel, the first decoupling cable and the second decoupling cable are connected to the slide after being guided by the third guide wheel and the fourth guide wheel respectively, and the part of the first decoupling cable between the third guide wheel and the slide and the part of the second decoupling cable between the fourth guide wheel and the slide are parallel to the direction of movement of the slide.
[0021] Preferably, the main decoupling member has a cam structure, and the main decoupling member is used to rotate to drive the cam structure to contact the slide, thereby driving the slide to move.
[0022] Preferably, the main decoupling member has a driving gear portion, and the slave decoupling member has a driven gear portion meshing with the driving gear. The main decoupling member is used to rotate so that the driving gear portion drives the driven gear portion to move, thereby driving the slave decoupling member to move.
[0023] A slave operating device comprises a robotic arm and a surgical instrument as described above, wherein the surgical instrument is mounted on the robotic arm and the robotic arm is used to manipulate the movement of the surgical instrument.
[0024] A surgical robot comprises a main operating console and the above-mentioned slave operating device, and the slave operating device performs corresponding operations according to the instructions of the main operating console.
[0025] The surgical instrument of the present invention uses a mechanical structure to decouple the driving cable for manipulating the pitch motion of the end effector and the driving cable for manipulating the yaw motion of the end effector, and can very accurately and controllably decouple the two. The use of mechanical decoupling can reduce the program algorithm of the entire surgical robot, making the operation of the surgical robot more stable. BRIEF DESCRIPTION OF THE DRAWINGS
[0026] Figure 1 It is a structural schematic diagram of a slave operating device of a surgical robot according to an embodiment of the present invention;
[0027] Figure 2 This is a schematic diagram of the structure of a main operating console of a surgical robot according to an embodiment of the present invention;
[0028] Figure 3 A schematic diagram of the structure of a mechanical arm of a slave operating device according to an embodiment of the present invention;
[0029] Figure 4 It is a schematic structural diagram of a surgical instrument according to an embodiment of the present invention;
[0030] Figures 5A-5D It is a structural schematic diagram of an end effector according to an embodiment of the present invention;
[0031] Figure 5E This is a schematic diagram of the structure of a driving cable in a long axis according to an embodiment of the present invention;
[0032] Fig. 6A A three-dimensional diagram of a first support frame of an end effector according to an embodiment of the present invention;
[0033] Figure 6B A top view of a first support frame of an end effector according to an embodiment of the present invention;
[0034] Figure 6C A top view of a first support frame of an end effector according to another embodiment of the present invention;
[0035] Figures 7A-7C It is a schematic diagram of an end effector in a pitch state according to an embodiment of the present invention;
[0036] Fig. 8A is a three-dimensional diagram of an end effector according to an embodiment of the present invention;
[0037] Figure 8B for Fig. 8A An exploded view of the end effector is shown;
[0038] Figure 8Cfor Fig. 8A A top view of the second bracket;
[0039] Fig.8D for Fig. 8A Schematic diagram of the pitch state of the end effector shown;
[0040] Fig. 8E for Fig. 8A Schematic diagram of the pitch and yaw states of the end effector shown;
[0041] Fig. 9A is a schematic diagram of a driving device according to an embodiment of the present invention;
[0042] Fig. 9B and 9C for Fig. 9A A partial schematic diagram of the first driving cable and the second driving cable in the driving device shown being wound around the guide wheel;
[0043] Figures 9D-9E for Fig. 9A Schematic diagram of the decoupling process of the driving device;
[0044] Fig. 10A is a schematic diagram of a driving device according to an embodiment of the present invention;
[0045] Fig. 10B for Fig. 10A Schematic diagram of the decoupling process of the drive device shown;
[0046] Fig.11A is a schematic diagram of a driving device according to an embodiment of the present invention;
[0047] Fig. 11B for Fig.11A Schematic diagram of the decoupling process of the drive device shown;
[0048] Fig. 12A A three-dimensional diagram of a driving device according to an embodiment of the present invention;
[0049] Fig. 12B for Fig. 12A A top view of a driving device;
[0050] Fig. 12C for Fig. 12A A stereoscopic view of a decoupling member and a mounting seat of the drive device shown;
[0051] Fig.12D for Fig. 12C An exploded view of the decoupling member and the mounting base is shown;
[0052] Fig.12E for Fig. 12A A perspective view of the carriage of the drive device shown;
[0053] Fig.12F for Fig. 12A Schematic diagram of the decoupling process of the drive device shown.
[0054] Fig.13A A three-dimensional diagram of a driving device according to an embodiment of the present invention;
[0055] Fig. 13B For the present invention Fig.13A A top view of
[0056] Fig. 13C for Fig.13A An exploded view of the decoupling mechanism and mounting base in the illustrated embodiment;
[0057] Fig.13D for Fig.13A A top view of the main decoupling member in the illustrated embodiment;
[0058] Fig.13E for Fig.13A A schematic diagram of the decoupling process of the embodiment shown;
[0059] Fig.14A A three-dimensional diagram of a driving device according to an embodiment of the present invention;
[0060] Fig. 14B for Fig.14A A top view of a driving device;
[0061] Fig. 14C for Fig.14A An exploded view of the mount and slave decoupling member is shown;
[0062] Fig.14D is a three-dimensional diagram of a first decoupling slider;
[0063] Fig.14E for Fig. 14B Schematic diagram of the decoupling process of the drive device shown;
[0064] Fig.15 A schematic diagram of a driving device according to an embodiment of the present invention;
[0065] Fig.16A For use Fig. 8A A schematic diagram of a driving device of the embodiment shown;
[0066] Fig. 16B for Fig.16A Schematic diagram of the decoupling process of the drive device shown. DETAILED DESCRIPTION
[0067] In order to facilitate the understanding of the present invention, the present invention will be described more fully below with reference to the relevant drawings. The preferred embodiments of the present invention are given in the drawings. However, the present invention can be implemented in many different forms and is not limited to the embodiments described herein. On the contrary, the purpose of providing these embodiments is to make the disclosure of the present invention more thoroughly understood.
[0068] It should be noted that when an element is referred to as being "disposed on" another element, it may be directly on the other element or there may be a centered element. When an element is considered to be "connected" to another element, it may be directly connected to the other element or there may be a centered element at the same time. When an element is considered to be "coupled" to another element, it indicates that the change of at least one element will be restricted by another element. "Decoupling" means releasing the coupling relationship, indicating that two elements with a coupling relationship no longer have a coupling relationship, and the change of one element is no longer restricted by another element. The terms "vertical", "horizontal", "left", "right" and similar expressions used herein are for illustrative purposes only and do not represent the only implementation method. The terms "distal end" and "proximal end" used herein are used as directional words, which are commonly used terms in the field of interventional medical devices, where "distal end" refers to the end away from the operator during surgery, and "proximal end" refers to the end close to the operator during surgery.
[0069] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art of the present invention. The terms used herein in the specification of the present invention are only for the purpose of describing specific embodiments and are not intended to limit the present invention. The term "and / or" used herein includes any and all combinations of one or more related listed items.
[0070] Minimally invasive surgical robots generally include slave operating equipment and a main operating console. Figure 1 FIG. 1 is a slave operating device 100 according to an embodiment of the present invention. Figure 2The main operation console 200 of an embodiment of the present invention is a main operation console 200. The surgeon performs relevant control operations on the slave operation device 100 on the main operation console 200, and the slave operation device 100 performs surgical operations on the human body according to the input instructions of the main operation console 200. The main operation console 200 and the slave operation device 100 can be placed in the same operating room, or in different rooms, and even the main operation console 200 and the slave operation device 100 can be far apart. For example, the main operation console 200 and the slave operation device 100 are respectively located in different cities. The main operation console 200 and the slave operation device 100 can transmit data by wire or by wireless. For example, the main operation console 200 and the slave operation device 100 are located in the same operating room, and data is transmitted between the two by wire. For example, the main operation console 200 and the slave operation device 100 are respectively located in different cities, and long-distance data transmission is performed between the two through 5G wireless signals.
[0071] like Figure 1 As shown, the slave operation device 100 includes multiple robotic arms 110, each of which includes multiple joints and a robotic arm 130. The multiple joints are linked to achieve multiple degrees of freedom of movement of the robotic arm 130. The robotic arm 130 is equipped with a surgical instrument 120 for performing a surgical operation. The surgical instrument 120 passes through a trocar 140 fixed at the distal end of the robotic arm 130 and enters the human body. The robotic arm 110 is used to manipulate the movement of the surgical instrument 120 to perform the operation. The surgical instrument 120 is detachably mounted on the robotic arm 130, so that different types of surgical instruments 120 can be replaced at any time or the surgical instrument 120 can be removed to rinse or sterilize the surgical instrument 120. Figure 3 As shown, the surgical arm 130 includes a surgical arm body 131 and an instrument mounting frame 132 . The instrument mounting frame 132 is used to mount the surgical instrument 120 . The instrument mounting frame 132 can slide on the surgical arm body 131 , thereby driving the surgical instrument 120 to advance or retreat along the surgical arm body 131 .
[0072] like Figure 4As shown, the surgical instrument 120 includes a driving device 170 and an end effector 150 respectively located at the proximal end of the surgical instrument 120, and a long shaft 160 located between the driving device 170 and the end effector 150. The driving device 170 is used to connect with the instrument mounting frame 132 of the robotic arm 130. The instrument mounting frame 132 has a plurality of actuators (not shown in the figure). The plurality of actuators are engaged with the driving device 170 to transmit the driving force of the actuators to the driving device 170. The long shaft 160 is used to connect the driving device 170 and the end instrument 150. The long shaft 160 is hollow for the driving cable to pass through. The driving device 170 controls the movement of the end effector 150 through the driving cable so that the end effector 150 performs the relevant surgical operation.
[0073] Figure 5A-5D FIG. 1 is a schematic diagram of the structure of an end effector 150 according to an embodiment of the present invention. Figure 5A The end effector 150 shown includes a first bracket 210 and a second bracket 220, the distal end of the first bracket 210 includes a first pillar 314 and a second pillar 315, the proximal end of the first bracket 210 includes a base frame 316, one end of the base frame 316 is connected to the long axis 160, and the first pillar 314 and the second pillar 315 extend from the other end of the base frame 316 toward the distal end of the end effector 150, and the first pillar 314, the second pillar 315 and the base frame 316 form a roughly U-shaped clamp structure.
[0074] A first pin 311 and a second pin 312 are arranged between the first pillar 314 and the second pillar 315. One end of the first pin 311 is fixedly connected to the first pillar 314, and the other end thereof is fixedly connected to the second pillar 315. Similarly, one end of the second pin 312 is fixedly connected to the first pillar 314, and the other end thereof is fixedly connected to the second pillar 315. The second pin 312 and the first pin 311 are arranged side by side on the first pillar 314 and the second pillar 315, wherein the first pin 311 is closer to the base frame 316 of the first bracket 210 than the second pin 312.
[0075] To better illustrate the structure of the proximal end of the end effector 150, Figure 5B and Figure 5C The first bracket 210 is not shown. Figure 5B and Figure 5CAs shown, a first pulley group is arranged on the first pin 311, and the first pulley group includes a first pulley 211, a second pulley 212, a third pulley 213 and a fourth pulley 214 which are arranged on the first pin 311 in sequence; a second pulley group is arranged on the second pin 312, and the second pulley group includes a fifth pulley 215, a sixth pulley 216, a seventh pulley 217 and an eighth pulley 218 which are arranged on the second pin 312 in sequence; the first pulley 211 to the eighth pulley 218 are all used for guiding the drive cable; since the pulleys for guiding the drive cable are all arranged on the first bracket 210 and there is no pulley on the second bracket 220, the volume of the second bracket 220 can be made smaller, so that the volume of the end effector 150 is smaller, and there is no risk of the pulley falling off.
[0076] The second bracket 210 is provided with a third pillar 317, a fourth pillar 318 and a pitch wheel 319, which extend from the pitch wheel 319 along the distal end of the end effector 150 to form the third pillar 317 and the fourth pillar 318, and the third pillar 317, the fourth pillar 318 and the pitch wheel 319 form a roughly U-shaped frame shape, and the pitch wheel 319 of the second bracket 220 is installed on the second pin 312, and the second bracket 220 can rotate around the axis AA' passing through the second pin 312 to realize the pitch movement of the end effector 150.
[0077] A third pin 313 is provided between the third pillar 317 and the fourth pillar 318 of the second bracket 220. One end of the third pin 313 is fixedly connected to the third pillar 317 and the other end is fixedly connected to the fourth pillar 318. The third pin 313 is perpendicular to the first pin 311 and the second pin 312. The clamping part of the end effector 150 includes a first clamping part 230 and a second clamping part 240. The first clamping part 230 and the second clamping part 240 are rotatably provided on the second bracket 220 through the third pin 313. The first clamping part 230 and the second clamping part 240 can rotate around the axis BB' passing through the third pin 313 to realize the opening and closing and / or yaw movement of the end effector 150. The first clamping part 230 and the second clamping part 240 can be clamps for clamping tissues, or staplers for suturing, or cautery devices for electric cauterization, etc.
[0078] like Figures 5A-5D As shown, Figure 5A and 5B The direction markings shown are for the purpose of more conveniently describing the winding method of the drive cable on the end effector 150. The distal end and proximal end in the markings refer to the distal end and proximal end directions of the end effector 150, and the front, rear, left, and right refer to the directions of the end effector 150. Figure 5A and 5B The front direction, rear direction, left direction and right direction of the end effector 150 under the viewing angle. Although there are no direction marks in the figure, the other directions can be Figure 5A and 5B It is relatively easy to deduce the direction of the end effector 150. The driving cables arranged on the end effector 150 include a first pair of cables and a second pair of cables for manipulating the opening and closing and / or yaw movement of the end effector 150, and a third pair of cables for manipulating the pitch movement of the end effector 150. The first pair of cables includes a first driving cable 151A and a second driving cable 151B, wherein one end of the first driving cable 151A and the second driving cable 151B can be connected together or separated, which is the case for the second pair of cables and the third pair of cables. The second pair of cables includes a third driving cable 152A and a fourth driving cable 152B, and the third pair of cables includes a fifth driving cable 153A and a sixth driving cable 153B. Figure 5E As shown, each driving cable includes three sections. Taking the first driving cable 151A as an example, the first driving cable 151A includes a first cable section 151A1 for connecting to the driving device and a second cable section 151A2 for connecting to the end effector. The first cable section 151A1 and the second cable section 151A2 are connected by a rigid strip 151A3. Compared with using a whole driving cable, such a structure has higher transmission efficiency and is also prone to multiple driving cables being entangled in the long axis 160. It can be understood that in some other embodiments, the driving cable can also be a complete and unsegmented cable.
[0079] On one side of the end effector 150, the winding method of the first pair of cables on the first pulley block and the second pulley block is opposite to the winding method of the second pair of cables on the first pulley block and the second pulley block, the winding method of the first driving cable 151A of the first pair of cables on the first pulley block and the second pulley block is the same as the winding method of the second driving cable 151B on the first pulley block and the second pulley block, and the winding method of the third driving cable 152A of the second pair of cables on the first pulley block and the second pulley block is the same as the winding method of the fourth driving cable 152B on the first pulley block and the second pulley block. Specifically, the proximal end of the first driving cable 151A is connected to the driving unit in the driving device 170, and the distal end of the first driving cable 151A is guided by the front part of the first pulley 211 and extends toward the distal end of the end effector 150, and is guided by the rear part of the fifth pulley 215 and continues to extend along the distal end of the end instrument 150 and is finally fixed on the first clamping part 230. The second driving cable 151B is guided by the front of the fourth pulley 214 and then extends toward the distal end of the end effector 150, and then is guided by the rear of the eighth pulley 218 and then continues to extend toward the distal end of the end effector 150 and is finally fixed to the first clamping portion 230. The distal end of the third driving cable 152A is guided by the rear of the second pulley 212 and then extends toward the distal end of the end effector 150, and then is guided by the front of the sixth pulley 216 and then continues to extend toward the distal end of the end instrument 150 and is fixed to the second clamping portion 240. The distal end of the fourth driving cable 152B is guided by the rear of the third pulley 213 and then extends toward the distal end of the end effector 150, and then is guided by the front of the seventh pulley 217 and then continues to extend toward the distal end of the end instrument 150 and is transitioned to the second clamping portion 240.
[0080] The first drive cable 151A and the second drive cable 151B together drive the first clamping part 230 to rotate around the axis BB', and the third drive cable 152A and the fourth drive cable 152B together drive the second clamping part 240 to rotate around the axis BB', and then the first drive cable 151A, the second drive cable 151B, the third drive cable 152A and the fourth drive cable 152B together drive the first clamping part 230 and the second clamping part 240 to perform opening and closing and / or yaw movements.
[0081] The proximal ends of the fifth driving cable 153A and the sixth driving cable 153B of the third pair of cables are connected to the driving device 170, and the distal ends of the two are accommodated in the annular groove of the pitch wheel 319. The ends of the two are respectively fixed in the second bracket 220. The fifth driving cable 153A and the sixth driving cable 153B drive the second bracket 220 to rotate along the axis AA', and then the second bracket 220 drives the first clamping part 230 and the second clamping part 240 to perform pitch motion along the axis AA'.
[0082] The structure of the end effector 150 of the present invention and the winding method of the driving cable are different from those of the existing end effector. The first pulley group of the existing end effector is set on the first bracket of the end effector, and the second pulley group is set on the second bracket. The second pulley group performs pitching motion together with the second bracket. In addition, the winding method of the driving cable of the present invention is also different from that of the prior art. After the driving cable of the present invention is wound in the above-mentioned winding method, Figures 5A-5D As shown, the first driving cable 151A of the first pair of cables has a first portion of cable 151Aa between the fifth pulley 215 and the first clamping portion 230, the second driving cable 151B of the first pair of cables has a second portion of cable 151Ba between the eighth pulley 218 and the first clamping portion 230, the third driving cable 152A of the second pair of cables has a third portion of cable 152Aa between the sixth pulley 216 and the second clamping portion 240, and the fourth driving cable 151B of the second pair of cables has a third portion of cable 151Ba between the eighth pulley 218 and the first clamping portion 230. 2B There is a fourth portion of cable 152Ba between the seventh pulley 217 and the first clamping portion 240, wherein no matter how the end effector 150 pitches, the first portion of cable 151Aa and the second portion of cable 151Ba are always located on the same side of plane M, and the third portion of cable 152Aa and the fourth portion of cable 152Ba are always located on the same side of the other side of plane M. Plane M is a plane passing through the axis AA' of the second pin 312 and perpendicular to the axis BB' of the third pin 313. The first portion of cable 151Aa and the second portion of cable 151Ba are always located on the same side of plane M, and the third portion of cable 152Aa and the fourth portion of cable 152Ba are always located on the same side of the other side of plane M, so that the winding of the first pair of cables and the second pair of cables on the end effector 150 is relatively simple and neat, and it is also relatively easy to assemble.
[0083] like Figure 5C , 5D As shown, the first drive cable 151A and the second drive cable 151B are connected from the first bracket 210 ( Figure 5C and Figure 5D For the convenience of showing the driving cable, the first bracket 210 is not shown) and there are fifth and sixth cable sections 151Ab and 151Bb between the first pulley 211 and the fourth pulley 214 respectively. The third driving cable 152A and the fourth driving cable 151B have seventh and eighth cable sections 152Ab and 152Bb from the first bracket 210 to the second pulley 212 and the third pulley 213 respectively. The fifth and sixth cable sections 151Ab and 151Bb are both located on the same side of a plane P, which refers to a plane passing through the axis of the first pin 311 and the axis of the second pin 312 at the same time. The seventh and eighth cable sections 152Ab and 152Bb are both located on the same side of the other side of the plane P.
[0084] like Fig. 6A and6B As described, the base frame 316 of the first bracket 210 has a plurality of through holes for the driving cables to pass through, the plurality of through holes include a first through hole 219a for the fifth portion cable 151Ab of the first driving cable 151A to pass through, a second through hole 219b for the sixth portion cable 151Bb of the second driving cable 151B to pass through, a third through hole 219c for the seventh portion cable 152Ab of the third driving cable 152A to pass through, a fourth through hole 219d for the eighth portion cable 152Bb of the fourth driving cable 152B to pass through, a fifth through hole 219e for the fifth driving cable 153A to pass through, and a sixth through hole 219f for the sixth driving cable 153B to pass through. In order to enable the first driving cable 151A and the second driving cable 151B, the third driving cable 152A and the fourth driving cable 152B to undergo the same changes simultaneously (for example, their lengths increase or decrease simultaneously) when the end effector 150 performs pitch motion, the first through hole 219a and the second through hole 219b are located on the same side of the plane P, the third through hole 219c and the fourth through hole are located on the other side of the plane P, and the straight line passing through the center of the first through hole 219a and the second through hole 219b is parallel to the straight line passing through the center of the third through hole 219c and the center of the fourth through hole 219d. Due to this parallel relationship, the driving cable can pass through the through hole on the base frame 316 of the first bracket 210 and extend straight to the first pulley group, thereby making the driving efficiency of the driving cable relatively high.
[0085] like Figure 6B As shown, the first through hole 219a, the second through hole 219b, the third through hole 219c and the fourth through hole 219d are respectively located at the four vertices of the trapezoid, so that the first driving cable 151A and the second driving cable 151B pass through the first pulley 211 and the fourth pulley 214 on the outer side, respectively, and the third driving cable 152A and the fourth driving cable 152B pass through the second pulley 212 and the third pulley 213 on the inner side, respectively. In order to reduce the driving force loss of the fifth driving cable 153A and the sixth driving cable 153B when driving the pitching movement of the end effector 150, the fifth through hole 219e and the sixth through hole 219f are both located outside the trapezoid formed by the first through hole 219a, the second through hole 219b, the third through hole 219c and the fourth through hole 219d.
[0086] Another embodiment is Figure 6C The first through hole 319a, the second through hole 319b, the third through hole 319c and the fourth through hole 319d in the first bracket 310 are respectively located at the four vertices of the parallelogram, and the fifth through hole 319e and the sixth through hole 319f are both located outside the parallelogram formed by the first through hole 319a, the second through hole 319b, the third through hole 319c and the fourth through hole 319d.
[0087] In the prior art, the fifth cable of the first driving cable and the sixth cable of the second driving cable are located on the opposite sides of the plane P, the seventh cable of the third driving cable and the eighth cable of the fourth driving cable are also located on the opposite sides of the plane P, which is reflected in the distribution of the through holes for the driving cables to pass through on the first bracket. The two through holes for the first driving cable and the second driving cable of the first pair of cables to pass through are located on the opposite sides of the plane P, and the two through holes for the third driving cable and the fourth driving cable of the second pair of cables to pass through are also located on the opposite sides of the plane P. Since the end effector of the present invention and the prior art end effector are different in the entire structure and winding method, the end effector of the present invention is safer than the prior art, the driving cables and pulleys are not easy to fall off compared with the prior art, the assembly of the end instrument is also easier, and the volume of the entire end instrument is also smaller. Although the end device of the present invention has the above-mentioned advantages over the prior art, the end device of the present invention also brings new challenges, namely, the driving device of the existing end effector cannot drive the end effector of the present invention. More specifically, the method used by the driving device of the existing end effector to decouple the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables is no longer applicable to the end effector of the present invention.
[0088] The coupling relationship between the third pair of cables of the end instrument 150 and the first pair of cables and / or the second pair of cables is described in detail below. Figures 5A-5D As shown, the tangent points of the first portion of cable 151Aa, the second portion of cable 151Ba, the third portion of cable 152Aa and the fourth portion of cable 152Ba leaving the fifth pulley 215, the eighth pulley 218, the sixth pulley 216 and the seventh pulley 217 respectively are all located on plane a, and plane a is a plane passing through the first axis AA' and perpendicular to the above-mentioned plane P.
[0089] When the end effector 150 is to perform a pitching motion, the driving device 170 needs to pull the fifth driving cable 153A or the sixth driving cable 153B of the third pair of cables, so that the second bracket 220 drives the first clamping portion 230 and the second clamping portion 240 to perform a pitching motion around the first axis AA'. Fig. 7A and 7B As shown, the driving device 170 retracts and pulls the sixth driving cable 153B, so that the second bracket 220 and the first clamping part 230 and the second clamping part 240 perform pitch motion around the first axis AA'. If the end effector 150 only performs pitch motion, it is necessary to maintain the length of the first part cable 151Aa, the second part cable 151Ba, the third part cable 152Aa and the fourth part cable 153Ba constant, otherwise it will cause the end effector 150 to yaw or open and close motion.
[0090] At the end effector 150 from Figures 5A-5DThe straight position shown rotates to Figure 7A-7B During the pitch state shown in FIG. 1 , when the driving device 170 retracts the sixth driving cable 153B, if the target pitch angle that the end effector 150 needs to rotate through is α, the plane a needs to be rotated from Figure 5D The position in is also rotated by angle α to Fig. 7A The position of plane b, if the radius of the first pulley group and the second pulley group are both r1, in order to successfully rotate the end effector 150 to the target pitch angle α, the wrap lengths of the first drive cable 151A and the second drive cable 151B on the fifth pulley 215 and the eighth pulley 218 must be increased by a length L, where L = α*r1, and the wrap lengths of the corresponding third drive cable 152A and the fourth drive cable 152B on the sixth pulley 216 and the seventh pulley 217 must be reduced by a length L. Fig. 8A As shown, in the driving device 170, the first driving cable 151A and the second driving cable 151B are wound around the rotatable first driving unit 171 in opposite directions, and the third driving cable 152A and the fourth driving cable 152B are wound around the rotatable second driving unit 172 in opposite directions. The first driving unit 171 and the second driving unit 172 are rotationally fixed on their rotation axes, so the first driving unit 171 and the second driving unit 172 cannot be translated. Therefore, the first driving cable 151A and the second driving cable 151B cannot be translated by rotating the first driving unit 171 alone. Similarly, rotating the second drive unit 172 cannot increase or decrease the lengths of the third drive cable 152A and the fourth drive cable 152B at the same time. As mentioned above, if the end effector 150 is to successfully perform the pitch motion, the lengths of the first drive cable 151A and the second drive cable 151B on the end effector 150 must be increased or decreased at the same time, and the lengths of the third drive cable 152A and the fourth drive cable 152B on the end effector must be decreased or increased at the same time. Therefore, the movement of the third pair of cables is restricted by the first pair of cables and the second pair of cables.
[0091] The relationship in which the change of one element is restricted by another element is called a coupling relationship, that is, there is a coupling relationship between one element and another element. For the first pair of cables, the second pair of cables and the third pair of cables, this restricted relationship can be that the third pair of cables is restricted by the first pair of cables and / or the second pair of cables, so that the third pair of cables cannot move at all, making it impossible for the end effector to achieve pitch movement. It can also be that the third pair of cables is restricted by the first pair of cables and / or the second pair of cables, so that the movement of any cable among the first pair of cables, the second pair of cables and the third pair of cables will cause the other cables to move unexpectedly, causing the end effector to move unexpectedly and fail to perform the desired operation. For example, when the third pair of cables is manipulating the pitching movement of the end effector, due to the coupling relationship between the third pair of cables and the first pair of cables and / or the second pair of cables, the movement of the third pair of cables will simultaneously cause the movement of the first pair of cables and / or the second pair of cables, so that the end effector will cause the opening and closing and / or yaw movement of the end effector while the pitching movement is in progress, resulting in the pitching movement of the end effector and the opening and closing and / or offset movement affecting each other, and the pitching movement of the end effector and the opening and closing and / or offset movement are not independent of each other, so that the end effector 150 cannot correctly perform the surgical operation. Therefore, it is necessary to release the coupling relationship between the third pair of cables and the first pair of cables and / or the second pair of cables, so that the movement of the third pair of cables is no longer restricted by the first pair of cables and / or the second pair of cables, and the movements between the two can be independent of each other, without interfering or affecting each other. This release of the coupling relationship between the third pair of cables and the first pair of cables and / or the second pair of cables is called decoupling.
[0092] The end effector of another embodiment of the present invention is as follows Fig. 8A , 8B As shown, the end effector 250 in this embodiment is a monopolar cautery instrument, and the end effector 250 includes a first bracket 410, a second bracket 420, and an execution part 430. The first bracket 410 and the second bracket 420 are generally U-shaped structures. The first bracket 410 includes a base frame 411 and a first pillar 412 and a second pillar 413 extending from the base frame 411 along the distal end of the end effector 250. The proximal end of the base frame 410 is used to connect the long axis 160. The second bracket 420 is installed between the first pillar 412 and the second pillar 413 of the first bracket 410. The second bracket 420 includes a pitch wheel 421 and a third pillar 423 and a fourth pillar 424 extending from the pitch wheel 421 along the distal end of the end effector 250. The execution part 430 is installed between the third pillar 423 and the fourth pillar 424. In this embodiment, the execution part 430 is a monopolar cautery tool. It can be understood that in some other embodiments, the execution part 430 can also be other execution tools, such as a cutter.
[0093] A first pin 414 and a second pin 415 are provided between the first pillar 412 and the second pillar 413 of the first bracket 410, and the first pulley group and the second pulley group for driving the cable guide are provided respectively. The first pulley group includes a first pulley 441 and a second pulley 442 sequentially provided on the first pin 414, and the second pulley group includes a third pulley 443 and a fourth pulley 444 sequentially provided on the second pin 415. The pitch wheel 421 of the second bracket 420 is provided on the second pin 414, and the pitch wheel 421 can rotate around the axis AA' of the second pin 414 to achieve the pitch motion of the end effector 250. A third pin 431 is provided between the third pillar 423 and the fourth pillar 424 of the second bracket 420, and the actuator 430 is provided on the third pin 431 and can rotate around the axis BB' of the third pin 431 to achieve the yaw motion of the end effector 250, and the third pin 431 is perpendicular to the first pin 412 and the second pin 413.
[0094] The first pair of cables for manipulating the yaw motion of the end effector 250 includes a first drive cable 251A and a second drive cable 251B. The distal end of the first drive cable 251A is guided by the rear of the first pulley 441 and then continues to extend through the front of the third pulley 443, then continues to extend to the distal end of the end effector 250 and is finally fixed on the actuator 430. The distal end of the second drive cable 251B is guided by the rear of the second pulley 442 and then continues to extend through the front of the fourth pulley 444, then continues to extend to the distal end of the end effector 250 and is finally fixed on the actuator 430.
[0095] The second pair of cables for manipulating the pitch movement of the end effector 250 includes a third driving cable 252A and a fourth driving cable 252B. The pitch wheel 241 has an annular groove for accommodating and guiding the third driving cable 252A and the fourth driving cable 252B. The distal ends of the third driving cable 252A and the fourth driving cable 252B are accommodated in the annular groove of the pitch wheel 421 and the distal ends are fixed in the second bracket 420.
[0096] like Figure 8B As shown, the end actuator 250 also includes a cable 253 for providing power to the actuator 430, the second pulley 442 has a first guide boss 442A for guiding the cable 253, the fourth pulley 444 has a second guide boss 443A for guiding the cable 253, and the distal end of the cable 253 is connected to the actuator 430 after passing through the first guide boss 442A of the second pulley 442 and the second guide boss 444A of the fourth pulley 444.
[0097] The execution part 430 includes an electric hook 432 and a first insulating member 433, a second insulating member 434 and a third insulating member 435 for preventing the electric hook and the cable 253 from burning unexpected locations. The proximal end of the electric hook 432 and the distal end of the cable 253 are connected in the first insulating member 433, the second insulating member 434 is connected to the distal end of the first insulating member 433, the end of the electric hook 432 is fixed in the second insulating member 434, the distal end of the cable 253 is accommodated in the third insulating member 435 and extends into the first insulating member 433 to be connected to the proximal end of the electric hook 432.
[0098] like Figure 8C As shown, the base frame of the first bracket 410 has a first through hole 411a and a second through hole 411b for the first driving cable 251A and the second driving cable 251B to pass through, respectively, a third through hole 411c and a fourth through hole 411d for the third driving cable 252A and the fourth driving cable 252B to pass through, and a fifth through hole 411e for the cable 253. Similar to the previous embodiment, the first through hole 441a and the second through hole 411b are located on the same side of the plane P passing through the axis of the first pin 414 and the second pin 415, the third through hole 411c and the fourth through hole 411d are located on the opposite sides of the plane P, and the third through hole 411c and the fourth through hole 411d are located on the same side of the plane P, so that the winding method of the first pair of cables on the end effector 250 is simple and easy to assemble.
[0099] like Fig.8D As shown, when the driving device of the end effector 250 retracts the fourth driving cable 252B and releases the third driving cable 252A, the end effector 250 performs the following operation: Fig.8D As shown in the pitching motion, when the fourth driving cable 252B is retracted and the first driving cable 251A is retracted and the second driving cable 251B is released, the end effector 250 performs the following Fig. 8E The pitch and yaw motion shown is the same as the previous embodiment. The second pair of cables used to manipulate the pitch motion of the end effector 250 and the first pair of cables used to manipulate the yaw motion of the end effector 250 are also coupled, that is, the movement of the third drive cable 252A and the fourth drive cable 252B is restricted by the first drive cable 251A and the third drive cable 251B.
[0100] How to release the coupling relationship between the driving cables in the above two embodiments? Figure 5ATaking the end effector in the illustrated embodiment as an example, an existing decoupling method is to use a software algorithm for decoupling. The main operation console 200 controls the third drive unit to drive the third pair of cables to move, and also controls the first drive unit and the second drive unit to drive the first pair of cables and the second pair of cables to move, so that the wrap angle length of the first pair of cables and the second pair of cables on the pulley increases or decreases with the movement of the third pair of cables. However, this decoupling method requires that the first part of the cables 151Aa and the second part of the cables 151Ba of the first pair of cables on the end effector are respectively located on the opposite sides of the plane M, and the third part of the cables 152Aa and the fourth part of the cables 152Ba of the second pair of cables are also respectively located on the opposite sides of the plane M, so that the first driving cables 151A and the second driving cables 151B of the first pair of cables form a loop across the plane M, and the third driving cables 152A and the fourth driving cables 152B of the second pair of cables also form a loop across the plane M. Only then can decoupling be achieved by controlling the movement of the drive unit through software. However, the present invention Figure 5A The first cable 151Aa and the second cable 151Ba of the first pair of cables on the end effector of the illustrated embodiment are located on the same side of the plane M, and the third cable 153Aa and the fourth cable 153Ba of the second pair of cables are also located on the same side of the plane M. Therefore, the existing software decoupling method cannot decouple the end effector of this type of the present invention. In addition, the method of decoupling using software algorithms will make the control program of the surgical robot complicated and prone to errors, and this method of decoupling using software algorithms will cause each drive unit of the driving mechanism of the surgical instrument to lose its independence. Specifically, the driving device has three drive units that drive three pairs of cables respectively. Ideally, the control of each drive unit is mutually opposed. However, when using software algorithm decoupling, it is necessary to simultaneously control the above three drive units to move together, which causes the three drive units to lose their independence and is prone to control errors.
[0101] The present invention proposes a mechanical decoupling solution, in which a mechanical decoupling mechanism is provided in the driving device 170 of the surgical instrument 120, thereby avoiding the disadvantages of the above-mentioned software algorithm decoupling.
[0102] like Fig. 9A FIG. 1 is a schematic diagram of a driving device 170 according to an embodiment of the present invention. The driving device 170 is suitable for driving Figure 5AThe end effector shown. The driving device 170 includes a first driving unit 171 and a second driving unit 172 for driving the end effector 150 to perform opening and closing and / or yaw motion, a third driving unit 173 for driving the end effector 150 to perform pitch motion, and a fourth driving unit 174 for driving the long axis 160 to perform rotation motion. The first driving cable 151A and the second driving cable 151B of the first pair of cables are respectively wound around the first driving unit 171 in opposite winding ways, the third driving cable 152A and the fourth driving cable 152B of the second pair of cables are respectively wound around the second driving unit 172 in opposite winding ways, the fifth driving cable 153A and the sixth driving cable 153B of the third pair of cables are respectively wound around the third driving unit 173 in opposite winding ways, and the seventh driving cable 154A and the eighth driving cable 154B are respectively wound around the fourth driving unit 174 in opposite winding ways.
[0103] When the actuator drive shaft 171A in the instrument mounting frame 132 rotates and drives the first drive unit 171 to rotate along with its axis, the first drive unit 171 retracts or releases the first drive cable 151A or the second drive cable 151B to rotate the first clamping portion 230 around its third pin 313. When the actuator in the instrument mounting frame 132 drives the second drive unit 172 to rotate along with its axis 172A, the second drive unit 172 retracts or releases the second drive cable 152A or the third drive cable 152B to rotate the second clamping portion 240 around the third pin 313. The first clamping portion 230 and the second clamping portion 240 move around the third pin 313 so that the end effector 150 performs opening and closing and / or yaw movements. When the actuator drive shaft 173A in the instrument mounting frame 132 rotates to drive the third drive unit 173 to rotate, the third drive unit 173 pulls or releases the fifth drive cable 153A or the sixth drive cable 153B to rotate the second bracket 220 around the axis AA' of the second pin 312, thereby achieving the pitching motion of the end effector 150. When the actuator in the instrument mounting frame 132 drives the fourth drive unit 174 to rotate along its shaft 174A, the fourth drive unit 174 pulls or releases the seventh drive cable 154A or the eighth drive cable 154B to achieve the self-rotation motion of the drive long shaft 160.
[0104] The drive device 170 further includes a decoupling mechanism for releasing the coupling relationship between the third pair of cables and the first and second pairs of cables on the side of the end effector 150. The decoupling mechanism includes a main decoupling member 1761 and a slave decoupling member 176. The slave decoupling member 176 includes a carriage 1762 and first and second guiding portions 1763 and 1764 connected to both ends of the carriage 1762. The main decoupling member 1761 is connected to the carriage 1762 through a first decoupling cable 1767 and a second decoupling cable 1768. The main decoupling member 1761 manipulates the movement of the slave decoupling member by driving the first decoupling cable 1767 and the second decoupling cable 1768. The first decoupling cable 1767 and the second decoupling cable 1768 are wound around the main decoupling member 1761 in opposite ways. The main decoupling member 1761 and the third drive unit 173 move at the same angular velocity. The main decoupling member 1761 and the third drive unit 173 can be arranged on the same shaft 173A. Therefore, the main decoupling member 1761 rotates coaxially with the third drive unit 173 along the shaft 173A. In some other embodiments, the main decoupling member 1761 and the third drive unit 173 can also be respectively arranged on different rotating shafts. The main decoupling member 1761 and the third drive unit 173 have different radii. The radius of the main decoupling member 1761 is r2, and the radius of the third drive unit 173 is R2, where r2 < R2. The main decoupling member 1761 realizes the movement of the slave decoupling member by pulling in or releasing the first decoupling cable 1767 or the second decoupling cable 1768. The main decoupling member 1761 and the third drive unit 173 can be driven by the same power source. The power source is the actuator in the above-mentioned slave operating device. In other embodiments, the main decoupling member and the third drive unit are arranged on different rotating shafts, but the main decoupling member still receives the driving force homologous to the third drive unit. For example, they are respectively connected and driven in different ways by the same actuator. Using the same power source to drive the third drive unit and the main decoupling member simultaneously can make the control of decoupling simpler. The decoupling mechanism does not need to separately detect the coupling state. The main decoupling member and the coupling source (i.e., the third drive unit) receive the same control information, but the structures on the transmission side are different.
[0105] Such as Fig. 9A, the first driving cable 151A and the second driving cable 151B are guided by the third guide wheel 177A, the first guide part 1763 and the third guide wheel 177C in turn, then enter the long shaft and extend to the end effector 150. The third driving cable 152A and the fourth driving cable 152B are guided by the second guide wheel 177B, the second guide part 1764 and the fourth guide wheel 177D in turn, then enter the long shaft and extend to the end effector 150. The fifth driving cable 153A and the sixth driving cable 153B are guided by the fifth guide wheel 177E and the sixth guide wheel 177F in turn, then enter the long shaft and extend to the end effector 150. As for how the first driving cable 151A to the sixth driving cable 153B are connected to the end effector 150, it has been described in detail above and will not be repeated here.
[0106] The decoupling process is as follows Fig.9D As shown in FIG. 1 , when the third driving unit 173 rotates counterclockwise (in the first direction) along with its shaft 173A, the third driving unit 173 retracts the sixth driving cable 153B and releases the fifth driving cable 153A at the same time, so that the second bracket 220 of the end effector 150 is as shown in FIG. Fig. 7A and 7B The entire end effector 150 performs a pitching motion by rotating around the axis AA' of the second pin 312. As described above, at this time, the wrap angle lengths of the first driving cable 151A and the second driving cable 151B on the fifth pulley 215 and the eighth pulley 218 need to be increased by L at the same time, and at the same time, the wrap angle lengths of the third driving cable 152A and the fourth driving cable 152B on the sixth pulley 216 and the seventh pulley 217 need to be reduced by L at the same time so that the end effector 150 can smoothly perform a pitching motion. Since the main decoupling member 1761 of the decoupling mechanism rotates coaxially with the third driving unit 173, when the third driving unit 173 rotates counterclockwise with the shaft 173A, the main decoupling member 1761 also rotates counterclockwise with the shaft 173A. At this time, the main decoupling member 1761 retracts the first decoupling cable 1767 and releases the second decoupling cable 1768. If the arc length of the main decoupling member 1761 is L / 2, the main decoupling member 1761 retracts the first decoupling cable 1767 and releases the second decoupling cable 1768. Under pulling, it moves a distance of L / 2 in direction A. At this time, due to the movement of the decoupling member, the lengths of the first driving cable 151A and the second driving cable 151B in the driving device 170 will be reduced by L at the same time, that is, the length of the first pair of cables in the driving device 170 will be reduced by 2L. Correspondingly, the lengths of the third driving cable 152A and the fourth driving cable 152B in the driving device 170 will be increased by L at the same time, that is, the length of the second pair of cables in the driving device 170 will be increased by 2L.
[0107] Thus, the length reduction of the first driving cable 151A and the second driving cable 151B in the driving device 170 is equal to the required increase in the length of the first driving cable 151A and the second driving cable 151B on the fifth pulley 215 and the eighth pulley 218, respectively, and the length increase of the third driving cable 152A and the fourth driving cable 152B in the driving device 170 is equal to the required decrease in the length of the third driving cable 152A and the fourth driving cable 152B on the sixth pulley 216 and the seventh pulley 217. On the contrary, if Fig.9E As shown, when the third drive unit 173 and the main decoupling member 1761 rotate clockwise (in the second direction) together, the increase in the length of the first drive cable 151A and the second drive cable 151B in the drive device 170 is equal to the required decrease in the length of the wrap angle of the first drive cable 151A and the second drive cable 151B on the fifth pulley 215 and the eighth pulley 218, respectively, and the decrease in the length of the third drive cable 152A and the fourth drive cable 152B in the drive device 170 is equal to the required increase in the length of the wrap angle of the third drive cable 152A and the fourth drive cable 152B on the sixth pulley 216 and the seventh pulley 217. As a result, the length change of the first pair of cables and the second cable on one side of the end effector caused by the pitch movement of the end effector is completely provided by the length change of the first pair of cables and the second cable in the driving device. Therefore, the movement of the third pair of cables will no longer be restricted by the first pair of cables and the second pair of cables. The decoupling mechanism realizes the release of the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables.
[0108] In order to enable the decoupling mechanism to accurately and controllably release the coupling relationship between the first pair of cables and the second pair of cables and the third pair of cables, the main decoupling member 1761 of the decoupling mechanism drives the slave decoupling member 176 to always move in a straight line, and the length changes of the first drive cable 151A, the second drive cable 151B, the third drive cable 152A and the fourth cable 152B caused by the movement of the slave decoupling member 176 are always linear. As shown in Figures 9A-9C, the first decoupling cable 1767 is redirected by the seventh guide wheel 1765 and then fixed to one end of the slave decoupling member 176 along the movement direction of the slave decoupling member 176. Similarly, the second decoupling cable 1768 is redirected by the eighth guide wheel 1766 and then fixed to the other end of the slave decoupling member 176 along the movement direction of the slave decoupling member 176. Therefore, the movement of the main decoupling member 1761 will cause the slave decoupling member 176 to move in a straight line. Furthermore, the portion of the first decoupling cable 1767 between the seventh guide wheel 1765 and the slave decoupling member 176 and the portion of the second decoupling cable 1768 between the eighth guide wheel 1766 and the slave decoupling member 176 are parallel to the movement direction of the slave decoupling member 176. During the decoupling process, the length change speed of the first decoupling cable 1767 and the second decoupling cable 1768 is directly proportional to the rotation linear speed of the main decoupling member 1761. Therefore, the movement speed of the slave decoupling member 176 is also directly proportional to the rotation linear speed of the main decoupling member 1761 and the third drive unit 173, thereby making the decoupling process precisely controllable.
[0109] like Figure 9B-9C As shown, the first guide wheel 177A, the first guide portion 1763 and the third guide wheel 177C all have a structure with two pulleys arranged side by side, and the two pulleys are used to guide the first driving cable 151A and the second driving cable 151B respectively. The first driving cable 151A forms a first decoupling portion cable 151Ac between the third guide wheel 177C and the first guide portion 1763, and a third decoupling portion cable 151Ad is formed between the first guide portion 1763 and the first guide wheel 177A. The second driving cable 151B forms a second decoupling portion cable 151Ac between the third guide wheel 177C and the first guide portion 1763. 51Bc, a fourth decoupling portion cable 151Bd is formed on the first guide portion 1763 and the first guide wheel 177A. Similarly, the second guide portion 1764, the second guide wheel 177B and the fourth guide wheel 177D also have a structure with two pulleys arranged side by side. The third drive cable 152A and the fourth drive cable 152B have a fifth decoupling portion cable 152Ac and a sixth decoupling portion cable 152Bc between the fourth guide wheel 177D and the second guide portion 1764, respectively, and a seventh decoupling portion cable 152Ad and an eighth decoupling portion cable ( Fig. 9AIn order to achieve more accurate decoupling, it is necessary to make the length change of the first decoupling part cable 151Ac equal to the length change of the second decoupling part cable 151Bc during the decoupling process. Therefore, the first decoupling part cable 151Ac and the second decoupling part cable 151Bc respectively form equal angles θ with the plane passing through the center of the third guide wheel 177C and perpendicular to the axis c1 of the third guide wheel 177C, and the fifth decoupling part cable 152Ac and the seventh decoupling part cable 152Bc also have the same setting as the seventh guide wheel 177D, so that during the decoupling process, the length changes of the first decoupling part cable 151Ac and the second decoupling part cable 151Bc are the same, and the length changes of the fifth decoupling part cable 152Ac and the seventh decoupling part cable 152Bc are the same. In addition, since θ is relatively small, the axial spacing H1 between the first decoupling part cable 151Ac and the second decoupling part cable 151Bc and the first guide wheel 1764 and the fourth guide wheel 177B is roughly equal. During the decoupling process, the first decoupling part cable 151Ac and the second decoupling part cable 151Bc are roughly parallel to the movement direction of the decoupling part, so that the nonlinear changes of the first decoupling part cable 151Ac and the second decoupling part cable 151Bc during the decoupling process caused by the first decoupling part cable 151Ac and the second decoupling part cable 151Bc are smaller, thereby achieving more precise decoupling.
[0110] like Fig. 9C As shown, the third decoupling portion cable 151Ad, the fourth decoupling portion cable 151Bd, the seventh decoupling portion cable 152Ad and the eighth decoupling portion cable are parallel to the movement direction of the slave decoupling member 176. In this way, the speed of the change in length of the third decoupling portion cable 151Ad, the fourth decoupling portion cable 151Bd, the seventh decoupling portion cable 152Ad and the eighth decoupling portion cable caused by the movement of the slave decoupling member during the decoupling process is directly proportional to the speed of movement of the slave decoupling member 176. Therefore, during the decoupling process, the speed of the length change of any one of the first drive cable 151A to the fourth drive cable 152B in the drive device 170 is directly proportional to the moving speed of the slave decoupling member 176. As described above, the moving speed of the slave decoupling member 176 is directly proportional to the rotation linear speed of the main decoupling member 1761 and the third drive unit 173. Therefore, during the decoupling process, the length change speed of any one of the first to fourth drive cables 151A, 152B in the drive device 170 is also directly proportional to the rotational linear speed of the main decoupling component 1761 and the third drive unit 173, thereby accurately controlling the length change of the first pair of cables and the second pair of cables on the end effector 150 through the main decoupling component 173 and the third drive unit 173, thereby achieving precise and controllable decoupling.
[0111] like Fig.9D The decoupling process of this embodiment is shown. Compared with the state shown in Figure 9A, the main decoupling member 1761 rotates counterclockwise by an arc length of L / 2, and the slave decoupling member 176 moves L / 2 distance in the A direction accordingly. The lengths of the first decoupling portion cable 151Ac, the third decoupling portion cable 151Ad, the second decoupling portion cable 151Bc, and the fourth decoupling portion cable 151Bd are simultaneously reduced by L / 2, so that the first driving cable 151A and the second driving cable 151B are simultaneously reduced in length L in the driving device 170, that is, the length of the first pair of cables in the driving device is reduced by 2L. Similarly, the lengths of the fifth decoupling portion cable 152Ac, the sixth decoupling portion cable 152Ad, the seventh decoupling portion cable 152Bc, and the eighth decoupling portion cable are simultaneously increased by L / 2, so that the third driving cable 152A and the fourth driving cable 152B are simultaneously increased in length L in the driving device 170, that is, the length of the second pair of cables in the driving device is increased by 2L.
[0112] Back again Fig. 7A , if the radius of the second pulley block in this embodiment is r1, the bottom radius of the annular groove 319A on the pitch wheel 319 of the second bracket 220 for accommodating and guiding the fifth drive cable 153A and the sixth drive cable 153B is R1, when the end effector 150 pitches, the fifth drive cable 153A or the sixth drive cable 153B can form a wrap angle in the annular groove. Figure 5D The zero position shown is rotated to Fig. 7A During the state shown, if the pitch angle of the end effector 150 is α, the wrap angle length of the fifth driving cable 153A in the annular groove 319A on the pitch wheel 319 increases by L1, and the wrap angle length of the sixth driving cable 153B in the annular groove 319A on the pitch wheel 319 decreases by L1 at the same time, wherein L1=α*R1. Since the pitch motion of the end effector 150 is driven by the third driving unit 173 in the driving device 170, as shown in FIG. Fig.9DAs shown, at this time, if the third driving unit 173 rotates counterclockwise (in the first direction) at an angle of α to make the end effector 150 pitch, the angle is β, the third driving unit 173 releases the fifth driving cable 153A and simultaneously retracts the sixth driving cable 153B, so that the length of the fifth driving cable 153A wrapped around the third driving unit 173 is reduced by L1, and the length of the sixth driving cable 153B wrapped around the third driving unit 173 is increased by L1, wherein L1=β*R2. Since the main decoupling member 1761 and the third driving unit 173 rotate coaxially, the main decoupling member 1761 releases the first decoupling cable 1767 and simultaneously retracts the second decoupling cable 1768, so that the length of the first decoupling cable 1767 wrapped around the main decoupling member 1761 is reduced by L / 2, that is, the first decoupling cable 1767 is released by L / 2, and the length of the second decoupling cable 1768 wrapped around the main decoupling member 1761 is increased by L / 2, wherein L / 2=β*r2, so that the slide 1762 moves a distance of L / 2 in the A direction, so that the lengths of the first driving cable 151A and the second driving cable 151B in the driving device 170 are respectively reduced by L, and the lengths of the third driving cable 152A and the fourth driving cable 152B in the driving device 170 are respectively increased by L. As can be seen from the above, L=α*r1. In summary, through the above four formulas: L1 = α * R1, L1 = β * R2, L / 2 = β * r2, L = α * r1, we can get the following relationship:
[0113]
[0114] The above relationship shows that the ratio of the radius of the third drive unit 173 to the radius of the main decoupling member 1761 is twice the ratio of the groove bottom radius of the annular groove 319A of the pitch wheel 319 to the radius of the second pulley block. The reason for this 2-fold relationship is that the slave decoupling member has two guide parts, namely the first guide part 1763 and the second guide part 1764. In other embodiments, the number of guide parts of the slave decoupling member 176 can also be other numbers, so that the relationship between the ratio of the radius of the third drive unit to the radius of the main decoupling member and the ratio of the radius of the pitch wheel to the radius of the second pulley block also changes accordingly. For example, the slave decoupling member can have N guide parts, and the ratio of the radius of the third drive unit to the radius of the main decoupling member is N times the ratio of the groove bottom radius of the annular groove of the pitch wheel to the radius of the second pulley block, that is: However, the increase in the number of guide parts of the slave decoupling member will increase the volume of the slave decoupling member accordingly. It is more preferred that the slave decoupling member in the above embodiment uses two guide parts. It can be understood that the radius of the above-mentioned drive unit and the radius of the main decoupling member refer to the radius of the part on which the drive cable or the decoupling cable is wound, such as the radius of the winch, and the radius of the pulley refers to the groove bottom radius of the pulley, which can be used to calculate the wrap angle length of the drive cable wound on the pulley. Although the pulley radius has different explanations in different documents (such as the bottom groove radius, the groove bottom radius), the pulley radius in the invention is a parameter used to measure the wrap angle length of the drive cable wound on the pulley.
[0115] Therefore, the length changes of the first pair of cables and the second pair of cables on one side of the end effector 150 required for the pitching movement of the end effector 150 are all accurately provided by the decoupling mechanism 176, so that the movement of the third pair of cables is no longer restricted by the first pair of cables and the second pair of cables, and the precise decoupling between the third pair of cables and the first pair of cables and the second pair of cables is achieved. During the entire decoupling process, the lengths of the first part of the cables 151Aa, the second part of the cables 151Ba, the third part of the cables 152Aa and the fourth part of the cables 153Ba can be kept constant, and the tension of the entire first pair of cables and the second pair of cables is also kept constant. In addition, since only the shaft 173A of the third drive unit 173 moves during the entire decoupling process, the first drive unit 171, the second drive unit 172 and the third drive unit 173 are completely independent. In addition, since the main decoupling member 1761 rotates coaxially with the coupling source, i.e., the third drive unit 173, which causes the coupling relationship, the main decoupling member 1761 and the coupling source third drive unit 173 move at the same angular velocity, and the two physically move completely synchronously. There is no need for the main operation setting to give a signal to control the decoupling mechanism. The movement of the decoupling mechanism is synchronized with the movement of the coupling source. The decoupling mechanism synchronizes with the third drive unit to decouple without any delay, and the length change of the first pair of cables and the second pair of cables on the side of the end effector 150 caused by the coupling source third drive unit 173 can be completely and accurately mapped to the length change of the first pair of cables and the second pair of cables on the decoupling mechanism 176, so that the decoupling mechanism 176 can completely and accurately release the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables. The so-called precise decoupling means that the third drive unit rotates a certain degree and the slave decoupling member moves a certain distance. The relationship between the two is determined, and the above-mentioned radius ratio equations have been given. In addition, since the slave decoupling component 176 is always driven by the main decoupling component 1761 to move to the corresponding position instead of being driven by the first pair of cables or the second pair of cables, the first pair of cables and the second pair of cables are basically not subjected to force on the slave decoupling component during the entire decoupling process. Therefore, the tension of the first pair of cables and the second pair of cables remains basically unchanged during the decoupling process, thereby increasing the service life of the first pair of cables and the second pair of cables and the accuracy of control over the end actuator 150.
[0116] Fig. 10A and 10BA driving device 270 according to another embodiment of the present invention is shown. The driving device 270B includes a first driving unit 271, a second driving unit 272, a third driving unit 273, a third driving unit 274 and a decoupling mechanism 276. When the first driving unit 271 rotates along with its axis 271A, the first driving unit 271 retracts or releases the first driving cable 151A or the second driving cable 151B to rotate the first clamping portion 230 around the third pin 313. When the actuator in the instrument mounting frame 132 drives the second driving unit 272 to rotate along with its axis 272A, the second driving unit 272 retracts or releases the second driving cable 152A or the third driving cable 152B to rotate the second clamping portion 240 around the third pin 313. The first clamping portion 230 and the second clamping portion 240 move around the third pin 313 so that the end effector 150 performs opening and closing and / or yaw motions. When the actuator in the instrument mounting frame 132 drives the third driving unit 273 to rotate along its axis 273A, the third driving unit 173 retracts or releases the fifth driving cable 153A or the sixth driving cable 153B to rotate the second bracket 220 around the axis AA' of the second pin so that the end effector 150 performs a pitch motion.
[0117] The decoupling mechanism 276 includes a main decoupling member 2761 and a slave decoupling member. The main decoupling member 2761 is a gear that rotates coaxially with the third drive unit 273. The slave decoupling member includes a rack 2762 and a first guide portion 2763 and a second guide portion 2764 connected at both ends of the rack 2762. The first drive cable 151A and the second drive cable 151B enter the long shaft 160 through the first guide portion 2763 of the slave decoupling member, and the second drive cable 152A and the second drive cable 152B enter the long shaft 160 through the second guide portion 2764 of the slave decoupling member.
[0118] like Fig. 10B As shown, when the third drive unit 273 and the main decoupling member 273 rotate counterclockwise with the shaft 273A, the third drive unit 273 retracts the sixth drive cable 153B and releases the fifth drive cable 153A, and the end effector 150 is as shown in FIG. Fig. 7A , 7BAs shown, a pitch motion is performed. At the same time, if the arc length of the main decoupling member 2761 rotating counterclockwise is L / 2, the length of the slave decoupling member moving along the A direction under the drive of the main decoupling member 2761 is also L / 2, the lengths of the first driving cable 151A and the second driving cable 151B between the first guide portion 2763 and the first guide wheel 277A, and the lengths between the first guide portion 2763 and the third guide wheel 277C are both reduced by L / 2, and the lengths of the third driving cable 152A and the fourth driving cable 152B between the second guide portion 2764 and the second guide wheel 277B, and the lengths between the second guide portion 2764 and the fourth guide wheel 277D are both increased by L / 2, so that the lengths of the first driving cable 151A and the second driving cable 151B in the driving device 270 are reduced by L as a whole, and the lengths of the third driving cable 152A and the fourth driving cable 152B in the driving device 270 are increased by L as a whole. Thus, the decoupling mechanism 276 in the drive device 270 provides the change in length of the first drive cable 151A to the fourth drive cable 152B on one side of the end effector 150 required for the pitch movement of the end effector 150, thereby releasing the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables, and the movement of the third pair of cables is no longer restricted by the first pair of cables and / or the second pair of cables.
[0119] Fig.11A , 11B The driving device 370 of another embodiment of the present invention is shown. The driving device 270B includes a first driving unit 371, a second driving unit 372, a third driving unit 373, a fourth driving unit 374 and a decoupling mechanism 376. Except that the structure of the decoupling mechanism 376 is different from that of the two embodiments, the other components are basically the same as those of the above two embodiments, and will not be repeated here. The decoupling mechanism 376 includes a main decoupling member 3761 that rotates coaxially with the third driving unit 373, a decoupling cam 3762 that is fixedly connected to or integrally formed with the main decoupling member 3761, and the two ends of the decoupling cam 3762 are respectively connected by a first guide portion 3763 and a second guide portion 3764.
[0120] like Fig. 11B As shown, when the main decoupling member 3761 and the third driving unit 373 rotate counterclockwise with the shaft 373A, the third driving unit 373 retracts the sixth driving cable 153B and releases the fifth driving cable 153A at the same time, and the end effector 150 is as shown in FIG. Figures 7A-7CAs shown, the pitch motion is performed. At the same time, the decoupling cam 3762 is driven by the main decoupling member 3761 and also rotates counterclockwise with the shaft 373A, so that the length of the first drive cable 151A and the second drive cable 151B between the first guide wheel 377A and the third guide wheel 377C is reduced by L, and the length of the third drive cable 152A and the fourth drive cable 152B between the second guide wheel 377B and the fourth guide wheel 377D is increased by L. Therefore, the decoupling mechanism 376 in the drive device 370 can provide the length change of the first drive cable 151A to the fourth drive cable 152B on one side of the end actuator 150 required for the pitch motion of the end actuator 150, thereby releasing the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables, and the movement of the third pair of cables is no longer restricted by the first pair of cables and / or the second pair of cables.
[0121] Figures 12A-12F A driving device according to another embodiment of the present invention is shown, the driving device 470 includes a main body 478, on which a first driving unit 471, a second driving unit 472, a third driving unit 473 and a fourth driving unit 474 are arranged, the long shaft 160 is connected to the main body 478 through a bearing, the decoupling mechanism 476 includes a main decoupling member 4761 and a slave decoupling member 4762, the main decoupling member 4761 and the third driving unit 473 are both connected to the shaft 476A, the main decoupling member 4761 and the third driving unit 473 rotate coaxially with the shaft 473A, the main decoupling member 4761 is arranged at the lower part of the third driving unit 473, that is, the main decoupling member 4761 is closer to the distal end of the driving device than the third driving unit 473. The decoupling member 4762 includes a slide 4765 and a first guide portion 4763 and a second guide portion 4764 arranged at both ends of the slide 4765. The slide 4765 is slidably connected to the mounting seat 477, and the mounting seat 477 is fixedly mounted on the main body 478. The mounting seat 477 is provided with a first guide wheel 476A, a second guide wheel 476B, a third guide wheel 476C and a fourth guide wheel 476D that cooperate with the slide 4765. The first guide wheel 476A, the second guide wheel 476B, the third guide wheel 476C and the fourth guide wheel 476D form a sliding area for the slide 4765 to slide therein, so that the slide 4765 can be restricted to slide in the sliding area on the mounting seat 477.
[0122] The first drive cable 151A and the second drive cable 151B are wound around the first drive unit 471 in opposite winding manners. The first drive cable 151A and the second drive cable 151B are guided by the first guide wheel 477A provided on the mounting seat 477, and then by the first guide portion 4763 provided on the slide 4765, and then by the third guide wheel 477C provided on the mounting seat 477, and then enter into the long axis 160, and extend along the far end of the long axis 160, and finally are fixed to the first clamping portion 230 on the end actuator 150. The third driving cable 152A and the fourth driving cable 152B are wound around the second driving unit 472 in a reverse winding manner, and the third driving cable 152A and the fourth driving cable 152B are guided by the second guide wheel 477B provided on the mounting seat, and then guided by the second guide portion 4764 provided on the slide 4765, and then guided by the fourth guide wheel 477D provided on the mounting seat 477, and then enter the long shaft 160, and extend along the distal end of the long shaft 160, and finally fixed to the second clamping portion 240 of the end effector 150. The fifth driving cable 153A and the sixth driving cable 153B enter the long shaft 160, and extend along the distal end of the long shaft 160, and finally fixed to the second bracket 220 after being guided by the fifth guide wheel 477E. The other ends of the seventh drive cable 154A and the eighth drive cable 154B wound around the fourth drive unit 474 are wound around the proximal end of the long axis 160. Like the above embodiments, the third pair of cables and the first pair of cables and the second pair of cables are also coupled on the end effector side.
[0123] The mounting seat 477 includes a first boss 4771, and the mounting seat 477 is fixed to the body 478 through the first boss 4771. The first boss 4771 is provided with a second boss 4772, a third boss 4773, and a fourth boss 4774. The second boss 4772 has a first mounting hole 4791 and a second mounting hole 4792, and the second guide wheel 476B and the third guide wheel 476C are respectively mounted on the second boss 4772 through the second mounting hole 4792 and the first mounting hole 4791. The third boss 4773 has a third mounting hole 4793 and a fourth mounting hole 4794, and the first guide wheel 477A and the second guide wheel 477B are respectively mounted on the third boss 4773 through the third mounting hole 4793 and the fourth mounting hole 4794. The fourth boss 4774 has a fifth mounting hole 4795. The first guide wheel 476A and the sixth guide wheel 4769 located below the first guide wheel 4796A are mounted in the sixth mounting hole 4796 through the same shaft. The sixth guide wheel 4796 is used to guide the first decoupling cable 4767 and the second decoupling cable 4768. The fifth boss 4775 has a seventh mounting hole 4797. The fourth guide wheel 476D is mounted on the fifth boss 4775 through the ninth mounting hole 4799. In order to keep the first guide wheel 476A and the fourth guide wheel 476D at the same height after being mounted on the mounting seat 477, the fourth boss 4774 and the fifth boss 4775 have a certain height difference, which is substantially equal to the height of the sixth guide wheel 4769.
[0124] The mounting seat 477 also has a first mounting column 4776 and a second mounting column 4777. The first mounting column 4776 and the second mounting column 4777 are arranged diagonally opposite to each other. The first mounting column 4776 and the second mounting column 4777 are provided with a sixth mounting hole 4796 and a seventh mounting hole 4797. The fifth guide wheel 477E is installed on the first mounting column 4776 and the second mounting column 4777 through the sixth mounting hole 4796. The limit pin 477F for preventing the fifth drive cable 153A and the sixth drive cable 153B from escaping from the fifth guide wheel 477E is installed on the first mounting column 4776 and the second mounting column 4777 through the seventh mounting hole 4797. The first mounting column 4776 and the second mounting column 4777 are arranged diagonally opposite to each other, so that the fifth guide wheel 477E can guide the drive cable coming from the diagonal direction.
[0125] A mounting groove 4798 and a wire hole 4775 are provided between the first mounting column 4776 and the second mounting column 4777 and the third boss 4773. The third guide wheel 477C and the fourth guide wheel 477D are mounted on the mounting seat 477 through the mounting groove 4795. The wire hole 4775 is located between the third guide wheel 477C and the fourth guide wheel 477D mounted on the mounting seat 477 through the mounting groove 4798. The wire hole 4775 is connected to the long shaft 160 for guiding the drive cable into the long shaft 160.
[0126] like Fig. 12C and Fig.12E As shown, a first slide rail 4766A and a second slide rail 4766B are provided on both sides of a slide 4765 of a decoupling member 4762. After the slide 4765 is connected to the mounting seat 477, the first slide rail 4766A and the second slide rail 4766B can slide in a sliding area formed by a first guide wheel 476A, a second guide wheel 476B, a third guide wheel 476C and a fourth guide wheel 476D. The first slide rail 4766A is slidably arranged on the aligned second guide wheel 476B and the third guide wheel 476C, and the second slide rail is slidably arranged on the aligned first guide wheel 476A and the fourth guide wheel 476D. The two ends of the slide 4765 are respectively provided with a first installation space 4767 and a second installation space 4768, and the first guide portion 4763 and the second guide portion 4764 are respectively installed in the first installation space 4767 and the second installation space 4768. The slide 4765 also has a central opening 4781, which is used to accommodate the first mounting column 4776, the second mounting column 4777 and the third boss 4773, and cooperates with the first mounting column 4776, the second mounting column 4777 and the third boss 4773 to limit the sliding stroke of the slide 4765 within the sliding area on the mounting seat 477.
[0127] The slide 4765 has a first guide groove 4684 and a first fixing hole 4782 at one end, and a second guide groove 4685 and a second fixing hole 4783 at the other end. The first guide groove 4784 is used to guide the first decoupling cable 4767 to be fixed in the first fixing hole 4782, and the second guide groove 4785 is used to guide the second decoupling cable 4768 to be fixed in the second fixing hole 4783. The first guide groove 4684 and the second guide groove 4685 are staggered from each other in the height direction of the slide 4765, so that the first decoupling cable 4767 and the second decoupling cable 4768 can be fixed to the slide 4765 without interfering with each other.
[0128] The decoupling process of this embodiment is as follows Fig.12FAs shown, when the third drive unit 473 rotates counterclockwise (in the first direction) along with the shaft 473A driven by the actuator, since the main decoupling member 4761 and the third drive unit 473 are connected to the actuator via the same shaft 473A, the main decoupling member 4761 and the third drive unit 473 rotate counterclockwise along with the shaft 473A at the same angular velocity, and the third drive unit 473 retracts the sixth drive cable 153B and releases the fifth drive cable 153A at the same time, so that the end effector 150 performs the following operation: Fig. 7A and 7B The pitching movement shown in the figure, at the same time, the main decoupling member 4761 pulls the second decoupling cable 4768 and releases the first decoupling cable 4767 at the same time, so that the slave decoupling member 4762 moves along Fig.12F If the movement is in direction A, Fig.12F The decoupling element 4762 is relative to Fig. 11B In the embodiment, the decoupling member 4762 moves a distance L / 2 in the A direction from the zero position state where the decoupling member 4762 is located, and the lengths of the first driving cable 151A and the second driving cable 151B between the first guide portion 4763 and the first guide wheel 477A, and the lengths between the first guide portion 4763 and the third guide wheel 477C are both reduced by L / 2, so that the lengths of the first driving cable 151A and the second driving cable in the driving device 470 are reduced by L, and the length of the first pair of cables in the driving device is reduced by 2L. Correspondingly, the lengths of the third driving cable 152A and the fourth driving cable 152B between the second guide portion 4764 and the second guide wheel 477B, and the lengths between the second guide portion 4764 and the fourth guide wheel 477D are both increased by L / 2, so that the lengths of the third driving cable 152A and the fourth driving cable 152B in the driving device are increased by L, and the length of the first pair of cables in the driving device is increased by 2L. Thus, the decoupling mechanism 276 in the drive device 370 provides the change in length of the first drive cable 151A, the second drive cable 151B, the third drive cable 152A and the fourth drive cable 152B on one side of the end effector 150 required for the pitch movement of the end effector 150, thereby releasing the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables. The movement of the third pair of cables is no longer restricted by the first pair of cables and the second pair of cables, so that the end effector 150 can smoothly perform pitch operations.
[0129] When the third drive unit 473 and the main decoupling member 4761 rotate in a second direction (clockwise) opposite to the first direction, the lengths of the first drive cable 151A and the second drive cable in the drive device 470 increase by L, and the lengths of the third drive cable 152A and the fourth drive cable 152B in the drive device decrease by L, respectively. The specific process is exactly the opposite of the above-mentioned rotation in the first direction and will not be repeated here.
[0130] Figures 13A-13E It is a driving device 570 of an embodiment of the present invention, and the driving device 570 is provided with a first driving device 570 including a main body 578, and a first driving unit 571, a second driving unit 572, a third driving unit 573 and a fourth driving unit 774 arranged on the main body 778, the proximal ends of the first driving cable 151A and the second driving cable 151B are wound around the first driving unit 571 in an opposite manner, the proximal ends of the third driving cable 152A and the fourth driving cable 152B are wound around the second driving unit 572 in an opposite manner, and the proximal ends of the fifth driving cable 153A and the sixth driving cable 153B are wound around the third driving unit 573 in an opposite manner.
[0131] To better illustrate the relationship between the main decoupling member 5761 and the slave decoupling member 5762, Fig. 13B The third drive unit is not shown. Fig. 13B As shown, the driving device 570 further includes a mounting seat 577 and a decoupling mechanism disposed on the mounting seat 577, the decoupling mechanism includes a main decoupling member 5761 and a slave decoupling member 5762, the main decoupling member 5761 and the third driving unit 5762 are disposed on the same rotating shaft 573A, the main decoupling member 5761 is a cam that rotates at the same angular velocity as the third driving unit 5762, the slave decoupling member 5762 includes a carriage 5765 and a first guide portion 5763 and a second guide portion 5764 mounted on the carriage 5765, and similar to the previous embodiment, the driving device 570 further includes a first guide wheel 576A, a second guide wheel 576B, a third guide wheel 576C and a fourth guide wheel 576D disposed on the mounting seat 577. The rotation axis of the first guide wheel 576A is parallel to the rotation axis of the first guide portion 5763, and the rotation axis of the fourth guide wheel 576D is perpendicular to the rotation axis of the first guide wheel 576A and the rotation axis of the first guide portion 5763. The rotation axis of the second guide wheel 576B is parallel to the rotation axis of the second guide portion 5764, and the rotation axis of the third guide wheel 576C is perpendicular to the rotation axis of the second guide wheel 576B and the rotation axis of the second guide portion 5764. The first drive cable 151A and the second drive cable 151B are redirected by the first guide wheel 576A, guided by the first guide portion 5763 of the slave decoupling member 5762, and then guided by the third guide 576C, and then leave the drive device 570 and enter the long shaft 160. The third drive cable 152A and the fourth drive cable 152B are redirected by the first guide wheel 576A, guided by the slave decoupling member 5762, and then guided by the third guide 576C, and then leave the drive device 570 and enter the long shaft 160. The fifth drive cable 153A and the sixth drive cable 153B are redirected by the fifth guide wheel 576E and enter the long shaft 160.
[0132] like Fig. 13CAs shown, the mounting seat 577 includes a first boss 5771 and a second boss 5772. The mounting seat 577 is mounted on the main body 578 through the first boss 5771. The first guide wheel 576A, the second guide wheel 576B, the third guide wheel 576C, the fourth guide wheel 576D and the fifth guide wheel 576E are all mounted on the second boss 5772. The slave decoupling member 5762 includes a carriage 5765 and a first guide portion 5763 and a second decoupling portion 5764 mounted on the carriage 5765. The first guide portion 5763 is used to connect the first driving cable 151A and the second driving cable 151B to the slave decoupling member 5762, and the second guide portion 5764 is used to connect the third driving cable 152A and the fourth driving cable 152B to the slave decoupling member 5762. The slide 5765 includes 5766 and a second opening 5767. The first opening 5766 is used to accommodate the main decoupling member 5761, and the second opening 5767 is used to accommodate the second boss 5771 of the mounting seat 577. The side wall of the second boss 5771 cooperates with the side wall of the second opening 5767 to limit the movement of the slide 5765 in the vertical sliding direction.
[0133] Back to Fig. 13B The slide 5765 has a first protrusion 5768 and a second protrusion 5769 extending into the first opening 5766. The main decoupling member 5761 abuts against the first protrusion 5768 and the second protrusion 5769 in the first opening 5766. The first protrusion 5768 and the second protrusion 5769 can move on the outer contour of the main decoupling member 5761 when the main decoupling member 5761 rotates, so that the slide 5765 slides on the mounting seat 577. Fig.13DAs shown, the main decoupling member 5761 includes a first cam 5761A and a second cam 5761B fixed on the rotating shaft 573A, the first cam 5761A and the second cam 5761B are both semi-heart-shaped cams, the second cam 5761B and the first cam 4761 have the same outer profile on a plane perpendicular to the shaft 573A, the outer profile of the first cam 5761A on a plane perpendicular to the shaft 573A includes a heart-shaped involute S1 and a first arc S2 and a second arc S3 located at both ends of the involute S1, the first arc S2 and the second arc S3 have different radii, and the distance from the involute S1 to the axis of the rotating shaft 473A is from the first arc S1 to the second arc S3. Arc S2 begins to gradually increase toward the direction of the second arc S3, and the involute S1 has the following curve: that is, there is a linear relationship between the change P of the distance from the involute S1 to the axis of the rotating shaft 473A and the angle θ1 at which the first cam 5761A rotates along the shaft 473A, P=K1*θ1+K2, wherein K1 and K2 are constants, so that when the main decoupling component 5761 rotates at a constant speed, the distance from the contact point of the first convex body 5768 with the involute S1 of the first cam 5761 to the rotating shaft 573A and the distance from the contact point of the second convex body 5768 with the involute S1' of the second cam to the rotating shaft 573A also change linearly at a uniform speed. The first cam 5761A and the second cam 5761B together form a heart-shaped cam-type main decoupling component 5761. The first cam 5761A and the second cam 5761B are staggered up and down in the axial direction of the cam. The first cam 5761A cooperates with the first protrusion 5768 of the slide 5761 for movement, and the second cam 5761B cooperates with the second protrusion 5768 of the slide 5761 for movement, so that the main decoupling component 5761 drives the movement of the slave decoupling component 5762, thereby releasing the coupling relationship between the first pair of cables and the second pair of cables and the third pair of cables.
[0134] The decoupling process of the drive device 570 is as follows: Fig.13E As shown, the third driving unit 473 ( Fig.13E Not shown) from Fig. 13B The zero position of is driven by the actuator to rotate counterclockwise (first direction) to Fig.13E During the process of reaching the limit position, the third driving unit 473 retracts the sixth driving cable 153B and releases the fifth driving cable 153A at the same time. At this time, the end effector 150 is as shown in FIG. Fig. 7A , 7BAs the main decoupling member 4761 and the third driving unit 473 are arranged on the same rotating shaft 473A, the main decoupling member 4761 also moves counterclockwise, and the first cam 4761A of the main decoupling member 4761 rotates counterclockwise so that the first convex body 5768 moves on the involute S1 of the first cam 4761A in a direction in which the distance from the involute S1 to the rotating shaft 473A increases, and on the contrary, the second cam 4761B of the main decoupling member 4761 rotates counterclockwise so that the first convex body 5768 moves on the involute S1 of the second cam 4761B in a direction in which the distance from the involute S1 to the rotating shaft 473A decreases, and as the inner wall of the second opening 5767 of the slide 5765 cooperates with the mounting seat 577 to limit the slide 5765 from moving in a direction perpendicular to the A direction, the slide 5765 is driven by the main decoupling member 4761 to move linearly in the A direction.
[0135] The slide 5765 also has a first guide portion 5763 connected to the first pair of cables and a second guide portion 5764 connected to the second pair of cables, so that the length change of the first pair of cables and the second pair of cables in the driving device caused by the movement of the slide 5765 is linear, and Fig. 9B , Fig. 9C Similar to the embodiment shown, the movement direction of the carriage 5765 is parallel to the portion of the first pair of cables between the first guide wheel 576A and the first guide portion 5763, and the movement direction of the carriage 5765 is parallel to the portion of the second pair of cables between the second guide wheel 576B and the second guide portion 5764. The angles between the first drive cable 151A and the second drive cable 151B between the first guide portion 5763 and the fourth guide wheel 576D and the straight line along the A direction are equal. Similarly, the angles between the third drive cable 152A and the fourth drive cable 152B between the second guide portion 5764 and the third guide wheel 576C and the straight line along the A direction are equal. If Fig.13EWhen the slide 5765 is in the position, it moves a distance of L / 2 in the direction A under the drive of the main decoupling member 5761, then the length of the first drive cable 151A and the second drive cable 151B between the first guide wheel 576A and the first guide part 5763 is reduced by the above L / 2, and the length between the first guide part 5763 and the fourth guide wheel 576D is also reduced by the above L / 2, so that the length of the first drive cable 151A and the second drive cable 151B in the drive device 570 is reduced by L, that is, the length of the first pair of cables in the drive device 570 is reduced by 2L. The length of the third driving cable 152A and the fourth driving cable 152B between the second guide wheel 576B and the second guide portion 5764 increases by L / 2, and the length between the second guide portion 5764 and the third guide wheel 576C also increases by L / 2, so that the length of the third driving cable 152A and the fourth driving cable 152B in the driving device 570 increases by L, that is, the length of the second pair of cables in the driving device 570 increases by 2L. Thus, the decoupling mechanism in the driving device 570 provides the length variation of the first driving cable 151A, the second driving cable 151B, the third driving cable 152A, and the fourth driving cable 152B on one side of the end effector 150 required for the pitching movement of the end effector 150, thereby releasing the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables, and the movement of the third pair of cables is no longer restricted by the first driving cable and the second driving cable, so that the end effector 150 can smoothly perform the pitching operation.
[0136] If the main decoupling member 5761 continues to rotate so that the slide 5765 moves to the extreme position, the first convex body 5798 leaves the involute S1 of the first cam 5761A and enters the second arc S3, and the second convex body 5769 leaves the involute S1' of the second cam 5761B and enters the first arc S2'. Since the distance from the contact point between the first convex body 5798 and the first cam 5761A to the rotation axis 573A does not change when the first convex body 5798 moves on the first arc S1 and the second arc S2 of the first cam 5761A, similarly, the first convex body 5798 is When the two convex bodies 5798 move on the first arc S1' and the second arc S2' of the second cam 5761B, the distance between the contact point of the first convex body 5798 with the first cam 5761A and the rotation axis 573A no longer changes, so the slide 5765 no longer moves along the A direction, and the slide 5765 is at the limit position of movement along the A direction at this time. Therefore, due to the existence of the first arc S1, S1' and the second arc S2, S2' of the main decoupling member 5761, the main decoupling member 5761 continues to rotate when it rotates to the limit position, so that the slide continues to move. On the contrary, when the main decoupling member 5761 rotates clockwise, the movement of the first cam 5761A, the second cam 5761B and the slide is opposite to the counterclockwise movement of the main decoupling member 5761, which will not be described in detail here.
[0137] Figures 14A-14E The driving device 670 is an embodiment of the present invention, and the driving device 670 includes a main body 678, and a first driving unit 671, a second driving unit 672, a third driving unit 673 and a fourth driving unit 674 arranged on the main body 678, one end of a first pair of cables is wound around the first driving unit 671, the proximal ends of the first driving cable 151A and the second driving cable 151B are wound around the first driving unit 671 in an opposite manner, the proximal ends of the third driving cable 152A and the fourth driving cable 152B are wound around the second driving unit 672 in an opposite manner, and the proximal ends of the fifth driving cable 153A and the sixth driving cable 153B are wound around the third driving unit 673 in an opposite manner.
[0138] The driving device 670 also includes a mounting seat 677 and a decoupling mechanism 676 . The mounting seat 677 is mounted on the body 678 , and the decoupling mechanism 176 is mounted on the mounting seat 677 . The decoupling mechanism includes a main decoupling member 6761 and a slave decoupling member. The main decoupling member 6761 is a gear rotating coaxially with the third drive unit 673. The slave decoupling member includes a transmission wheel 6762 and a decoupling slider. The decoupling slider includes a first decoupling slider 6764 and a second decoupling slider 6765. The first decoupling slider 6764 and the second decoupling slider 6765 are separated from each other and move independently of each other. The transmission wheel 6762 is connected to the first decoupling slider 6764 through a first decoupling cable 6766. The transmission wheel 6762 is connected to the second decoupling slider 6765 through a second decoupling cable 6767. The first decoupling slider 6764 and the second decoupling slider 6765 can move relative to each other, and the movement direction of the first decoupling slider 6764 and the movement direction of the second decoupling slider 6765 are greater than ninety degrees. The transmission wheel 6762 includes a coaxially arranged capstan 6762A and a transmission gear 6762B, the transmission gear 6762B is meshed with the main decoupling member 6761 through an intermediate gear 6763, and the transmission wheel 6762 is driven by the main decoupling member 6761 and controls the movement of the first decoupling slider 6764 and the second decoupling slider 6765 through the first decoupling cable 6766 and the second decoupling cable 6767. In some other embodiments, the intermediate gear 6763 may not be arranged between the transmission wheel 6762 and the main decoupling member 6761, and the transmission wheel 6762 and the main decoupling member 6761 are directly meshed with gears.
[0139] The first drive cable 151A and the second drive cable 151B are redirected by the first guide wheel 677A, pass through the first decoupling slider 6764, and then are guided by the third guide wheel 677C to enter the long axis 160. The third drive cable 152A and the fourth drive cable 152B are redirected by the second guide wheel 677B, pass through the second decoupling slider 6765, and then are guided by the fourth guide wheel 677D to enter the long axis 160. The fifth drive cable 153A and the sixth drive cable 153B are redirected by the fifth guide wheel 677E and then directly enter the long axis 160.
[0140] One end of the first decoupling cable 6766 is fixed on the winch 6762A, and the other end is connected to the first decoupling slider 6764 after being redirected by the sixth guide wheel 6768. One end of the second decoupling cable 6767 is fixed on the winch 6762A in the opposite winding manner to the first decoupling cable 6776, and the other end is connected to the second decoupling slider 6765 after being redirected by the seventh guide wheel 6769. The first decoupling cable 6766 and the second decoupling cable 6764 respectively manipulate the first decoupling slider 6764 and the second decoupling slider 6765 to slide on the mounting seat 677 to change the length of the first pair of cables and the second pair of cables in the driving device 670, thereby achieving the release of the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables. It can be understood that in some other embodiments, the first decoupling cable and the second pair of cables can also be connected to the first decoupling slider and the second decoupling block without passing through the guide wheel, but using other redirecting components, such as a curved conduit.
[0141] Fig. 14C Exploded view of mounting base 677 and decoupling parts. Fig. 14CThe installation relationship between the slave decoupling member and the mounting seat 477 is more clearly demonstrated. The mounting seat 477 has a first boss 4771, and the mounting seat 477 is installed on the main body 478 through the first boss 4771. The first boss 4771 has a second boss 6772 and a third boss 6773. The second boss 6772 has a first mounting hole 6781 and a second mounting hole 6782. The rotating shaft of the transmission wheel 6762 of the slave decoupling member is installed in the first mounting hole 6781, and the rotating shaft of the intermediate gear 6763 is installed in the second mounting hole 6782. The transmission wheel 6762 is meshed with the intermediate gear 6763 through the transmission gear 6762B to receive the driving force from the main decoupling member 6761. The third boss 6773 has a third mounting hole 6783, a fourth mounting hole 6784, a fifth mounting hole 6785 and a sixth mounting hole 6786. The third mounting hole 6783 is used to install the sixth guide wheel 6768 on the third boss 6773, the fourth mounting hole 6784 is used to install the seventh guide wheel 6769 on the third boss 6773, the fifth mounting hole 6785 is used to install the first guide wheel 677A on the third boss 6773, and the sixth mounting hole 6786 is used to install the second guide wheel 677B on the third boss 6773. The third boss 6773 also has a first slide groove 6791 and a second slide groove 6792. The first slide groove 6791 and the second slide groove 6792 have an acute angle to reduce the volume occupied by the mounting base 677. The first slide groove 6791 and the second slide groove 6792 are used to accommodate the first decoupling slider 6764 and the second decoupling slider 6795 respectively. The first decoupling slider 6764 and the second decoupling slider 6795 can slide in the first slide groove 6791 and the second slide groove 6792. The third boss 6773 also has a first boss 6775, a second boss 6776 and a third boss 6777. The first boss 6775, the second boss 6776 and the third boss 6777 form a guide hole for guiding the drive cable into the long axis 160. A mounting groove for installing the fifth guide wheel 677E is formed between the boss 6775 and the second boss 6776. A fourth guide wheel 677D is formed between the second boss 6776 and the third boss 6777. A mounting groove for installing the third guide wheel 677C is formed between the first boss 6775 and the third boss 6777. The third guide wheel 677C, the fourth guide wheel 677D and the fifth guide wheel 677E are respectively used to guide the first pair of cables, the second pair of cables and the third pair of cables into the guide hole.
[0142] The first decoupling slider 6764 from the decoupling member includes a first slider body 6764A and a first guide portion 6764B and a first fixing member 6764C installed on the first slider body 6764A, the first guide portion 6764B is used to guide the first driving cable 151A and the second pair of cables 151B, the first fixing member 6764C is used to fix the first decoupling cable 6766 to the first decoupling slider 6764, so that the transmission wheel 6762 can control the movement of the first decoupling slider 6764 through the first decoupling cable 6766. The second decoupling slider 6765 includes a second slider body 6765A, a second guide portion 6765B mounted on the second slider body 6765A, and a second fixing member 6764C. The decoupling of the second decoupling slider 6765 is basically the same as that of the first decoupling slider 6764, except that the ninth guide wheel 6764B of the second decoupling slider 6765 is used to guide the third driving cable 152A and the fourth driving cable 152B and the second fixing member is used to fix the second decoupling cable 6767. Fig.14D Further details of the first decoupling slider are shown, e.g. Fig.14D The first slider body 6764A of the first decoupling slider 6764 shown includes a first protrusion 6793 and a second protrusion 6794 arranged opposite to the first protrusion 6793. The first guide portion 6764B is installed between the first protrusion 6793 and the second protrusion 6794. Like the above-mentioned embodiment, the first guide portion 6764B also has two pulleys arranged side by side, and the two pulleys are used to guide the first drive cable 151A and the second drive cable 151B respectively. The first decoupling slider 6764 also has a third protrusion 6795 on the side opposite to the first protrusion 6793 and the second protrusion 6794. The third protrusion 6795 is used to install the first fixing member 6764C. The first decoupling cable 6766 is fixed between the first fixing member 6764C and the third protrusion 6795 by the first fixing member 6764C.
[0143] The decoupling process of this embodiment is as follows Fig.14E As shown, when the third driving unit 673 is driven by the actuator to rotate counterclockwise along the shaft 673A, since the main decoupling member 6761 and the third driving unit 673 are connected to the actuator through the same shaft 673A ( Fig.14E The main decoupling member 6761 is blocked by the third drive unit 673 and is not visible. At this time, the main decoupling member 6761 and the third drive unit 673 rotate counterclockwise (in the first direction) with the shaft 473A at the same angular velocity. The third drive unit 473 retracts the sixth drive cable 153B and releases the fifth drive cable 153A at the same time, so that the end effector 150 performs the following operation: Fig. 7A and 7BAt the same time, the main decoupling member 6761 drives the transmission wheel 6762 to rotate counterclockwise through the intermediate gear 6763 meshing therewith, so that the driven wheel 6762 releases the first decoupling cable 6767 and simultaneously pulls the second decoupling cable 6768, so that the first decoupling slider 6764 is relatively Fig. 14B The zero position shown has moved a distance L / 2 in the A direction. Similarly, the second decoupling slider 6765 has moved a distance L / 2 in the B direction relative to the zero position. Similar to the previous embodiment, the movement direction of the first decoupling slider 676 is parallel to the portion of the cables between the first drive cable 151A and the second drive cable 151B between the second guide wheel 677B and the first decoupling slider 6764, and the change in length of the first drive cable 151A and the second drive cable 151B between the second guide wheel 677B and the first decoupling slider 6764 is linearly related to the change in the movement distance of the first decoupling slider 6764, so that the length of the first drive cable 151A and the second drive cable 151B between the second guide wheel 677B and the first decoupling slider 6764 is reduced by L / 2. Similarly, the length between the third guide wheel 677C and the first decoupling slider 6764 is also reduced by L / 2, so that the length of the first drive cable 151A and the second drive cable 151B in the drive device 670 is reduced by L, that is, the length of the first pair of cables in the drive device is reduced by 2L. Similarly, part of the cables of the third drive cable 152A and the fourth drive cable 152B between the first guide wheel 677A and the second decoupling slider 6765 are parallel to the movement direction of the second decoupling slider 6765, and the length of the third drive cable 152A and the fourth drive cable 152B between the first guide wheel 677A and the second decoupling slider 6765 is increased by L / 2, and the length between the fourth guide wheel 677D and the second decoupling slider 6765 is also increased by L / 2, so that the length of the third drive cable 152A and the fourth drive cable 152B in the drive device 670 is increased by L, that is, the length of the second pair of drive cables in the drive device is increased by 2L. Thus, the decoupling mechanism 676 in the drive device 670 provides the change in length of the first drive cable 151A, the second drive cable 151B, the third drive cable 152A and the fourth drive cable 152B on one side of the end effector 150 required for the pitch movement of the end effector 150, thereby releasing the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables. The movement of the third pair of cables is no longer restricted by the first drive cables and the second drive cables, so that the end effector 150 can smoothly perform pitch operations.
[0144] Fig.15The driving device 770 of one embodiment of the present invention comprises a first driving unit 771, a second driving unit 772, a third driving unit 773 and a fourth driving unit 774, the proximal ends of the first driving cable 151A and the second driving cable 151B are wound around the first driving unit 771 in opposite ways, the proximal ends of the third driving cable 152A and the fourth driving cable 152B are wound around the second driving unit 772 in opposite ways, and the proximal ends of the fifth driving cable 153A and the sixth driving cable 153B are wound around the third driving unit 773 in opposite ways.
[0145] The decoupling mechanism of the driving device 770 includes a main decoupling member 7761 and a slave decoupling member 7762. The main decoupling member 7761 is used to drive the slave decoupling member 7762 to move so as to release the above coupling relationship. Different from the above embodiments, the main decoupling member 7761 in this embodiment is not directly connected to the third driving unit 773, the main decoupling member 7761 and the third driving unit 773 are non-coaxially arranged, and the main decoupling member 7761 moves independently of the third driving unit 773, that is, the main decoupling member 7761 does not receive the driving force from the actuator driving the third driving unit 773 to drive the slave decoupling member 7762 as in the above embodiments, and the main decoupling member 7761 drives the slave decoupling member 7762 to move according to the pitch indication information of the pitch device that can characterize the end effector 150.
[0146] The decoupling mechanism also includes a detection unit and a control unit. The detection unit includes a first tension sensor TS1, a second tension sensor TS2, a third tension sensor TS3, and a fourth tension sensor TS4, which are respectively arranged on the first drive cable 151A, the second drive cable 152B, the third drive cable 152A, and the fourth drive cable 152B and are used to detect the tension changes thereof. The first tension sensor TS1, the second tension sensor TS2, the third tension sensor TS3, and the fourth tension sensor TS4 transmit the detected tension change information to the control unit (not shown in the figure). The control unit receives the signal input of the detection unit and outputs a control signal after processing to control the movement of the main decoupling component 7761. It can be understood that the control unit is not limited to being arranged in the drive device, and can also be arranged in the mechanical arm or the main control console, as long as it can communicate with the detection unit and control the movement of the main decoupling component.
[0147] The other parts of the drive device 770 and Fig. 8ASimilar to the embodiment shown, specifically, the driving device 770 also includes a first guide wheel 777A, a second guide wheel 777B, a third guide wheel 777C and a fourth guide wheel 777D, and the slave decoupling member 7762 includes two guide parts, namely a first guide part 7767 and a second guide part 7765, and the first guide part 7767 and the second guide part 7765 are connected by a slide 7763 in the middle, and the main decoupling member 7761 is connected to the slave decoupling member 7762 by a first decoupling cable 1768 and a second decoupling cable 1769. The first drive cable 151A and the second drive cable 151B are first redirected by the first guide wheel 777A, and then are guided by the first guide part 7764 of the decoupling member 7762, and finally enter the long axis 160 through the third guide wheel 777C. The third drive cable 152A and the fourth drive cable 152B are redirected by the second guide wheel 777B, and then are guided by the second guide part 7765 of the decoupling member 7762, and finally enter the long axis 160 through the fourth guide wheel 777D.
[0148] The decoupling process of the drive device 770 is as follows: Fig.15 As shown, when the third driving unit 773 rotates counterclockwise (in the first direction), the third driving cable 773 pulls the fourth driving cable 153B and releases the third driving cable 153A at the same time. At this time, the end effector 150 is as shown in FIG. Fig. 7A , 7B Since the third pair of cables is coupled with the first pair of cables and the second pair of cables, the end effector 150 is Fig. 7A , 7B During the pitching motion shown, the tension of the first driving cable 151A and the second driving cable 151B will increase rapidly. The control unit receives and processes input signals from the first tension sensor TS1, the second tension sensor TS2, the third tension sensor TS3 and the fourth tension sensor TS4. Due to the increase in the tension of the first driving cable 151A and the second driving cable 151B and the decrease in the third driving cable 152A and the fourth driving cable 152B, the control unit will output a control signal to control the rotation of the main decoupling component 7761 to balance the tension of the first driving cable 151A to the fourth driving cable 152B.
[0149] Specifically, the control unit controls the main decoupling member 7761 to rotate counterclockwise, at which time the main decoupling member 7761 will retract the second decoupling cable 7769 and release the first decoupling cable 7768. At this time, if the tension change of the first pair of cables and the second pair of cables caused by the pitching movement of the end effector 150 is balanced, the main decoupling member unit 7762 will move along the A direction for a distance of L / 2. If the main decoupling member unit 7762 moves along the A direction for a distance of L / 2, similar to the above embodiments, since the first pair of cables are on the first guide wheel 777A and Part of the cables between the first guide portion 7764 is parallel to the movement direction of the slave decoupling member 7762, and part of the cables between the first guide portion 7764 and the third guide wheel 777C is roughly parallel to the movement direction of the slave decoupling member 7762. Similarly, part of the cables of the second pair of cables between the second guide wheel 777B and the second guide portion 7765 is parallel to the movement direction of the slave decoupling member 7762, and part of the cables of the second pair of cables between the second guide portion 7765 and the fourth guide wheel 777D is roughly parallel to the movement direction of the slave decoupling member 7762. Therefore, the distance between the first drive cable 151A and the second drive cable 151B between the first guide wheel 777A and the first guide portion 7764 and the distance between the first guide portion 7764 and the third guide wheel 777C is reduced by L / 2, so that the length of the first drive cable 151A and the second drive cable 151B in the drive device is reduced by L, that is, the length of the first pair of cables in the drive device 770 is reduced by 2L. On the contrary, the length of the third drive cable 152A and the fourth drive cable 152B in the drive device is increased by 2L, that is, the distance between the second pair of cables in the drive device 770 is increased by 2L. The reason for the length change L of the first to fourth driving cables in the driving device is the number of guides connected to the first pair of cables and / or the second pair of cables on the decoupling member 7765. In this embodiment, the number of guides is 2, and the length change of the first driving cable and / or the third driving cable in the driving device is twice the moving distance of the corresponding decoupling member 7765. It can be understood that in other embodiments, the number of guides on the decoupling member can also be other numbers. If the number of guides on the decoupling member is N, the length change of the first pair of cables and / or the second pair of cables in the driving device is the moving distance of the corresponding decoupling member 7765.
[0150] Thus, the decoupling mechanism within the drive device 770 provides the change in length of the first drive cable 151A, the second drive cable 151B, the third drive cable 152A and the fourth drive cable 152B on one side of the end effector 150 required for the pitch movement of the end effector 150, thereby releasing the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables. The movement of the third pair of cables is no longer restricted by the first drive cables and the second drive cables, so that the end effector 150 can smoothly perform pitch operations.
[0151] Since the drive cable will always wear out during use, and there will be corresponding errors in the detection of the tension sensor, the use of the tension of the drive cable as the pitch indication information of the end effector 150 may not be able to decouple very accurately. For example, in theory, the decoupling member 7762 needs to move a distance of L / 2 to achieve complete decoupling. However, due to the error of the tension sensor, the control unit may control the movement distance of the decoupling member 7762 to be not L / 2 based on the data of the tension sensor. Therefore, in one embodiment, the rotation state of the third drive unit 773 is used as the pitch state indication information of the end effector 150. The detection unit of the drive device 770 is an encoder connected to the third drive unit 773. The encoder can accurately detect the rotation angle of the third drive unit 773, so that the control unit can accurately obtain the rotation angle of the third drive unit 773 in real time, and then can accurately calculate the pitch angle of the end effector 150 to control the movement of the decoupling member 7762, thereby Figures 9A-14A As in each embodiment, the decoupling mechanism in the driving device 770 can accurately provide the length changes of the first driving cable 151A, the second driving cable 151B, the third driving cable 152A and the fourth driving cable 152B on one side of the end effector 150 required for the pitching movement of the end effector 150, thereby releasing the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables, and the movement of the third pair of cables is no longer restricted by the first driving cable and the second driving cable, so that the end effector 150 can smoothly perform the pitching operation. In some other embodiments, the decoupling mechanism does not need to be provided with a detection unit, and the control unit of the decoupling mechanism and the third driving unit simultaneously receive the control signal from the main control console, and the control signal from the main control console is used as the pitch state indication information of the end effector 150. The control unit can control the main decoupling component and the third driving unit to operate synchronously through the control signal from the main control console.
[0152] An embodiment of the present invention is suitable for driving Figures 8A-8E The drive device of the end effector 250 shown is as follows Fig.16A , 16BAs shown, the driving device 870 includes a first driving unit 871 for driving the yaw motion of the end effector 250, a second driving unit 872 for driving the pitch motion of the end effector 250, and a third driving unit 873 for driving the rotation motion of the end effector 250. The first driving cables 251A and 251B of the first pair of cables for manipulating the yaw motion of the end effector 250 are wound around the first driving unit 871 in opposite ways, the proximal ends of the second driving cables 252A and the third driving cables 252B of the second pair of cables for manipulating the pitch motion of the end effector 250 are wound around the second driving unit 872 in opposite ways, and the fourth driving cable 253A for driving the rotation of the long axis 160 is wound around the third driving unit 873. Based on the above-mentioned Figures 8A-8E It can be seen from the above that there is also a coupling relationship between the second pair of cables and the first pair of cables, and the driving device 870 also includes a decoupling mechanism for releasing the coupling relationship between the second pair of cables and the first pair of cables.
[0153] The decoupling mechanism includes a main decoupling member 8761 and a slave decoupling member 8762. The main decoupling member 8761 and the second driving unit 872 are arranged on the same rotating shaft 872A. The main decoupling member 8761 and the second driving unit 872 move with the same angular velocity along the rotating shaft 872A. The main decoupling member 8761 receives the same driving power from the second driving unit 872 and drives the slave decoupling member 8762 to move to release the above coupling relationship. The slave decoupling member 8762 includes a guide portion 8763 and a carriage 8764. The main decoupling member 8761 is connected to one end of the carriage 8764 through a first decoupling cable 8765 and is connected to the other end of the carriage 8764 through a second decoupling cable 8766. The driving device 870 drives the slave decoupling member 8763 to move in a straight line through the first decoupling cable 8765 and the second decoupling cable 8766.
[0154] The driving device further includes a first guide wheel 877A, a second guide wheel 877B, a third guide wheel 8767, and a fourth guide wheel 8768. The first pair of cables are first redirected by the first guide wheel 877A, then pass through the guide portion 8763, and finally enter the long shaft 160 through the second guide wheel 877B. The first decoupling cable 8765 is redirected by the third guide wheel 8767 and connected to the slide 8764. The second decoupling cable 8766 is redirected by the fourth guide wheel 8768 and connected to the slide 8764. The portion of the first decoupling cable 8765 between the third guide wheel 8767 and the slide 8764 is parallel to the movement direction of the slide 8764. The portion of the second decoupling cable 8766 between the fourth guide wheel 8768 and the slide 8764 is also parallel to the movement direction of the slide 8764. Therefore, during the decoupling process, the movement speed of the slide 8764 is directly proportional to the rotational linear speed of the main decoupling member 8761. It can be understood that in some other embodiments, the main decoupling component can also be connected to the slave decoupling component through gears or cams as in the previous embodiments. Please refer to the above-mentioned gear connection or cam connection embodiments for details, which will not be repeated here.
[0155] Part of the first drive cable 251A and the second drive cable 251B between the first guide wheel 877A and the guide part 8763 is parallel to the movement direction of the slide 8764, and part of the first drive cable 251A and the second drive cable 251B between the guide part 8763 and the second guide wheel 877B is roughly parallel to the movement direction of the slide 8764. Therefore, during the decoupling process, the speed of the length change of the first drive cable 251A and the second drive cable 251B in the drive device is directly proportional to the linear motion speed of the slide 8764. As mentioned above, the movement speed of the slide 8764 is directly proportional to the rotation linear speed of the main decoupling component 8761 and the rotation linear speed of the second drive unit 872. Therefore, the speed of the length change of the first drive cable 251A and the second drive cable 251B in the drive device is directly proportional to the rotation linear speed of the main decoupling component 8761 and the rotation linear speed of the second drive unit 872, making the decoupling process more precise and controllable. In this embodiment, the speed at which the length of the first drive cable 251A and the second drive cable 251B changes in the drive device is twice the rotational linear speed of the main decoupling member 8761 .
[0156] The decoupling process of the decoupling mechanism is as follows: Fig. 16BAs shown, when the second driving unit 872 rotates counterclockwise (in the first direction), the second driving unit retracts the fourth driving cable 252B and releases the third driving cable 252A at the same time. Since the main decoupling member 8761 and the second driving unit 872 rotate at the same angular speed, the main decoupling member 8761 retracts the second decoupling cable 8766 and releases the first decoupling cable 8765 at the same time, so that the slave decoupling member 8762 moves along the A direction, thereby reducing the length of the first pair of cables in the driving device 870 and increasing the length of the first pair of cables on the end effector 250. If the driving unit 8762 moves along the A direction by a distance of L / 2, similar to the previous embodiments, the lengths of the first driving cable 251A and the second driving cable 251B in the driving device 870 are reduced by a length L respectively.
[0157] like Fig.8D and Fig. 16B As shown, if the radius of the third pulley 443 and the fourth pulley 444 are both r1, the radius of the bottom of the annular groove 421A on the pitch wheel 421 for accommodating the second pair of cables is R1, the radius of the main decoupling member 8761 is r2, and the radius of the second drive unit 872 is R2, in order to achieve accurate decoupling, the radius r1 of the third pulley 443 and the fourth pulley 444, the radius R1 of the bottom of the annular groove 421A, the radius r2 of the main decoupling member 8761, and the radius R2 of the second drive unit 872 satisfy the following relationship:
[0158]
[0159] The specific derivation process and the above Fig. 7A In other embodiments, the number of guide parts of the slave decoupling member may be other numbers, so that the relationship between the ratio of the radius of the third drive unit to the radius of the main decoupling member and the ratio of the radius of the pitch wheel to the radius of the second pulley block also changes accordingly. For example, the slave decoupling member may have N guide wheels, and the ratio of the radius of the third drive unit to the radius of the main decoupling member is 2*N times the ratio of the radius of the pitch wheel to the radius of the second pulley block, that is: However, as the number of guide parts of the slave decoupling member increases, the volume of the slave decoupling member also increases accordingly. It is more preferred that the slave decoupling member in the above embodiment uses one guide part, which is a pulley through which the first drive cable on the slave decoupling member passes.
[0160] Thus, the decoupling mechanism in the driving device 870 provides the length variation of the first driving cable 251A and the second driving cable 251B on one side of the end effector 250 required for the pitching movement of the end effector 250, thereby releasing the coupling relationship between the third pair of cables and the first pair of cables and the second pair of cables. The movement of the third pair of cables is no longer restricted by the first driving cable and the second driving cable, so that the end effector 250 can smoothly perform the pitching operation, and the end effector 250 can achieve Fig.8D , 8E Pitch motion shown.
[0161] When the main decoupling component 8761 and the second driving unit 872 rotate coaxially clockwise, the change of the driving cable caused is opposite to that of the counterclockwise rotation. At this time, the second driving unit 872 retracts the third driving cable 252A and releases the fourth driving cable 252B. The main decoupling component 8761 retracts the first decoupling cable 8765 and releases the second decoupling cable 8766 to drive the slave decoupling component 8762 to move in the direction opposite to direction A, thereby increasing the length of the first driving cables 251A and 251B in the driving device at the same time. The increased length is exactly equal to the reduction of the first driving cable 251A and the second driving cable 251B on the second pulley set of the end effector 250. The first driving cable 251A and the second driving cable 251B will no longer be loose on the end effector 250, so that the end effector 250 can be smoothly operated with the end effector 250. Fig.8D The pitch motion in the opposite direction shown,
[0162] The above-mentioned embodiments only express several implementation methods of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for ordinary technicians in this field, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.
Claims
1. A surgical instrument, comprising an end effector, a drive device and a cable, wherein the drive device is configured to drive the end effector to move through the cable, the cable comprising a first pair of cables for driving the end effector to perform a yaw motion and a second pair of cables for driving the end effector to perform a pitch motion, It is characterized in that The driving device comprises: a driving unit, one end of the second pair of cables being connected to the driving unit, and the driving unit driving the end effector to perform a pitch motion through the second pair of cables; A decoupling mechanism, the decoupling mechanism includes a main decoupling member and a slave decoupling member, the main decoupling member is coaxially arranged with the driving unit, the radius of the driving unit is greater than the radius of the main decoupling member, the main decoupling member is used to rotate coaxially with the driving unit and drive the slave decoupling member to move to increase or decrease the length of the first pair of cables in the driving device, so that the driving unit drives the end effector to perform a pitching motion, the slave decoupling member includes a slide and a guide portion, the guide portion is installed at one end of the slide, the first pair of cables extend to the end effector after being guided by the guide portion, the main decoupling member is connected to the slide and drives the slide to move to change the length of the first pair of cables in the driving device, the slave decoupling member also includes a first decoupling cable and a second decoupling cable, the main decoupling member is connected to the slide through the first decoupling cable and the second decoupling cable, the main decoupling member is used to drive the slide to move through the first decoupling cable and the second decoupling cable to change the length of the first pair of cables in the driving device.
2. The surgical instrument according to claim 1, It is characterized in that The master decoupling member drives the slave decoupling member to move in a straight line to increase or decrease the length of the first pair of cables in the driving device.
3. The surgical instrument according to claim 2, It is characterized in that The first pair of cables includes a first driving cable and a second driving cable, and the first driving cable and the second driving cable cooperate to drive the yaw motion of the end effector. The second pair of cables includes a third driving cable and a fourth driving cable. The driving unit is used to rotate to retract one of the third driving cable and the fourth driving cable and release the other driving cable so that the lengths of the first driving cable and the second driving cable on the end effector are increased or decreased simultaneously.
4. The surgical instrument according to claim 3, It is characterized in that The drive unit and the main decoupling component are used to rotate the drive unit in a first direction to release the third drive cable and pull the fourth drive cable to increase the length of the first drive cable and the second drive cable on the end actuator, and the slave decoupling component moves under the drive of the main decoupling component to reduce the length of the first drive cable and the second drive cable in the drive device.
5. The surgical instrument according to claim 4, It is characterized in that The driving unit and the main decoupling member rotate along a second direction opposite to the first direction, and the driving unit retracts the third driving cable and releases the fourth driving cable, so that the lengths of the first driving cable and the second driving cable on the end actuator are reduced. At the same time, the slave decoupling member moves under the drive of the main decoupling member to increase the lengths of the first driving cable and the second driving cable in the driving device.
6. The surgical instrument according to claim 5, It is characterized in that The main decoupling member is rotated in the first direction to release the first decoupling cable and pull the second decoupling cable to move the carriage to reduce the length of the first drive cable and the second drive cable in the drive device.
7. The surgical instrument according to claim 6, It is characterized in that The main decoupling member rotates in a second direction opposite to the first direction to retract the first decoupling cable and retract the second decoupling cable so that the carriage moves along to reduce the length of the first drive cable and the second drive cable in the drive device.
8. The surgical instrument according to claim 7, It is characterized in that The driving device also includes a first guide wheel, the first pair of cables are guided by the first guide wheel and then extend to the end actuator after passing through the guide part, and the movement direction of the slide is parallel to the part of the first pair of cables between the first guide wheel and the guide part.
9. The surgical instrument according to claim 8, It is characterized in that The driving unit and the main decoupling member rotate simultaneously so that the length change of the first driving cable or the third driving cable on the end effector is equal to twice the distance moved by the carriage under the drive of the main decoupling member.
10. The surgical instrument according to claim 8, It is characterized in that The driving device also includes a second guide wheel, the first pair of cables are guided by the first guide wheel and then by the second guide wheel to extend to the end effector, and the axis of the first guide wheel is perpendicular to the axis of the guide part.
11. The surgical instrument according to claim 6, It is characterized in that The driving device also includes a third guide wheel and a fourth guide wheel, and the first decoupling cable and the second decoupling cable are connected to the slide after being guided by the third guide wheel and the fourth guide wheel respectively, and the movement direction of the slide is parallel to the part of the first decoupling cable between the third guide wheel and the slide and the part of the second decoupling cable between the fourth guide wheel and the slide.
12. A slave operating device, It is characterized in that The slave operating device comprises a robotic arm and a surgical instrument as described in any one of claims 1 to 11, wherein the surgical instrument is mounted on the robotic arm, and the robotic arm is used to manipulate the movement of the surgical instrument.
13. A surgical robot, It is characterized in that The surgical robot comprises a main operating console and a slave operating device as claimed in claim 12, wherein the slave operating device performs corresponding operations according to instructions of the main operating console.
Citation Information
Patent Citations
Cable length conserving medical instrument
CN110198681A
Surgical instrument, slave operating equipment and surgical robot
CN212853622U