A robot steamer anti-collision method, system and device

By judging the collision risk between the fabric device and the steamer during the robot's steamer, and adjusting the motion path and angle, the collision between the large-volume fabric device and the steamer is solved, and the efficiency and flexibility of the steamer are improved.

CN118636149BActive Publication Date: 2024-11-22INST OF AUTOMATION CHINESE ACAD OF SCI +1
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202410888919.2
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-07-04
Publication Date
2024-11-22
Estimated Expiration
2044-07-04

AI Technical Summary

Technical Problem

During the robot's steaming process, the large-volume fabric device is prone to collide with the steaming pot, resulting in an increase in the number of times in and out of the steaming pot and an extended steaming time, affecting efficiency.

Method used

By judging the collision result based on the central position of the steamer and the maximum radius of the spreading material in the fabric device, a motion planning strategy is formed, the intermediate transition point position and Euler angle are obtained, the translation path and rotation angle of the fabric device are adjusted, and the collision avoidance is formed, and the anti-collision movement scheme is formed. .

Benefits of technology

It improves the anti-collision flexibility and accuracy of the fabric device and the steamer, reduces the switching operation time, and the steamer pressure is more timely, improving the efficiency of steaming.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118636149B_ABST
    Figure CN118636149B_ABST
Patent Text Reader

Abstract

The present application relates to the technical field of intelligent steaming for brewing wine, specifically to a method, system and equipment for preventing collisions when a robot is steaming. In order to solve the problem of collisions between a material distribution device and a steaming pot in the prior art, the present application first determines whether the material distribution device will collide with the steaming pot at the current material distribution position and the next material distribution position, respectively, and determines whether the material distribution device will collide with the steaming pot during movement, thereby choosing whether to perform anti-collision planning operations. Then, in the process of performing anti-collision planning operations, the position of the intermediate transition point and its corresponding Euler angle are obtained according to the current material distribution position and the next material distribution position, as well as their respective Euler angles. Finally, a robot anti-collision scheme with high flexibility and accuracy is formed based on the above information, which can be used to perform robot steaming operations, thereby preventing collisions and reducing the switching action time of each time going to the center position of the steaming pot in the prior art, so that the steam pressure mash can be seen more timely, thereby improving the efficiency of steaming.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of intelligent steaming for brewing wine, and in particular to a robot steaming anti-collision method, system and equipment. Background Art

[0002] Robotic steaming refers to the use of a robot carrying a material distribution device to replace manual steaming. Robotic steaming is an intermittent steaming method. The robot needs to carry a material distribution device to receive the mash from the feeding system outside the steamer, enter the steamer, and spread the mash according to the planned material distribution motion trajectory.

[0003] For this intermittent steaming method, in order to reduce the number of times of entering and exiting the steamer to receive the mash and shorten the steaming time, the volume of the material distribution device needs to be increased as much as possible. However, a large-volume material distribution device is prone to collision with the steamer. Summary of the invention

[0004] The purpose of the present invention is to provide a robot steamer anti-collision method, system and equipment with high flexibility and accuracy in anti-collision between a material distribution device and a steamer pot.

[0005] The technical solution of the present invention is as follows:

[0006] A robot steamer anti-collision method includes the following operations:

[0007] S1. Based on the center position of the steamer pot and the maximum radius of the material spreading device, the collision results of the material spreading device with the steamer pot at the current material spreading position and the next material spreading position are obtained respectively to form a motion planning strategy mark;

[0008] S2, based on the current material laying position and the next material laying position, determine whether the material laying device will collide with the steamer in the process of moving from the current material laying position to the next material laying position; if no collision occurs, and the motion planning strategy flag corresponds to the collision results of the material laying device at the current material laying position and at the next material laying position are both no collision, then the material laying device moves from the current material laying position to the next material laying position; if a collision occurs, execute S3;

[0009] S3, based on the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the material distribution device, obtain the number of intermediate transition points inserted between the current paving position and the next paving position; obtain the translation transition point positions corresponding to the current paving position and the next paving position respectively, and obtain the first translation transition point position and the second translation transition point position; based on the first translation transition point position, the second translation transition point position, and the number of intermediate transition point insertions, obtain several intermediate transition point positions; based on the Euler angle corresponding to the first translation transition point position, obtain the Euler angles corresponding to the several intermediate transition point positions respectively;

[0010] S4, based on the current material laying position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material laying position and the corresponding Euler angle, the translation path and rotation angle of the material laying device are obtained to form the current anti-collision movement plan of the material laying device;

[0011] The next paving position is used as the current paving position to execute the operations of S1 and S2. All paving positions in the preset paving position sequence set execute the operations of S1 and S2, and several anti-collision movement schemes of the material distribution device are obtained, forming a robot anti-collision scheme for executing the robot steamer operation.

[0012] The operation of obtaining the collision result between the material distributing device and the steamer pot at the current material distributing position in S1 is specifically as follows:

[0013] The lateral offset and longitudinal offset between the current material spreading position and the center position of the steamer pot in the Cartesian coordinate system are obtained respectively; it is determined whether the ratio of the maximum material spreading radius of the material spreading device to the square root of the lateral offset and the longitudinal offset is less than the safety threshold; if so, the collision result of the material spreading device with the steamer pot at the current material spreading position is a collision; if not, the collision result of the material spreading device with the steamer pot at the current material spreading position is a non-collision.

[0014] The operation of judging in S2 whether the material distribution device will collide with the steamer during the process of moving from the current material distribution position to the next material distribution position is specifically as follows: respectively obtaining the differences in pitch angle, yaw angle and roll angle between the material distribution device at the current material distribution position and at the next material distribution position in Cartesian coordinates to obtain the pitch angle difference, yaw angle difference and roll angle difference; judging whether the absolute value of the pitch angle difference, the absolute value of the yaw angle difference and the absolute value of the roll angle difference are all less than the Euler angle difference threshold; if so, no collision occurs; if not, a collision occurs.

[0015] The specific method for obtaining the number of intermediate transition point insertions in S3 is:

[0016] Determine whether the absolute value of the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the cloth distribution device is greater than the first rotation degree; if it is greater than the first rotation degree, use the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the cloth distribution device as the initial rotation angle value of the cloth distribution device; if it is not greater than the first rotation degree and greater than the second rotation degree, use half of the difference between the Euler angles of the cloth distribution device at the current paving position and the next paving position as the initial rotation angle value of the cloth distribution device; if it is not greater than the second rotation degree, the initial rotation angle value of the cloth distribution device is the first value; determine whether the absolute value of the initial rotation angle value of the cloth distribution device is equal to the first value; if it is equal to the first value, the number of intermediate transition points inserted is the first value; if it is greater than the first value and not greater than the first rotation degree, the number of intermediate transition points inserted is the first number; if it is greater than the first rotation degree and not greater than the third rotation degree, the number of intermediate transition points inserted is the second number; if it is greater than the third rotation degree, the number of intermediate transition points inserted is the third number.

