Master-slave control method and device of endoscopic surgery robot, console and storage medium
By compensating the attitude data of the console end handle of the laminoscopic surgical robot, the target main-end attitude command is generated, which solves the fatigue problem caused by the operator's wrist being at a limit angle for a long time, and improves the comfort and duration of the operation.
Patent Information
- Application Number
- CN202411571094.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-11-06
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-11-06
AI Technical Summary
In laparoscopic surgery robot operation, due to differences in surgical style, individual body shape and operating habits, the operator often needs to work frequently in the reverse joint position, which is at the extreme angle for a long time, resulting in fatigue.
By obtaining the posture data of the console end handle of the laminoscopic surgery robot relative to the root base, comfort compensation is performed, and the target main attitude command is generated so that the wrist does not have to move to the extreme angle, so that the posture of the surgical platform reaches the extreme direction. Achieve a comfortable wrist posture.
It effectively reduces the extreme angle movement of the operator's wrist, reduces fatigue, and improves the comfort and duration of operation.
Smart Images

Figure CN119074239A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot technology, and in particular to a master-slave control method, device, console and storage medium of a laparoscopic surgical robot. Background Art
[0002] In modern medical technology, the application of laparoscopic surgical robots has gradually become an important means to improve surgical accuracy and reduce surgical risks.
[0003] During the use of the laparoscopic surgical robot, the operator can hold the end handle of the console and change the direction of the end handle by adjusting the wrist angle, thereby achieving master-slave remote operation.
[0004] Currently in actual surgical applications, due to differences in surgical areas, individual body shapes, and operating habits, the operator's wrist frequently works in an anti-joint position, and the wrist is at an extreme angle for a long time, causing operator fatigue. Summary of the invention
[0005] The present invention provides a master-slave control method, device, console and storage medium of a laparoscopic surgical robot, so as to realize comfort compensation processing based on original posture data, so that the master-end operator's wrist does not need to move to an extreme angle, and the posture of the surgical platform of the slave end can reach the extreme orientation, so that the wrist can work in a comfortable posture.
[0006] According to one aspect of the present invention, a master-slave control method of a laparoscopic surgical robot is provided, comprising:
[0007] Acquire the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console;
[0008] Performing comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the base at the root of the console to obtain the target main end posture command of the laparoscopic surgical robot, wherein the comfort compensation processing refers to the posture data compensation operation that allows the posture of the surgical platform to reach the extreme orientation without the wrist of the handle operator having to move to the extreme angle, so that the wrist works in a comfortable posture;
[0009] The target master-end posture instruction is sent to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction.
[0010] According to another aspect of the present invention, a master-slave control device for a laparoscopic surgical robot is provided, comprising:
[0011] A handle-base posture data acquisition module is used to obtain the posture data of the handle at the end of the console of the laparoscopic surgical robot relative to the base at the root of the console;
[0012] A posture data compensation processing module is used to perform comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the base at the root of the console to obtain the target main end posture instruction of the laparoscopic surgical robot. The comfort compensation processing refers to the posture data compensation operation that allows the posture of the surgical platform to reach the extreme orientation without the wrist of the handle operator moving to the extreme angle, so that the wrist works in a comfortable posture;
[0013] The target master end posture instruction sending module is used to send the target master end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave end posture control operation based on the target master end posture instruction.
[0014] According to another aspect of the present invention, a console of a laparoscopic surgical robot is provided, and the console of the laparoscopic surgical robot comprises:
[0015] at least one processor;
[0016] and a memory communicatively coupled to the at least one processor;
[0017] Among them, the memory stores a computer program that can be executed by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the master-slave control method of the laparoscopic surgical robot described in any embodiment of the present invention.
[0018] According to another aspect of the present invention, a computer-readable storage medium is provided, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to implement the master-slave control method of the laparoscopic surgical robot described in any embodiment of the present invention when executed by a processor.
[0019] The technical solution of the embodiment of the present invention obtains the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console, and then performs comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console, obtains the target master-end posture instruction of the laparoscopic surgical robot, and then sends the target master-end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction. The above technical solution, by performing comfort compensation processing on the basis of the original posture data, allows the master-end operator's wrist to reach the extreme angle without moving it, and allows the wrist to work in a comfortable posture.
[0020] It should be understood that the contents described in this section are not intended to identify the key or important features of the embodiments of the present invention, nor are they intended to limit the scope of the present invention. Other features of the present invention will become easily understood through the following description. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0022] Figure 1 is a flow chart of a master-slave control method of a laparoscopic surgical robot provided according to Embodiment 1 of the present invention;
[0023] Figure 2 is a structural schematic diagram of a control console of a laparoscopic surgical robot provided according to an embodiment of the present invention;
[0024] Figure 3 is a flow chart of a master-slave control method of a laparoscopic surgical robot provided according to Embodiment 2 of the present invention;
[0025] Figure 4 is a flow chart of a master-slave control method of a laparoscopic surgical robot provided according to Embodiment 3 of the present invention;
[0026] Figure 5 is a schematic diagram of the structure of a master-slave control device for a laparoscopic surgical robot provided according to a fourth embodiment of the present invention;
[0027] Figure 6 It is a structural schematic diagram of a control console of a laparoscopic surgical robot that implements the master-slave control method of the laparoscopic surgical robot according to an embodiment of the present invention. DETAILED DESCRIPTION
[0028] In order to enable those skilled in the art to better understand the scheme of the present invention, the technical scheme in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present invention.
[0029] It should be noted that the terms "first", "second", etc. in the specification and claims of the present invention and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequence. It should be understood that the data used in this way can be interchangeable where appropriate, so that the embodiments of the present invention described herein can be implemented in an order other than those illustrated or described herein. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device that includes a series of steps or units is not necessarily limited to those steps or units that are clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices. The acquisition, storage, use, processing, etc. of data in the technical solution of this application comply with the relevant provisions of national laws and regulations.
[0030] Embodiment 1
[0031] Figure 1 This is a flowchart of a master-slave control method for a laparoscopic surgical robot provided in the first embodiment of the present invention. This embodiment is applicable to the master-slave control of a laparoscopic surgical robot. The method can be executed by a master-slave control device for a laparoscopic surgical robot. The master-slave control device for a laparoscopic surgical robot can be implemented in the form of hardware and / or software. The master-slave control device for a laparoscopic surgical robot can be configured in the console of the laparoscopic surgical robot. Figure 1 As shown, the method includes:
[0032] S110, obtaining the posture data of the end handle of the console of the laparoscopic surgery robot relative to the root base of the console.
[0033] In the embodiments of the present invention, the laparoscopic surgical robot refers to a medical device designed for performing various minimally invasive surgeries. The laparoscopic surgical robot includes a console and a surgical platform. The console is connected to the surgical platform in communication. The console serves as a master end for implementing master-slave teleoperation, and the surgical platform serves as a slave end for implementing master-slave teleoperation. The console refers to a platform on which a user performs surgical operations and controls. For example, Figure 2 1 is a schematic diagram of the structure of a console of a laparoscopic surgical robot provided according to an embodiment of the present invention. The console may include, but is not limited to, an end handle 1, a joint position sensor 2, a display device 3, and a root base (not shown in the figure), etc., which are not specifically limited here. The joint position sensor 2 may be arranged at the joint of the mechanical arm of the console. The surgical platform may include a manipulator and an operating table, etc., which are not specifically limited here.
[0034] The posture data refers to the orientation of the end handle, which may include pitch angle, yaw angle and rotation angle. Specifically, the posture data of the end handle of the console of the laparoscopic surgical robot relative to the base of the console can be obtained through the joint position sensor.
[0035] Exemplarily, a console end handle coordinate system and a console root base coordinate system are established; when performing master-slave remote operation control, the joint position sensor can be used to collect the posture data of the end handle relative to the console root base coordinate system in the console end handle coordinate system, that is, the posture data of the console end handle relative to the console root base.
[0036] S120, performing comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console to obtain a target main end posture instruction of the laparoscopic surgical robot.
[0037] In the embodiment of the present invention, the comfort compensation processing refers to the posture data compensation operation that allows the posture of the surgical platform of the slave end to reach the extreme orientation without the wrist of the operator of the master end handle moving to the extreme angle, so that the wrist works in a comfortable posture. The target master end posture instruction refers to the posture data after the comfort compensation processing, which can be used to control the surgical platform of the slave end, thereby realizing master-slave teleoperation.
[0038] For example, the posture data of the end handle of the console of the laparoscopic surgical robot relative to the base of the console can be used to perform comfort compensation processing through the pre-calibrated posture data. For example, when the wrist is tilted upward by more than 45 degrees, the pitch angle in the posture data can be compensated according to the pre-configured pitch compensation angle. The posture data of the end handle of the console of the laparoscopic surgical robot relative to the base of the console can also be input into a posture data compensation model pre-trained based on machine learning, and then the model outputs the posture data after comfort compensation processing.
[0039] S130. Send the target master-end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction.
[0040] Exemplarily, after receiving the target master-end posture command, the control system of the surgical platform can perform inverse kinematics solution on the target master-end posture command to obtain the kinematic commands of each joint of the slave arm of the surgical platform, so that the surgical platform can complete the slave-end posture control operation according to the kinematic commands of each joint, thereby realizing master-slave remote operation.
[0041] The technical solution of the embodiment of the present invention obtains the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console, and then performs comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console, obtains the target master-end posture instruction of the laparoscopic surgical robot, and then sends the target master-end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction. The above technical solution, by performing comfort compensation processing on the basis of the original posture data, allows the master-end operator's wrist to reach the extreme angle without moving it, and allows the wrist to work in a comfortable posture.
[0042] Embodiment 2
[0043] Figure 3 A flow chart of a master-slave control method for a laparoscopic surgical robot provided in the second embodiment of the present invention, the method of this embodiment can be combined with the various optional schemes in the master-slave control method for a laparoscopic surgical robot provided in the above embodiments. The master-slave control method for a laparoscopic surgical robot provided in this embodiment is further optimized. Optionally, the comfort compensation processing is performed on the posture data of the console end handle of the laparoscopic surgical robot relative to the root base of the console to obtain the target master end posture instruction of the laparoscopic surgical robot, including: performing posture compensation processing of the console end handle and / or posture compensation processing of the console root base on the posture data of the console end handle of the laparoscopic surgical robot relative to the root base of the console to obtain the target master end posture instruction of the laparoscopic surgical robot.
[0044] like Figure 3 As shown, the method includes:
[0045] S210, obtaining the posture data of the end handle of the console of the laparoscopic surgery robot relative to the root base of the console.
[0046] S220, performing posture compensation processing of the console end handle and / or the console root base on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base, and obtaining a target main end posture instruction of the laparoscopic surgical robot.
[0047] S230. Send the target master-end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction.
[0048] In the embodiment of the present invention, the posture compensation processing of the end handle of the control console refers to the posture compensation of the end handle. Similarly, the posture compensation processing of the root base of the control console refers to the posture compensation of the root base.
[0049] In some optional embodiments, performing posture compensation processing of the console end handle of the laparoscopic surgical robot relative to the console root base includes one or more of the following steps: obtaining the pitch compensation angle of the console end handle; based on the pitch compensation angle of the console end handle, performing pitch angle compensation processing of the console end handle on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; obtaining the yaw compensation angle of the console end handle; based on the yaw compensation angle of the console end handle, performing yaw angle compensation processing of the console end handle on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; obtaining the rotation compensation angle of the console end handle; based on the rotation compensation angle of the console end handle, performing swivel angle compensation processing of the console end handle on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base.
[0050] For example, the pitch compensation angle of the console end handle pre-calibrated by the user may be obtained, and then the pitch compensation matrix of the console end handle may be determined based on the pitch compensation angle of the console end handle. The calculation formula is as follows:
[0051] ;
[0052] Among them, A1 represents the pitch compensation angle of the handle at the end of the console, represents the pitch compensation matrix of the console end handle; similarly, the yaw compensation angle of the console end handle pre-calibrated by the user can be obtained, and then the yaw compensation matrix of the console end handle can be determined based on the yaw compensation angle of the console end handle. The calculation formula is as follows:
[0053] ;
[0054] Among them, A2 represents the deflection compensation angle of the handle at the end of the console, represents the yaw compensation matrix of the end handle of the console;
[0055] Similarly, the rotation compensation angle of the console end handle pre-calibrated by the user can be obtained, and then the rotation compensation matrix of the console end handle can be determined based on the rotation compensation angle of the console end handle. The calculation formula is as follows:
[0056] ;
[0057] Among them, A3 represents the rotation compensation angle of the handle at the end of the console. represents the rotation compensation matrix of the console end handle; further, the target master end attitude command calculation formula can be as follows:
[0058] ;
[0059] in, Represents the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console. Indicates the target master end posture command.
[0060] In other optional embodiments, performing posture compensation processing of the console root base on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base includes one or more of the following steps: obtaining the pitch compensation angle of the console root base; based on the pitch compensation angle of the console root base, performing pitch angle compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; obtaining the yaw compensation angle of the console root base; based on the yaw compensation angle of the console root base, performing yaw angle compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; obtaining the swivel compensation angle of the console root base; based on the swivel compensation angle of the console root base, performing swivel angle compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base.
[0061] For example, the pitch compensation angle of the console root base pre-calibrated by the user may be obtained, and then the pitch compensation matrix of the console root base may be determined based on the pitch compensation angle of the console root base. The calculation formula is as follows:
[0062] ;
[0063] Wherein, B1 represents the pitch compensation angle of the base at the root of the console. represents the pitch compensation matrix of the console root base; similarly, the yaw compensation angle of the console root base pre-calibrated by the user can be obtained, and then the yaw compensation matrix of the console root base can be determined based on the yaw compensation angle of the console root base. The calculation formula is as follows:
[0064] ;
[0065] Among them, B2 represents the deflection compensation angle of the base at the root of the console, represents the yaw compensation matrix of the console root base;
[0066] Similarly, the rotation compensation angle of the console root base pre-calibrated by the user can be obtained, and then the rotation compensation matrix of the console root base can be determined based on the rotation compensation angle of the console root base. The calculation formula is as follows:
[0067] ;
[0068] Among them, B3 represents the rotation compensation angle of the base at the root of the console. represents the rotation compensation matrix of the root base of the console; further, the target master end attitude command calculation formula can be as follows:
[0069] ;
[0070] in, Represents the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console. Indicates the target master end posture command.
[0071] Exemplarily, the target master end posture instruction calculation formula can also be:
[0072] .
[0073] The technical solution of the embodiment of the present invention performs posture compensation processing of the handle at the end of the console and / or the posture compensation processing of the base at the root of the console based on the original posture data, so that the wrist of the operator at the main end does not need to move to the extreme angle, and the posture of the surgical platform at the slave end can reach the extreme orientation, so that the wrist can work in a comfortable posture.
[0074] Embodiment 3
[0075] Figure 4 A flowchart of a master-slave control method for a laparoscopic surgical robot provided in the third embodiment of the present invention, the method of this embodiment can be combined with the various optional schemes in the master-slave control method for a laparoscopic surgical robot provided in the above embodiments. The master-slave control method for a laparoscopic surgical robot provided in this embodiment is further optimized. Optionally, the comfort compensation processing is performed on the posture data of the console end handle of the laparoscopic surgical robot relative to the root base of the console to obtain the target master end posture instruction of the laparoscopic surgical robot, including: determining the target orientation data of the console end handle of the laparoscopic surgical robot; determining the posture compensation angle based on the target orientation data of the console end handle of the laparoscopic surgical robot; based on the posture compensation angle, comfort compensation processing is performed on the posture data of the console end handle of the laparoscopic surgical robot relative to the root base of the console to obtain the target master end posture instruction of the laparoscopic surgical robot.
[0076] like Figure 4 As shown, the method includes:
[0077] S310, obtaining the posture data of the end handle of the console of the laparoscopic surgery robot relative to the root base of the console.
[0078] S320, determining the target orientation data of the console end handle of the laparoscopic surgery robot.
[0079] In the embodiment of the present invention, the target orientation data refers to the pitch, yaw and roll orientation data of the end handle.
[0080] For example, the mean or median of the pitch, yaw and rotation orientation data of the end handle can be obtained from the data recording system of different historical surgical procedures or historical operators; then the mean or median of the pitch, yaw and rotation orientation data of the end handle is determined as the common orientation data, and then the common orientation data is used as the target orientation data. The common orientation data can also be updated according to the real-time orientation data of the end handle, so that the updated common orientation data can be used as the target orientation data.
[0081] S330, determining a posture compensation angle based on the target orientation data of the end handle of the console of the laparoscopic surgical robot.
[0082] Exemplarily, the calculation formula of the attitude compensation angle may be as follows:
[0083] Attitude compensation angle = Inv (Inv (initial orientation attitude deviation matrix) × target orientation data);
[0084] The initial orientation posture deviation matrix refers to the posture deviation matrix between the initial orientation of the end handle and the target orientation.
[0085] S340. Based on the posture compensation angle, comfort compensation processing is performed on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base to obtain a target main end posture instruction of the laparoscopic surgical robot.
[0086] In the embodiment of the present invention, a root base compensation matrix and / or an end handle compensation matrix can be constructed according to the posture compensation angle, and then the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console can be subjected to comfort compensation processing according to the root base compensation matrix and / or the end handle compensation matrix. The specific calculation formula can be as follows:
[0087] ;
[0088] in, represents the root base compensation matrix, represents the end handle compensation matrix.
[0089] In some optional embodiments, after obtaining the posture compensation angle, the XYZ fixed angle can be determined based on the posture compensation angle, and then the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console can be comfort compensated based on the XYZ fixed angle.
[0090] S350. Send the target master-end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction.
[0091] Optionally, after determining the posture compensation angle based on the target orientation data of the end handle of the console of the laparoscopic surgery robot, the method further includes: adjusting the orientation of a console display device of the laparoscopic surgery robot based on the posture compensation angle.
[0092] In the embodiment of the present invention, the posture compensation angle can also be used as a control instruction of the mechanical freedom to adjust the orientation of the display device so that the operator can obtain a better visual experience of the hand, the display device and the instrument screen in the display device.
[0093] The technical solution of the embodiment of the present invention determines the target orientation data of the console end handle of the laparoscopic surgical robot, and then determines the posture compensation angle according to the target orientation data of the console end handle of the laparoscopic surgical robot, and then based on the posture compensation angle, performs comfort compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the root base of the console, so that the wrist of the operator at the main end does not need to move to the extreme angle, and the posture of the surgical platform at the slave end can reach the extreme orientation, so that the wrist can work in a comfortable posture.
[0094] Embodiment 4
[0095] Figure 5 This is a schematic diagram of the structure of a master-slave control device for a laparoscopic surgical robot provided in Embodiment 4 of the present invention. Figure 5 As shown, the device comprises:
[0096] The handle-base posture data acquisition module 410 is used to acquire the posture data of the handle at the end of the console of the laparoscopic surgical robot relative to the base at the root of the console;
[0097] The posture data compensation processing module 420 is used to perform comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the base of the console root, and obtain the target main end posture instruction of the laparoscopic surgical robot. The comfort compensation processing refers to the posture data compensation operation that allows the posture of the surgical platform to reach the extreme orientation without the wrist of the handle operator moving to the extreme angle, so that the wrist works in a comfortable posture;
[0098] The target master-end posture instruction sending module 430 is used to send the target master-end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction.
[0099] The technical solution of the embodiment of the present invention obtains the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console, and then performs comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console, obtains the target master-end posture instruction of the laparoscopic surgical robot, and then sends the target master-end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction. The above technical solution, by performing comfort compensation processing on the basis of the original posture data, allows the master-end operator's wrist to reach the extreme angle without moving it, and allows the wrist to work in a comfortable posture.
[0100] In some optional implementations, the posture data compensation processing module 420 includes:
[0101] The handle-base posture compensation unit is used to perform posture compensation processing of the console end handle and / or the console root base on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base to obtain the target main end posture instruction of the laparoscopic surgical robot.
[0102] In some optional embodiments, the handle-base posture compensation unit includes one or more of the following subunits:
[0103] The pitch angle compensation subunit of the end handle is used to obtain the pitch compensation angle of the console end handle; based on the pitch compensation angle of the console end handle, the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base is subjected to the pitch angle compensation processing of the console end handle;
[0104] The end handle yaw angle compensation subunit is used to obtain the yaw compensation angle of the console end handle; based on the yaw compensation angle of the console end handle, the yaw angle compensation processing of the console end handle is performed on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base;
[0105] The rotation angle compensation subunit of the end handle is used to obtain the rotation compensation angle of the console end handle; based on the rotation compensation angle of the console end handle, the rotation angle compensation processing of the console end handle is performed on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base.
[0106] In some optional embodiments, the handle-base posture compensation unit includes one or more of the following subunits:
[0107] The pitch angle compensation subunit of the root base is used to obtain the pitch compensation angle of the root base of the console; based on the pitch compensation angle of the root base of the console, the posture data of the console end handle of the laparoscopic surgical robot relative to the root base of the console is subjected to pitch angle compensation processing of the root base of the console;
[0108] The root base yaw angle compensation subunit is used to obtain the yaw compensation angle of the console root base; based on the yaw compensation angle of the console root base, the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base is subjected to yaw angle compensation processing of the console root base;
[0109] The rotation angle compensation subunit of the root base is used to obtain the rotation compensation angle of the root base of the console; based on the rotation compensation angle of the root base of the console, the rotation angle compensation processing of the root base of the console is performed on the posture data of the console end handle of the laparoscopic surgical robot relative to the root base of the console.
[0110] In some optional implementations, the handle-base posture data acquisition module 410 includes:
[0111] The joint position sensor acquisition unit is used to obtain the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console through the joint position sensor.
[0112] In some optional implementations, the posture data compensation processing module 420 includes:
[0113] A target orientation data determination unit, used to determine the target orientation data of the console end handle of the laparoscopic surgery robot;
[0114] A posture compensation angle determination unit, used to determine a posture compensation angle based on target orientation data of a console end handle of the laparoscopic surgical robot;
[0115] The target master end posture instruction determination unit is used to perform comfort compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base based on the posture compensation angle to obtain the target master end posture instruction of the laparoscopic surgical robot.
[0116] In some optional embodiments, the master-slave control device of the laparoscopic surgical robot further includes:
[0117] The console display device adjustment unit is used to adjust the orientation of the console display device of the laparoscopic surgical robot based on the posture compensation angle.
[0118] The master-slave control device of the laparoscopic surgical robot provided in the embodiment of the present invention can execute the master-slave control method of the laparoscopic surgical robot provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.
[0119] Embodiment 5
[0120] Figure 6 The structure diagram of the console 10 of the laparoscopic surgical robot that can be used to implement the embodiment of the present invention is shown. The components, their connections and relationships, and their functions shown herein are only examples and are not intended to limit the implementation of the present invention described and / or required herein.
[0121] like Figure 6 As shown, the console 10 of the laparoscopic surgical robot includes at least one processor 11, and a memory connected to the at least one processor 11, such as a read-only memory (ROM) 12, a random access memory (RAM) 13, etc., wherein the memory stores a computer program that can be executed by at least one processor, and the processor 11 can perform various appropriate actions and processes according to the computer program stored in the read-only memory (ROM) 12 or the computer program loaded from the storage unit 18 to the random access memory (RAM) 13. In RAM 13, various programs and data required for the operation of the console 10 of the laparoscopic surgical robot can also be stored. The processor 11, ROM 12 and RAM 13 are connected to each other through a bus 14. The I / O interface 15 is also connected to the bus 14.
[0122] Multiple components in the console 10 of the laparoscopic surgical robot are connected to the I / O interface 15, including: an input unit 16, such as a keyboard, a mouse, etc.; an output unit 17, such as various types of displays, speakers, etc.; a storage unit 18, such as a disk, an optical disk, etc.; and a communication unit 19, such as a network card, a modem, a wireless communication transceiver, etc. The communication unit 19 allows the console 10 of the laparoscopic surgical robot to exchange information / data with other devices through a computer network such as the Internet and / or various telecommunication networks.
[0123] The processor 11 may be a variety of general and / or special processing components with processing and computing capabilities. Some examples of the processor 11 include, but are not limited to, a central processing unit (CPU), a graphics processing unit (GPU), various special artificial intelligence (AI) computing chips, various processors running machine learning model algorithms, a digital signal processor (DSP), and any appropriate processor, controller, microcontroller, etc. The processor 11 executes the various methods and processes described above, such as a master-slave control method of a laparoscopic surgical robot, which includes:
[0124] Acquire the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console;
[0125] Performing comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the base at the root of the console to obtain the target main end posture command of the laparoscopic surgical robot, wherein the comfort compensation processing refers to the posture data compensation operation that allows the posture of the surgical platform to reach the extreme orientation without the wrist of the handle operator having to move to the extreme angle, so that the wrist works in a comfortable posture;
[0126] The target master-end posture instruction is sent to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction.
[0127] In some embodiments, the master-slave control method of the laparoscopic surgical robot may be implemented as a computer program, which is tangibly contained in a computer-readable storage medium, such as a storage unit 18. In some embodiments, part or all of the computer program may be loaded and / or installed on the console 10 of the laparoscopic surgical robot via the ROM 12 and / or the communication unit 19. When the computer program is loaded into the RAM 13 and executed by the processor 11, one or more steps of the master-slave control method of the laparoscopic surgical robot described above may be performed. Alternatively, in other embodiments, the processor 11 may be configured to execute the master-slave control method of the laparoscopic surgical robot in any other appropriate manner (e.g., by means of firmware).
[0128] Various implementations of the systems and techniques described above herein can be implemented in digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products (ASSPs), system-on-chips (SOCs), complex programmable logic devices (CPLDs), computer hardware, firmware, software, and / or combinations thereof. These various implementations can include: being implemented in one or more computer programs that can be executed and / or interpreted on a programmable system including at least one programmable processor, which can be a special purpose or general purpose programmable processor that can receive data and instructions from a storage system, at least one input device, and at least one output device, and transmit data and instructions to the storage system, the at least one input device, and the at least one output device.
[0129] Computer programs for implementing the methods of the present invention may be written in any combination of one or more programming languages. These computer programs may be provided to a processor of a general-purpose computer, a special-purpose computer, or other programmable data processing device, so that when the computer program is executed by the processor, the functions / operations specified in the flow chart and / or block diagram are implemented. The computer program may be executed entirely on the machine, partially on the machine, partially on the machine and partially on a remote machine as a stand-alone software package, or entirely on a remote machine or server.
[0130] In the context of the present invention, a computer-readable storage medium may be a tangible medium that may contain or store a computer program for use by or in conjunction with an instruction execution system, device, or equipment. A computer-readable storage medium may include, but is not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices, or equipment, or any suitable combination of the foregoing. Alternatively, a computer-readable storage medium may be a machine-readable signal medium. A more specific example of a machine-readable storage medium may include an electrical connection based on one or more lines, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
[0131] To provide interaction with a user, the systems and techniques described herein may be implemented on a console of a laparoscopic surgical robot, which console has: a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to a user; and a keyboard and a pointing device (e.g., a mouse or a trackball), through which a user may provide input to the console of the laparoscopic surgical robot. Other types of devices may also be used to provide interaction with a user; for example, feedback provided to a user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback); and input from a user may be received in any form (including acoustic input, voice input, or tactile input).
[0132] The systems and techniques described herein may be implemented in a computing system that includes backend components (e.g., as a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes frontend components (e.g., a user computer with a graphical user interface or a web browser through which a user can interact with implementations of the systems and techniques described herein), or a computing system that includes any combination of such backend components, middleware components, or frontend components. The components of the system may be interconnected by any form or medium of digital data communication (e.g., a communication network). Examples of communication networks include: a local area network (LAN), a wide area network (WAN), a blockchain network, and the Internet.
[0133] A computing system may include a client and a server. The client and the server are generally remote from each other and usually interact through a communication network. The client and server relationship is generated by computer programs running on the corresponding computers and having a client-server relationship with each other. The server may be a cloud server, also known as a cloud computing server or cloud host, which is a host product in the cloud computing service system to solve the defects of difficult management and weak business scalability in traditional physical hosts and VPS services.
[0134] It should be understood that the various forms of processes shown above can be used to reorder, add or delete steps. For example, the steps described in the present invention can be executed in parallel, sequentially or in different orders, as long as the desired results of the technical solution of the present invention can be achieved, and this document does not limit this.
[0135] The above specific implementations do not constitute a limitation on the protection scope of the present invention. It should be understood by those skilled in the art that various modifications, combinations, sub-combinations and substitutions can be made according to design requirements and other factors. Any modification, equivalent substitution and improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims
1. A master-slave control method for a laparoscopic surgical robot, characterized in that: Executed by the console of the laparoscopic surgical robot, including: Acquire the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console; Performing comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the base at the root of the console to obtain the target main end posture command of the laparoscopic surgical robot, wherein the comfort compensation processing refers to the posture data compensation operation that allows the posture of the surgical platform to reach the extreme orientation without the wrist of the handle operator having to move to the extreme angle, so that the wrist works in a comfortable posture; The target master-end posture instruction is sent to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave-end posture control operation based on the target master-end posture instruction.
2. The method according to claim 1, characterized in that: The comfort compensation processing is performed on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console to obtain the target main end posture instruction of the laparoscopic surgical robot, including: The posture data of the console end handle of the laparoscopic surgical robot relative to the console root base is subjected to posture compensation processing of the console end handle and / or posture compensation processing of the console root base to obtain a target main end posture instruction of the laparoscopic surgical robot.
3. The method according to claim 2, characterized in that The processing of posture compensation of the console end handle of the laparoscopic surgery robot relative to the posture data of the console root base comprises one or more of the following steps: Acquire the pitch compensation angle of the console end handle; based on the pitch compensation angle of the console end handle, perform pitch compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; Acquire the yaw compensation angle of the console end handle; based on the yaw compensation angle of the console end handle, perform yaw angle compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; Obtain the rotation compensation angle of the console end handle; based on the rotation compensation angle of the console end handle, perform rotation angle compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base.
4. The method according to claim 2, characterized in that: The performing posture compensation processing of the console root base on the posture data of the console end handle of the laparoscopic surgery robot relative to the console root base comprises one or more of the following steps: Acquire the pitch compensation angle of the console root base; based on the pitch compensation angle of the console root base, perform pitch angle compensation processing of the console root base on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; Acquire the yaw compensation angle of the console root base; based on the yaw compensation angle of the console root base, perform yaw angle compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; Acquire the rotation compensation angle of the console root base; based on the rotation compensation angle of the console root base, perform rotation angle compensation processing of the console root base on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base.
5. The method according to claim 1, characterized in that: The step of obtaining the posture data of the end handle of the console of the laparoscopic surgery robot relative to the root base of the console includes: The posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console is obtained through the joint position sensor.
6. The method according to claim 1, characterized in that The comfort compensation processing is performed on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console to obtain the target main end posture instruction of the laparoscopic surgical robot, including: Determining target orientation data of a console end handle of the laparoscopic surgical robot; Determining a posture compensation angle based on target orientation data of a console end handle of the laparoscopic surgical robot; Based on the posture compensation angle, comfort compensation processing is performed on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base to obtain a target main end posture instruction of the laparoscopic surgical robot.
7. The method according to claim 6, characterized in that After determining the posture compensation angle based on the target orientation data of the console end handle of the laparoscopic surgical robot, the method further includes: Based on the posture compensation angle, the orientation of the console display device of the laparoscopic surgical robot is adjusted.
8. A master-slave control device for a laparoscopic surgical robot, characterized in that: The method is performed by the console of the laparoscopic surgical robot as claimed in claim 1, comprising: A handle-base posture data acquisition module is used to obtain the posture data of the handle at the end of the console of the laparoscopic surgical robot relative to the base at the root of the console; A posture data compensation processing module is used to perform comfort compensation processing on the posture data of the end handle of the console of the laparoscopic surgical robot relative to the base at the root of the console to obtain the target main end posture instruction of the laparoscopic surgical robot. The comfort compensation processing refers to the posture data compensation operation that allows the posture of the surgical platform to reach the extreme orientation without the wrist of the handle operator moving to the extreme angle, so that the wrist works in a comfortable posture; The target master end posture instruction sending module is used to send the target master end posture instruction to the surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes the slave end posture control operation based on the target master end posture instruction.
9. A console for a laparoscopic surgical robot, characterized in that: include: at least one processor; and a memory communicatively coupled to the at least one processor; Wherein, the memory stores a computer program executable by the at least one processor, and the computer program is executed by the at least one processor so that the at least one processor can execute the master-slave control method of the laparoscopic surgical robot according to any one of claims 1-7.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a processor to implement the master-slave control method of a laparoscopic surgical robot according to any one of claims 1 to 7 when executed.
Citation Information
Patent Citations
Hyperdexterous system user interface
CN107430389A
Main manipulator and surgical robot control equipment
CN113907891A
Main hand wrist, main operation equipment and surgical robot
CN116098713A
Techniques for adjusting display unit of viewing system
CN116528790A
Surgical robot control system and method, electronic equipment and storage medium
CN116919609A
Cited By
Compensation method and device for pitching joint of surgical instrument and slave end controller
CN119302748A
Compensation Method, Device and Slave Controller for Pitch Joint of Surgical Instrument
CN119302748B
Master-slave displacement compensation method and device of surgical robot, electronic equipment and storage medium
CN119655902A
