Anti-collision control method, device, medium and equipment

By constructing a safe zone surface and detecting the position of the robotic arm contour points in real time, the problem of collisions that are difficult to avoid in environments such as CT scanning rooms for master-slave robots has been solved, realizing fast and accurate collision avoidance control of the robotic arm and ensuring equipment safety.

CN114179079BActive Publication Date: 2024-11-01SHENGYI TECH (BEIJING) CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111453519.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-12-01
Publication Date
2024-11-01
Estimated Expiration
2041-12-01

AI Technical Summary

Technical Problem

In master-slave robot operation, especially in radiation-hazardous areas such as CT scan rooms, the movement trajectory of the robotic arm is difficult to predict in real time, making it difficult to avoid collisions with CT machines. Existing methods are computationally complex and time-consuming.

Method used

Construct a safe zone surface for the robotic arm's working area, extract end-effector contour points, establish a coordinate system, detect the position of contour points in real time, determine whether a collision occurs through the safe zone surface, and stop the movement when a collision is detected, issuing an alarm or adjusting control commands.

Benefits of technology

It enables robotic arms to quickly and accurately avoid collisions in complex environments, ensuring equipment safety, simplifying the modeling process, and improving real-time monitoring capabilities.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114179079B_ABST
    Figure CN114179079B_ABST
Patent Text Reader

Abstract

This article is about a method, device, medium and equipment for anti-collision control of a robot arm. The anti-collision control method of the robot arm includes: constructing a safe zone surface of the robot arm working area; extracting multiple contour points of the robot arm end and the actuator; establishing a first coordinate system with the center of the robot arm end as the origin, and determining the coordinates of multiple contour points; establishing a second coordinate system with the center of the robot arm base as the origin, and determining the position and posture matrix of the first coordinate system in the second coordinate system; determining the position of multiple contour points in the working area according to the relative position of the robot arm base and the working area, and the position and posture matrix. By real-time detection of the position of the robot arm contour points in the working area, the movement of the robot arm is controlled in time to prevent the robot arm from colliding with the device or equipment corresponding to the working area, thereby ensuring the safety of the equipment.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot control, and in particular to a method, device, medium and equipment for anti-collision control of a robot arm. Background Art

[0002] When the master-slave robot is operated, the master control end is usually a certain distance away from the slave robot, or in different rooms. Especially in some special application areas of medical robots, the slave robot is usually in a dangerous area with radiation, such as a CT scanning room, and the master control end is usually located in a radiation-free control room. Therefore, the safety requirements for the operation of the slave robot are very high. Especially for the slave robot used under CT, the robot needs to move the robotic arm and the special actuator it holds into the CT scanning hole, which is generally no more than 900mm in diameter. In such a small space, the robot also needs to complete various rotations, translations, punctures and other actions. How to ensure that the robotic arm and its actuators can move flexibly, quickly and accurately without colliding with the CT machine is a problem that CT-guided surgical robots must solve.

[0003] The traditional method of judging the collision of a robot arm in related technologies is to calculate the digital models of the robot arm and the object to be judged (such as a CT machine) according to the actual spatial position relationship, and determine whether the two models overlap in space. This method is accurate and direct, but it takes a long time, so it is usually used when the motion trajectory of the robot arm is known and fixed, and collision calculation and detection are performed when the motion trajectory of the robot arm is planned in advance. However, in a real-time control environment, the movement of the robot arm is completely controlled by the main end in real time, and the actual motion trajectory cannot be known in advance, making it difficult to avoid collisions between the robot arm and the CT machine. Summary of the invention

[0004] In order to overcome the problems existing in the related art, this article provides an anti-collision control method, device, medium and equipment for a robotic arm.

[0005] According to a first aspect of the present invention, a method for anti-collision control of a robot arm is provided, comprising:

[0006] Construct the safe zone surface of the robot's working area;

[0007] Extracting multiple contour points of the end of the robotic arm and the actuator;

[0008] Establishing a first coordinate system with the center of the end of the robotic arm as the origin, and determining the coordinates of the plurality of contour points;

[0009] Establishing a second coordinate system with the center of the robotic arm base as the origin, and determining the position and posture matrix of the first coordinate system in the second coordinate system;

[0010] The positions of the plurality of contour points in the working area are determined according to the relative position of the robot arm base and the working area, and the position and posture matrix.

