Surgical robot and method of registration of the same with a surgical bed, and surgical system

Abstract

This application relates to a registration method between a surgical robot and an operating table. A scanning rangefinder and a positioning marker are respectively installed on the surgical robot and the operating table. The method includes: acquiring scanning data from the scanning rangefinder, including a first vertical distance and a second vertical distance between the surgical robot and the operating table, the distance between the scanning rangefinder and the positioning marker, and the scanning angle of the scanning rangefinder; and determining registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table based on the scanning data, the position coordinates of the scanning rangefinder, and the position coordinates of the positioning marker. The registration information includes posture registration information and / or position registration information. This application, by setting up a scanning rangefinder and a positioning marker located within the scanning range of the scanning rangefinder, can determine the posture and / or position registration information between the surgical robot and the operating table based on the scanning data from the scanning rangefinder, providing a basis for the control of the surgical robot.

Description

Technical Field

[0001] This application relates to the field of medical device technology, specifically to a surgical robot, its registration method with an operating table, and a surgical system. Background Technology

[0002] Minimally invasive surgery refers to a surgical procedure performed inside the human body using modern medical instruments and equipment such as laparoscopes and thoracoscopes. Compared to traditional surgical methods, minimally invasive surgery has advantages such as less trauma, less pain, and faster recovery.

[0003] With the advancement of technology, minimally invasive surgical robot technology has gradually matured and is widely used. Minimally invasive surgical robots typically include a main control panel and slave control devices. The main control panel includes a handle, through which the surgeon sends control commands to the slave control devices. The slave control devices include a drive arm and a puncture device mounted at the distal end of the drive arm. The puncture device is used to insert into the body opening of the patient lying on the operating table to provide a channel for medical instruments to pass through.

[0004] In robotic-assisted surgery, surgeons often expect the operating table to move a certain distance or rotate a certain angle to adjust the patient's position and improve or optimize the surgical site's field of vision and operating space. However, the movement of the operating table causes the patient's incision to move, and the surgical robot typically cannot actively control the puncture device to follow the incision based on the operating table's movement information. This makes adjusting the operating table and operating the surgical robot cumbersome, time-consuming, and potentially harmful to the patient, increasing the uncertainty and risks during the surgery. Summary of the Invention

[0005] To address the aforementioned technical problems, this application provides a surgical robot, a registration method for the robot and an operating table, and a surgical system. By setting a scanning range measuring device and positioning marks within the scanning range of the scanning range measuring device, the posture and / or position registration information between the surgical robot and the operating table can be determined based on the scanning data of the scanning range measuring device, providing a basis for the control of the surgical robot.

[0006] To address the aforementioned technical problems, this application provides a registration method for a surgical robot and an operating table. One of the surgical robot and the operating table is equipped with a scanning ranging device, and the other of the surgical robot and the operating table is equipped with a positioning mark located within the scanning range of the scanning ranging device. The horizontal plane containing the first and second horizontal coordinate axes of the surgical robot's reference coordinate system, the horizontal plane containing the first and second horizontal coordinate axes of the operating table's reference coordinate system, and the horizontal plane containing the scanning direction of the scanning ranging device are parallel or coincident with each other. The method includes the following steps:

[0007] The scanning data of the scanning ranging device is acquired, including the first vertical distance and the second vertical distance between the surgical robot and the operating table, the distance between the scanning ranging device and the positioning mark, and the scanning angle of the scanning ranging device;

[0008] Based on the scan data, the position coordinates of the scanning ranging device, and the position coordinates of the positioning mark, the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table is determined. The registration information includes posture registration information and / or position registration information.

[0009] In one embodiment, the surgical robot includes a drive arm, the distal end of which is equipped with a puncture device for insertion into an opening in the body of a patient lying on the operating table. The method further includes:

[0010] Based on the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table, and the pose information of the puncture device in the reference coordinate system of the surgical robot, the attitude registration information and / or position registration information between the puncture device and the reference coordinate system of the operating table are determined.

[0011] In one embodiment, determining the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table based on the scan data, the position coordinates of the scanning ranging device, and the position coordinates of the positioning mark includes:

[0012] Based on the first vertical distance and the second vertical distance between the surgical robot and the operating table, the relative rotation angle between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table is determined, so as to obtain the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0013] In one embodiment, when the scanning ranging device includes a scanning ranging sensor, the first vertical distance is the minimum distance scanned by the scanning ranging sensor, and the second vertical distance is the distance scanned by the scanning ranging sensor from a horizontal direction perpendicular to the installation position; or...

[0014] When the scanning ranging device includes a first scanning ranging sensor and a second scanning ranging sensor, the first scanning ranging sensor and the second scanning ranging sensor are arranged at intervals on a horizontal plane, the first vertical distance is the minimum distance scanned by the first scanning ranging sensor, and the second vertical distance is the minimum distance scanned by the second scanning ranging sensor; or, the first vertical distance is the distance scanned by the first scanning ranging sensor from a horizontal direction perpendicular to the installation position, and the second vertical distance is the distance scanned by the second scanning ranging sensor from a horizontal direction perpendicular to the installation position.

[0015] In one embodiment, the scanning ranging device is installed on the surgical robot. Determining the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table based on the scanning data, the position coordinates of the scanning ranging device, and the position coordinates of the positioning mark includes:

[0016] Obtain the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table;

[0017] The position coordinates of the positioning mark in the reference coordinate system of the surgical robot are determined based on the distance between the scanning ranging device and the positioning mark, the scanning angle at which the scanning ranging device scans the positioning mark, and the position coordinates of the scanning ranging device in the reference coordinate system of the surgical robot.

[0018] Based on the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table, the position coordinates of the positioning mark in the reference coordinate system of the surgical robot, and the position coordinates of the positioning mark in the reference coordinate system of the operating table, the position coordinates of the origin of the reference coordinate system of the operating table in the reference coordinate system of the surgical robot are determined, so as to obtain the position registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0019] In one embodiment, the positioning mark includes the intersection of two planes on the mounting side where the positioning mark is located, the two planes having a height difference at the intersection, and the positioning mark being perpendicular to the horizontal plane. Acquiring the scanning data from the scanning ranging device includes:

[0020] Obtain the target scanning range;

[0021] The scanning ranging device is controlled to rotate and reciprocate within the target scanning range;

[0022] Determine whether the positioning marker has been detected;

[0023] If so, then obtain the target scanning data corresponding to the location marker when it is scanned, and the target scanning data includes the target distance;

[0024] Determine whether the conditions for stopping the scan are met;

[0025] If the conditions for stopping scanning are not met, the target scanning range is reduced to become the updated target scanning range, and the process returns to the step of controlling the scanning ranging device to rotate and reciprocate scanning within the target scanning range.

[0026] If the conditions for stopping scanning are met, the distance between the scanning ranging device and the positioning mark is determined based on the acquired target scanning data, and the scanning angle corresponding to the distance is acquired as the scanning angle of the scanning ranging device.

[0027] In one embodiment, the condition for stopping the scan includes at least one of the following:

[0028] The number of times the positioning marker has been detected has reached a preset number;

[0029] The difference in target distance between the two most recent scans is less than or equal to a preset difference.

[0030] The target scanning range is reduced to a constant value;

[0031] A unique distance value is obtained by scanning the target scanning range.

[0032] This application also provides a registration device for a surgical robot and an operating table, comprising:

[0033] Memory, used to load and execute computer programs;

[0034] Processor, used to load and execute the computer program;

[0035] The computer program is loaded and executed by the processor to implement the registration method between the surgical robot and the operating table as described above.

[0036] This application also provides a surgical robot, which is equipped with a scanning and ranging device for scanning positioning marks set on the operating table. The horizontal planes containing the first and second horizontal coordinate axes of the surgical robot's reference coordinate system, the horizontal planes containing the first and second horizontal coordinate axes of the operating table's reference coordinate system, and the horizontal plane containing the scanning direction of the scanning and ranging device are parallel or coincident with each other.

[0037] The surgical robot also includes a controller for performing steps to implement the registration method between the surgical robot and the operating table as described above.

[0038] This application also provides a surgical system, including an operating table and a surgical robot as described above, wherein the surgical robot is communicatively connected to the operating table.

[0039] This application also provides a computer-readable storage medium storing a computer program that, when executed by a processor, implements the steps of the registration method between the surgical robot and the operating table as described above.

[0040] This application discloses a registration method for a surgical robot and an operating table. A scanning rangefinder and a positioning marker are respectively installed on the surgical robot and the operating table. The method includes: acquiring scanning data from the scanning rangefinder, including a first vertical distance and a second vertical distance between the surgical robot and the operating table, the distance between the scanning rangefinder and the positioning marker, and the scanning angle of the scanning rangefinder; and determining registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table based on the scanning data, the position coordinates of the scanning rangefinder, and the position coordinates of the positioning marker. The registration information includes posture registration information and / or position registration information. By setting up a scanning rangefinder and a positioning marker within the scanning range of the scanning rangefinder, this application can determine the posture and / or position registration information between the surgical robot and the operating table based on the scanning data from the scanning rangefinder, providing a basis for the control of the surgical robot. Attached Figure Description

[0041] Figure 1 This is a simplified diagram of the device relationships of a surgical system according to one embodiment;

[0042] Figure 2 This is a schematic diagram of the structure of a surgical system according to one embodiment;

[0043] Figure 3 This is a simplified kinematic model diagram of a surgical system according to an embodiment;

[0044] Figure 4This is a flowchart illustrating a registration method between a surgical robot and an operating table according to an embodiment;

[0045] Figure 5 This is a design schematic diagram of a scanning ranging device and a positioning mark according to an embodiment;

[0046] Figure 6 This is a schematic diagram illustrating a registration principle according to an embodiment;

[0047] Figure 7 This is a schematic diagram illustrating another registration principle according to one embodiment;

[0048] Figure 8 This is a schematic diagram of the registration device between a surgical robot and an operating table according to one embodiment;

[0049] Figure 9 This is a schematic diagram of an operating table control panel according to one embodiment. Detailed Implementation

[0050] To facilitate understanding of the present invention, a more complete description will be given below with reference to the accompanying drawings. Preferred embodiments of the invention are shown in the drawings. However, the invention can be implemented in many different forms and is not limited to the embodiments described herein. Rather, these embodiments are provided to provide a thorough and complete understanding of the disclosure of the invention.

[0051] It should be noted that when an element is referred to as being "set on" another element, it can be directly on the other element or there may be an intervening element. When an element is considered to be "connected" to another element, it can be directly connected to the other element or there may be an intervening element. When an element is considered to be "coupled" to another element, it can be directly coupled to the other element or there may be an intervening element. The terms "vertical," "horizontal," "left," "right," and similar expressions used herein are for illustrative purposes only and do not represent the only possible implementation. The terms "distal" and "proximal" used herein are directional terms commonly used in the field of interventional medical devices, where "distal" refers to the end away from the operator during the procedure, and "proximal" refers to the end closer to the operator during the procedure.

