CN114454172A

CN114454172A - Control method for end adapter of mechanical arm

Info

Publication number: CN114454172A
Application number: CN202210179785.8A
Authority: CN
Inventors: 陈龙; 黄钦; 谢强
Original assignee: Wuhan United Imaging Zhirong Medical Technology Co Ltd
Current assignee: Wuhan United Imaging Zhirong Medical Technology Co Ltd
Priority date: 2020-09-25
Filing date: 2020-09-25
Publication date: 2022-05-10
Anticipated expiration: 2040-09-25
Also published as: CN114454172B; CN112192566A; CN112192566B

Abstract

The present application relates to a method for controlling an end adapter of a robot arm. The control method comprises the steps of obtaining a motion mode, and obtaining a first path if the motion mode is a plane motion mode. The first path passes through a first target point and a first craniotomy point, and the terminal adapter is located at a first fixation site. The first location point is located on a side of the first craniotomy point away from the first target point. And acquiring the position information of the second target point. And obtaining a second path comprising the second target point according to the position information of the second target point and the first path. The end adapter is driven to move to a second positioning point perpendicular to the first path. The second positioning point is positioned on the second path, and the second positioning point and the second target point are arranged at intervals. The control method obtains the second path according to the position information of the second target point and the first path by positioning the position of the second target point, avoids modeling, data acquisition and path planning again, and saves time.

Description

Control method for end adapter of mechanical arm

Technical Field

The application relates to the technical field of medical treatment, in particular to a control method of a tail end adapter of a mechanical arm.

Background

The existing technology for fine tuning target points is realized through a mechanical structure. A special mechanical structure is fitted to the end of the arm of the surgical robot or to the stereotactic frame, which provides an ordered arrangement of 5 puncture paths. One of the paths is a central path, passing through the target point. The other four paths are respectively positioned in the four directions of the upper, the lower, the left and the right of the central path and are separated from the central path by a fixed distance. The four peripheral paths pass through the area near the target point.

During the operation, the user performs the positioning operation with the central path. And if the position of the target point needs to be adjusted, switching to four paths, namely an upper path, a lower path, a left path and a right path, wherein the areas penetrated by the four paths are fixed. If the four paths still cannot accurately reach the target area, modeling, data acquisition and path planning need to be carried out again, so that the operation time is increased, and the operation efficiency is reduced.

Disclosure of Invention

In view of the above, it is necessary to provide a method for controlling an end adapter of a robot arm, which is directed to a problem of how to improve the efficiency of a surgical operation.

A method of controlling an end adapter of a robot arm, comprising:

acquiring a motion mode, and acquiring a first path if the motion mode is a planar motion mode, wherein the first path passes through a first target point and a first cranium entering point, the tail end adapter is positioned at a first positioning point, and the first path sequentially passes through the first positioning point, the first cranium entering point and the first target point;

and acquiring a position command, and controlling the terminal adapter to move along a first plane where the first positioning point is located according to the position command, wherein the first plane is perpendicular to the first path.

In one embodiment, if the position command includes position information of the second target point, the step of controlling the terminal adapter to move in the first plane where the first positioning point is located according to the position command includes:

obtaining a second path passing through the second target point according to the position information of the second target point and the first path, wherein the second path is parallel to the first path, and the second path and the first plane are intersected at a second positioning point;

and driving the end adapter to move to the second positioning point.

In one embodiment, the step of driving the end adapter to move to the second positioning point comprises:

driving the end adapter to move to the second positioning point perpendicular to the first path;

after the step of driving the end adapter to move to the second positioning point perpendicular to the first path, the control method further includes:

controlling the end adapter to move along the second path.

In one embodiment, after the step of driving the tip adapter to move to the second positioning point, the control method further includes:

and controlling the tail end adapter to move a distance towards the second positioning point along the second path, and then switching the motion mode to a spherical motion mode for motion.

In one embodiment, after the step of driving the tip adapter to move to the second location point, if the motion mode is switched from the planar motion mode to the spherical motion mode:

and acquiring position information of a fourth intracranial injection point, controlling the tail end adapter to move to the fourth positioning point by taking the second target point as a sphere center and taking the distance between the second target point and the second positioning point as a radius, wherein the second target point, the fourth intracranial injection point and the fourth positioning point are sequentially arranged on the same straight line.

In one embodiment, the method of controlling the tip adapter of the robot arm further includes:

acquiring a maximum allowable arc length;