[0011] Based on the above scheme, in some embodiments of this invention, the anti-collision control method of the robot arm further includes:

[0012] Receiving a control instruction from a user, and if the system state is a safe state, moving the robotic arm along the movement direction indicated by the control instruction;

[0013] When it is detected that any one of the plurality of contour points intersects or crosses the safety zone curved surface, the movement of the robot arm is stopped.

[0014] Based on the above solution, in some embodiments of this document, after stopping the movement of the robotic arm, the method further includes:

[0015] Marks the system status as out of bounds.

[0016] Based on the above scheme, in some embodiments of this invention, the anti-collision control method of the robot arm further includes:

[0017] After marking the system state as an out-of-bounds state, calculating the tangent plane of the intersection point of the contour point and the safety zone curved surface, and taking the normal direction pointing to the outside of the safety zone as the first direction;

[0018] When the robotic arm receives a manipulation instruction from the user again, it determines a second direction indicated by the manipulation instruction. If the angle between the second direction and the first direction is less than or equal to 90 degrees, an alarm message is issued and the robotic arm is refused to move in the second direction.

[0019] Based on the aforementioned scheme, in some embodiments of this article, if the angle between the second direction and the first direction is greater than 90 degrees, the robotic arm is controlled to move in the second direction; when the multiple contour points neither intersect nor cross the safety zone surface, the system state is marked as a safe state.

[0020] Based on the aforementioned scheme, in some embodiments of this article, the working area is a CT scanning hole, the safety zone surface is a combined surface of a cylindrical surface and a conical surface, and the inner diameter of the combined surface is smaller than the inner diameter of the CT scanning hole.

[0021] Based on the above solution, in some embodiments of this document, detecting that any contour point intersects or crosses the safety zone surface includes:

[0022] The real-time coordinates of the contour point are used to determine the radius r of the circle of the safety zone section where the real-time coordinates are located. k ;

[0023] Determine the distance D between the contour point and the central axis of the CT scanning hole k ;

[0024] If D k Greater than or equal to r k , it is judged as intersecting or crossing.

[0025] According to another aspect of the present invention, there is provided an anti-collision control device for a robotic arm, comprising:

[0026] A safety zone surface construction module is used to construct the safety zone surface of the robot's working area;

[0027] A contour extraction module, used to extract multiple contour points of the actuator at the end of the robot arm;

[0028] A first coordinate system establishment module, used to establish a first coordinate system with the center of the end of the robot arm as the origin, and determine the coordinates of the multiple contour points;

[0029] A second coordinate system establishment module, used to establish a second coordinate system with the center of the robotic arm base as the origin, and determine the position and posture matrix of the first coordinate system in the second coordinate system;

[0030] The contour point position determination module is used to determine the positions of the plurality of contour points in the working area according to the relative position of the robot arm base and the working area, and the position and posture matrix.

[0031] Based on the above solution, in some embodiments of this invention, the anti-collision control device of the robot arm further includes:

[0032] A control instruction receiving module, used to receive a user's control instruction, and if the system state is a safe state, move the robot arm along the movement direction indicated by the control instruction;

[0033] The control module is used to stop the movement of the robot arm when it is detected that any contour point among the multiple contour points intersects or crosses the safety zone curved surface.

[0034] According to another aspect of the present invention, a computer-readable storage medium is provided, on which a computer program is stored, and when the computer program is executed, the steps of the anti-collision control method of the robot arm are implemented.

[0035] According to another aspect of the present invention, a computer device is provided, comprising a processor, a memory and a computer program stored in the memory, wherein the processor implements the steps of the anti-collision control method of the robot arm when executing the computer program.

[0036] This paper constructs a safe zone surface of the working area and detects the position of the robot arm contour points in the working area in real time. When the robot arm contour points intersect or cross the safe zone surface of the working area, the movement of the robot arm can be controlled in time to prevent the robot arm from colliding with the device or equipment corresponding to the working area, thereby ensuring the safety of the equipment.

[0037] It is to be understood that the foregoing general description and the following detailed description are exemplary and explanatory only and are not restrictive of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS

[0038] The accompanying drawings constituting a part of this document are used to provide a further understanding of this document. The exemplary embodiments and descriptions of this document are used to explain this document and do not constitute an improper limitation on this document. In the accompanying drawings:

[0039] Figure 1 The figure is a flow chart of a method for preventing collision of a robot arm according to an exemplary embodiment.

[0040] Figure 2 is a schematic diagram of a robotic arm and a CT scanning hole according to an exemplary embodiment.

[0041] Figure 3 is a schematic diagram of a safety zone according to an exemplary embodiment.

[0042] Figure 4 is a schematic diagram of a safety zone according to an exemplary embodiment.

[0043] Figure 5 is a schematic diagram of a robotic arm according to an exemplary embodiment.

[0044] Figure 6 The invention is a block diagram of an anti-collision control device for a robot arm according to an exemplary embodiment.

[0045] Figure 7 The invention is a block diagram of an anti-collision control device for a robot arm according to an exemplary embodiment.

[0046] Figure 8 The figure is a flowchart of a robot arm working process according to an exemplary embodiment.

[0047] Fig. 9 The invention is a block diagram of a computer device according to an exemplary embodiment. DETAILED DESCRIPTION

[0048] In order to make the purpose, technical solutions and advantages of the embodiments of this article clearer, the technical solutions in the embodiments of this article will be clearly and completely described below in conjunction with the drawings in the embodiments of this article. Obviously, the described embodiments are part of the embodiments of this article, not all of the embodiments. Based on the embodiments in this article, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of this article. It should be noted that the embodiments in this article and the features in the embodiments can be combined with each other arbitrarily without conflict.

[0049] For master-slave robots, since the master control end is far away from the slave robot, or even not in the same room, when the master controls the robot to move, it cannot know the specific position of the slave robot's mechanical arm, and cannot make appropriate adjustments to the movement of the mechanical arm. Moreover, the mechanical arm of the slave robot is completely controlled by the master end in real time, and the actual movement trajectory of the mechanical arm cannot be known in advance, and a digital model cannot be established to accurately calculate the actual spatial position relationship between the mechanical arm and the working area. Therefore, this paper provides an anti-collision control method for the mechanical arm, which can quickly detect the spatial position relationship between the mechanical arm and the working area, and avoid collisions when the mechanical arm is controlled in real time.

[0050] Figure 1 The figure is a flow chart of a method for preventing collision of a robot arm according to an exemplary embodiment.

[0051] refer to Figure 1 The anti-collision control method includes at least steps S11 to S15, which are described in detail as follows:

[0052] Step S11, constructing a safety zone surface of the robot arm working area;

[0053] The robot controls the manipulator arm to perform various complex operations, such as moving objects or even performing surgical operations. When the motion trajectory of the manipulator arm is known or determined, an accurate digital model of the surrounding work area can be established to ensure that the manipulator arm will not collide with the surrounding work area during movement. However, in some cases, the movement of the manipulator arm is controlled by the control signal of the control end. For example, when the robot performs a puncture operation, the doctor adjusts the puncture angle at any time according to the relative position of the puncture needle and the puncture position shown in the CT image. The position angle of the manipulator arm also changes at any time. The motion trajectory of the manipulator arm is uncertain. Therefore, it is difficult to prevent the collision between the manipulator arm and the CT scan hole by establishing a digital model of the CT scan hole.

[0054] Furthermore, it takes a long time to establish a digital model of the CT scanning hole, which is not conducive to the improvement of existing equipment.

[0055] Therefore, this article provides a method for constructing a safety zone surface of a robot arm working area. In an exemplary embodiment, the working area is a CT scanning hole, and the safety zone surface is a combined surface of a cylindrical surface and a conical surface, and the inner diameter of the combined surface is smaller than the inner diameter of the CT scanning hole.

[0056] Figure 2 1 is a schematic diagram of a manipulator and a CT scanning hole according to an exemplary embodiment. In the figure, 1 is a manipulator, 2 is a CT scanning hole, and 3 is a safety zone. The safety zone is determined according to the shape of the CT scanning hole. Since the inside of the CT scanning hole is a cylindrical surface, and the side close to the manipulator is an approximate conical surface, a CT scanning hole safety zone with low complexity can be designed, that is, a cylindrical surface and a conical surface connected thereto are designed so that the center of the cylindrical surface or the conical surface coincides with the center of the CT scanning hole, and the inner diameter is smaller than the inner diameter of the CT scanning hole. For example, in one embodiment, the conical surface and the cylindrical surface can be set to be 10 cm smaller than the inner diameter of the actual CT scanning hole. Setting the size of the safety zone smaller than the actual size of the CT scanning hole can further improve the safety factor. In practical applications, the size of the safety zone can be determined according to the specific size of the working area. When the data accuracy of the safety zone model is high, the size of the safety zone can be made close to the actual size of the working area.