[0052] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as commonly understood by one of ordinary skill in the art to which this invention pertains. The terminology used herein in the specification of this invention is for the purpose of describing particular embodiments only and is not intended to be limiting of the invention. The term "and / or" as used herein includes any and all combinations of one or more of the associated listed items. In this invention, "each" includes one or more items.

[0053] Figure 1 This is a simplified diagram of the equipment relationships of a surgical system according to one embodiment. Figure 1 As shown, the surgical system 100 includes a surgical robot and an operating table 105. The surgical robot includes a bedside robotic arm system 101, a doctor's main control panel 103, and an imaging cart imaging system 108. It can be understood that the composition of the surgical robot is not limited to this.

[0054] The bedside robotic arm system 101 includes a drive arm with multiple joints. A puncture device is mounted at the distal end of the drive arm for insertion into a body opening of a patient 106 lying on the surface of an operating table 105. The puncture device provides a channel between the surgical robot and the organism (including a human / animal), through which medical instruments are inserted into the organism. The medical instruments include imaging instruments providing a field of view and surgical instruments providing surgical manipulation. The body opening includes surgical incisions and / or natural cavities in the organism, such as a patient's body. Exemplary natural cavities include the mouth, nose, and anus.

[0055] The doctor's main control console 103 and the bedside robotic arm system 101 communicate in real time via data transmission path 120. The surgeon's actions on the main control console 103 are performed by manipulating the medical devices in the bedside robotic arm system 101 through a master-slave mapping relationship based on a kinematic model. Simultaneously, the main control console 103 can monitor the status of the bedside robotic arm system 101, such as monitoring the motion information of each joint. When the operating table 105 performs movements of corresponding degrees of freedom, the patient 106, fixed to the surface of the operating table 105, remains relatively stationary relative to the surface. Changes in the patient's position are achieved by the operating table 105 performing movements of corresponding degrees of freedom. The motion information of each joint of the operating table 105 is recorded and stored in real time, and transmitted to the bedside robotic arm system 101 via data transmission path 150. Data transmission between the main control console 103 and the operating table 105 occurs via data transmission path 130. Images of the surgical site on patient 106 are acquired by an imaging device installed in the bedside robotic arm system 101. This imaging device is connected to the imaging cart system 108. The images acquired by the imaging device are transmitted to the imaging cart system 108 via data transmission path 110. Then, the imaging cart system 108 transmits the images acquired by the imaging device back to the doctor's main control panel 103 in real time via data transmission path 160, providing the doctor with a surgical field of view and facilitating the smooth execution of the surgery. In practice, data transmission paths 110, 120, 130, 150, and 160 can be either wired or wireless.

[0056] Figure 2 This is a schematic diagram of a surgical system according to one embodiment. Figure 2 The diagram illustrates the structure of the bedside robotic arm system 101 and the operating table 105 of the surgical robot. The bedside robotic arm system 101 includes a motion chassis 201, a robotic arm 250, and a drive arm. The motion chassis 201 can move the bedside robotic arm system 101 as a whole in any direction on a horizontal surface. The robotic arm 250 is used to position one or more drive arms as a whole. The drive arm includes an adjusting arm 260 and a manipulating arm 270.

[0057] The motion chassis 201 can adopt a wheeled movement structure, making the relative positional relationship between the bedside robotic arm system 101 and the operating table 105 more flexible. There are no constraints on designated location areas, and on-site medical personnel can independently push the system to complete the positioning and locking operations according to the actual surgical needs. This allows for close proximity to the operating table 105 while facilitating preoperative positioning of each manipulator 270 above the patient. In this embodiment, the bedside robotic arm system 101 is also equipped with a ranging component 202 for measuring external distances, such as a laser ranging component, an ultrasonic ranging component, or a visual ranging component. For example, the laser ranging component typically has ultra-high precision to facilitate accurate distance measurement.

[0058] The robotic arm 250 includes a fixed support column 203 fixedly connected to the motion chassis 201 for supporting all the motion joints, a lifting column 204 for performing the overall lifting linear motion J1 of the robotic arm 250, a large arm 205 and a small arm 206 for performing rotational motions J2 and J3 respectively, and a directional platform 207 for controlling one or more adjustment arms 260 to perform the overall rotational motion J4. The movement of these joints can quickly reach the expected preoperative positioning area, which helps to shorten the docking time between the preoperative bedside robotic arm system 101 and the patient 106.

[0059] One or more adjusting arms 260 are connected to the orientation platform 207 individually or in parallel via rotary joints J5. In some examples, the bedside robotic arm system 101 has multiple adjusting arms 260. Considering that the configurations of the multiple adjusting arms 260 are basically the same and the motion descriptions of each joint are basically the same, therefore... Figure 2 The structure is presented using only one adjusting arm 260 and one operating arm 270 as examples, along with the description of the joint motion relationships below. In some examples, the adjusting arm 260 includes a small rotating platform 208, a telescopic arm 209 that performs linear translation J6 in a horizontal direction parallel to the ground, a fixed vertical arm 210 fixedly connected to the telescopic arm 209, a movable vertical arm 211 that performs up-and-down lifting J7 in a vertical direction perpendicular to the ground, a turning head 212 that performs rotational movement J8, and a cyclone joint 213 that performs rotational movement J9.

[0060] The manipulator arm 270 includes a deflection joint 214 that rotates J10 with the cyclone joint 213, a parallelogram linkage base 215, a first link 216 and a second link 217 that perform rotational motion J11, and a holding arm 218 for performing linear motion J12 of the medical device 219 along the guide rail direction. A trocar 229 is mounted at the distal end of the manipulator arm 270. The distal fixed point 220 of the puncture device 229, which is at the same position as the body opening of the patient 106, is defined by the intersection of the axis of the cyclone joint 213 and the axis of the deflection joint 214. The intersection of these two axes with the lateral center plane of the parallelogram linkage device base 215 also converges to the distal fixed point 220 of the puncture device 229. In addition, the first link 216 and the second link 217, as two adjacent sides, together with two virtual adjacent sides parallel to them, form a parallelogram motion mechanism. This mechanism is controlled by a motor and performs the folding and opening motion of the parallelogram around the rotational motion J11 axis. The motion fixed point of the parallelogram also intersects with the distal fixed point 220 of the puncture device 229 at a point located on the central axis of the medical device 219. The end of the medical device 221 is inserted into the body of the patient 106 and performs the surgical actions of the doctor on the main control panel based on the master-slave mapping relationship.

[0061] The operating table 105 includes an operating table motion mechanism 280, which includes a wheeled chassis 227 movable on a horizontal surface, a fixed column 226, a telescopic column 225, a front-to-back tilting and rotating joint 223, a left-to-right tilting and rotating joint 224, and an uppermost table 222. The fixed column 226 is bolted to the wheeled chassis 227. The telescopic column 225 moves relative to the fixed column 226, performing a vertical lifting motion B2. Both columns also act as support mechanisms, supporting the table 222 of the operating table 105 and the patient 106. The axis of rotation B3 of the front-to-back tilting and rotating joint 223 intersects the axis of rotation B4 of the left-to-right tilting and rotating joint 224 above the telescopic column 225. The uppermost part is the table 222, which supports and fixes the patient 106. The front-to-back translational motion B1 of the table 222 is performed by a telescopic transmission mechanism located inside the table. During the movement of the operating table 222, the patient 106 needs to remain stationary relative to the operating table 222, the distal fixed point 220 of the puncture device 229 needs to remain stationary relative to the patient 106, and the end effector 221 of the medical device needs to remain stationary relative to the surgical site in order to ensure the patient's safety.

[0062] To actively control the surgical robot's drive arm to adjust the position and / or orientation of the puncture device during position and orientation changes on the operating table, it is necessary to first obtain orientation registration information and / or position registration information between the surgical robot and the operating table. Orientation registration information refers to the orientation transformation relationship between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table, while position registration information refers to the relative positional relationship between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table. In this embodiment, the registration information between the surgical robot and the operating table is obtained by establishing a position and orientation relationship between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0063] The reference coordinate system of the surgical robot is its own reference coordinate system, and the reference coordinate system of the operating table is its own reference coordinate system. In some embodiments, the reference coordinate system of the surgical robot includes its own base coordinate system. In some embodiments, the reference coordinate system of the operating table includes its own base coordinate system. Please refer to... Figure 2 and Figure 3The reference coordinate system 501 of the surgical robot can typically be established on the motion chassis 201 of the bedside robotic arm system 101, including two coordinate axes located on the horizontal plane with the origin located on the axis of the fixed support column 203. However, in actual implementation, the reference coordinate system 501 of the surgical robot may not be established on the motion chassis 201, as long as it has a fixed coordinate transformation relationship with the coordinate system of the motion chassis 201. According to the rules for establishing kinematic coordinate systems, robotic arm end coordinate system 502 and adjustment arm end coordinate system 503 are established at the ends of robotic arm 250 and adjustment arm 260, respectively, and medical device end coordinate system 504 and telecentric fixed point coordinate system 505 are established at the end of manipulator arm 270, respectively. In addition, joint coordinate systems are also established at the various motion joint positions inside robotic arm 250, adjustment arm 260 and manipulator arm 270. By applying the coordinate system transformation matrix of kinematic theory, the transformation relationships 510 between the robotic arm end-effector coordinate system 502 and the surgical robot's reference coordinate system 501, 520 between the adjustment arm end-effector coordinate system 503 and the robotic arm end-effector coordinate system 502, 530 between the medical device end-effector coordinate system 504 and the adjustment arm end-effector coordinate system 503, and 540 between the telecentric fixed-point coordinate system 505 and the adjustment arm end-effector coordinate system 503 can be calculated. Based on the coordinate system transformation relationships 510, 520, and 530, the relationship between the medical device end-effector coordinate system 504 and the surgical robot's reference coordinate system 501 can be obtained. The transformation relationship between the two can be used to determine the position and orientation of the medical device end effector in the reference coordinate system 501 of the surgical robot, including its position and posture. This allows the surgeon's surgical actions on the main operating table to be mapped onto the surgical instruments. Based on the coordinate system transformation relationships 510, 520, and 540, the transformation relationship between the telecentric fixed point coordinate system 505 and the reference coordinate system 501 of the surgical robot can be obtained. This allows the determination of the posture and position information of the puncture device installed at the end of the manipulator arm in the reference coordinate system 501 of the surgical robot. The position information of the puncture device can be represented by the position of the telecentric fixed point.