and when the arc length passed by the terminal adapter reaches the maximum allowable arc length, controlling the terminal adapter to be locked.

In one embodiment, the step of controlling the terminal adapter to move to a fourth positioning point in an arc motion with the second target point as a sphere center and a distance between the second target point and the second positioning point as a radius includes:

and controlling the terminal adapter to move to the fourth positioning point in a stepping mode with the first arc length.

acquiring the maximum allowable arc length;

acquiring the interval arc length between the second positioning point and the fourth positioning point;

preventing the end adapter from moving away from the second anchor point when the difference between the maximum allowed arc length and the spaced arc length is less than the first arc length.

In one embodiment, the tip adapter is controlled to move in steps with a second arc length when the difference between the maximum allowed arc length and the spaced arc length is less than the first arc length and greater than the second arc length;

performing the step of preventing the tip adapter from moving away from the second anchor point when the difference between the maximum allowed arc length and the spaced arc length is less than the second arc length;

the second arc length is less than the first arc length.

A method of controlling an end adapter of a robot arm, comprising:

acquiring a position command, and controlling the terminal adapter to move along a first plane where the first positioning point is located according to the position command, wherein the first plane is perpendicular to the first path;

acquiring a maximum allowable distance;

controlling the end adapter to lock when the distance traveled by the end adapter in the first plane reaches the maximum allowable distance.

In one embodiment, if the position command includes position information of the second target point, the step of controlling the terminal adapter to move along a first plane where the first positioning point is located according to the position command includes:

and driving the end adapter to move to the second positioning point.

and driving the end adapter to move to the second positioning point perpendicular to the first path.

In one embodiment, the step of driving the end adapter to move to the second positioning point perpendicular to the first path comprises:

and controlling the terminal adapter to move to the second positioning point in a first step stepping mode.

acquiring the maximum allowable distance;

acquiring the spacing distance between the first positioning point and the second positioning point;

preventing movement of the end adapter away from the first location point when the difference between the maximum allowable distance and the separation distance is less than the first step length.

In one embodiment, when the difference between the maximum allowable distance and the separation distance is less than the first step length and greater than a second step length, controlling the end adapter to move in steps of the second step length;

performing the step of preventing the end adapter from moving away from the first location point when the difference between the maximum allowable distance and the separation distance is less than the second step length;

the second step size is smaller than the first step size.

A method of controlling an end adapter of a robot arm, comprising:

acquiring a motion mode, and acquiring a first path if the motion mode is a spherical motion mode, wherein the first path passes through a first target point and a first cranium entering point, the tail end adapter is positioned at a first positioning point, and the first path sequentially passes through the first positioning point, the first cranium entering point and the first target point;

acquiring a position command, and controlling the terminal adapter to move along a first spherical surface where the first positioning point is located according to the position command;

acquiring a maximum allowable arc length;

In one embodiment, if the position command is position information of a second craniotomy point, the step of controlling the distal end adapter to move along the first spherical surface where the first positioning point is located according to the position command comprises:

and controlling the terminal adapter to take the first target point as a sphere center, and to move to a third positioning point in an arc-shaped motion by taking the distance between the first target point and the first positioning point as a radius, wherein the first target point, the second intracranial entering point and the third positioning point are sequentially arranged on the same straight line.

In one embodiment, the step of controlling the terminal adapter to move to a third location point by taking the first target point as a sphere center and taking a distance between the first target point and the first location point as a radius comprises:

controlling the terminal adapter to move to the third positioning point in a stepping mode with a first arc length;

after the end adapter moves to the third anchor point, the control method further comprises:

controlling the tip adapter to move toward the first target point.

In one embodiment, the method for controlling the end adapter of the robot arm further includes:

acquiring the maximum allowable arc length;

acquiring the interval arc length between the first positioning point and the third positioning point;

preventing movement of the end adapter away from the first anchor point when the difference between the maximum allowed arc length and the spaced arc length is less than the first arc length.

performing the step of preventing the end adapter from moving away from the first anchor point when the difference between the maximum allowed arc length and the spaced arc length is less than the second arc length;

the second arc length is less than the first arc length.

A surgical robotic system includes a robotic arm and a control device. The robotic arm includes a tip adapter. The control device includes a memory and a processor. The memory stores a computer program. The processor, when executing the computer program, performs the steps of the method according to any of the embodiments described above.

A computer-readable storage medium having stored thereon a computer program. Which when executed by a processor performs the steps of the method according to any of the embodiments described above.

