Movatterモバイル変換


[0]ホーム

URL:


CN119074239B - Master-slave control method and device of endoscopic surgical robot, control console and storage medium - Google Patents

Master-slave control method and device of endoscopic surgical robot, control console and storage medium

Info

Publication number
CN119074239B
CN119074239BCN202411571094.8ACN202411571094ACN119074239BCN 119074239 BCN119074239 BCN 119074239BCN 202411571094 ACN202411571094 ACN 202411571094ACN 119074239 BCN119074239 BCN 119074239B
Authority
CN
China
Prior art keywords
console
posture
surgical robot
laparoscopic surgical
compensation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202411571094.8A
Other languages
Chinese (zh)
Other versions
CN119074239A (en
Inventor
王伟
张瑞康
杨美明
苏衍宇
赵彦丞
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Sagebot Intelligent Medical Equipment Co Ltd
Original Assignee
Harbin Sagebot Intelligent Medical Equipment Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Sagebot Intelligent Medical Equipment Co LtdfiledCriticalHarbin Sagebot Intelligent Medical Equipment Co Ltd
Priority to CN202411571094.8ApriorityCriticalpatent/CN119074239B/en
Publication of CN119074239ApublicationCriticalpatent/CN119074239A/en
Application grantedgrantedCritical
Publication of CN119074239BpublicationCriticalpatent/CN119074239B/en
Activelegal-statusCriticalCurrent
Anticipated expirationlegal-statusCritical

Links

Classifications

Landscapes

Abstract

Translated fromChinese

本发明公开了一种腔镜手术机器人的主从控制方法、装置、控制台及存储介质。该方法包括:获取腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据;对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行舒适度补偿处理,得到腔镜手术机器人的目标主端姿态指令;将所述目标主端姿态指令发送至腔镜手术机器人的手术平台,以使所述腔镜手术机器人的手术平台基于所述目标主端姿态指令完成从端姿态控制操作。上述技术方案,通过在原有姿态数据的基础上进行舒适度补偿处理,使得主端操作者手腕不必运动到极限角度,即可让从端的手术平台姿态抵达极限朝向,使手腕工作在舒适姿态下。

The present invention discloses a master-slave control method, device, console and storage medium for a laparoscopic surgical robot. The method comprises: obtaining the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base; performing comfort compensation processing on the posture data of the console end handle of the laparoscopic surgical robot relative to the console root base to obtain the target master end posture instruction of the laparoscopic surgical robot; sending 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 scheme, by performing comfort compensation processing on the basis of the original posture data, enables the master end operator's wrist to reach the extreme angle without moving to the extreme angle, so that the posture of the surgical platform of the slave end can reach the extreme orientation, and the wrist can work in a comfortable posture.

Description

Master-slave control method and device of endoscopic surgical robot, control console and storage medium
Technical Field
The invention relates to the technical field of robots, in particular to a master-slave control method, a master-slave control device, a control console and a storage medium of an endoscopic surgery robot.
Background
In modern medical technology, the application of endoscopic surgical robots has become an important means for improving surgical accuracy and reducing surgical risks.
In the use process of the endoscopic surgery robot, an operator can hold the tail end handle of the control console, and the direction of the tail end handle is changed by adjusting the wrist angle, so that master-slave teleoperation is realized.
At present, in practical operation application, the wrist of an operator frequently works at the anti-joint position due to the difference of the surgical operation areas, the individual body types, the operation habits and the like, and the wrist is in a limit angle for a long time, so that the operator is tired.
Disclosure of Invention
The invention provides a master-slave control method, a master-slave control device, a control console and a storage medium of an endoscopic surgical robot, which are used for realizing comfort level compensation processing based on original posture data, so that the wrist of a master-end operator can reach the limit orientation without moving to the limit angle, and the posture of a surgical platform of a slave-end operator can work in a comfortable posture.
According to an aspect of the present invention, there is provided a master-slave control method of an endoscopic surgical robot, including:
acquiring attitude data of a control console tail end handle of the laparoscopic surgery robot relative to a control console root base;
Performing comfort level compensation processing on gesture data of a tail end handle of a control console of the laparoscopic surgery robot relative to a base at the root of the control console to obtain a target main end gesture instruction of the laparoscopic surgery robot, wherein the comfort level compensation processing refers to gesture data compensation operation that a wrist of a handle operator does not need to move to a limit angle, and the gesture of an operation platform can reach a limit orientation, so that the wrist works under a comfortable gesture;
And sending the target main end gesture instruction to an operation platform of the endoscopic surgery robot so that the operation platform of the endoscopic surgery robot can complete slave end gesture control operation based on the target main end gesture instruction.
According to another aspect of the present invention, there is provided a master-slave control apparatus of an laparoscopic surgical robot, including:
the handle-base attitude data acquisition module is used for acquiring attitude data of a handle at the tail end of a console of the laparoscopic surgery robot relative to a base at the root of the console;
The gesture data compensation processing module is used for performing comfort level compensation processing on gesture data of a tail end handle of a control console of the laparoscopic surgery robot relative to a root base of the control console to obtain a target main end gesture instruction of the laparoscopic surgery robot, wherein the comfort level compensation processing refers to gesture data compensation operation that a wrist of a handle operator can reach a limit orientation without moving the wrist to a limit angle, and the wrist works in a comfortable gesture;
And the target main end gesture command sending module is used for sending the target main end gesture command to the operation platform of the endoscopic surgical robot so that the operation platform of the endoscopic surgical robot can complete slave end gesture control operation based on the target main end gesture command.
According to another aspect of the present invention, there is provided a console of an laparoscopic surgical robot, the console of the laparoscopic surgical robot including:
At least one processor;
And a memory communicatively coupled to the at least one processor;
The memory stores a computer program executable by the at least one processor, so that the at least one processor can execute the master-slave control method of the laparoscopic surgery robot according to any embodiment of the present invention.
According to another aspect of the present invention, there is provided a computer readable storage medium storing computer instructions for causing a processor to implement a master-slave control method of an endoscopic surgical robot according to any of the embodiments of the present invention when executed.
According to the technical scheme, the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console are obtained, so that the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console are subjected to comfort level compensation processing, a target main end gesture command of the laparoscopic surgery robot is obtained, and the target main end gesture command is sent to an operation platform of the laparoscopic surgery robot, so that the operation platform of the laparoscopic surgery robot can complete slave end gesture control operation based on the target main end gesture command. According to the technical scheme, the comfort level compensation processing is performed on the basis of the original posture data, so that the wrist of the operator at the master end does not need to move to a limit angle, and the posture of the operation platform at the slave end can reach the limit orientation, and the wrist can work in the comfort posture.
It should be understood that the description in this section is not intended to identify key or critical features of the embodiments of the invention or to delineate the scope of the invention. Other features of the present invention will become apparent from the description that follows.
Drawings
In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings required for the description of the embodiments will be briefly described below, and it is apparent that the drawings in the following description are only some embodiments of the present invention, and other drawings may be obtained according to these drawings without inventive effort for a person skilled in the art.
FIG. 1 is a flow chart of a master-slave control method of an endoscopic surgical robot according to a first embodiment of the present invention;
FIG. 2 is a schematic structural view of a console of an laparoscopic surgical robot provided according to an embodiment of the present invention;
fig. 3 is a flowchart of a master-slave control method of an endoscopic surgical robot according to a second embodiment of the present invention;
Fig. 4 is a flowchart of a master-slave control method of an laparoscopic surgery robot according to a third embodiment of the present invention;
Fig. 5 is a schematic structural view of a master-slave control device of an laparoscopic surgery robot according to a fourth embodiment of the present invention;
fig. 6 is a schematic structural view of a console of the laparoscopic surgical robot implementing a master-slave control method of the laparoscopic surgical robot according to an embodiment of the present invention.
Detailed Description
In order that those skilled in the art will better understand the present invention, a technical solution in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in which it is apparent that the described embodiments are only some embodiments of the present invention, not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the present invention without making any inventive effort, shall fall within the scope of the present invention.
It should be noted that the terms "first," "second," and the like in the description and the claims of the present application and the above figures are used for distinguishing between similar objects and not necessarily for describing a particular sequential or chronological order. It is to be understood that the data so used may be interchanged where appropriate such that the embodiments of the application described herein may be implemented in sequences other than those illustrated or otherwise described herein. Furthermore, the terms "comprises," "comprising," and "having," and any variations thereof, are intended to cover a non-exclusive inclusion, such that a process, method, system, article, or apparatus that comprises a list of steps or elements is not necessarily limited to those steps or elements expressly listed but may include other steps or elements not expressly listed or inherent to such process, method, article, or apparatus. The technical scheme of the application obtains, stores, uses, processes and the like the data, which all meet the relevant regulations of national laws and regulations.
Example 1
Fig. 1 is a flowchart of a master-slave control method of an laparoscopic surgery robot according to a first embodiment of the present invention, where the method may be performed by a master-slave control device of the laparoscopic surgery robot, the master-slave control device of the laparoscopic surgery robot may be implemented in hardware and/or software, and the master-slave control device of the laparoscopic surgery robot may be configured in a console of the laparoscopic surgery robot. As shown in fig. 1, the method includes:
s110, acquiring posture data of a control console tail end handle of the laparoscopic surgery robot relative to a control console root base.
In embodiments of the present invention, the laparoscopic surgical robot refers to medical equipment designed to perform various minimally invasive procedures. The endoscope operation robot comprises a control console and an operation platform, wherein the control console is in communication connection with the operation platform, the control console is used as a master end for realizing master-slave teleoperation, and the operation platform is used as a slave end for realizing master-slave teleoperation. The console refers to a platform on which a user performs surgical operations and controls. Illustratively, fig. 2 is a schematic structural diagram of a console of an endoscopic surgical robot according to an embodiment of the present invention, which may include, but is not limited to, a distal handle 1, a joint position sensor 2, a display device 3, a root base (not shown in the drawings), and the like, without being specifically limited thereto. The joint position sensor 2 may be provided at a robot arm joint of the console. The surgical platform may include a manipulator, a surgical bed, etc., and is not particularly limited herein.
The gesture data refers to the orientation of the tip handle and may include pitch angle, yaw angle, and swivel angle. Specifically, attitude data of a console end handle of the laparoscopic surgical robot relative to a console root base may be obtained through an articulation position sensor.
The method comprises the steps of establishing a control console tail end handle coordinate system and a control console root base coordinate system, and acquiring posture data of a tail end handle relative to the control console root base coordinate system under the control console tail end handle coordinate system, namely posture data of the control console tail end handle relative to the control console root base through a joint position sensor when master-slave teleoperation control is carried out.
And S120, performing comfort level compensation processing on the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console, and obtaining a target main end gesture instruction of the laparoscopic surgery robot.
In the embodiment of the invention, the comfort level compensation processing refers to gesture data compensation operation of enabling the gesture of the operation platform of the slave end to reach the limit orientation without moving the wrist of the handle operator of the master end to the limit angle, so that the wrist works in the comfort gesture. The target main end gesture command refers to gesture data after comfort level compensation processing, and can be used for controlling a slave end operation platform, so that master-slave teleoperation is realized.
For example, the posture data of the control console tail end handle of the laparoscopic surgery robot relative to the control console root base can be subjected to comfort degree compensation processing through pre-calibrating the completed posture data, for example, when the wrist is tilted up to more than 45 degrees, the pitching angle in the posture data can be compensated according to the pre-configured pitching compensation angle. The gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console can be input into a gesture data compensation model which is trained in advance and is based on machine learning, and the model outputs gesture data after comfort level compensation processing.
S130, sending the target main end gesture instruction to a surgical platform of the endoscopic surgical robot, so that the surgical platform of the endoscopic surgical robot can complete slave end gesture control operation based on the target main end gesture instruction.
The control system of the surgical platform can perform inverse kinematics calculation on the target main end gesture command after receiving the target main end gesture command to obtain the kinematics command of each joint of the slave arm of the surgical platform, so that the surgical platform can complete the slave end gesture control operation according to the kinematics command of each joint to realize master-slave teleoperation.
According to the technical scheme, the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console are obtained, so that the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console are subjected to comfort level compensation processing, a target main end gesture command of the laparoscopic surgery robot is obtained, and the target main end gesture command is sent to an operation platform of the laparoscopic surgery robot, so that the operation platform of the laparoscopic surgery robot can complete slave end gesture control operation based on the target main end gesture command. According to the technical scheme, the comfort level compensation processing is performed on the basis of the original posture data, so that the wrist of the operator at the master end does not need to move to a limit angle, and the posture of the operation platform at the slave end can reach the limit orientation, and the wrist can work in the comfort posture.
Example two
Fig. 3 is a flowchart of a master-slave control method of an laparoscopic surgery robot according to a second embodiment of the present invention, where the method of the present embodiment may be combined with each of the alternatives in the master-slave control method of the laparoscopic surgery robot provided in the foregoing embodiment. The master-slave control method of the endoscopic surgery robot provided by the embodiment is further optimized. Optionally, the comfort level compensation processing is performed on the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console to obtain a target main end gesture command of the laparoscopic surgery robot, and the gesture compensation processing is performed on the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console and/or the gesture compensation processing of the root base of the control console to obtain the target main end gesture command of the laparoscopic surgery robot.
As shown in fig. 3, the method includes:
S210, acquiring posture data of a control console tail end handle of the laparoscopic surgery robot relative to a control console root base.
S220, carrying out posture compensation processing on the tail end handle of the control console of the laparoscopic surgery robot and/or posture compensation processing on the root base of the control console relative to the posture data of the root base of the control console, and obtaining a target main end posture instruction of the laparoscopic surgery robot.
S230, sending the target main end gesture instruction to a surgical platform of the endoscopic surgical robot, so that the surgical platform of the endoscopic surgical robot can complete slave end gesture control operation based on the target main end gesture instruction.
In the embodiment of the invention, the gesture compensation processing of the tail end handle of the control console refers to gesture compensation of the tail end handle, and similarly, the gesture compensation processing of the root base of the control console refers to gesture compensation of the root base.
In some alternative embodiments, performing attitude compensation processing of the console end handle of the laparoscopic surgical robot with respect to attitude data of the console root base includes one or more of obtaining a pitch compensation angle of the console end handle, performing pitch angle compensation processing of the console end handle with respect to attitude data of the console root base of the laparoscopic surgical robot based on the pitch compensation angle of the console end handle, obtaining a yaw compensation angle of the console end handle, performing yaw angle compensation processing of the console end handle with respect to attitude data of the console root base of the laparoscopic surgical robot based on the yaw compensation angle of the console end handle, obtaining a roll compensation angle of the console end handle, and performing roll angle compensation processing of the console end handle with respect to attitude data of the console root base based on the roll compensation angle of the console end handle.
Illustratively, the pitch compensation angle of the console end handle calibrated in advance 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, with the following calculation formula:
;
wherein A1 represents the pitch compensation angle of the console end handle,And similarly, the deflection compensation angle of the terminal handle of the control console calibrated in advance by a user can be obtained, and then the deflection compensation matrix of the terminal handle of the control console is determined based on the deflection compensation angle of the terminal handle of the control console, and the calculation formula is as follows:
;
wherein A2 represents the deflection compensation angle of the handle at the tail end of the control console,Representing a yaw compensation matrix of the console end handle;
similarly, the rotation compensation angle of the terminal handle of the control console calibrated in advance by the user can be obtained, and then the rotation compensation matrix of the terminal handle of the control console is determined based on the rotation compensation angle of the terminal handle of the control console, and the calculation formula is as follows:
;
wherein A3 represents the rotation compensation angle of the handle at the tail end of the control console,The rotation compensation matrix of the control console terminal handle is represented, and further, the calculation formula of the target main terminal gesture instruction can be as follows:
;
Wherein, thePosture data representing a console distal handle of the laparoscopic surgical robot relative to a console root base,And representing the target main end gesture instruction.
In other alternative embodiments, performing attitude compensation processing of a console root base on attitude data of a console end handle of the laparoscopic surgical robot relative to the console root base includes one or more of obtaining a pitch compensation angle of the console root base, performing pitch angle compensation processing of the console end handle of the laparoscopic surgical robot relative to the console root base based on the pitch compensation angle of the console root base, obtaining a yaw compensation angle of the console root base, performing yaw angle compensation processing of the console root base on attitude data of the console end handle of the laparoscopic surgical robot relative to the console root base based on the yaw compensation angle of the console root base, obtaining a swivel compensation angle of the console root base, and performing swivel angle compensation processing of the console end handle of the laparoscopic surgical robot relative to the console root base based on the swivel compensation angle of the console root base.
Illustratively, the pitch compensation angle of the console root base calibrated in advance 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, where the calculation formula is as follows:
;
wherein B1 represents the pitch compensation angle of the console root base,And similarly, the deflection compensation angle of the console root base calibrated in advance by a user can be obtained, and then the deflection compensation matrix of the console root base is determined based on the deflection compensation angle of the console root base, and the calculation formula is as follows:
;
wherein B2 represents the deflection compensation angle of the base of the root of the control console,Representing a yaw compensation matrix of a console root base;
Similarly, the rotation compensation angle of the console root base calibrated in advance by the user can be obtained, and then the rotation compensation matrix of the console root base is determined based on the rotation compensation angle of the console root base, and the calculation formula is as follows:
;
wherein B3 represents the rotation compensation angle of the base of the root of the control console,The rotation compensation matrix of the base of the control console root is represented, and further, the calculation formula of the gesture command of the main end of the target can be as follows:
;
Wherein, thePosture data representing a console distal handle of the laparoscopic surgical robot relative to a console root base,And representing the target main end gesture instruction.
Illustratively, the target master gesture instruction calculation formula may be:
According to the technical scheme, the gesture compensation processing of the tail end handle of the control console and/or the gesture compensation processing of the base of the root of the control console are/is performed on the basis of original gesture data, so that the wrist of a main end operator does not need to move to a limit angle, and the gesture of a surgical platform of a slave end can reach a limit orientation, and the wrist works in a comfortable gesture.
Example III
Fig. 4 is a flowchart of a master-slave control method of an laparoscopic surgery robot according to a third embodiment of the present invention, where the method of the present embodiment may be combined with each of the alternatives in the master-slave control method of the laparoscopic surgery robot provided in the foregoing embodiment. The master-slave control method of the endoscopic surgery robot provided by the embodiment is further optimized. Optionally, the comfort level compensation processing is performed on the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console to obtain a target main end gesture command of the laparoscopic surgery robot, wherein the comfort level compensation processing is performed on the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console to obtain the target main end gesture command of the laparoscopic surgery robot.
As shown in fig. 4, the method includes:
S310, acquiring posture data of a control console tail end handle of the laparoscopic surgery robot relative to a control console root base.
S320, determining target orientation data of a control console tail end handle of the endoscopic surgical robot.
In the embodiment of the invention, the target orientation data refer to pitch, yaw and rotation orientation data of the tail end handle.
For example, the average value or the median of the pitch, the yaw and the rotation direction data of the end handle can be obtained from a data recording system of different histories or histories of operators, and then the average value or the median of the pitch, the yaw and the rotation direction data of the end handle is determined as the common direction data, and then the common direction data is used as the target direction data. The common orientation data can be updated according to the real-time orientation data of the tail end handle, so that the updated common orientation data can be used as target orientation data.
S330, determining an attitude compensation angle based on target orientation data of a control console tail end handle of the endoscopic surgical robot.
For example, the calculation formula of the attitude compensation angle may be as follows:
Attitude compensation angle=inv (Inv (initial orientation attitude deviation matrix) ×target orientation data);
The initial orientation posture deviation matrix refers to a posture deviation matrix of the initial orientation of the tail end handle and the target orientation.
And S340, based on the attitude compensation angle, performing comfort level compensation processing on the attitude data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console, and obtaining a target main end attitude instruction of the laparoscopic surgery robot.
In the embodiment of the invention, a root base compensation matrix and/or a tail end handle compensation matrix can be constructed according to the attitude compensation angle, and then comfort compensation processing is carried out on the attitude data of the tail end handle of the console of the laparoscopic surgery robot relative to the root base of the console according to the root base compensation matrix and/or the tail end handle compensation matrix, wherein a specific calculation formula can be as follows:
;
Wherein, theRepresenting a root base compensation matrix,Representing the end handle compensation matrix.
In some alternative embodiments, after the posture compensation angle is obtained, an XYZ fixed angle may also be determined based on the posture compensation angle, and comfort compensation processing may be performed on posture data of a console end handle of the laparoscopic surgical robot relative to a console root base based on the XYZ fixed angle.
S350, sending the target main end gesture instruction to a surgical platform of the endoscopic surgical robot, so that the surgical platform of the endoscopic surgical robot completes slave end gesture control operation based on the target main end gesture instruction.
Optionally, after determining the attitude compensation angle based on the target orientation data of the console end handle of the laparoscopic surgical robot, further comprising adjusting an orientation of a console display device of the laparoscopic surgical robot based on the attitude compensation angle.
In the embodiment of the invention, the gesture compensation angle can also be used as a control instruction of mechanical degrees of freedom to adjust the orientation of the display device, so that an operator can obtain better visual feelings of hands, the display device and instrument pictures in the display device.
According to the technical scheme, the object orientation data of the tail end handle of the control console of the laparoscopic surgery robot is determined, the gesture compensation angle is determined according to the object orientation data of the tail end handle of the control console of the laparoscopic surgery robot, and the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the base of the root of the control console is subjected to comfort level compensation processing based on the gesture compensation angle, so that the wrist of a main end operator does not need to move to a limit angle, and the gesture of a surgery platform of a slave end can reach the limit orientation, so that the wrist works in a comfortable gesture.
Example IV
Fig. 5 is a schematic structural diagram of a master-slave control device of an laparoscopic surgery robot according to a fourth embodiment of the present invention. As shown in fig. 5, the apparatus includes:
a handle-base pose data acquisition module 410 for acquiring pose data of a console end handle of the laparoscopic surgical robot relative to a console root base;
The gesture data compensation processing module 420 is configured to perform a comfort level compensation process on gesture data of a control console tail end handle of the laparoscopic surgery robot relative to a control console root base, so as to obtain a target main end gesture instruction of the laparoscopic surgery robot, where the comfort level compensation process is a gesture data compensation operation that an operator wrist of the handle does not need to move to a limit angle, and the gesture of the surgical platform can reach a limit orientation, so that the wrist works in a comfortable gesture;
and a target master end gesture command sending module 430, configured to send the target master end gesture command to a surgical platform of the laparoscopic surgical robot, so that the surgical platform of the laparoscopic surgical robot completes a slave end gesture control operation based on the target master end gesture command.
According to the technical scheme, the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console are obtained, so that the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console are subjected to comfort level compensation processing, a target main end gesture command of the laparoscopic surgery robot is obtained, and the target main end gesture command is sent to an operation platform of the laparoscopic surgery robot, so that the operation platform of the laparoscopic surgery robot can complete slave end gesture control operation based on the target main end gesture command. According to the technical scheme, the comfort level compensation processing is performed on the basis of the original posture data, so that the wrist of the operator at the master end does not need to move to a limit angle, and the posture of the operation platform at the slave end can reach the limit orientation, and the wrist can work in the comfort posture.
In some alternative embodiments, the gesture data compensation processing module 420 includes:
and the handle-base posture compensation unit is used for carrying out posture compensation processing on the tail end handle of the control console of the laparoscopic surgery robot and/or posture compensation processing on the root base of the control console relative to the posture data of the root base of the control console so as to obtain a target main end posture instruction of the laparoscopic surgery robot.
In some alternative embodiments, the handle-base pose compensation unit comprises one or more of the following sub-units:
The system comprises a pitching angle compensation subunit of a tail end handle, a pitching angle compensation subunit of a control console tail end handle, a pitching angle compensation processing unit and a pitching angle compensation processing unit, wherein the pitching angle compensation subunit is used for acquiring a pitching compensation angle of the control console tail end handle;
The deflection angle compensation subunit of the tail end handle is used for acquiring a deflection compensation angle of the tail end handle of the control console, and performing deflection angle compensation processing on the gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the base of the root of the control console based on the deflection compensation angle of the tail end handle of the control console;
And the rotation angle compensation subunit is used for acquiring the rotation compensation angle of the tail end handle of the control console and carrying out rotation angle compensation processing on the tail end handle of the control console of the laparoscopic surgery robot relative to the posture data of the base of the root part of the control console based on the rotation compensation angle of the tail end handle of the control console.
In some alternative embodiments, the handle-base pose compensation unit comprises one or more of the following sub-units:
A pitch angle compensation subunit of the root base, configured to obtain a pitch compensation angle of the root base of the console; based on the pitching compensation angle of the console root base, performing pitching angle compensation processing on posture data of a console tail end handle of the laparoscopic surgery robot relative to the console root base;
The deflection angle compensation subunit of the root base is used for acquiring a deflection compensation angle of the control console root base, and performing deflection angle compensation processing on the control console end handle of the laparoscopic surgery robot relative to the gesture data of the control console root base based on the deflection compensation angle of the control console root base;
The system comprises a control console root base, a rotation angle compensation subunit and a control console root base processing unit, wherein the control console root base is used for acquiring a rotation compensation angle of the control console root base, and the rotation angle compensation processing of the control console root base is performed on gesture data of a control console end handle of the laparoscopic surgery robot relative to the control console root base based on the rotation compensation angle of the control console root base.
In some alternative embodiments, the handle-base pose data acquisition module 410 includes:
The joint position sensor acquisition unit is used for acquiring the gesture data of the tail end handle of the console of the laparoscopic surgery robot relative to the root base of the console through the joint position sensor.
In some alternative embodiments, the gesture data compensation processing module 420 includes:
A target orientation data determining unit configured to determine target orientation data of a console end handle of the laparoscopic surgery robot;
a posture compensation angle determining unit for determining a posture compensation angle based on target orientation data of a console end handle of the laparoscopic surgery robot;
And the target main end gesture instruction determining unit is used for carrying out comfort level compensation processing on gesture data of the tail end handle of the control console of the laparoscopic surgery robot relative to the root base of the control console based on the gesture compensation angle to obtain a target main end gesture instruction of the laparoscopic surgery robot.
In some alternative embodiments, the master-slave control device of the laparoscopic surgical robot further comprises:
And the control console display equipment adjusting unit is used for adjusting the orientation of the control console display equipment of the laparoscopic surgery robot based on the attitude compensation angle.
The master-slave control device of the laparoscopic surgery robot provided by the embodiment of the invention can execute the master-slave control method of the laparoscopic surgery robot provided by any embodiment of the invention, and has the corresponding functional modules and beneficial effects of the execution method.
Example five
Fig. 6 shows a schematic structural diagram of a console 10 of an laparoscopic surgical robot that may be used to implement an embodiment of the present invention. The components shown herein, their connections and relationships, and their functions, are meant to be exemplary only, and are not meant to limit implementations of the inventions described and/or claimed herein.
As shown in fig. 6, the console 10 of the laparoscopic surgical robot includes at least one processor 11, and a memory, such as a Read Only Memory (ROM) 12, a Random Access Memory (RAM) 13, etc., communicatively connected to the at least one processor 11, in which a computer program executable by the at least one processor is stored, and the processor 11 may 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 into the Random Access Memory (RAM) 13. In the RAM 13, various programs and data required for the operation of the console 10 of the laparoscopic surgery robot can also be stored. The processor 11, the ROM 12 and the RAM 13 are connected to each other via a bus 14. An I/O interface 15 is also connected to bus 14.
Various components in the console 10 of the laparoscopic surgical robot are connected to an 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 magnetic 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.
The processor 11 may be a variety of general and/or special purpose processing components having processing and computing capabilities. Some examples of processor 11 include, but are not limited to, a Central Processing Unit (CPU), a Graphics Processing Unit (GPU), various specialized Artificial Intelligence (AI) computing chips, various processors running machine learning model algorithms, digital Signal Processors (DSPs), and any suitable processor, controller, microcontroller, etc. The processor 11 performs the various methods and processes described above, such as a master-slave control method of an laparoscopic surgical robot, the method comprising:
acquiring attitude data of a control console tail end handle of the laparoscopic surgery robot relative to a control console root base;
Performing comfort level compensation processing on gesture data of a tail end handle of a control console of the laparoscopic surgery robot relative to a base at the root of the control console to obtain a target main end gesture instruction of the laparoscopic surgery robot, wherein the comfort level compensation processing refers to gesture data compensation operation that a wrist of a handle operator does not need to move to a limit angle, and the gesture of an operation platform can reach a limit orientation, so that the wrist works under a comfortable gesture;
And sending the target main end gesture instruction to an operation platform of the endoscopic surgery robot so that the operation platform of the endoscopic surgery robot can complete slave end gesture control operation based on the target main end gesture instruction.
In some embodiments, the master-slave control method of the laparoscopic surgical robot may be implemented as a computer program tangibly embodied on a computer-readable storage medium, such as the storage unit 18. In some embodiments, part or all of the computer program may be loaded and/or installed onto 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 RAM 13 and executed by 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 perform a master-slave control method of the laparoscopic surgical robot in any other suitable manner (e.g., by means of firmware).
Various implementations of the systems and techniques described here above may be implemented in digital electronic circuitry, integrated circuitry, field Programmable Gate Arrays (FPGAs), application Specific Integrated Circuits (ASICs), application Specific Standard Products (ASSPs), system-on-chip (SOCs), complex Programmable Logic Devices (CPLDs), computer hardware, firmware, software, and/or combinations thereof. These various embodiments may include being implemented in one or more computer programs that are executable and/or interpretable on a programmable system including at least one programmable processor, which may be a special or general purpose programmable processor, operable to receive data and instructions from, and to transmit data and instructions to, a storage system, at least one input device, and at least one output device.
A computer program for carrying out 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, special purpose computer, or other programmable data processing apparatus, such that the computer programs, when executed by the processor, cause the functions/acts specified in the flowchart and/or block diagram block or blocks to be implemented. The computer program may execute entirely on the machine, partly on the machine, as a stand-alone software package, partly on the machine and partly on a remote machine or entirely on the remote machine or server.
In the context of the present invention, a computer-readable storage medium may be a tangible medium that can contain, or store a computer program for use by or in connection with an instruction execution system, apparatus, or device. The computer readable storage medium may include, but is not limited to, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or any suitable combination of the foregoing. Alternatively, the computer readable storage medium may be a machine readable signal medium. More specific examples of a machine-readable storage medium would include an electrical connection based on one or more wires, a portable computer diskette, 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 disc read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
To provide for interaction with a user, the systems and techniques described herein can be implemented on a control console of a laparoscopic surgical robot having a display device (e.g., a CRT (cathode ray tube) or LCD (liquid crystal display) monitor) for displaying information to the user and a keyboard and a pointing device (e.g., a mouse or a trackball) by which the user can provide input to the control console of the laparoscopic surgical robot. Other kinds of devices may also be used to provide for interaction with a user, for example, feedback provided to the user may be any form of sensory feedback (e.g., visual feedback, auditory feedback, or tactile feedback), and input from the user may be received in any form, including acoustic input, speech input, or tactile input.
The systems and techniques described here can be implemented in a computing system that includes a background component (e.g., as a data server), or that includes a middleware component (e.g., an application server), or that includes a front-end component (e.g., a user computer having a graphical user interface or a web browser through which a user can interact with an implementation of the systems and techniques described here), or any combination of such background, middleware, or front-end components. The components of the system can 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.
The computing system may include clients and servers. The client and server are typically remote from each other and typically interact through a communication network. The relationship of client and server arises by virtue of computer programs running on the respective computers and having a client-server relationship to each other. The server can be a cloud server, also called a cloud computing server or a cloud host, and is a host product in a cloud computing service system, so that the defects of high management difficulty and weak service expansibility in the traditional physical hosts and VPS service are overcome.
It should be appreciated that various forms of the flows shown above may be used to reorder, add, or delete steps. For example, the steps described in the present invention may be performed in parallel, sequentially, or in a different order, so long as the desired results of the technical solution of the present invention are achieved, and the present invention is not limited herein.
The above embodiments do not limit the scope of the present invention. It will be apparent to those skilled in the art that various modifications, combinations, sub-combinations and alternatives are possible, depending on design requirements and other factors. Any modifications, equivalent substitutions and improvements made within the spirit and principles of the present invention should be included in the scope of the present invention.

Claims (8)

Translated fromChinese
1.一种腔镜手术机器人的主从控制装置,其特征在于,由腔镜手术机器人的控制台执行,包括:1. A master-slave control device for a laparoscopic surgical robot, characterized in that it is executed by a console of the laparoscopic surgical robot, 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;目标主端姿态指令发送模块,用于将所述目标主端姿态指令发送至腔镜手术机器人的手术平台,以使所述腔镜手术机器人的手术平台基于所述目标主端姿态指令完成从端姿态控制操作;A target master-end posture instruction sending module, used for sending 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 attitude data compensation processing module includes:目标朝向数据确定单元,用于确定所述腔镜手术机器人的控制台末端手柄的目标朝向数据;A target orientation data determination unit, used to determine the target orientation data of the console end handle of the laparoscopic surgery robot;姿态补偿角度确定单元,用于基于所述腔镜手术机器人的控制台末端手柄的目标朝向数据确定姿态补偿角度,所述姿态补偿角度=Inv(Inv(初始朝向的姿态偏差矩阵)×目标朝向数据),其中,初始朝向的姿态偏差矩阵是指末端手柄初始朝向与目标朝向的姿态偏差矩阵;A posture compensation angle determination unit, used to determine a posture compensation angle based on the target orientation data of the end handle of the console of the laparoscopic surgical robot, wherein the posture compensation angle=Inv(Inv(posture deviation matrix of initial orientation)×target orientation data), wherein the posture deviation matrix of initial orientation refers to the posture deviation matrix of the initial orientation of the end handle and the target orientation;目标主端姿态指令确定单元,用于基于所述姿态补偿角度,对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行舒适度补偿处理,得到腔镜手术机器人的目标主端姿态指令;A 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 a target master end posture instruction of the laparoscopic surgical robot;目标主端姿态指令的确定公式为:The formula for determining the target master end posture command is: ;其中,表示腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据,表示目标主端姿态指令,表示根部基座补偿矩阵,所述根部基座补偿矩阵根据姿态补偿角度构建得到,表示末端手柄补偿矩阵,所述末端手柄补偿矩阵根据姿态补偿角度构建得到。in, Represents the posture data of the end handle of the laparoscopic surgical robot console relative to the root base of the console. Indicates the target master end posture command, represents the root base compensation matrix, which is constructed according to the attitude compensation angle, represents an end handle compensation matrix, and the end handle compensation matrix is constructed according to the posture compensation angle.2.一种腔镜手术机器人的控制台,其特征在于,包括:2. A console for a laparoscopic surgical robot, comprising:至少一个处理器;at least one processor;以及与所述至少一个处理器通信连接的存储器;and a memory communicatively coupled to the at least one processor;其中,所述存储器存储有可被所述至少一个处理器执行的计算机程序,所述计算机程序被所述至少一个处理器执行,以使所述至少一个处理器能够执行腔镜手术机器人的主从控制方法,所述腔镜手术机器人的主从控制方法包括: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 a master-slave control method of a laparoscopic surgical robot, and the master-slave control method of the laparoscopic surgical robot includes:获取腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据;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;将所述目标主端姿态指令发送至腔镜手术机器人的手术平台,以使所述腔镜手术机器人的手术平台基于所述目标主端姿态指令完成从端姿态控制操作;Sending the target master-end posture command 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 command;所述对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行舒适度补偿处理,得到腔镜手术机器人的目标主端姿态指令,包括: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;基于所述腔镜手术机器人的控制台末端手柄的目标朝向数据确定姿态补偿角度,所述姿态补偿角度=Inv(Inv(初始朝向的姿态偏差矩阵)×目标朝向数据),其中,初始朝向的姿态偏差矩阵是指末端手柄初始朝向与目标朝向的姿态偏差矩阵;Determine a posture compensation angle based on the target orientation data of the end handle of the console of the laparoscopic surgical robot, wherein the posture compensation angle=Inv(Inv(posture deviation matrix of initial orientation)×target orientation data), wherein the posture deviation matrix of initial orientation refers to the posture deviation matrix of the initial orientation of the end handle and the target orientation;基于所述姿态补偿角度,对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行舒适度补偿处理,得到腔镜手术机器人的目标主端姿态指令;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;目标主端姿态指令的确定公式为:The formula for determining the target master end posture command is: ;其中,表示腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据,表示目标主端姿态指令,表示根部基座补偿矩阵,所述根部基座补偿矩阵根据姿态补偿角度构建得到,表示末端手柄补偿矩阵,所述末端手柄补偿矩阵根据姿态补偿角度构建得到。in, Represents the posture data of the end handle of the laparoscopic surgical robot console relative to the root base of the console. Indicates the target master end posture command, represents the root base compensation matrix, which is constructed according to the attitude compensation angle, represents an end handle compensation matrix, and the end handle compensation matrix is constructed according to the posture compensation angle.3.根据权利要求2所述的腔镜手术机器人的控制台,其特征在于,所述对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行舒适度补偿处理,得到腔镜手术机器人的目标主端姿态指令,包括:3. The console of the laparoscopic surgical robot according to claim 2, 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 are subjected to posture compensation processing of the console end handle and posture compensation processing of the console root base to obtain a target main end posture instruction of the laparoscopic surgical robot.4.根据权利要求3所述的腔镜手术机器人的控制台,其特征在于,所述对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行控制台末端手柄的姿态补偿处理包括以下步骤中的一项或多项:4. The console of the laparoscopic surgical robot according to claim 3, characterized in that the posture compensation processing of the console end handle of the laparoscopic surgical 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.5.根据权利要求3所述的腔镜手术机器人的控制台,其特征在于,所述对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行控制台根部基座的姿态补偿处理包括以下步骤中的一项或多项:5. The console of the laparoscopic surgical robot according to claim 3, characterized in that the 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 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.6.根据权利要求2所述的腔镜手术机器人的控制台,其特征在于,所述获取腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据,包括:6. The console of the laparoscopic surgical robot according to claim 2, characterized in that the step of obtaining the posture data of the end handle of the console of the laparoscopic surgical robot relative to the root base of the console comprises:通过关节位置传感器,获得腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据。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.7.根据权利要求2所述的腔镜手术机器人的控制台,其特征在于,在所述基于所述腔镜手术机器人的控制台末端手柄的目标朝向数据确定姿态补偿角度之后,还包括:7. The console of the laparoscopic surgical robot according to claim 2, characterized in that after determining the posture compensation angle based on the target orientation data of the end handle of the console of the laparoscopic surgical robot, it further comprises:基于所述姿态补偿角度,对所述腔镜手术机器人的控制台显示设备进行朝向调节。Based on the posture compensation angle, the orientation of the console display device of the laparoscopic surgical robot is adjusted.8.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机指令,所述计算机指令用于使处理器执行时实现腔镜手术机器人的主从控制方法,所述腔镜手术机器人的主从控制方法包括:8. A computer-readable storage medium, characterized in that the computer-readable storage medium stores computer instructions, and the computer instructions are used to implement a master-slave control method of a laparoscopic surgical robot when executed by a processor, and the master-slave control method of a laparoscopic surgical robot includes:获取腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据;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;将所述目标主端姿态指令发送至腔镜手术机器人的手术平台,以使所述腔镜手术机器人的手术平台基于所述目标主端姿态指令完成从端姿态控制操作;Sending the target master-end posture command 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 command;所述对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行舒适度补偿处理,得到腔镜手术机器人的目标主端姿态指令,包括: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;基于所述腔镜手术机器人的控制台末端手柄的目标朝向数据确定姿态补偿角度,所述姿态补偿角度=Inv(Inv(初始朝向的姿态偏差矩阵)×目标朝向数据),其中,初始朝向的姿态偏差矩阵是指末端手柄初始朝向与目标朝向的姿态偏差矩阵;Determine a posture compensation angle based on the target orientation data of the end handle of the console of the laparoscopic surgical robot, wherein the posture compensation angle=Inv(Inv(posture deviation matrix of initial orientation)×target orientation data), wherein the posture deviation matrix of initial orientation refers to the posture deviation matrix of the initial orientation of the end handle and the target orientation;基于所述姿态补偿角度,对所述腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据进行舒适度补偿处理,得到腔镜手术机器人的目标主端姿态指令;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;目标主端姿态指令的确定公式为:The formula for determining the target master end posture command is: ;其中,表示腔镜手术机器人的控制台末端手柄相对于控制台根部基座的姿态数据,表示目标主端姿态指令,表示根部基座补偿矩阵,所述根部基座补偿矩阵根据姿态补偿角度构建得到,表示末端手柄补偿矩阵,所述末端手柄补偿矩阵根据姿态补偿角度构建得到。in, Represents the posture data of the end handle of the laparoscopic surgical robot console relative to the root base of the console. Indicates the target master end posture command, represents the root base compensation matrix, which is constructed according to the attitude compensation angle, represents an end handle compensation matrix, and the end handle compensation matrix is constructed according to the posture compensation angle.
CN202411571094.8A2024-11-062024-11-06Master-slave control method and device of endoscopic surgical robot, control console and storage mediumActiveCN119074239B (en)

Priority Applications (1)

Application NumberPriority DateFiling DateTitle
CN202411571094.8ACN119074239B (en)2024-11-062024-11-06Master-slave control method and device of endoscopic surgical robot, control console and storage medium

Applications Claiming Priority (1)

Application NumberPriority DateFiling DateTitle
CN202411571094.8ACN119074239B (en)2024-11-062024-11-06Master-slave control method and device of endoscopic surgical robot, control console and storage medium

Publications (2)

Publication NumberPublication Date
CN119074239A CN119074239A (en)2024-12-06
CN119074239Btrue CN119074239B (en)2025-07-15

Family

ID=93665344

Family Applications (1)

Application NumberTitlePriority DateFiling Date
CN202411571094.8AActiveCN119074239B (en)2024-11-062024-11-06Master-slave control method and device of endoscopic surgical robot, control console and storage medium

Country Status (1)

CountryLink
CN (1)CN119074239B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
CN119302748B (en)*2024-12-172025-07-15哈尔滨思哲睿智能医疗设备股份有限公司Compensation method and device for pitching joint of surgical instrument and slave end controller
CN119655902B (en)*2025-02-202025-07-15哈尔滨思哲睿智能医疗设备股份有限公司Master-slave displacement compensation method and device for surgical robot, electronic equipment and storage medium

Citations (3)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
CN107430389A (en)*2015-02-242017-12-01Sri国际公司The skilful type system user interface of oversoul
CN116528790A (en)*2020-11-302023-08-01直观外科手术操作公司 Techniques for Adjusting Display Units of Viewing Systems
CN116919609A (en)*2022-04-072023-10-24上海微创医疗机器人(集团)股份有限公司Surgical robot control system, method, electronic device, and storage medium

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
US10188471B2 (en)*1999-09-172019-01-29Intuitive Surgical Operations, Inc.Tele-operative surgical systems and methods of control at joint limits using inverse kinematics
KR101997566B1 (en)*2012-08-072019-07-08삼성전자주식회사Surgical robot system and control method thereof
KR102214811B1 (en)*2013-03-152021-02-10인튜어티브 서지컬 오퍼레이션즈 인코포레이티드Systems and methods for using the null space to emphasize manipulator joint motion anisotropically
WO2021049189A1 (en)*2019-09-132021-03-18ソニー株式会社Medical arm system, arm device, and master–slave system operation method
CN113907891A (en)*2021-11-082022-01-11哈尔滨思哲睿智能医疗设备有限公司 A main operator and surgical robot manipulation equipment
CN116098713B (en)*2021-11-112025-09-23深圳市精锋医疗科技股份有限公司 Main wrist, main operating equipment and surgical robot
CN118891020A (en)*2022-03-182024-11-01柯惠Lp公司 Expanded input to the physician console for wrist-mounted robotic-assisted surgical instruments
CN117695018A (en)*2024-01-262024-03-15上海电气集团股份有限公司Master-slave robot, control method, system thereof and storage medium

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
CN107430389A (en)*2015-02-242017-12-01Sri国际公司The skilful type system user interface of oversoul
CN116528790A (en)*2020-11-302023-08-01直观外科手术操作公司 Techniques for Adjusting Display Units of Viewing Systems
CN116919609A (en)*2022-04-072023-10-24上海微创医疗机器人(集团)股份有限公司Surgical robot control system, method, electronic device, and storage medium

Also Published As

Publication numberPublication date
CN119074239A (en)2024-12-06

Similar Documents

PublicationPublication DateTitle
CN119074239B (en)Master-slave control method and device of endoscopic surgical robot, control console and storage medium
US8996176B2 (en)Robot apparatus, method for controlling the same, and computer program
WO2022002159A1 (en)Master-slave motion control method, robot system, device, and storage medium
CN113450903B (en) A human action mapping method, device, computer equipment and storage medium
CN116000925B (en)Mechanical arm tracking method, device, equipment and storage medium
CN116749168A (en)Rehabilitation track acquisition method based on gesture teaching
CN117224241A (en)Control method and related device of soft endoscope control system
CN107688293B (en)Modeling method of minimally invasive surgical robot
JP3559335B2 (en) 3D image processing device
CN119302748B (en)Compensation method and device for pitching joint of surgical instrument and slave end controller
CN115317136A (en) Control method, control device and robot for surgical robot
CN106695796A (en)Portable laser scanning measuring arm hand-eye calibration method based on RANSAC
CN118700152A (en) Cooperative control method, system, equipment, medium and product of dual-arm robot
CN113561172A (en) A dexterous hand control method and device based on binocular vision acquisition
CN106903665A (en)A kind of master-slave mode telesurgery robot control system based on stereoscopic vision
CN116185205B (en) Non-contact gesture interaction method and device
WO2024212553A1 (en)Robot remote control method and system
CN118143947A (en) A method, device, equipment and storage medium for determining posture
WO2024007900A1 (en)Method and apparatus for adjusting redundant degree of freedom, and computer device and mechanical arm
CN119097425B (en)Motion control method and device of endoscopic surgery robot, electronic equipment and storage medium
CN105997247A (en)A control terminal, an operation apparatus terminal, a method and a system for remote operations
CN114795486A (en)Intraoperative real-time robot hand-eye calibration method and system based on probe
CN120056093A (en)Method and device for determining rod member parameters of manipulator, electronic equipment, storage medium and computer program product
WO2025007231A1 (en)Robot attitude processing method and apparatus, electronic device, and storage medium
CN120154426A (en) Surgical robot positioning method, device, system, equipment, medium and product

Legal Events

DateCodeTitleDescription
PB01Publication
PB01Publication
SE01Entry into force of request for substantive examination
SE01Entry into force of request for substantive examination
GR01Patent grant
GR01Patent grant

[8]ページ先頭

©2009-2025 Movatter.jp