[0017] In S3, if the collision result of the material distribution device with the steamer pot when it is at the current material distribution position is no collision, the position of the first translation transition point is the current material distribution position, or the position of the first translation transition point does not exist; if the collision result of the material distribution device with the steamer pot when it is at the current material distribution position is a collision, the method for obtaining the position of the first translation transition point is: respectively obtain the lateral offset and longitudinal offset of the current material distribution position and the center position of the steamer pot in the Cartesian coordinate system; take the ratio of the maximum material spreading radius of the material distribution device to the square root of the lateral offset and the longitudinal offset, and the product of the horizontal axis offset and the longitudinal offset, respectively, as the horizontal and vertical coordinates of the first translation transition point position.

[0018] The intermediate transition point position in S3 is obtained based on the lateral transition amount, longitudinal transition amount, vertical transition amount of the first translation transition point position and the second translation transition point position, and the number of intermediate transition point insertions.

[0019] In the Euler angle at the intermediate transition point in S3, the pitch angle at the intermediate transition point is obtained based on the pitch angle at the first translation transition point and the pitch angle correction value; the yaw angle and roll angle at the intermediate transition point are both non-rotation angles.

[0020] S4 also includes obtaining the rotation direction of the cloth-laying device, which is used together with the translation path and rotation angle of the cloth-laying device to form an anti-collision movement plan for the cloth-laying device; the rotation direction of the cloth-laying device is obtained based on the difference in the rotation of the corresponding joint axis when the cloth-laying device is at the current material-laying position and at the next material-laying position.

[0021] A robot steamer loading anti-collision system, used to implement the above-mentioned robot steamer loading anti-collision method, comprising:

[0022] A motion planning strategy mark generation module is used to obtain the collision results of the material distribution device with the steamer at the current material distribution position and the next material distribution position based on the center position of the steamer and the maximum material distribution radius of the material distribution device, and form a motion planning strategy mark;

[0023] The collision judgment module during the movement process judges whether the material distribution device will collide with the steamer pot when it moves from the current material distribution position to the next material distribution position based on the current material distribution position and the next material distribution position; if no collision occurs, and the motion planning strategy flag corresponds to the collision results of the material distribution device at the current material distribution position and the next material distribution position are both no collision, then the material distribution device moves from the current material distribution position to the next material distribution position; if a collision occurs, the transition point generation module is executed;

[0024] A transition point generation module is used to obtain the number of intermediate transition points inserted between the current paving position and the next paving position based on the difference in Euler angles between the current paving position and the next paving position of the material distribution device; obtain the translation transition point positions corresponding to the current paving position and the next paving position respectively to obtain the first translation transition point position and the second translation transition point position; obtain a number of intermediate transition point positions based on the first translation transition point position, the second translation transition point position and the number of intermediate transition point insertions; obtain the Euler angles corresponding to the several intermediate transition point positions respectively based on the Euler angle corresponding to the first translation transition point position;

[0025] The current material distribution device anti-collision movement plan generation module is used to obtain the translation path and rotation angle of the material distribution device based on the current material distribution position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material distribution position and the corresponding Euler angle, so as to form the current anti-collision movement plan of the material distribution device;

[0026] The robot anti-collision scheme generation module is used to execute the operations of the motion planning strategy mark generation module and the movement process collision judgment module for the next paving position as the current paving position. All paving positions in the preset paving position sequence set execute the operations of the motion planning strategy mark generation module and the movement process collision judgment module to obtain several anti-collision movement schemes for the material distribution device, forming a robot anti-collision scheme for executing the robot steamer operation.

[0027] A robot steamer anti-collision device comprises a processor and a memory, wherein the processor implements the above-mentioned robot steamer anti-collision method when executing a computer program stored in the memory.

[0028] The beneficial effects of the present invention are:

[0029] The present invention provides a robot anti-collision method for steaming pot. First, based on the center position of the steaming pot and the maximum material spreading radius of the material distribution device, it is judged whether the material distribution device will collide with the steaming pot at the current material spreading position and the next material spreading position respectively, so as to judge the danger of the material distribution device at the current material spreading position and the next material spreading position, and form a motion planning strategy mark; then, based on the current material spreading position and the next material spreading position, it is judged whether the material distribution device will collide with the steaming pot during the movement, so as to choose whether to perform the anti-collision planning operation, so as to improve the flexibility and accuracy of the anti-collision of the material distribution device; then, in the process of performing the anti-collision planning operation, according to the current material spreading position and the next material spreading position, and the respective Euler angles, the intermediate transition point position and the corresponding Euler angle used to adjust the position and direction of the material distribution device to prevent the position of the material distribution device from colliding with the steaming pot are obtained. , ensuring that the material distribution device does not collide with the steamer when moving from the current material distribution position to the next material distribution position; finally, based on the current material distribution position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material distribution position and the corresponding Euler angles, the translation path and rotation angle of the material distribution device are determined, and the current anti-collision movement scheme of the material distribution device is formed. After all the material distribution positions in the preset material distribution position sequence set perform the above-mentioned collision judgment and anti-collision planning operations, several anti-collision movement schemes of the material distribution device are obtained, forming a robot anti-collision scheme with high flexibility and high accuracy. When used to perform the robot steaming operation, it can prevent the material distribution device from colliding with the steamer, and there is no need for the material distribution device to move to the center of the steamer every time to switch the action, which reduces the switching action time, makes the steam pressure mash more timely, and improves the steaming efficiency. BRIEF DESCRIPTION OF THE DRAWINGS

[0030] By reading the detailed description of the preferred embodiment below, the scheme and advantages of the present application will become clear to those skilled in the art. The accompanying drawings are only for the purpose of illustrating the preferred embodiment and are not to be considered as limiting the present invention.

[0031] In the attached picture:

[0032] Figure 1 This is a schematic diagram of the robot steamer structure in the embodiment;

[0033] The components represented by the reference numerals in the figure are:

[0034] 1. Robot; 2. Fabric distribution device; 3. Steamer; 4. Robotic arm; 5. Joint axis. DETAILED DESCRIPTION

[0035] Exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings.

[0036] This embodiment provides a robot steamer anti-collision method, including the following operations:

[0037] S1. Based on the center position of the steamer pot and the maximum radius of the material spreading device, the collision results of the material spreading device with the steamer pot at the current material spreading position and the next material spreading position are obtained respectively to form a motion planning strategy mark;

[0038] S2, based on the current material laying position and the next material laying position, determine whether the material laying device will collide with the steamer in the process of moving from the current material laying position to the next material laying position; if no collision occurs, and the motion planning strategy flag corresponds to the collision results of the material laying device at the current material laying position and at the next material laying position are both no collision, then the material laying device moves from the current material laying position to the next material laying position; if a collision occurs, execute S3;

[0039] S3, based on the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the material distribution device, obtain the number of intermediate transition points inserted between the current paving position and the next paving position; obtain the translation transition point positions corresponding to the current paving position and the next paving position respectively, and obtain the first translation transition point position and the second translation transition point position; based on the first translation transition point position, the second translation transition point position, and the number of intermediate transition point insertions, obtain several intermediate transition point positions; based on the Euler angle corresponding to the first translation transition point position, obtain the Euler angles corresponding to the several intermediate transition point positions respectively;