The control method of the terminal adapter of the mechanical arm provided by the embodiment of the application comprises the following steps: and acquiring a motion mode, and acquiring a first path if the motion mode is a plane motion mode. The first path passes through a first target point and a first craniotomy point, and the tip adapter is located at a first location. The first location point is located on a side of the first craniotomy point away from the first target point. And acquiring the position information of the second target point. And obtaining a second path comprising the second target point according to the position information of the second target point and the first path. The second path is parallel to the first path. And driving the end adapter to move to a second positioning point. The second positioning point is located on the second path, and the second positioning point and the second target point are arranged at intervals. The control method of the terminal adapter of the mechanical arm can avoid modeling, data acquisition and path planning again and save time by positioning the position of the second target point and obtaining the second path parallel to the first path according to the position information of the second target point and the first path. Even if the position of the target point changes for many times, a new puncture path can be quickly obtained, and the operation efficiency is improved.

Drawings

In order to more clearly illustrate the technical solutions in the embodiments or the conventional technologies of the present application, the drawings used in the descriptions of the embodiments or the conventional technologies will be briefly introduced below, it is obvious that the drawings in the following descriptions are only some embodiments of the present application, and for those skilled in the art, other drawings can be obtained according to the drawings without creative efforts.

Fig. 1 is a flowchart of a control method of an end adapter of a robot arm provided in a first embodiment of the present application;

FIG. 2 is a schematic plan view of an end adapter of the robotic arm as provided in one embodiment of the present application;

FIG. 3 is a flow chart of a method of controlling a tip adapter of a robotic arm provided in a second embodiment of the present application;

FIG. 4 is a flow chart of a method of controlling a tip adapter of a robotic arm provided in a third embodiment of the present application;

FIG. 5 is a flow chart of a method of controlling a tip adapter of a robotic arm provided in a fourth embodiment of the present application;

FIG. 6 is a flow chart of a method of controlling a tip adapter of a robotic arm provided in a fifth embodiment of the present application;

FIG. 7 is a schematic view of the planar mode of the end adapter of the robotic arm being switched to the spherical mode as provided in one embodiment of the present application;

FIG. 8 is a flow chart of a method of controlling a tip adapter of a robotic arm provided in a sixth embodiment of the present application;

FIG. 9 is a flowchart of a method of controlling a tip adapter of a robotic arm provided in a seventh embodiment of the present application;

fig. 10 is a flowchart of a control method of an end adapter of a robot arm provided in an eighth embodiment of the present application;

FIG. 11 is a schematic view of a spherical pattern of an end adapter of the robotic arm provided in an embodiment of the present application;

fig. 12 is a flowchart of a control method of an end adapter of a robot arm provided in a ninth embodiment of the present application;

fig. 13 is a flowchart of a control method of an end adapter of a robot arm provided in a tenth embodiment of the present application.

Reference numbers:

100. a mechanical arm; 110. a tip adaptor; 111. a first path; 113. a first limit point; 112. a second path; 114. a second limit point; 115. a third path; lmax, maximum allowed distance; lmax, maximum allowed arc length; 101. a first target point; 102. a first craniotomy point; 103. a first anchor site; 201. a second target point; 202. a third intracranial entry point; 203. a second positioning point; 302. a fourth intracranial entry point; 303. a fourth positioning point; 402. a second craniotomy point; 403. and a third anchor point.

Detailed Description

In order to make the aforementioned objects, features and advantages of the present application more comprehensible, embodiments accompanying the present application are described in detail below with reference to the accompanying drawings. In the following description, numerous specific details are set forth in order to provide a thorough understanding of the present application. This application is capable of embodiments in many different forms than those described herein and those skilled in the art will be able to make similar modifications without departing from the spirit of the application and it is therefore not intended to be limited to the embodiments disclosed below.

The numbering of the components as such, e.g., "first", "second", etc., is used herein for the purpose of describing the objects only, and does not have any sequential or technical meaning. The term "connected" and "coupled" when used in this application, unless otherwise indicated, includes both direct and indirect connections (couplings). In the description of the present application, it is to be understood that the terms "upper", "lower", "front", "rear", "left", "right", "vertical", "horizontal", "top", "bottom", "inner", "outer", "clockwise", "counterclockwise", and the like, indicate orientations or positional relationships based on those shown in the drawings, and are used only for convenience in describing the present application and for simplicity in description, and do not indicate or imply that the devices or elements referred to must have a particular orientation, be constructed in a particular orientation, and be operated, and thus, are not to be considered as limiting the present application.

