Partitioned mechanical arm cooperation method under non-real-time system
Through the partition planning and critical area management of the robotic arm motion trajectory, the problem of low efficiency of multi-robot joint control in non-real-time systems is solved, and efficient and safe multi-robot joint control is achieved.
Patent Information
- Application Number
- CN202411312741.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-20
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2044-09-20
AI Technical Summary
The robotic arms cannot obtain real-time position feedback during movement under the non-real-time operating system, resulting in low efficiency of coordinated control of multiple robotic arms and requires human intervention, so that the coordinated movement of multiple robotic arms cannot be effectively handled.
Through the partition planning and critical area management of the robotic arm movement trajectory, combined with position query under the stop state of the robotic arm, the partitioned control method is adopted to achieve coordinated control of multiple robotic arms, avoid collisions and improve efficiency.
It improves the operating efficiency and automation of the robotic arms, reduces manpower intervention, ensures the safety and stability of the coordinated control of multiple robotic arms, and prevents collisions between robotic arms.
Smart Images

Figure CN118906062A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of robot arm control, and in particular relates to a partitioned robot arm collaboration method in a non-real-time system. Background Art
[0002] For non-real-time operating systems, such as the Android system, when dealing with the coordinated control of multiple robotic arms, it is impossible to perform path planning based on real-time position feedback. When the robotic arm is in motion, it may take a long time for the system to process the data when it queries the position, and the time is not fixed. At this time, the position data is invalid. The query position is only valid when the robotic arm is in a stopped state. Therefore, the current control of the robotic arm of the non-real-time operating system is generally only for a single robotic arm, and the control is performed step by step when the robotic arm stops moving. The operation efficiency is low and it costs a lot of manpower. Summary of the invention
[0003] In view of the deficiencies in the above-mentioned prior art, the present invention aims to provide a partitioned robotic arm collaboration method under a non-real-time system, which realizes multi-robotic arm collaborative control through advance partition planning of the robotic arm motion trajectory combined with position query when the robotic arm is in a stopped state, thereby improving the operating efficiency of the robotic arm, having a high degree of automation and saving manpower.
[0004] In order to achieve the above object, the present invention provides a partitioned robotic arm collaboration method in a non-real-time system, comprising the steps of:
[0005] S1: dividing an area within a preset range where the initial position of the robot arm is located into a safety area, dividing a critical area between adjacent safety areas, and separating the critical area from the safety area by a first safety distance;
[0006] S2: Get the next instruction;
[0007] S3: Determine whether the instruction is a robot arm action instruction, if yes, proceed to the subsequent steps, otherwise return to step S2;
[0008] S4: Determine whether the target path of the robot arm overlaps with the safety area of the adjacent robot arm. If so, send a first control instruction to enable the control system to enter a planning control mode, and all the robot arms operate according to the first control scheme, and proceed to step S6; otherwise, proceed to step S5;
[0009] S5: Determine whether the control system is in the planning control mode and whether the target path of at least one of the robotic arms overlaps with the safety area of the adjacent robotic arm, if so, proceed to step S6; otherwise, proceed to step S7;
[0010] S6: Select the first control scheme to execute the robot arm motion instruction, and return to step S2;
[0011] S7: Determine whether the control system is in the planning control mode and the target path of any of the robotic arms overlaps with the safety area of the adjacent robotic arm, and if so, send a second control instruction to make the control system exit the planning control mode and proceed to step S8; otherwise, directly proceed to step S8;
[0012] S8: Determine whether the target path of the robot arm overlaps with the critical region. If so, select the second control scheme to execute the robot arm motion instruction and proceed to step S10; otherwise, proceed to step S9;
[0013] S9: directly execute the robot arm motion instruction and return to step S2;
[0014] S10: the robot arm requests the right to use the critical area;
[0015] S11: Determine whether the critical area is idle; if so, allocate the right to use the critical area to the robot arm; if occupied, the robot arm waits in a queue, and after the critical area is unoccupied and idle, the robot arm obtains the right to use the critical area;
[0016] S12: Execute the robot arm motion instruction. After executing the robot arm motion instruction, the robot arm exits the critical area, notifies the critical area that it is free, and returns to its own safe area; return to step S2.
[0017] As an implementation method, the first control scheme includes the steps of:
[0018] S41: the current robot arm obtains planning authority, and determines whether the current robot arm obtains planning authority successfully. If yes, proceed to the subsequent steps; otherwise, repeat step S41;
[0019] S42: taking the robotic arm that obtains the planning authority as the first target robotic arm;
[0020] S43: Determine whether the target path of the first target robot arm has an overlapping portion with the target path of the other adjacent robot arm; if not, plan the target path and target task of the first target robot arm, and return to step S2 after executing the target path and the target task; if yes, take the other robot arm with the overlapping portion as the second target robot arm, and directly proceed to step S44; the target path includes a moving trajectory from the starting position to the target position;
[0021] S44: determining whether the second target robotic arm is in a planning incomplete state, and continuing with subsequent steps after the second target robotic arm is in a state of releasing the planning incomplete state;
[0022] S45: Determine whether the target path of the second target robot arm causes an obstacle to the first target robot arm; if so, proceed to step S46 after performing an obstacle avoidance operation on the second target robot arm; otherwise, proceed directly to step S46;
[0023] S46: planning the target path and the target task of the first target robotic arm;
[0024] S47: After adjusting the moving speed of the first target robot arm, execute the target path and the target task, and return to step S2.
[0025] As an implementation manner, the preset rule is applied to a number of threads that are executed simultaneously.
[0026] As an implementation manner, the overlapping portion includes the moving trajectories of different robot arms plus an overlapping portion of a second safety distance range around the moving trajectory.
[0027] As an implementation manner, the step S44 further includes the steps of:
[0028] S441: Determine whether the second target robot arm is in an unfinished planning state. If so, it indicates that there are other threads, and proceed to step S442; otherwise, directly proceed to step S45;
[0029] S442: setting the first target robot arm to a planning unfinished state, releasing the planning authority, and entering a waiting state;
[0030] S443: The second target robotic arm wakes up the first target robotic arm after releasing the unfinished planning state in the other threads, and the first target robotic arm reacquires the planning authority.
[0031] As an implementation manner, the step S45 further includes the steps of:
[0032] S451: Determine whether the target path of the second target robot arm causes an obstruction to the first target robot arm; if so, proceed to step S452; otherwise, proceed directly to step S46;
[0033] S442: inserting an obstacle avoidance movement instruction into the second target robotic arm, setting the first target robotic arm to an uncompleted planning state, and releasing the planning authority; the robotic arm motion instruction includes the obstacle avoidance movement instruction;
[0034] S443: the first target robot arm enters waiting mode;
[0035] S444: The second target robotic arm wakes up the first target robotic arm when starting to execute the obstacle avoidance movement instruction, and the first target robotic arm reacquires the planning authority, and continues to step S46.
[0036] As an implementation manner, whether the target path of the second target robotic arm causes an obstruction to the first target robotic arm is determined based on the moving directions of the first target robotic arm and the second target robotic arm, the starting position and the target position of the target path.
[0037] As an embodiment, when the first target robotic arm and the second target robotic arm move in the same direction, and when the starting position of the second target robotic arm is located on the target path of the first target robotic arm, and the target position of the second target robotic arm is located on the target path of the first target robotic arm; it is determined that the target path of the second target robotic arm causes an obstruction to the first target robotic arm.
[0038] As an implementation mode, when the first target robotic arm and the second target robotic arm move toward each other, and when the target position of the second target robotic arm is located at or passes through the target path of the first target robotic arm; it is determined that the target path of the second target robotic arm causes an obstruction to the first target robotic arm.
[0039] As an implementation manner, when the first target robotic arm and the second target robotic arm move towards or in the same direction, and the starting position of the first target robotic arm is located on the target path of the second target robotic arm; an abnormality is reported.
[0040] The present invention adopts the above technical solution, so it has the following beneficial effects:
[0041] In the present invention, different preset control schemes are used to control the robot arm by preset partitions and according to the overlapping state of the target path and each partition; the control of the robot arm is simplified in some control schemes to improve the control efficiency of the robot arm; the control of multiple robot arms is made more flexible, which can effectively improve the efficiency of the robot arm in performing tasks, and the operation safety and stability are stronger. By planning the entry and exit of the control mode, it is ensured that when the target path of the robot arm overlaps with the safety area of the adjacent robot arm, the planning of the robot arm will not hinder the robot arm of other control schemes, thereby ensuring the effectiveness of robot arm planning and task execution. When the second control scheme is selected to run the robot arm action instruction, the robot arm requests the right to use the critical area, and notifies the critical area that it is free after exiting the critical area, which can ensure that there is only one robot arm moving and performing tasks in the critical area, preventing collisions between robot arms, and ensuring the effectiveness of robot arm path planning and task execution. When the first control scheme is selected to run the robot action instruction, by judging whether the target path of the current target robot arm has an overlapping part with the target path of the remaining robot arms other than the previous target robot arm, and the subsequent transfer authority and obstacle avoidance steps, collisions between robot arms can be effectively prevented, and the effective operation of each robot arm can be ensured. The overlapping part includes the overlapping part of the movement trajectory of different robot arms plus the second safety distance range of the outer periphery of the movement trajectory, which can effectively ensure that there is no collision between robot arms. The robot arm cooperation method of the present invention can be applied to several synchronously executed threads, and one or more threads can simultaneously execute the robot arm cooperation method of the first control scheme. When the target path of the second target robot arm causes an obstacle to the first target robot arm, an obstacle avoidance movement instruction is inserted into the second target robot arm, so that the second target robot arm can perform the steps of this method in a new thread and perform obstacle avoidance operations. In the case of multiple robot arms, the obstruction judgment and obstacle avoidance operations of adjacent robot arms can be realized diffusely, while reducing the program complexity of a single thread and improving the overall operation efficiency of the system. An error reporting mechanism is set in the present invention, and an error can be reported in time after a planning error is found, so as to ensure the safety and effectiveness of path planning. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0043] Figure 1 This is a general flow chart of a partitioned robotic arm collaboration method in a non-real-time system according to an embodiment of the present application;
[0044] Figure 2A schematic diagram of the partition structure of an embodiment of the present application;
[0045] Figure 3 This is a flow chart of a first control scheme of an embodiment of the present application;
[0046] Figure 4 This is a schematic diagram of a non-overlapping state of a target path of a robotic arm in a first control scheme of an embodiment of the present application;
[0047] Figure 5-6 This is a schematic diagram of a state where the target paths of the robot arms of the first control scheme of an embodiment of the present application overlap and travel in the same direction;
[0048] Figure 7-Figure 8 This is a schematic diagram of a state where the target paths of the robotic arms of the first control scheme of an embodiment of the present application overlap and move toward each other;
[0049] Fig. 9 This is a schematic diagram of an error reporting state in which the target paths of the robot arms overlap and move in opposite directions according to the first control scheme of an embodiment of the present application;
[0050] Description of Figure Numbers:
[0051] 1- Safe area;
[0052] 2- Critical region. DETAILED DESCRIPTION
[0053] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of the present invention.
[0054] In the description of the present invention, it should be noted that the terms "upper", "lower", "left", "right", "center", "vertical", "horizontal", "inner", "outer", etc. indicate positions or positional relationships based on the positions or positional relationships shown in the accompanying drawings, which are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", "third", etc. are only used for descriptive purposes and cannot be understood as indicating or implying relative importance.
[0055] In the description of the present invention, it should be noted that, unless otherwise clearly specified and limited, the terms "installation", "setting", "connection", "connection" and the like should be understood in a broad sense. For example, "connection" can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be an indirect connection through an intermediate medium, or the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0056] Example 1
[0057] See also Figure 1 and Figure 2 , a partitioned robot arm collaboration method in a non-real-time system according to the first embodiment of the present invention is applicable to a robot arm arranged along a straight track, and the robot arm needs to obtain the planning authority before performing the target path planning; comprising the steps of:
[0058] S1: Divide the area within the preset range where the initial position of the robot arm is located into a safety area 1, divide a critical area 2 between adjacent safety areas 1, and separate the critical area 2 from the safety area 1 by a first safety distance a;
[0059] Safety area 1 is the area where the robot arm can move freely, and one safety area 1 corresponds to one robot arm.
[0060] Critical area 2 is the area where two adjacent robotic arms need to collaborate to process tasks, and only one robotic arm is allowed to be in this area at the same time.
[0061] The first safety distance a is the minimum distance between the safety area 1 and the adjacent critical area 2, ensuring that no collision will occur even if there are robotic arms on the boundaries of the safety area 1 and the critical area 2.
[0062] S2: Get the next instruction;
[0063] S3: Determine whether the instruction is a robot arm action instruction, if yes, proceed to the subsequent steps, otherwise return to step S2;
[0064] S4: Determine whether the target path of the robot arm overlaps with the safety area 1 of the adjacent robot arm. If so, send a first control instruction to enable the control system to enter the planning control mode, and all the robot arms operate according to the first control scheme, and proceed to step S6; otherwise, proceed to step S5;
[0065] S5: Determine whether the control system is in the planning control mode and whether the target path of at least one of the robotic arms overlaps with the safety area 1 of the adjacent robotic arm, if so, proceed to step S6; otherwise, proceed to step S7;
[0066] S6: Select the first control scheme to execute the robot arm motion instruction, and return to step S2;
[0067] S7: Determine whether the control system is in the planning control mode and the target path of any of the robotic arms overlaps with the safety area 1 of the adjacent robotic arm. If so, send a second control instruction to make the control system exit the planning control mode and proceed to step S8; otherwise, proceed directly to step S8;
[0068] S8: Determine whether the target path of the robot arm overlaps with the critical region 2. If so, select the second control scheme to run the robot arm motion instruction and proceed to step S10; otherwise, proceed to step S9;
[0069] S9: directly execute the robot arm motion instruction and return to step S2;
[0070] S10: the robot arm requests the right to use the critical area 2;
[0071] S11: Determine whether the critical area 2 is idle; if it is idle, assign the right to use the critical area 2 to the robot arm; if it is occupied, the robot arm waits in a queue, and after the critical area 2 is unoccupied and idle, the robot arm obtains the right to use the critical area 2;
[0072] S12: Execute the robot arm motion instruction. After executing the robot arm motion instruction, the robot arm exits the critical area 2, notifies the critical area 2 to be idle, and returns to its own safety area 1; return to step S2.
[0073] In this embodiment, by presetting partitions and controlling the manipulator with different preset control schemes according to the overlapping state of the target path and each partition; simplifying the control of the manipulator in some control schemes to improve the control efficiency of the manipulator; making the control of multiple manipulators more flexible, the efficiency of the manipulator in performing tasks can be effectively improved, and the operation safety and stability are stronger. By planning the entry and exit of the control mode, it is ensured that when the target path of the manipulator overlaps with the safety area 1 of the adjacent manipulator, the planning of the manipulator will not hinder the manipulator of other control schemes, ensuring the effectiveness of manipulator planning and task execution. When the second control scheme is selected to run the manipulator action instruction, the manipulator requests the right to use the critical area 2, and notifies the critical area 2 that it is free after exiting the critical area 2, which can ensure that there is only one manipulator in the critical area 2 to move and perform tasks, prevent collisions between manipulators, and ensure the effectiveness of manipulator path planning and task execution.
[0074] For example, a partitioned robotic arm collaboration method in a non-real-time system according to the first embodiment of the present invention, when applied to a system having a first robotic arm and a second robotic arm, may specifically include the following steps:
[0075] S1: Divide the area within the preset range where the initial position of the robot arm is located into a safety area 1, divide a critical area 2 between adjacent safety areas 1, and separate the critical area 2 from the safety area 1 by a first safety distance a;
[0076] S2: Get the next instruction;
[0077] S3: Determine whether the instruction is a robot arm action instruction, if yes, proceed to the subsequent steps, otherwise return to step S2;
[0078] S4: Determine whether the target path of the first robotic arm overlaps with the safety area 1 of the adjacent second robotic arm. In this embodiment, there is no overlap, and proceed to step S5;
[0079] S5: Determine whether the control system is in the planning control mode and whether the target path of at least one of the robot arms overlaps with the safety area 1 of the adjacent robot arm. If it is determined that there is no overlap, proceed to step S7;
[0080] S7: Determine whether the control system is in the planning control mode and the target path of any of the robot arms overlaps with the safety area 1 of the adjacent robot arm. If not, proceed to step S8;
[0081] S8: Determine whether the target path of the first robot arm overlaps with the phase critical area 2. In this embodiment, if it is determined to be yes, the second control scheme is selected to run the robot arm motion instruction and proceed to step S10;
[0082] S10: The first robot arm requests the right to use the critical area 2;
[0083] S11: Determine whether the critical area 2 is free. In this embodiment, the critical area 2 has been occupied by the second robot arm, and the first robot arm is waiting in line. After the critical area 2 is unoccupied and free, the first robot arm obtains the right to use the critical area 2.
[0084] S12: The first robotic arm executes the robotic arm motion instruction. After executing the robotic arm motion instruction, the first robotic arm exits the critical area 2, notifies the critical area 2 to be idle, and returns to its own safety area 1; return to step S2.
[0085] Example 2
[0086] See also Figures 1 to 9The steps of a partitioned robot arm collaboration method in a non-real-time system in the second embodiment of the present invention are basically the same as those in the first embodiment, except that: the first control scheme includes the steps of:
[0087] S41: the current robot arm obtains planning authority, and determines whether the current robot arm obtains planning authority successfully. If yes, proceed to the subsequent steps; otherwise, repeat step S41;
[0088] S42: taking the robotic arm that obtains the planning authority as the first target robotic arm;
[0089] S43: Determine whether the target path of the first target robot arm has an overlapping portion with the target path of the other adjacent robot arm; if not, plan the target path and target task of the first target robot arm, and return to step S2 after executing the target path and the target task; if yes, take the other robot arm with the overlapping portion as the second target robot arm, and directly proceed to step S44; the target path includes a moving trajectory from the starting position to the target position;
[0090] S44: determining whether the second target robotic arm is in a planning incomplete state, and continuing with subsequent steps after the second target robotic arm is in a state of releasing the planning incomplete state;
[0091] The step S44 further comprises the steps of:
[0092] S441: Determine whether the second target robot arm is in an unfinished planning state. If so, it indicates that there are other threads, and proceed to step S442; otherwise, directly proceed to step S45;
[0093] S442: setting the first target robot arm to a planning unfinished state, releasing the planning authority, and entering a waiting state;
[0094] S443: The second target robotic arm wakes up the first target robotic arm after releasing the unfinished planning state in the other threads, and the first target robotic arm reacquires the planning authority.
[0095] S45: Determine whether the target path of the second target robot arm causes an obstacle to the first target robot arm; if so, proceed to step S46 after performing an obstacle avoidance operation on the second target robot arm; otherwise, proceed directly to step S46;
[0096] The step S45 further comprises the steps of:
[0097] S451: Determine whether the target path of the second target robot arm causes an obstruction to the first target robot arm; if so, proceed to step S452; otherwise, proceed directly to step S46;
[0098] S442: inserting an obstacle avoidance movement instruction into the second target robotic arm, setting the first target robotic arm to an uncompleted planning state, and releasing the planning authority; the robotic arm motion instruction includes the obstacle avoidance movement instruction;
[0099] S443: the first target robot arm enters waiting mode;
[0100] S444: The second target robotic arm wakes up the first target robotic arm when starting to execute the obstacle avoidance movement instruction, and the first target robotic arm reacquires the planning authority, and continues to step S46.
[0101] S46: planning the target path and the target task of the first target robotic arm;
[0102] S47: After adjusting the moving speed of the first target robot arm, execute the target path and the target task, and return to step S2.
[0103] In this embodiment, the preset rule is applied to a number of threads that are executed synchronously, so that one or more threads can simultaneously execute the robotic arm collaboration method of the first control scheme.
[0104] When the robotic arm obtains the planning authority, if no other robotic arm has obtained the planning authority and the robotic arm is the first to make a request to obtain the planning authority, the robotic arm obtains the planning authority, otherwise, the planning authority cannot be obtained.
[0105] The overlapping portion includes the moving trajectories of different robotic arms plus the overlapping portion of a second safety distance range around the moving trajectories, which can effectively ensure that no collision occurs between the robotic arms.
[0106] In this embodiment, the preset speeds of the robotic arms are the same, and whether the target path of the second target robotic arm causes an obstruction to the first target robotic arm is determined based on the moving directions of the first target robotic arm and the second target robotic arm, the starting position and the target position of the target path.
[0107] When the first target robotic arm and the second target robotic arm move in the same direction, and when the starting position of the second target robotic arm is located on the target path of the first target robotic arm, and the target position of the second target robotic arm is located on the target path of the first target robotic arm; it is determined that the target path of the second target robotic arm causes an obstruction to the first target robotic arm, such as Figure 6 shown.
[0108] When the first target robotic arm and the second target robotic arm move toward each other, and when the target position of the second target robotic arm is located at or passes through the target path of the first target robotic arm; it is determined that the target path of the second target robotic arm causes an obstruction to the first target robotic arm, such as Figure 7 and Figure 8 shown.
[0109] For example, a partitioned robotic arm collaboration method in a non-real-time system according to the second embodiment of the present invention, when applied to a system having a first robotic arm and a second robotic arm, may specifically include the following steps:
[0110] S1: Divide the area within the preset range where the initial position of the robot arm is located into a safety area 1, divide a critical area 2 between adjacent safety areas 1, and separate the critical area 2 from the safety area 1 by a first safety distance a;
[0111] S2: Get the next instruction;
[0112] S3: Determine whether the instruction is a robot arm motion instruction, if yes, proceed to the subsequent steps, otherwise return to step S2;
[0113] S4: Determine whether the target path of the first robotic arm overlaps with the safety area 1 of the adjacent robotic arm. In this embodiment, if it is judged to be yes, send a first control instruction to make the control system enter the planning control mode, and all the robotic arms operate according to the first control scheme, and proceed to step S6;
[0114] S6: Select the first control scheme to execute the robot arm motion instruction, and return to step S2;
[0115] The first control scheme comprises the steps of:
[0116] S41: The current robot arm obtains planning authority, and determines whether the current robot arm obtains planning authority successfully. If yes, proceed to the subsequent steps; otherwise, repeat step S41;
[0117] S42: taking the robotic arm that obtains the planning authority as the first target robotic arm. In this embodiment, the first target robotic arm is the first robotic arm;
[0118] S43: Determine whether the target path of the first robotic arm overlaps with the target path of the adjacent second robotic arm; in this embodiment, the target path of the second robotic arm overlaps with the target path of the first robotic arm; the second robotic arm is used as the second target robotic arm;
[0119] S44: determining whether the second robotic arm is in a planning incomplete state, and continuing with subsequent steps after the second robotic arm is in a state of releasing the planning incomplete state;
[0120] In this embodiment, the step S44 further includes the steps of:
[0121] S441: Determine whether the second robot arm is in an unfinished planning state. In this embodiment, if it is determined to be yes, it indicates that there are other threads, and proceed to step S442;
[0122] S442: setting the first robot arm to a planning unfinished state, releasing the planning authority, and entering a waiting state;
[0123] S443: The second robotic arm wakes up the first robotic arm after releasing the unfinished planning state in the other threads, and the first robotic arm reacquires the planning authority.
[0124] S45: Determine whether the target path of the second robotic arm causes an obstruction to the first robotic arm; in this embodiment, the first robotic arm and the second robotic arm move in the same direction and the target position of the second robotic arm is located behind the forward direction of the target position of the first robotic arm. Figure 5 As shown, by determining that the target path of the second robotic arm does not cause an obstacle to the first robotic arm, directly proceed to step S8;
[0125] S46: planning the target path and the target task of the first robotic arm;
[0126] S47: After adjusting the moving speed of the first robot arm, execute the target path and the target task, and return to step S2.
[0127] Example 3
[0128] See also Fig. 9 , the partitioned robotic arm collaboration method under a non-real-time system of embodiment three of the present invention has steps that are basically the same as those of embodiment two, except that it also includes the steps of: when the first target robotic arm and the second target robotic arm move toward each other, the target position of the first target robotic arm is located behind the moving direction of the starting position of the second target robotic arm and the target position of the second target robotic arm is located behind the moving direction of the starting position of the first target robotic arm; reporting an abnormality.
[0129] The present invention provides an error reporting mechanism, which can promptly report errors when planning errors are discovered, thereby ensuring that path planning is safe and effective.
[0130] Example 4
[0131] See also Figures 1 to 9The steps of the partitioned robotic arm collaboration method in a non-real-time system in the fourth embodiment of the present invention are basically the same as those in the third embodiment, except that the partitioned robotic arm collaboration method in a non-real-time system in the fourth embodiment of the present invention, when applied to a system having a first robotic arm, a second robotic arm, and a third robotic arm, may specifically include the following steps:
[0132] S1: Divide the area within the preset range where the initial position of the robot arm is located into a safety area 1, divide a critical area 2 between adjacent safety areas 1, and separate the critical area 2 from the safety area 1 by a first safety distance a;
[0133] S2: Get the next instruction;
[0134] S3: Determine whether the instruction is a robot arm motion instruction, if yes, proceed to the subsequent steps, otherwise return to step S2;
[0135] S4: Determine whether the target path of the first robotic arm overlaps with the safety area 1 of the adjacent robotic arm. In this embodiment, if it is judged to be yes, send a first control instruction to make the control system enter the planning control mode, and all the robotic arms operate according to the first control scheme, and proceed to step S6;
[0136] S6: Select the first control scheme to execute the robot arm motion instruction, and return to step S2;
[0137] The first control scheme comprises the steps of:
[0138] S41: The current robot arm obtains planning authority, and determines whether the current robot arm obtains planning authority successfully. If yes, proceed to the subsequent steps; otherwise, repeat step S41;
[0139] S42: taking the robotic arm that obtains the planning authority as the first target robotic arm. In this embodiment, the first target robotic arm is the first robotic arm;
[0140] S43: Determine whether the target path of the first robotic arm overlaps with the target path of other adjacent robotic arms; in this embodiment, by determining that the target path of the second robotic arm overlaps with the target path of the first robotic arm, the second robotic arm having the overlapping portion is used as the second target robotic arm;
[0141] S44: determining whether the second robotic arm is in a planning incomplete state, and continuing with subsequent steps after the second robotic arm is in a state of releasing the planning incomplete state;
[0142] In this embodiment, the step S44 further includes the steps of:
[0143] S441: Determine whether the second robotic arm is in an uncompleted planning state. In this embodiment, the second robotic arm is in a state of releasing the uncompleted planning state, and directly proceed to step S45.
[0144] S45: Determine whether the target path of the second robotic arm causes an obstruction to the first robotic arm; in this embodiment, if the target path of the second robotic arm causes an obstruction to the target path of the first robotic arm, perform an obstacle avoidance operation on the second robotic arm and proceed to step S46;
[0145] In this embodiment, the step S45 further includes the steps of:
[0146] S451: Determine whether the target path of the second robotic arm causes an obstruction to the first robotic arm; if determined to be yes, proceed to step S452;
[0147] S452: inserting an obstacle avoidance movement instruction into the second robotic arm, setting the first robotic arm to an uncompleted planning state, and releasing the planning authority;
[0148] S453: the first robot arm enters a waiting state;
[0149] S454: The second robotic arm starts to run the steps of this method in other threads starting from step S1; when running to step S5, it is determined that the target path of the third robotic arm overlaps with the target path of the second robotic arm, and then by determining that the third robotic arm is in a state of releasing the incomplete planning state, it is directly determined whether the target path of the third robotic arm causes an obstacle to the target path of the second robotic arm. In this embodiment, the third robotic arm does not cause an obstacle to the target path of the second robotic arm, so an avoidance path for the second robotic arm is planned, and the moving speed of the second robotic arm is adjusted before starting to perform obstacle avoidance operations, waking up the first robotic arm, and the first robotic arm regains the planning authority, and continues to step S46.
[0150] S46: planning the target path and the target task of the first robotic arm;
[0151] S47: After adjusting the moving speed of the first robot arm, execute the target path and the target task, and return to step S2.
[0152] The present invention is described in detail above in conjunction with the embodiments of the accompanying drawings. A person skilled in the art can make various variations of the present invention according to the above description. Therefore, certain details in the embodiments should not constitute a limitation of the present invention, and the scope of protection of the present invention shall be defined by the scope of the attached claims.
Claims
1. A partitioned robotic arm collaboration method in a non-real-time system, comprising the steps of: S1: dividing an area within a preset range where the initial position of the robot arm is located into a safety area, dividing a critical area between adjacent safety areas, and separating the critical area from the safety area by a first safety distance; S2: Get the next instruction; S3: Determine whether the instruction is a robot arm action instruction, if yes, proceed to the subsequent steps, otherwise return to step S2; S4: Determine whether the target path of the robot arm overlaps with the safety area of the adjacent robot arm. If so, send a first control instruction to enable the control system to enter a planning control mode, and all the robot arms operate according to the first control scheme, and proceed to step S6; otherwise, proceed to step S5; S5: Determine whether the control system is in the planning control mode and whether the target path of at least one of the robotic arms overlaps with the safety area of the adjacent robotic arm, if so, proceed to step S6; otherwise, proceed to step S7; S6: Select the first control scheme to execute the robot arm motion instruction, and return to step S2; S7: Determine whether the control system is in the planning control mode and the target path of any of the robotic arms overlaps with the safety area of the adjacent robotic arm, and if so, send a second control instruction to make the control system exit the planning control mode and proceed to step S8; otherwise, directly proceed to step S8; S8: Determine whether the target path of the robot arm overlaps with the critical region. If so, select the second control scheme to execute the robot arm motion instruction and proceed to step S10; Otherwise, proceed to step S9; S9: directly execute the robot arm motion instruction and return to step S2; S10: the robot arm requests the right to use the critical area; S11: Determine whether the critical area is idle; if so, allocate the right to use the critical area to the robot arm; If it is occupied, the robot arm waits in a queue, and after the critical area is unoccupied and free, the robot arm obtains the right to use the critical area; S12: Execute the robot arm motion instruction, and the robot arm exits the critical area after executing the robot arm motion instruction, notifies the critical area to be free, and returns to its own safe area; Return to step S2.
2. According to the partitioned robotic arm collaboration method in a non-real-time system according to claim 1, It is characterized in that The first control scheme comprises the steps of: S41: the current robot arm obtains planning authority, and determines whether the current robot arm obtains planning authority successfully. If yes, proceed to the subsequent steps; otherwise, repeat step S41; S42: taking the robotic arm that obtains the planning authority as the first target robotic arm; S43: Determine whether the target path of the first target robot arm has an overlapping portion with the target path of the other adjacent robot arm; if not, plan the target path and target task of the first target robot arm, and return to step S2 after executing the target path and the target task; if yes, take the other robot arm with the overlapping portion as the second target robot arm, and directly proceed to step S44; the target path includes a moving trajectory from the starting position to the target position; S44: determining whether the second target robotic arm is in a planning incomplete state, and continuing with subsequent steps after the second target robotic arm is in a state of releasing the planning incomplete state; S45: Determine whether the target path of the second target robot arm causes an obstacle to the first target robot arm; if so, proceed to step S46 after performing an obstacle avoidance operation on the second target robot arm; otherwise, proceed directly to step S46; S46: planning the target path and the target task of the first target robotic arm; S47: After adjusting the moving speed of the first target robot arm, execute the target path and the target task, and return to step S2.
3. The partitioned robotic arm collaboration method in a non-real-time system according to claim 2, It is characterized in that The preset rule is applied to a plurality of threads that are executed simultaneously.
4. The partitioned robotic arm collaboration method in a non-real-time system according to claim 2, It is characterized in that The overlapping portion includes the overlapping portion of the moving trajectories of different robot arms plus a second safety distance range around the moving trajectories.
5. The partitioned robotic arm collaboration method in a non-real-time system according to any one of claims 2 to 4, It is characterized in that The step S44 further comprises the steps of: S441: Determine whether the second target robot arm is in an unfinished planning state. If so, it indicates that there are other threads, and proceed to step S442; Otherwise, proceed directly to step S45; S442: setting the first target robot arm to a planning unfinished state, releasing the planning authority, and entering a waiting state; S443: The second target robotic arm wakes up the first target robotic arm after releasing the unfinished planning state in the other threads, and the first target robotic arm reacquires the planning authority.
6. The partitioned robotic arm collaboration method in a non-real-time system according to any one of claims 2 to 4, It is characterized in that The step S45 further comprises the steps of: S451: Determine whether the target path of the second target robot arm causes an obstruction to the first target robot arm; if so, proceed to step S452; Otherwise, go directly to step S46; S442: inserting an obstacle avoidance movement instruction into the second target robotic arm, setting the first target robotic arm to an uncompleted planning state, and releasing the planning authority; the robotic arm motion instruction includes the obstacle avoidance movement instruction; S443: the first target robot arm enters waiting mode; S444: The second target robotic arm wakes up the first target robotic arm when starting to execute the obstacle avoidance movement instruction, and the first target robotic arm reacquires the planning authority, and continues to step S46.
7. The partitioned robot arm collaboration method in a non-real-time system according to any one of claims 2 to 4, It is characterized in that It is determined whether the target path of the second target robotic arm causes an obstruction to the first target robotic arm according to the moving directions of the first target robotic arm and the second target robotic arm, the starting position and the target position of the target path.
8. The partitioned robotic arm collaboration method in a non-real-time system according to any one of claims 2 to 4, It is characterized in that When the first target robotic arm and the second target robotic arm move in the same direction, and when the starting position of the second target robotic arm is on the target path of the first target robotic arm, and the target position of the second target robotic arm is on the target path of the first target robotic arm; it is determined that the target path of the second target robotic arm causes an obstruction to the first target robotic arm.
9. The partitioned robot arm collaboration method in a non-real-time system according to any one of claims 2 to 4, It is characterized in that When the first target robotic arm and the second target robotic arm move toward each other, and when the target position of the second target robotic arm is located at or passes through the target path of the first target robotic arm; it is determined that the target path of the second target robotic arm causes an obstruction to the first target robotic arm.
10. The partitioned robotic arm collaboration method in a non-real-time system according to any one of claims 2 to 4, It is characterized in that When the first target robotic arm and the second target robotic arm move towards or in the same direction, and the starting position of the first target robotic arm is located on the target path of the second target robotic arm; an abnormality is reported.
Citation Information
Patent Citations
Dual-arm type device control method based on multithreaded mutual exclusion control technology
CN108340372A
Underwater double-arm cooperating grabbing, holding and collision preventing integrated method and system
CN109822554A
Robot control method, control system, robot and storage device
CN111727414A
Control method and device for automatically avoiding operation area during multi-gun spraying
CN112827771A
Human-robot collaboration planning and monitoring technology
WO2015049202A2
Cited By
Mechanical arm cooperation method under non-real-time system
CN118952216A
Robotic arm collaboration methods in non-real-time systems
CN118952216B
