WO2024046147A1 - Surgical system and force feedback method - Google Patents
Surgical system and force feedback method Download PDFInfo
- Publication number
- WO2024046147A1 WO2024046147A1 PCT/CN2023/113782 CN2023113782W WO2024046147A1 WO 2024046147 A1 WO2024046147 A1 WO 2024046147A1 CN 2023113782 W CN2023113782 W CN 2023113782W WO 2024046147 A1 WO2024046147 A1 WO 2024046147A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- motor
- force
- clamping
- angle
- opening
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Ceased
Links
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
- A61B34/37—Leader-follower robots
Definitions
- the present application relates to the field of medical devices, and in particular to a master-slave remote operation surgical system and a force feedback method.
- Minimally invasive surgery refers to a surgical method that uses modern medical instruments such as laparoscope and thoracoscope and related equipment to perform surgery inside the human cavity. Compared with traditional surgical methods, minimally invasive surgery has the advantages of less trauma, less pain, and faster recovery.
- Minimally invasive medical robot-assisted surgery systems usually include a master console and a slave operating device.
- the doctor controls the slave operating device by controlling the input device of the master console.
- the slave operating device is used to respond to the control commands sent by the master console and perform the corresponding surgery. operate.
- the instrument is connected to a driving device of the slave operating device for performing surgical operations.
- the distal end of the instrument includes an end effector for performing surgical operations and a joint assembly connected to the end effector that can move with multiple degrees of freedom.
- the present application provides a surgical system in a first aspect, which includes a surgical instrument including a clamping part; an input device including a gripping part for controlling the gripping part. Opening and closing angle; driving device, which includes a first motor and a second motor, the first motor and the second motor Used to drive the clamping part to perform opening and closing actions; the controller is configured as:
- the operating data of the first motor and the second motor includes one of the current, voltage, and rotation speed of the first motor and the second motor.
- the surgical instrument further includes a long shaft and a wrist, the clamping part is rotatably connected to the wrist, and the wrist is rotatably connected to the distal end of the long shaft;
- the driving device includes a third motor for driving the wrist to perform a pitching action.
- the third motor drives the wrist to perform a pitching action
- the first and second motors can remain stationary to maintain the clamp. The opening and closing angle of the handle remains unchanged;
- controller is further configured to:
- controller is further configured to:
- the surgical instrument also contains a plurality of winches and a decoupling mechanism in the instrument box, and the first and second winches of the plurality of winches are respectively used to receive the first and second winches.
- the power input of the motor, the first winch is connected to the clamping part through a first pair of cables, the second winch is connected to the clamping part through a second pair of cables, the first pair of cables and the A second pair of cables is wound around the decoupling mechanism, and when the first motor drives the wrist to rotate, the decoupling mechanism moves to increase the tension in the first pair of cables and the second pair of cables.
- the length of one pair of cables in the instrument box is reduced by the length of the other pair of cables in the instrument box, thereby maintaining the opening and closing angle of the clamping portion unchanged.
- the input device further includes an actuator and a link assembly.
- One end of the link assembly is connected to the actuator and the other end is connected to the holding member.
- the actuator A feedback force is provided to the gripping member based on the clamping force and through the linkage mechanism.
- the linkage mechanism includes a first link and a second link.
- One end of the first link is rotatably connected to the handle, and the other end is connected to one end of the second link. Rotatingly connected, the other end of the second link is connected with the actuator.
- the input device includes a housing, an actuator and a first sheave connected to the actuator, and the first sheave is rotationally connected to the housing through a first pin, The first sheave is connected to the holding member through a first cable, and the actuator provides a feedback force to the holding member based on the clamping force and through the first cable.
- the present application provides a surgical system, including a surgical instrument, a driving device and a controller.
- the surgical instrument includes a long shaft, including a proximal part and a distal part; and an end effector, including a wrist and a clamping part. , the wrist is rotatably connected to the distal part, and the clamping part is rotatably connected to the wrist;
- the driving device includes a plurality of motors, the first motor and the second motor of the plurality of motors are used to drive the clamping part to perform opening and closing actions, and the third motor of the plurality of motors drives the wrist part to perform pitching. action
- the first and second motors can remain stationary to maintain the opening and closing angle of the clamping portion unchanged;
- the controller is configured as:
- the present application provides a force feedback control method for a surgical system.
- the remote operation surgical system includes a surgical instrument, an input device and a driving device.
- the surgical instrument includes a clamping part;
- the input device includes a grip.
- a holding member used to control the opening and closing angle of the clamping portion;
- the driving device includes a first motor and a second motor, and the first motor and the second motor are used to drive the clamping portion to perform opening and closing actions;
- the methods include:
- Figure 1 is a top view of a remotely operated surgical system for surgical operations according to one embodiment of the present application
- Figure 2 is a schematic diagram of a device according to an embodiment of the present application.
- Figure 3A is a schematic diagram of the main console of the surgical system according to an embodiment of the present application.
- Figure 3B is a schematic diagram of the input device of the main console according to an embodiment of the present application.
- Figure 4 is a schematic diagram of a slave operating device of the surgical system according to an embodiment of the present application.
- Figure 5 is a schematic diagram of the robotic arm of the slave operating device according to an embodiment of the present application.
- 6A-6D are schematic diagrams of the end effector of the surgical instrument according to one embodiment of the present application.
- Figures 7A-7B are schematic diagrams of the end effector performing a pitching action according to the embodiment shown in Figures 6A-6D;
- Figure 8A is a schematic diagram of the internal structure of the instrument box of the surgical instrument shown in Figures 6A-6D;
- FIGS 8B-8C are schematic diagrams of the instrument box decoupling process shown in Figure 8A;
- 9A-9B are schematic diagrams of an end effector of a surgical instrument according to another embodiment of the present application.
- Figure 10A is a schematic diagram of the internal structure of the instrument box of the surgical instrument shown in Figures 9A-9B;
- FIGS 10B-10C are schematic diagrams of the instrument box decoupling process shown in Figure 10A;
- Figure 11A is a schematic diagram of the handle of the input device according to an embodiment of the present application.
- Figure 11B is a cross-sectional view of the handle shown in Figure 11A;
- Figure 11C is a cross-sectional view of the handle shown in Figure 11A from another perspective;
- Figure 12 is a schematic diagram of the applied force analysis of the end effector clamping member according to one embodiment of the present application.
- Figure 13A is a schematic diagram of the handle of the input device according to one embodiment of the present application.
- Figure 13B is a perspective view of the handle of the embodiment shown in Figure 13A.
- a component when a component is said to be “set on” another component, it can be directly placed on another component. There can also be centered components on the component.
- an element When an element is said to be “connected” to another element, it can either be directly connected to the other element, intervening elements may also be present, or the two elements can be interconnected via signals.
- an element When an element is said to be “coupled” to another element, it can either be directly coupled to the other element, intervening elements may also be present, or the two elements can interact via signals.
- distal and proximal used in this article are directional terms, which are commonly used terms in the field of interventional medical devices. “Distal” refers to the end far away from the surgeon during the operation, and “proximal” refers to the operation. The end of the procedure closest to the surgeon.
- tool is used herein to describe a medical device for insertion into a patient's body and for performing a surgical or diagnostic procedure, the tool including an end effector, which may be a surgical device for performing a surgical procedure.
- Surgical instruments such as cauterizers, clamps, staplers, scissors, imaging equipment (such as endoscopes or ultrasound probes), and the like.
- Some tools used in embodiments of the present application further include providing the end effector with an articulating component (e.g., a joint assembly) such that the position and orientation of the end effector can be manipulated for movement in one or more mechanical degrees of freedom relative to the instrument axis.
- end effectors include jaws that also include functional mechanical degrees of freedom, such as opening and closing.
- the tool may also include stored information that may be updated by the surgical system, whereby the storage system may provide one-way or two-way communication between the tool and one or more system elements.
- a remotely operated surgical system is shown in Figure 1.
- the remotely operated surgical system includes a master console 10 and a slave operating device 20.
- the master console 10 is remotely connected to the slave operating device 20.
- the slave operating device 50 includes a plurality of robotic arms 21, and a plurality of instruments and/or imaging devices are respectively detachable. are mounted on different robotic arms 21.
- the surgeon S can remotely operate and control instruments and/or imaging equipment on the main console 10.
- the main console 10 is configured to send control signals to the slave operating device 20 and display images acquired from the slave operating device 20 according to the operation of the surgeon S.
- the surgeon S can observe the three-dimensional imaging in the patient's body provided by the imaging system through the main console 10.
- the surgeon S can control the operation device 10 to perform related operations (for example, with an immersive feeling). Perform surgical procedures or obtain internal images of patients).
- the master console 10 and the slave operating device 20 can be placed in the same room for remote operation, or they can be placed in different rooms, or even located in different cities.
- the main console 10 is also connected to the electronic equipment cart C through remote communication.
- the electronic equipment cart C is connected to the main console 10 and the slave operating device 20 through remote communication.
- the electronic equipment cart 30 may include an energy generating device, an image signal Processing devices and other electronic equipment.
- wired Ethernet communication is used for remote communication between the main console 10, the slave operating device 20, and the electronic equipment cart C.
- the remote communication is not limited to wired Ethernet communication and may also be other wired methods.
- it includes but is not limited to serial port, CAN, RS485, RS232, USB, SPI, etc., or wireless communication methods, such as but is not limited to WiFi, NB, Zigbee, Bluetooth, RFID, etc.
- Teleoperated surgical systems also often include imaging systems that enable the operator to view the surgical site from outside the patient's body.
- the imaging system typically includes an imaging device (such as an endoscope) with video image capture capabilities and one or more video display devices for displaying the captured images.
- the imaging device includes optics of one or more imaging sensors (eg, CCD or CMOS sensors) that will acquire images within the patient's body.
- the one or more imaging sensors may be placed at a remote end of the imaging device, and the signals generated by the one or more sensors may be transmitted along a cable or wirelessly for processing and display on the video display device.
- One or more cannulas are connected to the distal end of the robotic arm 21, and the cannulas are inserted into the body of the patient P lying on the operating bed T.
- Assistant A installs the tool 30 on the robotic arm 21 according to the surgical conditions, or replaces/reloads the tool 30 from the robotic arm 21. After the tool 30 is installed on the robotic arm 21, it is inserted into the body of the patient P through the cannula.
- Surgeon S, assistant A, and anesthesiologist B form the basic surgical team.
- the tool 30 may be a surgical instrument such as an electric cauterizer, a clamp, a stapler, or an ultrasonic scalpel for performing surgical operations, or may be an imaging device (such as an endoscope) for acquiring images or other surgical tools.
- the tool 30 includes a transmission box 31 , a long shaft 32 and an end effector 33 .
- the transmission box is used to receive the power input on the robotic arm 21 and transmit it to the end effector 33 .
- the actuator 33 may be a device for performing surgery, such as a clamp, an ultrasonic scalpel, etc.; it may also be an imaging device, such as an image sensor.
- the main console of an embodiment of the present application is shown in Figure 3A.
- the main console 100 includes a display device 101, an armrest, first and second input devices 102, 103, an observation device 104 and a plurality of pedals 105.
- Two input devices Devices 102, 103 are respectively used to control different instruments or imaging equipment.
- the display device 101 is used to display images acquired by the above imaging system.
- the display device 101 is a three-dimensional imaging display device.
- the surgeon S observes the image displayed by the display device 101 through the observation device 104 .
- the armrest 11 is used to place the surgeon's arms and/or hands. In some embodiments, according to actual needs, the armrest can be omitted, or the observation device 104 can be omitted, and direct observation can be performed at this time.
- the surgeon S controls the tool movement of the slave operating device 20 by operating the first and second input devices 102 and 103.
- the control signal processing system of the master console 10 processes the input signal of the input device 102 and then sends a control signal to the slave operating device 20.
- the slave operating device 20 responds to the control signal of the master console 100 and performs corresponding operations, that is, master-slave control.
- the control signal processing system may also be provided in the slave operating device 20 , for example, in the base of the slave operating device 20 .
- the first input device 102 includes a handle 1021, a wrist joint assembly 1030, and an elbow joint assembly 1040.
- the handle 1021 is used for the surgeon to hold, and the wrist joint assembly 1030 is used for movement.
- the elbow joint assembly 1040 is used to change the position of the first input device 102, such as the position of the handle 1021.
- the wrist joint assembly 1030 includes a plurality of wrist joints 1301, 1032, 1033, 1034.
- Each wrist joint 1301, 1032, 1033, 1034 is rotationally connected to each other through an L-shaped connecting rod, wherein the wrist joint 1031 rotates around the axis X1, The wrist joint 1032 rotates around its axis X2, the wrist joint 1033 rotates around its axis X3, the wrist joint 1034 rotates around its axis X4, and each wrist joint 1301, 1032, 1033, 1034 rotates around its respective axis to change the posture of the input device 102.
- the posture of the input device 102 includes the posture of the intersection of axis X1, axis X2, axis X3, and axis X4.
- the elbow joint assembly 1040 includes a plurality of elbow joints 1041, 1042, 1043.
- the elbow joint 1041 rotates around its axis X5, the elbow joint 1042 rotates around its axis X6, and the elbow joint 1043 rotates around its axis X7.
- Each elbow joint 1041, 1042, 1043 rotate about their respective axes thereby changing the position of the input device 102 .
- the wrist joint assembly 1030 and the elbow joint assembly 1040 include multiple motors, and the multiple motors are used to drive the wrist joint assembly 1030 and the elbow joint assembly 1040 to move.
- the controller 250 controls the movement of one or more motors of the wrist joint assembly 1030, thereby controlling the movement of the wrist joint assembly 1030, thereby changing the posture of the first input device 102 and/or the second input device 103.
- the slave operating device 200 includes multiple robotic arms 210 , 220 , 230 , 240 and a controller 2500 .
- the multiple robotic arms 210 , 220 , 230 , 240 may be of the same configuration. , it can also be in different configurations.
- Multiple tools 310, 320, 330, 340 are installed on multiple robotic arms 210, 220, 230, 240.
- the first instrument 310 among the multiple tools is detachably installed.
- the second instrument 320 is detachably installed on the third robot arm 230
- the third instrument 330 is detachably installed on the fourth robot arm 240.
- the imaging device 340 is detachably mounted on the second robot arm 220.
- the instrument and the imaging device can interchange the installed robotic arms.
- the third instrument 330 and the imaging device 320 can interchange the installed robotic arms. After the exchange, the imaging device is installed on the third robotic arm 230.
- the second instrument 320 is installed on the second robotic arm 220.
- the controller 2500 is configured to control the joint movements of the driving robot arms 210, 220, 230, 240, and the movements of the instruments 310, 320, 330 and the imaging device 340 in response to control signals from the master console 100 or the slave operating device 20. .
- the controller 2500 may be provided in the base of the slave operating device 200. In some embodiments, the controller 2500 may also be provided on each robot arm. It is understandable that the controller 2500 may also be provided in the master console 100.
- the controller 2500 and the above-mentioned control signal processing system are the same control device, or the controller 2500 and the above-mentioned control signal processing system are different control devices respectively provided in the slave operating device 20 and the master console 10 .
- the robotic arm 210 includes a flat The parallelogram mechanism 211 and the arm 212 are arranged in parallel.
- the driving device 213 is slidably disposed on the arm 212.
- the driving device 213 is used to drive the end effector 313 of the surgical instrument 310.
- the parallelogram mechanism 211 is used to rotate the surgical instrument 310 around a remote site. The center of movement rotates.
- the driving device 213 includes a plurality of motors 213a, 213b, 213c, and 213d.
- the plurality of motors 213a, 213b, 213c, and 213d are connected to the transmission device in the instrument box 311.
- the plurality of motors 213a , 213b, 213c, 213d drive the long shaft 312 and the end effector 313 by driving the transmission device.
- the first motor 213a and the second motor 213b are used to drive the end effector 313 to perform opening and closing actions
- the third motor 213c is used to drive the end effector 313 to open and close.
- the fourth motor 213d is used to drive the long shaft 312 to rotate.
- the driving device 213 and the instrument box 311 may also be connected through a sterile adapter.
- the end effectors of existing surgical instruments have kinematic couplings.
- the driving device drives the end effector to move
- two or more motors are required to participate in driving one degree of freedom movement of the end effector, such as driving the end effector 313.
- the motor for opening and closing the clamping part not only needs to drive the opening and closing of the clamping part, but may also need to cooperate with the decoupling movement when the end effector 313 performs pitching motion.
- One embodiment of the present invention provides a mechanically decoupled surgical instrument. Through mechanical decoupling, the motor that drives the opening and closing movement of the clamping portion only drives the opening and closing movement of the clamping portion.
- the end effector 150 includes a first bracket 210 and a wrist 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 first pillar 314 and a second pillar 315 .
- the end includes a base frame 316. One end of the base frame 316 is connected to the long axis.
- a first pillar 314 and a second pillar 315 are formed extending from the other end of the base frame 316 toward the distal end of the end effector 150.
- the first pillar 314 and the second pillar 315 are The pillar 315 and the bottom frame 316 form a substantially U-shaped clamp structure.
- a first pin 311 and a second pin 312 are provided between the first pillar 314 and the second pillar 315.
- the first pin 311 and the second pin 312 are fixedly connected to the first pillar 314 and the second pillar 315 side by side, wherein the first pin 311 and the second pin 312 are fixedly connected to the first pillar 314 and the second pillar 315.
- One pin 311 is closer to the base 316 of the first bracket 210 than the second pin 312.
- first bracket 210 is not shown in Figures 6B and 6C.
- a first pulley group is provided on the first pin 311.
- a pulley set includes a first pulley 211, a second pulley 212, a third pulley 213 and a fourth pulley 214 arranged in sequence on the first pin 311.
- a second pulley set is arranged on the second pin 312. The second pulley set includes a pulley set in sequence.
- the fifth pulley 215, the sixth pulley 216, the seventh pulley 217 and the eighth pulley 218 placed on the second pin 312, the first pulley 211 to the eighth pulley 218 are all used to guide the driving cable, because they are used to guide the driving.
- the pulleys of the cable are all arranged on the first bracket 210, and there are no pulleys on the wrist 220. Therefore, the volume of the wrist 220 can be made smaller, making the end effector 150 smaller, and there is no risk of the pulleys falling off.
- the wrist 220 is provided with a third pillar 317, a fourth pillar 318 and a pitch wheel 319.
- the third pillar 317 and the fourth pillar 318 extend from the pitch wheel 319 along the distal end of the end effector 150.
- the third pillar 317, The fourth pillar 318 and the pitch wheel 319 form a roughly U-shaped frame.
- the pitch wheel 319 is installed on the second pin 312 .
- the wrist 220 can rotate around AA′ of the axis of the second pin 312 to achieve the pitch of the end effector 150 sports.
- a third pin 313 is provided between the third pillar 317 and the fourth pillar 318, and the third pin 313 is perpendicular to the first pin 311 and the second pin 312.
- the clamping part 260 of the end effector 150 includes a first clamping part 261 and a second clamping part 262.
- the first clamping part 261 and the second clamping part 262 are rotatably arranged on the wrist 220 through a third pin 313.
- the first clamping member 261 and the second clamping member 262 can rotate around the axis BB' of the third pin 313 to realize the opening, closing and yawing movements of the clamping part 260.
- the clamping member 262 may be a clamp for clamping tissue, a stapler for suturing, or a cautery for electric cauterization, or the like.
- the driving cables provided on the end effector 150 include a first pair of cables 151 and a second pair of cables 152 for operating the end effector 150 to open, close, and yaw, and a third pair of cables 153 for operating the end effector 150 to pitch.
- the first pair of cables 151 includes a first drive cable 151A and a second drive cable 151B.
- the second pair of cables 152 includes a third drive cable 152A and a fourth drive cable 152B
- the third pair of cables 153 includes a fifth drive cable 153A and a sixth drive cable 153B.
- the first pair of cables 151 is wound on the first pulley set and the second pulley set in the same way as the second pair of cables 152 is wound on the first pulley set and the second pulley set.
- the winding method is opposite.
- the first driving cable 151A of the first pair of cables 151 is wound on the first pulley set and the second pulley set in the same way as the second driving cable 151B is wound on the first pulley set and the second pulley set.
- the third driving cable 152A of the second pair of cables 152 is wound in the same manner on the first pulley set and the second pulley set
- the fourth driving cable 152B is wound on the first pulley set and the second pulley set in the same manner.
- the proximal end of the first driving cable 151A is connected to the transmission device in the instrument box 170
- the distal end of the first driving cable 151A extends toward the distal end of the end effector 150 after being guided by the front of the first pulley 211 , and continues to extend along the distal end of the terminal instrument 150 after passing through the rear guide of the fifth pulley 215 and is finally fixed on the first clamping member 261 .
- the second driving cable 151B extends toward the distal end of the end effector 150 after passing through the front guide of the fourth pulley 214, and continues to extend toward the distal end of the end effector 150 after passing through the rear guide of the eighth pulley 218, and is finally fixed on on the first clamping member 261.
- the distal end of the third driving cable 152A extends toward the distal end of the end effector 150 after being guided by the rear of the second pulley 212, and continues to extend toward the distal end of the end instrument 150 after being guided by the front of the sixth pulley 216 and is fixed.
- the distal end of the fourth driving cable 152B extends toward the distal end of the end effector 150 after passing through the rear guide of the third pulley 213, and continues toward the end after passing through the front guide of the seventh pulley 217.
- the distal end of tip instrument 150 extends and transitions onto second clamp 262 .
- the proximal ends of the fifth driving cable 153A and the sixth driving cable 153B of the third pair of cables 153 reach the instrument box 170 , and their distal ends are accommodated in the annular groove 319A of the pitch wheel 319 , and their ends are respectively fixed on the wrist.
- the fifth driving cable 153A and the sixth driving cable 153B together drive the wrist 220 to rotate along the axis AA', and then the wrist 220 drives the first clamping part 230 and the second clamping part 240 to rotate along the axis AA'. pitching motion.
- the coupling relationship between the third pair of cables 153 of the end instrument 150 and the first and second pairs of cables 151, 152 will be described in detail below.
- the instrument box 170 needs to retract and pull the third pair of cables 153.
- the fifth driving cable 153A or the sixth driving cable 153B of the cable 153 causes the wrist 220 to drive the first clamping part 230 and the second clamping part 240 to pitch together around the first axis AA', as shown in FIGS. 7A and 7B
- the winch 171 in the instrument box 170 pulls the sixth driving cable 153B, so that the wrist 220 and the first clamping part 230 and the second clamping part 240 move around the first axis AA'.
- the lengths of the first driving cable 151A and the second driving cable 151B on the end effector 150 must be increased or decreased at the same time, and the lengths of the third driving cable 152A and the fourth driving cable 152B The length on the end effector must be reduced or increased at the same time, so the movement of the third pair of cables 153 is limited to the first pair of cables 151 and the second pair of cables 152 .
- the relationship in which the change of one element is affected/restricted by another element is called a coupling relationship, that is, there is a coupling relationship between one element and another element.
- this coupling relationship is such that any movement of any cable between the second pair of cables 152 and the third pair of cables 153 will cause the other cables to fail. Desired movement, resulting in undesired movement of the end effector.
- This coupling relationship causes the pitching motion of the end effector to interact with the opening and closing and/or deflecting motions, and the pitching motion and the opening and closing and/or deflecting motions of the end effector are not independent of each other, so that the end effector 150 cannot correctly Perform surgical procedures.
- the movements of the two can be independent of each other, without interfering or affecting each other, so as to eliminate the problem between the third pair of cables 153 and the first pair of cables 151 and/or the second pair of cables 152.
- the coupling relationship is called decoupling.
- an existing decoupling method is to use software algorithms for decoupling.
- the existing software decoupling method cannot decouple the type of end effector of the present invention.
- the present invention proposes A mechanical decoupling solution is to provide a mechanical decoupling mechanism in the instrument box 170 of the surgical instrument 120 to decouple the coupling relationship between the first pair of cables 151 , the second pair of cables 152 and the third pair of cables 153 .
- FIG. 8A is a schematic diagram of an instrument box 170 according to an embodiment of the present invention.
- the instrument box 170 is suitable for receiving power input and driving the end effector shown in FIG. 6A .
- the instrument box 170 includes a first winch 171 and a second winch 172 for driving the end effector 150 to perform opening and closing and/or yaw movements.
- the third winch 173 for pitching movement of the end effector 150, and the fourth winch 174 for driving the long shaft 160 to rotate.
- the first driving cable 151A and the second driving cable 151B of the first pair of cables 151 are respectively wound on the first winch 171 in an opposite winding manner, and the third driving cable 152A and the fourth driving cable 152B of the second pair of cables 152 are respectively wound in opposite directions.
- the fifth drive cable 153A and the sixth drive cable 153B of the third pair of cables 153 are respectively wound on the third winch 173 in an opposite winding manner.
- the eight drive cables 154B are each wound around the fourth winch 174 in opposite winding patterns.
- the first winch 171 retracts or releases the first driving cable 151A or the second driving cable 151B to make the first clamping member 261 surround its third pin.
- 313 rotates, when the second motor in the driving device 132 drives the second winch 172 to rotate, the second winch 172 retracts or releases the second driving cable 152A and the third driving cable 152B to make the second clamping member 262 surround the third driving cable 152A.
- the third winch 173 retracts or releases the fifth driving cable 153A and the sixth driving cable 153B so that the wrist 220 revolves around the axis of the second pin 312 AA' rotates so that the end effector 150 performs a pitching motion.
- the fourth motor in the driving device 132 drives the fourth winch 174 to rotate with its shaft 174A
- the fourth winch 174 retracts or releases the seventh driving cable 154A or the eighth driving cable 154B to realize the rotational movement of the driving long shaft 160 .
- the instrument box 170 also includes a decoupling mechanism for decoupling the coupling relationship between the third pair of cables 153 and the first and second pairs of cables 151 and 152 on the end effector 150 side.
- the decoupling mechanism includes a decoupling wheel 1761 and the sliding frame 176.
- the sliding frame 176 includes a supporting frame 1762 and a first guide part 1763 and a second guide part 1764 connected to both ends of the supporting frame 1762.
- the first and second driving cables 151A and 151B are wound around the first guide part 1763.
- the third and fourth driving cables 152A, 152B are wound around the second guide part 1764, the decoupling wheel 1761 is connected to the support frame 1762 through the first decoupling cable 1767 and the second decoupling cable 1768, and the decoupling wheel 1761 is driven by The first decoupling cable 1767 and the second decoupling cable 1768 in turn control the movement of the carriage 176 .
- the decoupling wheel 1761 and the third winch 173 may be disposed on the same shaft 173A, and the decoupling wheel 1761 and the third winch 173 rotate coaxially.
- the decoupling wheel 1761 and the third winch 173 have different radii.
- the radius of the decoupling wheel 1761 is r2, and the radius of the third winch 173 is R2, where r2 ⁇ R2.
- the decoupling wheel 1761 is pulled or pulled by Releasing the first decoupling cable 1767 or the second decoupling cable 1768 causes movement of the carriage 176 .
- the decoupling process is shown in Figure 8B.
- the third winch 173 rotates counterclockwise (first direction)
- the third winch 173 pulls the sixth driving cable 153B and simultaneously releases the fifth driving cable 153A, so that the end effector 150
- the wrist 220 rotates about the axis AA' of the second pin 312 as shown in Figures 7A and 7B, and the entire end effector 150 performs a pitching motion. Since the decoupling wheel 1761 and the third winch 173 rotate coaxially, the decoupling wheel 1761 pulls the second decoupling cable 1768 and releases the first decoupling cable 1767 at the same time.
- the carriage 176 moves a distance of L/2 in the direction A under the pull of the second decoupling cable 1768.
- the first driving cable 151A and the second driving cable 151B are in the instrument box.
- the lengths in the instrument box 170 will be reduced by L at the same time.
- the lengths of the third driving cable 152A and the fourth driving cable 152B in the instrument box 170 will be increased by L at the same time.
- the length reduction amount of the first driving cable 151A and the second driving cable 151B in the instrument box 170 is required to be the same as the wrapping angle length of the first driving cable 151A and the second driving cable 151B on the fifth pulley 215 and the eighth pulley 218 respectively.
- the increase in length of the third driving cable 152A and the fourth driving cable 152B in the instrument box 170 is equal to the length increase of the third driving cable 152A and the fourth driving cable 152B on the sixth pulley 216 and the seventh pulley 217
- the required reductions in angular lengths are equal. On the contrary, as shown in FIG.
- the change in length of the first pair of cables and the second cable on the end effector side caused by the pitching motion of the end effector is entirely provided by the change in length of the first pair of cables and the second cable within the instrument box 170, 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, and the decoupling mechanism realizes the decoupling relationship between the third pair of cables and the first pair of cables and the second pair of cables.
- the decoupling wheel 1761 of the decoupling mechanism drives the carriage 176 always along a straight line.
- the wire moves, and 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 resulting from the movement of the decoupling member 176 is always linear.
- FIG. 9A it is a schematic structural diagram of a terminal instrument 250 according to an embodiment of the present invention.
- the terminal instrument 250 includes a wrist 410 with a substantially U-shaped structure, a first bracket 510 , a clamping part 610 and a driving cable.
- the distal end of the first pair of cables 251 is installed on the first clamping member 611 of the clamping part 610, and its proximal end is connected to the first winch in the instrument box 270.
- the distal end of the second pair of cables 252 is installed on the clamping part 610.
- the second clamping member 612 of the part 610 On the second clamping member 612 of the part 610, its proximal end is connected to the winch in the instrument box 270, and the first pair of cables 251 and the second pair of cables 252 cooperate to operate the first clamping member 611 and the second clamping member 612 Rotating around the axis BB′ of the first pin 512 realizes the opening, closing and yawing movements of the terminal instrument 250 .
- the distal end of the third pair of cables 253 is mounted on the wrist 410, and the proximal end is connected to the third winch in the instrument box 270.
- the first pair of cables 251 includes a first drive cable 251A and a second drive cable 251B
- the second pair of cables includes 252 a third drive cable 252A and a fourth drive cable 252B.
- the first pulley set 320 is fixed on the wrist 410
- the second pulley set 330 is installed on the first bracket 510, wherein the first pulley set 320 includes first, second, third and fourth pulleys 321, 322, 323, 324
- the second pulley group 330 includes fifth, sixth, seventh and eighth pulleys 325, 326, 327 and 328.
- the first pair of cables 251 and the second pair of cables 252 are wound in the same manner on the first pulley set 320 and the second pulley set 320, but the first driving cable 251A and the second driving cable 251B of the first pair of cables 251 are wound on the first pulley set 320
- the third drive cable 252A and the fourth drive cable 252B of the second pair of cables 252 are wound in opposite ways on the first pulley set 320 and the second pulley set 330 .
- the first driving cable 251A passes through the front guide of the first pulley 321 and then passes through the rear guide of the fifth pulley 325 and then passes through the first bracket 510 and extends into the long axis 160;
- the second drive cable 251B passes through the third The guide at the rear of the pulley 323 then passes through the guide at the front of the seventh pulley 327 and then extends through the first bracket 510 into the long axis 160 .
- the third driving cable 252A passes through the front guide of the second pulley 322 and then passes through the rear guide of the sixth pulley 326 before passing through the wrist 210 and extending into the long axis 160 .
- the fourth drive cable 352B passes through the rear of the fourth pulley 324 . After being guided by the front part of the eighth pulley 228, it passes through the wrist part 410 and extends into the terminal long axis 160.
- the length of the wrapping angle on the pulley 228 will be reduced, thereby causing the clamping portion 610 to rotate counterclockwise around the axis BB' of the first pin 412 from the dotted line position in the figure to the solid line position in the figure, which is undesirable.
- the present invention also provides an instrument box that can decouple the above-mentioned surgical instrument 250.
- the instrument box 270 includes a first winch 271 for driving the end instrument 250 to perform opening, closing, and yaw.
- the second winch 272 is used to drive the terminal instrument 250 to perform pitching motion
- the third winch 273 is used
- the fourth winch 274 is used to drive the long shaft 160 to rotate.
- the proximal ends of the first drive cable 251A and the second drive cable 251B of the first pair of cables 251 are wound on the first winch 271 in an opposite winding manner, and the third drive cable 252A and the fourth drive cable 252B of the second pair of cables 252
- the proximal ends of the third pair of cables 253 are respectively wound on the second winch 272 in an opposite winding manner.
- the fifth driving cable 253A and the sixth driving cable 253B of the third pair of cables 253 are respectively wound on the third winch 273 in an opposite winding manner.
- the sixth drive cable 254A and the seventh drive cable 254B of the pair of cables are respectively wound on the fourth winch element 274 in opposite winding patterns.
- the instrument box 270 also includes a decoupling mechanism for decoupling the coupling relationship between the third pair of cables 253 and the first pair of cables 251 and the second pair of cables 252 on the end effector 250 side.
- the decoupling mechanism includes a decoupling wheel 275
- the decoupling wheel 275 and the third winch 273 are coaxially arranged with the sliding frame 276.
- the sliding frame 276 includes a support frame 2761 and guide wheels 2763 and 2764 provided at both ends of the support frame 2761.
- the first driving cable 251A and the third driving cable 252A are guided by the first guide part 2763 and then enter the long shaft 160 .
- the second driving cable 251B and the fourth driving cable 152B are guided by the second guide part 2764 and then enter the long shaft 160 .
- the decoupling wheel 275 is used to drive the slave carriage 276 to change the length of the first pair of cables 251 and the second pair of cables 252 in the instrument box, thereby decoupling the connection between the third pair of cables and the first and second pairs of cables. coupling relationship.
- the third winch 273 pulls the fifth driving cable 253B and simultaneously releases the fourth driving cable 253A, so that the wrist of the terminal instrument 250 220 rotates along the axis AA′ of the second pin 511 .
- the decoupling wheel 275 and the third winch 273 are coaxially arranged, when the decoupling wheel 275 rotates in the first direction, it releases the first decoupling cable 2765 and simultaneously pulls the second decoupling cable 2766 to pull the support frame 2761 of the carriage 276 Move along direction A in the instrument box 270, so that the lengths of the first driving cable 251A and the third driving cable 252A in the driving device are simultaneously reduced, and the lengths of the second driving cable 251B and the fourth driving cable 252B in the driving device are simultaneously reduced. Increase.
- the pitch movement of the end effector 250 requires changes in the wrapping angle lengths of the first driving cable 151A of the first pair of cables 251 and the third driving cable 152A of the second pair of cables on the fifth pulley 225 and the sixth pulley 226 respectively.
- the amount, as well as the change amount of the wrapping angle length of the second driving cable 151B and the fourth driving cable 152B on the seventh pulley 227 and the eighth pulley 228 respectively, are all caused by the first movement of the decoupling member 176 of the decoupling mechanism.
- a change in the length of the drive cable 151A and the third drive cable 152A within the drive device, and a change in the length of the second drive cable 152B and the fourth drive cable 152B within the drive device provide such that movement of the third pair of cables No longer limited by the first pair of cables and the second pair of cables, precise decoupling between the third pair of cables and the first and second pairs of cables is achieved.
- the driving motor that drives the movement of the clamping part only drives the movement of the clamping part and does not need to participate in the decoupling movement.
- the third motor 213c drives the wrist pitching motion of the surgical instrument
- the third motor 213c drives the movement of the clamping part. 1.
- the second motors 213a and 213b can be stationary, so that the opening and closing angle of the clamping portion of the end effector remains unchanged.
- changes in the operating data of the first and second motors 213a and 213b that drive the clamping member can only be caused by clamping to human tissue, so the clamping can be determined based on the operating data.
- One embodiment of the present invention also provides an input device with force feedback.
- the handle 1130 of the input device is rotationally connected to the wrist joint 1031.
- the handle 1130 includes a housing 1131 and a holding member 1133.
- the holding member 1133 Rotatingly mounted on the housing 1131, the housing 1131 also includes a handle 1132.
- the operator holds the handle 1132 like a gun and holds the grip 1133 with his fingers.
- the handle 1130 also includes a force feedback device.
- the force feedback device includes a force feedback motor 1201, a transmission cable 1203 and a first sheave 1204.
- the force feedback motor 1201 is connected to the first sheave 1204 through the transmission cable 1203. .
- the bracket 1134 of the holding member 1133 is connected to the first sheave 1204 through the second sheave 1205.
- the second sheave 1205 and the first sheave 1204 are arranged on the same pin 1135, and the encoder 1207 is fixed on the first sheave. 1204, and is coaxially arranged with the first and second sheave 1204, 1205, for detecting the rotation angle of the first and second sheave 1204, 1205.
- first sheave 1204 and the second sheave 1205 may not be disposed on the same pin.
- first sheave 1204 and the second sheave 1205 may be disposed on different pins.
- the sheave 1204 and the second sheave 1205 are directly connected through a cable or gear.
- the bracket 1134 is connected to the second sheave 1205 through a first actuation cable 1206a and a second actuation cable 1206b.
- the first and second actuation cables 1206a, 1206b extend along opposite sides of the bracket 1134.
- the first actuation cable 1206a and the second actuation cable 1206b extend along the opposite sides of the bracket 1134.
- One end of the cable 1206a and one end of the second actuation cable 1206b are respectively fixed on both sides of the bracket 1134.
- the first and second actuation cables 1205a and 1206b are wound around the second sheave 1205 in opposite ways, and the first and second actuation cables 1205a, 1206b are wound on the second pulley 1205 in an opposite manner, and the first and second actuation cables 1205a, 1206b are wound on the second pulley 1205 in an opposite manner.
- the other end of the moving cable 1206a and the other end of the second actuation cable 1206b are fixed on the second sheave 1205.
- the first actuation cable 1206a and the second actuation cable 1206b extend in grooves in the side walls of the bracket 1134.
- the holding member 1133 is rotationally connected to the housing 1131 through a second pin 1136, and the second pin 1136 is parallel to the first pin 1135, so that when the holding member 1133 rotates, the first drive The cable 1206a and the second drive cable 1206b are not easily slipped out of the grooves in the side walls of the bracket 1133.
- the bracket 1133 of the grip 1133 rotates in the clockwise direction CW as shown in the figure.
- the second sheave 1205 rotates counterclockwise.
- the holding member 1133 rotates in the counterclockwise CCW direction around the second pin 1133, and the second actuation cable 1206b pulls the first sheave 1135 to rotate clockwise.
- Encoder 1207 can detect the second The sheave 1205 rotates to obtain the rotation angle of the grip 1133.
- the controller of the surgical system controls the opening and closing angle of the clamping portion of the end effector of the surgical instrument according to the rotation angle of the grip 1133.
- a compressed spring (not shown) is provided between the bracket 1134 of the grip 1133 and the housing 1131. After the operator releases the grip 1133, the spring recovers so that the grip 1133 moves in the reverse direction. The hour hand rotates in the CCW direction.
- the force exerted on the tissue R by the clamping action of the clamping part 260 is as shown in Figure 12.
- the interaction force of human tissue is usually considered to be the clamping operation force, which can be decomposed into three-dimensional axial forces F g , F s , and F t along the end tool coordinate system, where F g represents the effect of the surgical instrument on human tissue. Tooth surface clamping force, F s represents the radial tangential force, and F t represents the axial tensile force.
- the three-dimensional axial force F g , F s and F t are further decomposed into the tooth surface of the first clamping part 261 and are three-dimensional axial components F g ′, F s ′, F t ′ and the tooth surface of the second clamping part 262 and are three-dimensional axial components.
- Component force F g ′′, F s ′′, F t ′′, the force decomposition relationship can be expressed by the following formula
- the driving cable that drives the clamping part to move will be stretched and deformed, thereby causing the first motor 213a and the second motor 213a that drive the clamping part to rotate.
- the current of the motor 213b suddenly changes greatly, and after the above-mentioned mechanical decoupling, the first motor 213a and the second motor 213b no longer participate in the decoupling movement, and the two motors independently drive the first clamping part of the clamping part. and the second clamping member.
- a sudden change in the current of the two motors indicates that the clamping part is clamping the human tissue.
- the "operating force of the clamping part - current change" force feedback model also includes the clamping part The relationship between the tangential force F s of the two clamping parts and the current change amount of the third motor 213c.
- the clamping part can also be The two clamping parts 261 and 610 are subjected to a tangential force on the tooth surface, and the tangential force on the tooth surface is perpendicular to the above-mentioned clamping force.
- a calibration device is used to calibrate the mathematical relationship between the current changes of the first motor 213a, the second motor 213b and the third motor 213c and the clamping force of the clamping part measured by the pressure sensor, and finally obtain according to the mathematical relationship. "Operation force of the clamping part - current change" force feedback model.
- the force feedback motor 1201 provides a feedback force to the grip 1133 based on the detected clamping force of the clamping portion through currents passing through the first motor 213a and the second motor 213b.
- the clamping force of the clamping parts 240 and 610 is converted into the input current of the force feedback motor 1201.
- the force feedback motor 1201 outputs a corresponding resistance according to the input current.
- the resistance can be equal to the clamping force of the clamping parts 260 and 610, and also It can be proportional to the size of the clamping force.
- the resistance output by the feedback motor 1201 will be transmitted to the holding member 1133 through the transmission cable 1203, the first sheave 1204 and the second sheave 1205, thereby The operator can feel the resistance provided by the feedback motor 1201 when operating the handle, so that the operator can intuitively feel the resistance when the end effector of the instrument clamps the tissue, making the operation safer.
- the handle 2130 includes a housing 2131 and two holding parts 2133a, 2133b.
- the two holding parts 2133a, 2133b respectively pass through the two first pins 2134a.
- 2134b is rotatably connected to the housing 2131, and the opening and closing angle of the clamping portion of the end effector of the surgical instrument can be controlled by pinching the two holding pieces 2133.
- the handle 2130 also includes a force feedback device.
- the force feedback device includes a link assembly and a force feedback actuator 2201.
- the link assembly includes two first links 2201a and 2201b. One ends of the two first links 2201a and 2201b pass through respectively.
- the two second pins 2135a and 2135b are rotationally connected to the two holding pieces 2133a and 2133b, and the other ends of the two first links 2201a and 2201b are rotationally connected to one end of the second link 2202 through a third pin 2136.
- the other end of the second link 2202 is connected to the force feedback actuator 2201.
- the controller of the force feedback device detects the clamping force of the clamping part through the current of the first motor 213a and the second motor 213b.
- the detected clamping force of the clamping part is converted into an input current of the force feedback brake 2201.
- the force feedback actuator inputs resistance to the holding clamps 2133a, 2133b through the connecting rod assembly according to the input current to facilitate the operation. Provides force feedback.
- the force feedback actuator 2201 is connected to the second link 2202 through the third link 2203.
- the second link 2202 moves in a straight line, and its movement direction is consistent with the first pins 2134a, 2134b, and the second link 2202.
- the pins 2135a, 2135b and the third pin 2136 are vertical, and the linear motion of the second link 2202 drives the movement of the third link 2203, thereby transmitting the motion of the second link 2202 to the force feedback actuator 2201, whereby the force
- the feedback actuator 2201 can detect the movement amount of the second link 2202, whereby the force feedback actuator 2201 detects the opening and closing angles of the gripping parts 2133a and 2133b.
- a spring 2205 is provided between the two holding parts 2133a and 2133b. After the operator releases the holding parts 2133a and 2133b, the spring 2205 provides an elastic restoring force, causing the two holding parts 2133a to ,2133b stay away from each other.
- the controller of the force feedback device detects the tangential force of the clamping part through the current of the third motor, and the controller of the force feedback device converts the detected clamping force of the clamping part into a force
- the input current of the feedback motor 1201 or the force feedback brake 2201 is fed back.
- the force feedback actuator inputs resistance to the grip 1133 or the grips 2133a, 2133b through the connecting rod assembly according to the input current, so as to provide the operator with a clip containing Force feedback of the tangential force of the holding part.
- other operating data of the first motor 213a and the second motor 213b can also be used to establish a mathematical model of the clamping force of the clamping part and the operating data.
- the "clamping force of the clamping part” can be established.
- Mathematical models such as “Clamping force - rotational speed change”, “Clamping force of the clamping part - Torque change”, “Clamping force of the clamping part - Voltage change”.
- the force feedback device provides force feedback for the grip 1133 according to a force feedback model related to the opening and closing angle of the grip 1133 .
- the force feedback device enables a force feedback model based on whether the end effector of the surgical instrument is clamped to human tissue.
- the surgical system pre-stores threshold currents related to the first motor 213a and the second motor 213b.
- the force feedback model is started.
- the force feedback model is related to the opening and closing angles of the grips 1133 and 2133 of the handle.
- the controller of the force feedback device detects that the currents of the first motor 213a and the second motor 213b are greater than the first threshold current, Obtain the first rotation angle of the holding parts 1133, 2133 at this time, and obtain the second rotation angle of the holding parts 1133, 2133 after moving from the first rotation angle in real time, where the second rotation angle is smaller than the first rotation angle.
- the angle refers to the included angle between the center line of the holding member and the handle. Taking FIG. 11C as an example, the rotation angle refers to the included angle ⁇ between the holding member 1133 and the center line X1 of the handle 1130 .
- the feedback motor 1201 or the force feedback actuator 2201 of the force feedback device provides feedback force to the gripper based on the first rotation angle and the second rotation angle of the gripper.
- the feedback force is obtained based on the first rotation angle and the second rotation angle, that is, the first rotation angle and the second rotation angle are input into the force inverse model, thereby obtaining the feedback force.
- F mg is the feedback force
- ⁇ mg is the first rotation angle of the grip
- ⁇ grip is the second rotation angle of the grip
- k 1 , k 2 ,..., k n represent constant coefficients.
- the feedback motor 1201 or the force feedback actuator 2201 outputs a feedback force to the grip according to the feedback force F mg .
- the controller of the force feedback device can be placed in the input device, or can be set in the main console 10, or in the slave operating device 20.
- the controller 2500 in the slave operating device 20 is used to realize the controller function of the force feedback device. It can be understood that What's more, the controller of the force feedback device can be placed anywhere in the surgical system.
- the force feedback device provides feedback force to the gripping member 1133 based on a force feedback model related to the opening and closing angles of the two gripping members of the gripping portions 260, 610 of the instrument. Specifically, when the controller of the force feedback device detects that the current of the first motor 213a and the second motor 213b is greater than the first threshold current, it obtains the first opening and closing angle of the clamping part at this time, and obtains the clamping angle in real time. The actual second opening and closing angle after the part moves from the first opening and closing angle, wherein the second opening and closing angle is smaller than the first opening and closing angle, and the opening and closing angle refers to the opening and closing angle between the two clamping parts of the clamping part.
- the opening and closing angle is zero when the clamping space is closed.
- the feedback motor 1201 provides feedback force to the handle based on the first opening and closing angle and the second opening and closing angle, that is, the first opening and closing angle and the second opening and closing degree are input into the force inverse model, thereby obtaining the clamping force of the clamping portion,
- the force feedback device outputs feedback force to the holding piece according to the clamping force.
- F ug is the clamping force of the clamping part
- ⁇ ug is the first opening and closing angle of the clamping part
- ⁇ tool is the second opening and closing angle
- k 1 , k 2 ,..., k n represent constant coefficients, which are obtained by measurement calibration during the modeling process.
- the feedback motor 1201 or the force feedback actuator 2201 outputs a feedback force to the gripper according to the clamping force Fug .
- Operating data such as voltage, rotation speed, and torque are used to determine whether the clamping part of the instrument is clamping the tissue.
- the force feedback device provides the grips 1133, 2133 with a feedback force including a tangential force related to the clamping portion according to a force feedback model related to the pitch angle of the wrist 220.
- the surgical system pre-stores a second current threshold related to the third motor 213c.
- the controller of the force feedback device detects that the current of the third motor 213c exceeds the second current threshold, it obtains the grips 1133, 2133 at this time. the third rotation angle, and obtain the fourth rotation angle of the holding parts 1133, 2133 after moving from the third rotation angle in real time, where the fourth rotation angle is smaller than the third rotation angle.
- the force feedback motor 1201 or the force feedback actuator 2201 of the force feedback device provides a feedback force including a tangential force to the gripper 1133, 2133 based on the third rotation angle and the fourth rotation angle. How to obtain the feedback force through the force feedback model and the third and fourth rotation angles of the holding member can be referred to the above embodiments, which will not be described again here.
- the force feedback device provides feedback force to the grips 1133, 2133 based on a force feedback model related to the pitch angle of the instrument's wrist 220, 410. Specifically, when the controller of the force feedback device detects that the current of the third motor 213c is greater than the second threshold current, it obtains the first pitch angle of the wrist 220, 410 at this time, and obtains the first pitch angle of the wrist from the wrist in real time. The actual second pitch angle after a pitch angle movement, wherein the first pitch angle is smaller than the second pitch angle.
- the force feedback motor 1201 or the brake 2201 provides feedback force to the grip based on the first pitch angle of the wrist and the second pitch angle of the clamping part.
- the force feedback device outputs a feedback force to the gripping part according to the tangential force of the clamp.
- F vg is the tangential force of the clamping part
- ⁇ vg is the first pitch angle of the wrist
- ⁇ wrist is the second pitch angle of the wrist
- k 1 , k 2 ,..., k n represent constant values
- Coefficients are obtained from measurement calibration during the modeling process.
- the feedback motor 1201 or the force feedback actuator 2201 outputs a feedback force to the grip according to the tangential force F vg .
Landscapes
- Health & Medical Sciences (AREA)
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Robotics (AREA)
- Biomedical Technology (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Heart & Thoracic Surgery (AREA)
- Medical Informatics (AREA)
- Molecular Biology (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Manipulator (AREA)
Abstract
Description
本申请要求于2022年8月31日提交中国知识产权局,申请号为202211054800.2,发明名称为“一种外科手术系统”的中国专利申请的优先权;以及要求于2022年8月31日提交中国知识产权局,申请号为202211057444.X,发明名称为“一种外科手术系统及力反馈方法”的中国专利申请的优先权。This application is required to be submitted to the China Intellectual Property Office on August 31, 2022, with the application number 202211054800.2 and the priority of the Chinese patent application with the invention name "A Surgical System"; and it is required to be submitted to China on August 31, 2022 Intellectual Property Office, the application number is 202211057444.X, and the invention title is “A surgical system and force feedback method”.
本申请涉及医疗器械领域,特别是涉及一种主从操作的远程操作外科手术系统及力反馈方法。The present application relates to the field of medical devices, and in particular to a master-slave remote operation surgical system and a force feedback method.
微创手术是指利用腹腔镜、胸腔镜等现代医疗器械及相关设备在人体腔体内部施行手术的一种手术方式。相比传统手术方式微创手术具有创伤小、疼痛轻、恢复快等优势。Minimally invasive surgery refers to a surgical method that uses modern medical instruments such as laparoscope and thoracoscope and related equipment to perform surgery inside the human cavity. Compared with traditional surgical methods, minimally invasive surgery has the advantages of less trauma, less pain, and faster recovery.
随着科技的进步,微创医疗机器人技术逐渐成熟,并被广泛应用。微创医疗机器人辅助手术系统通常包括主控制台及从操作设备,医生通过控制主控制台的输入设备控制从操作设备,从操作设备用于响应主控制台发送的控制命令,并执行相应的手术操作。器械与从操作设备的驱动装置连接,用于执行外科手术,器械的远端包括用于执行手术操作的末端执行器和与末端执行器连接的可以多个自由度动作的关节组件。With the advancement of science and technology, minimally invasive medical robot technology has gradually matured and been widely used. Minimally invasive medical robot-assisted surgery systems usually include a master console and a slave operating device. The doctor controls the slave operating device by controlling the input device of the master console. The slave operating device is used to respond to the control commands sent by the master console and perform the corresponding surgery. operate. The instrument is connected to a driving device of the slave operating device for performing surgical operations. The distal end of the instrument includes an end effector for performing surgical operations and a joint assembly connected to the end effector that can move with multiple degrees of freedom.
而在医生远程操作手术机器人辅助手术系统时,不能直观地感受到手术器械施加到人体组织的力,从而可能引发意外情况,例如手术器械夹持力过大,破坏了组织。When doctors remotely operate the surgical robot-assisted surgery system, they cannot intuitively feel the force exerted by surgical instruments on human tissue, which may cause unexpected situations, such as excessive clamping force of surgical instruments, damaging the tissue.
发明内容Contents of the invention
基于此,本申请在第一方面提供一种外科手术系统,其包括手术器械,其包括夹持部;输入装置,其包括握持件,所述握持件用于控制所述夹持部的开合角度;驱动装置,其包括第一马达和第二马达,所述第一马达和所述第二马达 用于驱动夹持部执行开合动作;控制器,其被配置为:Based on this, the present application provides a surgical system in a first aspect, which includes a surgical instrument including a clamping part; an input device including a gripping part for controlling the gripping part. Opening and closing angle; driving device, which includes a first motor and a second motor, the first motor and the second motor Used to drive the clamping part to perform opening and closing actions; the controller is configured as:
获取所述第一马达和所述第二马达的运行数据;Obtain operating data of the first motor and the second motor;
确定所述第一马达和所述第二马达的运行数据是否大于第一阈值;Determine whether operating data of the first motor and the second motor is greater than a first threshold;
如果所述运行数据大于所述第一阈值,获取此时所述握持件的第一转动角度;If the operating data is greater than the first threshold, obtain the first rotation angle of the holding member at this time;
获取所述握持件的第二转动角度,并基于所述第一转动角度和所述第二转动角度向所述握持件输出反馈力,其中所述第二转动角度小于所述第一转动角度;Obtain a second rotation angle of the holding member, and output a feedback force to the holding member based on the first rotation angle and the second rotation angle, wherein the second rotation angle is smaller than the first rotation angle angle;
或者,如果所述运行数据大于所述第一阈值,获取此时所述夹持部的第一开合角度;Or, if the operating data is greater than the first threshold, obtain the first opening and closing angle of the clamping portion at this time;
获取夹持部的第二开合角度,并基于所述第一开合角度和所述第二开合角度向所述握持件输出反馈力,其中所述第二开合角度小于所述第一开合角度。Obtain a second opening and closing angle of the clamping portion, and output a feedback force to the gripper based on the first opening and closing angle and the second opening and closing angle, wherein the second opening and closing angle is smaller than the third opening and closing angle. One opening and closing angle.
在一个具体的实施例中,所述第一马达和所述第二马达的运行数据包括所述第一马达和所述第二马达的电流、电压、转速中的一种。In a specific embodiment, the operating data of the first motor and the second motor includes one of the current, voltage, and rotation speed of the first motor and the second motor.
在一个具体的实施例中,所述手术器械还包括长轴和腕部,所述夹持部与所述腕部转动连接,所述腕部与所述长轴的远端转动连接;所述驱动装置包括用于驱动所述腕部执行俯仰动作的第三马达,在第三马达驱动所述腕部执行俯仰动作时,所述第一、第二马达可维持不动,以维持所述夹持部的开合角度不变;In a specific embodiment, the surgical instrument further includes a long shaft and a wrist, the clamping part is rotatably connected to the wrist, and the wrist is rotatably connected to the distal end of the long shaft; The driving device includes a third motor for driving the wrist to perform a pitching action. When the third motor drives the wrist to perform a pitching action, the first and second motors can remain stationary to maintain the clamp. The opening and closing angle of the handle remains unchanged;
在一个具体的实施例中,所述控制器还被配置为:In a specific embodiment, the controller is further configured to:
获取第三马达的运行数据;Obtain the operating data of the third motor;
确定所述第三马达的运行数据是否大于第二阈值;Determine whether the operating data of the third motor is greater than a second threshold;
如果所述第三马达的运行数据大于所述第二阈值,获取此时所述握持件的第三转动角度;If the operating data of the third motor is greater than the second threshold, obtain the third rotation angle of the holding member at this time;
获取握持件的第四转动角度,并基于所述第三转动角度和所述第四转动角度向所述握持件输出反馈力,所述第四转动角度小于所述第三转动角度;Obtaining a fourth rotation angle of the holding member, and outputting a feedback force to the holding member based on the third rotation angle and the fourth rotation angle, the fourth rotation angle being smaller than the third rotation angle;
在一个具体的实施例中,所述控制器还被配置为:In a specific embodiment, the controller is further configured to:
获取第三马达的运行数据; Obtain the operating data of the third motor;
确定所述第三马达的运行数据是否大于第二阈值;Determine whether the operating data of the third motor is greater than a second threshold;
如果所述第三马达的运行数据大于所述第二阈值,获取此时所述腕部的第一俯仰角度;If the operating data of the third motor is greater than the second threshold, obtain the first pitch angle of the wrist at this time;
获取腕部的第二俯仰角度,并基于所述第一俯仰角度和所述第二俯仰角度向所述握持件输出反馈力,其中所述第二俯仰角度小于所述第一俯仰角度;Obtaining a second pitch angle of the wrist, and outputting a feedback force to the grip based on the first pitch angle and the second pitch angle, wherein the second pitch angle is smaller than the first pitch angle;
在一个具体的实施例中,所述手术器械还容纳在器械盒中的多个绞盘及解耦机构,所述多个绞盘的第一、第二绞盘分别用于接受所述第一、第二马达的动力输入,所述第一绞盘通过第一对缆绳与所述夹持部连接,所述第二绞盘通过第二对缆绳与所述夹持部连接,所述第一对缆绳和所述第二对缆绳绕在所述解耦机构上,在所述第一马达驱动所述腕部转动时,所述解耦机构运动以增加所述第一对缆绳和所述第二对缆绳中的一对缆绳在所述器械盒中的长度并减少其中另一对缆绳在所述器械盒中的长度,从而维持所述夹持部的开合角度不变。In a specific embodiment, the surgical instrument also contains a plurality of winches and a decoupling mechanism in the instrument box, and the first and second winches of the plurality of winches are respectively used to receive the first and second winches. The power input of the motor, the first winch is connected to the clamping part through a first pair of cables, the second winch is connected to the clamping part through a second pair of cables, the first pair of cables and the A second pair of cables is wound around the decoupling mechanism, and when the first motor drives the wrist to rotate, the decoupling mechanism moves to increase the tension in the first pair of cables and the second pair of cables. The length of one pair of cables in the instrument box is reduced by the length of the other pair of cables in the instrument box, thereby maintaining the opening and closing angle of the clamping portion unchanged.
在一个具体的实施例中,所述输入装置还包括致动器和连杆组件,所述连杆组件一端连接所述致动器,另一端与所述握持件连接,所述致动器基于所述夹持力并通过所述连杆机构向所述握持件提供反馈力。In a specific embodiment, the input device further includes an actuator and a link assembly. One end of the link assembly is connected to the actuator and the other end is connected to the holding member. The actuator A feedback force is provided to the gripping member based on the clamping force and through the linkage mechanism.
在一个具体的实施例中,所述连杆机构包括第一连杆和第二连杆,所述第一连杆的一端与所述手柄转动连接,另一端与所述第二连杆的一端转动连接,所述第二连杆的另一端与所述致动器连接。In a specific embodiment, the linkage mechanism includes a first link and a second link. One end of the first link is rotatably connected to the handle, and the other end is connected to one end of the second link. Rotatingly connected, the other end of the second link is connected with the actuator.
在一个具体的实施例中,所述输入装置包括壳体、致动器和与所述致动器连接第一绳轮,所述第一绳轮通过第一销与所述壳体转动连接,所述第一绳轮与所述握持件通过第一缆绳连接,所述致动器基于所述夹持力并通过所述第一缆绳向所述握持件提供反馈力。In a specific embodiment, the input device includes a housing, an actuator and a first sheave connected to the actuator, and the first sheave is rotationally connected to the housing through a first pin, The first sheave is connected to the holding member through a first cable, and the actuator provides a feedback force to the holding member based on the clamping force and through the first cable.
本申请在第二方面提供一种外科手术系统,包括手术器械、驱动装置及控制器,手术器械包括长轴,包括近端部分和远端部分;末端执行器,其包括腕部和夹持部,所述腕部与所述远端部分转动连接,所述夹持部与所述腕部转动连接;In a second aspect, the present application provides a surgical system, including a surgical instrument, a driving device and a controller. The surgical instrument includes a long shaft, including a proximal part and a distal part; and an end effector, including a wrist and a clamping part. , the wrist is rotatably connected to the distal part, and the clamping part is rotatably connected to the wrist;
驱动装置包括多个马达,所述多个马达的第一马达和第二马达用于驱动所述夹持部执行开合动作,在所述多个马达的第三马达驱动所述腕部执行俯仰动作 时,所述第一、第二马达可维持不动,以维持所述夹持部的开合角度不变;The driving device includes a plurality of motors, the first motor and the second motor of the plurality of motors are used to drive the clamping part to perform opening and closing actions, and the third motor of the plurality of motors drives the wrist part to perform pitching. action When, the first and second motors can remain stationary to maintain the opening and closing angle of the clamping portion unchanged;
控制器被配置为:The controller is configured as:
获取所述第三马达的运行数据;Obtain operating data of the third motor;
确定所述第三马达的运行数据是否大于预存储的阈值;Determine whether the operating data of the third motor is greater than a pre-stored threshold;
如果所述第三马达的运行数据大于所述阈值,获取此时所述握持件的第一转动角度;If the operating data of the third motor is greater than the threshold, obtain the first rotation angle of the holding member at this time;
获取所述握持件的第二转动角度,并基于所述第一转动角度和所述第二转动角度向所述握持件输出反馈力,其中所述第二转动角度小于所述第一转动角度;Obtain a second rotation angle of the holding member, and output a feedback force to the holding member based on the first rotation angle and the second rotation angle, wherein the second rotation angle is smaller than the first rotation angle angle;
或者,如果所述第三马达的运行数据大于所述阈值,获取此时所述腕部的第一俯仰角度;Or, if the operating data of the third motor is greater than the threshold, obtain the first pitch angle of the wrist at this time;
获取所述腕部的第二俯仰角度,并基于所述第一俯仰角度和所述第二俯仰角度向所述握持件输出反馈力,其中所述第二俯仰角度大于所述第一俯仰角度。Obtaining a second pitch angle of the wrist, and outputting a feedback force to the grip based on the first pitch angle and the second pitch angle, wherein the second pitch angle is greater than the first pitch angle .
本申请在第二方面提供一种外科手术系统的力反馈控制方法,所述远程操作外科手术系统包括手术器械、输入装置及驱动装置,所述手术器械包括夹持部;所述输入装置包括握持件,所述握持件用于控制所述夹持部的开合角度;In a second aspect, the present application provides a force feedback control method for a surgical system. The remote operation surgical system includes a surgical instrument, an input device and a driving device. The surgical instrument includes a clamping part; the input device includes a grip. A holding member used to control the opening and closing angle of the clamping portion;
所述驱动装置包括第一马达和第二马达,所述第一马达和所述第二马达用于驱动夹持部执行开合动作;The driving device includes a first motor and a second motor, and the first motor and the second motor are used to drive the clamping portion to perform opening and closing actions;
所述方法包括:The methods include:
获取所述第一马达和所述第二马达的运行数据;Obtain operating data of the first motor and the second motor;
确定所述第一马达和所述第二马达的运行数据是否大于预存储的阈值;Determine whether operating data of the first motor and the second motor is greater than a pre-stored threshold;
如果所述运行数据大于所述阈值,获取此时所述握持件的第一转动角度;If the operating data is greater than the threshold, obtain the first rotation angle of the holding member at this time;
获取握持件的第二转动角度,基于所述第一转动角度和所述第二转动角度向所述握持件输出反馈力,其中所述第二转动角度小于所述第一转动角度;Obtaining a second rotation angle of the holding member, and outputting a feedback force to the holding member based on the first rotation angle and the second rotation angle, wherein the second rotation angle is smaller than the first rotation angle;
或者,如果所述运行数据大于所述阈值,获取此时所述夹持部的第一开合角度;Or, if the operating data is greater than the threshold, obtain the first opening and closing angle of the clamping part at this time;
获取夹持部的第二开合角度,基于所述第一开合角度和所述第二开合角度向所述握持件输出反馈力,其中所述第二开合角度小于所述第一开合角度。 Obtain a second opening and closing angle of the clamping portion, and output a feedback force to the gripper based on the first opening and closing angle and the second opening and closing angle, wherein the second opening and closing angle is smaller than the first opening and closing angle. Opening and closing angle.
图1为本申请一个实施例用于外科手术的远程操作外科手术系统的俯视图;Figure 1 is a top view of a remotely operated surgical system for surgical operations according to one embodiment of the present application;
图2为本申请一个实施例的器械的示意图;Figure 2 is a schematic diagram of a device according to an embodiment of the present application;
图3A为本申请的一个实施例的外科手术系统的主控制台的示意图;Figure 3A is a schematic diagram of the main console of the surgical system according to an embodiment of the present application;
图3B为本申请的一个实施例的主控制台的输入装置的示意图;Figure 3B is a schematic diagram of the input device of the main console according to an embodiment of the present application;
图4为本申请一个实施例的外科手术系统的从操作设备的示意图;Figure 4 is a schematic diagram of a slave operating device of the surgical system according to an embodiment of the present application;
图5为本申请一个实施例的从操作设备的机械臂示意图;Figure 5 is a schematic diagram of the robotic arm of the slave operating device according to an embodiment of the present application;
图6A-6D为本申请一个实施例的手术器械的末端执行器的示意图;6A-6D are schematic diagrams of the end effector of the surgical instrument according to one embodiment of the present application;
图7A-7B为图6A-6D所示的实施例的末端执行器执行俯仰动作的示意图;Figures 7A-7B are schematic diagrams of the end effector performing a pitching action according to the embodiment shown in Figures 6A-6D;
图8A为图6A-6D所示的手术器械的器械盒内部结构示意图;Figure 8A is a schematic diagram of the internal structure of the instrument box of the surgical instrument shown in Figures 6A-6D;
图8B-8C为图8A所示的器械盒解耦过程示意图;Figures 8B-8C are schematic diagrams of the instrument box decoupling process shown in Figure 8A;
图9A-9B为本申请另一实施例的手术器械的末端执行器的示意图;9A-9B are schematic diagrams of an end effector of a surgical instrument according to another embodiment of the present application;
图10A为图9A-9B所示的手术器械的器械盒内部结构示意图;Figure 10A is a schematic diagram of the internal structure of the instrument box of the surgical instrument shown in Figures 9A-9B;
图10B-10C为图10A所示的器械盒解耦过程示意图;Figures 10B-10C are schematic diagrams of the instrument box decoupling process shown in Figure 10A;
图11A为本申请的一个实施例输入装置的手柄示意图;Figure 11A is a schematic diagram of the handle of the input device according to an embodiment of the present application;
图11B为图11A所示的手柄的一个视角的剖视图;Figure 11B is a cross-sectional view of the handle shown in Figure 11A;
图11C为图11A所示的手柄的另一个视角的剖视图;Figure 11C is a cross-sectional view of the handle shown in Figure 11A from another perspective;
图12为本申请一个实施例的末端执行器夹持件的施加力分析示意图;Figure 12 is a schematic diagram of the applied force analysis of the end effector clamping member according to one embodiment of the present application;
图13A为本申请一个实施例的输入装置的手柄示意图;Figure 13A is a schematic diagram of the handle of the input device according to one embodiment of the present application;
图13B为图13A所示的实施例手柄的立体图。Figure 13B is a perspective view of the handle of the embodiment shown in Figure 13A.
为了便于理解本申请,下面将参照相关附图对本申请进行更全面的描述。附图中给出了本申请的较佳实施方式。但是,本申请可以以许多不同的形式来实现,并不限于本文所描述的实施方式。相反地,提供这些实施方式的目的是使对本申请的公开内容理解的更加透彻全面,并非对本申请的限制。In order to facilitate understanding of the present application, the present application will be described more fully below with reference to the relevant drawings. The preferred embodiments of the present application are shown in the accompanying drawings. However, the present application may be implemented in many different forms and is not limited to the embodiments described herein. On the contrary, these embodiments are provided for the purpose of making the disclosure of the present application more thorough and comprehensive, and are not intended to limit the present application.
需要说明的是,当元件被称为“设置于”另一个元件,它可以直接在另一个元 件上或者也可以存在居中的元件。当一个元件被认为是“连接”另一个元件,它可以是直接连接到另一个元件或者可能同时存在居中元件,也可指两个元件通过信号进行交互相连。当一个元件被认为是“耦合”/“耦接”另一个元件,它可以是直接耦合到另一个元件或者可能同时存在居中元件,也可指两个元件通过信号进行交互。本文所使用的术语“垂直的”、“水平的”、“左”、“右”、“上方”、“下方”以及类似的表述只是为了说明的目的,并不表示是唯一的实施方式,应理解的是,这些与空间相关的术语旨在除了附图中描绘的取向之外还涵盖设备在使用中或在操作中的不同取向,例如,如果设备在附图中被翻转,则描述为在其他元件或特征“下方”或“之下”的元件或特征将被取向为在其他元件或特征“上方”。因此,示例术语“下方”可以包括上方和下方两种取向。It should be noted that when a component is said to be "set on" another component, it can be directly placed on another component. There can also be centered components on the component. When an element is said to be "connected" to another element, it can either be directly connected to the other element, intervening elements may also be present, or the two elements can be interconnected via signals. When an element is said to be "coupled" to another element, it can either be directly coupled to the other element, intervening elements may also be present, or the two elements can interact via signals. The terms "vertical", "horizontal", "left", "right", "above", "below" and similar expressions used herein are for illustrative purposes only and do not represent the only implementation manner and should It will be understood that these spatially relative terms are intended to cover different orientations of the device in use or operation in addition to the orientation depicted in the figures, e.g., if the device is turned over in the figures, then it is described as orientated in the figures. Elements or features that are "below" or "beneath" other elements or features will be oriented "above" the other elements or features. Thus, the example term "below" may include both upper and lower orientations.
本文所使用的术语“远端”、“近端”作为方位词,该方位词为介入医疗器械领域惯用术语,其中“远端”表示手术过程中远离外科医生的一端,“近端”表示手术过程中靠近外科医生的一端。The terms "distal" and "proximal" used in this article are directional terms, which are commonly used terms in the field of interventional medical devices. "Distal" refers to the end far away from the surgeon during the operation, and "proximal" refers to the operation. The end of the procedure closest to the surgeon.
术语“工具”在文中被用来描述医疗设备,该医疗设备用于插入患者身体并用于执行外科手术或诊断程序,该工具包括末端执行器,末端执行器可以是用于执行外科手术相关的外科手术器械,例如电烧灼器、钳夹器、吻合器、剪割器、成像设备(例如内窥镜或超声探头)以及类似物。本申请实施例中使用的一些工具进一步包括为末端执行器提供了铰接部件(例如关节组件),使得末端执行器的位置和取向能够以相对于器械轴一个或多个机械自由度被操控而运动。进一步地,末端执行器包括还包括功能性机械自由度,例如打开和闭合的钳夹。工具还可以包括可以被外科手术系统更新的存储信息,借此该存储系统可以提供工具与一个或多个系统元件之间的单向或双向通信。The term "tool" is used herein to describe a medical device for insertion into a patient's body and for performing a surgical or diagnostic procedure, the tool including an end effector, which may be a surgical device for performing a surgical procedure. Surgical instruments such as cauterizers, clamps, staplers, scissors, imaging equipment (such as endoscopes or ultrasound probes), and the like. Some tools used in embodiments of the present application further include providing the end effector with an articulating component (e.g., a joint assembly) such that the position and orientation of the end effector can be manipulated for movement in one or more mechanical degrees of freedom relative to the instrument axis. . Further, end effectors include jaws that also include functional mechanical degrees of freedom, such as opening and closing. The tool may also include stored information that may be updated by the surgical system, whereby the storage system may provide one-way or two-way communication between the tool and one or more system elements.
除非另有定义,本文所使用的所有的技术和科学术语与属于本申请的技术领域的技术人员通常理解的含义相同。本文中在本申请的说明书中所使用的术语只是为了描述具体的实施方式的目的,不是旨在于限制本申请。本文所使用的术语“及/或”和“和/或”包括一个或多个相关的所列项目的任意的和所有的组合。Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the technical field to which this application belongs. The terminology used herein in the description of the application is for the purpose of describing specific embodiments only and is not intended to limit the application. As used herein, the terms "and/or" and "and/or" include any and all combinations of one or more of the associated listed items.
本申请一个实施例的远程操作的外科手术系统如图1所示,远程操作的外 科手术系统包括主控制台10和从操作设备20,主控制台10远程通信地连接到从操作设备20,从操作设备50包括多个机械臂21,多个器械和/或成像设备分别可拆卸地安装在不同的机械臂21上。外科医生S可在主控制台10上远程操作控制器械和/或成像设备,主控制台10被配置为根据外科医生S的操作向从操作设备20发送控制信号和显示从操作设备20获取的影像,外科医生S通过主控制台10可以观察到影像系统提供的患者体内的三维立体成像,外科医生S通过观察患者体内三维的影像,能以沉浸式的感觉控制从操作设备10执行相关操作(例如执行外科手术或获取患者体内影像)。主控制台10和从操作设备设备20可以放置在同一个房间远程操作,也可以放置在不同的房间,甚至可以位于不同的城市。A remotely operated surgical system according to one embodiment of the present application is shown in Figure 1. The remotely operated surgical system The surgical system includes a master console 10 and a slave operating device 20. The master console 10 is remotely connected to the slave operating device 20. The slave operating device 50 includes a plurality of robotic arms 21, and a plurality of instruments and/or imaging devices are respectively detachable. are mounted on different robotic arms 21. The surgeon S can remotely operate and control instruments and/or imaging equipment on the main console 10. The main console 10 is configured to send control signals to the slave operating device 20 and display images acquired from the slave operating device 20 according to the operation of the surgeon S. The surgeon S can observe the three-dimensional imaging in the patient's body provided by the imaging system through the main console 10. By observing the three-dimensional image in the patient's body, the surgeon S can control the operation device 10 to perform related operations (for example, with an immersive feeling). Perform surgical procedures or obtain internal images of patients). The master console 10 and the slave operating device 20 can be placed in the same room for remote operation, or they can be placed in different rooms, or even located in different cities.
主控制台10还远程通信地与电子设备推车C连接,电子设备推车C远程通信地与主控制台10、从操作设备20相连接,电子设备推车30可包括能量发生装置、图像信号处理装置等电子设备。本实施例中,主控制台10与从操作设备20、电子设备推车C之间采用有线以太网通讯方式进行远程通信,但远程通信并不限于有线以太网通讯,也可以是其他有线方式,例如包括但不限于串口、CAN、RS485、RS232、USB、SPI等,或者以及无线通讯方式,例如包括但不限于WiFi、NB、Zigbee、蓝牙、RFID等。The main console 10 is also connected to the electronic equipment cart C through remote communication. The electronic equipment cart C is connected to the main console 10 and the slave operating device 20 through remote communication. The electronic equipment cart 30 may include an energy generating device, an image signal Processing devices and other electronic equipment. In this embodiment, wired Ethernet communication is used for remote communication between the main console 10, the slave operating device 20, and the electronic equipment cart C. However, the remote communication is not limited to wired Ethernet communication and may also be other wired methods. For example, it includes but is not limited to serial port, CAN, RS485, RS232, USB, SPI, etc., or wireless communication methods, such as but is not limited to WiFi, NB, Zigbee, Bluetooth, RFID, etc.
远程操作的外科手术系统通常还包括使操作者能够从患者身体外部观察手术部位的影像系统。该影像系统通常包括具有视频图像采集功能成像设备(例如内窥镜)和用于显示被采集图像的一个或多个视频显示设备。一般地,成像设备包括将获取患者身体内图像的一个或多个成像传感器(例如CCD或CMOS传感器)的光学器件。该一个或多个成像传感器可以被放置在的具有成像设备的远端处,并且该一个或多个传感器产生的信号可以沿电缆或通过无线传输以在视频显示设备上处理和显示。Teleoperated surgical systems also often include imaging systems that enable the operator to view the surgical site from outside the patient's body. The imaging system typically includes an imaging device (such as an endoscope) with video image capture capabilities and one or more video display devices for displaying the captured images. Typically, the imaging device includes optics of one or more imaging sensors (eg, CCD or CMOS sensors) that will acquire images within the patient's body. The one or more imaging sensors may be placed at a remote end of the imaging device, and the signals generated by the one or more sensors may be transmitted along a cable or wirelessly for processing and display on the video display device.
一个或多个套管连接于机械臂21的远端,套管插入躺在手术床T的患者P的身体上。助手A根据手术状况将工具30安装到机械臂21上,或从机械臂21上更换/重新装载工具30,工具30安装到机械臂21上后,通过套管插入患者P的体内。外科医生S、助手A以及麻醉师B组成基本的外科手术团队。 One or more cannulas are connected to the distal end of the robotic arm 21, and the cannulas are inserted into the body of the patient P lying on the operating bed T. Assistant A installs the tool 30 on the robotic arm 21 according to the surgical conditions, or replaces/reloads the tool 30 from the robotic arm 21. After the tool 30 is installed on the robotic arm 21, it is inserted into the body of the patient P through the cannula. Surgeon S, assistant A, and anesthesiologist B form the basic surgical team.
工具30可以是用于执行手术操作的电烧灼器、钳夹器、吻合器、超声刀等手术器械,也可以是获取影像的成像设备(例如内窥镜)或者其他外科工具。在一些实施例中,如图2所示,工具30包括传动盒31、长轴32及末端执行器33,传动盒用于接收机械臂21上的动力输入,并传递给末端执行器33,末端执行器33可以是执行手术的装置,例如钳夹,超声刀等;也可以是成像装置,例如图像传感器。The tool 30 may be a surgical instrument such as an electric cauterizer, a clamp, a stapler, or an ultrasonic scalpel for performing surgical operations, or may be an imaging device (such as an endoscope) for acquiring images or other surgical tools. In some embodiments, as shown in FIG. 2 , the tool 30 includes a transmission box 31 , a long shaft 32 and an end effector 33 . The transmission box is used to receive the power input on the robotic arm 21 and transmit it to the end effector 33 . The actuator 33 may be a device for performing surgery, such as a clamp, an ultrasonic scalpel, etc.; it may also be an imaging device, such as an image sensor.
本申请的一个实施例的主控制台如图3A所示,主控制台100包括显示设备101、扶手、第一、第二输入设备102,103、观察装置104以及多个踏板105,两个输入设备102,103分别用于控制不同的器械或成像设备。显示设备101用于显示上述影像系统所获取图像,例如,显示设备101为三维成像显示设备。外科医生S通过观察装置104观察显示设备101所显示的图像。扶手11用于放置外科医生的胳膊及/或手部,在一些实施例中,根据实际需要,也可以省略扶手,或省略观察装置104,此时可直接观察。The main console of an embodiment of the present application is shown in Figure 3A. The main console 100 includes a display device 101, an armrest, first and second input devices 102, 103, an observation device 104 and a plurality of pedals 105. Two input devices Devices 102, 103 are respectively used to control different instruments or imaging equipment. The display device 101 is used to display images acquired by the above imaging system. For example, the display device 101 is a three-dimensional imaging display device. The surgeon S observes the image displayed by the display device 101 through the observation device 104 . The armrest 11 is used to place the surgeon's arms and/or hands. In some embodiments, according to actual needs, the armrest can be omitted, or the observation device 104 can be omitted, and direct observation can be performed at this time.
外科医生S通过操作第一、第二输入设备102,103控制从操作设备20的工具运动,主控制台10的控制信号处理系统处理输入设备102的输入信号后向从操作设备20发出控制信号,从操作设备20响应主控制台100的控制信号,并进行相应的操作,即主从控制。在一些实施例中,控制信号处理系统也可以设置在从操作设备20中,例如设置在从设操作设备20的基座中。The surgeon S controls the tool movement of the slave operating device 20 by operating the first and second input devices 102 and 103. The control signal processing system of the master console 10 processes the input signal of the input device 102 and then sends a control signal to the slave operating device 20. The slave operating device 20 responds to the control signal of the master console 100 and performs corresponding operations, that is, master-slave control. In some embodiments, the control signal processing system may also be provided in the slave operating device 20 , for example, in the base of the slave operating device 20 .
在一些实施例中,如图3B所示,第一输入设备102包括手柄1021、腕部关节组件1030和肘部关节组件1040,手柄1021用于外科医生握持,腕部关节组件1030的运动用于改变第一输入设备102的姿态,例如手柄1021的姿态。肘部关节组件1040用于改变第一输入设备102的位置,例如手柄1021的位置。In some embodiments, as shown in Figure 3B, the first input device 102 includes a handle 1021, a wrist joint assembly 1030, and an elbow joint assembly 1040. The handle 1021 is used for the surgeon to hold, and the wrist joint assembly 1030 is used for movement. To change the posture of the first input device 102, such as the posture of the handle 1021. The elbow joint assembly 1040 is used to change the position of the first input device 102, such as the position of the handle 1021.
腕部关节组件1030包括多个腕关节1301,1032,1033,1034,各腕关节1301,1032,1033,1034之间通过L型连杆相互转动连接,其中腕关节1031围绕轴其线X1旋转,腕关节1032围绕其轴线X2旋转,腕关节1033围绕其轴线X3旋转,腕关节1034围绕其轴线X4旋转,各腕关节1301,1032,1033,1034围绕各自的轴线转动从而改变输入设备102的姿态。在一些实施例中,输入设备102的姿态包括轴线X1、轴线X2、轴线X3、以及轴线X4交点的姿态。 The wrist joint assembly 1030 includes a plurality of wrist joints 1301, 1032, 1033, 1034. Each wrist joint 1301, 1032, 1033, 1034 is rotationally connected to each other through an L-shaped connecting rod, wherein the wrist joint 1031 rotates around the axis X1, The wrist joint 1032 rotates around its axis X2, the wrist joint 1033 rotates around its axis X3, the wrist joint 1034 rotates around its axis X4, and each wrist joint 1301, 1032, 1033, 1034 rotates around its respective axis to change the posture of the input device 102. In some embodiments, the posture of the input device 102 includes the posture of the intersection of axis X1, axis X2, axis X3, and axis X4.
肘部关节组件1040包括多个肘关节1041,1042,1043,肘关节1041围绕其轴线X5旋转,肘关节1042围绕其轴线X6旋转,肘关节1043围绕其轴线X7旋转,各肘关节1041,1042,1043围绕各自的轴线转动从而改变输入设备102的位置。The elbow joint assembly 1040 includes a plurality of elbow joints 1041, 1042, 1043. The elbow joint 1041 rotates around its axis X5, the elbow joint 1042 rotates around its axis X6, and the elbow joint 1043 rotates around its axis X7. Each elbow joint 1041, 1042, 1043 rotate about their respective axes thereby changing the position of the input device 102 .
腕部关节组件1030和肘部关节组件1040包括多个电动机,该多个电动机用于驱动腕部关节组件1030和肘部关节组件1040运动。在一些实施例中,控制器250通过控制腕部关节组件1030的一个或多个电动机运动,进而控制腕部关节组件1030运动,从而使第一输入设备102和/或第二输入设备103的姿态跟随器械末端的姿态;或者,使第一输入设备102和/或第二输入设备103的姿态与器械末端的姿态对齐。The wrist joint assembly 1030 and the elbow joint assembly 1040 include multiple motors, and the multiple motors are used to drive the wrist joint assembly 1030 and the elbow joint assembly 1040 to move. In some embodiments, the controller 250 controls the movement of one or more motors of the wrist joint assembly 1030, thereby controlling the movement of the wrist joint assembly 1030, thereby changing the posture of the first input device 102 and/or the second input device 103. Follow the posture of the instrument end; alternatively, align the posture of the first input device 102 and/or the second input device 103 with the posture of the instrument end.
在一些实施例中,如图4所示,从操作设备200包括多个机械臂210,220,230,240和控制器2500,多个机械臂210,220,230,240可以是相同的构型,也可以是不同的构型,多个工具310,320,330,340安装在多个机械臂210,220,230,240上,具体地,多个工具中的第一器械310可拆卸地安装在多个机械臂中的第一机械臂210,第二器械320可拆卸地安装在第三机械臂230上,第三器械330可拆卸地安装在第四机械臂240上,多个工具中的成像设备340可拆卸地安装在第二机械臂220上。在其它的一些实施例中,器械和图像设备可以互换所安装的机械臂,例如第三器械330和成像设备320可以互换所安装的机械臂,互换后第三机械臂230上安装成像设备340,第二机械臂220上安装第二器械320。In some embodiments, as shown in FIG. 4 , the slave operating device 200 includes multiple robotic arms 210 , 220 , 230 , 240 and a controller 2500 . The multiple robotic arms 210 , 220 , 230 , 240 may be of the same configuration. , it can also be in different configurations. Multiple tools 310, 320, 330, 340 are installed on multiple robotic arms 210, 220, 230, 240. Specifically, the first instrument 310 among the multiple tools is detachably installed. In the first robot arm 210 of the plurality of robot arms, the second instrument 320 is detachably installed on the third robot arm 230, and the third instrument 330 is detachably installed on the fourth robot arm 240. Among the plurality of tools, The imaging device 340 is detachably mounted on the second robot arm 220. In some other embodiments, the instrument and the imaging device can interchange the installed robotic arms. For example, the third instrument 330 and the imaging device 320 can interchange the installed robotic arms. After the exchange, the imaging device is installed on the third robotic arm 230. In the equipment 340, the second instrument 320 is installed on the second robotic arm 220.
控制器2500被配置为响应于来自主控制台100或从操作设备20的控制信号,控制驱动机械臂210,220,230,240的关节运动,以及器械310、320、330和成像设备340的运动。控制器2500可以设置在从操作设备200的底座中,在一些实施例中,控制器2500也可以设置在各个机械臂上,可以理解,控制器2500也可以设置在主控制台100中。在一些实施例中,控制器2500与上述控制信号处理系统是同一控制装置,或者控制器2500和上述控制信号处理系统是分别设在从操作设备20和主控制台10内的不同控制装置。The controller 2500 is configured to control the joint movements of the driving robot arms 210, 220, 230, 240, and the movements of the instruments 310, 320, 330 and the imaging device 340 in response to control signals from the master console 100 or the slave operating device 20. . The controller 2500 may be provided in the base of the slave operating device 200. In some embodiments, the controller 2500 may also be provided on each robot arm. It is understandable that the controller 2500 may also be provided in the master console 100. In some embodiments, the controller 2500 and the above-mentioned control signal processing system are the same control device, or the controller 2500 and the above-mentioned control signal processing system are different control devices respectively provided in the slave operating device 20 and the master console 10 .
如图5所示,以多个机械臂中的第一机械臂210为例,机械臂210包括平 行四边形机构211和持械臂212,驱动装置213滑动设置在持械臂212上,驱动装置213用于驱动手术器械310的末端执行器313动作,平行四边形机构211用于是手术器械310围绕一个远程运动中心转动。驱动装置213包括多个马达213a、213b,213c,213d,器械盒311安装到驱动装置213上后,多个马达213a、213b,213c,213d对接到器械盒311中的传动装置,多个马达213a、213b,213c,213d通过驱动传动装置而驱动长轴312和末端执行器313动作,其中,第一马达213a和第二马达213b用于驱动末端执行器313执行开合动作,第三马达213c用于驱动末端执行器313执行俯仰动作,第四马达213d用于驱动长轴312自转。在一些实施例中,驱动装置213和器械盒311中间也可以通过无菌适配器连接。As shown in FIG. 5 , taking the first robotic arm 210 among multiple robotic arms as an example, the robotic arm 210 includes a flat The parallelogram mechanism 211 and the arm 212 are arranged in parallel. The driving device 213 is slidably disposed on the arm 212. The driving device 213 is used to drive the end effector 313 of the surgical instrument 310. The parallelogram mechanism 211 is used to rotate the surgical instrument 310 around a remote site. The center of movement rotates. The driving device 213 includes a plurality of motors 213a, 213b, 213c, and 213d. After the instrument box 311 is installed on the driving device 213, the plurality of motors 213a, 213b, 213c, and 213d are connected to the transmission device in the instrument box 311. The plurality of motors 213a , 213b, 213c, 213d drive the long shaft 312 and the end effector 313 by driving the transmission device. The first motor 213a and the second motor 213b are used to drive the end effector 313 to perform opening and closing actions, and the third motor 213c is used to drive the end effector 313 to open and close. To drive the end effector 313 to perform the pitching action, the fourth motor 213d is used to drive the long shaft 312 to rotate. In some embodiments, the driving device 213 and the instrument box 311 may also be connected through a sterile adapter.
现有的手术器械的末端执行器存在着运动耦合,在驱动装置驱动末端执行器动作时,需要两个或更多个马达参与驱动末端执行器的一个自由度的运动,例如驱动末端执行器313的夹持部开合的马达不仅需要驱动夹持部开合,还可能需要在末端执行器313执行俯仰运动时配合进行解耦运动,本发明一个实施例提供一种机械解耦的手术器械,通过机械解耦,驱动夹持部开合运动的马达仅驱动夹持部开合运动。The end effectors of existing surgical instruments have kinematic couplings. When the driving device drives the end effector to move, two or more motors are required to participate in driving one degree of freedom movement of the end effector, such as driving the end effector 313. The motor for opening and closing the clamping part not only needs to drive the opening and closing of the clamping part, but may also need to cooperate with the decoupling movement when the end effector 313 performs pitching motion. One embodiment of the present invention provides a mechanically decoupled surgical instrument. Through mechanical decoupling, the motor that drives the opening and closing movement of the clamping portion only drives the opening and closing movement of the clamping portion.
手术器械的末端执行器的运动解耦Motion decoupling of end effectors of surgical instruments
在一个实施例中,如图6A所示,末端执行器150包括第一支架210和腕部220,第一支架210的远端包括第一支柱314和第二支柱315,第一支架210的近端包括底架316,底架316的一端与长轴连接,从底架316的另一端朝末端执行器150的远端延伸形成第一支柱314和第二支柱315,第一支柱314、第二支柱315以及底架316形成大致U型夹的结构。In one embodiment, as shown in FIG. 6A , the end effector 150 includes a first bracket 210 and a wrist 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 first pillar 314 and a second pillar 315 . The end includes a base frame 316. One end of the base frame 316 is connected to the long axis. A first pillar 314 and a second pillar 315 are formed extending from the other end of the base frame 316 toward the distal end of the end effector 150. The first pillar 314 and the second pillar 315 are The pillar 315 and the bottom frame 316 form a substantially U-shaped clamp structure.
在第一支柱314与第二支柱315之间设置有第一销311和第二销312,第一销311和第二销312并排固定连接在第一支柱314和第二支柱315上,其中第一销311比第二销312更靠近第一支架210的底架316。A first pin 311 and a second pin 312 are provided between the first pillar 314 and the second pillar 315. The first pin 311 and the second pin 312 are fixedly connected to the first pillar 314 and the second pillar 315 side by side, wherein the first pin 311 and the second pin 312 are fixedly connected to the first pillar 314 and the second pillar 315. One pin 311 is closer to the base 316 of the first bracket 210 than the second pin 312.
为更好的展示末端执行器150的近端的结构,在图6B和图6C中没有显示第一支架210,如图6B和图6C所示,第一销311上设置有第一滑轮组,第一滑轮组包括依次设置在第一销311上的第一滑轮211、第二滑轮212、第三滑轮213和第四滑轮214,第二销312上设置有第二滑轮组,第二滑轮组包括依次设 置在第二销312上的第五滑轮215、第六滑轮216、第七滑轮217以及第八滑轮218,第一滑轮211至第八滑轮218都是用于引导驱动缆绳,由于用于引导驱动缆绳的滑轮都设置在第一支架上210,腕部220上没有滑轮,因此腕部220的体积可以制造的更小,使得末端执行器150的体积更小,并且不会存在滑轮脱落的风险。In order to better demonstrate the structure of the proximal end of the end effector 150, the first bracket 210 is not shown in Figures 6B and 6C. As shown in Figures 6B and 6C, a first pulley group is provided on the first pin 311. A pulley set includes a first pulley 211, a second pulley 212, a third pulley 213 and a fourth pulley 214 arranged in sequence on the first pin 311. A second pulley set is arranged on the second pin 312. The second pulley set includes a pulley set in sequence. The fifth pulley 215, the sixth pulley 216, the seventh pulley 217 and the eighth pulley 218 placed on the second pin 312, the first pulley 211 to the eighth pulley 218 are all used to guide the driving cable, because they are used to guide the driving. The pulleys of the cable are all arranged on the first bracket 210, and there are no pulleys on the wrist 220. Therefore, the volume of the wrist 220 can be made smaller, making the end effector 150 smaller, and there is no risk of the pulleys falling off.
腕部220上设置有第三支柱317、第四支柱318以及俯仰轮319,从俯仰轮319上沿末端执行器150的远端延伸形成第三支柱317和第四支柱318,第三支柱317、第四支柱318以及俯仰轮319构成大致U型架的形状,俯仰轮319安装在第二销312上,腕部220可以围绕第二销312的轴线的AA’旋转以实现末端执行器150的俯仰运动。The wrist 220 is provided with a third pillar 317, a fourth pillar 318 and a pitch wheel 319. The third pillar 317 and the fourth pillar 318 extend from the pitch wheel 319 along the distal end of the end effector 150. The third pillar 317, The fourth pillar 318 and the pitch wheel 319 form a roughly U-shaped frame. The pitch wheel 319 is installed on the second pin 312 . The wrist 220 can rotate around AA′ of the axis of the second pin 312 to achieve the pitch of the end effector 150 sports.
第三支柱317和第四支柱318之间设置有第三销313,第三销313与第一销311、第二销312相互垂直。末端执行器150的夹持部260包括第一夹持件261和第二夹持件262,第一夹持件261和第二夹持件262通过第三销313可转动地设置在腕部220上,第一夹持件261和第二夹持件262可以围绕第三销313的轴线BB’旋转,以实现夹持部260的开合和偏航运动,第一夹持件261和第二夹持件262可以是用于夹持组织的钳夹,或用于缝合的吻合器、或者用于电烧灼的烧灼器等。A third pin 313 is provided between the third pillar 317 and the fourth pillar 318, and the third pin 313 is perpendicular to the first pin 311 and the second pin 312. The clamping part 260 of the end effector 150 includes a first clamping part 261 and a second clamping part 262. The first clamping part 261 and the second clamping part 262 are rotatably arranged on the wrist 220 through a third pin 313. On, the first clamping member 261 and the second clamping member 262 can rotate around the axis BB' of the third pin 313 to realize the opening, closing and yawing movements of the clamping part 260. The clamping member 262 may be a clamp for clamping tissue, a stapler for suturing, or a cautery for electric cauterization, or the like.
设置在末端执行器150的驱动缆绳包括用于操纵末端执行器150开合和偏航运动第一对缆绳151和第二对缆绳152,用于操纵末端执行器150俯仰运动第三对缆绳153,第一对缆绳151包括第一驱动缆绳151A和第二驱动缆绳151B。第二对缆绳152包括第三驱动缆绳152A和第四驱动缆绳152B,第三对缆绳153包括第五驱动缆绳153A以及第六驱动缆绳153B。The driving cables provided on the end effector 150 include a first pair of cables 151 and a second pair of cables 152 for operating the end effector 150 to open, close, and yaw, and a third pair of cables 153 for operating the end effector 150 to pitch. The first pair of cables 151 includes a first drive cable 151A and a second drive cable 151B. The second pair of cables 152 includes a third drive cable 152A and a fourth drive cable 152B, and the third pair of cables 153 includes a fifth drive cable 153A and a sixth drive cable 153B.
如图6C、6D所示,在末端执行器150一侧上,第一对缆绳151在第一滑轮组和第二滑轮组上的绕线方式与第二对缆绳152在第一滑轮组和第二滑轮组上的绕线方式相反,第一对缆绳151的第一驱动缆绳151A在第一滑轮组和第二滑轮组上的绕线方式与第二驱动缆绳151B在第一滑轮组和第二滑轮组上的绕线方式相同,第二对缆绳152的第三驱动缆绳152A在第一滑轮组和第二滑轮组上的绕线方式相同与第四驱动缆绳152B在第一滑轮组和第二滑轮组上的绕线方式相 同。具体地,第一驱动缆绳151A的近端连接到器械盒170内的传动装置上,第一驱动缆绳151A的远端经过第一滑轮211的前部的导向后朝末端执行器150的远端延伸,并经过第五滑轮215的后部后导向后继续沿末端器械150的远端延伸并最后固定在第一夹持件261上。第二驱动缆绳151B经过第四滑轮214的前部导向后朝末端执行器150的远端延伸,并经过第八滑轮218的后部导向后继续朝末端执行器150的远端延伸并最后固定在第一夹持件261上。第三驱动缆绳152A的远端经过第二滑轮212后部的导向后朝末端执行器150的远端延伸,并经过第六滑轮216的前部导向后继续朝末端器械150的远端延伸并固定在第二夹持件262上,第四驱动缆绳152B的远端经过第三滑轮213的后部导向后朝末端执行器150的远端延伸,并经过第七滑轮217的前部导向后继续朝末端器械150的远端延伸并过渡在第二夹持件262上。As shown in Figures 6C and 6D, on the side of the end effector 150, the first pair of cables 151 is wound on the first pulley set and the second pulley set in the same way as the second pair of cables 152 is wound on the first pulley set and the second pulley set. The winding method is opposite. The first driving cable 151A of the first pair of cables 151 is wound on the first pulley set and the second pulley set in the same way as the second driving cable 151B is wound on the first pulley set and the second pulley set. , the third driving cable 152A of the second pair of cables 152 is wound in the same manner on the first pulley set and the second pulley set, and the fourth driving cable 152B is wound on the first pulley set and the second pulley set in the same manner. same. Specifically, the proximal end of the first driving cable 151A is connected to the transmission device in the instrument box 170 , and the distal end of the first driving cable 151A extends toward the distal end of the end effector 150 after being guided by the front of the first pulley 211 , and continues to extend along the distal end of the terminal instrument 150 after passing through the rear guide of the fifth pulley 215 and is finally fixed on the first clamping member 261 . The second driving cable 151B extends toward the distal end of the end effector 150 after passing through the front guide of the fourth pulley 214, and continues to extend toward the distal end of the end effector 150 after passing through the rear guide of the eighth pulley 218, and is finally fixed on on the first clamping member 261. The distal end of the third driving cable 152A extends toward the distal end of the end effector 150 after being guided by the rear of the second pulley 212, and continues to extend toward the distal end of the end instrument 150 after being guided by the front of the sixth pulley 216 and is fixed. On the second clamp 262, the distal end of the fourth driving cable 152B extends toward the distal end of the end effector 150 after passing through the rear guide of the third pulley 213, and continues toward the end after passing through the front guide of the seventh pulley 217. The distal end of tip instrument 150 extends and transitions onto second clamp 262 .
第三对缆绳153的第五驱动缆绳153A和第六驱动缆绳153B的近端到器械盒170,两者的远端被容纳在俯仰轮319的环形槽319A内,两者的末端分别固定在腕部220内,第五驱动缆绳153A和第六驱动缆绳153B一起驱动腕部220沿轴线AA’旋转,进而腕部220带动第一夹持部230和第二夹持部240一起沿轴线AA’进行俯仰运动。The proximal ends of the fifth driving cable 153A and the sixth driving cable 153B of the third pair of cables 153 reach the instrument box 170 , and their distal ends are accommodated in the annular groove 319A of the pitch wheel 319 , and their ends are respectively fixed on the wrist. In the part 220, the fifth driving cable 153A and the sixth driving cable 153B together drive the wrist 220 to rotate along the axis AA', and then the wrist 220 drives the first clamping part 230 and the second clamping part 240 to rotate along the axis AA'. pitching motion.
以下详细说明末端器械150的第三对缆绳153和第一、第二对缆绳151,152之间的耦合关系,当欲使末端执行器150执行俯仰运动时,则需器械盒170收拉第三对缆绳153的第五驱动缆绳153A或第六驱动缆绳153B,使得腕部220带动第一夹持部230和第二夹持部240一起围绕第一轴线AA’俯仰运动,如图7A和7B所示,器械盒170内的绞盘171收拉第六驱动缆绳153B,使得腕部220以及第一夹持部230和第二夹持部240围绕第一轴线AA’俯仰运动,若末端执行器150只执行俯仰运动,则需要维持第一对缆绳151、第二对缆绳152在第二滑轮组与夹持部之间的缆绳部分长度不变,否则会引起末端执行器150的偏航或开合运动。The coupling relationship between the third pair of cables 153 of the end instrument 150 and the first and second pairs of cables 151, 152 will be described in detail below. When the end effector 150 is to perform pitching motion, the instrument box 170 needs to retract and pull the third pair of cables 153. The fifth driving cable 153A or the sixth driving cable 153B of the cable 153 causes the wrist 220 to drive the first clamping part 230 and the second clamping part 240 to pitch together around the first axis AA', as shown in FIGS. 7A and 7B As shown, the winch 171 in the instrument box 170 pulls the sixth driving cable 153B, so that the wrist 220 and the first clamping part 230 and the second clamping part 240 move around the first axis AA'. If the end effector 150 only To perform the pitching motion, it is necessary to maintain the length of the cable portion of the first pair of cables 151 and the second pair of cables 152 between the second pulley group and the clamping portion unchanged, otherwise it will cause yaw or opening and closing motion of the end effector 150 .
在末端执行器150从图6A-6D所示的笔直状态旋转到图7A-7B所示的俯仰状态的过程中,在器械盒170收拉第六驱动缆绳153B时,假若末端执行器150需要转过的目标俯仰角度是α,则平面a需要从图6D中的位置也旋转α角度到 图7A的平面b的位置,假若第一滑轮组和第二滑轮组的滑轮的半径均为r1,为了使末端执行器150成功旋转目标的俯仰角度α,此时必须使得第一驱动缆绳151A和第二驱动缆绳151B分别在第五滑轮215和第八滑轮218上的包角长度同时增加长度L,其中L=α*r1,而相应的第三驱动缆绳152A和第四驱动缆绳152B分别在在第六滑轮216和第七滑轮217上的包角长度同时减少了长度L。During the process of the end effector 150 rotating from the straight state shown in Figures 6A-6D to the pitched state shown in Figures 7A-7B, when the instrument box 170 retracts and pulls the sixth driving cable 153B, if the end effector 150 needs to rotate The target pitch angle is α, then plane a needs to be rotated by α angle from the position in Figure 6D to At the position of plane b in Figure 7A, if the radii of the pulleys of the first pulley group and the second pulley group are both r1, in order for the end effector 150 to successfully rotate the target's pitch angle α, the first drive cable 151A and the second pulley set must be The wrapping angle lengths of the driving cable 151B on the fifth pulley 215 and the eighth pulley 218 respectively increase by the length L, where L=α*r1, and the corresponding third driving cable 152A and the fourth driving cable 152B are respectively on the sixth pulley 215 and the eighth pulley 218. The length of the wrapping angle on the pulley 216 and the seventh pulley 217 is reduced by the length L at the same time.
若要使末端执行器150的执行俯仰运动必须要使得第一驱动缆绳151A和第二驱动缆绳151B在末端执行器150上的长度同时增加或减少,第三驱动缆绳152A和第四驱动缆绳152B的在末端执行器上的长度必须同时减少或增加,故第三对缆绳153的运动受限制于第一对缆绳151、第二对缆绳152。In order for the end effector 150 to perform pitching motion, the lengths of the first driving cable 151A and the second driving cable 151B on the end effector 150 must be increased or decreased at the same time, and the lengths of the third driving cable 152A and the fourth driving cable 152B The length on the end effector must be reduced or increased at the same time, so the movement of the third pair of cables 153 is limited to the first pair of cables 151 and the second pair of cables 152 .
将这种一个元件的变化受另一个元件的影响/限制的关系称之为耦合关系,即一个元件与另一元件之间存在耦合关系。对于第一对缆绳151、第二对缆绳152以及第三对缆绳153而言,这种耦合关系使得第二对缆绳152和第三对缆绳153之间的任一条缆绳运动,都会引发其他缆绳不期望的运动,从而导致末端执行器也发生不期望的运动。这种耦合关系导致末端执行器的俯仰运动与开合和/或偏移运动相互影响,末端执行器的俯仰运动与开合和/或偏移运动相互不独立,使得末端执行器150无法正确的执行手术操作。因此需要解除第三对缆绳153和第一对缆绳151和/或第二对缆绳152之间的这种耦合关系,使第三对缆绳153的运动不再受限制于第一对缆绳151和/或第二对缆绳152,两者之间的运动能相互独立、互不干扰或影响,将这种解除第三对缆绳153和第一对缆绳151和/或第二对缆绳152之间这种耦合关系称之为解耦。The relationship in which the change of one element is affected/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 151 , the second pair of cables 152 and the third pair of cables 153 , this coupling relationship is such that any movement of any cable between the second pair of cables 152 and the third pair of cables 153 will cause the other cables to fail. Desired movement, resulting in undesired movement of the end effector. This coupling relationship causes the pitching motion of the end effector to interact with the opening and closing and/or deflecting motions, and the pitching motion and the opening and closing and/or deflecting motions of the end effector are not independent of each other, so that the end effector 150 cannot correctly Perform surgical procedures. Therefore, it is necessary to release the coupling relationship between the third pair of cables 153 and the first pair of cables 151 and/or the second pair of cables 152 so that the movement of the third pair of cables 153 is no longer restricted by the first pair of cables 151 and/or Or the second pair of cables 152, the movements of the two can be independent of each other, without interfering or affecting each other, so as to eliminate the problem between the third pair of cables 153 and the first pair of cables 151 and/or the second pair of cables 152. The coupling relationship is called decoupling.
对于如何解除上述耦合关系,一种现有的解耦方法是使用软件算法进行解耦,但是现有的软件解耦方法是无法解耦本发明这种类型的末端执行器的,本发明提出了一种机械解耦的方案,在手术器械120的器械盒170中设置一种机械解耦机构,从而解除第一对缆绳151和第二对缆绳152及第三对缆绳153之间耦合关系。Regarding how to decouple the above coupling relationship, an existing decoupling method is to use software algorithms for decoupling. However, the existing software decoupling method cannot decouple the type of end effector of the present invention. The present invention proposes A mechanical decoupling solution is to provide a mechanical decoupling mechanism in the instrument box 170 of the surgical instrument 120 to decouple the coupling relationship between the first pair of cables 151 , the second pair of cables 152 and the third pair of cables 153 .
如图8A所示为本发明一实施例的器械盒170的示意图,该器械盒170适用于接收动力输入并驱动图6A所示的末端执行器。器械盒170包括用于驱动末端执行器150执行开合和/或偏航运动的第一绞盘171和第二绞盘172,用于驱动 末端执行器150俯仰运动的第三绞盘173,以及用于驱动长轴160自转运动的第四绞盘174。第一对缆绳151的第一驱动缆绳151A和第二驱动缆绳151B分别以相反的缠绕方式绕在第一绞盘171上,第二对缆绳152的第三驱动缆绳152A和第四驱动缆绳152B分别以相反的缠绕方式绕在第二绞盘172上,第三对缆绳153的第五驱动缆绳153A和第六驱动缆绳153B分别以相反的缠绕方式绕在第三绞盘173上,第七驱动缆绳154A和第八驱动缆绳154B分别以相反的缠绕方式绕在第四绞盘174上。FIG. 8A is a schematic diagram of an instrument box 170 according to an embodiment of the present invention. The instrument box 170 is suitable for receiving power input and driving the end effector shown in FIG. 6A . The instrument box 170 includes a first winch 171 and a second winch 172 for driving the end effector 150 to perform opening and closing and/or yaw movements. The third winch 173 for pitching movement of the end effector 150, and the fourth winch 174 for driving the long shaft 160 to rotate. The first driving cable 151A and the second driving cable 151B of the first pair of cables 151 are respectively wound on the first winch 171 in an opposite winding manner, and the third driving cable 152A and the fourth driving cable 152B of the second pair of cables 152 are respectively wound in opposite directions. The fifth drive cable 153A and the sixth drive cable 153B of the third pair of cables 153 are respectively wound on the third winch 173 in an opposite winding manner. The eight drive cables 154B are each wound around the fourth winch 174 in opposite winding patterns.
当驱动装置132内的第一马达213a驱动第一绞盘171旋转时,第一绞盘171收拉或释放第一驱动缆绳151A或第二驱动缆绳151B以使第一夹持件261围绕其第三销313旋转,当驱动装置132内的第二马达驱动213b第二绞盘172旋转时,第二绞盘172收拉或释放第二驱动缆绳152A、第三驱动缆绳152B以使第二夹持件262围绕第三销313旋转。当驱动装置132内的第三马达驱动213c第三绞盘173旋转时,第三绞盘173收拉或者释放第五驱动缆绳153A、第六驱动缆绳153B时以使腕部220围绕第二销312的轴线AA’旋转从而实现末端执行器150执行俯仰运动。当驱动装置132内的第四马达驱动第四绞盘174随其轴174A旋转时,第四绞盘174收拉或释放第七驱动缆绳154A或第八驱动缆绳154B实现驱动长轴160的自转运动。When the first motor 213a in the driving device 132 drives the first winch 171 to rotate, the first winch 171 retracts or releases the first driving cable 151A or the second driving cable 151B to make the first clamping member 261 surround its third pin. 313 rotates, when the second motor in the driving device 132 drives the second winch 172 to rotate, the second winch 172 retracts or releases the second driving cable 152A and the third driving cable 152B to make the second clamping member 262 surround the third driving cable 152A. Three pins 313 rotation. When the third motor driving 213c in the driving device 132 rotates the third winch 173, the third winch 173 retracts or releases the fifth driving cable 153A and the sixth driving cable 153B so that the wrist 220 revolves around the axis of the second pin 312 AA' rotates so that the end effector 150 performs a pitching motion. When the fourth motor in the driving device 132 drives the fourth winch 174 to rotate with its shaft 174A, the fourth winch 174 retracts or releases the seventh driving cable 154A or the eighth driving cable 154B to realize the rotational movement of the driving long shaft 160 .
器械盒170还包括用于解除第三对缆绳153与第一对缆绳151、第二对缆绳152之间在末端执行器150一侧的耦合关系的解耦机构,解耦机构包括解耦轮1761和滑架176,滑架176包括支撑架1762和连接在支撑架1762两端的第一导向部1763、第二导向部1764,第一、第二驱动缆绳151A,151B绕在第一导向部1763上,第三、第四驱动缆绳152A、152B绕在第二导向部1764上,解耦轮1761通过第一解耦缆绳1767和第二解耦缆绳1768与支撑架1762连接,解耦轮1761通过驱动第一解耦缆绳1767和第二解耦缆绳1768进而操纵滑架176的运动。The instrument box 170 also includes a decoupling mechanism for decoupling the coupling relationship between the third pair of cables 153 and the first and second pairs of cables 151 and 152 on the end effector 150 side. The decoupling mechanism includes a decoupling wheel 1761 and the sliding frame 176. The sliding frame 176 includes a supporting frame 1762 and a first guide part 1763 and a second guide part 1764 connected to both ends of the supporting frame 1762. The first and second driving cables 151A and 151B are wound around the first guide part 1763. , the third and fourth driving cables 152A, 152B are wound around the second guide part 1764, the decoupling wheel 1761 is connected to the support frame 1762 through the first decoupling cable 1767 and the second decoupling cable 1768, and the decoupling wheel 1761 is driven by The first decoupling cable 1767 and the second decoupling cable 1768 in turn control the movement of the carriage 176 .
解耦轮1761与第三绞盘173可以设置在同一轴173A上,解耦轮1761与第三绞盘173同轴旋转。解耦轮1761和第三绞盘173具有不同的半径,解耦轮1761的半径为r2,第三绞盘173的半径为R2,其中r2<R2,解耦轮1761通过收拉或 释放第一解耦缆绳1767或第二解耦缆绳1768使得滑架176运动。The decoupling wheel 1761 and the third winch 173 may be disposed on the same shaft 173A, and the decoupling wheel 1761 and the third winch 173 rotate coaxially. The decoupling wheel 1761 and the third winch 173 have different radii. The radius of the decoupling wheel 1761 is r2, and the radius of the third winch 173 is R2, where r2<R2. The decoupling wheel 1761 is pulled or pulled by Releasing the first decoupling cable 1767 or the second decoupling cable 1768 causes movement of the carriage 176 .
解耦过程如图8B所示,当第三绞盘173沿逆时针(第一方向)旋转时,第三绞盘173收拉第六驱动缆绳153B并同时释放第五驱动缆绳153A,使得末端执行器150的腕部220如图7A和7B围绕第二销312的轴线AA’旋转,整个末端执行器150执行俯仰运动。由于解耦轮1761与第三绞盘173同轴旋转,此时解耦轮1761收拉第二解耦缆绳1768并同时释放第一解耦缆绳1767,假如解耦轮1761转过的弧长为L/2,则滑架176在第二解耦缆绳1768的拉动下沿A方向运动L/2距离,此时由于滑架176的运动,使得第一驱动缆绳151A和第二驱动缆绳151B在器械盒170内的长度将同时减少L,相应地,第三驱动缆绳152A和第四驱动缆绳152B在器械盒170内的长度将同时增加L。The decoupling process is shown in Figure 8B. When the third winch 173 rotates counterclockwise (first direction), the third winch 173 pulls the sixth driving cable 153B and simultaneously releases the fifth driving cable 153A, so that the end effector 150 The wrist 220 rotates about the axis AA' of the second pin 312 as shown in Figures 7A and 7B, and the entire end effector 150 performs a pitching motion. Since the decoupling wheel 1761 and the third winch 173 rotate coaxially, the decoupling wheel 1761 pulls the second decoupling cable 1768 and releases the first decoupling cable 1767 at the same time. If the arc length of the decoupling wheel 1761 is L /2, then the carriage 176 moves a distance of L/2 in the direction A under the pull of the second decoupling cable 1768. At this time, due to the movement of the carriage 176, the first driving cable 151A and the second driving cable 151B are in the instrument box. The lengths in the instrument box 170 will be reduced by L at the same time. Correspondingly, the lengths of the third driving cable 152A and the fourth driving cable 152B in the instrument box 170 will be increased by L at the same time.
由此第一驱动缆绳151A和第二驱动缆绳151B在器械盒170内的长度减少量与第一驱动缆绳151A和第二驱动缆绳151B分别在第五滑轮215和第八滑轮218上包角长度需要的增加量相等,第三驱动缆绳152A和第四驱动缆绳152B在器械盒170内的长度增加量与第三驱动缆绳152A和第四驱动缆绳152B在第六滑轮216和第七滑轮217上的包角长度需要的减少量相等。相反地,如图8C所示,当第三绞盘173和解耦轮1761一起顺时针(第二方向)旋转时,第一驱动缆绳151A和第二驱动缆绳151B在器械盒170内的长度增加量与第一驱动缆绳151A和第二驱动缆绳151B分别在第五滑轮215和第八滑轮218上包角长度需要的减少量相等,第三驱动缆绳152A和第四驱动缆绳152B在器械盒170内的长度减少量与第三驱动缆绳152A和第四驱动缆绳152B在第六滑轮216和第七滑轮217上的包角长度需要的增加量相等。由此第一对缆绳和第二缆绳在因末端执行器俯仰运动而引起的在末端执行器一侧上长度变化量全部由第一对缆绳和第二缆绳在器械盒170内的长度变化提供,因此第三对缆绳的运动将不再受第一对缆绳、第二对缆绳的限制,解耦机构实现了解除第三对缆绳与第一对缆绳、第二对缆绳之间的耦合关系。Therefore, the length reduction amount of the first driving cable 151A and the second driving cable 151B in the instrument box 170 is required to be the same as the wrapping angle length of the first driving cable 151A and the second driving cable 151B on the fifth pulley 215 and the eighth pulley 218 respectively. The increase in length of the third driving cable 152A and the fourth driving cable 152B in the instrument box 170 is equal to the length increase of the third driving cable 152A and the fourth driving cable 152B on the sixth pulley 216 and the seventh pulley 217 The required reductions in angular lengths are equal. On the contrary, as shown in FIG. 8C , when the third winch 173 and the decoupling wheel 1761 rotate clockwise (second direction) together, the lengths of the first driving cable 151A and the second driving cable 151B in the instrument box 170 increase. The amount of reduction required for the wrap angle length of the first drive cable 151A and the second drive cable 151B on the fifth pulley 215 and the eighth pulley 218 respectively, the third drive cable 152A and the fourth drive cable 152B in the instrument box 170 The length reduction is equal to the required increase in wrap angle length of the third drive cable 152A and the fourth drive cable 152B on the sixth pulley 216 and the seventh pulley 217 . Thus, the change in length of the first pair of cables and the second cable on the end effector side caused by the pitching motion of the end effector is entirely provided by the change in length of the first pair of cables and the second cable within the instrument box 170, 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, and the decoupling mechanism realizes the decoupling relationship between the third pair of cables and the first pair of cables and the second pair of cables.
为了使在解耦机构能精确可控地解除第三对缆绳153与第一对缆绳151、第二对缆绳152之间的耦合关系,解耦机构的解耦轮1761驱动滑架176始终沿直 线运动,并且使得从解耦件176运动引起的第一驱动缆绳151A、第二驱动缆绳151B、第三驱动缆绳152A以及第四缆绳152B的长度变化始终是线性的。In order to enable the decoupling mechanism to accurately and controllably decouple the coupling relationship between the third pair of cables 153, the first pair of cables 151, and the second pair of cables 152, the decoupling wheel 1761 of the decoupling mechanism drives the carriage 176 always along a straight line. The wire moves, and 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 resulting from the movement of the decoupling member 176 is always linear.
如图9A所示,为本发明一实施例的末端器械250的结构示意图,末端器械250包括大致呈U形结构的腕部410、第一支架510,以及夹持部610和驱动缆绳。第一对缆绳251的远端安装在夹持部610的第一夹持件611上,其近端连接到器械盒270内的第一绞盘上,第二对缆绳252的远端安装在夹持部610的第二夹持件612上,其近端连接到器械盒270内的绞盘上,第一对缆绳251和第二对缆绳252配合操纵第一夹持件611和第二夹持件612绕第一销512的轴线BB’旋转,实现末端器械250的开合和偏航运动。第三对缆绳253的远端安装在腕部410上,近端连接到器械盒270内的第三绞盘上。As shown in FIG. 9A , it is a schematic structural diagram of a terminal instrument 250 according to an embodiment of the present invention. The terminal instrument 250 includes a wrist 410 with a substantially U-shaped structure, a first bracket 510 , a clamping part 610 and a driving cable. The distal end of the first pair of cables 251 is installed on the first clamping member 611 of the clamping part 610, and its proximal end is connected to the first winch in the instrument box 270. The distal end of the second pair of cables 252 is installed on the clamping part 610. On the second clamping member 612 of the part 610, its proximal end is connected to the winch in the instrument box 270, and the first pair of cables 251 and the second pair of cables 252 cooperate to operate the first clamping member 611 and the second clamping member 612 Rotating around the axis BB′ of the first pin 512 realizes the opening, closing and yawing movements of the terminal instrument 250 . The distal end of the third pair of cables 253 is mounted on the wrist 410, and the proximal end is connected to the third winch in the instrument box 270.
第一对缆绳251包括第一驱动缆绳251A和第二驱动缆绳251B,第二对缆绳包括252第三驱动缆绳252A和第四驱动缆绳252B。第一滑轮组320固定在腕部410上,第二滑轮组330安装在在第一支架510上,其中第一滑轮组320包括第一、第二、第三、第四滑轮321,322,323,324,第二滑轮组330包括第五、第六、第七、第八滑轮325,326,327,328。The first pair of cables 251 includes a first drive cable 251A and a second drive cable 251B, and the second pair of cables includes 252 a third drive cable 252A and a fourth drive cable 252B. The first pulley set 320 is fixed on the wrist 410, and the second pulley set 330 is installed on the first bracket 510, wherein the first pulley set 320 includes first, second, third and fourth pulleys 321, 322, 323, 324, The second pulley group 330 includes fifth, sixth, seventh and eighth pulleys 325, 326, 327 and 328.
第一对缆绳251和第二对缆绳252在第一滑轮组320和第二滑轮组320上的绕线方式相同,但第一对缆绳251的第一驱动缆绳251A和第二驱动缆绳251B在第一滑轮组320和第二滑轮组330上的绕线方式相反,第二对缆绳252的第三驱动缆绳252A和第四驱动缆绳252B在第一滑轮组320和第二滑轮组330上的绕线方式相反。具体地,第一驱动缆绳251A经过第一滑轮321前部的导向然后再经过第五滑轮325的后部导向然后穿过第一支架510延伸至长轴160内;第二驱动缆绳251B经过第三滑轮323后部的导向然后再经过第七滑轮327的前部的导向后然后穿过第一支架510延伸至长轴160内。第三驱动缆绳252A经过第二滑轮322前部的导向然后再经过第六滑轮326的后部导向后穿过腕部210延伸至长轴160内,第四驱动缆绳352B经过第四滑轮324的后部的导向后然后再经过第八滑轮228的前部的导向后穿过腕部410延伸至末端长轴160内。The first pair of cables 251 and the second pair of cables 252 are wound in the same manner on the first pulley set 320 and the second pulley set 320, but the first driving cable 251A and the second driving cable 251B of the first pair of cables 251 are wound on the first pulley set 320 The third drive cable 252A and the fourth drive cable 252B of the second pair of cables 252 are wound in opposite ways on the first pulley set 320 and the second pulley set 330 . Specifically, the first driving cable 251A passes through the front guide of the first pulley 321 and then passes through the rear guide of the fifth pulley 325 and then passes through the first bracket 510 and extends into the long axis 160; the second drive cable 251B passes through the third The guide at the rear of the pulley 323 then passes through the guide at the front of the seventh pulley 327 and then extends through the first bracket 510 into the long axis 160 . The third driving cable 252A passes through the front guide of the second pulley 322 and then passes through the rear guide of the sixth pulley 326 before passing through the wrist 210 and extending into the long axis 160 . The fourth drive cable 352B passes through the rear of the fourth pulley 324 . After being guided by the front part of the eighth pulley 228, it passes through the wrist part 410 and extends into the terminal long axis 160.
本实施例中的第三对缆绳253与第一对缆绳251、第二对缆绳252之间也存在耦合关系。具体地,如图9B所示,当手术器械的器械盒270释放第三对缆绳 253的第五驱动缆绳253A并收拉第三对缆绳253的第六驱动缆绳253B时,期望的末端执行器250俯仰运动是末端执行器250的腕部410和夹持部610一起绕第二销511的轴线AA’顺时针方向旋转,并且在旋转的过程中夹持部610不绕第一销412运动。In this embodiment, there is also a coupling relationship between the third pair of cables 253, the first pair of cables 251, and the second pair of cables 252. Specifically, as shown in Figure 9B, when the instrument box 270 of the surgical instrument releases the third pair of cables When the fifth driving cable 253A of the third pair of cables 253 is retracted and the sixth driving cable 253B of the third pair of cables 253 is retracted, the desired pitching motion of the end effector 250 is that the wrist 410 and the clamping portion 610 of the end effector 250 revolve around the second pin together. The axis AA′ of 511 rotates clockwise, and the clamping portion 610 does not move around the first pin 412 during the rotation.
但是由于驱动缆绳经过上述绕线方式后,腕部410和夹持部610一起绕第二销412的轴线AA’逆时针旋转的过程中,使得第一对缆绳351的第一驱动缆绳251A和第二对缆绳252的第三驱动缆绳252B分别在第五滑轮325和第六滑轮326上的包角长度将增加,同时第二驱动缆绳252B和第四驱动缆绳252B分别在第七滑轮227和第八滑轮228上的包角长度将减少,从而促使夹持部610绕第一销412的轴线BB’逆时针旋转,从图中虚线位置旋转到图中实线位置,这是不期望发生的,第三对缆绳253与第一对缆绳251、第二对缆绳252之间也存在耦合关系。However, due to the above winding method of the driving cable, when the wrist portion 410 and the clamping portion 610 rotate counterclockwise around the axis AA' of the second pin 412, the first driving cable 251A of the first pair of cables 351 and the second pair of cables 351 are rotated counterclockwise. The wrapping angle length of the third driving cable 252B of the two pairs of cables 252 on the fifth pulley 325 and the sixth pulley 326 respectively will increase, while the second driving cable 252B and the fourth driving cable 252B are on the seventh pulley 227 and the eighth pulley respectively. The length of the wrapping angle on the pulley 228 will be reduced, thereby causing the clamping portion 610 to rotate counterclockwise around the axis BB' of the first pin 412 from the dotted line position in the figure to the solid line position in the figure, which is undesirable. There is also a coupling relationship between the three pairs of cables 253 and the first pair of cables 251 and the second pair of cables 252 .
因此本发明还提供了一种可以解除上述手术器械250的耦合关系的器械盒,如图10A所示,该器械盒270包括用于驱动末端器械250执行开合、偏航的第一绞盘271和第二绞盘272,用于驱动末端器械250执行俯仰运动的第三绞盘273,以及用于驱动长轴160自转运动的第四绞盘274。第一对缆绳251的第一驱动缆绳251A和第二驱动缆绳251B的近端以相反的缠绕方式绕在第一绞盘271上,第二对缆绳252的第三驱动缆绳252A和第四驱动缆绳252B的近端分别以相反的缠绕方式绕在第二绞盘272上,第三对缆绳253的第五驱动缆绳253A和第六驱动缆绳253B分别以相反的缠绕方式绕在第三绞盘273上,第四对缆绳的第六驱动缆绳254A和第七驱动缆绳254B分别以相反的缠绕方式绕在第四绞盘元274上。Therefore, the present invention also provides an instrument box that can decouple the above-mentioned surgical instrument 250. As shown in FIG. 10A, the instrument box 270 includes a first winch 271 for driving the end instrument 250 to perform opening, closing, and yaw. The second winch 272 is used to drive the terminal instrument 250 to perform pitching motion, the third winch 273 is used, and the fourth winch 274 is used to drive the long shaft 160 to rotate. The proximal ends of the first drive cable 251A and the second drive cable 251B of the first pair of cables 251 are wound on the first winch 271 in an opposite winding manner, and the third drive cable 252A and the fourth drive cable 252B of the second pair of cables 252 The proximal ends of the third pair of cables 253 are respectively wound on the second winch 272 in an opposite winding manner. The fifth driving cable 253A and the sixth driving cable 253B of the third pair of cables 253 are respectively wound on the third winch 273 in an opposite winding manner. The sixth drive cable 254A and the seventh drive cable 254B of the pair of cables are respectively wound on the fourth winch element 274 in opposite winding patterns.
器械盒270还包括用于解除第三对缆绳253与第一对缆绳251、第二对缆绳252之间在末端执行器250一侧的耦合关系的解耦机构,解耦机构包括解耦轮275和滑架276,解耦轮275与第三绞盘273同轴设置,滑架276包括支撑架2761和设置在支撑架2761两端的导向轮2763,2764。第一驱动缆绳251A和第三驱动缆绳252A通过第一导向部2763的导向后然后进入长轴160内,第二驱动缆绳251B和第四驱动缆绳152B通过第二导向部2764的导向后然后进入长轴内。 解耦轮275用于驱动从滑架276移动以改变第一对缆绳251和第二对缆绳252在器械盒内的长度,从而解除第三对缆绳与第一对缆绳、第二对缆绳之间的耦合关系。The instrument box 270 also includes a decoupling mechanism for decoupling the coupling relationship between the third pair of cables 253 and the first pair of cables 251 and the second pair of cables 252 on the end effector 250 side. The decoupling mechanism includes a decoupling wheel 275 The decoupling wheel 275 and the third winch 273 are coaxially arranged with the sliding frame 276. The sliding frame 276 includes a support frame 2761 and guide wheels 2763 and 2764 provided at both ends of the support frame 2761. The first driving cable 251A and the third driving cable 252A are guided by the first guide part 2763 and then enter the long shaft 160 . The second driving cable 251B and the fourth driving cable 152B are guided by the second guide part 2764 and then enter the long shaft 160 . inside the shaft. The decoupling wheel 275 is used to drive the slave carriage 276 to change the length of the first pair of cables 251 and the second pair of cables 252 in the instrument box, thereby decoupling the connection between the third pair of cables and the first and second pairs of cables. coupling relationship.
如图10B所示,当第三绞盘273沿第一方向(逆时针)旋转时,第三绞盘273收拉第五驱动缆绳253B并同时释放第四驱动缆绳253A,从而使得末端器械250的腕部220沿第二销511的轴线AA’旋转。由于解耦轮275与第三绞盘273同轴设置,解耦轮275沿第一方向旋转时释放第一解耦缆绳2765并同时收拉第二解耦缆绳2766从而牵引滑架276的支撑架2761在器械盒270内沿A方向移动,从而使得第一驱动缆绳251A和第三驱动缆绳252A在驱动装置内的长度同时减少,第二驱动缆绳251B和第四驱动缆绳252B在驱动装置内的长度同时增加。As shown in FIG. 10B , when the third winch 273 rotates in the first direction (counterclockwise), the third winch 273 pulls the fifth driving cable 253B and simultaneously releases the fourth driving cable 253A, so that the wrist of the terminal instrument 250 220 rotates along the axis AA′ of the second pin 511 . Since the decoupling wheel 275 and the third winch 273 are coaxially arranged, when the decoupling wheel 275 rotates in the first direction, it releases the first decoupling cable 2765 and simultaneously pulls the second decoupling cable 2766 to pull the support frame 2761 of the carriage 276 Move along direction A in the instrument box 270, so that the lengths of the first driving cable 251A and the third driving cable 252A in the driving device are simultaneously reduced, and the lengths of the second driving cable 251B and the fourth driving cable 252B in the driving device are simultaneously reduced. Increase.
如图10C所示,当第三绞盘273和解耦轮275一起沿与第一方向相反的第二方向旋转时,整个解耦过程和上述第三绞盘273和解耦轮275沿第一方向旋转的过程相反,因此所引起的驱动缆绳和解耦缆绳的变化也和上述沿第一方向运动相反。As shown in FIG. 10C , when the third winch 273 and the decoupling wheel 275 rotate together in the second direction opposite to the first direction, the entire decoupling process and the above-mentioned third winch 273 and the decoupling wheel 275 rotate in the first direction. The process is opposite, so the changes caused by the driving cable and the decoupling cable are also opposite to the above-mentioned movement in the first direction.
由此末端执行器250俯仰运动所需要第一对缆绳251的第一驱动缆绳151A和第二对缆绳的第三驱动缆绳152A分别在第五滑轮225和第六滑轮226上的包角长度的变化量,以及第二驱动缆绳151B和第四驱动缆绳152B分别在第七滑轮227和第八滑轮228上的包角长的变化量,全部由解耦机构的从解耦件176运动引起的第一驱动缆绳151A和第三驱动缆绳152A在驱动装置内的长度的变化量,以及第二驱动缆绳152B和第四驱动缆绳152B在驱动装置内的长度的变化量提供,从而使得第三对缆绳的运动不再受第一对缆绳、第二对缆绳的限制,实现第三对缆绳和第一对缆绳、第二对缆绳之间的精确解耦。Therefore, the pitch movement of the end effector 250 requires changes in the wrapping angle lengths of the first driving cable 151A of the first pair of cables 251 and the third driving cable 152A of the second pair of cables on the fifth pulley 225 and the sixth pulley 226 respectively. The amount, as well as the change amount of the wrapping angle length of the second driving cable 151B and the fourth driving cable 152B on the seventh pulley 227 and the eighth pulley 228 respectively, are all caused by the first movement of the decoupling member 176 of the decoupling mechanism. A change in the length of the drive cable 151A and the third drive cable 152A within the drive device, and a change in the length of the second drive cable 152B and the fourth drive cable 152B within the drive device provide such that movement of the third pair of cables No longer limited by the first pair of cables and the second pair of cables, precise decoupling between the third pair of cables and the first and second pairs of cables is achieved.
经过上述机械解耦后,驱动夹持部运动的驱动马达仅驱动夹持部运动,不需要参与解耦运动,换而言之,在第三马达213c驱动手术器械的腕部俯仰运动时,第一、第二马达213a,213b可以不动,从而末端执行器的夹持部的开合角度也维持不变。此时驱动夹持件运动的第一、第二马达213a,213b的运行数据的改变(例如电流的突然改变),只可能是因为夹持到人体组织产生,因此可以通过该运行数据确定夹持部施加到人体组织的夹持力,并基于该夹持力为输入装置提供力 反馈。After the above mechanical decoupling, the driving motor that drives the movement of the clamping part only drives the movement of the clamping part and does not need to participate in the decoupling movement. In other words, when the third motor 213c drives the wrist pitching motion of the surgical instrument, the third motor 213c drives the movement of the clamping part. 1. The second motors 213a and 213b can be stationary, so that the opening and closing angle of the clamping portion of the end effector remains unchanged. At this time, changes in the operating data of the first and second motors 213a and 213b that drive the clamping member (such as a sudden change in current) can only be caused by clamping to human tissue, so the clamping can be determined based on the operating data. The clamping force exerted to the human body tissue and providing force to the input device based on the clamping force feedback.
本发明的一个实施例还提供一种具有力反馈的输入装置,如图11A所示,输入装置的手柄1130与腕关节1031转动连接,手柄1130包括外壳1131和握持件1133,握持件1133转动安装在壳体1131上,外壳1131还包括把手1132,操作者在使用手柄1130时,像握枪一样握住把手1132,手指握住握持件1133。One embodiment of the present invention also provides an input device with force feedback. As shown in Figure 11A, the handle 1130 of the input device is rotationally connected to the wrist joint 1031. The handle 1130 includes a housing 1131 and a holding member 1133. The holding member 1133 Rotatingly mounted on the housing 1131, the housing 1131 also includes a handle 1132. When using the handle 1130, the operator holds the handle 1132 like a gun and holds the grip 1133 with his fingers.
如图11B、11C所示,手柄1130还包括力反馈装置,力反馈装置包括力反馈马达1201、传动缆绳1203以及第一绳轮1204,力反馈马达1201通过传动缆绳1203与第一绳轮1204连接。握持件1133的支架1134通过第二绳轮1205与第一绳轮1204相连接,第二绳轮1205与第一绳轮1204设置在同一销轴1135上,编码器1207固定在第一绳轮1204下方,并与第一、第二绳轮1204,1205同轴设置,用于检测第一、第二绳轮1204,1205的转动角度。在一些实施例中,第一绳轮1204和第二绳轮1205也可以不设置在同一销轴上,例如,第一绳轮1204和第二绳轮1205设置在不同的销轴上,第一绳轮1204和第二绳轮1205直接通过缆绳或者齿轮相连接。As shown in Figures 11B and 11C, the handle 1130 also includes a force feedback device. The force feedback device includes a force feedback motor 1201, a transmission cable 1203 and a first sheave 1204. The force feedback motor 1201 is connected to the first sheave 1204 through the transmission cable 1203. . The bracket 1134 of the holding member 1133 is connected to the first sheave 1204 through the second sheave 1205. The second sheave 1205 and the first sheave 1204 are arranged on the same pin 1135, and the encoder 1207 is fixed on the first sheave. 1204, and is coaxially arranged with the first and second sheave 1204, 1205, for detecting the rotation angle of the first and second sheave 1204, 1205. In some embodiments, the first sheave 1204 and the second sheave 1205 may not be disposed on the same pin. For example, the first sheave 1204 and the second sheave 1205 may be disposed on different pins. The sheave 1204 and the second sheave 1205 are directly connected through a cable or gear.
支架1134通过第一致动缆绳1206a和第二致动缆绳1206b与第二绳轮1205相连接,第一、第二致动缆绳1206a,1206b沿着支架1134的相对的侧面延伸,第一致动缆绳1206a的一端和第二致动缆绳1206b的一端分别固定在支架1134的两侧,第一、第二致动缆绳1205a,1206b以相反的方式缠绕在第二绳轮1205上,并且第一致动缆绳1206a的另一端和第二致动缆绳1206b的另一端固定在第二绳轮1205上。在一些实施例中,第一致动缆绳1206a和第二致动缆绳1206b在支架1134的两侧侧壁的凹槽中延伸。The bracket 1134 is connected to the second sheave 1205 through a first actuation cable 1206a and a second actuation cable 1206b. The first and second actuation cables 1206a, 1206b extend along opposite sides of the bracket 1134. The first actuation cable 1206a and the second actuation cable 1206b extend along the opposite sides of the bracket 1134. One end of the cable 1206a and one end of the second actuation cable 1206b are respectively fixed on both sides of the bracket 1134. The first and second actuation cables 1205a and 1206b are wound around the second sheave 1205 in opposite ways, and the first and second actuation cables 1205a, 1206b are wound on the second pulley 1205 in an opposite manner, and the first and second actuation cables 1205a, 1206b are wound on the second pulley 1205 in an opposite manner. The other end of the moving cable 1206a and the other end of the second actuation cable 1206b are fixed on the second sheave 1205. In some embodiments, the first actuation cable 1206a and the second actuation cable 1206b extend in grooves in the side walls of the bracket 1134.
在一个实施例中,握持件1133通过第二销轴1136与壳体1131转动连接,第二销轴1136和第一销轴1135平行,这样可以使握持件1133在转动时,第一驱动缆绳1206a和第二驱动缆绳1206b在支架1133的侧壁的凹槽内不易滑出。In one embodiment, the holding member 1133 is rotationally connected to the housing 1131 through a second pin 1136, and the second pin 1136 is parallel to the first pin 1135, so that when the holding member 1133 rotates, the first drive The cable 1206a and the second drive cable 1206b are not easily slipped out of the grooves in the side walls of the bracket 1133.
当操作者按压握持件1133,握持件1133的支架1133沿图示顺时针方向CW转动,在第一致动缆绳1206a的拉动下,第二绳轮1205逆时针转动,当操作者拉握持件1133,握持件1133围绕第二销轴1133沿逆时针CCW方向转动,第二致动缆绳1206b拉动第一绳轮1135顺时针转动。编码器1207可以检测到第二 绳轮1205转动角度,从而得到握持件1133的转动角度,手术系统的控制器根据握持件1133的转动角度来控制手术器械的末端执行器的夹持部的开合角度。When the operator presses the grip 1133, the bracket 1133 of the grip 1133 rotates in the clockwise direction CW as shown in the figure. Under the pull of the first actuation cable 1206a, the second sheave 1205 rotates counterclockwise. When the operator pulls the grip The holding member 1133 rotates in the counterclockwise CCW direction around the second pin 1133, and the second actuation cable 1206b pulls the first sheave 1135 to rotate clockwise. Encoder 1207 can detect the second The sheave 1205 rotates to obtain the rotation angle of the grip 1133. The controller of the surgical system controls the opening and closing angle of the clamping portion of the end effector of the surgical instrument according to the rotation angle of the grip 1133.
在一些实施例中,在握持件1133的支架1134和外壳1131之间设有被压缩的弹簧(图未示出),在操作者释放握持件1133后,弹簧恢复使得握持件1133沿逆时针CCW方向转动。In some embodiments, a compressed spring (not shown) is provided between the bracket 1134 of the grip 1133 and the housing 1131. After the operator releases the grip 1133, the spring recovers so that the grip 1133 moves in the reverse direction. The hour hand rotates in the CCW direction.
在手术器械的夹持部260夹持到人体组织R后,夹持部260的夹持动作的施加到组织R的力情况如图12所示,手术器械在夹持人体组织操作过程中,与人体组织的相互作用力通常被认为是夹持操作力,被可以沿末端工具坐标系分解为三维轴向作用力Fg、Fs、Ft,其中,Fg表示手术器械对于人体组织作用的齿面夹持力,Fs表示径向切向力,Ft表示轴向拉伸力。由于夹持部260中的第一夹持部件261和第二夹持部件262由缆绳单独控制,且与人体组织接触过程中均产生相互作用力,因此,可以将三维轴向作用力Fg、Fs、Ft进一步分解到第一夹持部件261齿面上且为三维轴向分力Fg′、Fs′、Ft′和第二夹持部件262齿面上且为三维轴向分力Fg″、Fs″、Ft″,力分解关系可以通过下式进行表达
After the clamping part 260 of the surgical instrument clamps the human tissue R, the force exerted on the tissue R by the clamping action of the clamping part 260 is as shown in Figure 12. During the operation of clamping the human tissue, the surgical instrument interacts with The interaction force of human tissue is usually considered to be the clamping operation force, which can be decomposed into three-dimensional axial forces F g , F s , and F t along the end tool coordinate system, where F g represents the effect of the surgical instrument on human tissue. Tooth surface clamping force, F s represents the radial tangential force, and F t represents the axial tensile force. Since the first clamping part 261 and the second clamping part 262 in the clamping part 260 are individually controlled by cables, and both generate interactive forces during contact with human tissue, the three-dimensional axial force F g , F s and F t are further decomposed into the tooth surface of the first clamping part 261 and are three-dimensional axial components F g ′, F s ′, F t ′ and the tooth surface of the second clamping part 262 and are three-dimensional axial components. Component force F g ″, F s ″, F t ″, the force decomposition relationship can be expressed by the following formula
其中,表示力Ft的矢量形式,同理到力矢量和表示矢量力的标量数值,同理到力标量值和 in, Represents the vector form of force F t , the same as the force vector and Represents vector force The scalar value of and
在手术器械150,250的夹持部260,610夹持到人体组织后,会引起驱动夹持部运动的驱动缆绳产生拉伸形变,进而导致驱动夹持部转动的第一马达213a和第二马达213b的电流产生突然较大的变化,而经过上述机械解耦后,第一马达213a和第二马达213b不再参与解耦运动,该两个马达分别独立驱动夹持部第一夹持件和第二夹持件,该两个马达的电流突然产生变化则表示夹持部夹持到人体组织,通过将该电流变化量输入到预先存储的“夹持部的操作力-电流变化量”的力反馈模型,其中操作力包括了夹持部的夹持力,即可以得到夹持到组织时的夹持部的夹持力的大小。After the clamping parts 260 and 610 of the surgical instruments 150 and 250 are clamped to human tissue, the driving cable that drives the clamping part to move will be stretched and deformed, thereby causing the first motor 213a and the second motor 213a that drive the clamping part to rotate. The current of the motor 213b suddenly changes greatly, and after the above-mentioned mechanical decoupling, the first motor 213a and the second motor 213b no longer participate in the decoupling movement, and the two motors independently drive the first clamping part of the clamping part. and the second clamping member. A sudden change in the current of the two motors indicates that the clamping part is clamping the human tissue. By inputting the current change amount into the pre-stored "operating force of the clamping part - current change amount" Force feedback model, in which the operating force includes the clamping force of the clamping part, that is, the clamping force of the clamping part when clamping to the tissue can be obtained.
在一个实施例中,“夹持部的操作力-电流变化量”力反馈模型还包括夹持部 的两个夹持件切向力Fs与第三马达213c的电流变化量之间的关系,手术器械150,250的夹持部260,610夹持到人体组织后,也能使夹持部261,610的两个夹持件受到齿面切向力,齿面切向力垂直上述夹持力,齿面切向力的存在将使第三马达213c的电流产生突然变化,将第三马达213c的电流变化量输入到力反馈模型中即可得到夹持不的齿面切向力大小。In one embodiment, the "operating force of the clamping part - current change" force feedback model also includes the clamping part The relationship between the tangential force F s of the two clamping parts and the current change amount of the third motor 213c. After the clamping parts 260 and 610 of the surgical instruments 150 and 250 are clamped to human tissue, the clamping part can also be The two clamping parts 261 and 610 are subjected to a tangential force on the tooth surface, and the tangential force on the tooth surface is perpendicular to the above-mentioned clamping force. The existence of the tangential force on the tooth surface will cause a sudden change in the current of the third motor 213c, and the third motor will The current change of 213c is input into the force feedback model to obtain the tangential force on the tooth surface of the clamping force.
在一些实施例中,通过标定设备对第一马达213a、第二马达213b和第三马达213c的电流变化量与压力传感器测量的夹持部的夹持力进行数学关系标定,根据数学关系最终得到“夹持部的操作力-电流变化量”力反馈模型。In some embodiments, a calibration device is used to calibrate the mathematical relationship between the current changes of the first motor 213a, the second motor 213b and the third motor 213c and the clamping force of the clamping part measured by the pressure sensor, and finally obtain according to the mathematical relationship. "Operation force of the clamping part - current change" force feedback model.
力反馈马达1201基于通过第一马达213a和第二马达213b的电流所检测到夹持部的夹持力大小向握持件1133提供反馈力,例如,力反馈装置的控制器根据检测到的夹持部240,610的夹持力转化为力反馈马达1201的输入电流,力开反馈马达1201根据该输入电流输出相应的阻力,该阻力可以和夹持部260,610的夹持力相等,也可以和该夹持力的大小成比例。由于第一绳轮1204和第二绳轮1205设置在同一销轴,反馈马达1201输出的阻力将通过传递缆绳1203、第一绳轮1204和第二绳轮1205传递到握持件1133上去,从而使操作者操作手柄时感受到反馈马达1201提供的阻力,这样操作者就能直观的感受到器械的末端执行器夹持到组织时的阻力大小,使得手术更加安全。The force feedback motor 1201 provides a feedback force to the grip 1133 based on the detected clamping force of the clamping portion through currents passing through the first motor 213a and the second motor 213b. The clamping force of the clamping parts 240 and 610 is converted into the input current of the force feedback motor 1201. The force feedback motor 1201 outputs a corresponding resistance according to the input current. The resistance can be equal to the clamping force of the clamping parts 260 and 610, and also It can be proportional to the size of the clamping force. Since the first sheave 1204 and the second sheave 1205 are arranged on the same pin, the resistance output by the feedback motor 1201 will be transmitted to the holding member 1133 through the transmission cable 1203, the first sheave 1204 and the second sheave 1205, thereby The operator can feel the resistance provided by the feedback motor 1201 when operating the handle, so that the operator can intuitively feel the resistance when the end effector of the instrument clamps the tissue, making the operation safer.
在一个实施例中,如图13A、13B所示的手柄2130,手柄2130包括壳体2131和两个握持件2133a,2133b,两个握持件2133a,2133b分别通过两个第一销轴2134a,2134b与壳体2131转动连接,操作通过捏压两个握持件2133可以实现对手术器械的末端执行器的夹持部的开合角度进行控制。In one embodiment, as shown in the handle 2130 in Figures 13A and 13B, the handle 2130 includes a housing 2131 and two holding parts 2133a, 2133b. The two holding parts 2133a, 2133b respectively pass through the two first pins 2134a. , 2134b is rotatably connected to the housing 2131, and the opening and closing angle of the clamping portion of the end effector of the surgical instrument can be controlled by pinching the two holding pieces 2133.
手柄2130还包括力反馈装置,力反馈装置包括连杆组件和力反馈致动器2201,连杆组件包括两个第一连杆2201a,2201b,两个第一连杆2201a,2201b的一端通过分别通过两个第二销轴2135a,2135b与两个握持件2133a,2133b转动连接,两个第一连杆2201a,2201b的另一端通过第三销轴2136与第二连杆2202一端转动连接,第二连杆2202的另一端连接力反馈致动器2201。The handle 2130 also includes a force feedback device. The force feedback device includes a link assembly and a force feedback actuator 2201. The link assembly includes two first links 2201a and 2201b. One ends of the two first links 2201a and 2201b pass through respectively. The two second pins 2135a and 2135b are rotationally connected to the two holding pieces 2133a and 2133b, and the other ends of the two first links 2201a and 2201b are rotationally connected to one end of the second link 2202 through a third pin 2136. The other end of the second link 2202 is connected to the force feedback actuator 2201.
和上述缆绳驱动的实施例类似,力反馈装置的控制器通过第一马达213a和第二马达213b的电流来检测到夹持部的夹持力大小,在力反馈装置的控制器根 据检测到的夹持部的夹持力转化为力反馈制动器2201的输入电流,力反馈致动器根据该输入电流通过所述连杆组件向所述握持夹2133a,2133b输入阻力,以为操作者提供力反馈。Similar to the above cable-driven embodiment, the controller of the force feedback device detects the clamping force of the clamping part through the current of the first motor 213a and the second motor 213b. The detected clamping force of the clamping part is converted into an input current of the force feedback brake 2201. The force feedback actuator inputs resistance to the holding clamps 2133a, 2133b through the connecting rod assembly according to the input current to facilitate the operation. Provides force feedback.
在一个实施例中,力反馈致动器2201通过第三连杆2203与第二连杆2202相连接,第二连杆2202沿直线运动,其运动方向与第一销轴2134a,2134b、第二销轴2135a,2135b及第三销轴2136垂直,第二连杆2202的直线运动带动第三连杆2203运动,从而将第二连杆2202的运动传递到力反馈致动器2201,藉此力反馈致动器2201可以检测到第二连杆2202的运动量,由此力反馈致动器2201检测到握持件2133a和握持件2133b的开合角度。In one embodiment, the force feedback actuator 2201 is connected to the second link 2202 through the third link 2203. The second link 2202 moves in a straight line, and its movement direction is consistent with the first pins 2134a, 2134b, and the second link 2202. The pins 2135a, 2135b and the third pin 2136 are vertical, and the linear motion of the second link 2202 drives the movement of the third link 2203, thereby transmitting the motion of the second link 2202 to the force feedback actuator 2201, whereby the force The feedback actuator 2201 can detect the movement amount of the second link 2202, whereby the force feedback actuator 2201 detects the opening and closing angles of the gripping parts 2133a and 2133b.
在一个施例中,两个握持件2133a,2133b之间还设有弹簧2205,在操作者松开握持件2133a,2133b后,弹簧2205提供弹性回复力,使的两个握持件2133a,2133b彼此远离。In one embodiment, a spring 2205 is provided between the two holding parts 2133a and 2133b. After the operator releases the holding parts 2133a and 2133b, the spring 2205 provides an elastic restoring force, causing the two holding parts 2133a to ,2133b stay away from each other.
在一个实施例中,力反馈装置的控制器通过第三马达的电流来检测到夹持部的切向力大小,力反馈装置的控制器将检测到的夹持部的夹持力转化为力反馈马达1201或力反馈制动器2201的输入电流,力反馈致动器根据该输入电流通过所述连杆组件向所述握持件1133或握持件2133a,2133b输入阻力,以为操作者提供包含夹持部切向力的力反馈。In one embodiment, the controller of the force feedback device detects the tangential force of the clamping part through the current of the third motor, and the controller of the force feedback device converts the detected clamping force of the clamping part into a force The input current of the feedback motor 1201 or the force feedback brake 2201 is fed back. The force feedback actuator inputs resistance to the grip 1133 or the grips 2133a, 2133b through the connecting rod assembly according to the input current, so as to provide the operator with a clip containing Force feedback of the tangential force of the holding part.
可以理解,在一些实施例中,也可以利用第一马达213a和第二马达213b的其它运行数据来建立夹持部的夹持力与运行数据的数学模型,例如可以建立“夹持部的夹持力-转速变化量”、“夹持部的夹持力-力矩变化量”、“夹持部的夹持力-电压变化量”等数学模型。It can be understood that in some embodiments, other operating data of the first motor 213a and the second motor 213b can also be used to establish a mathematical model of the clamping force of the clamping part and the operating data. For example, the "clamping force of the clamping part" can be established. Mathematical models such as "Clamping force - rotational speed change", "Clamping force of the clamping part - Torque change", "Clamping force of the clamping part - Voltage change".
在一个实施例中,力反馈装置根据与握持件1133的开合角度相关的力反馈模型来为握持件1133提供力反馈。具体地,力反馈装置基于手术器械的末端执行器是否夹持到人体组织而启用力反馈模型,例如,外科手术系统预先存储有与第一马达213a和第二马达213b的相关的阈值电流,当力反馈装置检测到第一马达213a和第二马达213b的电流大于该第一阈值电流时,则启动力反馈模型。该力反馈模型和手柄的握持件1133,2133的开合角度相关,力反馈装置的控制器在检测到第一马达213a和第二马达213b的电流大于该第一阈值电流时,
获取此时握持件1133,2133的第一转动角度,并实时获取握持件1133,2133从该第一转动角度运动后的第二转动角度,其中第二转动角度小于第一转动角度,转动角度是指握持件与手柄的中心线之间的夹角,以图11C为例,转动角度是指握持件1133与手柄1130的中心线X1的夹角γ。力反馈装置的反馈马达1201或力反馈致动器2201基于握持件第一转动角度和第二转动角度向握持件提供给反馈力。其中,基于将第一转动角度和第二转动角度得到反馈力,即将第一转动角度和第二转动角度输入到力反模型中,从而得到反馈力。力反馈模型如下:
Fmg=k1(θmg-θgrip)+k2(θmg-θgrip)2+…+kn(θmg-θgrip)n
In one embodiment, the force feedback device provides force feedback for the grip 1133 according to a force feedback model related to the opening and closing angle of the grip 1133 . Specifically, the force feedback device enables a force feedback model based on whether the end effector of the surgical instrument is clamped to human tissue. For example, the surgical system pre-stores threshold currents related to the first motor 213a and the second motor 213b. When the force feedback device detects that the currents of the first motor 213a and the second motor 213b are greater than the first threshold current, the force feedback model is started. The force feedback model is related to the opening and closing angles of the grips 1133 and 2133 of the handle. When the controller of the force feedback device detects that the currents of the first motor 213a and the second motor 213b are greater than the first threshold current, Obtain the first rotation angle of the holding parts 1133, 2133 at this time, and obtain the second rotation angle of the holding parts 1133, 2133 after moving from the first rotation angle in real time, where the second rotation angle is smaller than the first rotation angle. The angle refers to the included angle between the center line of the holding member and the handle. Taking FIG. 11C as an example, the rotation angle refers to the included angle γ between the holding member 1133 and the center line X1 of the handle 1130 . The feedback motor 1201 or the force feedback actuator 2201 of the force feedback device provides feedback force to the gripper based on the first rotation angle and the second rotation angle of the gripper. Wherein, the feedback force is obtained based on the first rotation angle and the second rotation angle, that is, the first rotation angle and the second rotation angle are input into the force inverse model, thereby obtaining the feedback force. The force feedback model is as follows:
F mg =k 1 (θ mg -θ grip )+k 2 (θ mg -θ grip ) 2 +…+k n (θ mg -θ grip ) n
上述力反馈模型中Fmg为反馈力,θmg为握持件第一转动角度,θgrip为握持件第二转动角度,k1、k2、…、kn表示常值系数,在建模过程中由测量标定得到。反馈马达1201或力反馈致动器2201根据反馈力Fmg向握持件输出反馈力。In the above force feedback model, F mg is the feedback force, θ mg is the first rotation angle of the grip, θ grip is the second rotation angle of the grip, k 1 , k 2 ,..., k n represent constant coefficients. Under construction It is obtained by measurement and calibration during the molding process. The feedback motor 1201 or the force feedback actuator 2201 outputs a feedback force to the grip according to the feedback force F mg .
力反馈装置的控制器可以置于输入装置内,也可以设置在主控制台10,或从操作设备20中,例如使用从操作设备20内控制器2500实现力反馈装置的控制器功能,可以理解的是,力反馈装置的控制器可以设置在手术系统的任何地方。The controller of the force feedback device can be placed in the input device, or can be set in the main console 10, or in the slave operating device 20. For example, the controller 2500 in the slave operating device 20 is used to realize the controller function of the force feedback device. It can be understood that What's more, the controller of the force feedback device can be placed anywhere in the surgical system.
在一个实施例中,力反馈装置根据与器械的夹持部260,610的两个夹持件开合角度相关的力反馈模型来为握持件1133提供给反馈力。具体地,当力反馈装置的控制器在检测到第一马达213a和第二马达213b的电流大于该第一阈值电流时,获取此时夹持部的第一开合角度,并实时获取夹持部从该第一开合角度运动后的实际的第二开合角度,其中第二开合角度小于第一开合角度,开合角度是指夹持部的两个夹持件之间的开合角度,在夹持间闭合时开合角度为零。反馈马达1201基于该第一开合角度和第二开合角度向手柄提供反馈力,即将第一开合角度和第二开合度输入到力反模型中,从而得到夹持部的夹持力,力反馈装置根据该夹持力向握持件输出反馈力,本实施例中力反馈模型如下:
Fug=k1(θug-θtool)+k2(θug-θtool)2+…+kn(θug-θtool)n
In one embodiment, the force feedback device provides feedback force to the gripping member 1133 based on a force feedback model related to the opening and closing angles of the two gripping members of the gripping portions 260, 610 of the instrument. Specifically, when the controller of the force feedback device detects that the current of the first motor 213a and the second motor 213b is greater than the first threshold current, it obtains the first opening and closing angle of the clamping part at this time, and obtains the clamping angle in real time. The actual second opening and closing angle after the part moves from the first opening and closing angle, wherein the second opening and closing angle is smaller than the first opening and closing angle, and the opening and closing angle refers to the opening and closing angle between the two clamping parts of the clamping part. The opening and closing angle is zero when the clamping space is closed. The feedback motor 1201 provides feedback force to the handle based on the first opening and closing angle and the second opening and closing angle, that is, the first opening and closing angle and the second opening and closing degree are input into the force inverse model, thereby obtaining the clamping force of the clamping portion, The force feedback device outputs feedback force to the holding piece according to the clamping force. In this embodiment, the force feedback model is as follows:
F ug =k 1 (θ ug -θ tool )+k 2 (θ ug -θ tool ) 2 +…+k n (θ ug -θ tool ) n
上述力反馈模型中Fug为夹持部的夹持力,θug为夹持部的第一开合角度, θtool为第二开合角度,k1、k2、…、kn表示常值系数,在建模过程中由测量标定得到。反馈马达1201或力反馈致动器2201根据夹持力Fug向握持件输出反馈力。In the above force feedback model, F ug is the clamping force of the clamping part, θ ug is the first opening and closing angle of the clamping part, θ tool is the second opening and closing angle, k 1 , k 2 ,..., k n represent constant coefficients, which are obtained by measurement calibration during the modeling process. The feedback motor 1201 or the force feedback actuator 2201 outputs a feedback force to the gripper according to the clamping force Fug .
可以理解,在一些实施例中,也可以通过检测第一马达213a和第二马达213b的其它运行数据来判断器械的夹持部是否夹持到组织,例如第一马达213a和第二马达213b的电压、转速、力矩等运行数据来判断器械的夹持部是否夹持到组织。It can be understood that in some embodiments, it can also be determined whether the clamping part of the instrument clamps the tissue by detecting other operating data of the first motor 213a and the second motor 213b, such as the first motor 213a and the second motor 213b. Operating data such as voltage, rotation speed, and torque are used to determine whether the clamping part of the instrument is clamping the tissue.
在一个实施例中,力反馈装置根据与腕部220的俯仰角度相关的力反馈模型来为握持件1133,2133提供包括夹持部切向力相关的反馈力。外科手术系统预存储有与第三马达213c相关的第二电流阈值,当力反馈装置的控制器在检测到第三马达213c的电流超过第二电流阈值时,获取此时握持件1133,2133的第三转动角度,并实时获取握持件1133,2133从该第三转动角度运动后的第四转动角度,其中第四转动角度小于第三转动角度。力反馈装置的力反馈马达1201或力反馈致动器2201基于握持件1133,2133的第三转动角度和第四转动角度向握持件提供给包含切向力的反馈力。如何通过力反馈模型和握持件的第三、第四转动角度得到反馈力,可以参照上述实施例,这里不再赘述。In one embodiment, the force feedback device provides the grips 1133, 2133 with a feedback force including a tangential force related to the clamping portion according to a force feedback model related to the pitch angle of the wrist 220. The surgical system pre-stores a second current threshold related to the third motor 213c. When the controller of the force feedback device detects that the current of the third motor 213c exceeds the second current threshold, it obtains the grips 1133, 2133 at this time. the third rotation angle, and obtain the fourth rotation angle of the holding parts 1133, 2133 after moving from the third rotation angle in real time, where the fourth rotation angle is smaller than the third rotation angle. The force feedback motor 1201 or the force feedback actuator 2201 of the force feedback device provides a feedback force including a tangential force to the gripper 1133, 2133 based on the third rotation angle and the fourth rotation angle. How to obtain the feedback force through the force feedback model and the third and fourth rotation angles of the holding member can be referred to the above embodiments, which will not be described again here.
在一个实施例中,力反馈装置根据与器械的腕部220,410的俯仰角度相关的力反馈模型来为握持件1133,2133提供给反馈力。具体地,当力反馈装置的控制器在检测到第三马达213c的电流大于该第二阈值电流时,获取此时腕部220,410的第一俯仰角度,并实时获取腕部从腕部第一俯仰角度运动后的实际的第二俯仰角度,其中第一俯仰角度小于第二俯仰角度。力反馈马达1201或制动器2201基于该腕部的第一俯仰角度和夹持部第二俯仰角度向握持件提供反馈力。即将腕部第一俯仰角和第二俯仰角输入到力反模型中,从而得到夹持部的切向力,力反馈装置根据该夹切向力向握持件输出反馈力,本实施例中力反馈模型如下:
Fvg=k1(θvg-θwrist)+k2(θvg-θwrist)2+…+kn(θvg-θwrist)n
In one embodiment, the force feedback device provides feedback force to the grips 1133, 2133 based on a force feedback model related to the pitch angle of the instrument's wrist 220, 410. Specifically, when the controller of the force feedback device detects that the current of the third motor 213c is greater than the second threshold current, it obtains the first pitch angle of the wrist 220, 410 at this time, and obtains the first pitch angle of the wrist from the wrist in real time. The actual second pitch angle after a pitch angle movement, wherein the first pitch angle is smaller than the second pitch angle. The force feedback motor 1201 or the brake 2201 provides feedback force to the grip based on the first pitch angle of the wrist and the second pitch angle of the clamping part. That is, the first pitch angle and the second pitch angle of the wrist are input into the force reaction model to obtain the tangential force of the clamping part. The force feedback device outputs a feedback force to the gripping part according to the tangential force of the clamp. In this embodiment The force feedback model is as follows:
F vg =k 1 (θ vg -θ wrist )+k 2 (θ vg -θ wrist ) 2 +…+k n (θ vg -θ wrist ) n
上述力反馈模型中Fvg为夹持部的切向力,θvg为腕部的第一俯仰角度,θwrist为腕部第二俯仰角度,k1、k2、…、kn表示常值系数,在建模过程中由测量标定得到。反馈马达1201或力反馈致动器2201根据切向力Fvg向握持件输出反馈力。In the above force feedback model, F vg is the tangential force of the clamping part, θ vg is the first pitch angle of the wrist, θ wrist is the second pitch angle of the wrist, k 1 , k 2 ,..., k n represent constant values Coefficients are obtained from measurement calibration during the modeling process. The feedback motor 1201 or the force feedback actuator 2201 outputs a feedback force to the grip according to the tangential force F vg .
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对 上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above-described embodiments can be combined in any way. To simplify the description, they are not All possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。 The above-mentioned embodiments only express several implementation modes of the present application, and their descriptions are relatively specific and detailed, but they should not be understood as limiting the scope of the invention patent. It should be noted that, for those of ordinary skill in the art, several modifications and improvements can be made without departing from the concept of the present application, and these all fall within the protection scope of the present application. Therefore, the protection scope of this patent application should be determined by the appended claims.
Claims (19)
Applications Claiming Priority (4)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211057444.XA CN117653352A (en) | 2022-08-31 | 2022-08-31 | Surgical operation system and force feedback method |
| CN202211054800.2A CN117653351A (en) | 2022-08-31 | 2022-08-31 | Surgical operation system |
| CN202211057444.X | 2022-08-31 | ||
| CN202211054800.2 | 2022-08-31 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2024046147A1 true WO2024046147A1 (en) | 2024-03-07 |
Family
ID=90100402
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/CN2023/113782 Ceased WO2024046147A1 (en) | 2022-08-31 | 2023-08-18 | Surgical system and force feedback method |
Country Status (1)
| Country | Link |
|---|---|
| WO (1) | WO2024046147A1 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN119184864A (en) * | 2024-09-26 | 2024-12-27 | 哈尔滨思哲睿智能医疗设备股份有限公司 | Surgical instrument clamping control method, device, controller, storage medium and program product |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107961078A (en) * | 2017-12-18 | 2018-04-27 | 微创(上海)医疗机器人有限公司 | Surgical robot system and its operating theater instruments |
| US20190083189A1 (en) * | 2016-12-27 | 2019-03-21 | Olympus Corporation | Manipulator system |
| US20200054401A1 (en) * | 2018-08-20 | 2020-02-20 | Verb Surgical Inc. | Method and system for engagement of a surgical tool with actuators of a tool drive in a surgical robotic system |
| CN111012511A (en) * | 2018-10-09 | 2020-04-17 | 成都博恩思医学机器人有限公司 | A surgical instrument control method for a laparoscopic surgical robot |
| CN111787874A (en) * | 2017-12-28 | 2020-10-16 | 爱惜康有限责任公司 | Surgical Instruments with Sensing Arrays |
| CN114072090A (en) * | 2019-06-27 | 2022-02-18 | 西拉格国际有限公司 | Robotic Surgical System with Safe and Cooperative Sensing Control |
-
2023
- 2023-08-18 WO PCT/CN2023/113782 patent/WO2024046147A1/en not_active Ceased
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20190083189A1 (en) * | 2016-12-27 | 2019-03-21 | Olympus Corporation | Manipulator system |
| CN107961078A (en) * | 2017-12-18 | 2018-04-27 | 微创(上海)医疗机器人有限公司 | Surgical robot system and its operating theater instruments |
| CN111787874A (en) * | 2017-12-28 | 2020-10-16 | 爱惜康有限责任公司 | Surgical Instruments with Sensing Arrays |
| US20200054401A1 (en) * | 2018-08-20 | 2020-02-20 | Verb Surgical Inc. | Method and system for engagement of a surgical tool with actuators of a tool drive in a surgical robotic system |
| CN111012511A (en) * | 2018-10-09 | 2020-04-17 | 成都博恩思医学机器人有限公司 | A surgical instrument control method for a laparoscopic surgical robot |
| CN114072090A (en) * | 2019-06-27 | 2022-02-18 | 西拉格国际有限公司 | Robotic Surgical System with Safe and Cooperative Sensing Control |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN119184864A (en) * | 2024-09-26 | 2024-12-27 | 哈尔滨思哲睿智能医疗设备股份有限公司 | Surgical instrument clamping control method, device, controller, storage medium and program product |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10463438B2 (en) | Modular device comprising mechanical arms | |
| JP4781492B2 (en) | Articulated manipulator device and endoscope system having the same | |
| CN105073055B (en) | Systems and methods for proximal control of surgical instruments | |
| CN101242788B (en) | Surgical accessory clamp and system | |
| CN111888012B (en) | Surgical instrument platform | |
| JP7600220B2 (en) | Hybrid direct control and robotic assisted surgery system | |
| Li et al. | A miniature manipulator with variable stiffness towards minimally invasive transluminal endoscopic surgery | |
| CN111084661A (en) | Operation support device, method of controlling the same, and recording medium | |
| JP2002503976A (en) | Force-reflective surgical instruments and positioning mechanisms for performing minimally invasive surgery with enhanced sophistication and sensitivity | |
| US12311548B2 (en) | Estimating joint friction and tracking error of a robotics end effector | |
| US12343104B2 (en) | Surgical platform supported and controlled by multiple arms | |
| CN116098713A (en) | Main hand wrist, main operating equipment and surgical robot | |
| WO2022228149A1 (en) | Input device, main operating device, and surgical robot | |
| CN116370095A (en) | surgical robot | |
| CN116056655A (en) | Controlling an endoscope by a surgical robot | |
| KR20240074873A (en) | Hardstop detection and handling for surgical instruments | |
| CN116869669B (en) | Surgical robot system | |
| CN116616898A (en) | Instrument with parallel joints and surgical robot | |
| WO2024046147A1 (en) | Surgical system and force feedback method | |
| JPH08224247A (en) | Medical manipulator | |
| WO2020209165A1 (en) | Surgical operation system and method for controlling surgical operation system | |
| Low et al. | Master-slave robotic system for therapeutic gastrointestinal endoscopic procedures | |
| CN117653352A (en) | Surgical operation system and force feedback method | |
| CN117100408B (en) | Surgical instrument and surgical robot | |
| WO2023116578A1 (en) | Instrument having parallel joint, and surgical robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 23859181 Country of ref document: EP Kind code of ref document: A1 |
|
| NENP | Non-entry into the national phase |
Ref country code: DE |
|
| 32PN | Ep: public notification in the ep bulletin as address of the adressee cannot be established |
Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205A DATED 21.07.2025) |