In this application, unless expressly stated or limited otherwise, a first feature is "on" or "under" a second feature such that the first and second features are in direct contact, or the first and second features are in indirect contact via an intermediary. Also, a first feature "on," "over," and "above" a second feature may be directly or diagonally above the second feature, or may simply indicate that the first feature is at a higher level than the second feature. A first feature being "under," "below," and "beneath" a second feature may be directly under or obliquely under the first feature, or may simply mean that the first feature is at a lesser elevation than the second feature.

In robotic-assisted surgery, a physician performs an image scan of the patient's brain. By scanning the image, the doctor can judge the relevant information of the focus. According to the relevant information of the focus and other information of the brain of the patient. The surgeon will customize the surgical plan. Multiple puncture paths are included in the surgical plan. Each puncture path includes information such as a target point of the puncture path, a craniotomy position, a diameter of the path, or a length of the instrument. The target point is arranged at the focus position. The cranium entering point is arranged on the surface of the skull of the patient. The puncture path is also referred to as the path of the needle track. During the puncturing procedure, it is desirable that the distal adapter 110 of the robotic arm 100 be positioned adjacent to the craniotomy site prior to the puncturing procedure by the surgeon.

Referring to fig. 1 and fig. 2, an embodiment of the present application provides a method for controlling an end adaptor 110 of a robot arm 100, including:

s1000, obtain the first path 111. The first path 111 passes through the first target point 101 and the first craniotomy point 102, and the tip adaptor 110 is located at the first fixation point 103. The first pathway 111 passes through the first fixation site 103, the first craniotomy point 102 and the first target point 101 in sequence.

S2000, obtaining a position command, and controlling the terminal adapter 110 to move along a first plane or a first spherical surface where the first positioning point 103 is located according to the position command, where the first plane is perpendicular to the first path 111.

According to the control method of the end adapter 110 of the robot arm 100 provided by the embodiment of the application, the end adapter 110 is controlled to move along the first plane or the first spherical surface where the first positioning point 103 is located according to the position command, and the first plane is perpendicular to the first path 111, so that the degree of freedom of movement of the end adapter 110 is reduced, re-modeling, data acquisition and path planning are avoided, and the time is saved. Even if the position of the target point changes for many times, a new puncture path can be quickly obtained, and the operation efficiency is improved.

The position command includes mode information, distance information, direction information, step size information, or the like.

In one embodiment, if the position command includes the position information of the second target point 201, the step of controlling the end adapter 110 to move along the first plane where the first positioning point 103 is located according to the position command includes:

s200, obtaining a second path 112 passing through the second target point 201 according to the position information of the second target point 201 and the first path 111. The second path 112 is parallel to the first path 111.

S300, driving the terminal adapter 110 to move to the second positioning point 203.

According to the control method of the terminal adapter 110 of the robot arm 100, provided by the embodiment of the application, the second path 112 parallel to the first path 111 is obtained according to the position information of the second target point 201 and the first path 111 by positioning the position of the second target point 201, so that re-modeling, data acquisition and path planning are avoided, and time is saved. Even if the position of the target point changes for many times, a new puncture path can be quickly obtained, and the operation efficiency is improved.

The position information of the second target point 201 may include moving direction information or target position information.

The first target 101 is an original target. The first cranium entering point 102 is an original cranium entering point. The second target point 201 is a new target point modified based on the original target point. The third cranium entry point 202 is a new cranium entry point modified from the original cranium entry point. The first path 111 is an original puncture path. The second path 112 is a new puncture path.

The tip adaptor 110 is used to mount a surgical tool. The surgical tool may comprise a scalpel, an electric drill or other surgical tool.

The end adapter 110 is moved to the first location 103 by manual or automated means.

The step of obtaining a second path 112 through the second target point 201 according to the position information of the second target point 201 and the first path 111 in the step S200 includes:

a line parallel to the first path 111 is drawn through the second target point 201. The straight line is the straight line of the second path 112.

The tip adapter 110 may move along a straight line or a curved line to the straight line.

In one embodiment, the method for controlling the tip adapter 110 of the robot arm 100 further includes:

s410, obtaining a safe distance, wherein the safe distance is the minimum distance between the tail end adapter 110 and the third craniotomy point 202. Controlling the locking of the tip adapter 110 when the tip adapter 110 is a safe distance from the third craniotomy point 202.

In one embodiment, the surgical instrument is a power drill. After the electric drill is installed on the end adapter 110, the end adapter 110 is controlled to drive the electric drill to perforate at the third cranium entering point 202.

