[go: up one dir, main page]

WO2002013368A1 - Dispositif de commande de moteur electrique - Google Patents

Dispositif de commande de moteur electrique Download PDF

Info

Publication number
WO2002013368A1
WO2002013368A1 PCT/JP2001/006682 JP0106682W WO0213368A1 WO 2002013368 A1 WO2002013368 A1 WO 2002013368A1 JP 0106682 W JP0106682 W JP 0106682W WO 0213368 A1 WO0213368 A1 WO 0213368A1
Authority
WO
WIPO (PCT)
Prior art keywords
signal
simulation
torque
simulated
provides
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.)
Ceased
Application number
PCT/JP2001/006682
Other languages
English (en)
French (fr)
Inventor
Souki Kaku
Hideki Honda
Ryuichi Oguro
Hidekazu Miyagawa
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
Yaskawa Electric Manufacturing Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Yaskawa Electric Corp, Yaskawa Electric Manufacturing Co Ltd filed Critical Yaskawa Electric Corp
Priority to US10/343,955 priority Critical patent/US6873132B2/en
Priority to KR1020037001756A priority patent/KR100740623B1/ko
Priority to EP01954423A priority patent/EP1313207A1/en
Publication of WO2002013368A1 publication Critical patent/WO2002013368A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

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
    • H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
    • H02P23/14—Estimation or adaptation of motor parameters, e.g. rotor time constant, flux, speed, current or voltage
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control

