This application is based upon and claims the benefit of priority from the prior Japanese Patent Application No. 2015-123607, filed on Jun. 19, 2015, the entire contents of which are incorporated herein by reference.
1. Technical Field
The disclosure relates to a drive control device configured to drive a motor.
2. Related Art
A drive control device configured to drive a motor by performing pulse width modulation (PWM) control is known.
Japanese Unexamined Patent Application Publication No. 2014-165982 proposes a drive control device having a motor rotation speed negative feedback loop (primary feedback element) and a motor current negative feedback loop (secondary feedback element).
In normal PWM control, a relationship between a duty-ratio of a PWM signal and a voltage or current is non-linear. Accordingly, the voltage and current cannot be directly converted to the duty ratio of the PWM signal. Hence, the drive control device has the motor current negative feedback loop which detects the current flowing in the motor and causes the duty ratio of the PWM signal to follow the current and converge.
A current detector is required to form the motor current negative feedback loop described above. Moreover, in a case where digital processing is needed, an AD converter is also required. Accordingly, the hardware configuration of the drive control device is complex.
An object of the disclosure is to provide a drive control device in which the hardware configuration can be simplified.
A drive control device in accordance with some embodiments includes a processor and a memory including instructions that, when executed by the processor, cause the processor to perform operations. The operations include: comparing a rotation speed of a motor driven by a PWM control of a synchronous rectification type and a target value of the rotation speed and calculating an error speed; calculating a torque required in the motor based on the calculated error speed; calculating a drive voltage of the motor in the synchronous rectification type based on the calculated torque, the rotation speed of the motor, and an electrical specification of the motor; and setting a duty ratio of a PWM signal in the synchronous rectification type based on the calculated drive voltage.
According to the aforementioned configuration, the duty ratio corresponding to the error speed can be thereby set without forming a motor current negative feedback loop. Accordingly, it is possible to omit a current detector and an AD converter for forming the motor current negative feedback loop and simplify the hardware configuration.
The electrical specification of the motor may include an inductance of the motor.
According to the configuration described above, a decrease in response performance clue to integral delay of a current caused by the inductance can be suppressed.
The operations may further include: generating a carrier-signal; and generating a PWM signal with the set duty ratio by comparing the generated carrier signal and a PWM setting value corresponding to the drive voltage.
According to the configuration described above, the PWM signal can be generated in a short time. As a result, highly-accurate rotation speed control and quick response to a target speed command is made possible.
In the following detailed description, for purposes of explanation, numerous specific details are set forth in order to provide a thorough understanding of the disclosed embodiments. It will be apparent, however, that one or more embodiments may be practiced without these specific details. In other instances, well-known structures and devices are schematically shown in order to simplify the drawing.
Description will be hereinbelow provided for embodiments of the present invention by referring to the drawings. It should be noted that the same or similar parts and components throughout the drawings will be denoted by the same or similar reference signs, and that descriptions for such parts and components will be omitted or simplified. In addition, it should be noted that the drawings are schematic and therefore different from the actual ones.
The embedded microcomputer 2 controls the driver 3 by PWM control of a synchronous rectification type. The embedded microcomputer 2 includes a device-embedded digital signal processor (DSP), a central processing unit (CPU), and a storage formed of a semiconductor memory and the like. The storage stores instructions that, when executed by a processor of the DSP or the CPU, cause the processor to perform operations explained below. The storage may be provided outside the embedded microcomputer 2. The embedded microcomputer 2 includes a speed setter 11, a speed comparator 12, a PID adjuster (torque calculator) 13, a drive-voltage duty-ratio calculator (drive voltage calculator, duty ratio calculator) 14, a carrier signal generator 15, a simple PWM generator (PWM generator) 16, a capture unit 17, and a rotation speed detector 18.
The speed setter 11, the speed comparator 12, the PID adjuster 13, the drive-voltage duty-ratio calculator 14, the carrier signal generator 15, the capture unit 17, and the rotation speed detector 18 are implemented by firmware (software) in the embedded microcomputer 2. The simple PWM generator 16 is a unit built in the embedded micro computer 2 as hardware.
The speed setter 11 outputs a target speed command indicating a target value of a rotation speed of the motor 6 to the speed comparator 12. The target value is inputted into the speed setter 11 from the outside.
The speed comparator 12 compares the rotation speed of the motor 6 and the target value and calculates an error speed which is the difference therebetween. The rotation speed of the motor 6 is inputted from the rotation speed detector 18 into the speed comparator 12.
The PID adjuster 13 calculates a torque required in the motor 6 to set the rotation speed of the motor 6 to the target value, based on the error speed by means of PID calculation.
The drive-voltage duty-ratio calculator 14 calculates a drive voltage of the motor 6 in the synchronous rectification type, based on the torque calculated by the PID adjuster 13, the rotation speed of the motor 6, and the electrical specification of the motor 6. Moreover, the drive-voltage duty-ratio calculator 14 sets a duty ratio of a PWM signal in the synchronous rectification type, based on the calculated drive voltage. Furthermore, the drive-voltage duty-ratio calculator 14 calculates a PWM setting value corresponding to the calculated drive voltage and outputs the PWM setting value to a comparator 19 of the simple PWM generator 16.
The carrier signal generator 15 generates a saw-tooth wave or triangle wave carrier signal of a predetermined cycle and outputs the carrier signal to the simple PWM generator 16.
The simple PWM generator 16 generates a rectangle wave PWM signal and outputs the PWM signal to the driver 3. The simple PWM generator 16 has the comparator 19. The comparator 19 generates a PWM signal with the set duty ratio by comparing the carrier signal and the PWM setting value. The comparator 19 outputs the PWM signal with the set duty ratio to a switch element SW1 of the driver 3 to be described later, and outputs a PWM signal with the opposite phase to the PWM signal outputted to the switch element SW1, to a switch element SW2.
The capture unit 17 obtains a pulse signal outputted from the speed detector 5 and corresponding to the rotation angle of the motor 6, and measures the cycle of the pulse signal.
The rotation speed detector 18 calculates the rotation speed of the motor 6 based on the cycle of the pulse signal measured by the capture unit 17. The rotation speed detector 18 outputs the calculated rotation speed to the speed comparator 12.
The driver 3 drives the motor 6 by using a PWM signal inputted from the embedded microcomputer 2. The driver 3 includes a predriver 21 and an H-bridge circuit 22.
The predriver 21 connects the comparator 19 of the simple PWM generator 16 to the switch elements SW1, SW2 of the H-bridge circuit 22. The PWM signals outputted from, the comparator 19 and having phases opposite to each other are inputted respectively into the switch elements SW1, SW2 via the predriver 21.
The H-bridge circuit 22 includes four switch elements SW1 to SW4. The switch elements SW1, SW2 are connected in series between a power supply voltage terminal P and a ground terminal in a line connected to one terminal of the motor 6. Meanwhile, the switch elements SW3, SW4 are connected in series between the power supply voltage terminal P and the ground terminal in a line connected to another terminal of the motor 6. In the H bridge circuit 22, the switch elements SW1, SW4 located on a diagonal form one pair and the switch elements SW2, SW3 located on a diagonal form another pair. For example, in an H (high) period of the PWM signal inputted into the switch element SW1, the switch elements SW1, SW4 are set to an on state. In this case, the PWM signal inputted in the switch element SW2 is in an L (low) period, and the switch elements SW2, SW3 are set to an off state.
The power supply 4 supplies voltage to the driver 3. The power supply 4 is connected to the power supply voltage terminal P of the H-bridge circuit 22.
The speed detector 5 outputs the pulse signal corresponding to the rotation angle of the motor 6. The speed detector 5 is formed of, for example, a rotary encoder.
In control performed by the aforementioned drive control device 1, the PID adjuster 13, the drive-voltage duty-ratio calculator 14, the carrier signal generator 15, the simple PWM generator 16, and the driver 3 form, a control element. A control target is an electrical system including the motor 6 and an entire mechanical system. The controlled variable is the rotation speed of the motor 6. The speed detector 5, the capture unit 17, and the rotation speed detector 18 form a feedback element (negative feedback loop of the rotation speed of the motor).
Next, the control target in the control of the drive control device 1 is described.
First, the control target in the mechanical system is described.
The control target in the mechanical system includes, for example, a sheet conveyer 31 provided in a printing device as illustrated in
As illustrated in
Note that, as illustrated in
Tm(t)=Jm·dωm(t)/dt+Wq·ωm(t)+To (1)
ωm [rad/sec]: angular speed
Tm [N·m]: supplied torque
Jm [Kg·m2]: moment of inertia
Wq [N·m/(rad/sec)] viscous load resistance
To [N·m]: friction load torque.
When the formula (1) is Laplace-transformed into an S function expression, the following formula (2) is obtained.
Tm(s)=Jm·S·ωm(s)+Wq·ωm(s)+To (2).
Accordingly, an angular speed (rotation speed) ωm(s) can be obtained from the following formula (3).
ωm(s)=(Tm(s)−To)/(Jm−S+Wq) (3).
Next, the control target in the electrical system is described.
The control target in the electrical system is the motor 6. The motor 6 which is a DC motor can be expressed by an equivalent circuit as illustrated in
Vpm [V]: inter-terminal voltage (PWM voltage supplied to the motor)
Ve [V]: reverse induced voltage (voltage generated by rotation of the motor itself)
KE [V/(rad/sec)]: induced voltage constant (constant for converting the rotation speed to the induced voltage)
La [H]: armature winding inductance
Ra [Ω]: armature winding resistance
Im [A]: armature winding current
Kt [N·m/A]: torque constant (constant for converting a current to torque)
Tm [N·m]: generated torque
ωm [rad/sec]: angular speed.
In the equivalent circuit illustrated in
Vpm(t)=La·dIm(t)/dt+Ra·Im(t)+Ve(t) (4)
Ve(t)=KE·ωm(t) (5)
Tm(t)=KT·Im(t) (6).
The following formulae (7) to (9) are obtained by Laplace-transforming the formulae (4) to (6) into S-function expression.
Vpm(s)=La·S·Im(s)+Ra−Im(s)+Ve(s) (7)
Ve(s)=KE·ωm(s) (8)
ωm(s)=KT·Im(s) (9).
From the formulae (7) and (8) , the armature winding current Im(s) is expressed by the following formula (10).
Im(s)=(Vpm(s)−KE·ωm(s) )/La·S+Ra) (10).
Next, an operation of the rotation speed control in the drive control device 1 is described by using the block line diagram of
In
A block 62 performs appropriate gain adjustment for each PID element based on the equation of motion in the aforementioned formula (1) for the error speed ωm(s) inputted from the summing point 61, and calculates a torque Tm′(s) required to set the rotation speed of the motor 6 to the target value ωr(s). In this case, Kd is a differential (acceleration) gain. Kp is a proportional (speed) gain. Ki is an integral (displacement) gain. The calculation of the block 62 corresponds to processing by the PID adjuster 13 in
A block 63 calculates a drive voltage Vpm(s)′ of the motor 6 in the synchronous rectification type, based on the torque Tm′(s) inputted from the block 62, the angular speed ωm(s) of the motor 6, and the electrical specification (electrical parameter) of the motor 6. The armature winding inductance La, the armature winding resistance Ra, the torque constant KT, and the induced voltage constant KE are used as the electrical parameters of the motor 6. The drive voltage Vpm(s)′ is calculated by using the following formula (11).
The current Im(s)′ to flow through the motor 6 is calculated by using the following formula (12).
Im(s)′=Tm′(s)/KT (12).
The calculation of the block 63 corresponds to part of the processing by the drive-voltage duty-ratio calculator 14 of
A block 64 calculates a PWM setting value Vpm(s)″ corresponding to the drive voltage Vpm(s)′ inputted from the block 63. The PWM setting value Vpm(s)″ is used to generate the PWM signal with the simple PWM generator 16 of
Vpm(s)″=Vpm(s)′/2+Vps(s)/2 (13).
In this formula, Vps is a drive power supply voltage of the power supply 4 of
In a block 65, the duty ratio of the PWM signal corresponding to the drive voltage Vpm(s)′ is set and the motor 6 is driven by using the PWM signal with the set duty ratio. The duty ratio of the PWM signal (PWM_Duty) is calculated from the following formula (14).
PWM_Duty [%]=(Vpm(s)′+Vps(s))·100/2·Vps(s) (14).
It is known that, in the synchronous rectification type, the average value of the drive voltage of the motor and the duty ratio of the PWM signal are proportional to each other. Moreover, when the duty ratio is 50%, the average value of the drive voltage is zero and the motor is in a stop state. When the duty ratio is greater than 50%, the average value of the drive voltage is a positive value. When the duty ratio is less than 50%, the average value of the drive voltage is a negative value. The motor can be thereby rotated, in a forward direction and a reverse direction.
The drive voltage Vpm(s)′ calculated by using the formula (11) is a value between −Vps(s) and +Vps(s). When Vpm(s)′=Vps(s), the duty ratio is 100%. When Vpm(s)′=−Vps(s), the duty ratio is 0%. When Vpm(s)′=0, the duty ratio is 50%. Moreover, from the aforementioned characteristic of the synchronous rectification type, the drive voltage Vpm(s)′ and the duty ratio are proportional. Based on this fact, the duty ratio of the PWM signal corresponding to the drive voltage Vpm(s)′ is calculated from the formula (14).
The processing of the block 65 corresponds to the processing of part of the drive-voltage duty-ratio calculator 14, the carrier signal generator 15, the simple PWM generator 16, and the driver 3 of
The inter-terminal voltage Vpm(s) of the motor 6 is controlled by the aforementioned control to be set equal to the drive voltage Vpm(s)′ which is calculated by the block 63 and which is used to set the rotation speed of the motor 6 to the target value ωr(s). The torque Tm(s) generated in the motor 6 by the drive at the drive voltage Vpm(s)′ becomes equal to the torque Tm′(s) calculated in the block 62. Moreover, the current (armature winding current) Im(s) flowing in the motor 6 becomes equal to the current Im(s)′ calculated from Tm′(s).
Next, an Algol (Algorithmic Language) of the rotation speed control in the drive control device 1 is described by using
In
A subtractor 72 subtracts an error speed, ωe(z) subjected to unit delay in a delayer 73 from the error speed ωe(z) inputted from the subtractor 71.
A differential calculator 74 calculates a differential torque Td(z) by multiplying the calculation result of the subtractor 72 by the differential gain Kd.
A proportion calculator 75 calculates a proportional torque Tp(z) by multiplying the error speed ωe(z) inputted from the subtracter 71 by the proportional gain Kp.
An adder 76 adds the error speed ωe(z) subjected to unit delay in the delayer 73 to the error speed ωe(z) inputted from the subtracter 71.
An integral calculator 77 multiplies the calculation result of the adder 76 by the integral gain Ki. An adder 78 adds an integral torque Ti(z) subjected to unit delay in a delayer 79 to the calculation result of the integral calculator 77 and calculates the integral torque Ti(z).
An adder 80 adds up the differential torque Td(z), the proportional torque Tp(z), the integral torque Ti(z) to calculate a PTD output torque Tm′(z). The PID output torque Tm′(z) is a torque required, to set the rotation speed of the motor 6 to the target value ωm(z).
The processing by the subtracter 72, the delayer 73, the differential calculator 74, the proportion, calculator 75, the adder 76, the integral calculator 77, the adder 78, the delayer 79, and the adder 80 corresponds to processing by the PID adjuster 13 of
A current converter 81 converts the PID output torque Tm′(z) to a current Im(z)′ to flow in the motor 6 by dividing the PID output torque Tm′(z) by a torque constant KT.
A subtracter 82 subtracts the current Im(z)′ subjected to unit delay in a delayer 83 from the current Im(z)′ inputted from the current converter 81.
An inductance voltage calculator 84 calculates an inductance voltage Vl(z) by multiplying the calculation result of the subtractor 82 by a conversion constant KL of an amount corresponding to inductance.
A winding resistance voltage calculator 85 calculates a winding resistance voltage Vr(z) by multiplying the current Im(z)′ inputted from the current converter 81 by a conversion constant KR of an amount corresponding to a winding resistance.
A reverse induced voltage calculator 86 calculates a reverse induced voltage Ve(z) by multiplying the angular speed ωm(s) of the motor 6 by a induced voltage constant KE.
An adder 87 calculates a drive voltage Vpm(z)′ of the motor 6 in the synchronous rectification type by adding up the inductance voltage Vl(z), the winding resistance voltage Vr(z), and the reverse induced voltage Ve(z).
A duty ratio calculator 88 calculates the duty ratio (PWM_Duty) of the PWM signal by using the aforementioned formula (14). The motor 6 is driven by using the PWM signal with, the calculated duty ratio.
The processing by the current converter 81, the subtracter 82, the delayer 83, the inductance voltage calculator 84, the winding resistance voltage calculator 85, the reverse induced voltage calculator 86, the adder 87, and the duty ratio calculator 88 corresponds to the processing by the drive-voltage duty-ratio calculator 14 of
A speed converter 89 converts the pulse signal (motor speed pulse) outputted from the speed detector 5 to the angular speed ωm(z) of the motor 6. The angular speed ωm(z) is outputted to the subtractor 71 and the reverse induced voltage calculator 86, The processing by the speed converter 89 corresponds to the processing by the capture unit 17 and the rotation speed detector 18 of
Next, an operation of generating the PWM signal in the simple PWM generator 16 is described.
The carrier signal inputted from the carrier signal generator 15 into the comparator 19 of the simple PWM generator 16 takes a value between zero and Vps(s) as depicted in
The PWM setting value Vpm(s)″ calculated by using the aforementioned formula (13) also takes a value between zero and Vps(s). When the drive voltage Vpm(s)′ of the motor 6 is equal to zero, Vpm(s)″=Vps(s)/2. When Vpm(s)′>0, Vpm(s)″>Vps(s)/2. When Vpm(s)′<0, Vpm(s)″<Vps(s)/2.
The comparator 19 compares the carrier signal and the PWM setting value Vpm(s)″ and generates a PWM signal which is at a high level in a period when the value of the PWM setting value Vpm(s)″ is greater than the value of the carrier signal and which is at a low level in a period when the value of the PWM setting value Vpm(s)″ is less than the value of the carrier signal.
A PWM signal whose duty ratio is greater than 50% is thereby generated when Vpm(s)″>Vps(s)/2, i.e. when Vpm(s)′>0 as depicted in
Since the simple PWM generator 16 generates the PWM signal by simply comparing the carrier signal and the PWM setting value Vpm(s)the PWM signal can be generated in a short time. This achieves performances including highly-accurate rotation speed control of the motor 6 and high-speed response to the target speed command.
The PWM signal generated by the simple PWM generator 16 is inputted in to the driver 3 and the motor 6 is driven according to the duty ratio of the PWM signal.
Next, description is given of comparison between the rotation speed control of the motor 6 by the drive control device 1 and rotation speed control ignoring the inductance component of the motor 6.
In the rotation speed control ignoring the inductance component of the motor 6, the drive voltage Vpm(s)′ is calculated by using the aforementioned formula (11), assuming that VI(s)=0.
In
As described above, in the drive control device 1, decrease in the response performance due to integral delay of the current to the voltage caused by the inductance can be suppressed by considering the inductance component.
Next, evidence data on a performance of the drive control device 1 regarding the rotation speed control of the motor 6 is depicted in
In this case, each of the rotation speed non-uniformity ratios Wow [%] is expressed by the following formula (15).
Wow=(ωm−ωr)−100/ωr (15)
As illustrated in
Next, measured data of the angular speed com of the motor and the error speed ωe in four types of drive patterns (drive patterns A to D) are depicted respectively in
The drive pattern A is a pattern in which the state of the motor 6 is switched from a forward rotation state to a stop state, and then to a reverse rotation state. The drive pattern B is a pattern in which the state of the motor 6 is switched from the reverse rotation state to an instantaneous stop, and then to the forward rotation state. The drive pattern C is a pattern in which the state of the motor 6 is switched between a high-speed forward rotation state and a low-speed forward rotation state. The drive pattern D is a pattern in which the state of the motor 6 is switched between a high-speed reverse rotation state and a low-speed reverse rotation state.
As depicted in
As described above, in the drive control device 1, the drive-voltage duty-ratio calculator 14 calculates the drive voltage of the motor 6 in the synchronous recertification method, based on the torque calculated by the PID adjuster 13, the rotation speed of the motor 6, and the electrical specification (electrical parameter) of the motor 6. Moreover, the drive-voltage duty-ratio calculator 14 sets the duty ratio of the PWM signal in the synchronous recertification method, based on the calculated drive voltage. The duty ratio corresponding to the error speed can be thereby set without forming a motor current negative feedback loop. Accordingly, in the drive control device 1, it is possible omit a current detector and an AD converter forming the motor current negative feedback loop and simplify the hardware configuration.
Since the inductance (armature winding inductance La) of the motor 6 is included in the electrical specification (electrical parameter) of the motor 6 used to calculate the drive voltage, the decrease in response performance due to the integral delay of the current caused by inductance can be suppressed.
Moreover, in the drive control device 1, the simple PWM generator 16 generates the PWM signal with the set duty ratio by comparing the carrier signal and the PWM setting value. Accordingly, there is no delay due to processing of detecting the current flowing in the motor and at the same time causing the duty ratio of the PWM signal to follow the current and converge, the delay occurring in the configuration using the motor current negative feedback loop. Accordingly, the PWM signal can be generated in a short time. As a result, highly-accurate rotation speed control and quick response to the target speed command is made possible.
Moreover, in the drive control device 1, the entire control system can be digitized and a speed control (fully-digital programmable servo) system can be established by firmware with a high degree of freedom.
Embodiments of the present invention have been described above. However, the invention may be embodied in other specific forms without departing from the spirit or essential characteristics thereof. The present embodiments are therefore to be considered in all respects as illustrative and not restrictive, the scope of the invention being indicated by the appended, claims rather than by the foregoing description and all changes which come within the meaning and range of equivalency of the claims are therefore intended to be embraced therein.
Moreover, the effects described in the embodiments of the present invention are only a list of optimum effects achieved, by the present invention. Hence, the effects of the present invention are not limited to those described in the embodiment of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
2015-123607 | Jun 2015 | JP | national |