[0057] Figure 3 , Figure 4 FIG. 1 is a schematic diagram of a safety zone according to an exemplary embodiment. Figure 3 , Figure 4 , set the coordinate system of the CT machine to a coordinate system with a point farthest from the center of the CT scanning hole as the origin (X c , Y c , Z c ). The safe zone range is set as follows: r1 is the radius of the cylinder, r2 is the radius of the largest end of the cone, z1 is the Z-axis value of the farthest end of the cylinder, z2 is the Z-axis value at the intersection of the cylinder and the cone, and z3 is the Z-axis value of the largest end of the cone. It can be seen that the size of the safe zone is limited by z1, z2, z3, r1, and r2. This greatly simplifies the model data of the robot's working area and shortens the workload of building the model.

[0058] As long as the contour of any point of the robotic arm does not exceed the safe zone surface when it moves, it can be ensured that the robotic arm will not collide with the CT scanning hole, ensuring the safety of the equipment.

[0059] A simple safety zone surface is constructed according to the working area of ​​the robot arm. While ensuring that the robot arm will not collide with the equipment, a mathematical model can be quickly established for detecting the position of the robot arm, which is conducive to the rapid promotion and use of this method.

[0060] Those skilled in the art should understand that in this embodiment, the safety zone is a curved surface, which is a combination of a cylindrical surface and a conical surface, and is a simple safety zone established when the working area is a CT scanning hole. When the working area is the internal space of other equipment, the safety zone can be established according to the internal space of the specific equipment.

[0061] Step S12, extracting multiple contour points of the end of the robot arm and the actuator.

[0062] When the robot arm is working, an actuator is installed at the end of the robot arm. For example, when performing a puncture operation, a puncture needle is installed at the end of the robot arm. The actuator and the end of the robot arm will extend into the CT scanning hole to perform the operation. Therefore, the actuator or the end of the robot arm may collide with the equipment.

[0063] In order to ensure that the end of the robot arm or the actuator does not collide with the equipment in the working area during operation, it is only necessary to extract multiple outer contour points of the end of the robot arm or the actuator, monitor the positional relationship between the multiple outer contour points and the safety zone surface, and prevent the multiple outer contour points from intersecting or crossing the safety zone surface, thereby preventing the end of the robot arm or the actuator from colliding with the equipment. The number of outer contour points is determined by the specific shape of the end of the robot arm and the actuator, and the outer contour points are the most likely locations to collide with the equipment.

[0064] By extracting contour points at the end of the robot arm or on the actuator, the model data of the robot arm is simplified and the amount of monitoring data is reduced.

[0065] Step S13, establishing a first coordinate system with the center of the end of the robot arm as the origin, and determining the coordinates of multiple contour points.

[0066] Figure 5 is a schematic diagram of a robotic arm according to an exemplary embodiment. Figure 5 , the contour points can be identified as points P1, P2, ...P n The first coordinate system is established with the center of the end of the robot arm as the origin (X t , Y t , Z t ), we can get the coordinates of all these contour points in this coordinate system

[0067] Step S14, establishing a second coordinate system with the center of the robot base as the origin, and determining the position and posture matrix of the first coordinate system in the second coordinate system.

[0068] Since the robot is installed on the robot base, the second coordinate system (X r , Y r , Zr ), from which the origin of the robot arm end coordinate system O can be determined t The position and posture of the robot coordinate system are expressed using the matrix It means that the matrix is ​​obtained from the robot controller in real time, and the value of the matrix changes in real time when the robot moves.

[0069] Step S15, determining the positions of multiple contour points in the working area according to the relative position of the robot base and the working area, and the position and posture matrix.

[0070] Since the positions of the robot base and the working area of ​​the CT device are relatively fixed, their positional relationship is expressed by a matrix It represents the position and posture of the origin of the robot coordinate system in the CT coordinate system.