[0040] S4, based on the current material laying position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material laying position and the corresponding Euler angle, the translation path and rotation angle of the material laying device are obtained to form the current anti-collision movement plan of the material laying device;

[0041] The next paving position is used as the current paving position to execute the operations of S1 and S2. All paving positions in the preset paving position sequence set execute the operations of S1 and S2, and several anti-collision movement schemes of the material distribution device are obtained, forming a robot anti-collision scheme for executing the robot steamer operation.

[0042] In this embodiment, the structure of the robot used for steaming is as follows: Figure 1 As shown, the robot 1 has a mechanical arm 4 that is rotatably connected to a material distribution device 2 via a joint shaft 5. The mechanical arm 4 controls the material distribution device 2 to move and rotate on the upper part of the steamer pot 3 to reach a designated material distribution position according to a corresponding moving path of a preset material distribution position sorting set. When the material distribution device 2 reaches the designated material distribution position, the material distribution device 2 is controlled to spread material into the steamer pot 3. After the material distribution device 2 performs material spreading at each material distribution position, the robot steaming operation is completed.

[0043] The specific anti-collision method in the robot steamer operation is as follows.

[0044] S1. Based on the center position of the steamer pot and the maximum radius of the material spreading device, the collision results of the material spreading device with the steamer pot at the current material spreading position and the next material spreading position are obtained respectively to form a motion planning strategy mark.

[0045] Based on the center position of the steamer pot and the maximum radius of the material spreading device, it is determined whether the material spreading device will collide with the steamer pot at the current material spreading position and the next material spreading position (the starting coordinate position of the next material spreading action trajectory), thereby determining the danger of the material spreading device at the current material spreading position and the next material spreading position, which is convenient for subsequent anti-collision adjustments.

[0046] The operation of obtaining the collision result between the material distribution device and the steamer at the current material distribution position is as follows: respectively obtain the lateral offset and longitudinal offset between the current material distribution position and the center position of the steamer in the Cartesian coordinate system; determine whether the ratio of the maximum material distribution radius of the material distribution device to the square root of the lateral offset and the longitudinal offset is less than the safety threshold (1); if less than, the collision result between the material distribution device and the steamer at the current material distribution position is a collision; if not less than, the collision result between the material distribution device and the steamer at the current material distribution position is a non-collision. In the actual process, a point can be selected from the material distribution device as a key point. The coordinate position of the key point represents the position of the material distribution device in the anti-collision method of the steamer on the robot, which is used to determine whether the material distribution device will collide with the steamer. The selection of the key point can be customized according to actual needs.

[0047] The operation of obtaining the collision result between the material distribution device and the steamer at the current material distribution position can be realized through the following program algorithm: (TP1, Cal_case1) = f1 (Center_pos, Current_axis), Center_pos and Current_axis are algorithm inputs, Center_pos is the center of the steamer in the Cartesian coordinate system, and Current_axis is the coordinate of the current material distribution position in the joint coordinate system; TP1 and Cal_case are algorithm outputs, TP1 is the Cartesian coordinate position obtained by translating from Current_axis to the safe area while keeping the posture unchanged, recorded as the first translation transition point; Cal_case1 is the shaping type of the collision result of the material distribution device at the current material distribution position;

[0048] Step 1: Convert Current_axis to the coordinate Current_pos in the Cartesian coordinate system; (Current_pos.x, Current_pos.y), (Center_pos.x, Center_pos.y) are located on the xy plane, .x represents the horizontal coordinate, and .y represents the vertical coordinate;

[0049] Step 2: The maximum radius of the material spreading device is Rs, the lateral offset between the current material spreading position and the center position of the steamer pot is dx = Current_pos.x-Center_pos.x; the longitudinal offset between the current material spreading position and the center position of the steamer pot is dy = Current_pos.y-Center_pos.y; the square root of the lateral offset and the longitudinal offset is Rc = sqrt(dx*dx+dy*dy), and the ratio of the maximum radius of the material spreading device to the square root of the lateral offset and the longitudinal offset is Rf = Rs / Rc;

[0050] Step 3: Determine whether Rf is less than the safety threshold 1; if Rf<1, it means that the current material laying position is in a non-safe area and there is a risk of colliding with the edge of the steamer pot, then the collision result of the material laying device with the steamer pot at the current material laying position is a collision; TP1.x=Current_pos.x+Rf*dx; TP1.y=Current_pos.y+Rf*dy; Cal_case1=1; if Rf≥1, it means that the current material laying position is in a safe area and there is no risk of colliding with the edge of the steamer pot, then the collision result of the material laying device with the steamer pot at the current material laying position is a collision, TP1=Current_pos, Cal_case=0.

[0051] The operation of obtaining the collision result between the material distribution device and the steamer at the next material distribution position is similar to the operation of obtaining the collision result between the material distribution device and the steamer at the current material distribution position, so it will not be described in detail here to save space.

[0052] The operation of forming the motion planning strategy flag is: if the collision result of the material distribution device at the current material distribution position is no collision, record Cal_case1 = 0, the collision result of the material distribution device at the next material distribution position is no collision, record Cal_case2 = 0, then the motion planning strategy flag is no collision + no collision, record CaseP = 1; if the collision result of the material distribution device at the current material distribution position is no collision, record Cal_case1 = 0, the collision result of the material distribution device at the next material distribution position is collision, record Cal_case2 = 1, then the motion planning strategy flag is no collision + collision , CaseP=2; if the collision result of the cloth distribution device at the current paving position is a collision, Cal_case1=1 is recorded, and the collision result of the cloth distribution device at the next paving position is a non-collision, Cal_case2=0 is recorded, then the motion planning strategy is marked as collision+non-collision, CaseP=3; if the collision result of the cloth distribution device at the current paving position is a collision, Cal_case1=1 is recorded, and the collision result of the cloth distribution device at the next paving position is a collision, Cal_case2=1 is recorded, then the motion planning strategy is marked as collision+collision, CaseP=4.

[0053] S2. Based on the current paving position and the next paving position, determine whether the material distribution device will collide with the steamer when moving from the current paving position to the next paving position; if no collision occurs, and the motion planning strategy flag corresponds to the collision results of the material distribution device at the current paving position and the next paving position being no collision, then the material distribution device moves from the current paving position to the next paving position; if a collision occurs, execute S3.

[0054] Based on the current material laying position and the next material laying position, it is judged whether the material laying device will collide with the steamer during the movement, so as to choose whether to perform the anti-collision operation, thereby improving the flexibility and accuracy of the anti-collision of the material laying device.

[0055] First, determine whether the material distribution device will collide with the steamer during the process of moving from the current material distribution position to the next material distribution position. The specific operation is as follows: obtain the differences in pitch angle, yaw angle and roll angle between the current material distribution position and the next material distribution position under Cartesian coordinates, and obtain the pitch angle difference, yaw angle difference and roll angle difference; determine whether the absolute value of the pitch angle difference, the absolute value of the yaw angle difference and the absolute value of the roll angle difference are all less than the Euler angle difference threshold; if less than, no collision occurs; if not less than, a collision occurs. Yaw angle, roll angle and pitch angle are all Euler angles. The pitch angle, yaw angle and roll angle are the angles at which the joint axis at the end of the robot's mechanical arm rotates around the x-axis, y-axis and z-axis, respectively, that is, the angles at which the material distribution device rotates around the x-axis, y-axis and z-axis, respectively.