Definitions

  • the present invention relates to a control device for a motor (a DC motor, an induction motor, a synchronous motor, a linear motor, etc.) for driving a load machine such as a table or a robot arm of a machine tool.
  • a motor a DC motor, an induction motor, a synchronous motor, a linear motor, etc.
  • a feedback control system that provides a second simulated torque signal and a torque command to a mechanical system composed of a transmission mechanism that performs the first simulation and a feedforward control system that provides a first simulated torque signal.
  • Degree control devices are often used.
  • FIG. 1 is a block diagram showing an example of a conventional two-degree-of-freedom control device.
  • a conventional position control device includes an electric motor 3 that drives a load machine 1 via a torque transmission mechanism 2, and at least two integration operations when a rotation angle command signal of the electric motor is input.
  • a feedforward signal operation circuit 21 that outputs a simulated rotation angle signal, a simulated speed signal, and a first simulated torque signal, respectively, by a predetermined function operation including: a rotation speed and a rotation angle of the electric motor;
  • a rotation detector 20 a position control circuit 22 that outputs a first speed signal based on the simulated rotation angle signal and an actual rotation angle signal output from the rotation detector;
  • a speed control circuit 23 that outputs a second simulated torque signal based on the first speed signal and the actual speed signal output from the rotation detector; and the first simulated torque signal and the second simulated torque signal.
  • claim 1 of the present invention includes the following means.
  • Command generator that provides the actual command signal.
  • An actual observer that observes a state quantity between the mechanical system and the power conversion circuit and provides an actual response signal at a first control sample time.
  • a higher-level control unit that provides a first simulated position signal, a first simulated speed signal, and a first simulated torque signal at a second control sample time longer than a first control sample time based on the actual command signal.
  • a lower control unit that provides a second simulation torque signal at a first control sample time based on the first simulation position signal, the first simulation speed signal, and the actual response signal;
  • a torque compensation unit that provides a third simulated torque signal at a second control sample time based on the first simulated position signal, the first simulated speed signal, and the actual response signal.
  • a torque synthesis unit that provides a torque command at a first control sample time based on the first simulation torque signal, the second simulation torque signal, and the third simulation torque signal.
  • Claim 2 of the present invention is provided with the following means.
  • Real Command generator that provides command signals.
  • An actual observer that observes a state quantity between the mechanical system and the power conversion circuit and provides an actual response signal at a first control sample time.
  • a higher-level control unit that provides a first simulated position signal, a first simulated speed signal, and a first simulated torque signal at a second control sample time longer than a first control sample time based on the actual command signal.
  • a lower control unit that provides a second simulation torque signal at a first control sample time based on the first simulation position signal, the first simulation speed signal, and the actual response signal;
  • a torque compensating unit that provides a third simulated torque signal at a second control sample time based on the second simulated torque signal
  • a torque synthesis unit that provides a torque command at a first control sample time based on the first simulation torque signal, the second simulation torque signal, and the third simulation torque signal.
  • Claim 3 of the present invention includes means described below. Command generator that provides the actual command signal.
  • An actual observer that observes a state quantity between the mechanical system and the power conversion circuit and provides an actual response signal at a first control sample time.
  • a higher-level control unit that provides a first simulated position signal, a first simulated speed signal, and a first simulated torque signal at a second control sample time longer than a first control sample time based on the actual command signal.
  • a simulation observer for providing an estimated position signal and an estimated speed signal at a first control sample time based on a torque command and the actual response signal.
  • a lower control unit that provides a second simulated torque signal at a first control sample time based on the first simulated position signal, the first simulated speed signal, the estimated position signal, and the estimated speed signal.
  • a torque compensating unit that provides a third simulated torque signal at a second control sample time based on the second simulated torque signal
  • a torque synthesis unit that provides a torque command at a first control sample time based on the first simulation torque signal, the second simulation torque signal, and the third simulation torque signal.
  • Claim 4 of the present invention is provided with the following means.
  • An upper-level controller that provides a first simulated torque signal based on the actual command signal, the first simulated position signal, and the first simulated speed signal.
  • a simulation lower-order control unit that provides a fourth simulation signal based on the first simulation position signal 0F and the first simulation speed signal wF.
  • An adder that provides a first simulation signal based on the first simulation torque signal and the fourth simulation signal.
  • a simulation model for providing a second simulation signal and a third simulation signal based on the first simulation signal is provided.
  • a simulation signal processor for providing a first simulation position signal and a first simulation speed signal at a second control sample time based on the second simulation signal and the third simulation signal.
  • Claim 5 of the present invention is provided with the following means.
  • An integrator for providing a third simulation signal based on the 28th simulation signal An integrator for providing a third simulation signal based on the 28th simulation signal.
  • An integrator for providing a second simulation signal based on the third simulation signal.
  • a subtractor that provides a 32nd simulation signal based on the first simulation signal and the second simulation signal.
  • a coefficient unit that provides a 29th simulation signal based on the 32nd simulation signal.
  • a coefficient unit that provides a 30th simulation signal based on the 29th simulation signal and the third simulation signal, and provides a 31st simulation signal based on the 30th simulation signal.
  • Claim 6 of the present invention includes the following means.
  • a coefficient unit that provides a fifth simulation signal based on the second simulation signal.
  • An addition unit that provides a sixth simulation signal based on the fifth simulation signal and the third simulation signal.
  • a coefficient unit that provides a fourth simulation signal based on the sixth simulation signal.
  • a seventh simulation signal is provided based on the actual command signal and the first simulation position signal.
  • a coefficient unit that provides an eighth simulation signal based on the seventh simulation signal.
  • a coefficient unit that provides a ninth simulation signal based on the first simulation speed signal and the eighth simulation signal, and provides a first simulation torque signal based on the ninth simulation signal.
  • Claim 8 of the present invention is provided with the following means.
  • a coefficient unit that provides a 20th simulation signal based on the first simulation position signal and the actual response signal, and provides a 21st simulation signal based on the 20th simulation signal.
  • a differentiator for providing a second simulation signal at a first control sample time based on the actual response signal is
  • An adder / subtracter for providing a second simulation signal based on the second simulation signal and the second simulation signal.
  • a coefficient unit that provides a second simulation torque signal based on the second simulation signal.
  • the ninth aspect of the present invention includes the following means.
  • a coefficient unit that provides a 21st simulation signal based on the 20th simulation signal.
  • An adder / subtractor that provides a simulated signal.
  • a coefficient unit that provides a second simulation torque signal based on the second simulation signal.
  • the tenth aspect of the present invention includes the following means.
  • a command compensator for providing a 24th simulation signal at a first control sample time based on the first simulation position signal.
  • a command compensator for providing a 25th simulation signal at a first control sample time based on the first simulation speed signal.
  • a 20th simulation signal is provided based on the 24th simulation signal and the actual response signal.
  • a coefficient unit that provides a 21st simulation signal based on the 20th simulation signal.
  • a differentiator for providing a second simulation signal at a first control sample time based on the actual response signal is
  • An adder / subtractor that provides a 23rd simulation signal based on the 21st simulation signal, the 22nd simulation signal, and the 25th simulation signal.
  • a coefficient unit that provides a second simulation torque signal based on the second simulation signal.
  • Claim 11 of the present invention is provided with the following means.
  • a command compensator for providing a 24th simulation signal at a first control sample time based on the first simulation position signal.
  • a command compensator for providing a 25th simulation signal at a first control sample time based on the first simulation speed signal.
  • a reducer that provides a 20th simulation signal based on the 24th simulation signal and the estimated position signal.
  • a coefficient unit that provides a 21st simulation signal based on the 20th simulation signal.
  • a second simulation is performed based on the 21st simulation signal, the estimated speed signal, and the 25th simulation signal.
  • a coefficient unit that provides a second simulation torque signal based on the second simulation signal.
  • Claim 12 of the present invention is provided with the following means.
  • a command filter for providing a 26th simulation signal based on the second simulation torque signal.
  • An adder for providing a torque command based on the 26th simulation signal, the first simulation torque signal, and the third simulation torque signal.
  • Claim 13 of the present invention is provided with the following means.
  • a command filter for providing a 26th simulation signal based on the second simulation torque signal.
  • a command compensator for providing a 27th simulation signal at a first control sample time based on the first simulation torque signal.
  • An adder that provides a torque command based on the 26th simulation signal, the third simulation torque signal, and the 27th simulation signal.
  • claim 14 of the present invention includes the following means.
  • a subtractor that provides a 10th simulation signal based on the actual response signal and the first simulation position signal.
  • a coefficient device that provides a 12th simulation signal based on the 10th simulation signal.
  • a differentiator for providing a first simulation signal at a second control sample time based on the actual response signal is a differentiator for providing a first simulation signal at a second control sample time based on the actual response signal.
  • An adder / subtracter that provides a 13th simulation signal based on the 12th simulation signal, the 11th simulation signal, and the first simulation speed signal.
  • a discretized integrator for providing a third simulated torque signal at a second control sample time based on the first to fourth simulated signals.
  • the fifteenth aspect of the present invention includes the following means. 1. A discretized integrator that provides a third simulated torque signal at a second control sample time based on the second simulated torque signal.
  • the upper control unit, the first torque compensating unit, the lower control unit, and the torque combining unit are configured by a plurality of processors.
  • the seventeenth aspect of the present invention includes the following means.
  • the upper control unit, the second torque compensation unit, the lower control unit, and the torque combining unit are configured by a plurality of processors.
  • Claim 18 of the present invention is provided with the following means.
  • Means wherein the higher-level control unit, the second torque compensating unit, the simulation observer, the lower-level control unit, and the torque combining unit are configured by a plurality of processors.
  • the higher-level control unit of the conventional motor control device has a control sample time different from that of the lower-level control. Vibration and overshoot that appear in control performance when constructed can be prevented.
  • the higher-level control unit realizes a control sample time different from that of the lower-level control, a more complex control process can be performed by a processor with the same processing function in the higher-level control unit, while the control sample time is shorter. Since the control processing of the lower control unit can be performed, more robust feedback characteristics can be obtained.
  • the control process of the lower control unit can be more simply realized, and the control process of the lower control unit can be performed in a shorter control sample time. Therefore, it is possible to easily realize the configuration of the higher-level control unit in consideration of the characteristics described above.
  • the introduction of the first torque compensator which processes with a control sample time different from that of the lower control unit, allows the lower control unit and the first torque compensator to be designed independently, so that the high frequency region and the low frequency region Therefore, it is possible to more easily design a control system according to the different characteristics of the mechanical system, and to achieve good control performance.
  • the second torque compensating unit uses only the second simulated torque, the amount of data communication between the second torque compensating unit and the lower control unit can be reduced. Therefore, the motor control device can be realized with a shorter control sample time using processors having the same processing function. Therefore, it is possible to prevent vibration and overshoot that appear when the higher-level control unit is constructed with a control sample time different from that of the lower-level control in the conventional motor control device, and it is possible to achieve good control performance.
  • the control of the upper control unit, the lower control unit, and the second control unit can be performed. Since the gain can be set larger, good control performance can be realized.
  • the simulation model becomes simpler when the mechanical resonance frequency of the mechanical system is high.
  • the higher-level control unit is constructed with a control sample time different from that of the lower-level control in the motive control device, it is possible to prevent vibration and overshoot appearing in the control control performance and reduce the amount of calculation required for the motor control device. .
  • the simulated lower-level control unit can be more easily realized by constructing the simulated lower-level control unit with a PP control system. Therefore, it is possible to prevent the vibration and overshoot appearing when the higher-level control unit is constructed with a control sample time different from that of the lower-level control unit in the conventional motor control device, and to reduce the amount of calculation required for the motor control device. . Also, the parameters of the simulation lower-level control unit can be set more easily.
  • the host controller can be more easily realized by constructing the host controller with a PP control system. Therefore, it is possible to prevent the vibration and overshoot that appear when the higher-level control unit is constructed with a control sample time different from that of the lower-level control in the conventional motor control device, and to reduce the amount of calculation required for the motor control device. . Also, the parameters of the host controller can be set more easily.
  • the upper controller can be realized more easily. Therefore, it is possible to prevent the vibration and overshoot that appear when the upper control unit is constructed with a control sample time different from that of the lower control in the conventional motor control device, and to reduce the amount of calculation required for the motor control device. . Also, the parameters of the lower control unit can be set more easily. Further, when the upper control unit is constructed in consideration of the lower control unit, the configuration of the upper control unit can be made simpler.
  • the first simulated position signal and the first simulated speed signal updated at the first sample control time are considered in consideration of the difference between the first sample control time and the second sample control time.
  • the 24th simulation signal and the 25th simulation signal are generated in the second sample control time and input to the conventional lower-order control unit, whereby the second simulation torque signal can be smoothed. Therefore, in the conventional motor control device, the vibration and overshoot that appear when the upper control unit is constructed with a control sample time different from that of the lower control Can be prevented.
  • the vibration component included in the second simulated torque signal can be reduced, and the higher-level control unit differs from the lower-level control in the conventional motor control device. Vibrations and overshoots that appear when constructed in sample time can be prevented.
  • the 27th simulation signal is converted to the second simulation signal while considering the difference between the first sampling control time and the second sampling control time.
  • the torque command can be smoothed by generating it in two sample control times and inputting it to the conventional torque synthesis unit. Therefore, it is possible to prevent the vibration and overshoot that appear when the higher-level control unit is constructed with a control sample time different from that of the lower-level control in the conventional motor control device.
  • the conventional motor controller can be used when the upper control unit is constructed with a control sample time different from that of the lower control. Appearance of vibration and overshoot can be prevented, and the amount of calculation for the motor control device can be reduced. Also, the parameters of the first torque compensator can be set more easily.
  • the second torque compensator by constructing the second torque compensator with the I control system, vibration and overshoot that appear when the upper control unit is constructed with a control sample time different from that of the lower control in the conventional motor control device. Shooting can be prevented, and the amount of calculation required for the motor control device can be reduced. Also, the parameters of the second torque compensator can be set more easily.
  • vibration and overshoot appearing when a higher-level control unit is constructed with a control sample time different from that of a lower-level control in a conventional motor control device by comprising a plurality of processors. Can be prevented, and the control sample time of the motor control device can be greatly reduced.
  • FIG. 1 is a block diagram showing the prior art
  • FIG. 2 is a block diagram showing the first embodiment of the present invention
  • FIG. 3 is a block diagram showing a second embodiment of the present invention
  • FIG. 4 is a block diagram showing a third embodiment of the present invention
  • FIG. 5 is a block diagram showing a fourth embodiment of the present invention
  • FIG. FIG. 7 is a block diagram showing a fifth embodiment of the present invention
  • FIG. 7 is a block diagram showing a sixth embodiment of the present invention
  • FIG. 8 is a block diagram showing a seventh embodiment of the present invention
  • FIG. 10 is a block diagram showing Embodiment 9 of the present invention
  • FIG. 10 is a block diagram showing Embodiment 10 of the present invention
  • FIG. 10 is a block diagram showing Embodiment 10 of the present invention
  • FIG. 12 is a block diagram showing Embodiment 10 of the present invention.
  • FIG. 13 is a block diagram showing an embodiment 12 of the present invention.
  • FIG. 14 is a block diagram showing an embodiment 13 of the present invention.
  • FIG. 15 is a block diagram showing the present invention.
  • FIG. 16 is a block diagram showing an embodiment 15 of the present invention.
  • FIG. 16 is a block diagram showing an embodiment 15 of the present invention.
  • Example 1 of the present invention will be described in detail.
  • Embodiment 1 of the present invention will be described with reference to FIG.
  • FIG. 2 is a block diagram showing the entire first embodiment of the present invention.
  • the embodiment of the present invention includes a mechanical system 5 including a load machine 1, a transmission mechanism 2, an electric motor 3, and a power conversion circuit 4, an actual observation device 6, a command generator 7,
  • the control unit 8 includes a control unit 8, a lower control unit 9, a torque combining unit 10, and a first torque compensating unit 11.
  • the mechanical system 5, actual observation device 6, and command generator 7 are the same as those of the conventional device.
  • ⁇ ref is an actual command signal generated from the command generator 7.
  • ⁇ ⁇ is a real response signal generated from the real observer 6.
  • the upper control unit 8 provides the first simulated position signal ⁇ F, the first simulated speed signal wF, and the first simulated torque signal TFF at the second control sample time t2 based on the actual command signal 0 ref.
  • the lower control unit 9 provides the second simulated torque signal TFB at the first control sample time t1 based on the first simulated position signal ⁇ F, the first simulated speed signal wF, and the actual response signal 0 m. I do.
  • the first torque compensator 11 provides the third simulated torque signal TD at the second control sample time t2 based on the first simulated position signal ⁇ F, the first simulated speed signal wF, and the actual response signal ⁇ m. . .
  • the torque synthesis unit 10 provides a torque command Tref based on the first simulated torque signal TFF, the second simulated torque signal TFB, and the third simulated torque signal TD.
  • the first simulated position signal ⁇ F, the first simulated speed signal wF, and the first simulated torque signal TF F are expressed by the equations (1), (2), and (3) as the second control sample. Generated after discretization at time t2.
  • TFF [J s V (T 1 * s 2 + T 2 * s + 1)] * ⁇ ref (3)
  • T 1, T 2, J m is considering characteristics of the mechanical system 5 and the lower control unit It was set above.
  • a third simulated torque signal TD is generated after the equation (4) is discretized at the second control sample time t2.
  • K1 and K2 are control gains.
  • TD [(K 1 * (6 F- ⁇ m)-K 2 * (wF-wm)] / s (4)
  • a torque command is generated as follows.
  • FIG. 3 is a block diagram showing the entirety of the present embodiment.
  • the embodiment of the present invention includes a mechanical system 5 including a load machine 1., a transmission mechanism 2, an electric motor 3, and a power conversion circuit 4, an actual observation device 6, a command generator 7, Upper control section 8 and lower control
  • the control unit 9 includes a control unit 9, a torque synthesis unit 10, and a second torque compensation unit 12.
  • the second torque compensator 12 provides the third simulated torque signal TD at the second control sample time t2 based on the second simulated torque signal TFB.
  • a third simulated torque signal TD is generated after discretizing Equation (7) with the second control sample time t2.
  • FIG. 4 is a block diagram showing the entirety of the present embodiment.
  • the embodiment of the present invention includes a mechanical system 5 including a load machine 1, a transmission mechanism 2, an electric motor 3, and a power conversion circuit 4, an actual observation device 6, a command generator 7,
  • the control unit 8 includes a control unit 8, a low-order control unit 14, a torque synthesis unit 10, a simulation observer 13, and a second torque compensation unit 12.
  • the simulated observer 13 provides the estimated position signal ⁇ mh and the estimated speed signal wmh at the first control sample time t1 based on the actual response signal ⁇ ⁇ and the torque command Tref. Based on the first simulated position signal ⁇ F, the first simulated speed signal wF, the estimated position signal ⁇ mh, and the estimated speed signal wmh, the lower control unit 14 performs the second simulated torque signal at the first control sample time t1. Provide TFB.
  • the second simulated torque signal TFB is generated by Expression (8).
  • TF B K 3 * ( ⁇ F- ⁇ mh) + K4 (wF-wmh) (8)
  • the estimated position signal 0 mh and the estimated velocity signal wmh are generated as follows.
  • k1 is a sample counter corresponding to the first control sample time t1, and (k1) represents the value of the time variable at time t1 * k1.
  • ⁇ mh (k l + 1) ⁇ mh (k l) + wmh (k l) * t 1
  • wmh (k l + 1) wmh (k l) + T r e f (k l) * t 1 / J m
  • FIG. 5 is a block diagram showing Embodiment 4 of the present invention.
  • an upper control unit 8 of the embodiment of the present invention includes an upper controller 8a, a simulated lower control unit 8b, an adder 8d, a simulated model 8c, and a simulated signal processor 8e. It is composed of Host controller 8 a provides a real command signals theta re f a first simulation torque signal TFF based on the first simulation position signal theta F and the first simulation speed signal w F.
  • the simulation lower control unit 8b provides a fourth simulation signal SI4 based on the first simulation position signal ⁇ F and the first simulation speed signal wF.
  • the adder 8d provides a first simulation signal SI1 based on the first simulation torque signal TFF and the fourth simulation signal SI4.
  • the simulation model 8c provides a second simulation signal SI2 and a third simulation signal SI3 based on the first simulation signal SI1.
  • the simulation signal processor 8e converts the first simulation position signal eF and the first simulation speed signal wF at the second control sample time t2 based on the second simulation signal SI2 and the third simulation signal SI3. provide.
  • the host controller 8a generates the first simulated torque signal TFF as follows.
  • the fourth simulation signal SI4 is generated as follows.
  • the first simulation signal S I1 is generated as follows.
  • a second simulation signal S I2 and a second simulation signal S I3 are generated.
  • a first simulation position signal 0F and a first simulation speed signal wF are generated as follows.
  • k2 is a sampling force counter corresponding to the second control sample time t2, and (k2) represents the value of the time variable at time t2 * k2.
  • ⁇ F (t) SI 2 (k 2 * t 2) (1 7)
  • FIG. 6 is a block diagram showing the present embodiment.
  • a simulation model 8c of the embodiment of the present invention includes a subtractor 8c4, a coefficient unit 8c5, a subtractor 8c6, a coefficient unit 8c7, and a coefficient unit 8c1. And an integrator 8c2 and an integrator 8c3.
  • a simulation signal SI32 is generated as follows.
  • the coefficient is set to Kp, and the simulation signal SI29 is generated as follows.
  • a simulation signal SI30 is generated as follows.
  • the coefficient is set to Kv, and the simulation signal SI31 is generated as follows.
  • the coefficient unit 8c1 the coefficient is set to 1 / Jm, and the simulation signal S I 28 is generated as follows.
  • the simulation signal S I 3 is generated as follows.
  • the simulation signal S I 2 is generated as follows.
  • FIG. 7 is a block diagram showing the present embodiment.
  • the simulated lower-level control unit 8b according to the embodiment of the present invention includes a coefficient unit 8b1, an adder 8b2, and a coefficient unit 8b3.
  • the coefficient is set to Kp, and the simulation signal S I5 is generated as follows.
  • the simulation signal SI6 is generated as follows.
  • the coefficient unit 8b3 the coefficient is set to Kv, and the simulation signal SI4 is generated as follows.
  • FIG. 8 is a block diagram showing the seventh embodiment.
  • the host controller 8a of the embodiment of the present invention includes a subtractor 8a4, a coefficient unit 8a1, a subtractor 8a2, and a coefficient unit 8a3.
  • the simulation signal SI7 is generated as follows.
  • the coefficient is set to Kpf, and the simulation signal SI8 is generated as follows.
  • a simulation signal SI9 is generated as follows.
  • the coefficient is set to Kvf, and the first simulated torque signal TFF is generated as follows.
  • FIG. 9 is a block diagram showing the present embodiment.
  • the lower control unit 9 according to the embodiment of the present invention includes a subtractor 9a, a coefficient unit 9b, an adder / subtractor 9c, a coefficient unit 9d, and a difference unit 9e. I have.
  • a simulation signal SI20 is generated as follows.
  • the coefficient is set to Kp, and the simulation signal SI21 is generated as follows.
  • a simulation signal SI22 is generated as follows.
  • the adder / subtractor 9c generates a simulation signal S I23 as follows.
  • the coefficient is set to Kv, and the second simulated torque signal ⁇
  • TFB S I 23 * Kv (3 8)
  • FIG. 10 is a block diagram showing the present embodiment.
  • the lower control unit 14 according to the embodiment of the present invention includes a subtractor 9a, a coefficient unit 9b, an adder / subtractor 9c, and a coefficient unit 9d.
  • a simulation signal SI20 is generated as follows.
  • the coefficient is set to Kp, and a simulated signal S I21 is generated as in equation (35).
  • the adder / subtractor 9c generates a simulation signal S I23 as follows.
  • the coefficient is set to Kv, and as shown in equation (38), the second simulation torque Generates the lock signal TFB.
  • FIG. 11 is a block diagram showing the present embodiment.
  • a lower control unit 9 according to an embodiment of the present invention includes a subtractor 9a, a coefficient unit 9b, an adder / subtractor 9c, a coefficient unit 9d, a difference unit 9e, and a command. It comprises a compensator 9 f and a command compensator 9 g.
  • the command compensator 9 f generates a simulation signal S I 24 as follows.
  • the simulation signal S I 25 is generated as follows.
  • the subtractor 9a generates the simulation signal S I 20 as follows.
  • the coefficient is set to Kp, and the simulation signal SI
  • the adder / subtractor 9c generates a simulation signal S I23 as follows.
  • the coefficient is set to Kv, and the second simulated torque signal TFB is generated as in equation (38).
  • FIG. 12 is a block diagram showing the present embodiment.
  • the lower control unit 14 of the embodiment of the present invention includes a subtracter 9 a, a coefficient unit 9 b, an adder / subtractor 9 c, a coefficient unit 9 d, a command compensator 9 f, It consists of a command compensator 9 g.
  • a simulation signal S I 24 is generated as shown in equation (41).
  • a simulation signal S I 25 is generated as shown in equation (45).
  • a simulation signal S I20 is generated as follows.
  • the coefficient is set to Kp, and a simulated signal S I21 is generated as in equation (35).
  • the adder / subtractor 9c generates a simulation signal S I23 as follows.
  • S I 23 S I 21 + S I 25 -wmh (49)
  • the coefficient is set to Kv, and the second simulated torque signal TFB is generated as in equation (38).
  • FIG. 13 is a block diagram showing Embodiment 12 of the present invention.
  • the torque synthesizing unit 10 includes a command filter 10b and an adder 10a.
  • a simulation signal S I 26 is generated as follows.
  • the adder 10a generates a torque command Treff as follows.
  • FIG. 14 is a block diagram showing the present embodiment.
  • the torque synthesizing unit 10 according to the embodiment of the present invention includes a command filter 10b, an adder 10a, and a command compensator 10c.
  • a simulation signal SI27 is generated as follows.
  • the adder 10a generates a torque command Treff as follows.
  • FIG. 15 is a block diagram showing the present embodiment.
  • the first torque compensator 11 of the embodiment of the present invention includes a subtractor 11 a, a coefficient unit 11 b, a coefficient unit 11 c, an adder-subtractor 11 f, It consists of a differentiator 11d and a discretized integrator 11e.
  • a simulation signal SI10 is generated as follows.
  • the coefficient is set to Kp, and the simulation signal SI12 is generated as follows.
  • a simulation signal SI11 is generated as follows.
  • a simulation signal S I 13 is generated as follows.
  • the coefficient unit 11C the coefficient is set to Kv, and the simulation signal SI14 is generated as follows.
  • the coefficient is set to K i and the third simulated torque signal TD is generated as follows.
  • TD (k 2) TD (k 2— 1) + K i * SI 14 (k 2) (59)
  • FIG. 16 is a block diagram showing the present embodiment.
  • the second torque compensator 12 according to the embodiment of the present invention includes a discretized integrator 12a.
  • the coefficient is set to K i and the third simulated torque signal TD is generated as follows.
  • the high-order control unit 8, the first torque compensating unit 11, the low-order control unit 9, and the torque synthesizing unit 10 shown in the above embodiment can be easily realized by respective processors.
  • the high-order control unit 8, the second torque compensating unit 12, the low-order control unit 9, and the torque synthesizing unit 10 shown in the above-described embodiment can be easily realized by the respective processors.
  • the high-order control unit 8, the second torque compensating unit 12, the simulated observer 13, the low-order control unit 14, and the torque synthesizing unit 10 shown in the above-described embodiment can be easily implemented by respective processors. it can. Industrial potential
  • the present invention has the following effects.
  • the control processing of the lower control unit can be realized more simply, and the control processing of the lower control unit can be performed in a shorter control sample time.
  • the configuration of the higher-level control unit in consideration of the above characteristics can be configured more easily.
  • the lower control unit and the first torque compensator can be designed independently, so that the high frequency range and the low frequency
  • the control system can be designed more easily according to the different characteristics of the mechanical system appearing in the area, and better control performance can be realized.
  • the torque compensator can reduce the amount of data communication between the second torque compensator and the lower-level control unit. Since it can be constructed simply, a motor control device can be realized with a shorter control sample time using processors having the same processing function.
  • the noise included in the actual response signal can be reduced, so that the control gains of the upper control unit, the lower control unit, and the second control unit can be set larger. Therefore, when the higher-level control unit is constructed with a control sample time different from that of the lower-level control in the conventional motor control device, it is possible to prevent vibration and overshoot appearing in the control, thereby realizing better control performance.
  • the upper control unit considering the characteristics of the lower control unit and the mechanical system can be easily implemented in the second control sample time.
  • the vibration and overshoot that appear in the control when the higher-level control unit is constructed with a control sample time different from that of the lower-level control in the conventional motor control device Can be prevented, and better control performance can be realized.
  • the simulation model can be more easily realized when the mechanical resonance frequency of the mechanical system is high, so the upper control unit differs from the lower control in the conventional motor control device. Vibration and overshoot appearing in the control when constructed with the control sample time can be prevented, and the amount of calculation required for the motor control device can be reduced.
  • the simulated lower-level control unit can be realized more easily by constructing it with a PP control system. Therefore, when a higher-level control unit is constructed with a control sample time different from that of a lower-level control in a conventional motor control device, it is possible to prevent vibration and overshoot appearing in control, and to reduce the amount of calculation required for the motor control device. Can be.
  • the host controller By constructing the host controller with a PP control system, the host controller can be realized more easily.
  • the parameters of the host controller can be set more easily.
  • the upper controller can be realized more easily.
  • the parameters of the lower control unit can be set more easily. Further, when the upper-level control unit is constructed in consideration of the lower-level control unit, the configuration of the upper-level control unit can be made simpler. 19) The first simulated position signal and the first simulated speed signal updated at the first sample control time are compared with the 24th simulated signal while considering the difference between the first sample control time and the second sample control time. By generating the 25th simulation signal in the second sample control time and inputting it to the conventional lower-level control unit, the second simulation torque signal can be smoothed.
  • the higher-level control unit when the higher-level control unit is constructed with a control sample time different from that of the lower-level control, it is possible to prevent vibration and overshoot appearing in the control.
  • the vibration component included in the second simulated torque signal can be reduced, and the higher-level control unit is constructed with a control sample time different from that of the lower-level control in the conventional motor control device. Vibration and overshoot that appear in the control in the event of a shock.
  • the torque command can be smoothed by generating and inputting it to the conventional torque synthesis unit.
  • the control performance of the conventional motor controller can be improved if the upper control unit is constructed with a control sample time different from that of the lower control. Vibration and overshoot appearing on the motor can be prevented, and the amount of calculation for the motor control device can be reduced.
  • the parameters of the first torque compensator can be set more easily.
  • the vibration and overshoot appearing in the control performance when the upper control unit is constructed with a control sample time different from that of the lower control in the conventional motor control device. Can be prevented, and the amount of calculation required for the motor control device can be reduced.
  • the parameters of the second torque compensator can be set more easily.

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Electric Motors In General (AREA)
  • Feedback Control In General (AREA)