[0071] Therefore, at any time, the kth contour point on the end effector of the robot The position in the CT coordinate system is in,

[0072]

[0073] As long as all contour points Within the safety zone surface, it can be ensured that the robot arm will not collide with the CT device. This embodiment constructs a safety zone surface model of the robot arm's working area, extracts multiple contour points from the robot arm and the actuator, and determines the positions of the multiple contour points in the working area, thereby replacing a complex mathematical model and simplifying the modeling process.

[0074] In an exemplary embodiment, the anti-collision control method further includes:

[0075] Receive the user's control command, and if the system state is in a safe state, move the robot arm along the movement direction indicated by the control command;

[0076] When it is detected that any contour point among multiple contour points intersects or crosses the safety zone surface, the movement of the robot arm is stopped.

[0077] After establishing the mathematical model of the positions of the multiple contour points in the working area as described above, the position of the robot arm can be monitored in real time. If multiple contour points are located within the safe zone surface, the system is marked as safe. For example, before the puncture surgery, the robot arm has not yet reached the working area of ​​the puncture surgery and is far away from the CT scanning hole. At this time, the system is in a safe state. For another example, during the puncture surgery, the robot arm extends into the CT scanning hole, but the coordinates of multiple contour points are within the range of the safe zone surface. At this time, the system is in a safe state.

[0078] In a safe state, the user's control instructions are received. For example, the doctor controls the movement of the robotic arm through the control handle and moves the robotic arm along the movement direction indicated by the control instruction.

[0079] During the movement of the robot arm, the position coordinates of multiple contour points in the CT coordinate system are monitored at any time. When it is detected that any contour point among the multiple contour points intersects or crosses the safety zone surface, the movement of the robot arm is stopped.

[0080] In this embodiment, it is possible to sequentially calculate whether n contour points intersect or cross the safety zone surface. If any contour point intersects or crosses the safety zone surface, the calculation of the remaining contour points is stopped, and the movement of the robot arm is stopped. k represents the kth contour point P k Whether it intersects or crosses the safety zone surface, X k = false means neither intersecting nor crossing, X k = true means intersecting or crossing. sys Indicates whether the whole intersects or crosses:

[0081] X sys =X1||X2||…||X n .

[0082] By further simplifying the judgment logic, accelerating the acquisition of monitoring data, and improving the real-time performance of monitoring, the detection results are quickly fed back and the movement of the robotic arm is stopped after the contour point intersects or crosses the safe zone surface, ensuring that the robotic arm will not collide with the CT equipment.

[0083] In an exemplary embodiment, when the working area is a CT scanning hole, detecting that any contour point intersects or crosses the safety zone surface includes:

[0084] The real-time coordinates of the contour point are used to determine the radius r of the circle in the safety zone section where the real-time coordinates are located. k ;

[0085] Determine the distance D between the contour point and the central axis of the CT scan hole k ;

[0086] If D k Greater than or equal to r k , it is judged as intersecting or crossing.

[0087] For example, the kth contour point P k , the real-time coordinates in the CT coordinate system are X k The calculation is as follows:

[0088]

[0089] D k and r k The calculation of is as follows: According to the safety zone model, the safety zone can be obtained The safety zone of the cross section is a circle with a radius of r k

[0090]

[0091] The kth contour point P k The distance from the Z axis of the CT coordinate system is D k ,but

[0092]

[0093] Determine the kth contour point P k Whether it intersects or crosses the safety zone, we only need to judge D k Is it greater than r k , if D k Greater than or equal to r k , then it is judged as intersecting or crossing, otherwise it is neither intersecting nor crossing.

[0094] In practical applications, the real-time coordinates of the contour points may be real-time coordinates in other coordinate systems.

[0095] According to the specific characteristics of CT scanning holes, the mathematical model is further simplified, the amount of calculation is reduced, the detection speed is improved, and the movement of the robot arm is stopped in a shorter time after the contour point intersects or crosses the safety zone to avoid collision.

[0096] While stopping the movement of the robotic arm, an alarm message can also be issued to remind the user that the robotic arm has crossed the safety zone and stopped moving.

[0097] In an exemplary embodiment, after stopping the movement of the robotic arm, the anti-collision control method of the robotic arm further includes: marking the system state as an out-of-bounds state.