[0056] The operation of judging whether the material distribution device will collide with the steamer during the process of moving from the current material distribution position to the next material distribution position can be realized by the following program algorithm: the current material distribution position Current_axis and the next material distribution position Next_axis in the joint axis coordinate system are respectively converted into the current material distribution position Current_pos and the next material distribution position Next_pos in the Cartesian coordinate system; the collision flag is recorded as the BOOL variable Aovid_flag; when the absolute value of the pitch angle difference between the current material distribution position and the next material distribution position in the Cartesian coordinate system abs(Current_pos.a -Next_pos.a)<Euler angle difference threshold ΔAngleTh; and the absolute value of the yaw angle difference between the current paving position and the next paving position in Cartesian coordinates, abs(Current_pos.b-Next_pos.b)<ΔAngleTh, and the absolute value of the roll angle difference between the current paving position and the next paving position in Cartesian coordinates, abs(Current_pos.a-Next_pos.a)<ΔAngleTh, Aovid_flag=FALSE, indicating that no collision will occur; otherwise, Aovid_flag=TRUE, and a collision will occur.

[0057] Then, if no collision occurs, and the motion planning strategy flag corresponds to the collision results of the material distribution device at the current material distribution position and the next material distribution position are both non-collision, that is, the motion planning strategy flag is non-collision + non-collision, CaseP = 1, then the material distribution device directly moves from the current material distribution position to the next material distribution position.

[0058] If a collision occurs, the collision avoidance planning operation in S3 needs to be executed.

[0059] S3. Based on the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the material distribution device, obtain the number of intermediate transition points inserted between the current paving position and the next paving position; obtain the translation transition point positions corresponding to the current paving position and the next paving position respectively, and obtain the first translation transition point position and the second translation transition point position; based on the first translation transition point position, the second translation transition point position, and the number of intermediate transition point insertions, obtain several intermediate transition point positions; based on the Euler angle corresponding to the first translation transition point position, obtain the Euler angles corresponding to several intermediate transition point positions respectively.

[0060] According to the current material laying position and the next material laying position, as well as their respective Euler angles, the intermediate transition point position and its corresponding Euler angles for adjusting the position and direction of the material laying device to prevent the material laying device position from colliding with the steamer pot are obtained, thereby ensuring that the material laying device does not collide with the steamer pot when moving from the current material laying position to the next material laying position.

[0061] First, based on the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the material distribution device, the number of intermediate transition points inserted between the current paving position and the next paving position is obtained, which can prevent the material distribution device from colliding with the steamer, reduce the path point planning amount, and increase the moving speed of the material distribution device. Because the rotation angle of the material distribution device is controlled by the joint axis at the end of the robot's mechanical arm, the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the material distribution device is the difference between the preset joint axis coordinates at the current paving position and the joint axis coordinates at the next paving position.

[0062] The method for obtaining the number of intermediate transition point insertions is as follows: determine whether the absolute value of the rotation difference between the joint axis corresponding to the current paving position and the next paving position of the cloth device is greater than the first rotation degree (360°); if it is greater than the first rotation degree, use the rotation difference between the joint axis corresponding to the current paving position and the next paving position of the cloth device as the initial rotation angle value of the cloth device; if it is not greater than the first rotation degree and greater than the second rotation degree (180°), use half of the rotation difference between the joint axis corresponding to the current paving position and the next paving position of the cloth device as the initial rotation angle value of the cloth device. Angle value; if not greater than the second rotation degree, the initial rotation angle value of the material distribution device is the first value (0); determine whether the absolute value of the initial rotation angle value of the material distribution device is equal to the first value (0); if equal to the first value (0), the number of intermediate transition points inserted is the first value (0); if greater than the first value and not greater than the first rotation degree, the number of intermediate transition points inserted is the first number (1); if greater than the first rotation degree and not greater than the third rotation degree (540°), the number of intermediate transition points inserted is the second number (2); if greater than the third rotation degree, the number of intermediate transition points inserted is the third number (3).

[0063] The method for obtaining the number of intermediate transition point insertions can be implemented through the following program algorithm: OFFSET_A = f2 (Current_axis, Next_axis), Current_axis and Next_axis are the inputs of the algorithm, which are the current material laying position Current_axis and the next material laying position Next_axis in the joint axis coordinate system, respectively, and OFFSET_A is the output of the algorithm, which is the initial rotation angle value of the material laying device, and its type is floating point type;

[0064] STEP1: Calculate the rotation difference of the joint axis corresponding to the current material laying position and the next material laying position of the material laying device, that is, calculate the coordinate difference of the joint axis at the end of the robot arm at the current material laying position and the next material laying position OFFSET_A6 = Next_axis.A6-Current_axis.A6;

[0065] STEP2: Determine the absolute value abs(OFFSET_A6) of OFFSET_A6 and the first rotation degree. If abs(OFFSET_A6)>360°, then OFFSET_A=OFFSET_A6; if abs(OFFSET_A6)>180° and abs(OFFSET_A6)≤360°, then OFFSET_A=0.5*OFFSET_A6; if abs(OFFSET_A6)≤180°, then OFFSET_A=0;

[0066] STEP3: Determine whether the absolute value of the initial rotation angle value of the fabric device |Offset_A| is equal to 0; if |Offset_A|=0, then insert the number of transition points point_num=0; if |Offset_A|>0 and |Offset_A|≤360°, then insert the number of transition points point_num=1; if |Offset_A|>360° and |Offset_A|≤540°, then insert the number of transition points point_num=2; if |Offset_A|>540, then insert the number of transition points point_num=3.

[0067] Then, the translation transition point positions corresponding to the current paving position and the next paving position are respectively obtained to obtain the first translation transition point position and the second translation transition point position, which are used for the material distribution device to translate from the current paving position to the next paving position.

[0068] In the motion planning strategy flag, if the collision result of the material distribution device with the steamer pot when it is at the current material distribution position is no collision, the first translation transition point position is the current material distribution position, or the first translation transition point position does not exist;

[0069] In the motion planning strategy flag, if the collision result between the material distribution device and the steamer is a collision when the material distribution device is at the current material distribution position, the method for obtaining the position of the first translation transition point is: respectively obtain the lateral offset and longitudinal offset of the current material distribution position and the center position of the steamer in the Cartesian coordinate system; take the ratio of the maximum material distribution radius of the material distribution device to the square root of the lateral offset and the longitudinal offset, and the product of the horizontal axis offset and the longitudinal offset, respectively, as the horizontal and vertical coordinates of the position of the first translation transition point. The vertical coordinate of the first translation transition point is the vertical coordinate of the current material distribution position.

