Rapid shutdown method along planned trajectory

Through the rapid shutdown method along the planned trajectory, the downtime and magnification change speed are adjusted in real time, the emergency shutdown problem in robot control technology is solved, and the computing resource saving and dynamic adjustment of the shutdown position is realized, ensuring the rapid and rapid robot in emergency situations. Smooth shutdown.

CN118927244AActive Publication Date: 2024-11-12EFORT INTELLIGENT EQUIP CO LTD

Patent Information

Application Number
CN202411031416.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-30
Publication Date
2024-11-12
Estimated Expiration
2044-07-30

AI Technical Summary

Technical Problem

Existing robot control technology is difficult to shut down quickly in emergencies, and the existing methods are sensitive to data noise, lack local control capabilities, high computing resources demand, rely on hardware configuration, and uncertain downtime.

Method used

Using a fast shutdown method along the planning trajectory, the downtime and magnification change speed are adjusted in real time by loading the settings parameters, and dynamically scaling and deceleration are achieved to ensure that the downtime is within the predetermined range, reduce follow-up errors, and directly perform express control at the control layer to avoid Re-planning of trajectory interpolation layer.

Benefits of technology

It realizes simple computing logic, strong local control capabilities, dynamic adjustment of shutdown locations, and does not rely on hardware configuration, ensuring the robot's rapid and smooth shutdown in emergency situations, reducing economic losses.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118927244A_ABST
    Figure CN118927244A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of robot control, in particular to a quick shutdown method along a planned trajectory, which comprises the following steps: when a robot starts, loading setting parameters required by calculation, and setting minimum shutdown time and robot multiplying power change speed feedback compensation quantity; current robot state information is obtained, and the current multiplying power is stored in the multiplying power backup variable; the downtime of the robot is adjusted according to the real-time feedback position of the joint shaft of the robot; setting a multiplying power change speed; setting the maximum deceleration of the joint axis of the robot used in later calculation; the rate change speed of the robot is updated; the current multiplying power value of the robot is adjusted; and the robot multiplying power change speed feedback compensation amount is updated. According to the method, the robot can be controlled to execute the quick stop action by using the local maximum acceleration at different speeds, and the stop distance is shortened as far as possible within the fixed stop time, so that the purpose of reducing economic loss as far as possible in an emergency is achieved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of robot control, in particular to a rapid stopping method along a planned trajectory. Background Art

[0002] In order to meet the requirements of efficient development in the digital age, robot control technology is constantly iterating and upgrading at an astonishing speed. While putting forward high-quality control requirements such as fast, stable, and accurate for robots, robot safety is always the primary control indicator for measurement and assessment. With the widespread application of robots in different fields, whether robots directly replace manual labor or manual and robot collaborative operation application scenarios, how to control the robot to stop smoothly in the shortest time and with the shortest braking distance in an emergency is always the primary goal of protecting life and property safety. Therefore, how to ensure that the robot stops quickly in an emergency during the robot control process is of great research value.

[0003] The Chinese invention patent document "A method for planning the stopping motion trajectory of an industrial robot" (CN201911381022) takes into account the shortcomings of the robot trajectory interpolation layer and the control layer that have interpolation information response delay problems, transfers the processing logic of the stop command to the control layer for processing, and directly performs secondary planning on the calculated joint positions, thereby improving the response timeliness of rapid shutdown. When constructing a cubic spline model, this implementation method is more sensitive to data noise, lacks certain local control capabilities, and has high requirements for computing resources and certain requirements for hardware configuration. "A motion control emergency stop method" (CN202011098843) uses quartic spline curve planning to ensure the continuity of speed and acceleration during the emergency stop process, and the stop position will not exceed the target point, but this method relies on the advance determination of the stop position. If the stop position is not confirmed in time, it will lead to the problem of too long downtime. Summary of the invention

[0004] In order to solve the above technical problems, the present invention proposes a rapid shutdown method along a planned trajectory.

[0005] The technical problem to be solved by the present invention is achieved by adopting the following technical solutions:

[0006] A fast stopping method along a planned trajectory comprises the following steps:

[0007] Step 1. When the robot starts, load the setting parameters required for calculation: maximum stop time upper (> 0), maximum velocity of joint axis velupper (> 0), maximum acceleration of joint axis accupper (> 0), joint axis following error threshold fellerrthrod (> 0), system control frequency freq (> 0), and set the minimum stop time lower and robot magnification change speed feedback compensation extravel;

[0008] Step 2: After receiving the emergency stop signal, the system obtains the current robot status information: the real-time feedback speed velfeedback of the joint axis, the real-time feedback acceleration accfeedback of the joint axis, the real-time feedback tracking error feelerr of the joint axis, and the current rate value feedrade of the robot, and saves the current rate to the rate backup variable feedratepre;

[0009] Step 3: According to the real-time feedback position of the robot joint axis, adjust the robot's stop time stoptime to ensure that the stop time stoptime is always within the range of [stoptimelower, stoptimeupper];

[0010] Step 4, set the rate change speed feedratevel;

[0011] Step 5, set the robot joint axis maximum deceleration decupper used in the later calculation, and compare the joint axis real-time feedback tracking error felterr with the joint axis tracking error threshold felterrthrod in step 1. When felterr>fellowerthrod, the joint axis deceleration scaling ratio k can be adjusted from the default value 1.0 to 0.9;

[0012] Step 6: Update the robot rate change speed feedratevel;

[0013] Step 7. Adjust the robot's current multiplier value feedrade;

[0014] Step 8: Update the robot ratio change speed feedback compensation extravel.

[0015] As a further improvement of the present invention, the expression of the minimum stoptimelower in step 1 is as follows:

[0016]

[0017] The robot ratio change speed feedback compensation extravel expression is as follows:

[0018] extravel=0 (2). As a further improvement of the present invention, the expression of the rate backup variable feedratepre in step 2 is as follows:

[0019] feedratepre=feedrate (3).

[0020] As a further improvement of the present invention, the expression of the stop time in step 3 is as follows:

[0021]

[0022] stoptime=min(stoptimeupper,max(stoptime,stoptimelower)) (5).

[0023] As a further improvement of the present invention, the expression of the rate change speed feedratevel in step 4 is as follows:

[0024]

[0025] As a further improvement of the present invention, the maximum deceleration decupper expression of the robot joint axis in step 5 is as follows:

[0026] decupper=k*accupper (7).

[0027] As a further improvement of the present invention, the expression of the robot rate change speed feedratevel in step 6 is as follows:

[0028]

[0029] As a further improvement of the present invention, the current feedrade value of the robot in step 7 is expressed as follows:

[0030]

[0031] As a further improvement of the present invention, the expression of the robot ratio change speed feedback compensation amount extravel in step 8 is as follows:

[0032] extravel=(feedratevelpre-feedratevel)*freq (10).

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

[0034] The present invention provides a rapid stopping method along a planned trajectory, which has the advantages of simple calculation logic, strong local control capability, dynamic adjustment of the stopping position, and no dependence on hardware configuration.

[0035] 1. Implemented in the real-time task of the robot control layer, the speed control interface of the rapid shutdown is directly called after receiving the stop signal, and the rapid control is performed according to the real-time feedback data of the robot. There is no need to call the robot trajectory interpolation layer for secondary planning, which ensures the real-time control of the robot speed and effectively avoids the control hysteresis problem caused by re-planning.

[0036] 2. Relying on the real-time speed feedback data of each joint, the downtime is dynamically adjusted to ensure that the robot can stop quickly at the maximum acceleration within the corresponding downtime at different speeds.

[0037] 3. Relying on the real-time tracking error feedback data of each joint, the tracking error is compared with the maximum threshold of the tracking error. When the tracking error exceeds the maximum threshold, the rate of change of the robot magnification is dynamically reduced. Ensure that the tracking error of each axis is always kept in a healthy state during the robot speed regulation.

[0038] 4. When an emergency stop signal is received, the robot's magnification scaling ratio can be adjusted at the largest possible rate of change per unit time, and the robot's acceleration can be kept at the maximum value as much as possible, thereby ensuring that the robot can complete the emergency stop task with the shortest braking distance within the same stop time, so as to achieve the purpose of minimizing economic losses in an emergency.