Description

明細書 電動機制御装置 技術分野
本発明は、 例えば、 工作機械におけるテーブルやロボットのアームのような負 荷機械を駆動する電動機 （直流電動機、 誘導電動機、 同期電動機、 リニアモータ など） の制御装置に関するものである。 背景技術
工作機械におけるテーブル、 ロボッ トのアームなどの負荷機械と、 前記負荷機 械を駆動する直流電動機、 誘導電動機、 同期電動機、 電磁石、 リニアモータなど の駆動装置と、 前記負荷機械と駆動装置とを連結する伝達機構とから構成された 機械系に対して、 第 2模擬トルク信号と トルク指令とを提供するフィードバック 制御系と、 第 1模擬トルク信号を提供するフイードフォヮ一ド制御系とを持った 2自由度制御装置が多く使用されている。
例えば、 特願平 4- 119402 と、 特願平 4- 138223 などがある。 第 1図は従来 の 2自由度制御装置の例を示すプロック線図である。
第 1図に示すように、 従来の位置制御装置は、 トルク伝達機構 2を介して負荷 機械 1を駆動する電動機 3と、 前記電動機の回転角指令信号を入力されて少なく とも 2 回の積分演算を含む所定の関数演算により摸擬回転角信号と摸擬速度信号 と第 1模擬トルク信号とをそれぞれ出力するフィードフォヮ一ド信号演算回路 2 1と、 前記電動機の回転速度及ぴ回転角を検出する回転検出器 2 0と、 前記摸擬 回転角信号および前記回転検出器から出力された実回転角信号に基づいて第 1 の 速度信号を出力する位置制御回路 2 2と、 前記模擬速度信号と前記第 1 の速度信 号と前記回転検出器から出力された実速度信号とに基づいて第 2模擬トルク信号 を出力する速度制御回路 2 3と、 前記第 1模擬トルク信号と前記第 2模擬トルク 信号に基づいて前記電動機のトルクを制御する制御手段 2 4とを備えたことによ り、 高速応答の位置制御性能が得られる。
しかしながら、 フィードフォワード演算の制御サンプル時間がフィードバック 演算の制御サンプル時間より大きくなる場合、 フィードフォヮ一ドの数値モデル が制御対象に一致しているにもかかわらず、 サンプル時間が異なることにより、 離散化モデリング誤差が発生する。 よって、 実回転角信号と摸擬回転角信号との 間に、 誤差が生じられ、 実回転角信号にオーバーシュートや振動が発生する場合 力 Sある。
本発明の目的は、 フィードフォヮ一ド演算の制御サンプル時間とフィードバッ ク演算の制御サンプル時間とが異なる場合においても、 実回転角信号と摸擬回転 角信号との間に、 誤差を生じさせず、 良好な制御性能を実現する電動機制御装置 を提供することである。 発明の開示
上記問題を解決するため、 本発明の請求項 1は、 以下に述べるような手段を備 えるものである。
実指令信号を提供する指令発生器。
前記機械システムと前記動力変換回路との状態量を観測し、 第 1制御サンプル時 間で実応答信号を提供する実観測器。
前記実指令信号に基づいて、 第 1制御サンプル時間より大きな第 2制御サンプル 時間で第 1模擬位置信号と第 1模擬速度信号と第 1模擬トルク信号とを提供する 上位制御部。
前記第 1模擬位置信号と前記第 1模擬速度信号と前記実応答信号とに基づいて第 1制御サンプル時間で第 2模擬トルク信号を提供する下位制御部。
前記第 1模擬位置信号と前記第 1模擬速度信号と前記実応答信号とに基づいて第 2制御サンプル時間で第 3模擬トルク信号を提供するトルク捕償部。
前記第 1模擬トルク信号と前記第 2模擬トルク信号と前記第 3模擬トルク信号に 基づいて第 1制御サンプル時間でトルク指令を提供するトルク合成部。
また、 本発明の請求項 2は、 以下に述べるような手段を備えるものである。 実 指令信号を提供する指令発生器。
前記機械システムと前記動力変換回路との状態量を観測し、 第 1制御サンプル時 間で実応答信号を提供する実観測器。
前記実指令信号に基づいて、 第 1制御サンプル時間より大きな第 2制御サンプル 時間で第 1模擬位置信号と第 1模擬速度信号と第 1模擬トルク信号とを提供する 上位制御部。
前記第 1模擬位置信号と前記第 1模擬速度信号と前記実応答信号とに基づいて第 1制御サンプル時間で第 2模擬トルク信号を提供する下位制御部。
前記第 2模擬トルク信号に基づいて第 2制御サンプル時間で第 3模擬トルク信号 を提供するトルク補償部。
前記第 1模擬トルク信号と前記第 2模擬トルク信号と前記第 3模擬トルク信号に 基づいて第 1制御サンプル時間でトルク指令を提供するトルク合成部。
また、 本発明の請求項 3は、 以下に述べるような手段を備えるものである。 実指令信号を提供する指令発生器。
前記機械システムと前記動力変換回路との状態量を観測し、 第 1制御サンプル時 間で実応答信号を提供する実観測器。
前記実指令信号に基づいて、 第 1制御サンプル時間より大きな第 2制御サンプル 時間で第 1模擬位置信号と第 1模擬速度信号と第 1模擬トルク信号とを提供する 上位制御部。 '
トルク指令と前記実応答信号とに基づいて第 1制御サンプル時間で推定位置信号 と推定速度信号とを提供する模擬観測器。
前記第 1模擬位置信号と前記第 1模擬速度信号と前記推定位置信号と前記推定速 度信号とに基づいて第 1制御サンプル時間で第 2模擬トルク信号を提供する下位 制御部。
前記第 2模擬トルク信号に基づいて第 2制御サンプル時間で第 3模擬トルク信号 を提供するトルク補償部。
前記第 1模擬トルク信号と前記第 2模擬トルク信号と前記第 3模擬トルク信号に 基づいて第 1制御サンプル時間でトルク指令を提供するトルク合成部。 また、 本発明の請求項 4は、 以下に述べるような手段を備えるものである。 前記実指令信号と第 1模擬位置信号と第 1模擬速度信号とに基づいて第 1模擬ト ルク信号を提供する上位コントローラ。
第 1模擬位置信号 0 Fと第 1模擬速度信号 w Fとに基づいて第 4模擬信号を提供 する模擬下位制御部。
前記第 1模擬トルク信号と前記第 4模擬信号とに基づいて第 1模擬信号を提供す る加算器。
前記第 1模擬信号に基づいて第 2模擬信号と第 3模擬信号とを提供する模擬モデ ル。
前記第 2模擬信号と前記第 3模擬信号とに基づいて第 2制御サンプル時間で第 1 模擬位置信号と第 1模擬速度信号とを提供する模擬信号処理器。
また、 本発明の請求項 5は、 以下に述べるような手段を備えるものである。 第 3 1模擬信号に基づいて第 2 8模擬信号を提供する係数器。
前記第 2 8模擬信号に基づいて第 3模擬信号を提供する積分器。
前記第 3模擬信号に基づいて第 2模擬信号を提供する積分器。
前記第 1模擬信号と前記第 2模擬信号に基づいて第 3 2模擬信号を提供する減算 前記第 3 2模擬信号に基づいて第 2 9模擬信号を提供する係数器。
前記第 2 9模擬信号と前記第 3模擬信号に基づいて第 3 0模擬信号を提供する減 前記第 3 0模擬信号に基づいて第 3 1模擬信号を提供する係数器。
また、 本発明の請求項 6は、 以下に述べるような手段を備えるものである。 前記第 2模擬信号に基づいて第 5模擬信号を提供する係数器。
前記第 5模擬信号と前記第 3模擬信号とに基づいて第 6模擬信号を提供する加算 前記第 6模擬信号に基づいて第 4模擬信号を提供する係数器。
また、 本発明の請求項 7は、 以下に述べるような手段を備えるものである。 前記実指令信号と前記第 1模擬位置信号とに基づいて第 7模擬信号を提供する減 前記第 7模擬信号に基づいて第 8模擬信号を提供する係数器。
前記第 1模擬速度信号と前記第 8模擬信号とに基づいて第 9模擬信每を提供する 前記第 9模擬信号に基づいて第 1模擬トルク信号を提供する係数器。
また、 本発明の請求項 8は、 以下に述べるような手段を備えるものである。 前記第 1模擬位置信号と前記実応答信号とに基づいて第 2 0模擬信号を提供する 前記第 2 0模擬信号に基づいて第 2 1模擬信号を提供する係数器。
前記実応答信号に基づいて第 1制御サンプル時間で第 2 2模擬信号を提供する差 分器。
前記第 2 1模擬信号と前記第 2 2模擬信号とに基づいて第 2 3模擬信号を提供す る加減算器。
前記第 2 3模擬信号に基づいて第 2模擬トルク信号を提供する係数器。
また、 本発明の請求項 9は、 以下に述べるような手段を備えるものである。 前記第 1模擬位置信号と前記推定位置信号とに基づいて第 2 0模擬信号を提供す る減算器。
前記第 2 0模擬信号に基づいて第 2 1模擬信号を提供する係数器。
前記第 2 1模擬信号と前記第 1模擬速度信号と前記推定速度信号とに基づいて第
2 3模擬信号を提供する加減算器。
前記第 2 3模擬信号に基づいて第 2模擬トルク信号を提供する係数器。
また、 本発明の請求項 1 0は、 以下に述べるような手段を備えるものである。 前記第 1模擬位置信号に基づいて第 1制御サンプル時間で第 2 4模擬信号を提供 する指令補償器。
前記第 1模擬速度信号に基づいて第 1制御サンプル時間で第 2 5模擬信号を提供 する指令補償器。
前記第 2 4模擬信号と前記実応答信号とに基づいて第 2 0模擬信号を提供する減 前記第 2 0模擬信号に基づいて第 2 1模擬信号を提供する係数器。
前記実応答信号に基づいて第 1制御サンプル時間で第 2 2模擬信号を提供する差 分器。
前記第 2 1模擬信号と前記第 2 2模擬信号と前記第 2 5模擬信号とに基づいて第 2 3模擬信号を提供する加減算器。
前記第 2 3模擬信号に基づいて第 2模擬トルク信号を提供する係数器。
また、 本発明の請求項 1 1は、 以下に述べるような手段を備えるものである。 前記第 1模擬位置信号に基づいて第 1制御サンプル時間で第 2 4模擬信号を提供 する指令補償器。
前記第 1模擬速度信号に基づいて第 1制御サンプル時間で第 2 5模擬信号を提供 する指令補償器。
前記第 2 4模擬信号と前記推定位置信号とに基づいて第 2 0模擬信号を提供する 減 器。
前記第 2 0模擬信号に基づいて第 2 1模擬信号を提供する係数器。
前記第 2 1模擬信号と前記推定速度信号と前記第 2 5模擬信号とに基づいて第 2
3模擬信号を提供する加減算器。
前記第 2 3模擬信号に基づいて第 2模擬トルク信号を提供する係数器。
また、 本発明の請求項 1 2は、 以下に述べるような手段を備えるものである。 前記第 2模擬トルク信号に基づいて第 2 6模擬信号を提供する指令フィルタ。 前記第 2 6模擬信号と前記第 1模擬トルク信号と前記第 3模擬トルク信号とに基 づいてトルク指令を提供する加算器。
また、 本発明の請求項 1 3は、 以下に述べるような手段を備えるものである。 前記第 2模擬トルク信号に基づいて第 2 6模擬信号を提供する指令フィルタ。 前記第 1模擬トルク信号に基づいて第 1制御サンプル時間で第 2 7模擬信号を提 供する指令補償器。
前記第 2 6模擬信号と前記第 3模擬トルク信号と前記第 2 7模擬信号とに基づい てトルク指令を提供する加算器。
また、 本発明の請求項 1 4は、 以下に述べるような手段を備えるものである。 前記実応答信号と第 1模擬位置信号とに基づいて第 1 0模擬信号を提供する減算 前記第 1 0模擬信号に基づいて第 1 2模擬信号を提供する係数器。
前記実応答信号に基づいて第 2制御サンプル時間で第 1 1模擬信号を提供する差 分器。
前記第 1 2模擬信号と前記第 1 1模擬信号と前記第 1模擬速度信号とに基づいて 第 1 3模擬信号を提供する加減算器。
前記第 1 3模擬信号に基づいて第 1 4模擬信号を提供する係数器。
前記第 1 4模擬信号に基づいて第 2制御サンプル時間で第 3模擬トルク信号を提 供する離散化積分器。
また、 本発明の請求項 1 5は、 以下に述べるような手段を備えるものである。 1 . 前記第 2模擬トルク信号に基づいて第 2制御サンプル時間で第 3模擬トルク 信号を提供する離散化積分器。
また、 本発明の請求項 1 6は、 以下に述べるような手段を備えるものである。 ， 前記上位制御部と、 前記第 1 トルク補償部と、 前記下位制御部と、 前記トルク合 成部とが複数のプロセッサで構成される手段。
また、 本発明の請求項 1 7は、 以下に述べるような手段を備えるものである。 前記上位制御部と、 前記第 2 トルク捕償部と、 前記下位制御部と、 前記トルク合 成部とが複数のプロセッサで構成される手段。
また、 本発明の請求項 1 8は、 以下に述べるような手段を備えるものである。 前記上位制御部と、 前記第 2 トルク補償部と、 前記模擬観測器と、 前記下位制御 部と、 前記トルク合成部とが複数のプロセッサで構成ざれる手段。
本発明請求項 1では、 まず、 下位制御部と機械システムとの特性を考慮するよ うに上位制御部を構成することによって、 従来の電動機制御装置で上位制御部が 下位制御と異なる制御サンプル時間で構築された場合に制御制御性能に現れる振 動やオーバーシュートを防ぐことができる。 また、 上位制御部が下位制御と異な る制御サンプル時間で実現することによって、 同一処理機能を持つプロセッサで より複雑な制御処理を上位制御部で実現しながら、 より短い制御サンプル時間で 下位制御部の制御処理を行うことができるので、 より口バストなフィードバック 特性が得られる。 また、 第 1 トルク補償部の導入によって、 下位制御部の制御処 理をよりシンプルに実現し、 より短い制御サンプル時間で下位制御部の制御処理 を行うことができると共に、 下位制御部と機械システムとの特性を考慮した上位 制御部の構成を簡単に実現することができる。 さらに、 下位制御部と異なる制御 サンプル時間で処理する第 1 トルク補償部の導入によって、 下位制御部と第 1 ト ルク補償部とをそれぞれで設計することができるので、 高周波数領域と低周波数 領域とに現れる機械システムの異なる特性に応じた制御系の設計をより簡単に行 うことができ、 良好な制御性能を実現することができる。
本発明請求項 2では、 第 2 トルク補償部が第 2模擬トルクのみを利用すること により、 第 2 トルク補償部と下位制御部とのデータ通信量を減らすことができる と共に、 第 2 トルク補償部をよりシンプルに構築することができるので、 同一処 理機能を持つプロセッサでより短い制御サンプル時間で電動機制御装置を実現す ることができる。 よって、 従来の電動機制御装置で上位制御部が下位制御と異な る制御サンプル時間で構築された場合に現れる振動やオーバーシュートを防ぐこ とができ、 良好な制御性能を実現することができる。
本発明請求項 3では、 さらに、 模擬観測器を導入することによって、 実応答信 号に含まれたノイズを減らすことができるので、 上位制御部と下位制御部と第 2 . 制御部との制御ゲインをより大きく設定することができるので、 良好な制御性能 を実現することができる。
本発明請求項 4では、 従来の上位制御部に模擬下位制御部と模擬信号処理器と を加えることによって、 下位制御部と機械システムとの特性を考慮した上位制御 部を第 2制御サンプル時間で容易に実現できるようにすると共に、 従来の電動機 制御装置で上位制御部が下位制御部と異なる制御サンプル時間で構築された場合 に現れる振動やオーバーシュートを防ぐことができ、 良好な制御性能を実現する ことができる。
本発明請求項 5では、 模擬モデルを剛体系で構築することによって、 機械シス テムの機械共振周波数が高い場合、 模擬モデルがより簡単になるので、 従来の電 動機制御装置で上位制御部が下位制御と異なる制御サンプル時間で構築された場 合に制御制御性能に現れる振動やオーバーシュートを防ぐことができると共に、 電動機制御装置にかかる計算量を減らすことができる。
本発明請求項 6では、模擬下位制御部を P— P制御系で構築することによって、 模擬下位制御部をより簡単に実現できる。 よって、 従来の電動機制御装置で上位 制御部が下位制御部と異なる制御サンプル時間で構築された場合に現れる振動や オーバーシュートを防ぐことができると共に、 電動機制御装置にかかる計算量を 減らすことができる。 また、 模擬下位制御部のパラメータをより容易に設定する ことができる。
本発明請求項 7では、 上位コントローラを P— P制御系で構築することによつ て、 上位コントローラをより簡単に実現できる。 よって、 従来の電動機制御装置 で上位制御部が下位制御と異なる制御サンプル時間で構築された場合に現れる振 動やオーバーシュートを防ぐことができると共に、 電動機制御装置にかかる計算 量を減らすことができる。 また、 上位コントローラのパラメータをより容易に設 定することができる。
本発明請求項 8、 9では、 下位制御部を P— P制御系で構築することによって、 上位コントローラをより簡単に実現できる。 よって、 従来の電動機制御装置で上 位制御部が下位制御と異なる制御サンプル時間で構築された場合に現れる振動や オーバーシュートを防ぐことができると共に、 電動機制御装置にかかる計算量を 減らすことができる。 また、 下位制御部のパラメータをより容易に設定すること ができる。 さらに、 下位制御部を考慮して上位制御部を構築するとき、 上位制御 部の構成をよりシンプル的にすることができる。
本発明請求項 1 0、 1 1では、 第 1サンプル制御時間で更新される第 1模擬位 置信号と第 1模擬速度信号とを第 1サンプル制御時間と第 2サンプル制御時間と の違いを考慮しながら、 第 2 4模擬信号と第 2 5模擬信号とを第 2サンプル制御 時間で生成し、 従来の下位制御部に入力することによって、 第 2模擬トルク信号 を滑らかにすることができる。 よって、 従来の電動機制御装置で上位制御部が下 位制御と異なる制御サンプル時間で構築された場合に現れる振動やオーバーシュ ートを防ぐことができる。
本発明請求項 1 2では、 指令フィルタを加えることによって、 第 2模擬トルク 信号に含まれている振動成分を減らすことができると共に、 従来の電動機制御装 置で上位制御部が下位制御と異なる制御サンプル時間で構築された場合に現れる 振動やオーバ一シュートを防ぐことができる。
本発明請求項 1 3では、 第 1サンプル制御時間で更新される第 1模擬トルク信 号を第 1サンプル制御時間と第 2サンプル制御時間との違いを考慮しながら、 第 2 7模擬信号を第 2サンプル制御時間で生成し、 従来のトルク合成部に入力する ことによって、 トルク指令を滑らかにすることができる。 よって、 従来の電動機 制御装置で上位制御部が下位制御と異なる制御サンプル時間で構築された場合に 現れる振動やオーバーシュートを防ぐことができる。
本発明請求項 1 4では、 第 1 トルク補償器を P— P— I制御系で構築すること によって、 従来の電動機制御装置で上位制御部が下位制御と異なる制御サンプル 時間で構築された場合に現れる振動やオーバーシユートを防ぐことができると共 に、 電動機制御装置にかかる計算量を減らすことができる。 また、 第 1 トルク補 償器のパラメータをより容易に設定することができる。
本発明請求項 1 5では、 第 2 トルク補償器を I制御系で構築することによって、 従来の電動機制御装置で上位制御部が下位制御と異なる制御サンプル時間で構築 された場合に現れる振動やオーバーシュートを防ぐことができると共に、 電動機 制御装置にかかる計算量を減らすことができる。 また、 第 2 トルク補償器のパラ メータをより容易に設定することができる。
本発明請求項 1 6〜1 8では、 複数のプロセッサで構成することによって、 従 来の電動機制御装置で上位制御部が下位制御と異なる制御サンプル時間で構築さ れた場合に現れる振動やオーバーシュートを防ぐことができると共に、 本電動機 制御装置の制御サンプル時間を大幅に減らすことができる。 図面の簡単な説明
第 1図は従来技術を示すプロック図、 第 2図は本発明の実施例 1を示すプロッ ク図、 第 3図は本発明の実施例 2を示すプロック図、 第 4図は本発明の実施例 3 を示すプロック図、 第 5図は本発明の実施例 4を示すブロック図、 第 6図は本発 明の実施例 5を示すプロック図、 第 7図は本発明の実施例 6を示すプロック図、 第 8図は本発明の実施例 7を示すプロック図、 第 9図は本発明の実施例 8を示す ブロック図、 第 1 0図は本発明の実施例 9を示すブロック図、 第 1 0図は本発明 の実施例 1 0を示すプロック図、 第 1 2図は本発明の実施例 1 1を示すブロック 図、 第 1 3図は本発明の実施例 1 2を示すブロック図、 第 1 4図は本発明の実施 例 1 3を示すプロック図、 第 1 5図は本発明の実施例 1 4を示すプロック図、 第 1 6図は本発明の実施例 1 5を示すプロック図である。 発明を実施するための最良の形態
次に本発明の実施形態を実施例に基づいて説明する。
[実施例 1 ]
以下、 本発明の実施例 1について詳細に説明する。
以下、 第 2図を参照しながら本発明の実施例 1を説明する。
第 2図は、 本発明の実施例 1の全体を示すプロック図である。 第 2図において、 本発明の実施例は、 負荷機械 1と伝達機構 2と電動機 3と動力変換回路 4とから 構成された機械システム 5と、 実観測器 6と、 指令発生器 7と、 上位制御部 8と、 下位制御部 9と、 トルク合成部 1 0と、 第 1 トルク補償部 1 1とから構成されて いる。
機械システム 5と実観測器 6と指令発生器 7とは従来装置のものと同一である。 Θ r e f は指令発生器 7から生成された実指令信号である。 θ κιは実観測器 6か ら生成された実応答信号である。
上位制御部 8は、 実指令信号 0 r e f に基づいて、 第 2制御サンプル時間 t 2 で第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fと第 1模擬トルク信号 T F Fと を提供する。
下位制御部 9は、 第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fと実応答信号 0 mとに基づいて第 1制御サンプル時間 t 1で第 2模擬トルク信号 T F Bを提供 する。
第 1 トルク補償部 1 1は、 第 1模擬位置信号 Θ Fと第 1模擬速度信号 wFと実 応答信号 Θ mとに基づいて第 2制御サンプル時間 t 2で第 3模擬トルク信号 T D を提供する。 .
トルク合成部 1 0は、 第 1模擬トルク信号 T F Fと第 2模擬トルク信号 T F B と第 3模擬トルク信号 TDとに基づいてトルク指令 T r e f を提供する。
上位制御部 8において、 第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fと第 1 模擬トルク信号 TF Fとが、 （1)、 （2)、 (3) の式を第 2制御サンプル時間 t 2で離散化した上で生成される。
Θ F = [1/ (T 1 * s 2 + T 2 * s + 1 )] * Θ r e f (1)
wF= i s / ( l * s 2 + T2* s + 1)] * 0 r e f (2)
T F F = [ J s V (T 1 * s 2 + T 2 * s + 1 )] * Θ r e f (3) ただし、 T 1、 T 2、 J mは機械システム 5と下位制御部の特性を考慮した上で 設定されたものである。
第 1 トルク補償部 1 1において、 第 3模擬トルク信号 TDが （4) 式を第 2制 御サンプル時間 t 2で離散化した上で生成される。 ただし、 K 1、 K2は制御ゲ ィンである。
TD= [(K 1 * (6 F - Θ m) -K 2* (wF-wm)] / s (4) 下位制御部 9において、 第 2模擬トルク信号が、 （5) 式を第 1制御サンプル 時間 t 1で離散化した上で生成される。 ただし、 K3、 Κ4は制御ゲインである。 T F Β = Κ 3 * ( Θ F - Θ m) +K 4 * (wF-wm) (5)
トルク合成部 1 0において、 トルク指令を次のように生成する。
T r e f =T F F + TD + T F B (6)
[実施例 2]
次に、 本発明の実施例 2について第 3図を参照しながら詳細に説明する。
第 3図は、 本実施例の全体を示すプロック図である。 第 3図において、 本発明の 実施例は、 負荷機械 1.と伝達機構 2と電動機 3と動力変換回路 4とから構成され た機械システム 5と、 実観測器 6と、 指令発生器 7と、 上位制御部 8と、 下位制 御部 9と、 トルク合成部 1 0と、 第 2 トルク補償部 1 2とから構成されている。 第 2 トルク補償部 1 2は、 第 2模擬トルク信号 TF Bに基づいて第 2制御サン プル時間 t 2で第 3模擬トルク信号 TDを提供する。
第 2 トルク補償部 1 2において、 第 3模擬トルク信号 TDが （7) 式を第 2制 御サンプル時間 t 2で離散化した上で生成される。
TD = K 5*TF B/ s (7)
[実施例 3 ]
次に、 本発明の実施例 3について第 4図を参照しながら詳細に説明する。
第 4図は、 本実施例の全体を示すプロック図である。 第 4図において、 本発明の 実施例は、 負荷機械 1と伝達機構 2と電動機 3と動力変換回路 4とから構成され た機械システム 5と、 実観測器 6と、 指令発生器 7と、 上位制御部 8と、 下位制 御部 1 4と、 トルク合成部 1 0と、 模擬観測器 1 3と、 第 2 トルク補償部 1 2と から構成されている。
模擬観測器 1 3は、 実応答信号 θ πιと トルク指令 T r e f とに基づいて第 1制 御サンプル時間 t 1で推定位置信号 Θ mhと推定速度信号 wmhとを提供する。 下位制御部 1 4は、 第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fと推定位置 信号 Θ mhと推定速度信号 wmhとに基づいて第 1制御サンプル時間 t 1で第 2 模擬トルク信号 T F Bを提供する。
下位制御部 1 4において、 第 2模擬トルク信号 TF Bが （8) 式で生成される。 TF B = K 3 * (Θ F- Θ mh) +K4 (wF-wmh) (8) 模擬観測器 1 3において、 推定位置信号 0 mhと推定速度信号 wmhとを次の ように生成する。 k 1は第 1制御サンプル時間 t 1に対応するサンプルカウンタ であり、 （ k 1 ) は、 時刻 t 1 * k 1時の時間変数の値を表す。
e (k l ) = 6 m (k l ) - Θ mh (k 1 ) (9)
Θ mh (k l+1) = Θ mh (k l ) +wmh (k l ) * t 1
+ L 1 * e (k 1 ) (1 0)
wmh (k l+1) =wmh (k l) +T r e f (k l ) * t 1 / J m
+ L 2 * e (k 1 ) (1 1) [実施例 4 ]
次に、 本実施例について第 5図を参照しながら詳細に説明する。
第 5図は、 本発明の実施例 4を示すブロック図である。 第 5図において、 本発明 の実施例の上位制御部 8は、 上位コントローラ 8 aと、 模擬下位制御部 8 bと、 加算器 8 dと、 模擬モデル 8 cと、 模擬信号処理器 8 eとから構成されている。 上位コントローラ 8 aは、 実指令信号 θ r e f と第 1模擬位置信号 Θ Fと第 1 模擬速度信号 w Fとに基づいて第 1模擬トルク信号 T F Fを提供する。
模擬下位制御部 8 bは、 第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fとに基づ いて第 4模擬信号 S I 4を提供する。
加算器 8 d第 1模擬トルク信号 TF Fと第 4模擬信号 S I 4とに基づいて第 1模 擬信号 S I 1を提供する。
模擬モデル 8 cは、 第 1模擬信号 S I 1に基づいて第 2模擬信号 S I 2と第 3模 擬信号 S I 3とを提供する。
模擬信号処理器 8 eは第 2模擬信号 S I 2と前記第 3模擬信号 S I 3とに基づい て第 2制御サンプル時間 t 2で第 1模擬位置信号 e Fと第 1模擬速度信号 w Fと を提供する。
上位コントローラ 8 aにおいて、 第 1模擬トルク信号 TFFを次のように生成 十る。
TFF=K5* ( Θ r e f - Θ F) -K 6 *wF (1 2) 模擬下位制御部 8 bにおいて、 第 4模擬信号 S I 4を次のように生成する。
S I 4 =K 7 * Θ F + K 8 *wF (13)
加算器 8 dにおいて、 第 1模擬信号 S I 1を次のように生成する。
S I 1 =TFF— S I 4 (1 4)
模擬モデル 8 cにおいて、 第 2模擬信号 S I 2と第 2模擬信号 S I 3とを生成 する。
模擬信号処理器 8 eにおいて、 第 1模擬位置信号 0 Fと第 1模擬速度信号 wF を次のように生成する。 k 2は第 2制御サンプル時間 t 2に対応するサンプル力 ゥンタであり、 （k 2) は、 時刻 t 2* k 2時の時間変数の値を表す。 Θ F ( t ) = S I 2 (k 2 * t 2) ( 1 7)
wF ( t ) = S I 3 (k 2 * t 2) ( 1 8)
ただし、
k 2 * t 2≤ (k 2+1) * t 2 ( 1 9)
[実施例 5 ]
次に、 本発明の実施例 5について第 6図を参照しながら詳細に説明する。
第 6図は、 本実施例を示すブロック図である。 第 6図において、 本発明の実施例 の模擬モデル 8 cは、 減算器 8 c 4と、 係数器 8 c 5と、 減算器 8 c 6と、 係数 器 8 c 7と、 係数器 8 c 1 と、 積分器 8 c 2と、 積分器 8 c 3とから構成されて レ、る。
減算器 8 c 4において、 次のように模擬信号 S I 3 2を生成する。
S I 3 2 = S I 1 - S I 2 ( 2 0)
係数器 8 c 5において、 係数を K pに設定し、 次のように模擬信号 S I 2 9を生 成する。
S I 2 9 =K p * S I 3 2 ( 2 1 )
減算器 8 c 6において、 次のように模擬信号 S I 3 0を生成する。
S I 3 0 = S I 2 9— S 1 3 ( 2 2)
係数器 8 c 7において、 係数を K vに設定し、 次のように模擬信号 S I 3 1を生 成する。
S I 3 1 =K v* S 1 3 0 ( 2 3 )
係数器 8 c 1において、 係数を 1 / J mに設定し、 次のように模擬信号 S I 2 8 を生成する。
S I 2 8 = S I 3 l / J m ( 2 4)
模擬信号 S I 3を次のように生成する。
S I 3 = S I 2 8 / s ( 2 5)
模擬信号 S I 2を次のように生成する。
S I 2 = S I 3 / s ( 2 6)
[実施例 6 ] 次に、 本発明の実施例 6について第 7図を参照しながら詳細に説明する。
第 7図は、 本実施例を示すブロック図である。 第 7図において、 本発明の実施 例の模擬下位制御部 8 bは、 係数器 8 b 1と、 加算器 8 b 2と、 係数器 8 b 3と から構成されている。
係数器 8 b 1において、 係数を Kpに設定し、 次のように模擬信号 S I 5を生成 する。
S I 5 =Κ ρ * Θ F (27)
加算器 8 b 2において、 次のように模擬信号 S I 6を生成する。
S I 6 =wF + S I 5 (28)
係数器 8 b 3において、 係数を Kvに設定し、 次のように模擬信号 S I 4を生 成する。
S I 4 =Κ V氺 S I 6 (29)
' [実施例 7]
次に、 本発明の実施例 7について第 8図を参照しながら詳細に説明する。
第 8図は、 本実施例 7を示すプロック図である。 第 8図において、 本発明の実施 例の上位コントローラ 8 aは、 減算器 8 a 4と、 係数器 8 a 1と、 減算器 8 a 2 と、 係数器 8 a 3とから構成されている。
減算器 8 a 4において、 次のように模擬信号 S I 7を生成する。
S I 7 = 0 r e f - 0 F (30)
係数器 8 a 1において、 係数を Kp f に設定し、 次のように模擬信号 S I 8を 生成する。
S I 8 =Kp f 氺 S I 7 (3 1)
減算器 8 a 2において、 次のように模擬信号 S I 9を生成する。
S I 9 = S I 8 -wF (32)
係数器 8 a 3において、 係数を Kv f に設定し、 次のように第 1模擬トルク信 号 TF Fを生成する。
TF F =K V f * S I 9 (33)
[実施例 8] 次に、 本発明の実施例 8について第 9図を参照しながら詳細に説明する。
第 9図は、 本実施例を示すブロック図である。 第 9図において、 本発明の実施例 の下位制御部 9は、 減算器 9 aと、 係数器 9 bと、 加減算器 9 cと、 係数器 9 d と、 差分器 9 eとから構成されている。
減算器 9 aにおいて、 次のように模擬信号 S I 20を生成する。
S I 2 O = 0 F- 0 m (34)
係数器 9 bにおいて、 係数を Kpに設定し、 次のように模擬信号 S I 21を生 成する。
S I 21 =S I 20氺 Kp (3 5)
差分器 9 eにおいて、 次のように模擬信号 S I 22を生成する。
S I 22 (k 1 ) = Θ m (k 1 ) - Θ m (k 1 - 1 ) (3 6)
加減算器 9 cにおいて、 次のように模擬信号 S I 23を生成する。
S I 23 = S I 21 +wF - S I 22 (3 7)
係数器 9 dにおいて、 係数を Kvに設定し、 次のように第 2模擬トルク信号 Τ
FBを生成する。
TFB = S I 23 *Kv (3 8)
[実施例 9 ]
次に、 本発明の実施例 9について第 1 0図を参照しながら詳細に説明する。
第 1 0図は、 本実施例を示すプロック図である。 第 1 0図において、 本発明の実 施例の下位制御部 14は、 減算器 9 aと、 係数器 9 bと、 加減算器 9 cと、 係数 器 9 dとから構成されている。
減算器 9 aにおいて、 次のように模擬信号 S I 20を生成する。
S I 20 = 6 F- 6 mh (3 9)
係数器 9 bにおいて、 係数を Kpに設定し、 （3 5) 式のように模擬信号 S I 21を生成する。
加減算器 9 cにおいて、 次のように模擬信号 S I 23を生成する。
S I 23 = S I 21 +wF-wmh (40)
係数器 9 dにおいて、 係数を Kvに設定し、 （3 8) 式のように第 2模擬トル ク信号 TFBを生成する。
[実施例 1 0 ]
次に、 本発明の実施例 1 0について第 1 1図を参照しながら詳細に説明する。 第 1 1図は、 本実施例を示すブロック図である。 第 1 1図において、 本発明の実 施例の下位制御部 9は、 減算器 9 aと、 係数器 9 bと、 加減算器 9 cと、 係数器 9 dと、 差分器 9 eと、 指令補償器 9 f と、 指令補償器 9 gとから構成されてい る。
指令補償器 9 f において、 次のように模擬信号 S I 24を生成する。
S I 24 (k 1 ) = Θ F (k 2 - 1 )
+ ( Θ F (k 2) — Θ F (k 2 - 1 )) (41) ただし、
k 1 = i + (k 2 - 1 ) * I (4 2)
1 = t 2/ t 1 (43)
0≤ i < I (44)
指令補償器 9 gにおいて、 次のように模擬信号 S I 25を生成する。
S I 2 5 (k 1 ) =wF (k 2 - 1 )
+ (wF (k 2) — wF (k 2— 1 )) * i / I (4 5) 減算器 9 aにおいて、 次のように模擬信号 S I 20を生成する。
S I 20 = S I 24— Θ m (46)
係数器 9 bにおいて、 係数を Kpに設定し、 （3 5) 式のように模擬信号 S I
20を生成する。
差分器 9 eにおいて、 （3 6) 式のように模擬信号 S I 22を生成する。
加減算器 9 cにおいて、 次のように模擬信号 S I 23を生成する。
S I 23 = S I 21 + S I 25— S I 22 (47)
係数器 9 dにおいて、 係数を Kvに設定し、 （3 8) 式のように第 2模擬トル ク信号 TFBを生成する。
[実施例 1 1 ]
次に、 本発明の実施例 1 1について第 1 2図を参照しながら詳細に説明する。 第 1 2図は、 本実施例を示すブロック図である。 第 1 2図において、 本発明の実 施例の下位制御部 14は、 減算器 9 aと、 係数器 9 bと、 加減算器 9 cと、 係数 器 9 dと、 指令補償器 9 f と、 指令補償器 9 gとから構成されている。
指令補償器 9 f において、 （41) 式のように模擬信号 S I 24を生成する。 指令補償器 9 gにおいて、 （45) 式のように模擬信号 S I 2 5を生成する。 減算器 9 aにおいて、 次のように模擬信号 S I 20,を生成する。
S I 20 = S I 24- 6mh (48)
係数器 9 bにおいて、 係数を Kpに設定し、 （3 5) 式のように模擬信号 S I 21を生成する。
加減算器 9 cにおいて、 次のように模擬信号 S I 23を生成する。 S I 23 = S I 21 + S I 25 -wmh (49)
係数器 9 dにおいて、 係数を Kvに設定し、 （3 8) 式のように第 2模擬トル ク信号 TFBを生成する。
[実施例 1 2]
次に、 本発明の実施例 1 2について第 1 3図を参照しながら詳細に説明する。 第 1 3図は、 本実施例 1 2を示すプロック図である。 第 1 3図において、 本発明 の実施例のトルク合成部 1 0は、 指令フィルタ 1 0 bと、 加算器 1 0 aとから構 成されている。
指令フィルタ 1 0 bにおいて、 次のように模擬信号 S I 26を生成する。
S I 26 =T F B/ ( t f * s + 1 ) (50)
加算器 1 0 aにおいて、 次のようにトルク指令 T r e f を生成する。
T r e f =S I 26+TD + TFF (51)
[実施例 1 3 ]
次に、 本発明の実施例 1 3について第 14図を参照しながら詳細に説明する。 第 1 4図は、 本実施例を示すブロック図である。 第 1 4図において、 本発明の実 施例のトルク合成部 1 0は、 指令フィルタ 1 0 bと、 加算器 1 0 aと、 指令補償 器 1 0 cとから構成されている。
指令フィルタ 1 0 bにおいて、 （50) 式のように模擬信号 S I 26を生成す る。
指令補償器 1 0 cにおいて、 次のように模擬信号 S I 2 7を生成する。
S I 2 7 (k 1 ) =T F F (k 2 - 1 )
+ (T F F (k 2) — T F F (k 2 - 1 ))
* i / I ( 5 2)
加算器 1 0 aにおいて、 次のようにトルク指令 T r e f を生成する。
T r e f = S I 2 6 +TD+ S I 2 7 ( 5 3 )
[実施例 1 4 ]
次に、 本発明の実施例 1 4について第 1 5図を参照しながら詳細に説明する。 第 1 5図は、 本実施例を示すプロック図である。 第 1 5図において、 本発明の実 施例の第 1 トルク補償器 1 1は、 減算器 1 1 aと、 係数器 1 1 bと、 係数器 1 1 cと、 加減算器 1 1 f と、 差分器 1 1 dと、 離散化積分器 1 1 eとから構成され ている。
減算器 1 1 aにおいて、 次のように模擬信号 S I 1 0を生成する。
S I l O = 0 F - 0 m ( 5 4 )
係数器 1 1 bにおいて、 係数を K pに設定し、 次のように模擬信号 S I 1 2を生 成する。
S I 1 2 =Κ 氺 S I 1 0 ( 5 5)
差分器 1 1 dにおいて、 次のように模擬信号 S I 1 1を生成する。
S I 1 1 (k 2) = Θ m (k 2) 一 θ πι (k 2 - 1 ) ( 5 6 )
加減算器 1 1 f において、 次のように模擬信号 S I 1 3を生成する。
S I 1 3 = S I 1 2 +wF— S I 1 1 ( 5 7)
係数器 1 1 Cにおいて、 係数を K vに設定し、 次のように模擬信号 S I 1 4を 生成する。
S I 1 4 =Κ V氺 S I 1 0 ( 5 8)
離散化積分器 1 1 eにおいて、 係数を K iに設定し、 次のように第 3模擬トル ク信号 TDを生成する。
TD (k 2) =TD (k 2— 1 ) + K i * S I 14 (k 2) (59)
[実施例 1 5 ]
次に、 本発明の実施例 1 5について第 1 6図を参照しながら詳細に説明する。 第 1 6図は、 本実施例を示すプロック図である。 第 1 6図において、 本発明の実 施例の第 2 トルク補償器 1 2は、 離散化積分器 1 2 aから構成されている。
離散化積分器 1 2 aにおいて、 係数を K iに設定し、 次のように第 3模擬トルク 信号 TDを生成する。
TD (k 2) =TD (k 2— 1 )
+ K i *TF B (k 2) (60)
[実施例 1 6 ]
上述実施例に示す上位制御部 8と、 第 1 トルク補償部 1 1と、 下位制御部 9と、 トルク合成部 1 0とをそれぞれのプロセッサで構成することが容易に実現できる。
[実施例 1 7]
上述実施例に示す上位制御部 8と、 第 2 トルク補償部 1 2と、 下位制御部 9と、 トルク合成部 1 0とをそれぞれのプロセッサで構成することが容易に実現できる。
[実施例 1 8 ]
上述実施例に示す上位制御部 8と、 第 2 トルク補償部 1 2と、 模擬観測器 1 3 下位制御部 1 4と、 トルク合成部 1 0とをそれぞれのプロセッサで構成すること が容易に実現できる。 産業上の利用の可能性
上述したように、 本発明は、 下記の効果を有する。
1 ) 位制御部と機械システムとの特性を考慮するように上位制御部を構成するこ とによって、 従来の電動機制御装置で上位制御部が下位制御と異なる制御サンプ ル時間で構築された場合に制御に現れる振動やオーバーシュートを防ぐことがで さる。
2 ) 上位制御部が下位制御と異なる制御サンプル時間で実現することによって、 同一処理機能を持つプロセッサでより複雑な制御処理を上位制御部で実現しなが ら、 より短い制御サンプル時間で下位制御部の制御処理を行うことができるので、 より口バストなフィードバック特性が得られる。
3 ) 第 1 トルク補償部の導入によって、 下位制御部の制御処理をよりシンプルに 実現し、 より短い制御サンプル時間で下位制御部の制御処理を行うことができる と共に、 下位制御部と機械システムとの特性を考慮した上位制御部の構成をより 簡単に構成することができる。
4 ) 制御部と異なる制御サンプル時間で処理する第 1 トルク補償部の導入によつ て、 下位制御部と第 1 トルク補償部とをそれぞれで設計することができるので、 高周波数領域と低周波数領域とに現れる機械システムの異なる特性に応じた制御 系の設計をより簡単に設計することができ、 よりよい制御性能を実現することが できる。
5 ) 2 トルク補償部が第 2模擬トルクのみを利用することにより、 第 2 トルク捕 償部と下位制御部とのデータ通信の通信量を減らすことができると共に、 第 2 ト ルク補償部をよりシンプル的に構築することができるので、 同一処理機能を持つ プロセッサでより短い制御サンプル時間で電動機制御装置を実現することができ る。
6 ) 従来の電動機制御装置で上位制御部が下位制御と異なる制御サンプル時間で 構築された場合に制御に現れる振動やオーバーシュートを防ぐことができ、 より よレ、制御性能を実現することができる。
7 ) 模擬観測器を導入することによって、 実応答信号に含まれたノイズを減らす ことができるので、 上位制御部と下位制御部と第 2制御部との制御ゲインをより 大きく設定することができるので、 従来の電動機制御装置で上位制御部が下位制 御と異なる制御サンプル時間で構築された場合に制御に現れる振動やオーバーシ ユートを防ぐことができ、 よりよい制御性能を実現することができる。
8 ) 従来の上位制御部に模擬下位制御部と模擬信号処理器とを加えることによつ て、 下位制御部と機械システムとの特性を考慮した上位制御部を第 2制御サンプ ル時間で容易に実現すると共に、 従来の電動機制御装置で上位制御部が下位制御 と異なる制御サンプル時間で構築された場合に制御に現れる振動やオーバーシュ ートを防ぐことができ、 よりよい制御性能を実現することができる。
9 ) 模擬モデルと模擬下位制御部とを連続系並の特性を有するので、 模擬モデル と模擬下位制御部との各パラメータをより簡単に設定することができる。
1 0 ) 模擬モデルを剛体系で構築することによって、 機械システムの機械共振周 波数が高い場合、 模擬モデルをより簡単に実現できるので、 従来の電動機制御装 置で上位制御部が下位制御と異なる制御サンプル時間で構築された場合に制御に 現れる振動やオーバーシユートを防ぐことができると共に、 電動機制御装置にか かる計算量を減らすことができる。
1 1 ) 模擬下位制御部を P— P制御系で構築することによって、 模擬下位制御部 をより簡単に実現できる。 よって、 従来の電動機制御装置で上位制御部が下位制 御と異なる制御サンプル時間で構築された場合に制御に現れる振動やオーバーシ ユートを防ぐことができると共に、 電動機制御装置にかかる計算量を減らすこと ができる。
1 2 ) 模擬下位制御部のパラメータをより容易に設定することができる。
1 3 ) 上位コントローラを P— P制御系で構築することによって、 上位コント口 ーラをより簡単に実現できる。
1 4 ) 従来の電動機制御装置で上位制御部が下位制御と異なる制御サンプル時間 で構築された場合に制御に現れる振動やオーバーシュートを防ぐことができると 共に、 電動機制御装置にかかる計算量を減らすことができる。
1 5 ) 上位コントローラのパラメータをより容易に設定することができる。
1 6 ) 下位制御部を P— P制御系で構築することによって、 上位コントローラを より簡単に実現できる。
1 7 ) 従来の電動機制御装置で上位制御部が下位制御と異なる制御サンプル時間 で構築された場合に制御に現れる振動やオーバーシュートを防ぐことができると 共に、 電動機制御装置にかかる計算量を減らすことができる。
1 8 ) 下位制御部のパラメータをより容易に設定することができる。 さらに、 下 位制御部を考慮して上位制御部を構築するとき、 上位制御部の構成をよりシンプ ルにすることができる。 1 9 ) 第 1サンプル制御時間で更新される第 1模擬位置信号と第 1模擬速度信号 とを第 1サンプル制御時間と第 2サンプル制御時間との違いを考慮しながら、 第 2 4模擬信号と第 2 5模擬信号とを第 2サンプル制御時間で生成し、 従来の下位 制御部に入力することによって、 第 2模擬トルク信号を滑らかにすることができ る。
2 0 ) 従来の電動機制御装置で上位制御部が下位制御と異なる制御サンプル時間 で構築された場合に制御に現れる振動やオーバ一シユートを防ぐことができる。 2 1 ) 指令フィルタを加えることによって、 第 2模擬トルク信号に含まれている 振動成分を減らすことができると共に、 従来の電動機制御装置で上位制御部が下 位制御と異なる制御サンプル時間で構築された場合に制御に現れる振動やオーバ 一シュートを防ぐことができる。
2 2 ) 第 1サンプル制御時間で更新される第 1模擬トルク信号を第 1サンプル制 御時間と第 2サンプル制御時間との違いを考慮しながら、 第 2 7模擬信号を第 2 サンプル制御時間で生成し、 従来のトルク合成部に入力することによって、 トル ク指令を滑らかにすることができる。
2 3 ) 第 1 トルク補償器を P— P— I制御系で構築することによって、 従来の電 動機制御装置で上位制御部が下位制御と異なる制御サンプル時間で構築された場 合に制御制御性能に現れる振動やオーバーシュートを防ぐことができると共に、 電動機制御装置にかかる計算量を減らすことができる。
2 4 ) 第 1 トルク補償器のパラメータをより容易に設定することができる。
2 5 ) 第 2 トルク補償器を I制御系で構築することによって、 従来の電動機制御 装置で上位制御部が下位制御と異なる制御サンプル時間で構築された場合に制御 制御性能に現れる振動やオーバーシュートを防ぐことができると共に、 電動機制 御装置にかかる計算量を減らすことができる。
2 6 ) 第 2 トルク補償器のパラメータをより容易に設定することができる。
2 7 ) 複数のプロセッサで構成することによって、 従来の電動機制御装置で上位 制御部が下位制御と異なる制御サンプル時間で構築された場合に制御に現れる振 動やオーバーシュートを防ぐことができると共に、 本電動機制御装置の制御サン プル時間を大幅に減らすことができる,