[0070] The acquisition of the second translation transition point position is similar to that of the first translation transition point position, and will not be described in detail here to save space.

[0071] Next, based on the first translation transition point position, the second translation transition point position, and the number of intermediate transition point insertions, several intermediate transition point positions are obtained to adjust the posture of the material distribution device to prevent the material distribution device from colliding with the steamer during the process of moving from the current material distribution position to the next material distribution position.

[0072] The intermediate transition point position is obtained based on the lateral transition offset, longitudinal transition offset, vertical transition offset, and the number of intermediate transition point insertions between the first translation transition point position and the second translation transition point position.

[0073] Specifically: if the number of inserted intermediate transition points is the first value (0), there is no intermediate transition point position; if the number of inserted intermediate transition points is the first number (1), the horizontal coordinate, vertical coordinate and vertical coordinate of the intermediate transition point position are respectively half of the horizontal transition offset, half of the vertical transition offset and half of the vertical transition offset between the first translation transition point position and the second translation transition point position, and the sum corresponding to the horizontal coordinate, vertical coordinate and vertical coordinate of the first translation transition point position; if the number of inserted intermediate transition points is the second number (2), the horizontal coordinate, vertical coordinate and vertical coordinate of the first intermediate transition point position are respectively one-third of the horizontal transition offset, one-third of the vertical transition offset and one-third of the vertical transition offset between the first translation transition point position and the second translation transition point position, and the sum corresponding to the horizontal coordinate, vertical coordinate and vertical coordinate of the first translation transition point position, and the horizontal coordinate, vertical coordinate and vertical coordinate of the second intermediate transition point position are respectively two-thirds of the horizontal transition offset, two-thirds of the vertical transition offset and two-thirds of the vertical transition offset between the first translation transition point position and the second translation transition point position, and the sum corresponding to the horizontal coordinate, vertical coordinate and vertical coordinate of the first translation transition point position. The sum of the horizontal coordinate, vertical coordinate and vertical coordinate of the first translation transition point position; if the number of inserted intermediate transition points is the third number (3), the horizontal coordinate, vertical coordinate and vertical coordinate of the first intermediate transition point position are respectively one-fourth of the horizontal transition offset, one-fourth of the longitudinal transition offset and one-fourth of the vertical transition offset between the first translation transition point position and the second translation transition point position, and the sum of the horizontal coordinate, vertical coordinate and vertical coordinate of the first translation transition point position, the horizontal coordinate, vertical coordinate and vertical coordinate of the second intermediate transition point position are respectively one-fourth of the horizontal transition offset, one-fourth of the longitudinal transition offset and one-fourth of the vertical transition offset between the first translation transition point position and the second translation transition point position The horizontal transition offset of one-half, the longitudinal transition offset of one-half, and the vertical transition offset of one-half of the second translation transition point position are respectively the corresponding sum of the horizontal coordinate, vertical coordinate and vertical coordinate of the first translation transition point position, and the horizontal coordinate, vertical coordinate and vertical coordinate of the third intermediate transition point position are respectively three-quarters of the horizontal transition offset, three-quarters of the longitudinal transition offset, and three-quarters of the vertical transition offset between the first translation transition point position and the second translation transition point position, and the corresponding sum of the horizontal coordinate, vertical coordinate and vertical coordinate of the first translation transition point position.

[0074] The method for obtaining the intermediate transition point position can be implemented by the following program algorithm: (Middle1_pos, Middle2_pos, Middle3_pos) = f3(TP1, TP2, point_num), TP1, TP2, point_num are the inputs of the algorithm, TP1, TP2 are the first intermediate transition point position and the second intermediate transition point position in Cartesian coordinates, point_num is the number of intermediate transition point insertions, Middle1_pos, Middle2_pos, Middle3_pos are the outputs of the algorithm, which are the first intermediate transition point position, the second intermediate transition point position and the third intermediate transition point position in Cartesian coordinates, respectively;

[0075] Step 1: Calculate the coordinate offset from TP1 to TP2;

[0076] Transverse transition offset x_offset = TP2.x - TP1.x,

[0077] Longitudinal transition offset y_offset = TP2.y - TP1.y,

[0078] Vertical transition offset z_offset = TP2.z - TP1.z,

[0079] Step 2: Calculate the positions of Middle1_pos, Middle2_pos, and Middle3_pos;

[0080] (1) When point_num = 1,

[0081] Middle1_pos.x=x_offset / 2+TP1.x,

[0082] Middle1_pos.y=y_offset / 2+TP1.y,

[0083] Middle1_pos.z=z_offset / 2+TP1.z,

[0084] Middle2 and Middle3 do not exist;

[0085] (2) When point_num = 2,

[0086] Middle1_pos.x=x_offset / 3+TP1.x,

[0087] Middle1_pos.y=y_offset / 3+TP1.y,

[0088] Middle1_pos.z=z_offset / 3+TP1.z,

[0089] Middle2_pos.x=2*x_offset / 3+TP1.x,

[0090] Middle2_pos.y=2*y_offset / 3+TP1.y,

[0091] Middle2_pos.z=2*z_offset / 3+TP1.z,

[0092] Middle3 does not exist;

[0093] (3) When point_num = 3,

[0094] Middle1_pos.x=x_offset / 4+TP1.x,

[0095] Middle1_pos.y=y_offset / 4+TP1.y,

[0096] Middle1_pos.z=z_offset / 4+TP1.z,

[0097] Middle2_pos.x=2*x_offset / 4+TP1.x,

[0098] Middle2_pos.y=2*y_offset / 4+TP1.y,

[0099] Middle2_pos.z=2*z_offset / 4+TP1.z,

[0100] Middle3_pos.x=3*x_offset / 4+TP1.x,

[0101] Middle3_pos.y=3*y_offset / 4+TP1.y,

[0102] Middle3_pos.z=3*z_offset / 4+TP1.z.

[0103] Finally, based on the Euler angle corresponding to the first translation transition point position, the Euler angles corresponding to several intermediate transition point positions are obtained. When the material distribution device moves from the current material distribution position to the next material distribution position, the rotation of the material distribution device is controlled by rotating the joint axis to adjust the posture of the material distribution device to prevent collision with the steamer pot.

[0104] Among the Euler angles at the intermediate transition point, the pitch angle at the intermediate transition point is obtained based on the pitch angle at the first translation transition point and the pitch angle correction value (180°); the yaw angle and roll angle at the intermediate transition point are both non-rotation angles (0°).