[0098] When the robot moves to a point where the contour intersects or crosses the safety zone, and the control device stops the movement of the robot, the system status is marked as an out-of-bounds state. After the robot receives a new control instruction, it restricts the robot from moving in the direction where a collision may occur based on the current state being an out-of-bounds state. Alternatively, when the robot moves to a point where the contour intersects or crosses the safety zone, a sudden power outage occurs. After powering on again, the robot will not move the robot in the direction indicated by the control instruction, but will conditionally execute the control instruction based on the current state being an out-of-bounds state, to prevent the robot from further moving and causing a collision.

[0099] In an exemplary embodiment, the anti-collision control method of the robot arm further includes:

[0100] After marking the system state as out-of-bounds, calculate the tangent plane of the intersection point of the contour point and the safety zone surface, and take the normal direction pointing to the outside of the safety zone as the first direction;

[0101] When the robotic arm receives the user's control instruction again, it determines the second direction indicated by the control instruction. If the angle between the second direction and the first direction is less than or equal to 90 degrees, an alarm message is issued and the robotic arm is refused to move in the second direction.

[0102] After marking the system state as out-of-bounds, the normal pointing to the outside of the safety zone is used as the first direction according to the section of the intersection of the contour point in the out-of-bounds state and the safety zone surface. When the user controls the robot again, the robot first determines the movement direction indicated by the control instruction as the second direction according to the control instruction issued by the user. If the angle between the second direction and the first direction is less than or equal to 90 degrees, there is still a possibility of collision when moving in the second direction. At this time, the robot issues a warning message and refuses the robot arm to move in the second direction.

[0103] In an exemplary embodiment, if the angle between the second direction and the first direction is greater than 90 degrees, it is considered that the robot arm moves in this direction without collision, and the robot executes the control instruction.

[0104] In the out-of-bounds state, control instructions are executed conditionally to ensure that the robotic arm does not collide and ensure the safety of the equipment.

[0105] When all the multiple contour points neither intersect nor cross the safety zone surface, the system state is marked as a safe state.

[0106] In a safe state, control instructions can be executed unconditionally, improving the response speed of the robot arm.

[0107] Through the above embodiments, the anti-collision control method of the robot arm provided in this article simplifies the calculation of the safety zone, speeds up the calculation speed, and can meet the needs of real-time monitoring. When the robot arm crosses the boundary, the robot arm can continue to be controlled by the main end to return to the safety zone without worrying about the occurrence of collision. The continuity of CT scanning is guaranteed and the surgical process is accelerated.

[0108] Figure 6 is a block diagram of a collision avoidance control device for a robot arm according to an exemplary embodiment. Figure 6 The anti-collision control device of the robot arm includes: a safety zone surface construction module 601, a contour extraction module 602, a first coordinate system establishment module 603, a second coordinate system establishment module 604, and a contour point position determination module 605.

[0109] The safety zone surface construction module 601 is configured to construct a safety zone surface of a robot arm working area.

[0110] The contour extraction module 602 is configured to extract multiple contour points of the actuator at the end of the robot arm.

[0111] The first coordinate system establishing module 603 is configured to establish a first coordinate system with the center of the end of the robot arm as the origin, and determine the coordinates of multiple contour points.

[0112] The second coordinate system establishing module 604 is configured to establish a second coordinate system with the center of the robot base as the origin, and determine the position and posture matrix of the first coordinate system in the second coordinate system.

[0113] The contour point position determination module 605 is configured to determine the positions of multiple contour points in the working area according to the relative position of the robot base and the working area, and the position and posture matrix.

[0114] Figure 7 is a block diagram of a collision avoidance control device for a robot arm according to an exemplary embodiment. Figure 7 The anti-collision control device of the robotic arm also includes: a control instruction receiving module 701 and a control module 702.

[0115] The control instruction receiving module 701 is configured to receive a user's control instruction, and if the system state is a safe state, move the robot arm along the movement direction indicated by the control instruction.

[0116] The control module 702 is configured to stop the movement of the robot arm when it is detected that any contour point among the plurality of contour points intersects or crosses the safety zone surface.

[0117] In order to better understand the anti-collision control method of a robotic arm provided in this article, an example is given to illustrate. Specific embodiment one:

[0119] Figure 8 is a flowchart of a robot arm working process according to an exemplary embodiment. Figure 8 After constructing the safe zone surface model of the robot arm's working area (CT scan hole) and the posture matrix model of the robot arm's end, the safe zone surface model and the posture matrix model are input into the robot system. After the robot system is started, the robot system simultaneously calculates the position of the robot arm's end contour point in the safe zone marked on the safe zone surface in real time based on the safe zone surface model and the posture matrix model. When receiving the user's control command, determine the movement direction V of the robot arm. The robot system determines whether the end of the robot arm intersects or crosses the safe zone at the current moment, thereby determining whether the system state is a safe state or an out-of-bounds state, and the safe state is marked as S=S 安全 ; The out-of-bounds status is marked as S=S 越界 .

[0120] If the current system state is a safe state, the robot executes the control command and controls the movement of the manipulator. During the movement of the manipulator, the robot system calculates the position of the contour point at the end of the manipulator in the safety zone marked by the safety zone surface in real time. If all contour points neither intersect nor cross the safety zone, the system state is determined to be a safe state; if any contour point intersects or crosses the safety zone, the system state is determined to be an out-of-bounds state.

[0121] If any contour point is found to intersect or cross the safety zone, the first direction in the cross-border state is recorded. The first direction is the normal of the tangent plane of the intersection of the cross-border contour point and the safety zone surface pointing to the outside of the safety zone. The first direction is marked as V 越界 . Stop the movement of the robot arm and mark the system state as S=S 越界 .

[0122] In the out-of-bounds state, receive a user control instruction, determine that the movement direction V indicated by the control instruction is the second direction, and calculate V and V 越界 If the angle is greater than 90 degrees, the robot arm is controlled to move in the movement direction V; if the angle is less than or equal to 90 degrees, the robot arm is refused to move in the movement direction V indicated by the control instruction, and an alarm message is issued to prompt the user to change the control direction so that the robot arm moves in the opposite direction.

[0123] The anti-collision control method of the robotic arm provided in this article can effectively prevent the robotic arm from colliding with the device or equipment corresponding to the working area, thereby ensuring the safety of the equipment.

[0124] Fig. 9 is a block diagram of a computer device 900 for anti-collision control of a robot arm according to an exemplary embodiment. For example, the computer device 900 may be provided as a server. Fig. 9 The computer device 900 includes a processor 901, and the number of processors can be set to one or more as needed. The computer device 900 also includes a memory 902, which is used to store instructions that can be executed by the processor 901, such as application programs. The number of memories can be set to one or more as needed. The application programs stored therein can be one or more. The processor 901 is configured to execute instructions to execute the above-mentioned collision avoidance control method of the robot arm.

[0125] It should be understood by those skilled in the art that the embodiments of this article can be provided as methods, devices (equipment), or computer program products. Therefore, this article can adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Moreover, this article can adopt the form of a computer program product implemented on one or more computer-usable storage media containing computer-usable program codes. Computer storage media include volatile and non-volatile, removable and non-removable media implemented in any method or technology for storing information (such as computer-readable instructions, data structures, program modules or other data), including but not limited to RAM, ROM, EEPROM, flash memory or other memory technology, CD-ROM, digital versatile disk (DVD) or other optical disk storage, magnetic cassette, magnetic tape, disk storage or other magnetic storage device, or any other medium that can be used to store desired information and can be accessed by a computer. In addition, it is well known to those of ordinary skill in the art that communication media generally contain computer-readable instructions, data structures, program modules or other data in modulated data signals such as carrier waves or other transmission mechanisms, and may include any information delivery medium.

[0126] This document is described with reference to flowcharts and / or block diagrams of methods, apparatuses (devices) and computer program products according to the embodiments of this document. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor or other programmable data processing device to produce a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0127] These computer program instructions may also be stored in a computer readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer readable memory produce an article of manufacture including an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0128] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0129] In this article, the term "comprises", "comprising" or any other variation thereof is intended to cover non-exclusive inclusion, so that an article or device comprising a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such article or device. In the absence of more restrictions, the elements defined by the sentence "comprising..." do not exclude the presence of other identical elements in the article or device comprising the elements.

[0130] Although the preferred embodiments of this invention have been described, those skilled in the art may make additional changes and modifications to these embodiments once they have learned the basic creative concept. Therefore, the appended claims are intended to be interpreted as including the preferred embodiments and all changes and modifications falling within the scope of this invention.

