A control method and system for an industrial robot based on electrical control

By forming symmetrical commutation samples to calculate frictional heat flow and recursively derive the thermal drift angle, the positioning drift problem of industrial robots caused by changes in thermal state is solved, achieving a high-precision thermal drift compensation effect.

CN123060682APending Publication Date: 2026-11-10YANGZHOU POLYTECHNIC INST
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611288665.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-08-24
Publication Date
2026-11-10

AI Technical Summary

Technical Problem

Existing control methods are difficult to effectively compensate for end-effector positioning time-varying drift caused by changes in the thermal state of the joint reducer in industrial robots, especially during high-frequency reciprocating motion and load changes, resulting in inaccurate positioning.

Method used

By collecting motor current vector, joint angle vector, and joint velocity vector to form a symmetrical commutation sample, the friction torque and friction heat flow vector are calculated. The thermal drift angle vector is recursively derived using the thermal time constant and drift mapping matrix, and the joint angle is corrected in the servo position loop to achieve thermal drift compensation.

Benefits of technology

Without adding sensors, it effectively compensates for the equivalent zero-position drift of the joints, ensuring the consistency of end-effector positioning of the industrial robot during cold start, continuous operation, and restart, thus improving positioning accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123060682A_ABST
    Figure CN123060682A_ABST
Patent Text Reader

Abstract

This invention relates to the field of industrial robot control technology, and discloses a control method and system for an industrial robot based on electrical control. The control method acquires motor current vectors, joint angle vectors, and joint velocity vectors before and after the change of the sign of each joint velocity, forming symmetrical commutation samples. Based on the commutation current difference, it obtains the friction torque vector and friction heat flow vector. Combining the update interval and thermal time constant, it recursively derives the current heat accumulation vector. Using a drift mapping matrix, it obtains the thermal drift angle vector and corrects the target angle vector, then writes the corrected angle vector into the servo position loop of each joint. This invention utilizes symmetrical commutation data in the normal task trajectory to separate the friction heat source of the reducer, characterizing the thermal state changing with the commutation interval without the need for an additional reducer temperature sensor. Furthermore, it compensates for the equivalent zero-position drift of the joints based on calibration relationships, enabling the industrial robot to maintain stable end-effector positioning performance under different thermal states.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of industrial robot control technology, and more specifically, to a control method and system for an industrial robot based on electrical control. Background Technology

[0002] Industrial robots typically consist of a robot controller, servo drivers, electric drive joints, reducers, and encoders. Each joint performs tasks such as assembly, handling, welding, or grinding according to a task trajectory. When the robot continuously performs high-frequency reciprocating motions, the torque output by the servo motor is transmitted through the reducer. Meshing friction and transmission losses continuously generate heat. Changes in the work cycle, load, and downtime further alter the heat generation and dissipation processes. Changes in the internal temperature of the reducer cause changes in dimensions, meshing clearance, and friction state, causing the equivalent zero position of the joint to change over time. The same target angle may correspond to different end positions during cold starts, warm starts, and restarts.

[0003] Existing control methods mostly rely on the motor-side encoder to execute the position closed loop and calculate the end-effector pose using fixed geometric calibration relationships. This method can correct static errors caused by assembly, but its adaptability to the gradually changing transmission thermal state during operation is limited. When using a housing temperature sensor for compensation, there is a thermal hysteresis between the measured temperature and the internal frictional thermal state of the reducer, and the additional sensor increases wiring, installation, and maintenance work. When using the total motor current to estimate the heat generation, the currents corresponding to load gravity, acceleration / deceleration, and friction are superimposed, and changes in load or trajectory can easily cause estimation errors, making it difficult to properly compensate for the time-varying drift of the end-effector positioning during long-term operation of industrial robots. Summary of the Invention

[0004] This invention provides a control method and system for an industrial robot based on electrical control, solving the technical problem of time-varying drift in the end-effector positioning of industrial robots caused by changes in the thermal state of the joint reducer in related technologies.

[0005] In a first aspect, the present invention provides a control method for an industrial robot based on electrical control, which utilizes a robot controller to perform task trajectory control on an industrial robot with multiple electrically driven joints, including: Before and after the change of velocity sign at each joint, the motor current vector, joint angle vector, and joint velocity vector are collected, and symmetrical reversal samples are formed based on the joint angle component, velocity component, and acceleration direction. Calculate the motor current difference of the symmetrical commutation sample, obtain the friction torque vector by combining the torque constant matrix, and then obtain the friction heat flow vector by using the friction torque vector and the joint velocity vector. The current heat accumulation vector is recursively derived using the update interval between adjacent commutation updates, the thermal time constant, the frictional heat flow vector, and the previous heat accumulation vector; The thermal drift angle vector is obtained based on the drift mapping matrix and the current thermal accumulation vector, and the thermal drift angle vector is subtracted from the target angle vector to obtain the correction angle vector; The corrected angle vector is written into the servo position loop of each joint, and the joint angle vector is used as position feedback to control the movement of the industrial robot.