In one embodiment, the step of driving the end adapter 110 to move to the second positioning point 203 in the step S300 includes:

the end adapter 110 is driven to move to the second positioning point 203 perpendicular to the first path 111. The distance from the terminal adapter 110 vertically moving to the second positioning point 203 is the shortest, so that the time for preparing the operation is shortened, and the working efficiency is improved.

After the step of driving the end adapter 110 to move to the second positioning point 203 perpendicular to the first path 111, the control method further includes:

controlling the end adapter 110 to move along the second path 112.

Referring to fig. 3, in an embodiment, after the step S300, the method for controlling the end adapter 110 of the robot arm 100 further includes:

s310, obtaining the maximum allowable distance Lmax.

S320, when the distance traveled by the end adapter 110 in the first plane reaches the maximum allowable distance Lmax, controlling the end adapter 110 to be locked.

The maximum allowed distance Lmax is the maximum displacement that allows the end adapter 110 to move perpendicular to the first path 111. The distance traveled by the end adapter 110 is the radial distance between the location of the end adapter 110 and the first location point 103.

In one embodiment, the end adapter 110 is controlled to move along a straight line perpendicular to the first path 111, and the moving range of the end adapter 110 is a circular area with the first positioning point 103 as a center point and the maximum allowable distance Lmax as a radius. The plane of the circular area is perpendicular to the first path 111. A point on the edge of the circular area is a first limit point 113. The distance between the first limit point 113 and the first positioning point 103 is the maximum allowable distance Lmax. I.e. the end adapter 110 can only move in the circular area.

The projection area of the circular area towards the skull of the patient is the area which allows the correction of the cranium entering point.

The maximum allowed distance Lmax is related to the original target point position and the structure tissue in the vicinity of the original target point. The projection area of the circular area corresponding to the maximum allowable distance Lmax projected to the head of the patient is a safe area. Doctors punch holes or excise lesions on the skull in safe areas with little or no damage to other intracerebral tissue.

The maximum allowed distance Lmax is generally small. The maximum allowable distance Lmax is between 5mm and 10 mm.

In one embodiment, the terminal adapter 110 is manually operated by a technician, but only allows the terminal adapter 110 to move perpendicular to the first path 111. The technician can manually move the tip adapter 110 freely within the circular area.

In one embodiment, the step of driving the end adapter 110 to move to the second location point 203 perpendicular to the first path 111 comprises:

the control method of the terminal adapter 110 of the mechanical arm 100 controls the terminal adapter 110 to move in a stepping moving mode, so that the position information of the terminal adapter 110 can be accurately acquired by recording the number of steps, information delay is reduced, and safety is improved.

The first step length is smaller than the maximum allowed distance Lmax. The first step size is between 0.1mm and 1 mm.

Referring to fig. 4, in an embodiment, after the step S300, the method for controlling the end adapter 110 of the robot arm 100 further includes:

s301, acquiring the maximum allowable distance Lmax.

S302, a distance between the first positioning point 103 and the second positioning point 203 is obtained.

S303, when the difference between the maximum allowable distance Lmax and the separation distance is smaller than the first step length, the terminal adapter 110 is prevented from moving away from the first positioning point 103. I.e. the tip adaptor 110 can only move or not move towards the first fixation point 103, avoiding that the tip adaptor 110 exceeds the maximum allowed distance Lmax and exceeds a safe area, harming brain tissue.

In one embodiment, the tip adaptor 110 is controlled to move stepwise at the second step length when the difference between the maximum allowable distance Lmax and the separation distance is less than the first step length and greater than the second step length. The second step size is smaller than the first step size.

The step of preventing the end adapter 110 from moving away from the first location point 103 is performed when the difference between the maximum allowable distance Lmax and the separation distance is less than the second step length.

By adjusting the step size of the tip adapter 110 small, the step size of the tip adapter 110 can be increased to strive for a larger correction space for the cranium entry point and the target point.

In the above embodiment, the movement pattern of the end adapter 110 is a planar movement pattern. The end adapter 110 moves vertically to the second location point 203 and then moves along the second path 112 parallel to the first path 111. The cranium entry point and the target point are both corrected.

Referring to fig. 5, in an embodiment, before the step of obtaining the first path 111, the method further includes:

s001, acquiring a motion mode, and if the motion mode is a planar motion mode, executing the step of acquiring the first path 111.