[0131] Obviously, those skilled in the art can make various changes and modifications to this article without departing from the spirit and scope of this article. Thus, if these modifications and variations of this article fall within the scope of the claims and their equivalents, then the intention of this article also includes these modifications and variations.

Claims

1. A method for preventing collision of a robot arm, characterized in that: include: Construct the safe zone surface of the robot's working area; Extracting multiple contour points of the end of the robotic arm and the actuator; Establishing a first coordinate system with the center of the end of the robotic arm as the origin, and determining the coordinates of the plurality of contour points; Establishing a second coordinate system with the center of the robotic arm base as the origin, and determining the position and posture matrix of the first coordinate system in the second coordinate system; Determining the positions of the plurality of contour points in the working area according to the relative position of the robot arm base and the working area, and the position and posture matrix; Receiving a control instruction from a user, and if the system state is a safe state, moving the robotic arm along the movement direction indicated by the control instruction; When it is detected that any contour point among the plurality of contour points intersects or crosses the safety zone curved surface, the movement of the robot arm is stopped, and the system state is marked as an out-of-bounds state; After marking the system state as an out-of-bounds state, calculating the tangent plane of the intersection point of the contour point and the safety zone curved surface, and taking the normal direction pointing to the outside of the safety zone as the first direction; When the robotic arm receives a manipulation instruction from the user again, it determines a second direction indicated by the manipulation instruction. If the angle between the second direction and the first direction is less than or equal to 90 degrees, an alarm message is issued and the robotic arm is refused to move in the second direction.

2. The anti-collision control method of a robot arm according to claim 1, characterized in that: If the angle between the second direction and the first direction is greater than 90 degrees, the robot arm is controlled to move in the second direction; when the multiple contour points neither intersect nor cross the safety zone surface, the system state is marked as a safe state.

3. The anti-collision control method of a robot arm according to claim 1, characterized in that: The working area is a CT scanning hole, the safety zone curved surface is a combined curved surface of a cylindrical curved surface and a conical curved surface, and the inner diameter of the combined curved surface is smaller than the inner diameter of the CT scanning hole.

4. The anti-collision control method of a robot arm as claimed in claim 3, characterized in that: Detecting that any contour point intersects or crosses the safety zone surface includes: The real-time coordinates of the contour point are used to determine the radius r of the circle of the safety zone section where the real-time coordinates are located. k ; Determine the distance D between the contour point and the central axis of the CT scanning hole k ; If D k Greater than or equal to r k , it is judged as intersecting or crossing.

5. An anti-collision control device for a robotic arm, characterized in that: include: A safety zone surface construction module is used to construct the safety zone surface of the robot's working area; A contour extraction module, used to extract multiple contour points of the actuator at the end of the robot arm; A first coordinate system establishment module, used to establish a first coordinate system with the center of the end of the robot arm as the origin, and determine the coordinates of the multiple contour points; A second coordinate system establishment module, used to establish a second coordinate system with the center of the robotic arm base as the origin, and determine the position and posture matrix of the first coordinate system in the second coordinate system; A contour point position determination module, used to determine the positions of the plurality of contour points in the working area according to the relative position of the robot base and the working area, and the position and posture matrix; An operation instruction receiving module, used for receiving a user's operation instruction, and if the system state is a safe state, moving the mechanical arm along the movement direction indicated by the operation instruction; A control module, configured to stop the movement of the robot arm and mark the system state as an out-of-bounds state when detecting that any contour point among the plurality of contour points intersects or crosses the safety zone curved surface; A calculation module, used for calculating a tangent plane of an intersection point between the contour point and the safety zone surface after marking the system state as an out-of-bounds state, and taking a normal direction pointing to the outside of the safety zone as a first direction; The alarm module is used to determine the second direction indicated by the control instruction when the robot arm receives the user's control instruction again. If the angle between the second direction and the first direction is less than or equal to 90 degrees, an alarm message is issued and the robot arm is refused to move in the second direction.

6. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed, the steps of the method according to any one of claims 1 to 4 are implemented.

7. A computer device comprising a processor, a memory and a computer program stored in the memory, characterized in that: When the processor executes the computer program, the steps of the method according to any one of claims 1 to 4 are implemented.