[0006] The beneficial effects of this invention are as follows: By selecting paired data with approximately consistent attitude, approximately consistent absolute velocity, and the same acceleration direction in the commutation segment of the normal task trajectory, the influence of gravity load and inertial components in the motor current difference can be reduced, and a frictional heat flow vector related to the friction loss of the reducer can be formed accordingly; by recursively deriving the current heat accumulation vector using the actual update interval and thermal time constant, the changes in commutation frequency, cycle time, and thermal state caused by short pauses can be characterized; and by obtaining the thermal drift angle vector through the drift mapping matrix calibrated by multiple sets of stable thermal states and correcting the target angle vector, the equivalent zero-position drift of the joint can be compensated without adding a reducer temperature sensor, so that the end positioning performance in the cold start, continuous operation, and shutdown restart stages remains relatively consistent.

[0007] Secondly, the present invention provides a control system for an industrial robot based on electrical control, comprising: The commutation sample construction module is used to collect motor current vector, joint angle vector and joint velocity vector before and after the moment when the velocity sign of each joint changes, and to form symmetrical commutation samples based on the joint angle component, velocity component and acceleration direction. The frictional heat flow calculation module is used to calculate the motor current difference of the symmetrical commutation sample, obtain the frictional torque vector by combining the torque constant matrix, and then obtain the frictional heat flow vector by using the frictional torque vector and the joint velocity vector. The heat accumulation vector recursion module is used to recursively deduce the current heat accumulation vector using the update interval between adjacent commutation updates, the thermal time constant, the frictional heat flow vector, and the previous heat accumulation vector. The correction angle vector generation module is used to obtain the thermal drift angle vector based on the drift mapping matrix and the current thermal accumulation vector, and to subtract the thermal drift angle vector from the target angle vector to obtain the correction angle vector; The robot motion control module is used to write the correction angle vector to the servo position loop of each joint, and use the joint angle vector as position feedback to control the motion of the industrial robot.

[0008] Thirdly, the present invention provides a computer-readable storage medium comprising a computer program, wherein the computer program, when executed, controls a server on which the computer-readable storage medium resides to implement the steps of the method described in the first aspect. Attached Figure Description

[0009] To more clearly illustrate the technical solutions of the embodiments of the present invention, the accompanying drawings used in the embodiments will be briefly introduced below. It should be understood that the following drawings only show some embodiments of the present invention and should not be regarded as a limitation on the scope. For those skilled in the art, other related drawings can be obtained based on these drawings without creative effort.

[0010] Figure 1 This is a flowchart illustrating a control method for an industrial robot based on electrical control provided by the present invention. Figure 2 This is a schematic diagram of the process for forming symmetrical commutated samples provided by the present invention; Figure 3 This is a schematic diagram of a scenario for thermal drift compensation control of welding industrial robots provided by the present invention. Detailed Implementation

[0011] The subject matter described herein will now be discussed with reference to exemplary embodiments. It should be understood that these embodiments are discussed only to enable those skilled in the art to better understand and implement the subject matter described herein, and changes may be made to the function and arrangement of the elements discussed without departing from the scope of this specification. Various processes or components may be omitted, substituted, or added as needed in the examples. Furthermore, features described in some examples may be combined in other examples.

[0012] It should be noted that, unless otherwise defined, the technical or scientific terms used in one or more embodiments of the present invention should have the ordinary meaning understood by one of ordinary skill in the art to which this invention pertains. The terms "first," "second," and similar terms used in one or more embodiments of the present invention do not indicate any order, quantity, or importance, but are merely used to distinguish different components. Terms such as "comprising" or "including" indicate that the element or object preceding the term encompasses the elements or objects listed following the term and their equivalents, without excluding other elements or objects. Terms such as "connected" or "linked" are not limited to physical or mechanical connections, but can include electrical connections, whether direct or indirect. Terms such as "upper," "lower," "left," and "right" are used only to indicate relative positional relationships; when the absolute position of the described object changes, the relative positional relationship may also change accordingly.

[0013] like Figure 1 As shown, a control method for an industrial robot based on electrical control is proposed. This method utilizes a robot controller to control the task trajectory of an industrial robot with multiple electrically driven joints, and includes the following steps: Step S1: Collect motor current vector, joint angle vector and joint velocity vector before and after the moment when the velocity sign of each joint changes, and form symmetrical reversal samples based on joint angle components, velocity components and acceleration direction. Step S2: Calculate the motor current difference of the symmetrical commutation sample, obtain the friction torque vector by combining the torque constant matrix, and then obtain the friction heat flow vector by using the friction torque vector and the joint velocity vector. Step S3: The current heat accumulation vector is recursively derived using the update interval between adjacent commutation updates, the thermal time constant, the frictional heat flow vector, and the previous heat accumulation vector; Step S4: Obtain the thermal drift angle vector based on the drift mapping matrix and the current thermal accumulation vector, and subtract the thermal drift angle vector from the target angle vector to obtain the correction angle vector; Step S5: Write the corrected angle vector into the servo position loop of each joint, and use the joint angle vector as position feedback to control the movement of the industrial robot. Example 1

[0014] This embodiment describes the symmetric reversal sample formation process in step S1, such as... Figure 2 As shown, step S1 includes the following steps.

