Heavy-load industrial robot dual-motor control method, device and equipment and medium
By adopting the main motor position ring, speed ring, torque ring control and auxiliary motor torque ring control in heavy-duty industrial robots, combined with dynamic distributed torque calculation, the problems of high driving cost and complex control of heavy-duty industrial robots are solved. , realizes dual motor torque synchronization and equipment stability.
Patent Information
- Application Number
- CN202411070741.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-06
- Publication Date
- 2024-11-12
AI Technical Summary
The existing heavy-duty industrial robot dual-motor drive scheme is costly and complex in control strategies, making it difficult to achieve synchronization effects, resulting in strong coupling and affecting equipment performance.
The main motor adopts position ring, speed ring and torque ring control. The auxiliary motor only adopts torque ring control. The auxiliary motor torque ring input comes from the output of the main motor speed ring, and the dual motor torque is realized through dynamic distributed torque calculation and feedback. Synchronization reduces strong coupling of control strategies.
The cost of heavy-load industrial robot joints is reduced, the synchronous control of dual motor torque is realized, the control complexity is reduced, and the position deviation of the robot under all speed segments is within an acceptable range, ensuring the stable operation of the equipment.
Smart Images

Figure CN118944495A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robot control technology, and in particular to a method, device, equipment and medium for controlling dual motors of a heavy-duty industrial robot. Background Art
[0002] Industrial robots are defined as programmable multifunctional manipulators used to carry mechanical parts or workpieces, or special mechanical devices that can complete various tasks by changing programs. Industrial robots can replace human labor in high-risk and harsh environments. They have the advantages of high work efficiency, high precision, and good stability. They play a vital role in traditional manufacturing and are currently widely used in different industries such as mechanical processing, automobile parts manufacturing, food processing, electronics and electrical, and logistics.
[0003] As industrial robot technology continues to mature, the end-load capacity of industrial robots has become an important factor affecting the performance of robots. Therefore, how to improve the end-load capacity of industrial robots and thus improve the performance of robots has received more and more attention. At present, heavy-duty industrial robots are restricted by technology, with a small number of product types and manufacturers, making it difficult to cope with the heavy-duty robot market with wide demand. As high-end technical equipment, heavy-duty industrial robots have very broad application prospects.
[0004] Heavy-duty industrial robots usually use ultra-high torque output motor drives to achieve the large end load requirements. There are two major types of existing heavy-duty joint drive solutions: single-motor drive and dual-motor drive. Among them, the single-motor drive has high requirements for the motor output power and output torque, and must be matched with a large and high-cost reducer, which is too expensive; the dual-motor drive solution can output power to a single joint at the same time. This drive solution can greatly reduce costs, but the drive control algorithm is complex. The traditional dual-motor control strategy generally adopts a gantry synchronization control algorithm. In order to achieve a better synchronization effect, the two motor control strategies are strongly coupled, which is difficult to implement. Summary of the invention
[0005] The present application provides a method, device, equipment and medium for controlling dual motors of a heavy-duty industrial robot, which has the advantages of adopting a synchronous control strategy for main and auxiliary motors, wherein the control strategy for the main motor adopts a complete position loop, speed loop and torque loop control, and the control strategy for the auxiliary motor adopts only a torque loop control, and the input of the auxiliary motor torque loop comes from the output of the main motor speed loop. This not only achieves the control purpose of dual motor torque synchronization, but also reduces the strong coupling of the two motor control strategies.
[0006] The technical solution of this application is as follows:
[0007] On the one hand, the present application provides a dual-motor drive control method for a heavy-duty industrial robot, comprising the following steps:
[0008] S1: Mark the dual motors of the heavy-duty industrial robot as the main motor and auxiliary motor respectively;
[0009] S2: The main motor is controlled by position loop, speed loop and torque loop, and the auxiliary motor is controlled by torque loop. The torque loop input of the auxiliary motor comes from the speed loop output of the main motor.
[0010] S3: Calculate the first dynamic distributed torque according to the feedback speed of the main motor and the auxiliary motor and feed it back to the torque loop of the main motor and the auxiliary motor;
[0011] The second dynamic distributed torque is calculated according to the feedback positions of the main motor and the auxiliary motor and fed back to the torque loops of the main motor and the auxiliary motor.
[0012] Further, in step S2, the given torque output by the speed loop is distributed to the torque loops of the main motor and the auxiliary motor;
[0013] Furthermore, in step S2, the given torque output by the speed loop is distributed to the torque loops of the main motor and the auxiliary motor in a 1:1 manner.
[0014] Furthermore, in step S3, the calculation formula of the first dynamic distributed moment is as follows:
[0015] T v =k v (v m -v s )
[0016] The calculation formula of the second dynamic distributed moment is as follows:
[0017] T p =k p (p m -p s )
[0018] Among them, T v is the first dynamic distributed moment, T p is the second dynamic distributed moment, k v is the gain of the first dynamic distributed moment, k p is the gain of the second dynamic distributed torque, v m 、v s Feedback speed of main and auxiliary motors, p m 、p s Feedback position for main and auxiliary motors.
[0019] Furthermore, the first dynamically distributed torque and the second dynamically distributed torque are fed back to the torque loop of the main motor in the form of negative feedback, and the first dynamically distributed torque and the second dynamically distributed torque are fed back to the torque loop of the auxiliary motor in the form of positive feedback.
[0020] In another aspect, the present application provides a dual-motor drive control device for a heavy-duty industrial robot, comprising:
[0021] A main motor control module, used to control the main motor using a position loop, a speed loop and a torque loop;
[0022] An auxiliary motor control module, used for controlling the auxiliary motor using a torque loop;
[0023] and a dynamic torque distribution module, which is used to calculate the dynamic distributed torque according to the feedback speed and feedback position of the main motor and the auxiliary motor and feed it back to the torque loops of the main motor and the auxiliary motor;
[0024] The main motor control module outputs the given torque of the auxiliary motor to the auxiliary motor control module, and the given torque output by the speed loop is distributed to the torque loops of the main motor and the auxiliary motor in a 1:1 manner.
[0025] Further, the dynamic torque distribution module includes a first dynamic torque distribution module and a second dynamic torque distribution module;
[0026] The first dynamic torque distribution module is used to calculate the first dynamic distributed torque according to the feedback speed of the main motor and the auxiliary motor and feed it back to the torque loop of the main motor and the auxiliary motor;
[0027] The second dynamic torque distribution module is used to calculate the second dynamic distributed torque according to the feedback positions of the main motor and the auxiliary motor and feed it back to the torque loops of the main motor and the auxiliary motor.
[0028] Furthermore, the first dynamic torque distribution module adjustment formula is as follows:
[0029] T v =k v (v m -v s )
[0030] The second dynamic torque distribution module adjustment formula is as follows:
[0031] T p =k p (p m -p s )
[0032] Among them, T v is the given torque command output by the first dynamic torque distribution module, that is, the first dynamic distributed torque, T p is the given torque command output by the second dynamic torque distribution module, that is, the second dynamic distributed torque, k v is the gain of the first dynamic torque distribution module, k p is the gain of the second dynamic torque distribution module, v m 、v sFeedback speed of main and auxiliary motors, p m 、p s Feedback position of main and auxiliary motors;
[0033] The first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the main motor in the form of negative feedback, and the first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the auxiliary motor in the form of positive feedback.
[0034] On the other hand, the present application provides a heavy-load industrial robot dual-motor control device, including a processor and a memory, wherein the memory stores a computer program, and when the computer program is called and executed by the processor, the heavy-load industrial robot dual-motor drive control method as described above is implemented.
[0035] On the other hand, the present application provides a computer-readable storage medium, which stores a computer program. When the computer program is called and executed by a computer, it implements the dual-motor drive control method for a heavy-duty industrial robot as described above.
[0036] In summary, the beneficial effects of this application are:
[0037] 1. Traditional heavy-duty industrial robot joints are driven by motors with large torque output, which makes the cost of the whole machine too high. The present invention uses dual motors with relatively small output torque to drive the heavy-duty industrial robot joints, which can effectively reduce the manufacturing cost while meeting the robot's load capacity.
[0038] 2. The traditional dual-motor control strategy generally adopts the gantry synchronization control algorithm. In order to achieve a better synchronization effect, the two motor control strategies have strong coupling, which is difficult to implement. The present invention adopts the main and auxiliary motor synchronization control strategy. The main motor control strategy adopts a complete position loop, speed loop, and torque loop control. The auxiliary motor control strategy only uses the torque loop control, and the auxiliary motor torque loop input comes from the main motor speed loop output. This method not only achieves the control purpose of dual motor torque synchronization, but also reduces the strong coupling of the two motor control strategies.
[0039] 3. The present invention calculates the dynamic distributed torque and adjusts the torque loop, thereby achieving a small position deviation of the main and auxiliary motors in all speed ranges, which is always within the deviation range allowed by the mechanical design. The dynamic torque distribution module (or dynamic distributed torque) is used to adjust the dynamic torque distribution of the main and auxiliary motors in real time, ensuring that the robot body is always in a stable and reliable operating state. BRIEF DESCRIPTION OF THE DRAWINGS
[0040] Figure 1 It is a schematic diagram of the principle of this application;
[0041] Figure 2It is a schematic diagram of the feedback speed of the main and auxiliary motors of the robot when the robot is running without a dynamic torque distribution module in a specific embodiment of the present application;
[0042] Figure 3 It is a schematic diagram of the feedback speed of the main and auxiliary motors of the robot when it is running with a dynamic torque distribution module in a specific embodiment of the present application;
[0043] Figure 4 This is a schematic diagram of the position deviation of the main and auxiliary motors of the robot before and after the dynamic torque distribution module intervenes in a specific embodiment of the present application. DETAILED DESCRIPTION
[0044] The specific implementation of the present application is described in detail below with reference to the accompanying drawings.
[0045] A specific embodiment of the present application provides a dual-motor drive control method for a heavy-duty industrial robot, comprising the following steps:
[0046] S1: Mark the dual motors of the heavy-duty industrial robot as the main motor and auxiliary motor respectively.
[0047] S2: Figure 1 As shown, the main motor is controlled by a position loop, a speed loop and a torque loop, the auxiliary motor is controlled by a torque loop, and the torque loop input of the auxiliary motor comes from the speed loop output of the main motor.
[0048] Specifically, the given torque output by the speed loop is distributed to the torque loops of the main motor and the auxiliary motor in a 1:1 manner.
[0049] S3: Calculate the first dynamic distributed torque according to the feedback speed of the main motor and the auxiliary motor and feed it back to the torque loop of the main motor and the auxiliary motor;
[0050] The second dynamic distributed torque is calculated according to the feedback positions of the main motor and the auxiliary motor and fed back to the torque loops of the main motor and the auxiliary motor.
[0051] The calculation formula of the first dynamic distributed moment is as follows:
[0052] T v =k v (v m -v s )
[0053] The calculation formula of the second dynamic distributed moment is as follows:
[0054] T p =k p (p m -p s )
[0055] Among them, T v is the first dynamic distributed moment, Tp is the second dynamic distributed moment, k v is the gain of the first dynamic distributed moment, k p is the gain of the second dynamic distributed torque. The gain is set by the servo parameters (manually set according to the speed and position response), ranging from -1000 to 1000; v m 、v s Feedback speed of main and auxiliary motors, p m 、p s Feedback position for main and auxiliary motors.
[0056] The first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the main motor in the form of negative feedback, and the first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the auxiliary motor in the form of positive feedback.
[0057] Another specific implementation of the present application provides a dual-motor drive control device for a heavy-duty industrial robot, referring to Figure 1 , including a main motor control module, an auxiliary motor control module and a dynamic torque distribution module.
[0058] The main motor control module is used to control the main motor using position loop, speed loop and torque loop.
[0059] The auxiliary motor control module is used to control the auxiliary motor using a torque loop.
[0060] The dynamic torque distribution module is used to calculate the dynamic distributed torque according to the feedback speed and feedback position of the main motor and the auxiliary motor and feed it back to the torque loop of the main motor and the auxiliary motor. Among them, the main motor control module outputs the given torque of the auxiliary motor to the auxiliary motor control module, and the given torque output by the speed loop is distributed to the torque loops of the main motor and the auxiliary motor in a 1:1 manner.
[0061] The dynamic torque distribution module includes a first dynamic torque distribution module and a second dynamic torque distribution module. The first dynamic torque distribution module is used to calculate the first dynamic distributed torque according to the feedback speed of the main motor and the auxiliary motor and feed it back to the torque loop of the main motor and the auxiliary motor; the second dynamic torque distribution module is used to calculate the second dynamic distributed torque according to the feedback position of the main motor and the auxiliary motor and feed it back to the torque loop of the main motor and the auxiliary motor.
[0062] The adjustment formula of the first dynamic torque distribution module is as follows:
[0063] T v =k v (v m -v s )
[0064] The second dynamic torque distribution module adjustment formula is as follows:
[0065] Tp =k p (p m -p s )
[0066] Among them, T v is the given torque command output by the first dynamic torque distribution module, that is, the first dynamic distributed torque, T p is the given torque command output by the second dynamic torque distribution module, that is, the second dynamic distributed torque, k v is the gain of the first dynamic torque distribution module, k p is the gain of the second dynamic torque distribution module, v m 、v s Feedback speed of main and auxiliary motors, p m 、p s Feedback position of main and auxiliary motors;
[0067] The first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the main motor in the form of negative feedback, and the first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the auxiliary motor in the form of positive feedback.
[0068] In this embodiment, a 3KW motor is used as the main motor and the auxiliary motor for specific description. The specific working process of the dual motor control is as follows:
[0069] (1) Operation without dynamic torque distribution module:
[0070] The robot controller only sends position commands to the main motor and obtains the speed feedback from the main and auxiliary motors, such as Figure 2 As shown in the figure, it can be seen that there is speed fluctuation in the auxiliary motor speed feedback during operation.
[0071] (2) Run under the configuration of dynamic torque distribution module:
[0072] Under the same operating conditions, the feedback speed of the main and auxiliary motors is obtained, such as Figure 3 As shown in the figure, it can be seen that the auxiliary motor speed feedback fluctuation during operation is significantly improved. The position deviation of the main and auxiliary motors before and after the dynamic torque distribution module is involved is compared, as shown in the figure. Figure 4 As shown in the figure, it can be seen that the maximum position deviation pulse number of the main and auxiliary motors is significantly reduced during operation. According to the encoder resolution, the maximum position deviation pulse number is converted into an angle, which is reduced from 6.33° to 1.41°.
[0073] Another specific embodiment of the present application provides a heavy-load industrial robot dual-motor control device, including a processor and a memory, wherein the memory stores a computer program, and when the computer program is called and executed by the processor, the heavy-load industrial robot dual-motor drive control method as described above is implemented.
[0074] Another specific embodiment of the present application provides a computer-readable storage medium, which stores a computer program. When the computer program is called and executed by a computer, it implements the dual-motor drive control method for a heavy-duty industrial robot as described above.
[0075] The above is only a preferred implementation of the present application. It should be pointed out that a person skilled in the art can make several modifications and improvements without departing from the inventive concept of the present application, and these all fall within the scope of protection of the present application.
Claims
1. A dual-motor drive control method for a heavy-duty industrial robot, characterized in that: The following steps are involved: S1: Mark the dual motors of the heavy-duty industrial robot as the main motor and auxiliary motor respectively; S2: The main motor is controlled by position loop, speed loop and torque loop, and the auxiliary motor is controlled by torque loop. The torque loop input of the auxiliary motor comes from the speed loop output of the main motor. S3: Calculate the first dynamic distributed torque according to the feedback speed of the main motor and the auxiliary motor and feed it back to the torque loop of the main motor and the auxiliary motor; The second dynamic distributed torque is calculated according to the feedback positions of the main motor and the auxiliary motor and fed back to the torque loops of the main motor and the auxiliary motor.
2. The heavy-duty industrial robot dual-motor drive control method according to claim 1, characterized in that: In step S2, the given torque output by the speed loop is distributed to the torque loops of the main motor and the auxiliary motor.
3. The dual-motor drive control method for a heavy-duty industrial robot according to claim 2, characterized in that: In step S2, the given torque output by the speed loop is distributed to the torque loops of the main motor and the auxiliary motor in a 1:1 manner.
4. The dual-motor drive control method for a heavy-duty industrial robot according to claim 3, characterized in that: In step S3, the calculation formula of the first dynamic distributed moment is as follows: T v =k v (v m -v s ) The calculation formula of the second dynamic distributed moment is as follows: T p =k p (p m -p s ) Among them, T v is the first dynamic distributed moment, T p is the second dynamic distributed moment, k v is the gain of the first dynamic distributed moment, k p is the gain of the second dynamic distributed torque, v m 、v s Feedback speed of main and auxiliary motors, p m 、p s Feedback position for main and auxiliary motors.
5. The dual-motor drive control method for a heavy-duty industrial robot according to claim 1, characterized in that: The first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the main motor in the form of negative feedback, and the first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the auxiliary motor in the form of positive feedback.
6. A dual-motor drive control device for a heavy-duty industrial robot, characterized in that: include: A main motor control module, used to control the main motor using a position loop, a speed loop and a torque loop; An auxiliary motor control module, used for controlling the auxiliary motor using a torque loop; and a dynamic torque distribution module, which is used to calculate the dynamic distributed torque according to the feedback speed and feedback position of the main motor and the auxiliary motor and feed it back to the torque loops of the main motor and the auxiliary motor; The main motor control module outputs the given torque of the auxiliary motor to the auxiliary motor control module, and the given torque output by the speed loop is distributed to the torque loops of the main motor and the auxiliary motor in a 1:1 manner.
7. The dual-motor drive control device for a heavy-duty industrial robot according to claim 1, characterized in that: The dynamic torque distribution module includes a first dynamic torque distribution module and a second dynamic torque distribution module; The first dynamic torque distribution module is used to calculate the first dynamic distributed torque according to the feedback speed of the main motor and the auxiliary motor and feed it back to the torque loop of the main motor and the auxiliary motor; The second dynamic torque distribution module is used to calculate the second dynamic distributed torque according to the feedback positions of the main motor and the auxiliary motor and feed it back to the torque loops of the main motor and the auxiliary motor.
8. The dual-motor drive control device for a heavy-duty industrial robot according to claim 1, characterized in that: The adjustment formula of the first dynamic torque distribution module is as follows: T v =k v (v m -v s ) The second dynamic torque distribution module adjustment formula is as follows: t p =k p (p m -p s ) Among them, T v is the given torque command output by the first dynamic torque distribution module, that is, the first dynamic distributed torque, T p is the given torque command output by the second dynamic torque distribution module, that is, the second dynamic distributed torque, k v is the gain of the first dynamic torque distribution module, k p is the gain of the second dynamic torque distribution module, v m 、v s Feedback speed of main and auxiliary motors, p m 、p s Feedback position of main and auxiliary motors; The first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the main motor in the form of negative feedback, and the first dynamic distributed torque and the second dynamic distributed torque are fed back to the torque loop of the auxiliary motor in the form of positive feedback.
9. A heavy-duty industrial robot dual-motor control device, characterized in that: It comprises a processor and a memory, wherein the memory stores a computer program, and when the computer program is called and executed by the processor, the dual-motor drive control method for a heavy-duty industrial robot as described in any one of claims 1 to 5 is implemented.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is called and executed by a computer, the dual-motor drive control method for a heavy-duty industrial robot as described in any one of claims 1 to 5 is implemented.
