Drive system and surgical robot having the same
By adopting the design of linear drive device and drive shaft in the surgical robot system, combined with linear motor and elastic parts, the error problem during instrument switching is solved, high-precision drive and compliance are achieved, and the risk of collision between instruments and tissues is reduced. Improves the safety and accuracy of the surgery.
Patent Information
- Application Number
- CN202210916592.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-01
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2042-08-01
AI Technical Summary
The existing surgical robot system is inaccurate in control due to the error of rotation transmission torque when switching instruments, which is especially affected by small linear drive instruments, and it is difficult to avoid rigid collision between the instrument and tissue, increasing the risk of surgery.
The design of linear drive device and drive shaft enables rapid switching through the structure of the slot and the boss, and combines linear motor and elastic parts to provide high-precision drive and compliance, reducing the risk of collision between the device and the tissue.
It realizes rapid switching and high-precision driving of linear drive instruments, avoids rigid collision between instruments and tissues, and improves the safety and accuracy of surgery.
Smart Images

Figure CN115284272B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of medical devices, and in particular relates to a drive system and a surgical robot having the drive system. Background Art
[0002] Minimally invasive surgery is increasingly favored by surgeons and researchers due to its advantages such as small trauma, light pain, and short recovery period. With the development of robotic technology, minimally invasive surgical robots have gradually entered the clinical application stage from the laboratory research stage. In an operation, there are many types and quantities of surgical instruments actually used, so an interface that facilitates the rapid switching of surgical instruments is particularly important for the surgical robot system. Taking the instrument switching interface of the da Vinci surgical robot system as an example, the switching interface of this system is implemented based on the method of rotating torque transmission. This type of instrument switching interface is mature and widely used, but in order to facilitate the switching of instruments, the relative size of the protrusions and grooves of the switching interface structure is left with a margin, which will introduce errors to the control of the instrument. The impact on small wire-driven instruments is more obvious because the error accounts for a large proportion of the theoretical required displacement of the driving line. The error can be reduced by calibration compensation, but it will increase the time cost and complicate the use of the robot system. Therefore, for the drive of surgical instruments, it is very critical to have a fast instrument switching function while avoiding errors introduced by the switching interface. Summary of the invention
[0003] The present invention is based on the inventor's discovery and understanding of the following facts and problems:
[0004] Most of the current continuous surgical instruments are wire-driven and rigid, that is, the mutual antagonism of the driving wires gives the instrument sufficient rigidity. Once the driving wires are locked, the entire instrument is rigid. In fact, in the process of moving surgical instruments during surgery, collisions between the instrument and surrounding tissues are inevitable. If the instrument is rigid, it will cause relatively large trauma to the tissue. However, most surgical instrument drive devices cannot give the instrument flexibility.
[0005] The present invention aims to solve one of the technical problems in the related art at least to a certain extent. To this end, an embodiment of the present invention provides a drive system and a control method thereof and a surgical robot having the drive system.
[0006] According to an embodiment of the present invention, the driving system includes: a plurality of linear driving devices, each of the linear driving devices having a driving shaft, each of the driving shafts being provided with one of a first connecting member and a second connecting member; a plurality of transmission shafts, each of the transmission shafts being provided with the other of the first connecting member and the second connecting member, wherein the plurality of second connecting members can be one-to-one and detachably engaged in the plurality of first connecting members; and a plurality of control lines, the plurality of control lines being one-to-one connected to the plurality of transmission shafts, each of the control lines being suitable for being connected to a wire drive instrument.
[0007] According to the driving system of an embodiment of the present invention, a linear motor is used instead of a rotary motor, and linear power transmission is used instead of rotational power transmission. This allows for rapid switching of surgical instruments and enables high-precision driving. At the same time, the driving system can make rigid instruments compliant, thereby avoiding rigid collisions between instruments and tissues during surgery.
[0008] Optionally, the first connecting member is a slot, and the second connecting member is a boss, wherein a plurality of the bosses can be detachably engaged in the plurality of slots one by one, and each of the bosses extends from a corresponding one of the drive shaft and the transmission shaft in a direction opposite to the opening direction of the matching slot.
[0009] Optionally, each of the slots has an opening that opens toward a first direction, and each of the bosses extends from a corresponding one of the drive shaft and the transmission shaft toward a second direction, and the first direction and the second direction are opposite.
[0010] Optionally, each of the driving shafts includes a shaft body and a connecting block arranged on the shaft body, the circumferential surface of the connecting block is provided with a receiving groove, the bottom wall surface of the receiving groove is provided with the clamping groove, the clamping groove is wedge-shaped, and the end surface of the connecting block is provided with an over-groove, wherein the boss includes a wedge-shaped portion, the boss passes through the over-groove of the corresponding connecting block and is accommodated in its receiving groove, and the wedge-shaped portion fits in the corresponding clamping groove.
[0011] Optionally, the drive system further includes: a base, on which the plurality of linear drive devices are arranged, optionally, the linear drive devices are linear motors; and a mounting frame, on which the plurality of transmission shafts are arranged, and the mounting frame is detachably mounted on the base by a snap.
[0012] Optionally, a buckling direction of the buckle is opposite to an opening direction of each of the slots.
[0013] Optionally, the driving system further comprises: a base, the base is arranged on the base and the base can move on the base along the axial direction of the driving shaft.
[0014] Optionally, the drive system further includes: a mounting frame, a plurality of transmission shafts are arranged on the mounting frame, a plurality of elastic members, each of the elastic members is arranged on the mounting frame, each of the elastic members is in a deformed state, wherein each of the control lines includes a drive line and a transmission line, one end of the plurality of drive lines is connected to the plurality of transmission shafts one by one, and the other end of each drive line is suitable for being connected to a wire-driven device, one end of the plurality of transmission lines is connected to the plurality of elastic members one by one, and the other end of each transmission line is suitable for being connected to a wire-driven device.
[0015] Optionally, the mounting frame includes a first plate and a second plate arranged at intervals along the axial direction of the transmission shaft, a plurality of the transmission shafts are arranged on the first plate, and the second plate is used to install a wire-driven device, wherein a plurality of the elastic members are arranged on the first plate, and each of the elastic members is in a stretched state so as to apply a pulling force to the transmission line along the axial direction of the transmission shaft toward the first plate.
[0016] Optionally, the driving system further includes a plurality of support members, each of which is disposed on the first plate, wherein each of the support members extends along the axial direction of the transmission shaft, and the plurality of elastic members are sleeved on the plurality of support members in a one-to-one correspondence.
[0017] Optionally, each of the control lines includes a drive line and a transmission line, one end of the multiple drive lines is connected to the multiple transmission shafts one by one, and the other end of each drive line is suitable for being connected to a wire-driven device; further including multiple marking blocks and a camera for capturing the position of each marking block, and the multiple marking blocks are arranged on the drive lines one by one.
[0018] Optionally, the drive system further includes: a mounting frame, the mounting frame includes a first plate and a second plate arranged at intervals along the axial direction of the transmission shaft, a plurality of the transmission shafts are arranged on the first plate, one end of each of the transmission lines is connected to the first plate, and the other end of each of the transmission lines is suitable for being connected to a wire drive device, the second plate includes a mounting portion for mounting the wire drive device; and a plurality of first wire wheels and a plurality of second wire wheels, a plurality of the first wire wheels and a plurality of the second wire wheels are alternately arranged on the second plate around the mounting portion, a plurality of the drive lines pass around the plurality of the first wire wheels one by one, and a plurality of the transmission lines pass around the plurality of the second wire wheels one by one, wherein each of the marking blocks is located between the one end of the corresponding drive line and the corresponding first wire wheel.
[0019] Optionally, a tool channel is provided in the middle of the first plate, and the position of the tool channel corresponds to the position of the mounting portion on the second plate.
[0020] A control method for a drive system, for the error of a linear drive device itself, a closed-loop control is realized by a controller PID control algorithm; the machining error of a first connecting member and a second connecting member in a switching interface between a drive shaft and a transmission shaft, the error of the connection point where the movement of the transmission shaft is transmitted to a drive line, and the error of the elongation of the drive line due to tension are captured by a camera as closed-loop feedback; the displacement of the drive line is transmitted to a joint with a wire-driven instrument to cause a change in the posture of the wire-driven instrument, and the error occurring in this process is used as a closed-loop feedback signal of the entire wire-driven instrument drive system by acquiring the posture information of the instrument by adopting a posture sensor, a visual sensor or a magnetic sensor.
[0021] According to the control method of the drive system of an embodiment of the present invention, all links that may introduce errors in the entire power transmission process from the linear drive device to the final wire-driven instrument joint have undergone structural transmission improvements and closed-loop feedback in control, thereby achieving precise driving and control of the wire-driven instrument.
[0022] A surgical robot comprises: a drive system, which is a drive system according to an embodiment of the present invention; and a wire-driven instrument, wherein each control line of the drive system is connected to the wire-driven instrument.
[0023] According to the surgical robot of the embodiment of the present invention, the drive system can be used to quickly switch wire-driven instruments and achieve high-precision drive. At the same time, the drive system can make rigid instruments compliant to avoid rigid collision between instruments and tissues during surgery. BRIEF DESCRIPTION OF THE DRAWINGS
[0024] Figure 1 Schematic diagram of the structure of a driving system according to an embodiment of the present invention.
[0025] Figure 2 Schematic diagram of the structure of a transmission device according to an embodiment of the present invention.
[0026] Figure 3 This is the working principle of a set of driving lines according to an embodiment of the present invention.
[0027] Figure 4 3 is a comparison diagram of the drive shaft before and after pulling according to an embodiment of the present invention.
[0028] Figure 5 Schematic diagram of the structure of a base and a pedestal according to an embodiment of the present invention.
[0029] Figure 6 It is a structural schematic diagram of the movement of the base relative to the base according to an embodiment of the present invention.
[0030] Figure 7Schematic diagram of the structure of a linear drive device according to an embodiment of the present invention.
[0031] Figure 8 This is the precise control principle of the drive system according to the embodiment of the present invention.
[0032] Reference numerals:
[0033] Drive system 600;
[0034] Linear drive device 1; drive shaft 11; connecting block 12; receiving groove 120; clamping groove 121; through groove 122; drive bottom plate 13; drive vertical plate 14; drive horizontal plate 15;
[0035] Mounting frame 2; first plate 21; second plate 22;
[0036] Transmission shaft 3; boss 31; wedge-shaped portion 311; linear bearing 32; fixing groove 33; wire hole 34;
[0037] Driving line 4; marking block 41; camera 42; fixing block 43;
[0038] Line drive device 5; transmission line 6;
[0039] Elastic member 7; Support member 71;
[0040] First wire wheel 801; second wire wheel 802; wire shaft 81; bearing 82; column 83; horizontal column 84;
[0041] Sleeve 9; fixing plate 91;
[0042] Base 10; buckle 101; slider 102;
[0043] Base 20 ; guide rail 201 ; linear motor 202 ; push rod 203 ; crossbeam 204 ; support plate 205 . DETAILED DESCRIPTION
[0044] Embodiments of the present invention are described in detail below, and examples of the embodiments are shown in the accompanying drawings. The embodiments described below with reference to the accompanying drawings are exemplary and intended to be used to explain the present invention, but should not be understood as limiting the present invention.
[0045] like Figure 1-Figure 8 As shown, the driving system 600 according to the embodiment of the present invention includes a plurality of linear driving devices 1, a plurality of transmission shafts 3 and a plurality of control lines.
[0046] Each linear drive device 1 has a drive shaft 11, and each drive shaft 11 is provided with one of a first connecting member and a second connecting member; each transmission shaft 3 is provided with the other of the first connecting member and the second connecting member. In other words, the first connecting member can be provided on the drive shaft 11 or the transmission shaft 3, and the second connecting member can be provided on the transmission shaft 3 or the drive shaft 11. When the first connecting member is provided on the drive shaft 11, the second connecting member is provided on the transmission shaft 3, and when the first connecting member is provided on the transmission shaft 3, the second connecting member is provided on the drive shaft 11. Among them, a plurality of second connecting members can be matched in a plurality of first connecting members in a one-to-one and detachable manner. That is, the second connecting member can be matched in the corresponding first connecting member, and can also be detached from the first connecting member.
[0047] Multiple control lines are connected to multiple transmission shafts 3 one by one, and each control line is suitable for connecting to the wire drive device 5. That is, one end of each control line is connected to the transmission shaft 3, and the other end is connected to the wire drive device 5, thereby connecting the transmission shaft 3 to the wire drive device 5.
[0048] Reference below Figure 1-8 The operation process of the driving system 600 according to the embodiment of the present invention is briefly described.
[0049] The driving shafts 11 of the multiple linear drive devices 1 and the multiple transmission shafts 3 are connected through the first connecting member and the second connecting member. The movement of the driving shaft 11 in the axial direction drives the transmission shaft 3 to move through the first connecting member and the second connecting member. The movement of the transmission shaft 3 drives the wire drive device 5 to move through the control line.
[0050] When the wire drive device 5 needs to be replaced, the second connecting member is removed from the first connecting member, so that the transmission shaft 3 and the drive shaft 11 can be separated, the current wire drive device 5 is removed, and then the second connecting member or the first connecting member on the transmission shaft 3 connected to the replaced wire drive device 5 is matched with the first connecting member or the second connecting member of the drive shaft 11.
[0051] According to the driving system of the embodiment of the present invention, linear power transmission is used instead of rotational power transmission, that is, the design of the first connecting member and the second connecting member enables the transmission shaft and the driving shaft to cooperate better, and the second connecting member can be detached from the first connecting member more quickly and conveniently, and the second connecting member can also be quickly inserted into the first connecting member, thereby realizing rapid switching of the second connecting member and the first connecting member, so that the transmission shaft and the driving shaft can be switched more quickly, and finally realizing the rapid switching function of the wire-driven instrument, and also realizing high-precision driving.
[0052] like Figure 1-Figure 8 As shown, the driving system 600 according to the embodiment of the present invention comprises a plurality of linear driving devices 1, a plurality of transmission shafts 3 and a plurality of control lines. The first connecting member is a slot 121 and the second connecting member is a boss 31.
[0053] Each drive shaft 11 is provided with one of a slot 121 and a boss 31; each transmission shaft 3 is provided with the other of a slot 121 and a boss 31. In other words, the slot 121 can be provided on the drive shaft 11 or the transmission shaft 3, and the boss 31 can be provided on the transmission shaft 3 or the drive shaft 11. When the slot 121 is provided on the drive shaft 11, the boss 31 is provided on the transmission shaft 3, and when the slot 121 is provided on the transmission shaft 3, the boss 31 is provided on the drive shaft 11. The plurality of bosses 31 can be matched in a plurality of slots 121 in a one-to-one and detachable manner. That is, the boss 31 can be inserted into the corresponding slot 121, and can also be detached from the slot 121.
[0054] Each boss 31 extends from a corresponding one of the drive shaft 11 and the transmission shaft 3 in a direction opposite to the opening direction of the matching slot 121. That is, for the matching boss 31 and the slot 121, the opening direction of the slot 121 is a first direction, and each boss 31 extends from a corresponding one of the drive shaft 11 and the transmission shaft 3 in a second direction, the first direction being opposite to the second direction, so that the boss 31 can be quickly inserted into the slot.
[0055] The driving shafts 11 of the multiple linear drive devices 1 and the multiple transmission shafts 3 are connected through the bosses 31 and the slots 121. The movement of the driving shafts 11 in the axial direction drives the transmission shafts 3 to move through the bosses 31 and the slots 121. The movement of the transmission shafts 3 drives the wire drive device 5 to move through the control line.
[0056] When the wire drive device 5 needs to be replaced, the boss 31 is moved toward the opening direction of the slot 121 and the boss 31 is taken out from the slot 121, so that the transmission shaft 3 and the drive shaft 11 can be separated, and the current wire drive device 5 is removed, and then the boss 31 or the slot 121 on the transmission shaft 3 connected to the replaced wire drive device 5 is matched with the slot 121 or the boss 31 of the drive shaft 11.
[0057] According to the driving system of the embodiment of the present invention, the structural design of the slot and the boss is utilized to enable the transmission shaft and the driving shaft to better cooperate with each other, and the opening direction of the slot is opposite to the extension direction of the boss, so that the boss can be detached from the slot more quickly and conveniently, and the boss can also be quickly inserted into the slot, thereby realizing the rapid switching of the boss and the slot, so that the transmission shaft and the driving shaft can be switched faster, and finally the rapid switching function of the wire drive instrument is realized, and high-precision driving can also be realized.
[0058] like Figure 1-Figure 8 As shown, the linear drive device 1 of the drive system 600 according to the embodiment of the present invention is a linear motor.
[0059] Each driving shaft 11 includes a shaft body and a connecting block 12 disposed on the shaft body. The circumferential surface of the connecting block 12 is provided with a receiving groove 120, and the bottom wall surface of the receiving groove 120 is provided with a clamping groove 121. The end surface of the connecting block 12 is provided with a through groove 122 that is connected to the receiving groove 120. The arrangement of the through groove 122 allows the transmission shaft 3 and the boss 31 to pass through the corresponding through groove 122 of the connecting block 12 and the boss 31 to be accommodated in the receiving groove 120. The boss 31 includes a wedge-shaped portion 311, and the clamping groove 121 is wedge-shaped. The wedge-shaped portion 311 fits in the corresponding clamping groove 121. The wedge-shaped portion 311 of the boss 31 can fit more closely with the wedge-shaped clamping groove 121, and can transmit axial motion without gap, thereby further realizing high-precision driving.
[0060] Each slot 121 has an opening that opens toward a first direction, and each boss 31 extends from a corresponding one of the drive shaft 11 and the transmission shaft 3 toward a second direction, and the first direction and the second direction are opposite. The opening of each slot 121 faces the same direction, so that multiple bosses 31 can be inserted into the corresponding multiple slots 121 in the same direction, and multiple bosses 31 can also be taken out from the corresponding slots 121 from the same direction, so that the switching work of the wire drive device 5 can be carried out more conveniently and quickly. The extension direction of the boss 31 is opposite to the opening direction of the slot 121, so that the boss 31 can be more conveniently matched with the slot 121 and it is also easier to install the boss 31 and the connecting block 12. Since the opening directions of the multiple slots are the same, the extension directions of the multiple bosses are also consistent, so that the boss and the connecting block can be quickly installed, and then the mounting frame can be quickly installed, and finally the fast switching function of the wire drive device can be realized.
[0061] The connection block 12 is mounted on the end surface of the driving shaft 11 by means of screws, and the boss 31 is mounted on the end surface of one of the transmission shaft 3 and the driving shaft 11 by means of screws.
[0062] Optionally, the opening direction of the receiving groove 120 is the same as the opening direction of the clamping groove 121 provided on the bottom wall thereof, thereby making the structure of the driving system more reasonable. Optionally, the opening direction of the receiving groove 120 and the opening of the clamping groove 121 are both upward, and the extension direction of the boss 31 is downward, so that the boss 31 can be connected to the clamping groove 121 more conveniently and quickly, and the boss 31 and the connecting block 12 can be installed more conveniently.
[0063] The drive system 600 further includes a mounting frame 2, which includes a first plate 21 and a second plate 22 arranged at intervals along the axial direction of the transmission shaft 3. A plurality of transmission shafts 3 are arranged on the first plate 21, and the second plate 22 is used to mount the wire drive device 5. A linear bearing 32 is arranged on the first plate 21, and the transmission shaft 3 passes through the linear bearing 32, so that the transmission shaft 3 can move in the linear bearing 32. When the drive shaft 11 drives the transmission shaft 3 to move through the boss 31 and the slot 121, the transmission shaft 3 can move relative to the first plate 21 in the linear bearing 32.
[0064] The driving system 600 further includes a plurality of elastic members 7 and a plurality of supporting members 71, each of which is arranged on the first plate 21, wherein each supporting member 71 extends along the axial direction of the transmission shaft 3, and the plurality of elastic members 7 are sleeved on the plurality of supporting members 71 in a one-to-one correspondence. The supporting members 71 are connected to the first plate 21 by threads, the inner diameter of the elastic member 7 is larger than the outer diameter of the supporting member 71, and the supporting member 71 is located inside the elastic member 7, and the setting of the supporting member 71 is used to prevent the elastic member 7 from deforming in the vertical direction due to its own weight, thereby affecting the transmission.
[0065] Each control line includes a driving line 4 and a transmission line 6. One end of the plurality of driving lines 4 is connected to the plurality of transmission shafts 3 one by one, and the other end of each driving line 4 is suitable for being connected to the wire drive device 5, that is, the transmission shaft 3 can be connected to the wire drive device 5 through the driving line 4. One end of the plurality of transmission lines 6 is connected to the plurality of elastic members 7 one by one, and the other end of each transmission line 6 is suitable for being connected to the wire drive device 5, that is, the elastic member 7 can be connected to the wire drive device 5 through the transmission line 6. Each of the elastic members 7 is in a stretched state so as to apply a pulling force to the transmission line 6 along the axial direction of the transmission shaft 3 toward the first plate 21. Each of the other ends of each driving line 4 and each of the other ends of each transmission line 6 is connected to the wire drive device 5, and the rotation of the joint of the wire drive device 5 can be achieved through the mutual resistance of the driving line 4 and the transmission line 6 on the wire drive device 5.
[0066] like Figure 4 As shown, the driving wire 4 and the transmission wire 6 are generally steel wire ropes. When the driving shaft 11 of the linear drive device 1 is pulled along its axial direction toward a direction away from the wire drive device 5, the transmission shaft 3 connected to the driving shaft 11 through the slot 121 and the boss 31 moves accordingly, and drives the driving wire 4 fixed on the transmission shaft 3 to move in a direction away from the wire drive device 5, and the other end of the driving wire 4 is fixed at the joint of the wire drive device 5, driving the joint of the wire drive device 5 to rotate and produce an action, and at the same time, the transmission wire 6 on the joint moves toward a direction close to the wire drive device 5, so that the elastic member 7 connected to the other end of the transmission wire 6 is stretched.
[0067] When the driving shaft 11 of the linear drive device 1 moves along its axial direction toward the direction close to the wire drive device 5, the transmission shaft 3 connected to the driving shaft 11 through the slot 121 and the boss 31 moves accordingly, and drives the driving wire 4 to move toward the direction close to the wire drive device 5, so that the other end of the driving wire 4 drives the joint of the wire drive device 5 to rotate and produce an action, and at the same time, the transmission wire 6 on the joint moves in the direction away from the wire drive device 5, so that the elastic member 7 connected to the other end of the transmission wire 6 is compressed.
[0068] The setting of the elastic member makes the elastic member connected to the transmission shaft be stretched or compressed when the drive shaft moves, so that the drive system has a certain buffering effect, and finally the wire drive instrument has a certain compliance. When the drive system is used in a surgical environment, the compliance of the wire drive instrument will avoid the tissue in the surgical space, avoid damage to the tissue when it collides with it rigidly, and make the surgical process safer. Each of the elastic members 7 is in a deformed state, and the elastic member 7 can be a spring. The spring plays the role of pre-tightening the drive line and can restore the joint of the wire drive instrument to its initial state. By adjusting the parameters of the spring, that is, the spring coefficient, the wire drive instrument can obtain different load capacities and its own stiffness.
[0069] Optionally, a fixing block 43 is provided at one end of the driving wire 4, and the fixing block 43 may be cylindrical or semi-cylindrical. A fixing groove 33 is provided on the outer peripheral surface of the transmission shaft 3 connected to one end of the driving wire 4, and the width of the fixing groove 33 is not less than the width of the fixing block 43. The fixing block 43 can be inserted into the fixing groove 33. A wire hole 34 is also provided on the end surface of the transmission shaft 3. The driving wire 4 passes through the wire hole 34 and is connected to the fixing block 43, thereby connecting the driving wire 4 to the transmission shaft 3.
[0070] The second plate 22 of the mounting frame 2 includes a mounting portion for mounting the wire drive device 5. Optionally, the mounting portion is a sleeve 9, which is fixedly connected to the second plate 22 through a fixing plate 91 and passes through the second plate 22, and one end of the sleeve 9 is a polished end, which is a smooth and polished opening, and when the drive line 4 and the transmission line 6 pass through the polished end of the sleeve 9, the friction of the polished end on the drive line 4 and the transmission line 6 can be reduced.
[0071] A tool channel is provided in the middle of the first plate 21. The tool channel is a circular through hole. The position of the tool channel corresponds to the position of the sleeve 9 on the second plate 22, and is used when the wire drive instrument 5 is used as a catheter.
[0072] The driving system 600 further includes a plurality of first wire wheels 801 and a plurality of second wire wheels 802, which are alternately arranged on the second plate 22 around the sleeve 9, and a plurality of driving wires 4 are passed around the plurality of first wire wheels 801 in a one-to-one correspondence, and a plurality of transmission wires 6 are passed around the plurality of second wire wheels 802 in a one-to-one correspondence. One end of the driving wire 4 is connected to the transmission shaft 3, and the other end is connected to the wire drive device 5 after passing around the first wire wheel 801, and one end of the transmission wire 6 is connected to the elastic member 7, and the other end is connected to the wire drive device 5 after passing around the second wire wheel 802. The plurality of elastic members 7 and the plurality of transmission shafts 3 are also alternately arranged on the first plate 21 in a ring shape. The transmission shaft 3 corresponds to the first wire wheel 801, and the elastic member 7 corresponds to the second wire wheel 802. In this way, the driving line 4 between the transmission shaft 3 and the first wire wheel 801 and the transmission line 6 between the elastic member 7 and the second wire wheel 802 can remain parallel to each other and consistent with the axial direction of the transmission shaft 3, thereby better transmitting the movement of the driving shaft 11.
[0073] The structures of the first reel 801 and the second reel 8 are the same, both of which include a spool 81, a bearing 82, a column 83 and a cross column 84. The two ends of the spool 81 are arranged on the two columns 83 through the bearings 82. The use of the bearings 82 makes it possible for the first reel 801 and the second reel 802 to have no friction when winding. A cross column 84 is also arranged between the two columns 83, and a threaded hole is arranged in the middle of the cross column 84 for mounting the first reel 801 and the second reel 802 on the second plate 22. The second plate 22 is provided with a reel mounting hole for mounting the first reel 801 and the second reel 802, and the threaded hole corresponds to the reel mounting hole. Bolts pass through the threaded hole and the reel mounting hole to mount the first reel and the second reel on the second plate. In order to ensure that the driving line 4 between the first spool 801 and the transmission shaft 3 and the transmission line 6 between the second spool 802 and the elastic member 7 are parallel, the position of the spool mounting hole has a deviation relative to the center position of the support member 71, and the position of the spool mounting hole also has the same deviation relative to the center position of the transmission shaft 3. This deviation is equal to the radius of the winding point of the spool 81.
[0074] The polishing end of the sleeve 9 is located on the same side of the second plate 22 as the first wire wheel 801 and the second wire wheel 802. The length of the polishing end of the sleeve 9 extending out of the second plate 22 is less than or equal to the length from the second plate 22 to the winding position of the wire shaft 81 of the first wire wheel 801 and the second wire wheel 802, so that the contact area between the driving wire 4 and the transmission wire 6 and the polishing end of the sleeve 9 can be reduced, thereby reducing friction.
[0075] The driving system 600 further includes a plurality of marking blocks 41 and a camera 42 for capturing the position of each of the marking blocks 41. The plurality of marking blocks 41 are arranged on the driving line 4 in a one-to-one correspondence, and each marking block 41 is located between the end of the corresponding driving line 4 (i.e., the fixed block 43) and the first wire wheel 801. The arrangement of the marking block 41 can facilitate the camera 42 to capture and measure the moving distance of the driving line 4. The driving line 4 is directly connected to the wire drive device 5, so the position of the marking block 41 captured by the camera 42 is used as the negative feedback signal of the wire drive device 5, which can further ensure the high-precision control of the entire wire drive device 5.
[0076] The drive system 600 further includes: a base 10, a plurality of linear drive devices 1 are arranged on the base 10; a plurality of transmission shafts 3 are arranged on the mounting frame 2, and the mounting frame 2 is detachably arranged on the base 10 through a buckle 101. The buckling direction of the buckle 101 is opposite to the opening direction of each slot 121, so that the mounting frame 2 can be more stably matched with the base 10 and facilitate the rapid switching of the mounting frame. Optionally, the opening direction of each slot 121 is upward, and the buckling direction of the buckle 101 is downward, so that the mounting frame 2 can be connected to the buckle 101 more quickly, and the mounting frame 2 can also be quickly removed from the buckle 101. In addition, in order to achieve rapid switching of the line drive device 5, the mounting frame 2 can be fixed only by using the buckle 101 on the base 10.
[0077] Multiple linear drive devices 1, that is, multiple linear motors are arranged on a supporting frame, and the supporting frame includes a driving base plate 13, two driving vertical plates 14 and a driving cross plate 15. The driving base plate 13 is fixedly mounted on the base 10, and the two driving vertical plates 14 are installed on the driving base plate 13. The two driving vertical plates 14 are arranged parallel to each other, and the two driving vertical plates 14 are arranged on the same side of the driving base plate 13 and the two driving vertical plates 14 are perpendicular to the driving base plate 13. The driving cross plate 15 is located in the middle of the two driving vertical plates 14 to connect the two driving vertical plates 14, so as to enhance the stability of the entire supporting frame.
[0078] Multiple linear motors are symmetrically and evenly installed on both sides of the two driving vertical plates, the driving axis of each linear motor is parallel to each of the driving base plate and the driving vertical plates, the multiple driving axes of the multiple linear motors are arranged in parallel with each other, and the spacing between two adjacent linear motors is the same, that is, the spacing between two adjacent linear motors on each driving vertical plate and the spacing between two symmetrical linear motors between the two driving vertical plates are the same. The uniform layout of the above-mentioned multiple linear motors is mainly based on the spacing required by the linear motors themselves to avoid magnetic interference and the uniform layout of the driving lines.
[0079] The driving system 600 further includes: a base 20, on which the base 10 is arranged and can move on the base 20 along the axial direction of the driving shaft 11. The base 20 includes two support plates 205, two beams 204, two guide rails 201 and a linear motor 202. In order to provide sufficient support, the two ends of each beam 204 are mounted on two support plates 205, that is, the two support plates are symmetrically arranged at the two ends of the beam, and the two beams are arranged side by side. A guide rail is installed on each beam, and two sliders 102 are arranged on each guide rail 201. A linear motor 202 is arranged in the middle of the two beams 204, and the driving shaft of the linear motor 202, that is, the two ends of the push rod 203 are fixedly mounted on the two support plates 205. The tops of the linear motor 202 and the slider 102 are fixedly connected to the bottom of the base 10. When the base 10 needs to move relative to the base 20, the linear motor 202 is started, the push rod 203 of the linear motor 202 remains stationary, and the linear motor 202 moves. The movement of the linear motor 202 drives the slider 102 and the base 10 to move relative to the guide rail 201, thereby causing the base 10 to move relative to the base 20, thereby providing the wire drive device 5 with freedom in the axial direction of the linear motor 202.
[0080] The present invention also provides a surgical robot. The surgical robot according to an embodiment of the present invention includes a drive system 600 and a wire-driven instrument 5. The drive system 600 is the drive system 600 according to the above-mentioned embodiment of the present invention. Each control line of the drive system is connected to the wire-driven instrument.
[0081] According to the surgical robot of the embodiment of the present invention, the drive system can be used to quickly switch wire-driven instruments and achieve high-precision drive. At the same time, the drive system can make rigid instruments compliant to avoid rigid collision between instruments and tissues during surgery.
[0082] like Figure 8 As shown, the precise control principle of the drive system 600 is that all links that may introduce errors in the entire power transmission process from the driving shaft of the linear motor to the final wire-driven instrument have undergone structural transmission improvements and closed-loop feedback in control, thereby achieving precise driving and control of the wire-driven instrument.
[0083] Structural improvements: linear motors are used as power sources, linear drives replace rotary motor drives, and linear power transmission replaces rotary power transmission; linear motion can achieve rapid switching of wire-driven instruments through the special structure of the wedge-shaped slot and the wedge-shaped portion of the boss, avoiding errors introduced by the design of the switching interface, which is difficult to achieve using the switching interface of a rotary motor drive device.
[0084] Closed-loop feedback on control: There is no error in the design of this application, but considering the existence of uncontrollable factors such as processing, there will still be errors in the final position and posture of the line drive device. Figure 8 As shown, there are 4 possible errors. The first is the error of the motor itself, that is, the transmission error 1. Error 1 can be reduced by closed-loop control through the PID control algorithm of the motor controller; transmission error 2 is the switching interface between the linear drive device and the wire drive instrument, which is introduced from the linear motor drive shaft to the transmission shaft. The main consideration is the processing error of the slot and the boss; transmission error 3 is the movement of the transmission shaft transmitted to the connection on the drive line, and on the other hand, the drive line is stretched by the tension; transmission error 2 and transmission error 3 can be reduced by capturing the displacement of the marker block on the drive line through the camera of this application as a closed-loop feedback of the system control. Finally, the displacement of the drive line is transmitted to the joint of the wire drive instrument, causing the change of the posture of the wire drive instrument. This process will also cause transmission error 4, which is mainly caused by the connection between the drive line and the joint and the gap between the theoretical model and the actual model of the wire drive instrument. This part of the error is not within the scope of consideration of this design, but a posture sensor such as a grating sensor, a visual sensor or a magnetic sensor can be used to obtain the posture information of the instrument as a closed-loop feedback signal of the entire wire drive instrument control system, thereby achieving high-precision instrument control to the greatest extent.
[0085] In the description of the present invention, it is to be understood that the terms “center”, “longitudinal”, “lateral”, “length”, “width”, “thickness”, “up”, “down”, “front”, “back”, “left”, “right”, “vertical”, “horizontal”, “top”, “bottom”, “inside”, “outside”, “clockwise”, “counterclockwise”, “axial”, “radial”, “circumferential”, etc., indicating orientations or positional relationships based on the orientations or positional relationships shown in the accompanying drawings, are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the referred device or element must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as limiting the present invention.
[0086] In addition, the terms "first" and "second" are used for descriptive purposes only and should not be understood as indicating or implying relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include at least one of the features. In the description of the present invention, the meaning of "plurality" is at least two, such as two, three, etc., unless otherwise clearly and specifically defined.
[0087] In the present invention, unless otherwise clearly specified and limited, the terms "installed", "connected", "connected", "fixed" and the like should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral one; it can be a mechanical connection, an electrical connection, or communication with each other; it can be a direct connection, or an indirect connection through an intermediate medium, it can be the internal connection of two elements or the interaction relationship between two elements, unless otherwise clearly defined. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0088] In the present invention, unless otherwise clearly specified and limited, a first feature being "above" or "below" a second feature may mean that the first and second features are in direct contact, or the first and second features are in indirect contact through an intermediate medium. Moreover, a first feature being "above", "above" or "above" a second feature may mean that the first feature is directly above or obliquely above the second feature, or simply means that the first feature is higher in level than the second feature. A first feature being "below", "below" or "below" a second feature may mean that the first feature is directly below or obliquely below the second feature, or simply means that the first feature is lower in level than the second feature.
[0089] In the present invention, the terms "one embodiment", "some embodiments", "examples", "specific examples", or "some examples" etc. mean that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In this specification, the schematic representations of the above terms do not necessarily refer to the same embodiment or example. Moreover, the described specific features, structures, materials or characteristics may be combined in any one or more embodiments or examples in a suitable manner. In addition, those skilled in the art may combine and combine the different embodiments or examples described in this specification and the features of the different embodiments or examples, without contradiction.
[0090] Although the above embodiments have been shown and described, it is to be understood that the above embodiments are exemplary and are not to be construed as limitations on the present invention. Changes, modifications, substitutions and variations of the above embodiments by those of ordinary skill in the art are all within the scope of protection of the present invention.
Claims
1. A drive system, characterized in that: include: A plurality of linear drive devices, each of the linear drive devices having a drive shaft, each of the drive shafts being provided with one of a first connecting member and a second connecting member; A plurality of transmission shafts, each of the transmission shafts being provided with the other of the first connecting member and the second connecting member, wherein the plurality of the second connecting members can be detachably engaged in the plurality of the first connecting members in a one-to-one correspondence; and A plurality of control lines, the plurality of control lines are connected to the plurality of transmission shafts one by one, and each of the control lines is suitable for being connected to a wire drive device; The first connecting member is a slot, and the second connecting member is a boss, wherein a plurality of the bosses can be detachably engaged in the plurality of slots in a one-to-one correspondence, and each of the bosses extends from a corresponding one of the drive shaft and the transmission shaft in a direction opposite to an opening direction of the matched slot; Each of the driving shafts comprises a shaft body and a connecting block arranged on the shaft body, the peripheral surface of the connecting block is provided with a receiving groove, the bottom wall surface of the receiving groove is provided with the clamping groove, the clamping groove is wedge-shaped, the end surface of the connecting block is provided with a through groove communicating with the receiving groove, wherein the boss comprises a wedge-shaped portion, the boss passes through the through groove of the corresponding connecting block and is accommodated in the receiving groove thereof, and the wedge-shaped portion is fitted in the corresponding clamping groove; Further including: A mounting frame, wherein the plurality of transmission shafts are arranged on the mounting frame; and Multiple elastic members, each of which is arranged on the mounting frame, and each of the elastic members is in a deformed state, wherein each of the control lines includes a driving line and a transmission line, one end of the multiple driving lines is connected to the multiple transmission shafts one by one, and the other end of each driving line is suitable for connecting to a wire-driven device, one end of the multiple transmission lines is connected to the multiple elastic members one by one, and the other end of each transmission line is suitable for connecting to a wire-driven device.
2. The drive system according to claim 1, characterized in that: Each of the slots has an opening that opens toward a first direction, and each of the bosses extends from a corresponding one of the drive shaft and the transmission shaft toward a second direction, and the first direction and the second direction are opposite.
3. The drive system according to claim 2, characterized in that: Further including: A base, on which the plurality of linear drive devices are arranged; and A mounting frame, a plurality of transmission shafts are arranged on the mounting frame, and the mounting frame is detachably arranged on the base through buckles.
4. The drive system according to claim 3, characterized in that: The linear drive device is a linear motor.
5. The drive system according to claim 3, characterized in that: The buckling direction of the buckle is opposite to the opening direction of each of the slots.
6. The drive system according to claim 5, characterized in that: Further including: A base is provided on the base and can move on the base along the axial direction of the driving shaft.
7. The drive system according to claim 1, characterized in that: The mounting frame includes a first plate and a second plate arranged at intervals along the axial direction of the transmission shaft, a plurality of the transmission shafts are arranged on the first plate, and the second plate is used to install the wire drive device, wherein a plurality of the elastic members are arranged on the first plate, and each of the elastic members is in a stretched state so as to apply a pulling force to the transmission line along the axial direction of the transmission shaft toward the first plate.
8. The drive system according to claim 7, characterized in that: It further comprises a plurality of support members, each of which is arranged on the first plate, wherein each of the support members extends along the axial direction of the transmission shaft, and the plurality of elastic members are sleeved on the plurality of support members in a one-to-one correspondence.
9. The drive system according to claim 1 or 2, characterized in that: Each of the control lines includes a driving line and a transmission line, one end of the plurality of driving lines is connected to the plurality of transmission shafts one by one, and the other end of each driving line is suitable for connecting to a wire drive device; It further comprises a plurality of marking blocks and a camera for capturing the position of each of the marking blocks, wherein the plurality of marking blocks are arranged on the driving line in a one-to-one correspondence.
10. The drive system according to claim 9, characterized in that: Further including: A mounting frame, the mounting frame comprising a first plate and a second plate spaced apart along the axial direction of the transmission shaft, a plurality of the transmission shafts being arranged on the first plate, one end of each of the transmission lines being connected to the first plate, the other end of each of the transmission lines being suitable for being connected to a wire drive device, and the second plate comprising a mounting portion for mounting the wire drive device; as well as A plurality of first pulleys and a plurality of second pulleys are alternately arranged on the second plate around the mounting portion, a plurality of the driving lines are passed around the plurality of the first pulleys in a one-to-one correspondence, and a plurality of the transmission lines are passed around the plurality of the second pulleys in a one-to-one correspondence, wherein each of the marking blocks is located between one end of the corresponding driving line and the corresponding first pulley.
11. The drive system according to claim 10, characterized in that: A tool channel is provided in the middle of the first plate, and the position of the tool channel corresponds to the position of the mounting portion on the second plate.
12. A control method for a drive system according to any one of claims 9 to 11, characterized in that: In view of the error of the linear drive device itself, closed-loop control is achieved through the controller PID control algorithm; The machining errors of the first connecting member and the second connecting member in the switching interface between the drive shaft and the transmission shaft, the errors of the connection between the transmission shaft and the drive line, and the errors of the elongation of the drive line due to the tension, are captured by the camera as closed-loop feedback. The displacement of the driving wire is transmitted to the joint of the wire-driven instrument, causing the posture of the wire-driven instrument to change. The error in this process is obtained by using posture sensors, visual sensors or magnetic sensors to obtain the posture information of the instrument as a closed-loop feedback signal of the entire wire-driven instrument drive system.
13. A surgical robot, characterized in that: include: A drive system, wherein the drive system is a drive system according to any one of claims 1 to 10; as well as A wire-driven device, each control line of the driving system is connected to the wire-driven device.