[0015] Step S101: For the moment when the velocity sign changes at each joint, select two sampling points in the trajectory interpolation cycle that are located before and after the moment when the velocity sign changes and are equidistant from each other.

[0016] The moment when the sign of the speed changes is the commutation reference moment when the effective speed of the same joint changes from a positive value to a negative value or from a negative value to a positive value. The controller determines the speed data whose absolute value does not exceed one quantization increment of the speed feedback as zero speed data. When the sign of the last non-zero speed before the zero speed interval is opposite to that of the first non-zero speed after the zero speed interval, the commutation is confirmed to have occurred.

[0017] When the speed does not experience a continuous zero-speed interval, the midpoint between the two times corresponding to adjacent speed data with opposite signs is used as the reversal reference time; when the speed experiences a continuous zero-speed interval, the midpoint between the start and end times of the zero-speed interval is used as the reversal reference time.

[0018] The two sampling points are two control cycles centered on the reversing reference time, located before and after the reversing respectively, and with the same time distance. The controller first selects two control cycles with a time distance of one trajectory interpolation cycle. If the sampling pair fails the verification, it expands synchronously to both sides of the reversing reference time according to the same number of interpolation cycles until a valid sampling pair is obtained or the boundary of the current reversing segment is reached. If a valid sampling pair is not obtained when the boundary is reached, the reversing data for this time is discarded.

[0019] Step S102: Extract the current component, angle component and velocity component of the corresponding joints from the two sampling points respectively, and assemble them into motor current vector, joint angle vector and joint velocity vector according to the joint sequence.

[0020] The motor current vector is a vector composed of the torque current fed back by the servo drivers of each joint in a fixed joint order. Each component uses amperes as the unit and adopts the same current definition as the equivalent torque constant on the joint side of the corresponding joint. The controller reads the torque current through the real-time communication bus and records the controller timestamp and joint number at the same time.

[0021] The joint angle vector is a vector composed of the joint side angles measured by each joint encoder in a fixed joint sequence, with each component in radians. When the encoder is set on the motor side, the controller calculates the joint side angle based on the encoder count, reduction ratio, and joint zero position offset. When the encoder is set on the joint side, the controller directly uses the joint side angle calculated by the encoder.

[0022] The joint velocity vector is a vector composed of the joint-side angular velocities of each joint in a fixed joint order, with each component in radians per second as the unit. When the servo driver outputs joint-side velocity feedback, the controller reads the velocity feedback. When the servo driver only outputs the encoder angle, the controller divides the difference in joint-side angles between adjacent control cycles by the corresponding time interval to obtain the joint-side angular velocity. Both acquisition processes use the controller's unified time reference.

[0023] The trajectory interpolation data includes the target angle, target velocity, and target acceleration output by the trajectory planner in each interpolation cycle. The controller adds timestamps based on the same time reference to the trajectory interpolation data and servo feedback.

[0024] When the feedback timestamp coincides with the sampling time, the corresponding feedback value is used directly; when the feedback period is shorter than the trajectory interpolation period, the feedback value with the smallest time difference from the sampling time is used; when the feedback period is longer than the trajectory interpolation period, the feedback values ​​with adjacent timestamps on both sides of the sampling time are used for linear interpolation; the controller maintains the same alignment rules and fixed joint sequence during one task operation.

[0025] Step S103: Verify that the joint angle components of the two sampling points are consistent using the encoder resolution.

[0026] The encoder resolution is the smallest angle increment that the encoder can distinguish at the joint side. When the encoder is set on the motor side, the joint side angle increment is converted based on the encoder's count per revolution and the reduction ratio. The controller repeatedly reads the encoder when the robot is stationary, and the angle conversion error is determined by the maximum fluctuation of the repeated reading results. When the absolute value of the difference between the corresponding joint angle components of two sampling points does not exceed the sum of the encoder resolution and the angle conversion error, the corresponding joint angle components are considered to be consistent.

[0027] Step S104: Verify that the absolute values ​​of the velocity components of the two sampling points are consistent and that the acceleration directions are the same using trajectory interpolation data, thus forming a symmetrical reversal sample.

[0028] The absolute values ​​of the velocity components at two sampling points are consistent, meaning that the difference between the absolute values ​​of the corresponding velocity components does not exceed the sum of a quantization increment of the velocity feedback and the upper limit of the velocity estimation fluctuation. The upper limit of the velocity estimation fluctuation is determined by collecting velocity feedback from the robot under no-load and uniform speed conditions and taking the maximum absolute deviation of the velocity feedback relative to the set speed.

[0029] The acceleration direction is determined by the sign of the target acceleration in the trajectory interpolation data. When the target acceleration at two sampling points is both positive or both are negative, the acceleration direction is determined to be the same. When the trajectory planner does not directly output the target acceleration, the controller divides the difference between the target velocities of adjacent interpolation cycles by the interpolation cycle and determines the acceleration direction according to the sign of the result.

[0030] Symmetrical reversing samples are pairs of data consisting of pre-reversing and post-reversing data verified by joint angle component consistency, velocity component absolute value consistency, and acceleration direction consistency. The controller excludes data that has been stopped due to collision, emergency stop, servo alarm, or cannot form a valid sampling pair when it reaches the reversing segment boundary, based on the trajectory status word, driver alarm word, and task running status. Symmetrical reversing samples and their validity markers are only saved under normal position control conditions.