[0064] Considering the central symmetry of the operating table 105 in its mechanical structure and the distribution of its various joints within the system, the reference coordinate system 506 of the operating table is typically established at the center of the wheeled chassis 227, including two coordinate axes located on the horizontal plane with the origin located on the central axis of the wheeled chassis 227. However, in actual implementation, the reference coordinate system 506 of the operating table may not be established at the center of the wheeled chassis 227; it only needs to have a fixed coordinate transformation relationship with the coordinate system of the wheeled chassis 227. The coordinate systems of each joint are established sequentially at each joint according to the coordinate system establishment rules. To determine the motion information of the patient during the rotation of the operating table, the rotation center of the operating table is defined as an isocenter point, and an isocenter point coordinate system 507 and an operating table surface coordinate system 508 are established. By applying the coordinate system transformation matrix of kinematic theory, the transformation relationship 550 between the isocenter point coordinate system 507 and the reference coordinate system 506 of the operating table, and the transformation relationship 560 between the table surface coordinate system 508 and the isocenter point coordinate system 507 can be calculated.

[0065] After completing the pose registration between the surgical robot and the operating table, the transformation relationship 580 between the reference coordinate system 501 of the surgical robot and the reference coordinate system 506 of the operating table can be determined. Therefore, based on the coordinate system transformation relationships 550, 560, and 580, the kinematic relationship between the operating table surface coordinate system 508 and the reference coordinate system 501 of the surgical robot can be determined. When the medical device at the end of the drive arm is inserted into the patient's body through the puncture device, the distal fixed point of the puncture device coincides with the patient's opening position. Without considering the patient's breathing, the patient will remain relatively stationary after being strapped to the operating table. Based on the coordinate system transformation relationships 510, 520, 540, 550, 560, and 580, the transformation relationship 570 between the distal fixed point coordinate system 505 and the operating table coordinate system 508, as well as the transformation relationship 590 between the distal fixed point coordinate system 505 and the operating table reference coordinate system 506, can be determined. On this basis, the position information of the patient's body opening position point in the operating table coordinate system 508 and the posture information of the puncture device in the operating table coordinate system 508 can be determined. That is, the positional registration between the puncture device and the operating table reference coordinate system 506 is completed at the patient's body opening position.

[0066] Generally, when adjusting the operating table without releasing the docking relationship between the surgical robot and the patient, only the force acting on the puncture device during the movement of the operating table can be used to control the driving arm to perform a following movement, and at the same time, motion compensation is superimposed to improve the tracking accuracy of the posture. Since the movement of the driving arm is passive, rather than directly transmitting accurate movement instructions to the joints of the driving arm of the surgical robot for active control, and using the interaction force between the puncture device and the patient's body wall as the original driving force, it is impossible to evaluate the degree of influence of uncertain factors such as friction, and there is also a risk of instability. In this regard, the present application can complete the pose registration between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table at the body opening position of the patient by determining the pose registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table, thereby facilitating the realization of the linkage control between the surgical robot and the operating table.

[0067] Next, the registration method of the surgical robot and the operating table in this embodiment will be introduced. The registration method of the surgical robot and the operating table in this embodiment can be applied to Figure 1 and Figure 2 the surgical robots involved in, and can also be applied to other types of surgical robots, such as single-port surgical robots.

[0068] Such as Figure 4 shown, the registration method of the surgical robot and the operating table in an embodiment includes:

[0069] Step S1, obtaining the scan data of the scan ranging device. The scan data includes the first vertical distance and the second vertical distance between the surgical robot and the operating table, the distance between the scan ranging device and the positioning mark, and the scan angle of the scan ranging device;

[0070] Step S, according to the scan data, the position coordinates of the scan ranging device, and the position coordinates of the positioning mark, determining the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table. The registration information includes attitude registration information and / or position registration information.

[0071] Among them, one of the surgical robot and the operating table is provided with a scan ranging device, and the other of the surgical robot and the operating table is provided with a positioning mark within the scan range of the scan ranging device. Considering that the length of the base of the operating table is usually relatively longer than the length of the base of the surgical robot, the scan ranging device is set on the base of the surgical robot, which can better ensure that the detection targets (operating table and positioning mark) are within the detection range. In addition, as a calculation basis, the horizontal plane where the first horizontal axis and the second horizontal axis of the reference coordinate system of the surgical robot are located, the horizontal plane where the first horizontal axis and the second horizontal axis of the reference coordinate system of the operating table are located, and the horizontal plane where the scan direction of the scan ranging device is located are parallel or coincident with each other.

[0072] The first and second vertical distances between the surgical robot and the operating table include the minimum distance obtained by the scanning distance sensor and / or the distance obtained by the scanning distance sensor from a horizontal direction perpendicular to the installation position. In practical applications, the required first and second vertical distances are selected based on the installation method of the scanning distance sensor and the model used to calculate the registration information. The scanning angle of the scanning distance device includes the scanning angle when the scanning distance device scans the positioning mark. Based on the scanning data and the position coordinates of the scanning distance device, the rotation angle between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table can be determined as the posture registration information. Based on the scanning data, the position coordinates of the scanning distance device, and the position coordinates of the positioning mark, the position of the positioning mark in the reference coordinate system of the surgical robot can be determined. Then, combined with the position of the positioning mark in the reference coordinate system of the operating table, the positional relationship between the reference coordinate systems of the surgical robot and the operating table can be obtained as the position registration information. Thus, based on the rotation angle and positional relationship between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table, the pose registration information is obtained.

[0073] Furthermore, combined Figure 3 The kinematic model relationships shown, based on the registration information between the surgical robot's reference coordinate system and the operating table's reference coordinate system, and the pose information of the puncture device in the surgical robot's reference coordinate system, can determine the attitude registration information and / or position registration information between the puncture device and the operating table's reference coordinate system, or the attitude registration information and / or position registration information between the operating table's surface and the surgical robot's reference coordinate system. This fulfills the prerequisite for actively controlling the surgical robot's drive arm to adjust the position and pose of the puncture device when its position and pose change on the operating table's surface.

[0074] The following combination Figure 5-7 The two scanning range sensors shown illustrate the process of acquiring attitude registration information and position registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0075] (1) Obtain the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0076] Specifically, based on the scanning data, the position coordinates of the scanning ranging device, and the position coordinates of the positioning markers, the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table is determined. This includes: determining the relative rotation angle between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table based on the first vertical distance and the second vertical distance between the surgical robot and the operating table, so as to obtain the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0077] like Figure 5 As shown, the scanning ranging device includes a first scanning ranging sensor 303 and a second scanning ranging sensor 306, which are spaced apart on a horizontal plane. The first scanning ranging sensor 303 is mounted on a first fixed turntable 302, which is connected to a first servo motor 304. The second scanning ranging sensor 306 is mounted on a second fixed turntable 305, which is connected to a second servo motor 307. The first servo motor 304 and the second servo motor 307 are mounted on a motor mounting bracket 301. This structure is installed on a surgical robot or an operating table. During installation, the first servo motor 304 and the second servo motor 307 are initially set such that the two light beams emitted by the first scanning ranging sensor 303 and the second scanning ranging sensor 306 are parallel to each other. The first scanning ranging sensor 303 and the second scanning ranging sensor 306 can be laser ranging sensors. The positioning mark 313 is located at the junction of two planes 311 and 312 on the mounting side 310. The mounting side 310 can be the side of a surgical robot or an operating table. The two planes 311 and 312 are parallel to each other and have a height difference at the junction, for example, 0.1 mm, thus forming the positioning mark 313. The extension direction of the positioning mark 313 is perpendicular to the horizontal plane. When the first servo motor 304 and the second servo motor 307 drive the first fixed turntable 302 and the second fixed turntable 305 to perform rotational motion under program control, the laser 308 emitted by the first scanning distance sensor 303 and the laser 309 emitted by the second scanning distance sensor 306 illuminate the mounting side 310 where the positioning mark 313 is located, thereby obtaining scanning data. The scanning data includes the first vertical distance and the second vertical distance between the surgical robot and the operating table, the distance between the scanning distance device and the positioning mark, and the scanning angle of the scanning distance device.

[0078] like Figure 6 As shown, the reference coordinate system of the surgical robot is established at the center of the base 401, so that the reference coordinate system of the surgical robot has a two-dimensional coordinate system 402 (O) parallel to the ground. robot -X robot Y robotThe reference coordinate system of the operating table is established at the center of the base 403, so that the reference coordinate system of the operating table has a two-dimensional coordinate system 404 parallel to the ground (O). bed -X bed Y bed Without considering ground unevenness, the Z-axis of the surgical robot's reference coordinate system is... robot Z-axis of the reference coordinate system of the operating table bed Parallel to each other and perpendicular to the ground, the relative pose between the surgical robot and the operating table is not fixed, making the coordinate system O... robot -X robot Y robot Z robot With O bed -X bed Y bed Z bed There exists an angle θz around the Z-axis, which is the unknown variable used for attitude positioning between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table. The first scanning ranging sensor 303 and the second scanning ranging sensor 306 are spaced apart on the base 401 of the surgical robot. The initial directions of the first scanning ranging sensor 303 and the second scanning ranging sensor 306 are perpendicular to the emission direction of their installation positions. This initial direction is located on a horizontal plane and perpendicular to the first horizontal coordinate axis (e.g., X) of the surgical robot's reference coordinate system. robot (axis) or second horizontal coordinate axis (e.g., Y) robot axis), Figure 6 China and Israel Y robot The axis is parallel to or coincides with the major axis of the surgical robot base, and the initial directions of the first scanning ranging sensor 303 and the second scanning ranging sensor 306 are perpendicular to the Y-axis. robot The axis is illustrated.

[0079] based on Figure 6 As shown, the first vertical distance in the scan data is the distance b obtained by the first scanning ranging sensor 303 scanning from a horizontal direction perpendicular to the installation position, and the second vertical distance is the distance c obtained by the second scanning ranging sensor 306 scanning from a horizontal direction perpendicular to the installation position. The line connecting the first scanning ranging sensor 303 and the second scanning ranging sensor 306 is parallel to the Y-axis. robot Let a be the distance between the first scanning ranging sensor 303 and the second scanning ranging sensor 306. Based on the trigonometric function theorem, the coordinate system O can be calculated using the following formula. robot -X robot Y robot Z robot With O bed -X bed Y bed Z bedThe angle θz between them around the Z-axis:

[0080]

[0081] In another embodiment, when the scanning distance measuring device includes a first scanning distance measuring sensor 303 and a second scanning distance measuring sensor 306, the first vertical distance can also be the minimum distance scanned by the first scanning distance measuring sensor 303, that is, the length of the perpendicular line drawn from the first scanning distance measuring sensor 303 to the side of the operating table. The second vertical distance can also be the minimum distance scanned by the second scanning distance measuring sensor 306, that is, the length of the perpendicular line drawn from the second scanning distance measuring sensor 306 to the side of the operating table. The principle of calculating the included angle θz based on these two minimum distances is the same as that of formula (1), and will not be repeated here.