Referring to fig. 6 and 7 together, in one embodiment, after the step of driving the end adaptor 110 to move to the second positioning point 203, if the motion mode is switched from the plane motion mode to the spherical motion mode, then:

s400, acquiring position information of a fourth intracranial entry point 302, controlling the terminal adapter 110 to move to the fourth positioning point 303 by taking the second target point 201 as a sphere center and taking the distance between the second target point 201 and the second positioning point 203 as a radius to make arc motion, wherein the second target point 201, the fourth intracranial entry point 302 and the fourth positioning point 303 are sequentially arranged on the same straight line.

The end adapter 110 performs an arc motion with the second target point 201 as a center of sphere and a distance between the second target point 201 and the second positioning point 203 as a radius, so that a motion range of the end adapter 110 in the spherical motion mode is a partial spherical surface. The center of the sphere is the second target point 201. The radius of the sphere is the distance between the second target point 201 and the second positioning point 203.

The connecting line between the second target point 201 and the fourth intracranial entry point 302 is the third path 115. The intersection point of the third path 115 and the skull of the patient is a puncture target point. The target puncture point is designated as a fourth intracranial entry point 302.

In one embodiment, after the step of driving the end adapter 110 to move to the second positioning point 203, the control method further comprises: the end adapter 110 is controlled to move a distance along the second path 112 towards the second positioning point 203, and then the motion mode is switched to the spherical motion mode.

By switching the motion mode, the position of the craniotomy point can be changed, and important brain tissues between the craniotomy point and the target point are selectively avoided, so that the safety of the operation is improved.

Referring to fig. 8, in one embodiment, the method for controlling the end adapter 110 of the robot arm 100 further includes:

s410, obtaining a maximum allowable arc length lmax.

And S420, when the arc length walked by the tail end adapter 110 reaches the maximum allowable arc length lmax, controlling the tail end adapter 110 to be locked so as to ensure the safety of the cranium entering point position of the puncture operation.

The maximum allowable arc length lmax is the maximum displacement of arc motion by taking the second target point 201 as the center of sphere and taking the distance between the second target point 201 and the second positioning point 203 as the radius.

In fig. 2, the arc length between the second positioning point 203 and the fourth positioning point 303 is the maximum allowable arc length lmax. The maximum allowable arc length lmax is related to the position of the original target point and the brain tissue structure.

In one embodiment, the step of controlling the end adapter 110 to move to the fourth positioning point 303 by taking the second target point 201 as a sphere center and taking the distance between the second target point 201 and the second positioning point 203 as a radius to make an arc motion includes:

the end adapter 110 is controlled to move step by step to the fourth positioning point 303 with the first arc length.

The control method of the terminal adapter 110 of the mechanical arm 100 controls the terminal adapter 110 in a stepping moving mode, so that the position information of the terminal adapter 110 can be accurately acquired by recording the number of steps, information delay is reduced, and safety is improved.

Referring to fig. 9, in one embodiment, the method for controlling the end adapter 110 of the robot arm 100 further includes:

s401, obtaining a maximum allowable arc length lmax.

S402, obtaining the interval arc length between the second positioning point 203 and the fourth positioning point 303.

S403, when the difference between the maximum allowable arc length lmax and the interval arc length is smaller than the first arc length, preventing the terminal adapter 110 from moving away from the second positioning point 203. That is, the end adapter 110 can only move or not move near the second positioning point 203, so as to avoid the end adapter 110 exceeding the maximum allowable arc length lmax and the brain tissue being injured due to exceeding a safe zone.

In one embodiment, the tip adaptor 110 is controlled to move in steps with a second arc length when the difference between the maximum allowed arc length lmax and the separation arc length is less than the first arc length and greater than the second arc length. The second arc length is less than the first arc length.

The step of preventing the end adapter 110 from moving away from the second location point 203 is performed when the difference between the maximum allowed arc length lmax and the interval arc length is less than the second arc length. By adjusting the step arc length of the tip adapter 110 to be small, the step range of the tip adapter 110 can be increased to strive for a larger correction space for the craniotomy.

and controlling the terminal adapter 110 to reset to the first positioning point 103, so as to avoid route re-planning caused by misoperation.

Referring to fig. 10 and 11, in an embodiment, if the position command is position information of the second craniotomy point 402, the step of controlling the distal end adapter 110 to move along the first spherical surface where the first positioning point 103 is located according to the position command includes:

the terminal adapter 110 is controlled to move to the third positioning point 403 in an arc motion with the first target point 101 as the center of sphere and the distance between the first target point 101 and the first positioning point 103 as the radius. The first target point 101, the second intracranial entry point 402, and the third positioning point 403 are arranged in sequence on a straight line.

The control method of the tip adapter 110 of the mechanical arm 100 provided by the embodiment of the present application obtains a new puncture path by positioning the positions of the second craniotomy point 402 and the first target point 101, and performing an arc-shaped motion with the first target point 101 as a sphere center and a distance between the first target point 101 and the first positioning point 103 as a radius. The control method of the end adapter 110 of the robotic arm 100 avoids re-modeling, data collection and path planning, saving time. Even if the position of the target point changes for many times, a new puncture path can be quickly obtained, and the operation efficiency is improved.

Referring to fig. 12, in one embodiment, after the step S020, the method for controlling the tip adaptor 110 of the robot arm 100 further includes:

and S030, acquiring a maximum allowable arc length lmax.

And S040, when the arc length walked by the terminal adapter 110 reaches the maximum allowable arc length lmax, controlling the terminal adapter 110 to be locked so as to ensure the safety of the craniotomy position of the puncture operation.

The maximum allowable arc length lmax is the maximum displacement of arc motion by taking the first target point 101 as the center of sphere and taking the distance between the first target point 101 and the first positioning point 103 as the radius.

In fig. 3, the arc length between the first positioning point 103 and the third positioning point 403 is the maximum allowable arc length lmax. The maximum allowable arc length lmax is related to the position of the original target point and the brain tissue structure.

In one embodiment, the step of controlling the end adapter 110 to move to the third positioning point 403 by taking the first target point 101 as the center of the sphere and taking the distance between the first target point 101 and the first positioning point 103 as the radius comprises:

the end adapter 110 is controlled to move step by step to the third positioning point 403 with the first arc length.

After the end adapter 110 moves to the third location point 403, the control method further includes:

controlling the end adapter 110 to move towards the first target point 101.

Referring to fig. 13, in one embodiment, after the step S020, the method for controlling the tip adaptor 110 of the robot arm 100 further includes:

and S021, acquiring a maximum allowable arc length lmax.

S022, obtaining an arc length of an interval between the first positioning point 103 and the third positioning point 403.

S023, preventing the distal adaptor 110 from moving away from the first location point 103 when the difference between the maximum allowed arc length lmax and the interval arc length is less than the first arc length. I.e. the tip adaptor 110 can only move or not move close to the first fixation point 103, avoiding that the tip adaptor 110 exceeds the maximum allowed distance Lmax and exceeds a safe area, harming brain tissue.

controlling the tip adaptor 110 to move in a stepwise manner with a second arc length when a difference between the maximum allowed arc length lmax and the interval arc length is smaller than the first arc length and larger than the second arc length. The second arc length is less than the first arc length.

The step of preventing movement of the tip adaptor 110 away from the first location point 103 is performed when the difference between the maximum allowed arc length lmax and the separation arc length is less than the second arc length. By adjusting the step arc length of the tip adapter 110 to be small, the step range of the tip adapter 110 can be increased to strive for a larger correction space for the craniotomy.

In one embodiment, the tip adaptor 110 is controlled to move in steps with a second arc length when the difference between the maximum allowed arc length and the spaced arc length is less than the first arc length and greater than the second arc length;

performing the step of preventing the tip adaptor 110 from moving away from the first location point 103 when the difference between the maximum allowed arc length and the spaced arc length is less than the second arc length; the second arc length is less than the first arc length. By adjusting the step arc length of the tip adapter 110 to be small, the step range of the tip adapter 110 can be increased to strive for a larger correction space for the craniotomy.

In the spherical mode, any point may also be set as a target point, and the terminal adapter 110 is controlled to move on the spherical surface by taking the target point as a center of the sphere and taking a distance from a position of the point on the terminal adapter 110 to the target point as a radius.

Wherein the target point can be set as a craniotomy point, a target point or any other point.

Wherein the end adapter 110 may be self-defining at one point. The technical features of the embodiments described above may be arbitrarily combined, and for the sake of brevity, all possible combinations of the technical features in the embodiments described above are not described, but should be considered as being within the scope of the present specification as long as there is no contradiction between the combinations of the technical features.

The above-described examples merely represent several embodiments of the present application and are not to be construed as limiting the scope of the claims. It should be noted that, for a person skilled in the art, several variations and modifications can be made without departing from the concept of the present application, which falls within the scope of protection of the present application. Therefore, the protection scope of the present patent shall be subject to the appended claims.

