Path generation method and robot control system
By using linear interpolation of the external command cycle and performing acceleration correction in the robot control system, the problem of acceleration exceeding the limit caused by linear interpolation was solved, and path control was achieved so that the robot could accurately reach the target position within a predetermined time.
Patent Information
- Application Number
- CN202310417690.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2022-04-20
- Filing Date
- 2023-04-18
- Publication Date
- 2026-11-10
- Estimated Expiration
- 2043-04-18
AI Technical Summary
In existing technologies, robot control systems often encounter problems such as insufficient speed or acceleration exceeding critical values when using linear interpolation, leading to improper path control.
An external command cycle longer than the robot control cycle is used to generate the path position through linear interpolation, and corrections are made when the path speed or acceleration exceeds a critical value to ensure that the path position and speed reach the target position within a predetermined time.
This effectively avoids the problem of excessive acceleration in path control, ensuring that the robot can accurately reach the target position within the predetermined time, thus improving the reliability and accuracy of path control.
Smart Images

Figure CN116909263B_ABST
Abstract
Description
Technical Field
[0001] This disclosure relates to a path generation method and a robot control system that uses instructions from an external device to generate a robot path. Background Technology
[0002] Previously, it was known that robot control devices controlled robots based on control commands from external devices. Patent Document 1 discloses a motion control method that achieves path control by interpolating the command position when the period of the control command from the external device is longer than the robot's motion control cycle. Generally, quintic spline interpolation and linear interpolation can be used as interpolation methods. However, higher-order interpolation methods such as quintic spline interpolation, which rely on a large amount of position information, have the problem of difficulty in changing the behavior of the controlled object midway through the motion; therefore, linear interpolation is preferred.
[0003] Patent Document 1: Japanese Patent Application Publication No. 2020-4364
[0004] However, in simple linear interpolation, situations may arise where path control cannot be properly executed. For example, insufficient speed at the end of an interpolation interval may prevent reaching the target position at the end of the next interpolation interval. Alternatively, the acceleration along the path may exceed the critical acceleration. Summary of the Invention
[0005] According to a first aspect of this disclosure, a path generation method is provided for generating a robot path using instructions from an external device. The path generation method includes: step (a) receiving instruction information including control instructions from the external device in a second control cycle longer than a first control cycle, the first control cycle being a path control cycle related to a target position of a joint of the robot; and step (b) determining a path position for each of the first control cycles by interpolation between the first target position and the second target position using a first control instruction indicating a first target position and a second control instruction indicating a second target position following the first target position. The step (b) includes: step (b1), obtaining the path position for each first control cycle by performing linear interpolation between the first target position and the second target position; step (b2), using a third control command indicating the next third target position of the second target position, determining whether the path speed at the second target position is above a lower limit speed at which the third target position is reached at a predetermined arrival time when the third target position is assumed to be accelerated at a critical acceleration until the third target position; and step (b3), if it is determined that the path speed at the second target position is not above the lower limit speed, correcting the path speed between the first target position and the second target position so that the path speed at the second target position is above the lower limit speed.
[0006] According to a second aspect of this disclosure, a robot control system is provided. The robot control system includes: a robot having a servo control unit; a robot controller that sends control commands to the servo control unit; and an external device that sequentially sends instruction information including control commands to the robot controller at a second control cycle longer than a first control cycle, wherein the first control cycle is a path control cycle related to a target position of a joint of the robot. The robot controller performs: process (a) receiving instruction information from the external device sequentially at the second control cycle; and process (b) determining a path position for each of the first control cycles by interpolation between the first target position and the second target position using a first control command indicating a first target position and a second control command indicating a second target position following the first target position. Process (b) includes: process (b1) obtaining the path position for each of the first control cycles by performing linear interpolation between the first target position and the second target position; and process (b2) correcting the path position so that the path acceleration is below the critical acceleration if the path acceleration obtained from the interpolation result of the linear interpolation exceeds a critical acceleration. Attached Figure Description
[0007] Figure 1 This is an explanatory diagram showing the configuration of the robot control system in the embodiment.
[0008] Figure 2 This is a functional block diagram of the robot control system.
[0009] Figure 3 This is a flowchart illustrating the interpolation process for the path position in the first embodiment.
[0010] Figure 4A This is a graph showing the path position obtained by correcting for the critical acceleration limit.
[0011] Figure 4B This is a graph showing the path velocity obtained by correcting for the critical acceleration limit.
[0012] Figure 4C This is a graph showing the path acceleration obtained by correcting for the critical acceleration limit.
[0013] Figure 5A This is a graph showing the path position obtained by taking into account the correction of the lower limit velocity of the next interpolation interval.
[0014] Figure 5B This is a graph showing the path speed obtained by taking into account the correction of the lower limit speed of the next interpolation interval.
[0015] Figure 5C This is a graph showing the path acceleration obtained by taking into account the correction of the lower limit velocity of the next interpolation interval.
[0016] Figure 6 This is a graph showing an example of the acceleration change used to reach the lower limit velocity of the next interpolation interval.
[0017] Figure 7 This is a flowchart illustrating the interpolation process for the path position in the second embodiment.
[0018] Explanation of reference numerals in the attached figures
[0019] 100…Robot, 110…Base, 120…Robotic arm, 122…Actuator, 124…Sensor, 130…Servo control unit, 132…Actuator control unit, 134…Real-time communication unit, 140…Force sensor, 150…End effector, 200…Lower-level control device, 210…Non-real-time communication unit, 220…Control command generation unit, 230…Real-time communication unit, 240…Robot status forwarding unit, 300…Upper-level control device, 310…Command information generation unit, 320…Non-real-time communication unit. Detailed Implementation
[0020] A. First implementation method:
[0021] Figure 1 This is an explanatory diagram illustrating an example of a robot control system in one embodiment. The robot control system includes a robot 100; a lower-level control device 200 that sends control commands (CC) to the robot 100; and a higher-level control device 300 that sends instruction information (CI) for creating the control commands (CC) to the lower-level control device 200. The lower-level control device 200 is, for example, a robot controller, and the higher-level control device 300 is, for example, a personal computer. It should be noted that the lower-level control device 200 can also be referred to as a "first control device," and the higher-level control device 300 as a "second control device." The higher-level control device 300 is an external device of the robot 100.
[0022] The robot 100 includes a base 110, a robotic arm 120, and a servo control unit 130. The servo control unit 130 performs servo control related to the actuators that move the joints of the robotic arm 120. The servo control unit 130 is connected to a lower-level control device 200, which is an external device.
[0023] The robotic arm 120 is connected sequentially via four joints J1 to J4. A force sensor 140 and an end effector 150 are mounted at the front end of the robotic arm 120. The force sensor 140 may be omitted. Alternatively, other sensors such as gyroscope sensors and vibration sensors may be provided on the robotic arm 120. A TCP (Tool Center Point) serving as the control point of the robot 100 is set near the front end of the robotic arm 120. Although a four-axis robot with four joints J1 to J4 is illustrated in this embodiment, a robot with any arm mechanism having multiple joints can also be used. Furthermore, although the robot 100 in this embodiment is a horizontal multi-joint robot, a vertical multi-joint robot can also be used.
[0024] Figure 2 This is a functional block diagram of the robot control system. The lower-level control device 200 and the predetermined robot control cycle t... c1 The control command CC is synchronously sent to the servo control unit 130 to control the robot 100, and the robot status information RI is received from the servo control unit 130 and sent to the upper-level control device 300. The upper-level control device 300 can use the robot status information RI to create the next command information CI as needed. The upper-level control device 300 uses a control cycle t c2 The instruction information CI is sent to the lower-level control device 200, and the control cycle is t. c2 It is a control cycle t that is 200 longer than that of the lower-level control device. c1 The control cycle.
[0025] The upper-level control device 300 is preferably configured to create instruction information (CI) using a Robot Operating System (ROS), which is general-purpose control software independent of the robot 100's model or manufacturer. On the other hand, the lower-level control device 200 is preferably configured to create control instructions (CC) based on the instruction information CI using specific control software suitable for the robot 100's model. By combining such an upper-level control device 300 and a lower-level control device 200, a system capable of controlling the robot 100 can be easily constructed, regardless of the robot 100's model or manufacturer.
[0026] The robotic arm 120 includes actuators 122 and sensors 124. Actuators 122 are disposed at various joints for causing the joints to move. Actuators 122 also include encoders as position sensors indicating the position of each joint. In this disclosure, the term "position" of a joint refers to its displacement or angle. Additionally, "velocity" refers to the time derivative or angular velocity of the displacement, and "acceleration" refers to the second derivative or angular acceleration of the displacement. Sensor 124 includes... Figure 1 Various sensors, including the force sensor 140, are shown. Robot state information RI is information representing the state of robot 100, including position data as detection values from encoders in multiple joints and sensor values as detection values from sensor 124.
[0027] The servo control unit 130 includes an actuator control unit 132 that executes control of the actuator 122, and a real-time communication unit 134. The real-time communication unit 134 has a control cycle t c1 The function of synchronous communication with the lower-level control device 200. In this embodiment, the control cycle t c1 The latency is 2ms. The servo control unit 130 and the lower-level control device 200 are connected via a protocol that enables real-time communication at regular intervals, such as EtherCAT (Ethernet Control Automation Technology). In EtherCAT, process data obtained by linking input and output information such as digital data, analog data, and encoder values can be exchanged within Ethernet frames. In the EtherCAT connection, the lower-level control device 200 functions as the master device, and the servo control unit 130 functions as the slave device. The lower-level control device 200 and the upper-level control device 300 are connected via a protocol for non-real-time communication, such as Ethernet.
[0028] The upper-level control unit 300 includes an instruction information generation unit 310 and a non-real-time communication unit 320. The instruction information generation unit 310 generates a trajectory for the robotic arm 120 according to a pre-created robot control program RP, and creates instruction information CI for causing the robotic arm 120 to move along that trajectory. The instruction information CI includes position commands for causing the robotic arm 120 to move. The position commands are commands indicating the target positions of multiple joints of the robot 100, indicating each control cycle t. c2 The target location. The non-real-time communication unit 320 performs non-real-time communication with the non-real-time communication unit 210 of the lower-level control device 200. As described above, in this embodiment, the upper-level control device 300 and the lower-level control device 200 are connected via Ethernet. In non-real-time communication, instruction information CI is sent from the upper-level control device 300 to the lower-level control device 200, and robot status information RI is sent from the lower-level control device 200 to the upper-level control device 300. As described above, the robot status information RI includes position data of each joint of the robotic arm 120 and sensor values from the sensor 124.
[0029] The instruction information generation unit 310 performs the process of creating instruction information CI according to the robot control program RP. The instruction information CI is created by the robot control program RP using robot status information RI.
[0030] The lower-level control device 200 includes a non-real-time communication unit 210, a control command generation unit 220, a real-time communication unit 230, and a robot state forwarding unit 240. Command information CI sent from the upper-level control device 300 is received by the non-real-time communication unit 210 and forwarded to the control command generation unit 220. The control command generation unit 220 creates control commands CC according to the command information CI. In the creation of the control commands CC, the control command generation unit 220 performs path generation processing to generate the path positions of each joint. "Path position" refers to the position between target positions set by interpolation, and the positions between the target positions. In the path generation processing, the path positions between multiple target positions are determined by interpolating multiple target positions specified by multiple command information CIs. The real-time communication unit 230 operates according to each control cycle t. c1 The control command CC is sent to the servo control unit 130, and the robot status information RI is received from the servo control unit 130. The robot status information RI is then sent from the robot status forwarding unit 240 to the upper-level control device 300 via the non-real-time communication unit 210.
[0031] The servo control unit 130 of robot 100 executes path control to achieve the target positions of each joint of robot 100 according to the control command CC received from the lower-level control device 200. That is, the actuator control unit 132 executes path control of the actuators 122 that control each joint using path positions obtained through interpolation. The control period t during which the servo control unit 130 receives the control command CC from the lower-level control device 200 is... c1 This is called the "first control period t". c1 The control cycle t for the lower-level control device 200 to receive instruction information CI from the upper-level control device 300 is... c2 This is called the "second control period t". c2 "First control period t" c1 Set to be shorter than the second control period t c2 The servo control unit 130 operates with a cycle shorter than the second control cycle t. c2 The first control period t c1 The lower-level control device 200 sequentially receives control commands CC including the target position. First control cycle t c1 The preferred setting is the second control period t. c2 One-integer fraction.
[0032] Figure 3 This is a flowchart illustrating the path position interpolation process in the first embodiment. The interpolation process begins at the time point when the control command generation unit 220 receives a predetermined number of multiple command information CIs. In step S110, the control command generation unit 220 determines multiple path positions by performing linear interpolation between two target positions.
[0033] Figure 4A Examples of path positions as the result of interpolation processing are shown below. Figure 4A The horizontal axis represents time, and the vertical axis represents position. In this example, three target positions are defined: Tp0, Tp1, and Tp2. The horizontal axis is marked with the interpolation interval IP1 between target positions Tp0 and Tp1, and the interpolation interval IP2 between target positions Tp1 and Tp2. These interpolation intervals IP1 and IP2 have a second control period t for receiving the control command CC. c2 The length of the second control period t. c2 Divided into multiple first control periods t c1 First control period t c1 This is equivalent to setting time intervals for multiple path locations between two target locations Tp0 and Tp1. Figure 4A In the example, the first control period t c1 It is the second control period t c2 One-quarter of the interval, marked with the start time t0 of the interpolation interval and the first control periods t within the interpolation interval.c1 The end times are t1 to t4. Generally, when m is set to an integer greater than 2, the second control period t c2 It can be set as the first control period t c1 The length is m times the interpolation number. This integer m is also called the "interpolation number".
[0034] In linear interpolation, when the interpolation number m is set to an integer greater than 2 and k is set to an integer from 1 to m, for any two target positions Tp N ,Tp N+1 The path position p between k According to each time t within its interval k The following determinations are made.
[0035] [Mathematical Expression 1]
[0036] [Math.1]
[0037] p k =Tp N +k*Δp [1a]
[0038] Δp=(Tp N+1 -Tp N ) / m [1b].
[0039] exist Figure 4A In the diagram, the path position indicated by the point with "no critical acceleration correction" is obtained through... Figure 3 Step S110 involves linearly interpolating the path position. In the first interpolation interval IP1, the two target positions Tp0 and Tp1 are linearly interpolated. Similarly, in the second interpolation interval IP2, the two target positions Tp1 and Tp2 are linearly interpolated.
[0040] Figure 4B , Figure 4C This example shows path velocity and path acceleration as interpolation results of path position, respectively, corresponding to... Figure 4A The result of the path location shown. Figure 4B The vertical axis represents velocity. Figure 4C The vertical axis represents acceleration. Figure 4C In the interpolation interval IP2, the path acceleration indicated by the point with "no critical acceleration limit correction" exceeds the critical acceleration a at time t1. Lim Critical acceleration a Lim This is the maximum acceleration that each actuator 122 can achieve, predetermined for each actuator 122. When the path acceleration exceeds the critical acceleration α... LimIn this case, since the path position cannot be achieved, it is preferable to modify the path acceleration to be the critical acceleration a. Lim the following.
[0041] exist Figure 3 In steps S120 to S140, the path acceleration corresponding to the path position determined by the simple linear interpolation in step S110 exceeds the critical acceleration α. Lim In this case, the path position is corrected so that the path acceleration is the critical acceleration a. Lim Specifically, in step S120, the path acceleration is calculated, and in step S130, it is determined whether the path acceleration exceeds the critical acceleration α. Lim When the path acceleration does not exceed the critical acceleration a Lim In this case, proceed to the next step S210. On the other hand, if the path acceleration exceeds the critical acceleration a... Lim In this case, proceed to step S140 and consider the critical acceleration a. Lim This is used to correct the next path position. That is, to correct the next path position so that the path acceleration is at the critical acceleration α. Lim the following.
[0042] In step S140, the next path position p n For example, it can be determined as follows.
[0043] [Mathematical Expression 2]
[0044] [Math.2]
[0045] p n =p n-1 +Δp n [2a]
[0046] Δp n =(a Lim *d)*t c1 +Δp n-1 [2b].
[0047] Here, p n The path location, P, was determined through this correction. n-1 It is the position of the previous path, Δp n It is used to determine the current path position p n The sum of the values, Δp n-1 The previous path position P has been determined. n-1 The sum of the values at time a Lim It is the critical acceleration, t c1 This is the first control cycle, and d is a constant where 0 < d ≤ 1.
[0048] Figure 4AIn the diagram, the point marked as "with accel.limit correction" shows the result after correction in step S140. At time t1 of the second interpolation interval IP2, the path position p1 was corrected according to equations [2a] and [2b] above. In this example, the constant d is set to 1.0. Figure 4C As shown, the acceleration at time t1 is set to be the same as the critical acceleration a. Lim Equal values.
[0049] When the correction in step S140 is completed, return to step S110, at the path position p corrected by step S140. n Linear interpolation is performed between the target location and the next target location. Figure 4A In the example, linear interpolation is performed between the path position p1, which is corrected based on the position at time t1, and the next target position Tp2. For example... Figure 4C As shown, in the linear interpolation results between these positions p1 and Tp2, the path acceleration is less than the critical acceleration a regardless of the path position. Lim Therefore, the processing in steps S110 to S140 ends. As described above, in the processing in steps S110 to S140, linear interpolation can be used to determine the path position without exceeding the critical acceleration.
[0050] Steps S210 to S240 involve correcting the path position by considering the lower limit velocity of the next interpolation interval. "Next interpolation interval" refers to the interpolation interval following the one currently being interpolated. For example, when the current interpolation interval is set to start from the first target position Tp... N To the second target position Tp N+1 When the interval is , the next interpolation interval is from the second target position Tp. N+1 To the third target position Tp N+2 The interval. "The lower limit velocity of the next interpolation interval" is the second target position Tp. N+1 The speed at which the target position Tp is assumed to be reached after that. N+2 Until the critical acceleration a Lim During acceleration, at the third target position Tp N+2 Arrive at the third target position Tp at the scheduled arrival time N+2 The speed.
[0051] In step S210, the lower limit velocity V at the starting point of the next interpolation interval is calculated. min The lower limit speed V min For example, it can be calculated using the following formula.
[0052] [Mathematical Expression 3]
[0053] [Math.3]
[0054]
[0055] Here, Tp N+1 It is the second target location, Tp N+2 It is the third target location, a Lim It is the critical acceleration, t c1 This is the first control cycle, t c2 This is the second control cycle, and m is the interpolation number.
[0056] The second term of the molecule on the right side of the above [3] equation is equivalent to the second target position Tp. N+1 Until the third target position Tp is reached N+2 Until the critical acceleration a Lim The change in position caused by the change in velocity during acceleration, i.e., the increase in distance caused by acceleration. The lower limit velocity V at the starting point of the next interpolation interval. min via the third target position Tp N+2 With the second target position Tp N+1 Subtract the position change from the difference, and divide the result by the second control period t. c2 The length is obtained by calculating it.
[0057] If each first control cycle t is used c1 If we use discrete values to represent the above equation [3], then it can be rewritten as the following equation [4].
[0058] [Mathematical Expression 4]
[0059] [Math.4]
[0060]
[0061] Here, Δp' min It is the lower limit of the position increase at the starting point of the next interpolation interval, and the lower limit velocity V in the above [3] equation. min They are essentially the same.
[0062] The second term of the molecule on the right side of the above [4] equation is equivalent to the term from the second target position Tp. N+1 Until the third target position Tp is reached N+2 Until the critical acceleration a Lim The change in position caused by the change in velocity during acceleration. Additionally, the interpolation number m in the denominator of equation [4] is equivalent to the second control period t. c2 The value of the length. Thus, the lower limit velocity V at the starting point of the next interpolation interval. min or Δp' minAble to pass through the third target position Tp N+2 With the second target position Tp N+1 The difference minus Tp from the second target position N+1 Until the third target position Tp is reached N+2 Until the critical acceleration a Lim The position change caused by the velocity change during acceleration is subtracted from the position change and divided by the value equivalent to the second control period t. c2 The length is obtained by calculating the value of the length.
[0063] Figures 5A to 5C The lower bound velocity V, considering the next interpolation interval, is shown separately. min The path position, path velocity, and path acceleration are obtained through correction. In these graphs, the interpolation interval IP11 is the interval used as the current interpolation object. That is, Figure 5A The target position Tp11 at the starting point of the interpolation interval IP11 shown is the "first target position Tp". N The target position Tp12 at the end of the interpolation interval IP11 is the "second target position Tp". N+1 The target position Tp13 at the end of the next interpolation interval IP12 is the "third target position Tp". N+2 "In addition, in Figures 5A-5C In the diagram, the point marked "without initial velocity Vi correction" indicates the result when the correction process was not performed in steps S210 to S240. It should be noted that... Figure 5A The path position shown as "correction without initial velocity Vi" is the result of simple linear interpolation in the interpolation interval IP11.
[0064] exist Figure 3 In step S220, the initial velocity Vi at the start point of the next interpolation interval IP12 is calculated. This initial velocity Vi is equal to the velocity at the end time t4 of the current interpolation interval IP11.
[0065] In step S230, it is determined whether the initial velocity Vi at the starting point of the next interpolation interval IP12 is the lower limit velocity V. min That's all. The initial velocity Vi is the lower limit velocity V. min In the above situations, Figure 3 The processing is now complete. On the other hand, the initial velocity Vi is not at the lower limit velocity V. min Under the above conditions, proceed to step S240, considering the lower limit speed V. min To correct the path speed.
[0066] like Figure 5BAs shown, in the path position of "no initial velocity Vi correction", the initial velocity Vi at the starting point of the next interpolation interval IP12 is lower than the lower limit velocity V. min In this case, such as Figure 5A As shown, the target position Tp13 was not reached at the end of the next interpolation interval IP12. Therefore, in this case, a path speed correction is performed for the current interpolation interval IP11.
[0067] exist Figure 5B In the example shown, "with initial velocity Vi correction", the path velocity is corrected so that the velocity increases linearly from the start time t0 of the current interpolation interval IP11 and reaches the lower limit velocity V at time t2. min As a result, in the corrected path velocities, the initial velocity at the starting point of the next interpolation interval IP12 becomes similar to the lower limit velocity V. min Equal. Observation Figure 5C As shown in the acceleration diagram, the path velocity correction is performed such that the integral of the acceleration in the current interpolation interval IP11, i.e., the increase in velocity, becomes greater than before the path velocity correction. It should be noted that... Figure 5B Various methods other than those shown can be used as path speed correction methods in step S240. For example, the path speed can also be corrected so that the lower limit speed V is not reached at time t3 before the end of the current interpolation interval IP11. min At the end time t4, the lower limit velocity V is reached. min That's all. Regardless of the correction method used, the correction is performed to make the path velocity at the end of the current interpolation interval IP11 the lower limit velocity V. min The path position at the predetermined arrival time of the current interpolation interval IP11 is equal to the target position Tp12.
[0068] Figure 6 This shows the lower limit velocity V used to obtain the next interpolation interval. min A graph illustrating the change in acceleration along a path. In this example, assume the acceleration is within the current interpolation interval IP. N The value is zero in the middle, and the value is zero from the interpolation interval IP. N The time t from the middle to the end a In the middle, it accelerates with a certain acceleration α. This acceleration α is the critical acceleration a. Lim Below. At this point, assuming the current interpolation interval IP... N The path speed at the endpoint and the lower limit speed V min Equal, and the current interpolation range IP N The path position and target position Tp at the scheduled arrival time of the destination.N+1 If the condition of equality holds, then the following equations [5a] and [5b] are true.
[0069] [Mathematical Expression 5]
[0070] [Math.5]
[0071] V min =V N +α*t a [Sal
[0072]
[0073] Here, V N It is the current interpolation range IP. N The velocity at the starting point, Tp N+1 It is the current interpolation range IP. N The target position at the finish line, Tp N It is the current interpolation range IP. N The target position at the starting point, t c2 This is the second control cycle.
[0074] By solving equations [5a] and [5b] above, we can obtain Figure 6 acceleration α and time t a The solution. If these solutions are used in the current interpolation interval IP. N Execution Figure 6 The acceleration shown allows the next interpolation interval IP to be accelerated. N+1 The initial velocity Vi at the starting point becomes the lower limit velocity V. min Equal speeds. It should be noted that if the left side of equation [5a] is made the lower limit speed V... min The value obtained by multiplying by a coefficient greater than 1 will make the next interpolation interval IP... N+1 The initial velocity Vi at the starting point is the lower limit velocity V. min The values above.
[0075] When the path speed correction in step S240 is completed, return to step S220 to recalculate the initial speed Vi at the start point of the next interpolation interval IP12. Additionally, in step S230, determine whether the initial speed Vi at the start point of the next interpolation interval IP12 is the lower limit speed V. min That's it. Repeat steps S220 to S240 until the initial velocity Vi reaches the lower limit velocity V. min That's all. It should be noted that the correction process in step S240 is performed to make V... min In the case of ≤Vi, the process can also end after the execution of step S240. Figure 3 The processing.
[0076] As described above, in the above embodiments, since in Figure 3 In steps S120 to S140, path position correction considering critical acceleration is performed, thus enabling the robot's path position to be determined without exceeding the critical acceleration. Furthermore, in steps S210 to S240, since the path speed between the first and second target positions is corrected to ensure the path speed at the second target position is above a lower limit speed, the path can be determined such that the robot reaches the third target position at a predetermined arrival time.
[0077] It should be noted that either step S120 to S140 or step S210 to S240 can be omitted.
[0078] B. Second implementation method:
[0079] Figure 7 This is a flowchart illustrating the interpolation process for the path position in the second embodiment. Figure 7 Interpolation processing and Figure 3 The interpolation process in the first embodiment shown differs from the previous one in three ways: the addition of step S215 after step S210, the addition of step S235 after step S230, and the replacement of step S240 with step S245. Other aspects are the same. Figure 3 same.
[0080] In step S215, the upper limit velocity V at the starting point of the next interpolation interval is calculated. max When the next interpolation interval is set to start from the second target position Tp... N+1 To the third target position Tp N+2 When the interval is defined, the upper limit velocity V at the starting point of the next interpolation interval. max This is assuming that the target position Tp is reached. N+2 Until the critical deceleration b Lim During deceleration at the third target position Tp N+2 The scheduled arrival time will not exceed the third target position Tp N+2 The speed. This upper limit speed V max For example, it can be calculated using the following formula.
[0081] [Mathematical Expression 6]
[0082] [Math.6]
[0083]
[0084] Here, Tp N+1 It is the second target location, Tp N+2It is the third target location, b Lim It is the critical deceleration, t c1 This is the first control cycle, t c2 This is the second control cycle, and m is the interpolation number.
[0085] The second term of the molecule on the right side of the above [6] equation is equivalent to the term from the second target position Tp. N+1 Until the third target position Tp is reached N+2 Until the critical deceleration b Lim The change in position caused by the change in velocity during deceleration, i.e., the reduction in distance caused by deceleration. The upper limit velocity V at the starting point of the next interpolation interval. max By comparing this position change with the third target position Tp N+2 Second target position Tp N+1 The differences are summed, and the sum is divided by the second control period t. c2 The length is obtained by calculating it.
[0086] If each first control cycle t is used c1 If we use discrete values to represent the above equation [6], it can be rewritten as the following equation [7].
[0087] [Mathematical Expression 7]
[0088] [Math.7]
[0089]
[0090] Here, Δp' max It is the upper limit of the position increase at the starting point of the next interpolation interval, and the upper limit of the velocity V in the above [6] equation. max They are essentially the same.
[0091] The second term of the molecule on the right side of the above [7] equation is equivalent to the term from the second target position Tp. N+1 Until the third target position Tp is reached N+2 Until the critical deceleration b Lim The change in position caused by the change in velocity during deceleration. Additionally, the interpolation number m in the denominator of equation [7] is equivalent to the second control period t. c2 The value of the length. Thus, the upper limit velocity V at the starting point of the next interpolation interval. max or Δp' max Able to pass through the second target position Tp N+1 Until the third target position Tp is reached N+2 Until the critical deceleration b Lim The change in position caused by the change in velocity during deceleration and the position Tp of the third target N+2 Second target position Tp N+1The differences are summed, and the sum is divided by the value equivalent to the second control period t. c2 The length is obtained by calculating the value of the length.
[0092] Figure 7 The processing content of steps S220 and S230 after step S215 is the same as... Figure 3 These steps are the same. In step S230, the initial velocity Vi at the start point of the next interpolation interval is not at the lower limit velocity V. min Under the above conditions, proceed to step S245, considering the lower limit speed V. min This is used to correct the path speed. On the other hand, the initial speed Vi is the lower limit speed V. min In the above cases, proceed to step S235.
[0093] In step S235, it is determined whether the initial velocity Vi at the starting point of the next interpolation interval is the upper limit velocity V. max Below. The initial velocity Vi is the upper limit velocity V. max In the following cases, Figure 7 The processing is now complete. On the other hand, the initial velocity Vi did not reach the upper limit velocity V. max In the following cases, proceed to step S245, considering the upper limit speed V. max To correct the path speed. It should be noted that although the upper limit speed V is omitted... max The specific correction method for correcting path speed is explained below, but the lower limit speed V described in the first embodiment can be referred to. min The method for correcting path speed is used to perform the correction.
[0094] As described above, in the second embodiment, since the path velocity at the second target position, which serves as the starting point of the next interpolation interval, is set to an upper limit velocity V... max The following method is used to correct the path velocity between the first target position and the second target position, thus enabling the path to be determined so that the third target position can be reached at a predetermined arrival time.
[0095] It should be noted that, in the second embodiment, the determination of whether the path acceleration exceeds the critical deceleration b can also be made after the linear interpolation in step S110, for example, after step S130. Lim And when the path acceleration exceeds the critical deceleration b Lim In this case, the path position is corrected so that the path acceleration is the critical deceleration b. Lim The following is also true for the first implementation method.
[0096] Other implementation methods:
[0097] This disclosure is not limited to the embodiments described above, and can be implemented in various aspects without departing from its spirit. For example, this disclosure can also be implemented through the following aspects. In order to solve part or all of the technical problems of this disclosure, or to achieve part or all of the effects of this disclosure, the technical features in the above embodiments corresponding to the technical features in the aspects described below can be appropriately replaced or combined. In addition, if a technical feature is not described as an essential technical feature in this specification, it can be appropriately deleted.
[0098] (1) According to a first aspect of this disclosure, a path generation method is provided for generating a path of a robot using instructions from an external device. The path generation method includes: step (a), receiving instruction information including control instructions from the external device in a second control cycle longer than a first control cycle, the first control cycle being a control cycle for a path related to a target position of a joint of the robot; and step (b), determining a path position for each of the first control cycles by interpolation between the first target position and the second target position using a first control instruction indicating a first target position and a second control instruction indicating a second target position following the first target position. The step (b) includes: step (b1), obtaining the path position for each first control cycle by performing linear interpolation between the first target position and the second target position; step (b2), using a third control command indicating the next third target position of the second target position, determining whether the path speed at the second target position is above a lower limit speed at which the third target position is reached at a predetermined arrival time when the third target position is assumed to be accelerated at a critical acceleration until the third target position; and step (b3), if it is determined that the path speed at the second target position is not above the lower limit speed, correcting the path speed between the first target position and the second target position so that the path speed at the second target position is above the lower limit speed.
[0099] According to this path generation method, since the path speed between the first target position and the second target position is corrected by performing linear interpolation so that the path speed at the second target position is above the lower limit speed, the path can be determined such that the third target position can be reached at a predetermined arrival time.
[0100] (2) In the above path generation method, the lower limit speed can also be obtained by subtracting the position change caused by the speed change when accelerating with the critical acceleration from the second target position to the third target position from the difference between the third target position and the second target position, and dividing the value obtained by the subtraction by a value equivalent to the length of the second control cycle.
[0101] Based on this path generation method, the lower limit velocity at the second target position can be obtained with simple calculation.
[0102] (3) In the above path generation method, step (b) may include, after step (b3): step (b4), determining whether the path speed at the second target position is below the upper limit speed of the third target position when the predetermined arrival time at the third target position is assumed to be below the upper limit speed of the third target position when the path speed at the second target position is decelerated at a critical deceleration until the third target position; and step (b5), if it is determined that the path speed at the second target position is not below the upper limit speed, correcting the path speed between the first target position and the second target position so that the path speed at the second target position is below the upper limit speed.
[0103] According to this path generation method, since the path speed between the first target position and the second target position is corrected in such a way that the path speed at the second target position is below the upper limit speed, the path can be determined such that the third target position can be reached at a predetermined arrival time.
[0104] (4) In the above path generation method, step (b) may include the following step between step (b1) and step (b2): if the path acceleration obtained from the interpolation result of the linear interpolation exceeds the critical acceleration, the path position is corrected so that the path acceleration is below the critical acceleration.
[0105] According to this path generation method, by correcting the path position in consideration of critical acceleration, the robot's path position can be determined without exceeding the critical acceleration.
[0106] (5) According to a second aspect of this disclosure, a robot control system is provided. The robot control system comprises: a robot having a servo control unit; a robot controller that sends control commands to the servo control unit; and an external device that sequentially sends instruction information including control commands to the robot controller at a second control cycle longer than a first control cycle, wherein the first control cycle is a path control cycle related to a target position of a joint of the robot. The robot controller performs: process (a) receiving instruction information from the external device sequentially at the second control cycle; and process (b) determining a path position for each of the first control cycles by interpolation between the first target position and the second target position using a first control command indicating a first target position and a second control command indicating a second target position following the first target position. Process (b) includes: process (b1) obtaining the path position for each of the first control cycles by performing linear interpolation between the first target position and the second target position; and process (b2) correcting the path position so that the path acceleration is below the critical acceleration if the path acceleration obtained from the interpolation result of the linear interpolation exceeds a critical acceleration.
[0107] This disclosure can also be implemented through various means other than those described above. For example, it can be implemented through a robot system having a robot and a robot control device, a computer program for implementing the functions of the robot control device, and a non-transitory storage medium on which the computer program is recorded.
Claims
1. A path generation method, characterized in that, The path generation method for generating a robot's path using instructions from an external device includes: Step (a) involves sequentially receiving instruction information, including control instructions from the external device, in a second control cycle longer than the first control cycle, wherein the first control cycle is a path control cycle related to the target position of the robot's joints; and In step (b), using a first control command indicating a first target position and a second control command indicating a second target position following the first target position, the path position for each first control cycle is determined by interpolation between the first target position and the second target position. The process (b) includes: Step (b1) involves obtaining the path position for each of the first control cycles by performing linear interpolation between the first target position and the second target position; Step (b2) uses a third control command indicating the next third target position after the second target position to determine whether the path speed at the second target position is above the lower limit speed at which the third target position is reached at a predetermined arrival time when the third target position is assumed to be accelerated at a critical acceleration up to the third target position; and In step (b3), if it is determined that the path speed at the second target position is not above the lower limit speed, the path speed between the first target position and the second target position is corrected so that the path speed at the second target position is above the lower limit speed. The robot has a servo controller. The servo controller performs path control of the actuators of each joint of the robot using the path position obtained through the process (b).
2. The path generation method according to claim 1, characterized in that, The lower limit velocity is obtained by subtracting the position change caused by the velocity change during acceleration at the critical acceleration from the second target position to the third target position from the difference between the third target position and the second target position, and dividing the value obtained by the subtraction by a value equivalent to the length of the second control cycle.
3. The path generation method according to claim 1, characterized in that, The process (b) following the process (b3) includes: Step (b4) determines whether the path speed at the second target position is below the upper limit speed of the third target position when, assuming a critical deceleration up to the third target position, the predetermined arrival time at the third target position does not exceed the upper limit speed of the third target position; and In step (b5), if it is determined that the path speed at the second target position is not below the upper limit speed, the path speed between the first target position and the second target position is corrected so that the path speed at the second target position is below the upper limit speed.
4. The path generation method according to any one of claims 1 to 3, characterized in that, The step (b) between the steps (b1) and (b2) includes the following step: if the path acceleration obtained from the interpolation result of the linear interpolation exceeds the critical acceleration, the path position is corrected so that the path acceleration is below the critical acceleration.
5. A robot control system, characterized in that, have: The robot has a servo control unit; The robot controller sends control commands to the servo control unit; and An external device sequentially sends instruction information, including control commands, to the robot controller in a second control cycle that is longer than the first control cycle. The first control cycle is a path control cycle related to the target position of the robot's joints. The robot controller includes: Processing (a), sequentially receiving instruction information from the external device in the second control cycle; and In process (b), using a first control command indicating a first target position and a second control command indicating a second target position following the first target position, the path position for each first control cycle is determined by interpolation between the first target position and the second target position. The process (b) includes: Process (b1) involves obtaining the path position for each of the first control cycles by performing linear interpolation between the first target position and the second target position; Process (b2): If the path acceleration obtained from the interpolation result of the linear interpolation exceeds the critical acceleration, the path position is corrected so that the path acceleration is below the critical acceleration; Process (b3), using a third control command indicating the next third target position after the second target position, determines whether the path velocity at the second target position is above the lower limit velocity required to reach the third target position at a predetermined arrival time when, assuming critical acceleration up to the third target position, the path velocity at the second target position is greater than or equal to the lower limit velocity required to reach the third target position at a predetermined arrival time; and In process (b4), if it is determined that the path speed at the second target position is not above the lower limit speed, the path speed between the first target position and the second target position is corrected so that the path speed at the second target position is above the lower limit speed. The servo controller performs path control using the path positions obtained through the process (b) to control the actuators of each joint of the robot.
Citation Information
Patent Citations
Motion control program, motion control method and motion control device
JP2020004364A
Control apparatus, control system and control method
US20130197688A1
Robot control parameter interpolation
US20210370504A1
Motion control system with minimum time path generation
US4769583A