[0082] Please refer to Figure 7 When the scanning ranging device includes a scanning ranging sensor 303, the first vertical distance is the minimum distance b obtained by the scanning ranging sensor, and the second vertical distance is the distance a obtained by the scanning ranging sensor 303 from a horizontal direction perpendicular to the installation position. According to the trigonometric function theorem, the coordinate system O can be calculated using the following formula. robot -X robot Y robot Z robot With O bed -X bed Y bed Z bed The angle θz between them around the Z-axis:

[0083]

[0084] The angle θz obtained above is the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table. Therefore, based on the above formula, accurate attitude positioning between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table can be achieved. The positioning accuracy depends on the measurement accuracy of the scanning range sensor. The realization of this positioning is the technical foundation and prerequisite for the linkage between the surgical robot and the operating table.

[0085] (2) Obtain the position registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0086] When the scanning rangefinder is installed on the surgical robot, the registration information between the surgical robot's reference coordinate system and the operating table's reference coordinate system is determined based on the scanning data, the position coordinates of the scanning rangefinder, and the position coordinates of the positioning markers. This includes:

[0087] Obtain the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table;

[0088] The position coordinates of the positioning mark in the reference coordinate system of the surgical robot are determined based on the distance between the scanning ranging device and the positioning mark, the scanning angle of the scanning ranging device to the positioning mark, and the position coordinates of the scanning ranging device in the reference coordinate system of the surgical robot.

[0089] Based on the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table, the position coordinates of the positioning mark in the reference coordinate system of the surgical robot, and the position coordinates of the positioning mark in the reference coordinate system of the operating table, the position coordinates of the origin of the reference coordinate system of the operating table in the reference coordinate system of the surgical robot are determined, so as to obtain the position registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0090] The distance between the scanning ranging device and the positioning mark, as well as the scanning angle of the scanning ranging device, in the scan data are obtained using the following methods:

[0091] Obtain the target scanning range;

[0092] The scanning and ranging device is controlled to rotate and reciprocate within the target scanning range;

[0093] Determine whether a location marker has been detected;

[0094] If so, obtain the target scan data corresponding to the location marker when it is scanned. The target scan data includes the target distance.

[0095] Determine whether the conditions for stopping the scan are met;

[0096] If the conditions for stopping scanning are not met, the target scanning range is narrowed to become the updated target scanning range, and the process returns to the step of controlling the scanning ranging device to rotate and reciprocate scanning within the target scanning range.

[0097] If the conditions for stopping scanning are met, the distance between the scanning ranging device and the positioning mark is determined based on the acquired target scanning data, and the scanning angle corresponding to the distance is obtained as the scanning angle of the scanning ranging device.

[0098] The conditions for stopping the scan include at least one of the following:

[0099] The number of times the location marker has been detected has reached the preset number;

[0100] The difference in target distance between the two most recent scans is less than or equal to a preset difference.

[0101] The target scanning range is reduced to a constant value;

[0102] The target scanning range is scanned to find a unique distance value.

[0103] The scanning ranging device performs a reciprocating scanning motion under the drive of the driving device. During the scanning process, as positioning marks are continuously detected, the scanning range will continuously shrink. During this process, the target distance when the positioning mark is scanned each time is recorded, and the target scanning angle corresponding to the target distance can also be recorded. If the number of scans reaches more than two, and the difference between the target distances in the two most recent scan data is less than or equal to a preset difference, the scanning can be stopped. The distance between the scanning ranging device and the positioning mark is determined based on the target distances in the two most recent scan data. For example, the average value can be taken, or the most recent target distance can be taken. Then, the scanning angle corresponding to the most recent target distance can be obtained as the scanning angle of the scanning ranging device when it scans the positioning mark. In another embodiment, scanning can be stopped when the scanning range gradually shrinks to a constant value. At this point, the scanning ranging device is aligned with the positioning mark. Alternatively, the scanning range can be aligned with the positioning mark if the data scanned contains only a single distance value. In this case, the target distance in the last scan data is used as the distance between the scanning ranging device and the positioning mark. Simultaneously, after stopping, the scanning ranging device can obtain the angle between itself and the emitted detection light through encoder data acquisition and calculation; that is, the scanning angle at which the scanning ranging device scanned the positioning mark. Thus, by setting conditions for stopping scanning, higher accuracy in distance and scanning angle can be obtained, improving ranging efficiency.

[0104] like Figure 5 and Figure 6 As shown, when the scanning ranging device includes a first scanning ranging sensor 303 and a second scanning ranging sensor 306, the distance d between the first scanning ranging sensor 303 and the positioning mark 313, and the distance e between the second scanning ranging sensor 306 and the positioning mark 313 are obtained in the manner described above. In this case, the scanning angle at which the scanning ranging device scans the positioning mark includes the scanning angle θ1 of the first scanning ranging sensor 303 corresponding to distance d and the scanning angle θ2 of the second scanning ranging sensor 306 corresponding to distance e. Figure 7 As shown, when the scanning ranging device includes a scanning ranging sensor, the distance c between the scanning ranging sensor 303 and the positioning mark 313 can also be obtained in the above manner. In this case, the scanning angle of the scanning ranging device scanning the positioning mark includes the scanning angle θ1 of the scanning ranging sensor 303 corresponding to the distance c.

[0105] Please refer to Figure 6 Let the first scanning ranging sensor 303 and the second scanning ranging sensor 306 be located in coordinate system O. robot -X robot Y robot The coordinates in the figure are (x) r1 yr1 ) and (x r2 y r2 The positioning mark 313 is simplified to a point in the top view and its coordinate system O is known. bed -X bed Y bed The coordinates in (x) b1 According to the trigonometric function theorem, the position coordinates of the positioning mark 313 in the reference coordinate system of the surgical robot can be calculated, that is, the position coordinates of the positioning mark 313 in coordinate system O. robot -X robot Y robot coordinates (x) rb1 y rb1 ), represented as:

[0106]

[0107] Based on the above formulas (1) and (3), the origin O of the reference coordinate system of the operating table can be calculated. bed Position coordinates (x, y) in the reference coordinate system of the surgical robot ro1 y ro1 ), represented as:

[0108]

[0109] Thus, the positional registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table is obtained.

[0110] Or, such as Figure 7 As shown, the scanning ranging sensor 303 is in coordinate system O robot -X robot Y robot The coordinates are (x r1 y r1 Based on the trigonometric function theorem, the position coordinates of the positioning mark in the reference coordinate system of the surgical robot can be calculated, that is, the position coordinates of the positioning mark 313 in coordinate system O. robot -X robot Y robot coordinates (x) rb1 y rb1 ), represented as:

[0111]

[0112] Thus, the positional registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table is obtained.

[0113] Through the above process, formulas (1) and (4) can be used to determine the pose registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table. Formulas (2) and (5) can also be used to determine the pose registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

[0114] It is worth mentioning that after completing the above-mentioned position registration process, the drive arm can be actively controlled to adjust the posture of the puncture device based on the movement of the current operating table surface, or the drive arm can be actively controlled to adjust the position and posture of the puncture device, so as to adjust the operating table without severing the connection between the surgical robot and the patient, thereby improving operational efficiency and safety.

[0115] This application discloses a registration method for a surgical robot and an operating table. A scanning rangefinder and a positioning marker are respectively installed on the surgical robot and the operating table. The method includes: acquiring scanning data from the scanning rangefinder, including a first vertical distance and a second vertical distance between the surgical robot and the operating table, the distance between the scanning rangefinder and the positioning marker, and the scanning angle of the scanning rangefinder; and determining registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table based on the scanning data, the position coordinates of the scanning rangefinder, and the position coordinates of the positioning marker. The registration information includes posture registration information and / or position registration information. By setting up a scanning rangefinder and a positioning marker within the scanning range of the scanning rangefinder, this application can determine the posture and / or position registration information between the surgical robot and the operating table based on the scanning data from the scanning rangefinder, providing a basis for the control of the surgical robot.

[0116] The registration method of this application also has the following beneficial effects:

[0117] ① It can realize the position and positioning function between the surgical robot and the electric operating table. Based on this, by applying robot kinematic modeling, it can realize the position and positioning registration between the reference coordinate system of the puncture device and the operating table and the motion registration of each joint. Finally, it can realize the linkage technology between the surgical robot and the operating table. During the linkage process, it eliminates the tedious and repetitive docking operations such as removing the puncture device and / or surgical tools (such as surgical instruments and imaging instruments) from the patient's body, disassembling and installing surgical tools at the end of the surgical robot, and de-contacting the surgical robot and the operating table. This reduces the workload of medical and nursing assistants, improves the intelligence level of the surgical robot system, shortens the operation time, and improves the smoothness of the operation.

[0118] ② When using external sensors, a scanning and ranging device and positioning markers for pose localization were designed, which can achieve complete positioning of the position and attitude between the surgical robot and the operating table. This enables active control of each joint and eliminates uncertainties such as motion estimation, making the linkage technology between the surgical robot and the operating table more reliable and safer in practical applications.

[0119] This application also provides a registration device for a surgical robot and an operating table, such as... Figure 8 As shown, the registration device includes a processor 601, a communications interface 602, a memory 603, and a communications bus 604.

[0120] The processor 601, communication interface 602, and memory 603 communicate with each other via communication bus 604.

[0121] The communication interface 602 is used to communicate with other network elements such as various sensors, motors, solenoid valves, or other clients or servers.

[0122] The processor 601 is used to execute program 605, which can specifically perform the relevant steps in the above method embodiments.

[0123] Specifically, program 605 may include program code that includes computer operation instructions.

[0124] The processor 605 may be a central processing unit (CPU), an application-specific integrated circuit (ASIC), one or more integrated circuits configured to implement embodiments of the present invention, or a graphics processing unit (GPU). The control device includes one or more processors, which may be processors of the same type, such as one or more CPUs or one or more GPUs; or they may be processors of different types, such as one or more CPUs and one or more GPUs.

[0125] Memory 603 is used to store program 605. Memory 603 may include high-speed RAM memory, and may also include non-volatile memory, such as at least one disk storage device.

[0126] Specifically, program 605 can be used by processor 601 to load and execute steps to implement the registration method between the surgical robot and the operating table as described in the above embodiments.

[0127] This application also provides a surgical robot, which is equipped with a scanning and ranging device for scanning positioning marks set on the operating table. The horizontal planes containing the first and second horizontal coordinate axes of the surgical robot's reference coordinate system, the horizontal planes containing the first and second horizontal coordinate axes of the operating table's reference coordinate system, and the horizontal plane containing the scanning direction of the scanning and ranging device are parallel or coincident with each other.