[0031] It should be noted that the two symmetrically selected sampling points have joint attitudes and absolute velocity values ​​constrained by the verification scale. The same joint attitude suppresses the current component corresponding to the gravity load in the differential processing. The same acceleration direction avoids the inertial current component from being superimposed in the differential processing due to the reversal of direction. The symmetrical selection of points around the reversal reference moment can also limit the difference in inertial current between the two sampling points.

[0032] The frictional torque changes direction as the velocity direction reverses, thus enabling the extraction of the current difference related to the frictional torque amplitude from the reversal data of the normal mission trajectory, and reducing the influence of attitude changes and acceleration direction changes on this current difference. Example 2

[0033] This embodiment describes the process of obtaining the friction torque vector and friction heat flow vector in step S2. Step S2 includes the following steps.

[0034] Step S201: Construct a torque constant matrix using the torque constants of each servo motor.

[0035] The torque constant matrix is ​​formed by setting the equivalent torque constants of each servo motor on the joint side in a fixed joint sequence at the diagonal positions and setting them to zero at the remaining positions; industrial robots have When there are multiple electrically driven joints, the dimension of the torque constant matrix is: Each diagonal element uses Newton-meter per ampere as the unit.

[0036] The equivalent torque constant on the joint side can be calculated from the motor torque constant, reduction ratio and transmission efficiency under calibrated conditions recorded in the motor manufacturing data, or it can be obtained directly through dynamometer calibration.

[0037] During dynamometer calibration, multiple stable torque current points are set within the operating temperature range specified by the motor manufacturer. After deducting the zero point of the dynamometer device, the torque current and joint output torque are recorded synchronously. The linear fitting slope is used as the equivalent torque constant of the joint side. When the fitting slopes of forward rotation and reverse rotation are inconsistent, the arithmetic mean of the absolute values ​​of the two fitting slopes is taken, and the current definition, unit, and calibration results are stored in the robot controller.

[0038] Step S202: Calculate the difference between the motor current vectors before and after commutation in the symmetrical commutation sample, take the absolute value of each vector component, multiply it by the torque constant matrix, and take 1 / 2 to obtain the friction torque vector.

[0039] Specifically, the formula for calculating the friction torque vector is as follows:

[0040] In the formula, This represents the global update sequence number after a single effective frictional heat flux vector assembly is completed. Indicates that the update sequence number is The commutated motor current vector is arranged in a fixed joint sequence. Indicates that the update sequence number is The forward motor current vector is arranged in the same joint sequence.

[0041] Represents the torque constant matrix. Indicates that the update sequence number is The equivalent frictional torque vector on the joint side at that time; the absolute value is calculated according to the vector components, and each component is in Newton-meters.

[0042] The controller calculates the difference between the motor current component after commutation and the motor current component before commutation at the same joint, takes the absolute value of the difference, multiplies it by the equivalent torque constant of the joint side corresponding to that joint, and then takes half of the result to obtain the friction torque component of that joint; the friction torque components of each joint are arranged into a friction torque vector according to the fixed joint sequence.

[0043] Step S203: Calculate the average joint velocity vector, which represents the absolute value of the joint velocity vectors before and after the changeover.

[0044] The joint velocity average vector represents the arithmetic mean of the absolute values ​​of the corresponding joint velocities before and after the changeover. The controller first takes the absolute values ​​of the joint velocity vectors before and after the changeover according to their components, then calculates the arithmetic mean of the two absolute values ​​of the same joint, and forms the joint velocity average vector according to the fixed joint sequence. Each component is measured in radians per second.

[0045] Step S204: Multiply the friction torque vector by the average joint velocity vector by its components to obtain the friction heat flow vector.

[0046] Specifically, the formula for calculating the frictional heat flow vector is as follows:

[0047] In the formula, This represents the joint velocity vector after the global update. This represents the forward joint velocity vector corresponding to the global update. This indicates that the vector components of the same joint are multiplied together.

[0048] This represents the frictional heat flow vector corresponding to the global update; the absolute value of the velocity vector is calculated in components, and each component of the frictional heat flow vector is in watts.

[0049] Furthermore, after each joint obtains its first effective frictional heat flow component, the controller begins to assemble the frictional heat flow vector. When any joint obtains a new effective frictional heat flow component, the original component of the corresponding joint is replaced by this component, while other joints retain their most recent effective frictional heat flow component, and then a new frictional heat flow vector is formed according to a fixed joint sequence.

[0050] Each time an assembly is completed, the controller assigns a continuous global update sequence number and saves the corresponding timestamp, so that when different joints reverse in different control cycles, they still form vector inputs with a definite component order and a definite update time.

[0051] It should be noted that the friction torque vector is calculated using the equivalent torque constant of the joint side and multiplied by the corresponding component of the joint side velocity. Therefore, the friction heat flow vector is consistent in torque diameter, velocity diameter, and unit. The absolute value of the current difference is taken and half of it is used to extract the amplitude of the friction torque before and after the velocity direction is reversed. This is then combined with the average result of the absolute velocity value to obtain the friction loss power characterization of each joint reducer, thereby providing a heat source input for thermal state recursion that does not depend on the reducer temperature sensor. Example 3