[0105] When the number of intermediate transition points is the third number, the method for obtaining the pitch angle of the intermediate transition point position is: first, determine whether the pitch angle of the first translation transition point position is greater than the first pitch angle threshold (0°); if greater, the pitch angle of the first intermediate transition point position is the difference between the pitch angle of the first translation transition point position and the pitch angle correction value (180°); if not greater, the pitch angle of the first intermediate transition point position is the sum of the pitch angle of the first translation transition point position and the pitch angle correction value; then, determine whether the pitch angle of the first intermediate transition point position is greater than the first pitch angle threshold; if greater, the pitch angle of the first intermediate transition point position is greater than the first pitch angle threshold; The pitch angle of the second intermediate transition point is the difference between the pitch angle of the first intermediate transition point and the pitch angle correction value; if not greater than, the pitch angle of the second intermediate transition point is the sum of the pitch angle of the first intermediate transition point and the pitch angle correction value; finally, determine whether the pitch angle of the second intermediate transition point is greater than the first pitch angle threshold; if greater than, the pitch angle of the third intermediate transition point is the difference between the pitch angle of the second intermediate transition point and the pitch angle correction value; if not greater than, the pitch angle of the third intermediate transition point is the sum of the pitch angle of the second intermediate transition point and the pitch angle correction value. The pitch angle of the first translation transition point is obtained based on the Euler angle of the material laying device at the current material laying position.

[0106] Specifically: when the pitch angle TP1.a of the first translation transition point position>the first pitch angle threshold 0°, the pitch angle of the first intermediate transition point position Middle1_pos.a=TP1.a-180°, otherwise Middle1_pos.a=TP1.a+180°; when Middle1_pos.a>0°, Middle2_pos.a=Middle1_pos.a-180°, otherwise Middle2_pos.a=Middle1_pos.a+180°; when Middle2_pos.a>0°, Middle3_pos.a=Middle2_pos.a-180°, otherwise Middle3_pos.a=Middle2_pos.a+180°.

[0107] S4. Based on the current material laying position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material laying position and the corresponding Euler angles, the translation path and rotation angle of the material laying device are obtained, and the current anti-collision movement plan of the material laying device is formed; the next material laying position is used as the current material laying position to perform the operations of S1 and S2, and all material laying positions in the preset material laying position sequence set perform the operations of S1 and S2, and several anti-collision movement plans of the material laying device are obtained, forming a robot anti-collision plan for performing the robot steamer operation.

[0108] Firstly, the translation path of the material distribution device in the process of moving from the current material distribution position to the next material distribution position is determined in the order of the current material distribution position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions and the next material distribution position; based on the Euler angles of the current material distribution position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions and the next material distribution position, the rotation angle of the material distribution device in the process of moving from the current material distribution position to the next material distribution position is determined; thereby, the translation path and rotation angle of the material distribution device are obtained, forming an anti-collision movement scheme for the current material distribution device.

[0109] Among them, the translation path of the material distribution device can be realized according to the following program algorithm: the current Cartesian coordinate Current_pos of the robot, the Cartesian coordinate Next_pos of the starting point of the planned next motion trajectory, the translation transition point TP1 of Current_pos to avoid collision, the translation transition point TP2 of Next_pos to avoid collision, the number of inserted anti-collision transition points point_num, the anti-collision transition points Middle1_pos, Middle2_pos and Middle3_pos, and the motion planning strategy flag CaseP; MoveL is a linear motion instruction, MoveL X_pos, which means moving from the current position to point X_pos in a linear motion manner;

[0110] (1) When CaseP=1, that is, the motion planning strategy flag is no collision + no collision, the first translation transition point position and the second translation transition point position are the current paving position and the next paving position respectively, or the first translation transition point position and the second translation transition point position do not exist, then the material laying device moves from the current paving position Current_pos in the Cartesian coordinate system to the next paving position Next_pos, and the following motion instructions need to be executed.

[0111] If point_num=0, execute the motion instruction MoveLNext_pos, where MoveL is a linear motion instruction;

[0112] If point_num=1, execute the following steps:

[0113] MoveLMiddle1_pos,

[0114] MoveLNext_pos;

[0115] If point_num=2, execute the following steps:

[0116] MoveLMiddle1_pos,

[0117] MoveLMiddle2_pos,

[0118] MoveLNext_pos;

[0119] If point_num=3, execute

[0120] MoveLMiddle1_pos

[0121] MoveLMiddle2_pos

[0122] MoveLMiddle3_pos

[0123] MoveLNext_pos.

[0124] (2) When CaseP=2, the motion planning strategy is marked as no collision + collision, the second translation transition point is the next paving position, or the second translation transition point does not exist, then the material laying device moves from the current paving position Current_pos in the Cartesian coordinate system to the next paving position Next_pos, and the following motion instructions need to be executed.

[0125] If point_num=0, execute the motion instructions in sequence:

[0126] MoveL TP2,

[0127] MoveLNext_pos;

[0128] If point_num=1, execute the motion instructions in sequence:

[0129] MoveLMiddle1_pos,

[0130] MoveL TP2,

[0131] MoveLNext_pos.

[0132] If point_num=2, execute the following steps:

[0133] MoveLMiddle1_pos,

[0134] MoveLMiddle2_pos,

[0135] MoveL TP2,

[0136] MoveLNext_pos;

[0137] If point_num=3, execute the following steps:

[0138] MoveLMiddle1_pos,

[0139] MoveLMiddle2_pos,

[0140] MoveLMiddle3_pos,

[0141] MoveL TP2,

[0142] MoveLNext_pos.

[0143] (3) When CaseP=3, the motion planning strategy flag is collision+no collision, the first translation transition point position is the current material laying coordinate position, or the first translation transition point position does not exist, then the material laying device moves from the current material laying position Current_pos in the Cartesian coordinate system to the next material laying position Next_pos, and the following motion instructions need to be executed.

[0144] If point_num=0, execute the motion instructions in sequence:

[0145] MoveL TP1

[0146] MoveLNext_pos;

[0147] If point_num=1, execute the motion instructions in sequence:

[0148] MoveL TP1,

[0149] MoveLMiddle1_pos,

[0150] MoveLNext_pos;

[0151] If point_num=2, execute the following steps:

[0152] MoveL TP1,

[0153] MoveLMiddle1_pos,

[0154] MoveLMiddle2_pos,

[0155] MoveLNext_pos;

[0156] If point_num=3, execute the following steps:

[0157] MoveL TP1,

[0158] MoveLMiddle1_pos,

[0159] MoveLMiddle2_pos,

[0160] MoveLMiddle3_pos,

[0161] MoveLNext_pos.

[0162] (4) When CaseP=4, the motion planning strategy is marked as collision+collision. The robot moves from the current position Current_pos to the starting point Next_pos of the planned next spreading action trajectory. Then, the material spreading device moves from the current spreading position Current_pos in the Cartesian coordinate system to the next spreading position Next_pos. The following motion instructions need to be executed.

[0163] If point_num=0, execute the motion instructions in sequence:

[0164] MoveL TP1,

[0165] MoveL TP2,

[0166] MoveLNext_pos;

[0167] If point_num=1, execute the motion instructions in sequence:

[0168] MoveL TP1,

[0169] MoveLMiddle1_pos,

[0170] MoveL TP2,

[0171] MoveLNext_pos;

[0172] If point_num=2, execute the motion instructions in sequence:

[0173] MoveL TP1,

[0174] MoveLMiddle1_pos,

[0175] MoveLMiddle2_pos,

[0176] MoveL TP2,

[0177] MoveLNext_pos;

[0178] If point_num=3, execute the motion instructions in sequence:

[0179] MoveL TP1,