[0128] The surgical robot also includes a control device for performing steps of the registration method between the surgical robot and the operating table as described in the above embodiments.

[0129] This application also provides a surgical system, including an operating table and a surgical robot as described in the above embodiment, wherein the surgical robot is communicatively connected to the operating table, and the table surface of the operating table can be adjusted in one or more degrees of freedom.

[0130] This application also provides a computer-readable storage medium storing a computer program that, when executed by a processor, implements the steps of the registration method between the surgical robot and the operating table as described in the above embodiments.

[0131] After completing the above-mentioned position registration process, the drive arm can be actively controlled to adjust the posture of the puncture device based on the movement of the current operating table surface, or the drive arm can be actively controlled to adjust the position and posture of the puncture device, so as to adjust the operating table without severing the connection between the surgical robot and the patient, thereby improving operational efficiency and safety.

[0132] The following describes the process of linking the surgical robot and the operating table based on pose registration information. This process involves actively controlling the drive arm to adjust the position and orientation of the puncture device. One embodiment of the surgical robot control method includes:

[0133] Obtain the pose registration information between the surgical robot and the operating table;

[0134] Based on the pose registration information, determine the first pose of the puncture device in the reference coordinate system of the operating table;

[0135] In response to the movement of the operating table surface, the amount of movement of the table surface is acquired. Based on the pose registration information, the amount of movement, and the first pose, the second pose of the puncture device in the reference coordinate system of the surgical robot is determined.

[0136] Determine the target joint quantity of each joint in the surgical robot's drive arm based on the second pose.

[0137] The movement of each joint in the drive arm is controlled according to the target joint size to maintain the position of the puncture device relative to the operating table surface.

[0138] The linkage between the operating table and the surgical robot can begin after obtaining the pose registration information between them. Assuming the linkage process includes both the initial and subsequent moments, the first pose reflects the initial pose of the puncture device relative to the operating table (e.g., the worktable). Subsequently, once the worktable moves, the second pose (target pose) of the puncture device in the surgical robot's reference coordinate system is determined based on the first pose, the pose registration relationship, and the amount of movement of the worktable. The joint movements in the surgical robot are then controlled according to the second pose to maintain the poses of the puncture device and the worktable.

[0139] When the operating table moves, information such as the direction and magnitude of motion is transmitted to the surgical robot in real time via wired or wireless means for joint motion calculation. To ensure the puncture device remains relatively stationary relative to the patient's opening, the inverse kinematics model is applied based on the pose registration information between the puncture device and the operating table's reference coordinate system to calculate the corresponding joint quantities of each joint in the surgical robot's drive arm, including the direction and magnitude of motion, thus completing the joint motion registration. Next, the surgical robot controls the motion of each joint based on these joint quantities to maintain the puncture device's relative stationary position relative to the patient's opening. This achieves simultaneous and synchronous joint motion between the surgical robot and the operating table in the current degree of freedom, realizing the linkage technology between the surgical robot and the operating table.

[0140] The following describes the process of linking the surgical robot and the operating table based on posture registration information. This process involves actively controlling the drive arm to adjust the posture of the puncture device. One embodiment of the surgical robot control method includes:

[0141] Obtain the attitude registration information between the surgical robot and the operating table;

[0142] In response to the movement of the operating table surface in the degrees of freedom of posture, the motion information of the operating table surface in the degrees of freedom of posture is acquired;

[0143] Based on motion information and posture registration information, the target joint value of the first joint among multiple joints is determined, and the motion of the first joint is controlled according to the target joint value to maintain the posture of the puncture device relative to the operating table surface in the degree of posture freedom.

[0144] Using the above method, based on the posture registration information between the surgical robot and the operating table, the drive arm can be actively controlled to adjust the posture of the puncture device while the robot is moving freely on the operating table. This allows the operating table to be adjusted without disengaging the surgical robot from the patient, thus improving operational efficiency and safety.

[0145] After acquiring the posture registration information between the surgical robot and the operating table, in response to the movement of the operating table surface in the degree of posture freedom, the motion information of the operating table surface in the degree of posture freedom is acquired. Then, based on the motion information of the operating table surface in the degree of posture freedom and the posture registration information, the target joint amount of the first joint among the multiple joints of the drive arm can be determined. The movement of the first joint is controlled according to the target joint amount to maintain the posture of the puncture device relative to the operating table surface in the degree of posture freedom.

[0146] In this context, the degree of freedom of posture refers to the tilting motion of the operating table surface around an axis parallel to its length or around an axis perpendicular to its length. During this posture freedom movement on the operating table surface, the patient's body opening (distal fixed point) shifts position, thus requiring the puncture device to also change its posture (including position and orientation). The motion information of the operating table surface in the degree of freedom of posture includes the direction and angle of rotation. This motion information is transmitted to the surgical robot as the target motion direction and angle of the puncture device around the distal fixed point, thereby determining the target joint quantity of the first joint among the multiple joints of the drive arm. The first joint can be one or more joints. Figure 2 Taking the tilting motion B4 shown as an example, based on the motion information of the operating table surface, the unique inverse solution is obtained by inversely solving the rotational joints J10 and J11 in the manipulator 270 based on the kinematic model of the surgical robot, and then the puncture device 229 is controlled to perform the same rotational motion as the operating table surface around the telecentric fixed point 220.

[0147] During the adjustment of the operating table's posture, the table surface may also change position, including translation and lifting. Since the adjustment of the puncture device is related to the adjustment of the operating table's posture, the puncture device may also translate and lift as the position of the distal fixed point changes during the posture adjustment process. Therefore, the method of this embodiment further includes:

[0148] In response to the movement of the operating table surface in the degrees of freedom of posture, a target joint among multiple joints is controlled to adjust the position of the body opening, thereby allowing the drive arm to track the position of the body opening based on the force exerted by the body wall at the patient's body opening.

[0149] The translation and elevation caused by the puncture device when adjusting its posture are passively performed based on the force applied by the body wall at the patient's body opening.

[0150] Specifically, the positional degrees of freedom include lifting degrees of freedom, controlling a target joint among multiple joints associated with the adjustment of positional degrees of freedom, to allow the drive arm to track the position of the body opening based on the force exerted by the body wall at the patient's body opening, including:

[0151] In response to the movement of the operating table surface in the degree of postural freedom, the second joint in the target joint is controlled to be in a zero-force state. The second joint includes a joint with a degree of vertical freedom to allow the drive arm to track the movement of the body opening in the degree of vertical freedom based on the force exerted by the body wall of the patient's body opening.

[0152] Specifically, the positional degrees of freedom include translational degrees of freedom, controlling a target joint among multiple joints associated with the adjustment of positional degrees of freedom, to allow the drive arm to track the position of the body opening based on the force exerted by the body wall at the patient's body opening, including:

[0153] In response to the movement of the operating table surface in the degrees of postural freedom, the third joint in the target joint is controlled to be in a zero-force state. The third joint includes a joint with translational degrees of freedom to allow the drive arm to track the movement of the body opening in the translational degrees of freedom based on the force exerted by the body wall of the patient's body opening.

[0154] In response to the movement of the third joint, the movement of the fourth joint in the target joint is controlled to compensate for changes in the posture of the puncture device caused by the movement of the body opening in the translational degree of freedom.

[0155] In one embodiment, controlling the movement of the fourth joint in the target joint includes:

[0156] Obtain motion information of the first rotary joint in the third joint, and generate motion information of the second rotary joint in the fourth joint based on the motion information of the third joint. The motion information of the first rotary joint includes motion amount and motion direction, and the motion information of the second rotary joint includes a motion direction opposite to the motion direction of the first rotary joint and a motion amount of the same magnitude as the motion amount of the first rotary joint.

[0157] The movement of the second rotational joint is controlled based on the motion information of the second rotational joint.

[0158] In some embodiments, controlling a corresponding joint in the target joint, such as a second and / or third joint, to be in a zero-force state is, exemplary, necessary to control that corresponding joint to substantially compensate for (or balance) the gravity of its distal load and / or overcome the frictional forces of its own joint, so as to easily track the position of the body opening based on the force exerted by the body wall at the patient's body opening. Of course, this principle also applies to controlling the corresponding joint of the target joint to be in a zero-force state as described below.

[0159] In some embodiments, controlling the corresponding joint in the target joint to be in a zero-force state may include:

[0160] Obtain the joint position of at least the corresponding joint and the joint distal to it, and determine the compensation torque corresponding to the output of the corresponding joint by combining the joint position and the dynamic model associated with the corresponding joint; then, control the output of the compensation torque of the corresponding joint.

[0161] The joints of the drive arm typically include position sensors for detecting their joint position, such as encoders. The joints also typically include drive mechanisms, such as motors, to control the corresponding joints to a zero-force state, for example, by controlling the associated motor to output compensating torque.

[0162] The dynamic model required for this application is typically constructed for the corresponding joint; for example, the dynamic model constructed for different corresponding joints is usually different. Generally, the dynamic model is associated with the corresponding joint and the joint distal to it.

[0163] For example, the dynamic model for the corresponding joint can be constructed as follows:

[0164] Obtain the link parameters of the corresponding joint and its distal joint, and establish a link coordinate system based on these link parameters. A joint includes the joint itself and the link connected to it. Link parameters (i.e., DH parameters) include joint angles and / or joint displacements, link lengths, and other parameters.

[0165] Based on the link coordinate system, a first dynamic model associated with the corresponding joint is constructed. This first dynamic model is typically represented in symbolic form (i.e., a formula with unknown parameters), and is a fuzzy dynamic model (i.e., the dynamic parameters are temporarily uncertain). For example, this first dynamic model is expressed as the following formula:

[0166]