[0052] This embodiment describes the current heat accumulation vector recursion process in step S3, which includes the following steps.

[0053] Step S301: Obtain the update interval from the controller clock and calculate the thermal memory coefficient according to the negative exponential relationship between the update interval and the thermal time constant.

[0054] The update interval is the difference between the timestamp of the controller in the current globally effective update and the timestamp of the controller in the previous globally effective update, expressed in seconds. The thermal time constant is a positive equivalent time constant calibrated for the current robot reducer configuration and recursively used by thermal accumulation, expressed in seconds, used to characterize the time scale of the combined effect of frictional heating and heat dissipation under this configuration. The thermal memory coefficient is a dimensionless scalar determined by the update interval and the thermal time constant, used to control the proportion of historical thermal states retained in the current update.

[0055] The thermal time constant was determined through cold start and shutdown cooling tests. Before the test, the robot was placed in a calibration environment until the difference between the joint equivalent zero drift and the cold start reference entered the repeatability range of the external measuring device. Then, the calibration trajectory containing repeated reversals was executed, and the frictional heat flow vector and the joint equivalent zero drift were recorded simultaneously. After reaching a stable thermal state, the robot stopped moving and continued to record cooling data.

[0056] The heating and cooling data of each joint are jointly fitted using the first-order thermal response. The sum of squared residuals between the predicted drift and the measured drift at all measurement times is used as the fitting target. The time parameter is constrained to a positive value to obtain the thermal time constant that is used uniformly in the current robot configuration and stored in the robot controller.

[0057] Specifically, the formula for calculating the thermal memory coefficient is as follows:

[0058] In the formula, This indicates the update interval between the current global effective update and the previous global effective update. Represents the thermal time constant. This represents the currently globally updated hot memory coefficient. It represents an exponential function with the natural constant as the base; both the update interval and the thermal time constant are positive, so the thermal memory coefficient is greater than zero and less than one.

[0059] Step S302: The previous heat accumulation vector is weighted by the thermal memory coefficient, and the frictional heat flow vector is weighted by the value obtained by subtracting the thermal memory coefficient from 1. The sum of the two weighted results is taken as the current heat accumulation vector.

[0060] Specifically, the formula for calculating the current heat accumulation vector is as follows:

[0061] In the formula, This represents the current hot accumulation vector after the current globally effective update. This represents the previous heat accumulation vector after the last global effective update; both heat accumulation vectors are arranged in a fixed joint order, and each component uses watts as the unit. Its value represents the equivalent thermal state obtained by first-order thermal dynamic smoothing, and does not represent the instantaneous temperature of the reducer housing, nor does it represent heat.

[0062] The controller weights all components of the previous heat accumulation vector with the same thermal memory coefficient, and then weights all components of the current frictional heat flow vector with the value obtained by subtracting the thermal memory coefficient. Finally, the components with the same joint are added together to obtain the current heat accumulation vector. The global update time of the frictional heat flow vector and the recursion time of the heat accumulation vector are determined by the same controller clock to avoid recursion interval errors caused by different time bases.

[0063] Step S303: During the initialization of the industrial robot's cold start, the previous heat accumulation vector is set to zero.

[0064] Cold machine initialization refers to the point at which the difference between the equivalent zero drift of each joint and the cold machine reference detected by the external measuring device is within the repeatability range of the device, or when the robot's downtime reaches the cold machine waiting time predetermined in the cooling test and stored in the controller. When either cold machine condition is met, the controller sets the previous heat accumulation vector to the zero vector and sets the previous global update time to the initialization time.

[0065] If the robot stops without meeting the cold start condition, the controller retains the heat accumulation vector before the stop, and the next global effective update is recursively calculated using the actual update interval that includes the stop duration.

[0066] Furthermore, when the controller does not obtain a new effective frictional heat flow vector, it does not fabricate a frictional heat flow input, nor does it change the most recent heat accumulation vector; when the next global effective update arrives, the controller calculates the thermal memory coefficient based on the actual time between the two global effective updates, so that the historical thermal state decays according to the actual elapsed time.

[0067] It should be noted that the thermal memory coefficient introduces the actual time between adjacent global effective updates into the first-order recursion. When the update interval decreases, the retention ratio of historical thermal states in the current thermal accumulation vector increases, and when the update interval increases, this retention ratio decreases. Thus, unequal interval reversal, task cycle changes, and shutdown restarts can be processed using the same recursive relationship, and the current thermal accumulation vector forms a continuous thermal state representation corresponding to the real time process. Example 4

[0068] This embodiment describes the process of obtaining the thermal drift angle vector and the correction angle vector in step S4. Step S4 includes the following steps.

[0069] Step S401: Multiply the drift mapping matrix with the current heat accumulation vector to obtain the heat drift angle vector. The drift mapping matrix is ​​determined by least squares identification with full column rank constraints through multiple sets of heat accumulation vectors under stable thermal states and joint equivalent zero position drift, and stored in the robot controller.

