CN113824357A - Robot multi-motor driving system and control method thereof - Google Patents
Robot multi-motor driving system and control method thereof Download PDFInfo
- Publication number
- CN113824357A CN113824357A CN202111384544.9A CN202111384544A CN113824357A CN 113824357 A CN113824357 A CN 113824357A CN 202111384544 A CN202111384544 A CN 202111384544A CN 113824357 A CN113824357 A CN 113824357A
- Authority
- CN
- China
- Prior art keywords
- motor
- driving
- motors
- current
- robot
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
- H02P5/46—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another
- H02P5/50—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another by comparing electrical values representing the speeds
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/0004—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control
- H02P23/0027—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control using different modes of control depending on a parameter, e.g. the speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/28—Controlling the motor by varying the switching frequency of switches connected to a DC supply and the motor phases
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/04—Arrangements for controlling or regulating the speed or torque of more than one motor
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/28—Arrangements for controlling current
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/04—Arrangements for controlling or regulating the speed or torque of more than one motor
- H02P2006/045—Control of current
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Multiple Motors (AREA)
Abstract
The invention discloses a robot multi-motor driving system and a control method thereof, wherein the system comprises a synchronous belt transmission device, a speed reducing device, a multi-motor driver and a plurality of permanent magnet brushless motors; the permanent magnet brushless motors, the synchronous belt transmission devices and the speed reducing devices are all integrated in the robot limb structure, and the permanent magnet brushless motors and the speed reducing devices are respectively fixed at different positions of the robot limb structure and are connected through the synchronous belt transmission devices; the output of the speed reducer is used for driving the robot joint; the multi-motor driver is electrically connected with the plurality of motors and is used for controlling each motor. The multi-motor driver includes a detection module, a power driving module, and a controller module. The driving system can be arranged in a robot limb structure, the structural space of the robot is fully utilized, the driving reliability is high, the installation is convenient, and the performance of the driving joint of the robot can be improved on the basis of ensuring the compactness and the attractiveness of the system.
Description
Technical Field
The invention belongs to the field of motor control, and particularly relates to a robot multi-motor driving system and a control method thereof.
Background
The motor driving system is used as an executing component of the electric driving robot and plays an important role in performance expression of the robot body. For example, a large humanoid biped robot has high requirements on the torque of a motor driving system, particularly a knee joint. In order to improve the torque output capability of the driving system, a speed reducer with a high reduction ratio is generally adopted, but the high reduction ratio speed reducer causes the output rotating speed of the driving system to be low, the dynamic response to be slow, and the dynamic performance of the robot is influenced.
In order to improve the dynamic performance of the robot, researchers currently use a high-power large-torque motor to cooperate with a speed reducer with a low reduction ratio to realize the dynamic performance, such as a Cassie biped robot. The scheme can improve the dynamic performance of the robot, but can lead to larger motor size; considering that the biped robot is generally connected through the connecting rod, the inner space is limited, and the scheme can affect the installation and appearance of the structure; in addition, the high-power and high-torque motor generally has high current, and higher requirements on the performance of a driver and the heat dissipation of a system are also provided.
In order to improve the torque of the robot joint, the torque can be improved by adopting multiple motors to drive a single joint in a redundant mode. In the aspect of multi-motor driving, Chinese patent No. CN204858871U proposes a multi-shaft to single-shaft output converter of a small micro direct current motor, wherein 3 small motors are meshed with an output shaft through transmission gears; the method realizes multiplication of mechanical capacity, has the defects of being suitable for driving a micro motor and having certain requirements on transmission gear arrangement. The Chinese patent No. CN103481774B applies multi-motor drive to the electric automobile, improves the reliability of a driving system, but each motor rotating shaft needs a one-way clutch for fixation, has a complex structure and larger weight, and is not suitable for the application of a robot.
Disclosure of Invention
Aiming at the defects of the prior art, the invention provides a multi-motor driving system of a robot and a control method thereof, and the specific technical scheme is as follows:
a robot multi-motor driving system comprises a synchronous belt transmission device, a speed reducing device, a multi-motor driver and a plurality of permanent magnet brushless motors;
the permanent magnet brushless motors, the synchronous belt transmission devices and the speed reducing devices are all integrated in the robot limb structure, and the permanent magnet brushless motors and the speed reducing devices are respectively fixed at different positions of the robot limb structure and are connected through the synchronous belt transmission devices; the output of the speed reducing device is used for driving a robot joint; the multi-motor driver is electrically connected with the motors and used for controlling the motors;
the multi-motor driver comprises a detection module, a power driving module and a controller module;
the detection module comprises a current detection module, a bus voltage detection module and a plurality of position detection modules, and is respectively used for detecting the three-phase current of the motor, the bus voltage, the rotor position of each motor and the output position of the driving system and sending the three-phase current, the bus voltage, the rotor position of each motor and the output position of the driving system to the controller module;
the controller module receives a control signal sent by the central robot controller and a signal collected by the detection module, processes the control signal and the signal and outputs a PWM signal to the power driving module to control the motors to rotate;
the power driving module is used for receiving the PWM signals output by the controller module and converting the PWM signals into a plurality of power signals to drive the motors to work cooperatively.
Further, the transmission device is in synchronous belt transmission; the speed reducer is a planetary speed reducer, a cycloid speed reducer or a harmonic speed reducer.
Furthermore, the power driving module comprises a power switch tube driving circuit and a three-phase full-bridge circuit consisting of MOS or IGBT power switch tubes.
A control method of a multi-motor drive system of a robot includes the following steps:
s1: the controller module receives a control mode and an instruction sent by a central controller of the robot to obtain an operation mode of a driving system, wherein the operation mode is a torque mode, a rotating speed mode or a position mode;
s2: according to the operation mode of the driving system, the controller module performs multi-motor cooperative control to obtain the operation mode and corresponding instructions of each motor, and the method specifically comprises the following steps:
when the driving system is in a torque mode, each motor runs in a torque control mode;
when the driving system is in a rotating speed mode, one of all the motors is selected as a main motor, the other motors are selected as slave motors, the main motor runs in a rotating speed control mode, and the slave motors run in a torque control mode;
when the driving system is in a position mode, one of all the motors is selected as a main motor optionally, and the other motors are slave motors, the main motor runs in a position control mode, and the slave motors run in a torque control mode;
s3: and the controller module executes a corresponding motor control algorithm according to the control mode of each motor to control each motor to rotate.
Further, when the driving system is in a torque mode, the specific operation steps are as follows:
(1) calculating torque control commands T corresponding to the motorsiThe calculation formula is as follows:
wherein i is more than or equal to 1 and less than or equal to n, and n is the total number of the motors in the driving system; t is*Outputting a torque command for a driving system sent by a central controller; d represents the reduction ratio of the drive system, D = D1*D2Wherein D is1For synchronous belt reduction ratio, D2Is the reduction ratio of the reduction gear;
(2) calculating current command I of each motori= f(T i ) (ii) a Wherein the functionf(T) Obtaining the current torque curve according to a motor manual or an off-line test;
(3) the controller module measures current of each current motor phase according to the detection module, and feedback current is obtained after coordinate transformation processing;
(4) the controller module executes a current closed-loop control algorithm according to the current instruction and the feedback current value of each motor, and generates a driving signal after coordinate transformation and an SVPWM algorithm;
(5) the controller module sends the driving signal to the driving module, and the driving module controls the motors to rotate.
Further, when the driving system is in the rotating speed mode, the specific operation steps are as follows:
(1) calculating a rotation speed control command w of a main motorp=D*w*,w*Outputting a rotating speed instruction for a driving system sent by the central controller;
(2) the controller module controls the command w according to the rotating speed of the main motorpAnd executing a rotating speed closed-loop control algorithm according to the rotating speed of the main motor calculated according to the position detected by the position detection module to obtain the torque T of the main motorPAnd further obtains a slave motor torque control command Ti=TP;
(3) Calculating current command I of each motori= f(T i ) (ii) a Wherein the functionf(T) Obtaining the current torque curve according to a motor manual or an off-line test;
(4) the controller module measures current of each current motor phase according to the detection module, and feedback current is obtained after coordinate transformation processing;
(5) the controller module executes a current closed-loop control algorithm according to the current instruction and the feedback current value of each motor, and generates a driving signal after coordinate transformation and an SVPWM algorithm;
(6) the controller module sends the driving signal to the driving module, and the driving module controls the motors to rotate.
Further, when the driving system is in the position mode, the specific operation steps are as follows:
(1) calculating a main motor position control command thetap=θ*,θ*Outputting a position instruction for a driving system sent by a central controller;
(2) the controller module controls the command theta according to the position of the main motorpAnd the position detection module measures the output position of the driving system and executes a position closed-loop control algorithm to obtain a rotating speed control instruction w of the main motorp;
(3) The controller module controls the command w according to the rotating speed of the main motorpAnd executing a rotating speed closed-loop control algorithm according to the rotating speed of the main motor calculated according to the position detected by the position detection module to obtain the torque T of the main motorPAnd further obtains a slave motor torque control command Ti=TP;
(4) Calculating current command I of each motori= f(T i ) (ii) a Wherein the functionf(T) Obtaining the current torque curve according to a motor manual or an off-line test;
(5) the controller module measures current of each current motor phase according to the detection module, and feedback current is obtained after coordinate transformation processing;
(6) the controller module executes a current closed-loop control algorithm according to the current instruction and the feedback current value of each motor, and generates a driving signal after coordinate transformation and an SVPWM algorithm;
(7) the controller module sends the driving signal to the driving module, and the driving module controls the motors to rotate.
Further, the current closed-loop control algorithm adopts PI control, the rotating speed closed-loop control algorithm adopts PI control, and the position closed-loop control algorithm adopts P control.
The invention has the following beneficial effects:
the robot multi-motor driving system provided by the invention adopts a plurality of permanent magnet brushless motors to replace large-power giant motors, is convenient to be intensively arranged in a robot limb structure together with the synchronous belt transmission device and the speed reducing device, fully utilizes the structural space of the robot, has high driving reliability and convenient installation, and can improve the performance of a robot driving joint on the basis of ensuring the compactness and the attractiveness of the system. Meanwhile, the transmission mode of the synchronous belt is utilized, so that the structural complexity of the system is favorably reduced, and the installation is convenient; in addition, the multi-motor control method provided by the invention can synchronously carry out cooperative control on a plurality of motors, and prevent the internal force generated during multi-motor transmission.
Drawings
FIG. 1 is a block diagram of the components of a multi-motor drive system of a robot in the present invention;
FIG. 2 is a schematic structural diagram of a multi-motor drive system of a biped robotic knee joint according to one embodiment of the present invention;
FIG. 3 is a diagram of the steps of a multi-motor control method of the robot in the present invention;
fig. 4 is a detailed flowchart of a robot multi-motor control method in the present invention.
In fig. 2, 1 is a thigh of the biped robot, 2 is a permanent magnet brushless motor, 3 is a synchronous belt transmission device, 4 is a speed reduction device, and 5 is a knee joint of the biped robot.
Detailed Description
The present invention will be described in detail below with reference to the accompanying drawings and preferred embodiments, and the objects and effects of the present invention will become more apparent, it being understood that the specific embodiments described herein are merely illustrative of the present invention and are not intended to limit the present invention.
Fig. 1 is a block diagram of a multi-motor drive system of a robot according to the present invention, and as shown in fig. 1, the multi-motor drive system of a robot according to the present invention includes a synchronous belt transmission device 3, a reduction gear device 4, a multi-motor driver, and a plurality of permanent magnet brushless motors 2.
The permanent magnet brushless motors, the synchronous belt transmission devices and the speed reducing devices are all integrated in the robot limb structure, and the permanent magnet brushless motors and the speed reducing devices are respectively fixed at different positions of the robot limb structure and are connected through the synchronous belt transmission devices; the output of the speed reducer is used for driving the robot joint; the multi-motor driver is electrically connected with the plurality of motors and is used for controlling each motor.
Fig. 2 is a schematic view of the multi-motor drive system of the present invention applied to a knee joint of a biped robot. In the embodiment, 3 permanent magnet brushless motors 2 with the same model are adopted, are arranged inside thighs 1 of the biped robot and are transmitted to a speed reduction device 4 through the same synchronous belt, and the output of the speed reduction device 4 is used for driving a knee joint 5 of the biped robot; the speed reducer comprises a speed reducer, a bearing and a flange related structural member, wherein the speed reducer adopts a harmonic speed reducer in the embodiment. And a planetary speed reducer or a cycloid speed reducer can be adopted according to actual requirements.
As shown in fig. 1, the multi-motor driver includes a detection module, a power driving module, and a controller module provided therein; the detection module comprises a current detection module, a bus voltage detection module and a plurality of position detection modules, and is respectively used for detecting the three-phase current of the motor, the bus voltage, the position of the rotor of each motor and the position of the output end of the driving system and sending the position to the controller module;
the controller module receives a control signal sent by the central robot controller and a signal collected by the detection module, processes the control signal and the signal and outputs a PWM signal to the power driving module to control the motors to rotate; preferentially, the controller module can adopt an MCU with more pins and good processing performance; an STM32 controller is used in this example.
The power driving module is used for receiving the PWM signals output by the controller module and converting the PWM signals into a plurality of power signals to drive the motors to work cooperatively. The power driving module comprises a power switch tube driving circuit and a three-phase full-bridge circuit consisting of MOS or IGBT power switch tubes. In order to enable the driving effects of the motors to be the same, the devices adopted by the power driving modules for driving the motors are the same.
As shown in fig. 3, the method for controlling a multi-motor drive system of a robot according to the present invention comprises the steps of:
s1: the controller module receives a control mode and an instruction sent by a central controller of the robot to obtain an operation mode of a driving system, wherein the operation mode is a torque mode, a rotating speed mode or a position mode;
s2: according to the operation mode of the driving system, the controller module performs multi-motor cooperative control to obtain the operation mode and corresponding instructions of each motor, and the method specifically comprises the following steps:
when the driving system is in a torque mode, each motor runs in a torque control mode;
when the driving system is in a rotating speed mode, one of all the motors is selected as a main motor, the other motors are selected as slave motors, the main motor runs in a rotating speed control mode, and the slave motors run in a torque control mode;
when the driving system is in a position mode, one of all the motors is selected as a main motor optionally, and the other motors are slave motors, the main motor runs in a position control mode, and the slave motors run in a torque control mode;
s3: and the controller module executes a corresponding motor control algorithm according to the control mode of each motor to control each motor to rotate.
As shown in fig. 4, when the driving system is in the torque mode, the specific operation steps are as follows:
(1) calculating torque control commands T corresponding to the motorsiThe calculation formula is as follows:
wherein i is more than or equal to 1 and less than or equal to n, and n is the total number of the motors in the driving system; t is*Outputting a torque command for a driving system sent by a central controller; d represents the reduction ratio of the drive system, D = D1*D2Wherein D is1For synchronous belt reduction ratio, D2Is the reduction ratio of the reduction gear;
(2) calculating current command I of each motori= f(T i ) (ii) a Wherein the functionf(T) Obtaining the current torque curve according to a motor manual or an off-line test;
(3) the controller module measures current of each current motor phase according to the detection module, and feedback current is obtained after coordinate transformation processing;
(4) the controller module executes a current closed-loop control algorithm, preferably adopts PI control, and generates a driving signal after coordinate transformation and SVPWM algorithm according to the current instruction and feedback current value of each motor;
(5) the controller module sends the driving signal to the driving module, and the driving module controls the motors to rotate.
When the driving system is in a rotating speed mode, the specific operation steps are as follows:
(1) calculating a rotation speed control command w of a main motorp=D*w*,w*Outputting a rotating speed instruction for a driving system sent by the central controller;
(2) the controller module controls the command w according to the rotating speed of the main motorpAnd executing a rotating speed closed-loop control algorithm according to the rotating speed of the main motor calculated according to the position detected by the position detection module, preferably adopting PI control to obtain the torque T of the main motorPAnd further obtains a slave motor torque control command Ti=TP;
And then controlling the rotation of the master motor and the slave motor according to the steps of the torque operation mode. That is, the subsequent steps are the same as the steps (2) to (5) in the torque mode.
When the driving system is in the position running mode, the specific operation steps are as follows:
(1) calculating a main motor position control command thetap=θ*,θ*Outputting a position instruction for a driving system sent by a central controller;
(2) the controller module controls the command theta according to the position of the main motorpAnd the position detection module measures the output position of the driving system, executes a position closed-loop control algorithm, preferably adopts P control, and obtains a rotating speed control instruction w of the main motorp;
And then executing according to a rotating speed operation mode, and controlling the rotation of the master motor and the slave motor.
It will be understood by those skilled in the art that the foregoing is only a preferred embodiment of the present invention, and is not intended to limit the invention, and although the invention has been described in detail with reference to the foregoing examples, it will be apparent to those skilled in the art that various changes in the form and details of the embodiments may be made and equivalents may be substituted for elements thereof. All modifications, equivalents and the like which come within the spirit and principle of the invention are intended to be included within the scope of the invention.
Claims (8)
1. A robot multi-motor driving system is characterized by comprising a synchronous belt transmission device, a speed reducing device, a multi-motor driver and a plurality of permanent magnet brushless motors;
the permanent magnet brushless motors, the synchronous belt transmission devices and the speed reducing devices are all integrated in the robot limb structure, and the permanent magnet brushless motors and the speed reducing devices are respectively fixed at different positions of the robot limb structure and are connected through the synchronous belt transmission devices; the output of the speed reducing device is used for driving a robot joint; the multi-motor driver is electrically connected with the motors and used for controlling the motors;
the multi-motor driver comprises a detection module, a power driving module and a controller module;
the detection module comprises a current detection module, a bus voltage detection module and a plurality of position detection modules, and is respectively used for detecting the three-phase current of the motor, the bus voltage, the rotor position of each motor and the output position of the driving system and sending the three-phase current, the bus voltage, the rotor position of each motor and the output position of the driving system to the controller module;
the controller module receives a control signal sent by the central robot controller and a signal collected by the detection module, processes the control signal and the signal and outputs a PWM signal to the power driving module to control the motors to rotate;
the power driving module is used for receiving the PWM signals output by the controller module and converting the PWM signals into a plurality of power signals to drive the motors to work cooperatively.
2. The multi-motor robot drive system according to claim 1, wherein the transmission means is a synchronous belt transmission; the speed reducer is a planetary speed reducer, a cycloid speed reducer or a harmonic speed reducer.
3. The multi-motor robot drive system of claim 1, wherein the power drive module comprises a power switch tube drive circuit and a three-phase full bridge circuit composed of MOS or IGBT power switch tubes.
4. A control method of a robot multi-motor drive system according to claim 1, characterized by comprising the steps of:
s1: the controller module receives a control mode and an instruction sent by a central controller of the robot to obtain an operation mode of a driving system, wherein the operation mode is a torque mode, a rotating speed mode or a position mode;
s2: according to the operation mode of the driving system, the controller module performs multi-motor cooperative control to obtain the operation mode and corresponding instructions of each motor, and the method specifically comprises the following steps:
when the driving system is in a torque mode, each motor runs in a torque control mode;
when the driving system is in a rotating speed mode, one of all the motors is selected as a main motor, the other motors are selected as slave motors, the main motor runs in a rotating speed control mode, and the slave motors run in a torque control mode;
when the driving system is in a position mode, one of all the motors is selected as a main motor optionally, the other motors are auxiliary motors, the main motor runs in a position control mode, and the auxiliary motors run in a torque control mode;
s3: and the controller module executes a corresponding motor control algorithm according to the control mode of each motor to control each motor to rotate.
5. The control method of the multi-motor drive system of the robot as claimed in claim 4, wherein when the drive system is in the torque mode, the specific operation steps are as follows:
(1) calculating torque control commands T corresponding to the motorsiThe calculation formula is as follows:
wherein i is more than or equal to 1 and less than or equal to n, and n is the total number of the motors in the driving system; t is*Outputting a torque command for a driving system sent by a central controller; d represents the reduction ratio of the drive system, D = D1*D2Wherein D is1For synchronous belt reduction ratio, D2Is the reduction ratio of the reduction gear;
(2) calculating current command I of each motori= f(T i ) (ii) a Wherein the functionf(T) Obtaining the current torque curve according to a motor manual or an off-line test;
(3) the controller module measures current of each current motor phase according to the detection module, and feedback current is obtained after coordinate transformation processing;
(4) the controller module executes a current closed-loop control algorithm according to the current instruction and the feedback current value of each motor, and generates a driving signal after coordinate transformation and an SVPWM algorithm;
(5) the controller module sends the driving signal to the driving module, and the driving module controls the motors to rotate.
6. The control method of the multi-motor drive system of the robot as claimed in claim 5, wherein when the drive system is in a rotation speed mode, the specific operation steps are as follows:
(1) calculating a rotation speed control command w of a main motorp=D*w*,w*Outputting a rotating speed instruction for a driving system sent by the central controller;
(2) the controller module controls the command w according to the rotating speed of the main motorpAnd executing a rotating speed closed-loop control algorithm according to the rotating speed of the main motor calculated according to the position detected by the position detection module to obtain the torque T of the main motorPAnd further obtains a slave motor torque control command Ti=TP;
(3) Calculating current command I of each motori= f(T i ) (ii) a Wherein the functionf(T) According to the current torque curve in the motor manualA line or an off-line test is carried out;
(4) the controller module measures current of each current motor phase according to the detection module, and feedback current is obtained after coordinate transformation processing;
(5) the controller module executes a current closed-loop control algorithm according to the current instruction and the feedback current value of each motor, and generates a driving signal after coordinate transformation and an SVPWM algorithm;
(6) the controller module sends the driving signal to the driving module, and the driving module controls the motors to rotate.
7. The method for controlling a multi-motor drive system of a robot according to claim 6, wherein when the drive system is in a position mode, the specific operation steps are as follows:
(1) calculating a main motor position control command thetap=θ*,θ*Outputting a position instruction for a driving system sent by a central controller;
(2) the controller module controls the command theta according to the position of the main motorpAnd the position detection module measures the output position of the driving system and executes a position closed-loop control algorithm to obtain a rotating speed control instruction w of the main motorp;
(3) The controller module controls the command w according to the rotating speed of the main motorpAnd executing a rotating speed closed-loop control algorithm according to the rotating speed of the main motor calculated according to the position detected by the position detection module to obtain the torque T of the main motorPAnd further obtains a slave motor torque control command Ti=TP;
(4) Calculating current command I of each motori= f(T i ) (ii) a Wherein the functionf(T) Obtaining the current torque curve according to a motor manual or an off-line test;
(5) the controller module measures current of each current motor phase according to the detection module, and feedback current is obtained after coordinate transformation processing;
(6) the controller module executes a current closed-loop control algorithm according to the current instruction and the feedback current value of each motor, and generates a driving signal after coordinate transformation and an SVPWM algorithm;
(7) the controller module sends the driving signal to the driving module, and the driving module controls the motors to rotate.
8. The method of claim 7, wherein the current closed-loop control algorithm employs PI control, the rotational speed closed-loop control algorithm employs PI control, and the position closed-loop control algorithm employs P control.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111384544.9A CN113824357A (en) | 2021-11-22 | 2021-11-22 | Robot multi-motor driving system and control method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111384544.9A CN113824357A (en) | 2021-11-22 | 2021-11-22 | Robot multi-motor driving system and control method thereof |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113824357A true CN113824357A (en) | 2021-12-21 |
Family
ID=78918021
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111384544.9A Pending CN113824357A (en) | 2021-11-22 | 2021-11-22 | Robot multi-motor driving system and control method thereof |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113824357A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117375460A (en) * | 2023-12-07 | 2024-01-09 | 苏州朗信智能科技有限公司 | Crane cart motor synchronous control method and system |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102207738A (en) * | 2010-03-31 | 2011-10-05 | 东芝机械株式会社 | Servo control method and servo control apparatus |
CN103501136A (en) * | 2013-10-22 | 2014-01-08 | 中国船舶重工集团公司第七一二研究所 | Multi-motor synchronous coordination control method |
WO2015033861A1 (en) * | 2013-09-03 | 2015-03-12 | Ntn株式会社 | Control device for electric vehicle |
CN110465931A (en) * | 2018-05-10 | 2019-11-19 | 发那科株式会社 | Driving device and robot |
CN113179052A (en) * | 2021-05-17 | 2021-07-27 | 中国第一汽车股份有限公司 | Multi-unit motor control method, device, medium, and electronic apparatus |
-
2021
- 2021-11-22 CN CN202111384544.9A patent/CN113824357A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102207738A (en) * | 2010-03-31 | 2011-10-05 | 东芝机械株式会社 | Servo control method and servo control apparatus |
WO2015033861A1 (en) * | 2013-09-03 | 2015-03-12 | Ntn株式会社 | Control device for electric vehicle |
CN103501136A (en) * | 2013-10-22 | 2014-01-08 | 中国船舶重工集团公司第七一二研究所 | Multi-motor synchronous coordination control method |
CN110465931A (en) * | 2018-05-10 | 2019-11-19 | 发那科株式会社 | Driving device and robot |
CN113179052A (en) * | 2021-05-17 | 2021-07-27 | 中国第一汽车股份有限公司 | Multi-unit motor control method, device, medium, and electronic apparatus |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117375460A (en) * | 2023-12-07 | 2024-01-09 | 苏州朗信智能科技有限公司 | Crane cart motor synchronous control method and system |
CN117375460B (en) * | 2023-12-07 | 2024-03-01 | 苏州朗信智能科技有限公司 | Crane cart motor synchronous control method and system |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105392660B (en) | DC-to-AC converter and electric vehicle | |
EP1186464B1 (en) | A control device for motor/generators | |
KR101000410B1 (en) | Active vibration control system for hybried electric vehicle | |
JP5644854B2 (en) | Motor control device and control method | |
CN111354999A (en) | Vehicle and power battery heating device and method thereof | |
CN107363825A (en) | Under-actuated 2R mechanical arm device based on harmonic deceleration | |
US8052571B2 (en) | Control device and control method for hybrid vehicle | |
CN108667368B (en) | Vehicle and control method thereof | |
CN104850036A (en) | Control system and method for dual-redundancy electric steering engine | |
CN113824357A (en) | Robot multi-motor driving system and control method thereof | |
US20160009268A1 (en) | Hybrid powertrain and method for controlling the same | |
CN105610351B (en) | A kind of double-motor driving device | |
CN113442737B (en) | Double-motor control system and control method of double-motor combined driving system | |
US20160059711A1 (en) | Multi-link power-split electric power system for an electric-hybrid powertrain system | |
CN102684578A (en) | Direct control system for torque of electric motor | |
CN111913404B (en) | Control semi-physical simulation device and method for starting generator of multi-electric aircraft engine | |
CN106787979B (en) | Generator rotor angle self-stabilization rear feed compensating control method in high-speed brushless DC electromotor | |
CN111277191B (en) | Dynamic response active control method and device for brushless dual-electromechanical port motor | |
CN210269182U (en) | Testing device for vehicle brake pedal | |
CN111828234B (en) | Wave energy power generation equipment control method and device and wave energy power generation system | |
CN104779856A (en) | Doubly-fed shaft generator system | |
CN113852316A (en) | Generator starting control method and device based on model predictive control | |
CN209704753U (en) | A kind of multi-motors drive system of blower large torque blade | |
Hemdani et al. | Design of a switching table for direct power control of a DFIG using sliding mode theory | |
CN111355407A (en) | Load self-adaptive soft start control system and method for vehicle-mounted brushless direct current motor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20211221 |