[0167] Where τ is the actual torque of the joint, and θ is the joint position. It is the speed of the joint ( (It is the first derivative of θ) It is the speed of the joint ( M(θ) is the second derivative of θ, and M(θ) is the inertia matrix. It includes Coriolis force and centrifugal force, and G(θ) is the gravitational torque of the joint.

[0168] Determine the unknown dynamic parameters in the first dynamic model. The first dynamic model typically includes at least one unknown dynamic parameter. Generally, all unknown dynamic parameters involved in formula (6) can be determined to obtain an accurate second dynamic model. In one embodiment, the contribution of some unknown dynamic parameters to the joint torque can be ignored depending on the actual situation. For example, the mass, center of mass, and frictional torque of the joint can be the main focus. In some embodiments, the mass, center of mass, and frictional torque of the joint may be affected by the drive mechanism that drives the joint and / or the transmission mechanism that connects the drive mechanism and the joint to achieve transmission. For example, when the structure of the drive arm is relatively regular, at least some of the dynamic parameters such as the mass, center of mass, and frictional torque of the joint can be obtained directly without identification. Of course, at least some of the dynamic parameters such as the mass, center of mass, and frictional torque of the joint can also be obtained by identification methods. For example, the mass of the joint can be obtained by weighing, and the center of mass and frictional torque of the joint can be obtained by identification methods. For example, it is assumed that M(θ) and... The contribution to the joint torque is acceptable in one example of the invention, and therefore, equation (6) can be simplified as follows:

[0169] τ=G(θ) Formula (7)

[0170] The determined dynamic parameters are substituted into the first dynamic model to obtain the second dynamic model. This second dynamic model is a well-defined dynamic model (i.e., one with determined dynamic parameters). Furthermore, when determining the expected compensation torque of the drive mechanism corresponding to the respective joint by combining these joint positions and the dynamic models associated with those joints, the dynamic model used refers to this second dynamic model.

[0171] In some embodiments, considering the adverse effects of frictional torque, the frictional torque can be excluded from the actual torque of the joint. Specifically:

[0172] Based on the principle of dynamic equilibrium, a torque balance model for the joint can be constructed, which can be expressed by the following formula:

[0173]

[0174] Where τ is the actual torque of the joint, and θ is the joint position. Here, k1 and k2 are the gravitational torque parameters, and f is the frictional torque of the joint. Indicates the direction of velocity.

[0175] Furthermore, the frictional torque of a joint can be determined through identification methods. For example, a single joint can be controlled to move at a low, uniform speed, traversing the entire range of motion, collecting the actual torque of the joint and the corresponding joint position. This single joint refers to the joint corresponding to the given joint. During uniform motion, the frictional torque is approximately constant and is generally considered a fixed value. Therefore, based on the collected actual torque and corresponding joint position, and using methods such as least squares, the frictional torque of the joint can be identified. Understandably, the actual torque of a joint is output by the drive mechanism that drives its movement.

[0176] Furthermore, when determining the unknown dynamic parameters (e.g., the gravitational torque in formula (7)) in the first dynamic model through identification methods, each joint can be controlled to move at a low speed in a uniform manner, traversing the entire range of motion, collecting the actual torque of the corresponding joint, as well as the joint position corresponding to the corresponding joint and its distal joint, combining the actual torque of the corresponding joint, the frictional torque of the corresponding joint, and the joint position corresponding to the corresponding joint and its distal joint, and using methods such as least squares, the unknown dynamic parameters (e.g., the gravitational torque in formula (7)) of the joint can be identified. For example, in formula (7), the identified unknown dynamic parameters are mainly the gravitational torque parameters (including mass and center of mass, etc.), thus, a second dynamic model that relates the joint position of the corresponding joint and its distal joint to the compensation torque of the corresponding joint can be effectively constructed.

[0177] by Figure 2 Taking the tilting motion B4 shown as an example, a unique inverse solution is obtained by inversely solving the rotation joints J10 and J11 in the manipulator 270 based on the kinematic model of the surgical robot. This allows the puncture device to perform the same rotational motion around the distal fixed point as the operating table surface, while simultaneously adjusting each joint of the manipulator 270 to a non-motion-locked state. Specifically, by controlling joint J5 to perform a motion of the same magnitude but opposite direction to J8, motion compensation is provided for the passive change in the posture of the puncture device caused by the rotational motion of the manipulator 270. Ultimately, this ensures that the posture of the puncture device remains unchanged relative to the table surface during the linkage of posture degrees of freedom. Furthermore, joints J6, J7, and J8 of the manipulator 270 are in a zero-force drag mode (i.e., a zero-force state), allowing the manipulator 270 to drag the distal fixed point of the puncture device in the two-dimensional plane using the interaction force at the abdominal wall during the movement of the operating table surface.

[0178] It should be noted that during the execution of tilting motion B3, all joints of the robotic arm 250 are in a motion-locked state. The linkage between the adjusting arm 260 and the manipulating arm 270 is the same as that of the execution of tilting motion B4. The difference is that the rotation axes of tilting motion B3 and tilting motion B4 are perpendicular to each other. Since the table motion rotation matrices around different axes are different, the rotation matrices involving table motion in the kinematic model used when performing linkage calculations can be adjusted accordingly, so that the posture of the puncture state remains unchanged relative to the operating table during the linkage of executing tilting motion B3.

[0179] Furthermore, when not performing positional freedom movements, the operating table surface can also independently perform vertical movement. The method in this embodiment further includes: in response to the vertical movement of the operating table surface, acquiring motion information of the operating table surface in the vertical degree of freedom; determining a target joint amount for driving the fifth joint of the drive arm based on the motion information of the operating table surface in the vertical degree of freedom; and controlling the movement of the fifth joint according to the target joint amount to maintain the position of the puncture device relative to the operating table surface in the vertical degree of freedom. The motion information of the operating table surface in the vertical degree of freedom includes the direction of movement and the amount of movement. Figure 2 Taking the lifting motion B2 shown as an example, the fifth joint used to drive the drive arm can be the lifting column 204 of the robotic arm 250, thereby driving the drive arm to lift as a whole without adjusting the joints with lifting degrees of freedom in the drive arm. This avoids the joints with lifting degrees of freedom in the drive arm moving to their limit positions and affecting subsequent movements. During the movement, all other joints of the robotic arm 250 except for the lifting column 204, as well as all joints of the drive arm (adjusting arm 260 and manipulating arm 270), are in a motion-locked state, so that the posture of the puncture device 229 remains stationary relative to the patient site. In some embodiments, the fifth joint used to drive the drive arm can also be the moving vertical arm 211 of the adjusting arm 260 that performs the up-and-down lifting motion J7. In some embodiments, the fifth joint used to drive the drive arm can also be a combination of the lifting column 204 and the moving vertical arm 211.

[0180] When not performing posterior-degree-of-freedom movements, the operating table surface can also independently perform translational-degree-of-freedom movements. The method in this embodiment further includes: in response to the translational-degree-of-freedom movement of the operating table surface, controlling the sixth joint in the target joint to a zero-force state, the sixth joint including a joint with translational-degree-of-freedom movements to allow the drive arm to track the translational-degree-of-freedom movement of the body opening based on the force applied by the body wall of the patient's body opening; in response to the movement of the sixth joint, controlling the movement of the seventh joint in the target joint to compensate for changes in the posture of the puncture device caused by tracking the translational-degree-of-freedom movement of the body opening. Controlling the movement of the seventh joint in the target joint includes: acquiring motion information of the third rotational joint in the sixth joint; generating motion information of the fourth rotational joint in the seventh joint based on the motion information of the third rotational joint in the sixth joint, the motion information of the third rotational joint in the sixth joint including the amount and direction of motion; the motion information of the fourth rotational joint in the seventh joint including a direction of motion opposite to the direction of motion of the third rotational joint in the sixth joint, and an amount of motion equal to the magnitude of the amount of motion of the third rotational joint in the sixth joint; controlling the movement of the fourth rotational joint in the seventh joint according to the motion information of the fourth rotational joint in the seventh joint. Figure 2 Taking the forward and backward translational motion B1 shown as an example, the joints of the robotic arm 250 and the manipulator arm 270 are in a motion-locked state, and the lifting motion J7 of the adjusting arm 260 is also in a motion-locked state, while the remaining motions J5, J6, and J8 of the adjusting arm 260 are in a zero-force drag mode. During the movement of the operating table, relying on the interaction force between the puncture device 229 and the body wall of the patient's body opening at the distal fixed point 220, the table will drag the manipulator arm 270 to drive the distal fixed point 220 to perform translational motion. Based on the kinematic model, the magnitudes of the motions J5 and J8 are equal and the directions are opposite, so that the posture of the puncture device 229 remains unchanged during the movement.

[0181] By employing the above method, during the simultaneous movement of the operating table and the surgical robot, the puncture device and / or medical instrument mounted on the end of the surgical robot can remain inserted into the patient's body without needing to remove the puncture device and / or medical instrument from the end of the surgical robot before the operating table moves, or without completely disconnecting the surgical robot from the operating table and dragging the robotic arm to free up space for the operating table. This control method eliminates the cumbersome operation of repeated docking between the surgical robot and the operating table, shortens the operation time, and improves the smoothness of the entire surgical procedure. Furthermore, active control of the degree of freedom of posture reduces friction against the patient's body wall, improving safety. Moreover, during the linkage between the surgical robot and the operating table, the surgeon at the main control console can observe and monitor in real time the movement of the patient's organs and the posture of the surgical instruments and imaging devices in the viewing window through images acquired by the imaging instruments. This allows the desired posture to be reached in the shortest possible time, ensuring the safety and smoothness of the execution process.

[0182] The process of adjusting the posture of the puncture device by actively controlling the drive arm, or adjusting the position and posture of the puncture device by actively controlling the drive arm, to achieve linkage between the surgical robot and the operating table, may also include the following processes.

[0183] During the linkage process, the control method of this application also includes:

[0184] Based on the motion control of the operating table surface within a preset degree of freedom, the imaging instrument acquires images during the process of driving the arm.

[0185] In response to the recognition that a target area in the image meets a third preset condition, a control command is sent to the operating table. The control command includes instructions for controlling at least one of the following: delayed adjustment, stop adjustment, and deceleration adjustment of the operating table; wherein,

[0186] The third preset condition must be met, including at least one of the following:

[0187] Identify the target surgical site or a marker associated with the target surgical site within the target area;

[0188] The target surgical site is in a preset position within the target area.

[0189] The preset degrees of freedom include at least one of translational, lifting, and posture degrees of freedom. The process of controlling the drive arm based on the motion of the operating table surface within these preset degrees of freedom is the process of the surgical robot and the operating table working together. The target area is a region pre-marked in the image display area, including areas the surgeon intends to focus on, such as the central area or any area desired for identification, or even the entire image display area. During the movement of the operating table surface, the target area remains in the image acquired by the imaging device and can be remarked under the surgeon's control. The target area can be marked before or during the linkage. Furthermore, before linkage, feature areas can be marked on the actual patient's anatomical structure, for example, using fluorescence, and then identified during linkage. When the target area in the image meets the criteria, the operating table can be controlled to delay, stop, or decelerate, allowing the surgeon to observe whether the desired surgical site has reached the desired position or posture. For delayed and deceleration adjustments, the doctor can trigger a stop adjustment command when confirming that the desired surgical site meets the requirements, or the operating table can resume its original linkage if no other command is received after a preset time.

[0190] In some embodiments, one of the third preset conditions, "identifying the target surgical site or a marker associated with the target surgical site in the target area," may include detecting that the proportion of the target surgical site falling into the target area of ​​the currently acquired image during the linkage process reaches a preset value for the target area. For example, the proportion of the target surgical site falling into the target area of ​​the currently acquired image reaches more than 70% of the target area; or the target surgical site falls completely into the target area of ​​the currently acquired image. It may also include detecting that the number of markers associated with the target surgical site falling into the target area of ​​the currently acquired image and / or the proportion of the number falling into the target area to the total number of markers reaches a preset value. For example, there are 10 markers associated with the target surgical site, of which 7 markers fall into the target area of ​​the currently acquired image; or all 10 markers fall into the target area of ​​the currently acquired image; or more than 6 markers fall into the target area of ​​the currently acquired image.

[0191] In some embodiments, one of the third preset conditions, "the target surgical site is in a preset posture within the target area," means that the target surgical site is identified within the target area of ​​the image, and the posture of the target surgical site within the target area meets the set recognition conditions, such as tilting to the left, tilting to the right, or opening, thereby providing a better surgical field of view. When the operating table moves, the target surgical site changes its posture relative to the imaging device according to the movement of the operating table, which is reflected in the image of the imaging device as a change in posture. By recognizing the image, it can be determined whether the target surgical site and its current posture meet the set recognition conditions. When the target surgical site is identified within the target area and the posture of the target surgical site in the image meets the set recognition conditions, it is considered that the target surgical site is in a preset posture within the target area.

[0192] During the linkage process, the control method of this application also includes:

[0193] During the motion control of the operating table surface in the preset degrees of freedom, the operating part of the surgical robot and the medical device mounted at the distal end of the driving arm are aligned in response to the change in orientation between them.

[0194] The change in orientation between the surgical robot's operating unit and the medical device mounted at the distal end of the drive arm can occur in two ways: either no orientation relationship was established before linkage but was established during linkage, or the orientation relationship changes as linkage progresses. For example, the operating unit includes a first operating unit and a second operating unit, and the medical device includes a first medical device and a second medical device. In the first case, if neither the first nor the second operating unit was mapped to the first or second medical device before linkage, but a mapping is established between the first operating unit and the first medical device during linkage, then an orientation relationship is established. In the second case, if the first operating unit was mapped to the first medical device before linkage, but is switched to be mapped to the second medical device during linkage, then the orientation relationship changes. In other words, a change in orientation usually stems from a change in the mapping relationship.

[0195] The process of aligning the orientation of the operating unit and the medical device can be as follows: First, obtain the first pose of the medical device mapped by the operating unit in the imaging device coordinate system. Then, convert the first pose into a second pose of the operating unit in the display coordinate system. Next, determine the target joint values ​​of the joints in the operating unit based on the second pose. Finally, drive the corresponding joints in the operating unit to move according to the target joint values, so that the pose of the operating unit matches the pose of the medical device, thus completing the orientation alignment between the operating unit and the medical device. Achieving orientation alignment of the operating unit with the pose of the associated medical device during the linkage process helps save surgical preparation time.

[0196] During the linkage process, the motion information of all joints of the surgical robot and the operating table is monitored, recorded, and stored in real time. For example, if another linkage instruction for a different degree of freedom is received after completing the linkage of one degree of freedom, the next linkage process is allowed to continue without the need for the moving joints to return to the initial starting position midway. In addition, the doctor's main console screen displays the current linkage status between the surgical robot and the electric operating table. If an abnormality occurs, the linkage process can be terminated in a timely manner according to the pre-written program instructions.

[0197] To ensure the smooth progress of the linkage process between the surgical robot and the operating table, the control method of this embodiment further includes:

[0198] Before controlling the drive arm based on the movement of the operating table surface in the preset degrees of freedom, it is judged whether the surgical robot and / or the operating table meet the second preset condition;

[0199] If the second preset condition is met, the drive arm is controlled according to the movement of the operating table surface in the preset degrees of freedom; where

[0200] Meeting the second preset condition includes at least one of the following:

[0201] The surgical robot is docked with the patient;

[0202] The base of the surgical robot and the base of the operating table are in a motion-locked state;

[0203] The main operation console of the surgical robot is in a state allowing entry into the surgical operation;

[0204] The communication connection between the surgical robot and the operating table is in a normal state;

[0205] The movable ranges of the joints in the drive arm are within the preset motion ranges.

[0206] Among them, the preset degrees of freedom include at least one of the attitude degree of freedom, translation degree of freedom, and height degree of freedom. The judgment process for whether the second preset condition is met can be as follows:

[0207] Regarding whether the base of the surgical robot and the base of the operating table are in a motion-locked state. Please refer to Figure 2 , the moving chassis 201 (i.e., the base) of the surgical robot and the wheeled chassis 227 (i.e., the base) of the operating table are in a motion-locked state to ensure that no movement occurs during the surgical process and the linkage process. Whether the base of the surgical robot and the base of the operating table are in a motion-locked state can be detected and determined by the locking sensor on the base, or after the medical assistant personnel perform the operation, the locking information can be input and confirmed on the operation interface on the operating table or the surgical robot;

[0208] Regarding whether the communication connection between the surgical robot and the operating table is normal: After establishing the communication connection between the surgical robot and the operating table, a communication detection program can be run on the operating table or the surgical robot. Based on the detection results, it can be determined whether the communication connection between the surgical robot and the operating table is normal, so as to monitor the working status and joint movement information of the surgical robot and the operating table.

[0209] Regarding the docking of the surgical robot with the patient: It is necessary to check the relative fixation devices between the patient and the operating table surface. The patient must be stably secured on the operating table surface to ensure that there is no significant slippage relative to the operating table surface after changes in position, which could hinder the linkage between the surgical robot and the operating table. When docking the surgical robot with the patient, medical assistants can adjust the robotic arm 250, adjusting arm 260, and manipulating arm 270 to perform the desired orientation and positioning according to the surgical procedure requirements. They can also operate the surgical instruments and imaging devices mounted on the distal end of the surgical robot's drive arm to be inserted into the patient's body. After completing the operation, confirmation of the docking information should be entered on the operating interface on the operating table or surgical robot.

[0210] Regarding whether the range of motion of each joint in the drive arm is within the preset range of motion. The preset range of motion includes the central region of the maximum range of motion of each joint in the drive arm. The preset range of motion includes at least one of angular range of motion and linear range of motion. For example, if the maximum angular range of motion is -90° to 90°, then the preset range of motion can be -45° to 45°. During the linkage process, the joints involved should be in the non-limit region of their respective range of motion. The ideal position is for the joint to be in the central region of its range of motion to avoid the undesirable phenomenon of forced termination of motion before the motion is completed because the joint has reached its limit position. Therefore, it is necessary to determine the range of motion of each joint before the linkage begins, for example, by detecting the current position and angle of the joint to determine whether the range of motion of the joint is within the preset range of motion.

[0211] Whether the main operating table of the surgical robot is in a state where it is permissible to enter into surgical operations can be determined by detecting whether the orientation between the operating part of the surgical robot and the medical device installed at the distal end of the drive arm is aligned, as well as other conditions that need to be met for operation. The main operating table of the surgical robot is then used to determine whether it is permissible to enter into surgical operations based on the detection results.

[0212] After completing preoperative equipment preparation, medical support personnel can trigger a command to enter the linkage mode on the operating table. Linkage mode refers to the surgical robot controlling the drive arm based on the motion of the operating table surface within preset degrees of freedom, ensuring that the position and orientation of the puncture device relative to the operating table surface remain constant. After triggering the command to enter linkage mode, the operating table controller sends a request to initiate linkage to the surgical robot's control system via wired or wireless means (such as infrared transmission). At this time, the surgical robot makes an accurate judgment regarding the second preset conditions based on its internally programmed instructions. If all the second preset conditions are met, entry into linkage mode is permitted. If one or more of the second preset conditions are not met, the linkage request can be sent again until all the second preset conditions are met before entry into linkage mode is permitted. If the time spent in the iterative process of judging the second preset conditions and sending the linkage request exceeds the system's internally set time, the process of requesting entry into linkage mode will be forcibly terminated and exited.

[0213] After entering the linkage mode, the surgical robot and the operating table are first registered in posture. If the registration is successful, the doctor's main control panel can display a registration success signal through a readable medium (such as a color-changing indicator light) so that the doctor can be notified in time and the doctor and medical assistants can continue to execute the next instruction. If the registration is unsuccessful, the next linkage command cannot be entered into the linkage mode. At the same time, the doctor's main control panel will display a brightly colored signal prompt message (such as red) through a readable medium until the registration is successful before the next step can be allowed.

[0214] After successful registration, linkage can begin. To ensure the safety of the linkage process between the surgical robot and the operating table, the control method of this application may further include:

[0215] During the process of controlling the drive arm to move within a preset degree of freedom based on the operating table surface, it is determined whether the surgical robot meets the first preset condition.

[0216] If the first preset condition is not met, the motion control drive arm based on the operating table surface in the preset degrees of freedom will stop; wherein,

[0217] The first preset condition is met, including at least one of the following:

[0218] The puncture device is positioned relative to the body opening in a preset manner;

[0219] The position of the medical device mounted at the distal end of the drive arm relative to the surgical site is in a preset state;

[0220] The range of motion of each joint in the drive arm is within the preset range of motion.

[0221] The control method for the surgical robot during the linkage process is as described above. During the linkage process, the motion information of all joints of the surgical robot and the operating table is monitored, recorded, and stored in real time. Furthermore, the system monitors in real time whether the surgical robot meets the first preset condition. Specifically, whether the position of the puncture device relative to the body opening is in a preset state can be determined by identifying images acquired by an imaging device mounted at the distal end of the drive arm. If the surgical area partially or completely disappears from the image, it can be determined that there is significant relative motion between the puncture device and the body opening, and the position is not in the preset state. Similarly, whether the position of the medical instrument mounted at the distal end of the drive arm relative to the surgical site is in a preset state can be determined by identifying images acquired by an imaging device mounted at the distal end of the drive arm. If the change in the relative distance or angle between the medical instrument and the surgical site exceeds a certain threshold, it can be determined that there is significant relative motion between the medical instrument and the surgical site, and the position is not in the preset state. In addition, during the linkage process, the joints involved should be in the non-limited area of ​​their respective range of motion. The ideal position is for the joint to be in the center of the range of motion, so as to avoid the undesirable phenomenon of forced termination of movement before the movement is completed because the joint has reached the limit position. Therefore, the current position and angle of the joint can be detected to determine whether the range of motion of the joint is within the preset range of motion.

[0222] In some embodiments, when the first preset condition is not met, the motion control of the operating table surface in the preset degree of freedom is stopped, and a command can usually be issued to stop the motion control of the operating table surface in the preset degree of freedom.

[0223] Before the operating table reaches the target position, its movement only executes motion commands pressed by medical assistants in the motion command area of ​​the operating table controller. If the same button is pressed multiple times consecutively while a command is being executed, the system will only execute the first button press and automatically block repeated requests. Furthermore, if other motion command keys are pressed while a command is being executed, the system will continue executing the unfinished motion command and automatically block other button presses during this process. Once the operating table reaches the target position, the executing motion command automatically ends and the system waits for the next command. To continue executing a new motion command, the button for the desired motion must be pressed again to send another motion request to the system. After the linkage ends, pressing the exit function key exits the linkage mode. After exiting linkage mode, the system automatically switches back to the regular master-slave operation mode and waits for the next command.

[0224] Figure 9This is a schematic diagram of an operating panel for an operating table according to one embodiment. The operating panel 600 includes, but is not limited to, display areas and operating areas such as a screen display area 801, a mode switching function area 802, and a motion command area 803. The screen display area 801 further includes, but is not limited to, the current state of the operating table, the range of motion of each joint, the current motion commands executed on the table, data connection, and registration success signals, allowing medical assistants to view and grasp the current motion status of the operating table at any time through the screen display information, providing accurate current information for the next button operation and effectively avoiding operational errors. The mode switching function area 802 further includes, but is not limited to, a registration button, a stop button, an exit button, and lock and unlock buttons. The registration button is used to perform full registration between the surgical robot and the operating table in all degrees of freedom of motion and wait for the next operation command to be executed. The stop button is used to interrupt the control program midway, stopping the linkage action between each joint and maintaining the motion state at the time of stop until the next operation command begins execution. The exit button is used to switch back from the linkage mode to the normal master-slave operation mode after the linkage ends. The lock and unlock buttons control the stopping and releasing of the wheeled chassis of the surgical robot and operating table before and after surgery. The motion command area 803 further includes, but is not limited to, [other features]. Figure 9 The buttons displayed on the control panel define motion commands for each degree of freedom using the operating table's reference coordinate system as the motion reference coordinate system. The number of buttons is determined based on the number of degrees of freedom that the operating table is allowed to execute in the linkage mode.

[0225] This application discloses a control method for a surgical robot. The surgical robot includes a drive arm with multiple joints, and a puncture device is mounted at the distal end of the drive arm. The puncture device is used to insert into an opening in the body of a patient lying on the surface of an operating table. The control method includes: acquiring posture registration information between the surgical robot and the operating table; acquiring motion information of the operating table surface in the degrees of freedom of posture in response to the motion of the operating table surface; determining a target joint value for a first joint among the multiple joints based on the motion information and posture registration information; and controlling the motion of the first joint according to the target joint value to maintain the posture of the puncture device relative to the operating table surface in the degrees of freedom of posture. This application can actively control the drive arm to adjust the posture of the puncture device when the surgical robot moves in the degrees of freedom of posture on the operating table surface based on the posture registration information between the surgical robot and the operating table, thereby improving operational efficiency and safety.

[0226] The control method of this application also has the following beneficial effects:

[0227] ① It can realize the linkage between the surgical robot and the operating table. During the linkage process, the tedious and repetitive docking operations such as removing puncture devices and / or surgical tools (such as surgical instruments and imaging instruments) from the patient's body, disassembling and installing surgical tools at the end of the surgical robot, and de-contacting the surgical robot with the operating table are eliminated. This reduces the workload of medical and nursing assistants, improves the intelligence level of the surgical robot system, shortens the operation time, and improves the smoothness of the operation.

[0228] ② The interaction between the surgical robot and the operating table can be achieved simply by using attitude positioning, which makes the application and implementation simple and more reliable.

[0229] The technical features of the above embodiments can be combined in any way. For the sake of brevity, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0230] The technical features and combinations of any technical features described in the above embodiments are universal, applicable not only to single-port surgical robots but also to multi-port surgical robots, and neither affecting nor limiting their use in robotic arms with different configurations.

[0231] The embodiments described above are merely illustrative of several implementation methods of this application, and while the descriptions are relatively specific and detailed, they should not be construed as limiting the scope of the invention patent. It should be noted that those skilled in the art can make various modifications and improvements without departing from the concept of this application, and these all fall within the protection scope of this application. Therefore, the protection scope of this patent application should be determined by the appended claims.

Claims

1. A method for registering a surgical robot with an operating table, characterized in that, One of the surgical robot and the operating table is equipped with a scanning distance measuring device, and the other of the surgical robot and the operating table is equipped with a positioning mark located within the scanning range of the scanning distance measuring device. The horizontal plane containing the first and second horizontal coordinate axes of the surgical robot's reference coordinate system, the horizontal plane containing the first and second horizontal coordinate axes of the operating table's reference coordinate system, and the horizontal plane containing the scanning direction of the scanning distance measuring device are parallel or coincident with each other. The method includes the following steps: The scanning data of the scanning ranging device is acquired, including the first vertical distance and the second vertical distance between the surgical robot and the operating table, the distance between the scanning ranging device and the positioning mark, and the scanning angle of the scanning ranging device; Based on the scan data, the position coordinates of the scanning ranging device, and the position coordinates of the positioning mark, the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table is determined. The registration information includes posture registration information and / or position registration information. The step of determining the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table based on the scan data, the position coordinates of the scanning ranging device, and the position coordinates of the positioning mark includes: Based on the first vertical distance and the second vertical distance between the surgical robot and the operating table, the relative rotation angle between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table is determined, so as to obtain the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table; When the scanning ranging device includes a scanning ranging sensor, the first vertical distance is the minimum distance scanned by the scanning ranging sensor, and the second vertical distance is the distance scanned by the scanning ranging sensor from a horizontal direction perpendicular to the installation position; or... When the scanning ranging device includes a first scanning ranging sensor and a second scanning ranging sensor, the first scanning ranging sensor and the second scanning ranging sensor are arranged at intervals on a horizontal plane, the first vertical distance is the minimum distance scanned by the first scanning ranging sensor, and the second vertical distance is the minimum distance scanned by the second scanning ranging sensor; or, the first vertical distance is the distance scanned by the first scanning ranging sensor from a horizontal direction perpendicular to the installation position, and the second vertical distance is the distance scanned by the second scanning ranging sensor from a horizontal direction perpendicular to the installation position.

2. The method according to claim 1, characterized in that, The surgical robot includes a drive arm, the distal end of which is equipped with a puncture device for insertion into an opening in the body of a patient lying on the operating table. The method further includes: Based on the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table, and the pose information of the puncture device in the reference coordinate system of the surgical robot, the attitude registration information and / or position registration information between the puncture device and the reference coordinate system of the operating table are determined.

3. The method according to any one of claims 1 to 2, characterized in that, The scanning ranging device is installed on the surgical robot. Determining the registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table based on the scanning data, the position coordinates of the scanning ranging device, and the position coordinates of the positioning mark includes: Obtain the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table; The position coordinates of the positioning mark in the reference coordinate system of the surgical robot are determined based on the distance between the scanning ranging device and the positioning mark, the scanning angle at which the scanning ranging device scans the positioning mark, and the position coordinates of the scanning ranging device in the reference coordinate system of the surgical robot. Based on the attitude registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table, the position coordinates of the positioning mark in the reference coordinate system of the surgical robot, and the position coordinates of the positioning mark in the reference coordinate system of the operating table, the position coordinates of the origin of the reference coordinate system of the operating table in the reference coordinate system of the surgical robot are determined, so as to obtain the position registration information between the reference coordinate system of the surgical robot and the reference coordinate system of the operating table.

4. The method according to claim 1, characterized in that, The positioning mark includes the intersection of two planes on the mounting side where the positioning mark is located, the two planes having a height difference at the intersection, and the positioning mark being perpendicular to the horizontal plane. Acquiring the scanning data from the scanning ranging device includes: Obtain the target scanning range; The scanning ranging device is controlled to rotate and reciprocate within the target scanning range; Determine whether the positioning marker has been detected; If so, then obtain the target scanning data corresponding to the location marker when it is scanned, and the target scanning data includes the target distance; Determine whether the conditions for stopping the scan are met; If the conditions for stopping scanning are not met, the target scanning range is reduced to become the updated target scanning range, and the process returns to the step of controlling the scanning ranging device to rotate and reciprocate scanning within the target scanning range. If the conditions for stopping scanning are met, the distance between the scanning ranging device and the positioning mark is determined based on the acquired target scanning data, and the scanning angle corresponding to the distance is acquired as the scanning angle of the scanning ranging device.

5. The method according to claim 4, characterized in that, The conditions for stopping the scan include at least one of the following: The number of times the positioning marker has been detected has reached a preset number; The difference in target distance between the two most recent scans is less than or equal to a preset difference. The target scanning range is reduced to a constant value; A unique distance value is obtained by scanning the target scanning range.

6. A registration device for a surgical robot and an operating table, characterized in that, include: Memory, used to load and execute computer programs; Processor, used to load and execute the computer program; The computer program is loaded and executed by the processor to implement the steps of the registration method between the surgical robot and the operating table as described in any one of claims 1 to 5.

7. A surgical robot, characterized in that, The surgical robot is equipped with a scanning and ranging device, which is used to scan the positioning marks set on the operating table. The horizontal planes containing the first and second horizontal coordinate axes of the surgical robot's reference coordinate system, the horizontal planes containing the first and second horizontal coordinate axes of the operating table's reference coordinate system, and the horizontal plane containing the scanning direction of the scanning and ranging device are parallel or coincident with each other. When the scanning ranging device includes a scanning ranging sensor, the first vertical distance is the minimum distance scanned by the scanning ranging sensor, and the second vertical distance is the distance scanned by the scanning ranging sensor from a horizontal direction perpendicular to the installation position; or... When the scanning ranging device includes a first scanning ranging sensor and a second scanning ranging sensor, the first scanning ranging sensor and the second scanning ranging sensor are spaced apart on a horizontal plane, the first vertical distance is the minimum distance scanned by the first scanning ranging sensor, and the second vertical distance is the minimum distance scanned by the second scanning ranging sensor; or, the first vertical distance is the distance scanned by the first scanning ranging sensor from a horizontal direction perpendicular to the installation position, and the second vertical distance is the distance scanned by the second scanning ranging sensor from a horizontal direction perpendicular to the installation position. The surgical robot further includes a controller for performing the steps of implementing the registration method of the surgical robot and the operating table as described in any one of claims 1 to 5.

8. A surgical system, characterized in that, It includes an operating table and a surgical robot as described in claim 7, wherein the surgical robot is communicatively connected to the operating table.

9. A computer-readable storage medium, characterized in that, A computer program is stored on the computer-readable storage medium, which, when executed by a processor, implements the steps of the registration method between the surgical robot and the operating table as described in any one of claims 1 to 5.

Images