[0070] The drift mapping matrix is ​​a calibration matrix that maps the current heat accumulation vector to the equivalent zero-position drift of the joint; industrial robots have When there are one electrically driven joint, the dimension of the drift mapping matrix is... Each matrix element uses radians per watt as the unit, and rows and columns are determined according to a fixed joint order.

[0071] The equivalent zero-position drift of a joint is the change in the joint zero position relative to the cold machine reference under the same target angle vector. During calibration, an external measuring device measures the change in the end-effector pose relative to the cold machine reference pose, and the robot controller inputs this change into the calibrated robot kinematic model.

[0072] The controller adjusts the zero-position change of each joint to minimize the sum of squared residuals between the end pose change calculated by forward kinematics and the external measurement results, and uses the obtained joint zero-position change as the equivalent zero-position drift of the joint; when there are multiple solutions with the same residual, the minimum norm solution determined in advance by the calibration program is adopted, and the measurement results of the external measuring device should be traceable to its metrological calibration record.

[0073] A stable thermal state is defined as a situation where, in at least two consecutive equally spaced measurements, the absolute value of the difference between adjacent measurements of the equivalent zero-position drift of each joint does not exceed the repeatability range of the external measuring device. In each stable thermal state, the controller saves the current thermal accumulation vector, the external measuring device measures the end pose under the same target angle vector, and obtains the equivalent zero-position drift of the joint synchronized with the thermal accumulation vector according to the same kinematic solution rules.

[0074] When performing least squares identification, the current heat accumulation vector of each stable thermal state is used as a row to form an input data matrix, and the corresponding joint equivalent zero position drift is used as the same row to form an output data matrix. The number of stable thermal states is not less than the number of joints, and the columns of the input data matrix are independent of each other and satisfy the full column rank condition.

[0075] When the input data matrix is ​​not full column rank, calibration trajectories and stable thermal state data that allow the thermal accumulation levels of different joints to change independently are added until the full column rank condition is met. Then, the drift mapping matrix is ​​obtained with the goal of minimizing the sum of squared output residuals. After identification, the drift is calculated and compared with the measured drift using calibration trajectories that were not involved in the identification. If the comparison result exceeds the robot positioning accuracy index, calibration data is added and the identification is performed again.

[0076] Specifically, the formula for calculating the thermal drift angle vector is as follows:

[0077] In the formula Represents the drift mapping matrix, This represents the current globally valid update corresponding to the thermal drift angle vector; the thermal drift angle vectors are arranged in a fixed joint order, and each component uses radians as the unit.

[0078] The drift mapping matrix is ​​stored in the non-volatile storage area of ​​the robot controller, and the applicable robot model, reducer configuration, tool load upper and lower limits, calibration work area and calibration date are recorded. When the controller starts, it is verified that the matrix dimension is consistent with the number of joints and that the thermal time constant is positive. When the reducer or servo motor is replaced, or when the reduction ratio, transmission stage and transmission configuration are changed, recalibration is performed.

[0079] When the current thermal accumulation vector exceeds the upper and lower limits of each component of the calibration data, the thermal drift angle vector is calculated using the corresponding boundary thermal state and the maintenance information is recorded. Data outside the calibration range is not extrapolated.

[0080] Step S402: Subtract the thermal drift angle vector from the target angle vector to obtain the corrected angle vector.

[0081] Specifically, the formula for calculating the corrected angle vector is as follows:

[0082] In the formula, This represents the target angle vector output by the trajectory planner during the current interpolation period. This represents the correction angle vector for the current interpolation cycle; both the target angle vector and the correction angle vector are arranged in the order of fixed joints, and each component is in radians.

[0083] The positive direction of the joint angle, the direction of the joint equivalent zero drift, and the direction of the thermal drift angle are defined in the calibration phase. When the change of the joint equivalent zero position relative to the cold reference is positive in the hot engine state, the corresponding thermal drift angle component is positive. The controller subtracts this positive value from the target angle component, so that the position command is adjusted in the opposite direction. The target angle vector and the thermal drift angle vector are subtracted joint by joint using effective data of the same interpolation period.

[0084] It should be noted that the drift mapping matrix establishes a definite linear correspondence between the synchronous thermal accumulation state and the equivalent zero-position drift of the joint. When the input data matrix satisfies the full column rank condition, the least squares identification result can distinguish the mapping effect of the thermal state of each joint on the zero-position drift of each joint. Subtracting the thermal drift angle vector from the target angle vector according to the unified direction definition can enable the position command to pre-cancele the change in the equivalent zero position of the joint caused by the thermal state and reduce the transmission of this change to the end-position positioning result. Example 5

[0085] This embodiment describes the servo execution process in step S5, which includes the following steps.

[0086] Step S501: Write the corrected angle vector into the servo position ring of each joint.

[0087] After the robot controller completes the calculation of the correction angle vector in the current trajectory interpolation cycle, it writes each component into the corresponding servo position loop according to the fixed joint sequence. When the controller uses radians as the unit of angle, it converts the correction angle component into the driver position count according to the encoder revolution count, reduction ratio and joint zero position offset. The position commands of multiple joints are sent through a synchronization frame with the same execution timestamp, so that each joint uses the corresponding correction angle component at the same control moment.