[0180] MoveLMiddle1_pos,

[0181] MoveLMiddle2_pos,

[0182] MoveLMiddle3_pos,

[0183] MoveL TP2,

[0184] MoveLNext_pos.

[0185] In addition, in order to avoid the problem that the joint axis at the end of the manipulator arm that controls the rotation of the material distribution device cannot rotate when the rotation angle of the Euler angle is too large due to the limitation of its own rotation angle range, the present embodiment also includes obtaining the rotation direction of the material distribution device (the rotation direction of the joint axis at the end of the manipulator arm), which is used to form the current anti-collision movement scheme of the material distribution device with the translation path and rotation angle of the material distribution device; the rotation direction of the material distribution device is obtained based on the rotation difference of the joint axis corresponding to the current material distribution position and the next material distribution position. Specifically: determine whether the initial rotation angle value of the material distribution device is less than the angle threshold (0); if not less than, the rotation direction of the material distribution device is clockwise; if less than, the rotation direction of the material distribution device is counterclockwise. The initial rotation angle value of the material distribution device is obtained based on the rotation difference of the joint axis corresponding to the current material distribution position and the next material distribution position. The specific acquisition method has been stated before, and it will not be repeated here to save space.

[0186] Finally, the next material spreading position is used as the current material spreading position to execute the operations of S1 and S2. All material spreading positions in the preset material spreading position sequence set execute the operations of S1 and S2, and several anti-collision movement schemes of the material spreading devices are obtained, forming an anti-collision scheme for the robot. When the robot is used to perform the steamer operation, it can prevent the material spreading device from colliding with the steamer pot, and there is no need to move to the center of the steamer pot for action switching every time, which reduces the switching action time, makes the steam mash more timely, and improves the efficiency of steaming.

[0187] This embodiment also provides a robot steamer loading anti-collision system, which is used to implement the above-mentioned robot steamer loading anti-collision method, including:

[0188] A motion planning strategy mark generation module is used to obtain the collision results of the material distribution device with the steamer at the current material distribution position and the next material distribution position based on the center position of the steamer and the maximum material distribution radius of the material distribution device, and form a motion planning strategy mark;

[0189] The collision judgment module during the movement process judges whether the material distribution device will collide with the steamer pot when it moves from the current material distribution position to the next material distribution position based on the current material distribution position and the next material distribution position; if no collision occurs, and the motion planning strategy flag corresponds to the collision results of the material distribution device at the current material distribution position and the next material distribution position are both no collision, then the material distribution device moves from the current material distribution position to the next material distribution position; if a collision occurs, the transition point generation module is executed;

[0190] A transition point generation module is used to obtain the number of intermediate transition points inserted between the current paving position and the next paving position based on the difference in Euler angles between the current paving position and the next paving position of the material distribution device; obtain the translation transition point positions corresponding to the current paving position and the next paving position respectively to obtain the first translation transition point position and the second translation transition point position; obtain a number of intermediate transition point positions based on the first translation transition point position, the second translation transition point position and the number of intermediate transition point insertions; obtain the Euler angles corresponding to the several intermediate transition point positions respectively based on the Euler angle corresponding to the first translation transition point position;

[0191] The current material distribution device anti-collision movement plan generation module is used to obtain the translation path and rotation angle of the material distribution device based on the current material distribution position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material distribution position and the corresponding Euler angle, so as to form the current anti-collision movement plan of the material distribution device;

[0192] The robot anti-collision scheme generation module is used to execute the operations of the motion planning strategy mark generation module and the movement process collision judgment module for the next paving position as the current paving position. All paving positions in the preset paving position sequence set execute the operations of the motion planning strategy mark generation module and the movement process collision judgment module to obtain several anti-collision movement schemes for the material distribution device, forming a robot anti-collision scheme for executing the robot steamer operation.

[0193] This embodiment also provides a robot steamer anti-collision device, including a processor and a memory, wherein the processor implements the above-mentioned robot steamer anti-collision method when executing a computer program stored in the memory.

[0194] The present embodiment provides a method for preventing collisions of a robot on a steamer. First, based on the center position of the steamer pot and the maximum radius of the material spreading device, it is determined whether the material spreading device will collide with the steamer pot at the current material spreading position and the next material spreading position, respectively, so as to determine the danger of the material spreading device at the current material spreading position and the next material spreading position, and form a motion planning strategy mark; then, based on the current material spreading position and the next material spreading position, it is determined whether the material spreading device will collide with the steamer pot during the movement, so as to choose whether to perform the anti-collision planning operation, thereby improving the flexibility and accuracy of the anti-collision of the material spreading device; then, in the process of performing the anti-collision planning operation, according to the current material spreading position and the next material spreading position, as well as the respective Euler angles, the intermediate transition point position and the corresponding Euler angle used to adjust the position and direction of the material spreading device to prevent the position of the material spreading device from colliding with the steamer pot are obtained. , ensuring that the material distribution device does not collide with the steamer when moving from the current material distribution position to the next material distribution position; finally, based on the current material distribution position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material distribution position and the corresponding Euler angles, the translation path and rotation angle of the material distribution device are determined, and the current anti-collision movement scheme of the material distribution device is formed. After all the material distribution positions in the preset material distribution position sequence set perform the above-mentioned collision judgment and anti-collision planning operations, several anti-collision movement schemes of the material distribution device are obtained, forming a robot anti-collision scheme with high flexibility and high accuracy. When used to perform the robot steaming operation, it can prevent the material distribution device from colliding with the steamer, and there is no need for the material distribution device to move to the center of the steamer every time to switch the action, which reduces the switching action time, makes the steam pressure mash more timely, and improves the steaming efficiency.

Claims

1. A robot steamer anti-collision method, characterized in that: The following operations are included: S1. Based on the center position of the steamer pot and the maximum radius of the material spreading device, the collision results of the material spreading device with the steamer pot at the current material spreading position and the next material spreading position are obtained respectively to form a motion planning strategy mark; S2, based on the current material laying position and the next material laying position, determining whether the material laying device will collide with the steamer pot during the process of moving from the current material laying position to the next material laying position; If no collision occurs, and the motion planning strategy flag corresponds to the collision results of the material placing device at the current material placing position and at the next material placing position being no collision, the material placing device moves from the current material placing position to the next material placing position; If a collision occurs, execute S3; S3, based on the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the material placing device, obtaining the number of intermediate transition points inserted between the current paving position and the next paving position; Respectively obtain the translation transition point positions corresponding to the current paving position and the next paving position to obtain the first translation transition point position and the second translation transition point position; Based on the first translation transition point position, the second translation transition point position, and the number of intermediate transition point insertions, a plurality of intermediate transition point positions are obtained; Based on the Euler angle corresponding to the position of the first translation transition point, the Euler angles corresponding to the positions of several intermediate transition points are obtained; The method for obtaining the number of intermediate transition point insertions is specifically as follows: determining whether the absolute value of the rotation difference between the joint axis corresponding to the current material laying position and the next material laying position of the material laying device is greater than the first rotation degree; if it is greater than the first rotation degree, using the rotation difference between the joint axis corresponding to the current material laying position and the next material laying position of the material laying device as the initial rotation angle value of the material laying device; If it is not greater than the first rotation degree and greater than the second rotation degree, half of the difference between the Euler angles of the material placing device at the current material placing position and the Euler angles of the next material placing position is used as the initial rotation angle value of the material placing device; If it is not greater than the second rotation degree, the initial rotation angle value of the material distribution device is the first value; determine whether the absolute value of the initial rotation angle value of the material distribution device is equal to the first value; if it is equal to the first value, the number of intermediate transition points inserted is the first value; if it is greater than the first value and not greater than the first rotation degree, the number of intermediate transition points inserted is the first number; if it is greater than the first rotation degree and not greater than the third rotation degree, the number of intermediate transition points inserted is the second number; if it is greater than the third rotation degree, the number of intermediate transition points inserted is the third number; S4, based on the current material laying position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material laying position and the corresponding Euler angle, the translation path and rotation angle of the material laying device are obtained to form the current anti-collision movement plan of the material laying device; The next paving position is used as the current paving position to execute the operations of S1 and S2. All paving positions in the preset paving position sequence set execute the operations of S1 and S2, and several anti-collision movement schemes of the material distribution device are obtained, forming a robot anti-collision scheme for executing the robot steamer operation.