Claims

請求の範囲
1 . 負荷機械 1と、 動力を伝達する伝達機構 2と、 前記伝達機構 2を介して前 記負荷機械 1を駆動する電動機 3と、 トルク指令 T r e f に基づいて前記電動機 3を駆動する電力を与える動力変換回路 4とを有する機械システム 5に対して、 前記機械システム 5を所望の動きとなるように、 前記動力変換回路 4に適正なト ルク指令 T r e f を与える電動機制御装置であって、
実指令信号 Θ r e f を提供する指令発生器 7と、
前記機械システム 5の状態量を観測し、 第 1制御サンプル時間 t 1で実応答信 号 θ πιを提供する実観測器 6と、
前記実指令信号 Θ r e f に基づいて、 第 1制御サンプル時間 t 1より大きな第 2制御サンプル時間 t 2で第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fと第 1 模擬トルク信号 T F Fとを提供する上位制御部 8と、
前記第 1模擬位置信号 Θ Fと前記第 1模擬速度信号 w Fと前記実応答信号 Θ m とに基づいて第 1制御サンプル時間 t 1で第 2模擬トルク信号 T F Bを提供する 下位制御部 9と、
前記第 1模擬位置信号 Θ Fと前記第 1模擬速度信号 w Fと前記実応答信号 Θ m とに基づいて第 2制御サンプル時間 t 2で第 3模擬トルク信号 T Dを提供する第
1 トルク補償部 1 1と、
前記第 1模擬トルク信号 T F Fと前記第 2模擬トルク信号 T F Bと前記第 3模 擬トルク信号 T Dに基づいて第 1制御サンプル時間 t 1でトルク指令 T r e f を 提供するトルク合成部 1 0と、
を備えたことを特徴とする電動機制御装置。
2 . 負荷機械 1 と、 動力を伝達する伝達機構 2と、 前記伝達機構 2を介して前 記負荷機械 1を駆動する電動機 3と、 トルク指令 T r e f に基づいて前記電動機 3を駆動する電力を与える動力変換回路 4とを有する機械システム 5に対して、 前記機械システム 5を所望の動きとなるように、 前記動力変換回路 4に適正なト ルク指令 T r e f を与える電動機制御装置であって、
実指令信号 Θ r e f を提供する指令発生器 7と、 前記機械システム 5の状態量を観測し、 第 1制御サンプル時間 t 1で実応答信 号 6 mを提供する実観測器 6と、
前記実指令信号 Θ r e f に基づいて、 第 1制御サンプル時間 t 1より大きな第 2制御サンプル時間 t 2で第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fと第 1 模擬トルク信号 T F Fとを提供する上位制御部 8と、
前記第 1模擬位置信号 Θ Fと前記第 1模擬速度信号 w Fと前記実応答信号 Θ m とに基づいて第 1制御サンプル時間 t 1で第 2模擬トルク信号 T F Bを提供する 下位制御部 9と、
前記第 2模擬トルク信号 T F Bに基づいて第 2制御サンプル時間 t 2で第 3模 擬トルク信号 T Dを提供する第 2 トルク補償部 1 1と、
前記第 1模擬トルク信号 T F Fと前記第 2模擬トルク信号 T F Bと前記第 3模 擬トルク信号 T Dに基づいて第 1制御サンプル時間 t 1でトルク指令 T r e f を 提供するトルク合成部 1 0と、
を備えたことを特徴とする電動機制御装置。
3 . 負荷機械 1 と、 動力を伝達する伝達機構 2と、 前記伝達機構 2を介して前 記負荷機械 1を駆動する電動機 3と、 トルク指令 T r e f に基づいて前記電動機 3を駆動する電力を与える動力変換回路 4とを有する機械システム 5に対して、 前記機械システム 5を所望の動きとなるように、 前記動力変換回路 4に適正なト ルク指令 T r e f を与える電動機制御装置であって、
実指令信号 Θ r e f を提供する指令発生器 7と、
前記機械システム 5の状態量を観測し、 第 1制御サンプル時間 t 1で実応答信 号 0 mを提供する実観測器 6と、
前記実指令信号 Θ r e f に基づいて、 第 1制御サンプル時間 t 1より大きな第 2制御サンプル時間 t 2で第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fと第 1 模擬トルク信号 T F Fとを提供する上位制御部 8と、
トルク指令 T r e f と前記実応答信号 Θ mとに基づいて第 1制御サンプル時間 t 1で推定位置信号 S m hと推定速度信号 w m hとを提供する模擬観測器 1 3と、 前記第 1模擬位置信号 Θ Fと前記第 1模擬速度信号 w Fと前記推定位置信号 Θ m hと前記推定速度信号 wm hとに基づいて第 1制御サンプル時間 t 1で第 2模擬 トルク信号 T F Bを提供する下位制御部 1 4と、
前記第 2模擬トルク信号 T F Bに基づいて第 2制御サンプル時間 t 2で第 3模 擬トルク信号 T Dを提供する第 2 トルク補償部 1 2と、
前記第 1模擬トルク信号 T F Fと前記第 2模擬トルク信号 T F Bと前記第 3模 擬トルク信号 T Dに基づいて第 1制御サンプル時間 t 1でトルク指令 T r e f を 提供するトルク合成部 1 0と、
を備えたことを特徴とする電動機制御装置。
4 . 前記上位制御部 8が
前記実指令信号 Θ r e f と第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fとに 基づいて第 1模擬トルク信号 T F Fを提供する上位コントローラ 8 aと、
第 1模擬位置信号 Θ Fと第 1 '模擬速度信号 w Fとに基づいて第 4模擬信号 S I 4を提供する模擬下位制御部 8 bと、
前記第 1模擬トルク信号 T F Fと前記第 4模擬信号 S I 4とに基づいて第 1模 擬信号 S I 1を提供する加算器 8 dと、
前記第 1模擬信号 S I 1に基づいて第 2模擬信号 S I 2と第 3模擬信号 S I 3 とを提供する模擬モデル 8 cと、
前記第 2模擬信号 S I 2と前記第 3模擬信号 S I 3とに基づいて第 2制御サン プル時間 t 2で第 1模擬位置信号 Θ Fと第 1模擬速度信号 w Fとを提供する模擬 信号処理器 8 eと
を備えたことを特徴とする請求項 1から 3のう'ちいずれか 1項に記載の電動機制 御装置。
5 . 前記模擬モデル 8 cが
前記第 1模擬信号 S I 1と第 2模擬信号 S I 2とに基づいて第 3 2模擬信号 S I 3 2を提供する減算器 8 c 4と、
前記第 3 2模擬信号 S I 3 2に基づいて第 2 9模擬信号 S I 2 9を提供する係 数器 8 c 5と、
前記第 2 9模擬信号 S I 2 9と第 3模擬信号 S I 3とに基づいて第 3 0模擬信 号 S I 3 0を提供する減算器 8 c 6と、
前記第 3 0模擬信号 S I 3 0に基づいて第 3 1模擬信号 S I 3 1を提供する係 数器 8 c 7と、
前記第 3 1模擬信号 S I 3 1に基づいて第 2 8模擬信号 S I 2 8を提供する係 数器 8 c 1と、
前記第 2 8模擬信号 S I 2 8に基づいて第 3模擬信号 S I 3を提供する積分器 8 c 2と、
前記第 3模擬信号 S I 3に基づいて第 2模擬信号 S I 2を提供する積分器 8 c 3と
を備えたことを特徴とする請求項 1から 4のうちいずれか 1項に記載の電動機制
6 . 前記模擬下位制御部 8 bが、
前記第 1模擬位置信号 Θ Fに基づいて第 5模擬信号 S I 5を提供する係数器 8 b 1と、
前記第 5模擬信号 S I 5と前記第 1模擬速度信号 w Fとに基づいて第 6模擬信 号 S I 6を提供する加算器 8 b 2と、
前記第 6模擬信号 S I 6に基づいて第 4模擬信号 S I 4を提供する係数器 8 b 3と
を備えたことを特徴とする請求項 1から 5のうちいずれか 1項に記載の電動機制 御装置。
7 . 前記上位コントローラ 8 aが、
前記実指令信号 Θ r e f と前記第 1模擬位置信号 Θ Fとに基づいて第 7模擬信 号 S I 7を提供する減算器 8 a 4と、
前記第 7模擬信号 S I 7に基づいて第 8模擬信号 S I 8を提供する係数器 8 a 1と、
前記第 1模擬速度信号 w Fと前記第 8模擬信号 S I 8とに基づいて第 9模擬信 号 S I 9を提供する減算器 8 a 2と、
前記第 9模擬信号 S I 9に基づいて第 1模擬トルク信号 T F Fを提供する係数 器 8 a 3と
を備えたことを特徴とする請求項 1から 6のうちいずれか 1項に記載の電動機制
8 . 前記下位制御部 9が、
前記第 1模擬位置信号 Θ Fと前記実応答信号 Θ mとに基づいて第 2 0模擬信号 S I 2 0を提供する減算器 9 aと、
前記第 2 0模擬信号 S I 2 0に基づいて第 2 1模擬信号 S I 2 1を提供する係 数器 9 bと、
前記実応答信号 Θ mに基づいて第 1制御サンプル時間 t 1で第 2 2模擬信号 S I 2 2を提供する差分器 9 eと、
前記第 2 1模擬信号 S I 2 1と前記第 2 2模擬信号 S I 2 2と前記第 1模擬速 度信号 w Fとに基づいて第 2 3模擬信号 S I 2 3を提供する加減算器 9 cと、 前記第 2 3模擬信号 S I 2 3に基づいて第 2模擬トルク信号 T F Bを提供する係 数器 9 dと
を備えたことを特徴とする請求項 1、 請求項 2、 請求項 4から 7のうちいずれか 1項に記載の電動機制御装置。
9 . 前記下位制御部 1 4が、
前記第 1模擬位置信号 Θ Fと前記推定位置信号 Θ m hとに基づいて第 2 0模擬 信号 S I 2 0を提供する減算器 9 aと、
前記第 2 0模擬信号 S I 2 0に基づいて第 2 1模擬信号 S I 2 1を提供する係 数器 9 bと、
前記第 2 1模擬信号 S I 2 1と前記第 1模擬速度信号 w Fと前記推定速度信号 w m hとに基づいて第 2 3模擬信号 S I 2 3を提供する加減算器 9 cと、
前記第 2 3模擬信号 S I 2 3に基づいて第 2模擬トルク信号 T F Bを提供する 係数器 9 dと
を備えたことを特徴とする請求項 3から 7のうちいずれか 1項に記載の電動機制
0 . 前記下位制御部 9が、 前記第 1模擬位置信号 Θ Fに基づいて第 1制御サンプル時間 t 1で第 2 4模擬 信号 S I 2 4を提供する指令捕償器 9 f と、
前記第 1模擬速度信号 w Fに基づいて第 1制御サンプル時間 t 1で第 2 5模擬 信号 S I 2 5を提供する指令補償器 9 gと、
前記第 2 4模擬信号 S I 2 4と前記実応答信号 Θ mとに基づいて第 2 0模擬信 号 S I 2 0を提供する減算器 9 aと、
前記第 2 0模擬信号 S I 2 0に基づいて第 2 1模擬信号 S I 2 1を提供する係 数器 9 bと、
前記実応答信号 Θ mに基づいて第 1制御サンプル時間 t 1で第 2 2模擬信号 S I 2 2を提供する差分器 9 eと、
前記第 2 1模擬信号 S I 2 1と前記第 2 2模擬信号 S I 2 2と前記第 2 5模擬 信号 S I 2 5とに基づいて第 2 3模擬信号 S I 2 3を提供する加減算器 9 cと、 前記第 2 3模擬信号 S I 2 3に基づいて第 2模擬トルク信号 T F Bを提供する 係数器 9 dと
を備えたことを特徴とする請求項 1、 請求項 2、 請求項 4から 7のうちいずれか 1項に記載の電動機制御装置。
1 1 . 前記下位制御部 1 4が、
前記第 1模擬位置信号 Θ Fに基づいて第 1制御サンプル時間 t 1で第 2 4模擬 信号 S I 2 4を提供する指令補償器 9 f と、
前記第 1模擬速度信号 w Fに基づいて第 1制御サンプル時間 t 1で第 2 5模擬 信号 S I 2 5を提供する指令補償器 9 gと、
前記第 2 4模擬信号 S I 2 4と前記推定位置信号 0 m hとに基づいて第 2 0模 擬信号 S I 2 0を提供する減算器 9 aと、
前記第 2 0模擬信号 S I 2 0に基づいて第 2 1模擬信号 S I 2 1を提供する係 数器 9 bと、
前記第 2 1模擬信号 S I 2 1と前記推定速度信号 w m hと前記第 2 5模擬信号 S I 2 5とに基づいて第 2 3模擬信号 S I 2 3を提供する加減算器 9 cと、 前記第 2 3模擬信号 S I 2 3に基づいて第 2模擬トルク信号 T F Bを提供する係 数器 9 dと
を備えたことを特徴とする請求項 3から 7のうちいずれか 1項に記載の電動機制 御装置。
1 2. 前記トルク合成部 1 0が、
前記第 2模擬トルク信号 TFBに基づいて第 26模擬信号 S I 26を提供する 指令フィルタ 1 0 bと、
前記第 26模擬信号 S I 26と前記第 1模擬トルク信号 TF Fと前記第 3模擬 トルク信号 TDとに基づいてトルク指令 T r e f を提供する加算器 1 0 aと を備えたことを特徴とする請求項 1から 1 1のうちいずれか 1項に記載の電動機 制御装置。
1 3. 前記トルク合成部 1 0が、
前記第 2模擬トルク信号 TFBに基づいて第 26模擬信号 S I 26を提供する 指令フィルタ 1 0 bと、
前記第 1模擬トルク信号 T F Fに基づいて第 1制御サンプル時間 t 1で第2 7 模擬信号 S I 2 7を提供する指令補償器 1 0 cと、
前記第 26模擬信号 S I 26と前記第 3模擬トルク信号 TDと前記第 27模擬 信号 S I 27とに基づいてトルク指令 T r e f を提供する加算器 10 aと を備えたことを特徴とする請求項 1から 1 1のうちいずれか 1項に記載の電動機 制御装置。
14. 前記第 1 トルク補償部 1 1が、
前記実応答信号 θπιと第 1模擬位置信号 Θ Fとに基づいて第 1 0模擬信号 S I 1 0を提供する減算器 1 1 aと、
前記第 1 0模擬信号 S I 1 0に基づいて第 1 2模擬信号 S I 1 2を提供する係 数器 1 1 bと、 ' 前記実応答信号 0 mに基づいて第 2制御サンプル時間 t 2で第 1 1模擬信号 S I 1 1を提供する差分器 1 1 dと、
前記第 1 2模擬信号 S I 1 2と前記第 1 1模擬信号 S I 1 1と前記第 1模擬速 度信号 wFとに基づいて第 1 3模擬信号 S I 1 3を提供する加減算器 1 1 f と、 前記第 1 3模擬信号 S I 1 3に基づいて第 1 4模擬信号 S I 1 4を提供する係 1 cと、
前記第 1 4模擬信号 S I 1 4に基づいて第 2制御サンプル時間 t 2で第 3模擬 トルク信号 T Dを提供する離散化積分器 1 1 eと
を備えたことを特徴とする請求項 1、 請求項 4から 8、 請求項 1 0、 請求項 1 2、 請求項 1 3のうちいずれか 1項に記載の電動機制御装置。
1 5 . 前記第 2 トルク補償部 1 2が、
前記第 2模擬トルク信号 T F Bに基づいて第 2制御サンプル時間 t 2で第 3模 擬トルク信号 T Dを提供する離散化積分器 1 2 a
から構成されることを特徴とする請求項 2から 6、 請求項 9、 請求項 1 1〜 1 3 のうちいずれか 1項に記載の電動機制御装置。
1 6 . 前記上位制御部 8と、 前記第 1 トルク補償部 1 1と、 前記下位制御部 9 と、 前記トルク合成部 1 0とが複数のプロセッサで構成される手段を備えたこと を特徴とする請求項 1、 請求項 4から 8、 請求項 1 0、 請求項 1 2から 1 4のう ちいずれか 1項に記載の電動機制御装置。
1 7 . 前記上位制御部 8と、 前記第 2 トルク捕償部 1 2と、
前記下位制御部 9と、 前記トルク合成部 1 0とが複数のプロセッサで構成される 手段を備えたことを特徴とする請求項 2、 請求項 4から 8、 請求項 1 0、 請求項 1 2、 請求項 1 3、 請求項 1 5のうちいずれか 1項に記載の電動機制御装置。
1 8 . 前記上位制御部 8と、 前記第 2 トルク補償部 1 2と、 前記模擬観測器 1 3と、 前記下位制御部 1 4と、 前記トルク合成部 1 0とが複数のプロセッサで構 成される手段を備えたことを特徴とする請求項 3から 7、 9、 請求項 1 1から 1 3、 請求項 1 5のうちいずれか 1項に記載の電動機制御装置。
PCT/JP2001/006682 2000-08-08 2001-08-03 Dispositif de commande de moteur electrique Ceased WO2002013368A1 (fr)