[0088] Step S502: Collect joint angle vectors from the encoder as position feedback.

[0089] Each joint encoder continuously acquires joint angle data. The controller sequentially performs encoder zero-position verification, count overflow processing, and joint-side unit conversion. Then, it assembles the joint angle vector according to the fixed joint sequence and inputs it into the servo position loop. Thermal drift compensation only changes the position command, does not modify the original encoder feedback, and does not change the current loop parameters, speed loop parameters, and position loop parameters of the servo driver.

[0090] In step S503, each joint servo position loop tracks the correction angle vector according to the position feedback closed loop to control the movement of the industrial robot.

[0091] Each joint servo position loop calculates and corrects the position deviation between the corresponding component of the joint angle vector and the servo position vector, and drives each joint motor according to the robot's existing control cycle, so that the position feedback tracks and corrects the position command. Between two adjacent global effective updates, the controller keeps the most recent hot drift angle vector and subtracts the hot drift angle vector from the current target angle vector in each trajectory interpolation cycle. The updated hot drift angle vector is then used after the next global effective update, so as to avoid the position command being interrupted due to the lack of commutation samples.

[0092] The controller continuously monitors driver alarms, joint limits, collision status, and task operation status. When any abnormal state is triggered, thermal drift compensation and robot movement are stopped according to the robot safety control logic. After the abnormal state is cleared, the controller performs zero vector initialization or retains the thermal accumulation vector before shutdown based on the cold machine judgment result, and resumes recursion and position command correction when the next valid update is obtained.

[0093] It should be noted that the corrected angle vector is used as the position command, and the joint angle vector collected by the encoder is used as the original position feedback. Therefore, thermal drift compensation can be integrated into the existing servo position closed loop without changing the control parameters of the current loop, speed loop and position loop. The unified joint sequence, angle unit and execution timestamp ensure that the correction amount and the feedback amount correspond to each joint, so that the industrial robot executes the thermally drift-corrected position command according to the same closed loop structure during the cold start, continuous operation and shutdown restart phases.

[0094] Based on the same inventive concept, embodiments of the present invention provide a control system for an industrial robot based on electrical control, comprising: The commutation sample construction module is used to collect motor current vector, joint angle vector and joint velocity vector before and after the moment when the velocity sign of each joint changes, and to form symmetrical commutation samples based on the joint angle component, velocity component and acceleration direction. The frictional heat flow calculation module is used to calculate the motor current difference of the symmetrical commutation sample, obtain the frictional torque vector by combining the torque constant matrix, and then obtain the frictional heat flow vector by using the frictional torque vector and the joint velocity vector. The heat accumulation vector recursion module is used to recursively deduce the current heat accumulation vector using the update interval between adjacent commutation updates, the thermal time constant, the frictional heat flow vector, and the previous heat accumulation vector. The correction angle vector generation module is used to obtain the thermal drift angle vector based on the drift mapping matrix and the current thermal accumulation vector, and to subtract the thermal drift angle vector from the target angle vector to obtain the correction angle vector; The robot motion control module is used to write the correction angle vector to the servo position loop of each joint, and use the joint angle vector as position feedback to control the motion of the industrial robot.

[0095] This invention can be deployed in controllers for industrial robots used in assembly, handling, welding, or grinding. Taking a welding robot with six electrically driven joints as an example, during the debugging phase, the torque constants of each servo motor are first read, and the robot, carrying a rated welding torch, executes a repetitive trajectory covering the commonly used working area. Using a calibrated laser tracker, the same detection pose is measured during the cold start, heating, stable operation, and cooling phases. The measured end-effector pose changes are converted into equivalent zero-position drift of the joints, completing the calibration of the thermal time constant and drift mapping matrix. Figure 3As shown, during production operation, the controller reads the motor current vector, joint angle vector, and joint velocity vector from the servo driver and encoder. It then filters symmetrical commutation samples within the commutation segment of the normal welding trajectory to sequentially obtain the friction torque vector, friction heat flow vector, current heat accumulation vector, and thermal drift angle vector. In each interpolation cycle, the currently valid thermal drift angle vector is subtracted from the target angle vector, and the corrected angle vector is synchronously written into the servo position loop of each joint. No additional temperature measurement device is needed when replacing with a workpiece of the same specification and the load remains within the calibration range; recalibration after replacing the reducer or significantly changing the tool load allows for continued application.

[0096] Based on the same inventive concept, embodiments of the present invention also provide a computer-readable storage medium storing a computer program thereon, which, when executed by a processor, implements the steps of the above-described control method for an industrial robot based on electrical control.

[0097] The technical solutions of the present invention have been described in detail above with reference to specific embodiments. However, the above embodiments are only used to illustrate the technical concept and technical solutions of the present invention and do not constitute a limitation on the scope of protection of the present invention. Those skilled in the art can make various modifications, alterations, equivalent substitutions, or other forms of adjustment based on the above embodiments without departing from the technical concept and basic principles of the present invention. All changes or improvements made based on the technical content disclosed in the present invention that do not depart from the technical concept and essence of the present invention should fall within the scope of protection defined by the claims of the present invention.

Claims