[0039] 5. Choose to implement it in the real-time task of the robot control layer, and directly perform position sampling on the original planned trajectory. There is no need to call the planning module for secondary planning, which saves some computing resources of the control system and effectively ensures that the motion position is always on the planned path during the shutdown process. BRIEF DESCRIPTION OF THE DRAWINGS

[0040] The present invention is further described below in conjunction with the accompanying drawings and embodiments:

[0041] Figure 1 This is the robot motion control flow chart;

[0042] Figure 2 This is the rapid shutdown control flow chart. DETAILED DESCRIPTION

[0043] In order to make the technical means, creative features, objectives and effects achieved by the present invention easy to understand, the present invention is further described below with reference to the accompanying drawings and embodiments.

[0044] The robot's control process (such as Figure 1(As shown) Generally, the user links with the robot control system through a robot teaching pendant or remote connection, and issues the motion instructions to be executed; after receiving the motion instructions issued by the upper layer, the motion instruction parsing module first performs state analysis according to the robot state to determine whether the robot meets the execution conditions for executing the motion instructions. The motion instructions can only be parsed when the execution conditions are met and sent to the motion planner. When the current state cannot meet the execution conditions, the motion instruction parser directly refuses to parse and completes the relevant exception and log information feedback; after the motion planner receives the new motion instruction, it first performs motion instruction parameter verification. When the parameter verification is abnormal, the trajectory planning is rejected and the exception and log information feedback are completed. When the parameter verification passes, the trajectory planning calculation is performed. When the planning is incorrect, the exception and log information feedback must be completed in time. After the planning is completed, it is necessary to wait for the robot control module to hand over the planning result signal; the robot control module notifies the planning module to prepare to hand over the planning result by handing over the planning result signal at an appropriate time according to its own motion state, and completes the trajectory result handover with the planning module. Then, the position sampling is performed according to the set interpolation cycle, and the position sampling results are sent to the servo management module, which controls the robot to move to the target position.

[0045] During the robot control process, if an abnormal alarm occurs and the robot needs to be stopped quickly, Figure 2 As shown in FIG. 1 , a method for rapid stopping along a planned trajectory of the present invention is shown, and the specific steps are as follows:

[0046] Step 1. When the robot starts, the setting parameters required for calculation are loaded, including: maximum stop time stoptimeupper (>0), maximum speed of joint axis velupper (>0), maximum acceleration of joint axis accupper (>0), joint axis following error threshold fellerrthrod (>0), system control frequency freq (>0), and the minimum stop time stoptimelower and robot multiplier change speed feedback compensation extravel are set.

[0047] The minimum stoptimelower expression is as follows:

[0048]

[0049] The robot rate change speed feedback compensation extravel expression is as follows:

[0050] extravel=0 (2).

[0051] Step 2. After receiving the emergency stop signal, the system obtains the current robot status information: the real-time feedback speed velfeedback of the joint axis, the real-time feedback acceleration accfeedback of the joint axis, the real-time feedback tracking error feelerr of the joint axis, and the current rate value feedrade of the robot, and saves the current rate to the rate backup variable feedratepre.

[0052] The expression of the rate backup variable feedratepre is as follows:

[0053] feedratepre=feedrate (3).

[0054] Step 3: According to the real-time feedback position of the robot joint axis, adjust the robot's stop time stoptime to ensure that the stop time stoptime is always within the range of [stoptimelower,stoptimeupper].

[0055] The stoptime expression is as follows:

[0056]

[0057] stoptime=min(stoptimeupper,max(stoptime,stoptimelower)) (5).

[0058] Step 4: Set the feedratevel rate.

[0059] The expression of feedratevel is as follows:

[0060]

[0061] Step 5. Set the maximum deceleration decupper of the robot joint axis used in the later calculation, and compare the real-time feedback following error felterr of the joint axis with the following error threshold felterrthrod of the joint axis in step 1. When felterr>fellowerrthrod, the joint axis deceleration scaling ratio k can be adjusted from the default value 1.0 to 0.9.

[0062] The decupper expression of the robot joint axis maximum deceleration is as follows:

[0063] decupper=k*accupper (7).

[0064] Step 6: Update the robot rate change speed feedratevel.

[0065] The expression of the robot rate change speed feedratevel is as follows:

[0066]

[0067] Step 7: Adjust the robot’s current multiplier value feedrade.