2. The robot steamer anti-collision method according to claim 1, characterized in that: In S1, the operation of obtaining the collision result between the material distributing device and the steamer pot at the current material distributing position is specifically as follows: Obtain the lateral offset and longitudinal offset of the current material laying position and the center position of the steamer pot in the Cartesian coordinate system respectively; Determine whether the ratio of the maximum material spreading radius of the material spreading device to the square root of the lateral offset and the longitudinal offset is less than a safety threshold; If it is less than, the collision result between the material placing device and the steamer pot at the current material placing position is a collision; If it is not less than, the collision result between the material distribution device and the steamer pot at the current material distribution position is no collision.

3. The robot steamer anti-collision method according to claim 1, characterized in that: In S2, the operation of judging whether the material distributing device will collide with the steamer pot during the process of moving from the current material distributing position to the next material distributing position is specifically as follows: Obtain the differences in pitch angle, yaw angle and roll angle between the current material laying position and the next material laying position of the material laying device in Cartesian coordinates, and obtain the pitch angle difference, yaw angle difference and roll angle difference; Determine whether the absolute value of the pitch angle difference, the absolute value of the yaw angle difference, and the absolute value of the roll angle difference are all less than the Euler angle difference threshold; If it is less than, no collision occurs; if it is not less than, a collision occurs.

4. The robot steamer anti-collision method according to claim 1, characterized in that: In S3, If the collision result between the material distributing device and the steamer pot when the material distributing device is at the current material distributing position is no collision, the position of the first translation transition point is the current material distributing position, or the position of the first translation transition point does not exist; If the result of the collision between the material distributing device and the steamer pot is a collision when the material distributing device is at the current material distributing position, the method for obtaining the position of the first translation transition point is: Obtain the lateral offset and longitudinal offset of the current material laying position and the center position of the steamer pot in the Cartesian coordinate system respectively; The ratio of the maximum material spreading radius of the material distribution device to the square root of the lateral offset and the longitudinal offset is multiplied by the product of the lateral offset and the longitudinal offset, respectively, as the abscissa and ordinate of the position of the first translation transition point.

5. The robot steamer anti-collision method according to claim 1, characterized in that: In S3, the intermediate transition point position is obtained based on the lateral transition amount, longitudinal transition amount, vertical transition amount of the first translation transition point position and the second translation transition point position, and the number of inserted intermediate transition points.

6. The robot steamer anti-collision method according to claim 1, characterized in that: In S3, among the Euler angles at the intermediate transition point, the pitch angle at the intermediate transition point is obtained based on the pitch angle at the first translation transition point and the pitch angle correction value; the yaw angle and roll angle at the intermediate transition point are both non-rotation angles.

7. The robot steamer anti-collision method according to claim 1, characterized in that: The S4 also includes obtaining the rotation direction of the cloth-laying device, which is used together with the translation path and rotation angle of the cloth-laying device to form an anti-collision movement plan for the cloth-laying device; the rotation direction of the cloth-laying device is obtained based on the rotation difference of the corresponding joint axis when the cloth-laying device is at the current material-laying position and at the next material-laying position.

8. A robot steamer loading anti-collision system, used to implement the robot steamer loading anti-collision method according to claim 1, characterized in that: include: A motion planning strategy mark generation module is used to obtain the collision results of the material distribution device with the steamer at the current material distribution position and the next material distribution position based on the center position of the steamer and the maximum material distribution radius of the material distribution device, and form a motion planning strategy mark; The collision judgment module during the movement process judges whether the material distribution device will collide with the steamer pot when it moves from the current material distribution position to the next material distribution position based on the current material distribution position and the next material distribution position; if no collision occurs, and the motion planning strategy flag corresponds to the collision results of the material distribution device at the current material distribution position and the next material distribution position are both no collision, then the material distribution device moves from the current material distribution position to the next material distribution position; if a collision occurs, the transition point generation module is executed; A transition point generation module is used to obtain the number of intermediate transition points inserted between the current paving position and the next paving position based on the rotation difference of the joint axis corresponding to the current paving position and the next paving position of the material distribution device; respectively obtain the translation transition point positions corresponding to the current paving position and the next paving position to obtain the first translation transition point position and the second translation transition point position; obtain a number of intermediate transition point positions based on the first translation transition point position, the second translation transition point position and the number of intermediate transition point insertions; obtain the Euler angles corresponding to the several intermediate transition point positions based on the Euler angle corresponding to the first translation transition point position; The current material distribution device anti-collision movement plan generation module is used to obtain the translation path and rotation angle of the material distribution device based on the current material distribution position, the first translation transition point position, the second translation transition point position, several intermediate transition point positions, the next material distribution position and the corresponding Euler angle, so as to form the current anti-collision movement plan of the material distribution device; The robot anti-collision scheme generation module is used to execute the operations of the motion planning strategy mark generation module and the movement process collision judgment module for the next paving position as the current paving position. All paving positions in the preset paving position sequence set execute the operations of the motion planning strategy mark generation module and the movement process collision judgment module to obtain several anti-collision movement schemes for the material distribution device, forming a robot anti-collision scheme for executing the robot steamer operation.

9. A robot steamer anti-collision device, characterized in that: It comprises a processor and a memory, wherein the processor implements the robot upper steamer anti-collision method as described in any one of claims 1-7 when executing the computer program stored in the memory.

Citation Information

Patent Citations

  • Automatic steamer-filling robot system for wine making and control method thereof

    CN105199894A

  • Path planning method and device, and electronic equipment

    CN111515953A

  • Mechanical arm collision detection method for multi-arm rock drilling robot

    CN113818816A

  • Retort feeding system and retort feeding method

    CN114988048A

  • Retort feeding method for recognizing three-dimensional morphology of material surface of retort pot and hot area distribution

    CN115322863A