1. A control method for an industrial robot based on electrical control, comprising using a robot controller to control the task trajectory of an industrial robot with multiple electrically driven joints, characterized in that, The method includes: Before and after the change of velocity sign at each joint, the motor current vector, joint angle vector, and joint velocity vector are collected, and symmetrical reversal samples are formed based on the joint angle component, velocity component, and acceleration direction. Calculate the motor current difference of the symmetrical commutation sample, obtain the friction torque vector by combining the torque constant matrix, and then obtain the friction heat flow vector by using the friction torque vector and the joint velocity vector. The current heat accumulation vector is recursively derived using the update interval between adjacent commutation updates, the thermal time constant, the frictional heat flow vector, and the previous heat accumulation vector; The thermal drift angle vector is obtained based on the drift mapping matrix and the current thermal accumulation vector, and the thermal drift angle vector is subtracted from the target angle vector to obtain the correction angle vector; The corrected angle vector is written into the servo position loop of each joint, and the joint angle vector is used as position feedback to control the movement of the industrial robot.

2. The control method for an industrial robot based on electrical control according to claim 1, characterized in that, The formation of the symmetrical reversing sample includes: for the moment when the velocity sign changes at each joint, selecting two sampling points located before and after the moment when the velocity sign changes and with an equal time distance in the trajectory interpolation cycle; extracting the current component, angle component, and velocity component of the corresponding joint from the two sampling points respectively, and assembling them into a motor current vector, a joint angle vector, and a joint velocity vector in the joint order; verifying the consistency of the joint angle components of the two sampling points with encoder resolution, and verifying the consistency of the absolute values ​​of the velocity components of the two sampling points and the same acceleration direction with trajectory interpolation data.

3. The control method for an industrial robot based on electrical control according to claim 1, characterized in that, The friction torque vector is obtained by: constructing a torque constant matrix using the torque constants of each servo motor; calculating the difference between the motor current vectors before and after commutation in the symmetrical commutation sample, taking the absolute value of each vector component, multiplying it by the torque constant matrix, and taking 1 / 2 to obtain the friction torque vector.

4. The control method for an industrial robot based on electrical control according to claim 1, characterized in that, Obtaining the frictional heat flow vector includes: calculating the average joint velocity vector based on the absolute values ​​of the joint velocity vectors before and after the changeover; and multiplying the frictional torque vector by the average joint velocity vector by their components to obtain the frictional heat flow vector.

5. The control method for an industrial robot based on electrical control according to claim 1, characterized in that, The recursion of the current heat accumulation vector includes: obtaining the update interval from the controller clock; calculating the thermal memory coefficient according to the negative exponential relationship between the update interval and the thermal time constant; weighting the previous heat accumulation vector with the thermal memory coefficient, and weighting the frictional heat flow vector with the value obtained by subtracting the thermal memory coefficient from 1, and taking the sum of the two weighted results as the current heat accumulation vector; setting the previous heat accumulation vector as the zero vector during the initialization of the industrial robot's cold start.

6. The control method for an industrial robot based on electrical control according to claim 1, characterized in that, The thermal drift angle vector is obtained by multiplying the drift mapping matrix with the current thermal accumulation vector to obtain the thermal drift angle vector; the drift mapping matrix is ​​determined by least squares identification with full column rank constraints through multiple sets of thermal accumulation vectors under stable thermal states and joint equivalent zero drift, and stored in the robot controller.

7. The control method for an industrial robot based on electrical control according to claim 1, characterized in that, The correction angle vector is obtained by subtracting the thermal drift angle vector from the target angle vector.

8. The control method for an industrial robot based on electrical control according to claim 1, characterized in that, The control of the industrial robot's motion includes: writing a correction angle vector into each joint servo position loop; acquiring joint angle vectors from an encoder as position feedback; and each joint servo position loop tracking the correction angle vector in a closed loop based on the position feedback to control the industrial robot's motion.

9. A control system for an industrial robot based on electrical control, characterized in that, The steps of performing the method as described in any one of claims 1 to 8 include: The commutation sample construction module is used to collect motor current vector, joint angle vector and joint velocity vector before and after the moment when the velocity sign of each joint changes, and to form symmetrical commutation samples based on the joint angle component, velocity component and acceleration direction. The frictional heat flow calculation module is used to calculate the motor current difference of the symmetrical commutation sample, obtain the frictional torque vector by combining the torque constant matrix, and then obtain the frictional heat flow vector by using the frictional torque vector and the joint velocity vector. The heat accumulation vector recursion module is used to recursively deduce the current heat accumulation vector using the update interval between adjacent commutation updates, the thermal time constant, the frictional heat flow vector, and the previous heat accumulation vector. The correction angle vector generation module is used to obtain the thermal drift angle vector based on the drift mapping matrix and the current thermal accumulation vector, and to subtract the thermal drift angle vector from the target angle vector to obtain the correction angle vector; The robot motion control module is used to write the correction angle vector to the servo position loop of each joint, and use the joint angle vector as position feedback to control the motion of the industrial robot.

10. A computer-readable storage medium, characterized in that, The computer-readable storage medium includes a computer program that, when executed, controls the server where the computer-readable storage medium is located to implement the steps of the method according to any one of claims 1 to 8.