Priority Applications (3)

Application Number Priority Date Filing Date Title
US10/343,955 US6873132B2 (en) 2000-08-08 2001-08-03 Electric motor control device
KR1020037001756A KR100740623B1 (ko) 2000-08-08 2001-08-03 전동기제어장치
EP01954423A EP1313207A1 (en) 2000-08-08 2001-08-03 Electric motor control device

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2000-239786 2000-08-08
JP2000239786A JP4654493B2 (ja) 2000-08-08 2000-08-08 電動機制御装置

Publications (1)

Publication Number Publication Date
WO2002013368A1 true WO2002013368A1 (fr) 2002-02-14

Family

ID=18731265

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2001/006682 Ceased WO2002013368A1 (fr) 2000-08-08 2001-08-03 Dispositif de commande de moteur electrique

Country Status (6)

Country Link
US (1) US6873132B2 (ja)
EP (1) EP1313207A1 (ja)
JP (1) JP4654493B2 (ja)
KR (1) KR100740623B1 (ja)
CN (1) CN1297063C (ja)
WO (1) WO2002013368A1 (ja)

Families Citing this family (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007506397A (ja) * 2003-09-15 2007-03-15 シーメンス　アクチエンゲゼルシヤフト 電動機の制御方法及び装置
CA2587717C (en) * 2004-11-17 2015-03-31 Toyota Technical Development Corporation Computing method of motor model, motor simulation method, motor simulation apparatus, motor-model computing program, simulation method and simulation program
US7262575B2 (en) * 2004-12-01 2007-08-28 Bio-Rad Laboratories, Inc. Method and apparatus for precise positioning of an object with linear stepper motors
JP2007112024A (ja) * 2005-10-20 2007-05-10 Mitsubishi Heavy Ind Ltd コルゲータの制御装置及び方法
JP4540727B2 (ja) * 2008-07-31 2010-09-08 山洋電気株式会社 モータ制御装置
JP4231544B1 (ja) * 2008-08-22 2009-03-04 山洋電気株式会社 モータ制御装置
RU2464696C1 (ru) * 2011-08-19 2012-10-20 Государственное образовательное учреждение высшего профессионального образования "Кубанский государственный технологический университет" (ГОУВПО КубГТУ) Программно-управляемый позиционный электропривод с улучшенными характеристиками на базе инерционного преобразователя при упругом валопроводе
CN103999000A (zh) 2011-11-12 2014-08-20 国际计测器株式会社 控制程序、控制方法及控制装置
US8901869B2 (en) * 2012-07-31 2014-12-02 Caterpillar Inc. Hybrid closed loop speed control using open look position for electrical machines controls
JP5943875B2 (ja) * 2013-05-09 2016-07-05 三菱電機株式会社 モータ制御装置
JP6106582B2 (ja) * 2013-12-09 2017-04-05 山洋電気株式会社 モータ制御装置
CN108012576B (zh) * 2016-01-22 2021-04-20 东芝三菱电机产业系统株式会社 电动机的速度控制装置
JP6409803B2 (ja) * 2016-03-14 2018-10-24 オムロン株式会社 シミュレーション装置、シミュレーション方法、制御プログラム、および記録媒体
JP6515844B2 (ja) * 2016-03-14 2019-05-22 オムロン株式会社 シミュレーション装置、シミュレーション方法、制御プログラム、および記録媒体
JP6502916B2 (ja) * 2016-11-17 2019-04-17 ミネベアミツミ株式会社 モータ駆動制御装置及びモータ駆動制御方法
US11086281B2 (en) 2017-11-14 2021-08-10 Rockwell Automation Technologies, Inc. Method and apparatus for online simulation of complex motion systems
CN108638062B (zh) * 2018-05-09 2021-08-13 科沃斯商用机器人有限公司 机器人定位方法、装置、定位设备及存储介质
CN110829355B (zh) * 2019-11-29 2021-06-22 郑州工程技术学院 一种机械设备过载保护装置
JP7363839B2 (ja) * 2021-03-09 2023-10-18 横河電機株式会社 制御装置、制御方法、および、制御プログラム

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05236777A (ja) * 1992-02-24 1993-09-10 Fujitsu General Ltd 空気調和機の制御装置
JPH10337070A (ja) * 1997-06-03 1998-12-18 Fuji Electric Co Ltd 電動機の速度制御装置
US5874821A (en) * 1994-10-21 1999-02-23 Agie Sa Method and apparatus for controlling a brushless electro motor by determining the absolute phase position of the rotor relative to the stator
US6008618A (en) * 1997-11-26 1999-12-28 General Motors Corporation Zero speed start-up for a speed sensorless induction motor drive
JP2000092881A (ja) * 1998-09-18 2000-03-31 Yaskawa Electric Corp 電動機制御装置

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2919852A1 (de) * 1979-05-16 1980-12-04 Siemens Ag Lastzustandsregelung einer umrichtergespeisten asynchronmaschine
JP3084928B2 (ja) * 1992-05-29 2000-09-04 三菱電機株式会社 電動機の位置制御装置
US5461293A (en) * 1993-05-12 1995-10-24 Sundstrand Corporation Rotor position detector
JPH07298698A (ja) * 1994-04-21 1995-11-10 Hitachi Ltd 誘導モータの制御装置
JP3288184B2 (ja) * 1994-10-05 2002-06-04 三菱電機株式会社 電動機の制御装置
JP3687185B2 (ja) * 1996-03-31 2005-08-24 マツダ株式会社 自動変速機の制御装置
US5729113A (en) * 1997-01-21 1998-03-17 General Electric Company Sensorless rotor velocity estimation for induction motors

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05236777A (ja) * 1992-02-24 1993-09-10 Fujitsu General Ltd 空気調和機の制御装置
US5874821A (en) * 1994-10-21 1999-02-23 Agie Sa Method and apparatus for controlling a brushless electro motor by determining the absolute phase position of the rotor relative to the stator
JPH10337070A (ja) * 1997-06-03 1998-12-18 Fuji Electric Co Ltd 電動機の速度制御装置
US6008618A (en) * 1997-11-26 1999-12-28 General Motors Corporation Zero speed start-up for a speed sensorless induction motor drive
JP2000092881A (ja) * 1998-09-18 2000-03-31 Yaskawa Electric Corp 電動機制御装置

Also Published As

Publication number Publication date
KR100740623B1 (ko) 2007-07-18
EP1313207A1 (en) 2003-05-21
JP2002058270A (ja) 2002-02-22
CN1529932A (zh) 2004-09-15
JP4654493B2 (ja) 2011-03-23
US6873132B2 (en) 2005-03-29
CN1297063C (zh) 2007-01-24
US20040090198A1 (en) 2004-05-13
KR20030021262A (ko) 2003-03-12

Similar Documents

Publication Publication Date Title
WO2002013368A1 (fr) Dispositif de commande de moteur electrique
JP3084928B2 (ja) 電動機の位置制御装置
JP5496365B2 (ja) モータ制御装置
JP3274070B2 (ja) 電動機制御方法及び電動機制御装置
EP1560325B1 (en) Position controller of motor
WO2006011519A1 (ja) サーボ制御装置
JP3404388B2 (ja) 電動機制御方法
JP2009237916A (ja) サーボ制御装置
JP2019008707A (ja) サーボ制御装置、サーボ制御方法及びシステム
JP2002176791A (ja) 電動機制御装置
Mingji et al. Adaptive position servo control of permanent magnet synchronous motor
JP3229926B2 (ja) 電動機の位置制御装置
Ali et al. The effect of parameters variation on bilateral controller
JP2002354857A (ja) 電動機制御装置
JP3656745B2 (ja) 電動機位置制御装置
JP2007336687A (ja) モータ制御装置
CN109656150B (zh) 基于matlab的复合轴控制系统偏差高精度控制方法
WO2020255724A1 (ja) ロボット制御装置及びロボット制御方法
JP2003189660A (ja) 電動機位置制御装置
Nagatsu et al. Force Control in Time-delay Systems Based on Equivalent Torsional and Elastic Forces Feedback
JP7586782B2 (ja) モータ制御装置
Sasaki et al. 3D vibration control of flexible manipulator by inverse systems using inner and outer decomposition
JP2003241802A (ja) 最適指令作成装置
WO2004034163A1 (ja) 最適指令作成装置
JP2024082155A (ja) ３相交流電動機の制御装置

Legal Events

Date Code Title Description
AK Designated states

Kind code of ref document: A1

Designated state(s): CN KR US

AL Designated countries for regional patents

Kind code of ref document: A1

Designated state(s): AT BE CH CY DE DK ES FI FR GB GR IE IT LU MC NL PT SE TR

121 Ep: the epo has been informed by wipo that ep was designated in this application
DFPE Request for preliminary examination filed prior to expiration of 19th month from priority date (pct application filed before 20040101)
WWE Wipo information: entry into national phase

Ref document number: 10343955

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 2001954423

Country of ref document: EP

WWE Wipo information: entry into national phase

Ref document number: 1020037001756

Country of ref document: KR

WWP Wipo information: published in national office

Ref document number: 1020037001756

Country of ref document: KR

WWE Wipo information: entry into national phase

Ref document number: 018170161

Country of ref document: CN

WWP Wipo information: published in national office

Ref document number: 2001954423

Country of ref document: EP

WWW Wipo information: withdrawn in national office

Ref document number: 2001954423

Country of ref document: EP