[0068] The robot's current multiplier value feedrade expression is as follows:

[0069]

[0070] Step 8: Update the robot ratio change speed feedback compensation extravel.

[0071] The robot ratio change speed feedback compensation extravel expression is as follows:

[0072] extravel=(feedratevelpre-feedratevel)*freq (10).

[0073] The above shows and describes the basic principles, main features and advantages of the present invention. Those skilled in the art should understand that the present invention is not limited to the above embodiments. The above embodiments and descriptions only describe the principles of the present invention. Without departing from the spirit and scope of the present invention, the present invention may have various changes and improvements, which fall within the scope of the present invention. The scope of protection of the present invention is defined by the attached claims and their equivalents.

Claims

1. A rapid shutdown method along a planned trajectory, characterized in that: The following steps are involved: Step 1. When the robot starts, load the setting parameters required for calculation: maximum stop time upper (> 0), maximum velocity of joint axis velupper (> 0), maximum acceleration of joint axis accupper (> 0), joint axis following error threshold fellerrthrod (> 0), system control frequency freq (> 0), and set the minimum stop time lower and robot magnification change speed feedback compensation extravel; Step 2: After receiving the emergency stop signal, the system obtains the current robot status information: the real-time feedback speed velfeedback of the joint axis, the real-time feedback acceleration accfeedback of the joint axis, the real-time feedback tracking error feelerr of the joint axis, and the current rate value feedrade of the robot, and saves the current rate to the rate backup variable feedratepre; Step 3: According to the real-time feedback position of the robot joint axis, adjust the robot's stop time stoptime to ensure that the stop time stoptime is always within the range of [stoptimelower, stoptimeupper]; Step 4, set the rate change speed feedratevel; Step 5, set the robot joint axis maximum deceleration decupper used in the later calculation, and compare the joint axis real-time feedback tracking error felterr with the joint axis tracking error threshold felterrthrod in step 1. When felterr>fellowerthrod, the joint axis deceleration scaling ratio k can be adjusted from the default value 1.0 to 0.9; Step 6: Update the robot rate change speed feedratevel; Step 7. Adjust the robot's current multiplier value feedrade; Step 8: Update the robot's rate change speed feedback compensation extravel.

2. A method for rapid shutdown along a planned trajectory according to claim 1, characterized in that: The expression of the minimum stoptimelower in step 1 is as follows: The robot rate change speed feedback compensation extravel expression is as follows: extravel=0 (2).

3. A method for rapid shutdown along a planned trajectory according to claim 1, characterized in that: The expression of the rate backup variable feedratepre in step 2 is as follows: feedratepre=feedrate (3).

4. A method for rapid shutdown along a planned trajectory according to claim 1, characterized in that: The stoptime expression in step 3 is as follows: stoptime=min(stoptimeupper,max(stoptime,stoptimelower)) (5).

5. The method for rapid shutdown along a planned trajectory according to claim 1, characterized in that: The expression of the rate change speed feedratevel in step 4 is as follows:

6. A method for rapid shutdown along a planned trajectory according to claim 1, characterized in that: The decupper expression of the maximum deceleration of the robot joint axis in step 5 is as follows: decupper=k*accupper (7).

7. A method for rapid shutdown along a planned trajectory according to claim 1, characterized in that: The expression of the robot rate change speed feedratevel in step 6 is as follows:

8. The method for rapid shutdown along a planned trajectory according to claim 1, characterized in that: The feedrade expression of the robot's current multiplier value in step 7 is as follows:

9. A method for rapid shutdown along a planned trajectory according to claim 1, characterized in that: In step 8, the robot rate change speed feedback compensation extravel expression is as follows: extravel=(feedratevelpre-feedratevel)*freq (10).

Citation Information

Patent Citations

  • Industrial robot stop motion trajectory planning method

    CN111015669A

  • Motion control emergency stop method

    CN112269348A

  • Position domain impedance control method and device, storage medium and operation robot

    CN112405531A

  • Robot motion control method combining speed optimization and feedforward compensation

    CN113253677A

  • Method for controlling motion of device, device, and storage apparatus

    WO2020093401A1

Cited By

  • Gear precision assembly system and assembly method based on visual servo

    CN122185238A