Claims

1. A method for controlling an end adapter of a robot arm, comprising:

2. The method of controlling a distal end adapter of a robot arm according to claim 1, wherein if the position command includes position information of a second target point, the step of controlling the distal end adapter to move in a first plane in which the first target point is located according to the position command comprises:

and driving the end adapter to move to the second positioning point.

3. The method of controlling the tip end adapter of the robot arm as set forth in claim 2, wherein the step of driving the tip end adapter to move to the second positioning point comprises:

controlling the end adapter to move along the second path.

4. The control method of a tip end adapter of a robot arm according to claim 2, characterized in that after the step of driving the tip end adapter to move to the second positioning point, the control method further comprises:

5. The method for controlling the tip end adapter of the robot arm according to claim 4, wherein after the step of driving the tip end adapter to move to the second anchor point, if the motion mode is switched from the planar motion mode to the spherical motion mode, then:

6. The method of controlling a tip end adapter of a robot arm according to claim 5, further comprising:

acquiring a maximum allowable arc length;

7. The method of controlling a tip end adapter of a robot arm according to claim 6, wherein the step of controlling the tip end adapter to move in an arc motion with the second target point as a center of sphere and a distance between the second target point and the second positioning point as a radius to a fourth positioning point comprises:

8. The method of controlling a tip end adapter of a robot arm according to claim 7, further comprising:

acquiring the maximum allowable arc length;

9. The method of controlling a tip adapter of a robotic arm of claim 8, wherein the tip adapter is controlled to move in steps at a second arc length when a difference between the maximum allowed arc length and the spaced arc length is less than the first arc length and greater than the second arc length;

the second arc length is less than the first arc length.

10. A method for controlling a distal end adapter of a robot arm, comprising:

obtaining a motion mode, and if the motion mode is a plane motion mode, obtaining a first path, wherein the first path passes through a first target point and a first craniotomy point, the tail end adapter is positioned at the first positioning point, and the first path sequentially passes through the first positioning point, the first craniotomy point and the first target point;

acquiring a maximum allowable distance;

11. The method of claim 10, wherein if the position command includes position information of a second target point, the step of controlling the end adapter to move along a first plane where the first target point is located according to the position command comprises:

and driving the end adapter to move to the second positioning point.

12. The method of controlling the tip end adapter of the robot arm as set forth in claim 11, wherein the step of driving the tip end adapter to move to the second positioning point comprises:

13. The method of controlling the tip end adapter of the robot arm as set forth in claim 12, wherein the step of driving the tip end adapter to move to the second positioning point perpendicularly to the first path comprises:

14. The method of controlling a tip end adapter of a robot arm of claim 13, further comprising:

acquiring the maximum allowable distance;

15. The control method of a tip end adapter of a robot arm according to claim 14, wherein the tip end adapter is controlled to move stepwise at a second step length when a difference between the maximum allowable distance and the spacing distance is smaller than the first step length and larger than the second step length;

the second step size is smaller than the first step size.

16. A method for controlling an end adapter of a robot arm, comprising:

acquiring a maximum allowable arc length;

17. The method of controlling a tip adapter of a robotic arm as claimed in claim 16, wherein if said position command is position information of a second craniotomy point, the step of controlling said tip adapter to move along said first spherical surface at said first location point according to said position command comprises:

18. The method of controlling a tip adaptor of a robot arm of claim 17, wherein the step of controlling the tip adaptor to move to a third location point by moving the tip adaptor in an arc motion with the first target point as a center of sphere and a distance between the first target point and the first location point as a radius comprises:

controlling the tip adapter to move toward the first target point.

19. The method of controlling a tip end adapter of a robot arm of claim 18, further comprising:

acquiring the maximum allowable arc length;

20. The method of controlling a tip adapter of a robotic arm of claim 19, wherein the tip adapter is controlled to move in steps at a second arc length when a difference between the maximum allowed arc length and the spaced arc length is less than the first arc length and greater than the second arc length;

the second arc length is less than the first arc length.

21. A surgical robotic system, comprising:

a robotic arm comprising a tip adapter; and

control device comprising a memory and a processor, the memory storing a computer program, characterized in that the processor realizes the steps of the method according to any one of claims 1 to 20 when executing the computer program.

22. A computer-readable storage medium, on which a computer program is stored, which, when being executed by a processor, carries out the steps of the method of any one of claims 1 to 20.