The present invention relates to an electric power steering device and relates in particular to a control device for that electric power steering device.
Electric power steering devices for vehicles detect the steering torque and other values generated by the steering shaft from movement of the steering wheel, calculate the current reference value serving as the steering auxiliary instruction for the motor based on that detected signal, and a current feedback control circuit calculates the current control value as the difference between the current reference value and the detected motor current value, and a motor is then driven by the current control value to apply an auxiliary force to the steering wheel.
An electric power steering device of this type utilizes a motor control circuit comprised of four field effect transistors FET 1 through FET 4 connected in a bridge as shown in
Among the two sets of FET pairs comprising the two mutually opposing arms in the H bridge circuit that make up the motor control circuit, the FET 1 of the first arm (or FET 2 of the second arm) is driven by a PWM signal (pulse width modulation signal) at a duty ratio D determined based on the current control value to regulate the flow of the motor current.
The rotation direction of the motor M is controlled by turning FET 3 of the second arm on, and FET 4 of the first arm off (or FET 3 of the second arm off, and FET 4 of the first arm on) based on the current control value signs.
When the FET 3 is conducting current, there is a current flow through the FET 1, the motor M, and the FET 3, and a positive current flows in the motor M. When the FET 4 of the second arm is conducting current, there is a current flow through the FET 2, the motor M, and the FET 4, and a negative current flows in the motor M. This motor control circuit cannot simultaneously drive the FET of both arms so there is little probability of an electrical short and this circuit is widely used since it is highly reliable.
However, after turning the steering wheel, the steering wheel then returns to a straight ahead (forward) driving position (hereafter called “steering wheel return”) due to self-aligning torque. In this state, no steering torque is generated so the current reference value Iref becomes zero. However a back electromotive force is generated in the motor so that the relation of the motor current I to the duty ratio D shifts upward by an amount equivalent to the back electromotive force as shown by the line (b) in
The feedback control circuit on the other hand, attempts to calculate the current control value E, however there is no duty ratio D corresponding to current reference value Iref so that an oscillating current at an amplitude nearly matching the motor current I of the discontinuous section is output as the current control value E as shown by the line (c) in
To resolve this problem, the inventors proposed a structure comprised of a motor control circuit made up of two pairs of semiconductor devices forming an H bridge circuit of two mutually opposing arms. In this bridge circuit, a first duty ratio PWM signal determined by the current control value drives the semiconductor devices of a first arm; and a second duty ratio PWM signal determined by a function of the first duty ratio, drives the semiconductor devices of a second arm, in a structure where each arm is driven separately. In this structure, there is no discontinuity in the relation between the duty ratio D and the motor current I in the vicinity of the state where the duty ratio D value is zero, even in a state where no steering torque is generated such as steering wheel return where point p is joined to point 0 in a straight line as shown in
In the above structure for driving the semiconductor devices of a first arm with a first duty ratio PWM signal that is determined based on a current control circuit, and driving the semiconductor devices of a second arm with a second duty ratio PWM signal defined by a function of the first duty ratio; separately driving the respective arm eliminates discontinuities in the relation between the duty ratio D and the motor current I, eliminates noise, and improves stability. However as can clearly be understood from
The electric power steering device of this invention for controlling the output of a motor that applies an auxiliary steering force to the steering mechanism from a current reference value calculated based on a steering torque generated in at least the steering shaft, is comprised of a duty ratio calculator for calculating a duty ratio D1 and a duty ratio D2 determined by the motor terminal voltage based on a current reference value, a motor drive circuit including a motor connected across the output terminals and a power supply connected across the input terminals of an H bridge circuit made up of a first arm and a second arm each containing a pair of semiconductor devices connected in series, and PWM signal of duty ratio D1 drives the semiconductor device in the upper stage of the first arm, and PWM signal of duty ratio D2 drives the semiconductor device in the lower stage of the second arm of the H bridge circuit; and a duty ratio calculator for calculating a duty ratio D1 and a duty ratio D2 showing the motor current characteristics of the duty ratio from the current reference value as continuous linear characteristics based on a specified formula.
The duty ratio calculator then separately calculates the duty ratio D1 and a duty ratio D2 based on the motor back electromotive force to show the motor current characteristics for duty ratio D as continuous linear characteristics.
The basic concept of this invention is described first. This invention further improves the non-linear control characteristics between the motor current I and the duty ratio D, namely the non-linear control characteristics made up of the three-stage broken line previously described while referring to
The motor control circuit of the electric power steering device is comprised of four field effect transistors FET 1 through FET 4 connected in an H bridge circuit as to make up a bridge made up of two arms, a first and a second arm as previously described in
Though previously explained in the voltage Vm (or motor terminal voltage) description, the duty ratio D is a ratio that determines the voltage motor terminal voltage Vm and so the motor terminal voltage can therefore by substituted for the duty ratio. Changing the FET 1 and FET 3 combination to the FET 2 and FET 4 combination reverses the direction that the motor rotates, however there is essentially no change in the operation so the following description uses the FET 1 and FET 3.
In order to improve the non-linear characteristics, this invention is comprised of an H bridge circuit including a first arm and a second arm where an FET 1 is driven at a duty D1, and a FET 3 is driven at a duty D2, with the duty D1 set by the following formula (a), and the duty D2 set by the following formula (b).
D1=Vref2/Vr (a)
D2={Vref2+sign(Vref2)(Vr−|KTω|)}/Vr (b)
Here, the respective symbols indicate:
Vref: motor terminal voltage command value
Vref2: linear motor terminal voltage command value
Vr: voltage supplied to motor (battery voltage)
KT: =constant of back electromotive force of motor
ω: motor angular velocity
sign (Vref2): sign of linear motor terminal voltage command value Vref2
The method for calculating the duty D1 and the duty D2 is described next.
The basic formula for the PWM signal drive in the H bridge circuit is expressed by the following formula (1).
Vm=(D1+D2)Vr−sign(D1)Vr−KTω (1)
where, Vm: motor terminal voltage
D1: upper stage duty for driving upper stage FET (value −1 through +1)
D2: lower stage duty for driving lower stage FET (value −1 through +1)
Vr: voltage supplied to motor (battery voltage)
KT: constant of back electromotive force of motor
ω: motor angular velocity
Usually, the duty D2 is fixed at 100 percent (D2=1.0), and just the duty D1 is varied. Since the sign for D1 is positive (0.3), when for example 30 percent of the battery voltage (D1=0.3) is applied to the motor, the Vm motor terminal voltage is therefore expressed by the following formula (1).
However, in order to resolve the problems in the background art as related previously (See Japanese Laid Open Patent Publication No. H09-39810), the duty D2 is calculated according to the following formula (2).
D2=D1+sign(D1)×B (2)
where, B is a constant.
The constant B is determined so as to express the relation between the duty D1 and the motor current I so that the characteristics become those as shown in
The determining of the constant B is described next. The formula (1) can be written into the following formula (3), when the condition that the duty D1 and the back electromotive force KTω be different signs is added.
Vm=(D1+D2)Vr−sign(D1)Vr+sign(D1)|KTω| (3)
Formula (3) expresses the characteristics of discontinuous section X shown in
and when formula (2) is substituted into this, then
In other words, the constant B is determined by the formula (4), so that the duty D2 expressed in formula (2) becomes a function of the duty D1.
The characteristics formula for the section A1′ and the section A2′, can be expressed as shown below in formula (5) if the duty D1′ is utilized in these sections.
Vm=VrD1′−KTω (5)
If the duty D1′ can be defined by D1, then the discontinuity characteristics can be converted into continuity characteristics. The formula (2), formula (4), formula (5) are substituted into the formula (1). The formula (5) is first of all substituted into the formula (1).
Vm=(D1+D2)Vr−sign(D1)Vr−KTω
VrD1′−KTω=(D1+D2)Vr−sign(D1)Vr−KTω
VrD1′=(D1+D2)Vr−sign(D1)Vr
When formula (2) is substituted into D2 of this formula, then:
VrD1′=(D1+(D1+sign(D1)×B}Vr−sign(D1)Vr
D1′=2D1+sign(D1)(B−1)
Solving for D1 in this formula yields:
D1=½{D1′−sign(D1)(B−1)}
Substituting formula (4) into B of this formula yields:
D1=½{D1′−sign(D1){|KTω|/Vr)}
Adding the condition that the upper stage duty D1 and KTω are different signs yields:
D1=½{D1′−(KTω/Vr)} (6)
Eliminating the sign D1 from the right part of formula (6), allows removing the absolute value so that the duty D1 can define the duty D1′.
In the above explanation, the discontinuous (or non-continuous) characteristics of motor terminal voltage Vm and motor current I of section A1′ and section A2′ in
In the embodiment, the motor terminal voltage command value Vref is calculated from the difference between the detected motor current I and the current reference value Iref that regulates the motor current, and used to regulate the motor terminal voltage. The duty ratio value is calculated as a voltage (voltage) so that in the following explanation it is referred to as motor terminal voltage command value Vref.
The motor terminal voltage command value Vref is mapped according to formula (6), by the second voltage command value that functions as the linear motor terminal voltage command value Vref. Here, the term “mapping” signifies that the motor terminal voltage command value Vref is converted to the linear motor terminal voltage command value Vref2 in order to convert the continuous bent line of three stages p-0-q, into the completely linear continuous characteristic p-q shown in
In the mapping process, the duty D1 is made to equal Vref2/Vr, and the duty D1′ is made to equal duty Vref/Vr, and the line A1 is converted to A1′, and line A2 is converted to A2′ as shown in
Substituting D1=Vref2, D1′=Vref/Vr into formula (6), allows expressing formula (6) as the following formula (7), and mapping can be performed per formula (7).
Vref2/Vr=½{(Vref/Vr)−(KTω/Vr)}
Vref2=½(Vref−KTω) (7)
Calculating the duty D1 is described next. In the mapping process, the duty D1 is handled as D1=Vref2/Vr, and Vref2 is expressed per the above formula (7), so that the duty D1 can be expressed per the following formula (a).
In the actual control circuit described later on, the duty D1 expressed in formula (a) is compensated such as by dead time compensation (or offset), and duty dither adding. Whether to perform this processing or not can be selected by optional selection items. The duty D1 set in formula (a) does not contain results from compensation processing such as dead time compensation (or offset), and duty dither adding.
Calculating the duty D2 is described next. When the formula (4) and formula (7) are substituted into formula (2), the duty D2 shown next can be expressed in the following formula (b).
In other words, the duty D2 can be expressed by the formula (a) not containing duty D1. This fact signifies that the duty D2 is set separately from the duty D1.
In the characteristics graph in
|Vref|<|KTω| (c)
If this condition (c) is satisfied, then the duty D1 is calculated by the formula (a), and the duty D2 is calculated by the formula (b). If this condition is not satisfied, then the duty D1 and duty D2 are calculated by the usual method without mapping.
However, in the vicinity the condition boundary or in other words, near point q in
If the motor terminal voltage command value Vref, and the back electromotive force KTω of motor contain noise, then the conditions might or might not be satisfied (established/not established) in the vicinity of the condition boundary (near point q in
A decision is made in the above mapping process, on whether the condition is established or not established, after first removing the noise components from the motor terminal voltage command value Vref, and the motor back electromotive force KTω.
In other words, when the following condition (d)
|Vref<|KTω| (d)
is satisfied among the absolute value for motor terminal voltage command Vref and the back electromotive force KTω of the motor after removing their respective noise components, then the duty D1 for performing mapping can be calculated from formula (a), and the duty D2 can be calculated from formula (b). If this condition is not satisfied then the duties D1 and D2 are calculated by the usual method without mapping.
The hysteresis characteristic may be applied to the above condition in order to prevent chattering from occurring in the mapping process. Namely, when the following condition (e)
|Vref|<|KTω (e)
including a hysteresis characteristic among the absolute value for the motor terminal voltage command Vref and absolute value of back electromotive force KTω of motor after removing their respective noise components is satisfied, then the duty D1 needed for mapping can be calculated from formula (a), and the duty D2 can be calculated from the formula (b). However if the condition is not satisfied, then D1 and D2 are calculated by the usual method without mapping.
In order to prevent chattering in the vicinity of the hysteresis characteristic boundary value, the prior decision results can be held (for use) regardless of whether the prior conditions were established or not.
Namely, when the following condition (f):
(|Vref|−KTω|)<−Hys (f)
where, Hys: the value of hysteresis width characteristics.
is satisfied for the absolute value for the motor terminal voltage command value Vref and the absolute value for the back electromotive force KTω of motor with their noise components removed, then the duty D1 needed for mapping can be calculated from formula (a), and the duty D2 may be calculated from the formula (b).
If the condition (f) (Hys<(|Vref|−|KTω|)) is not satisfied at this time, then D1 and D2 are calculated by the usual method without mapping.
Also if condition (f) is satisfied and moreover the condition (g) is satisfied, then the decision results from the prior condition (condition (f) was established or not) may be maintained without mapping.
−Hys<(|Vref|−|KTω|)<Hys (g)
The value of hysteresis characteristic Hys may be set as needed such as experimentally, according to the size of the noise contained in the motor terminal voltage command value Vref and the back electromotive force KTω of motor.
The outlines of the electric power steering device of this invention is described next while referring to
Electrical power is supplied from a battery 14 via the ignition key 11 to an electric control circuit 13 for controlling the power steering device. The electric control circuit 13 calculates the current reference value based on the vehicle speed detected by a vehicle speed sensor 12 and the steering torque detected by a torque sensor 3; and regulates the electrical current supplied to the motor 10 based on the current reference value that was calculated.
The electric control circuit 13 controls a clutch 9. The clutch 9 is engaged during normal operation, and is disengaged when the electric control circuit 13 decides there is a failure in the electric power steering device and the power is off.
The function and operation of the electric control circuit 13 are described next. The steering torque signal input from the torque sensor 3 is phase-compensated by the phase compensator 21 in order to boost steering stability, and back electromotive force to a current reference value calculator 22A. The vehicle speed signal detected by the vehicle speed sensor 12 is also inputted to the current reference value calculator 22A.
The current reference value calculator 22A calculates the current reference value (current command value) Iref by using the specified calculation formula based on the detected motor current value i, and the vehicle speed signal, and steering torque signal that were inputted. A current controller 22B calculates the motor terminal voltage command value Vref based on the detected motor current value i, and the current reference value Iref that were inputted.
A duty ratio processor 30 that functions as the duty ratio calculation means, contains a current drive linearity compensator 23, a current discontinuity compensator 24, and a compensator adder 25. The compensator adder 25 includes a multiplier 26, a dead time compensator 27, and a duty dither adder 28, and functions of duty ratio processor 30 is a calculating and outputting means for the duty D1, duty D2, and the motor drive directional signals.
The current drive linearity compensator 23 inputs the motor terminal voltage command value Vref, the battery voltage Vr, and the motor angular velocity ω (detected with a motor angular velocity sensor not shown in the drawing, or estimated from the motor terminal voltage, motor current), and calculates the linear motor terminal voltage command value Vref2 based on formulas (6) and(7). The calculated value Vref2 is inputted to the current discontinuity compensator 24 and the compensator adder 25.
The compensator adder 25 calculates the duty D1 based on the formula (a), so that the linear motor terminal voltage command value Vref2 is multiplied by a specified gain K in the multiplier 26, compensation processing such as dead time compensation and duty dither adding is performed in the dead time compensator 27 and the duty dither adder 28, and the compensated duty D1 is then calculated.
The current discontinuity compensator 24 calculates the duty D2 based on formula (b) so that the duty D2 is calculated from the linear motor terminal voltage Vref2.
The duty D1 and the duty D2 that were calculated are inputted along with the motor drive direction signal output from the current drive linearity compensator 23, into the motor drive circuit 35.
A motor current detection circuit 38 detects the flow of current in a positive direction based on the voltage drop across both ends of a resistor R1, and also detects the flow of current in a negative direction based on the voltage drop across both ends of the resistor R2. The motor current detection circuit 38 feeds back the detected motor current value i to the current reference value calculator 22A and the current controller 22B.
The dead time compensation and duty dither add processing is described next. The dead time compensation is described first. A dead time is established at the point in time that the PWM signal switches, in order to prevent electrical shorts due to the two arms in the H bridge circuit conducting simultaneously at the point in time that the signal switches from H to L, or at the point in time that the signal switches from L to H, based on the duty D of the PWM signal in the motor drive circuit utilized in the H bridge circuit. Dead time compensation is not the main subject of this application, so a description is omitted here. A description is however given in Japanese Laid Open Patent Publication No. H08-142884 by the present inventors.
The duty dither add processing is described next. A dead band occurs in the motor current characteristics for duty ratio D, in the vicinity where the duty D of the PWM signal is zero in the motor drive circuit utilized in the H bridge circuit. This dead band causes poor control response, and the steering wheel handling does not feel natural. A voltage dither signal is therefore supplied to the motor in the vicinity of the dead band to improve the control response, and make handling of the steering wheel feel more natural. Duty dither adding is not the main subject of this application, so a description is omitted here. A description is however given in Japanese Laid Open Patent Publication No. 2003-11834 by the present inventors.
This invention as described above, the motor current characteristics for duty ratio D exhibit continuous linear characteristics near a motor angular velocity of zero. This invention therefore not only eliminates non-continuous sections in motor current characteristics for duty ratio D near a motor angular velocity of zero that occur in a conventional electric power steering device, but can also eliminate step-type continuous characteristics. Therefore the change in feedback characteristics are eliminated even during the “steering wheel return” after the steering wheel was turned and then returned for driving straight ahead, so that an extremely smooth driving feeling is obtained.
Moreover, there is no chattering since no step-type changes occur from continuous changes in the back electromotive force generated in the motor during steering wheel return, and no noise due to chattering so that no noise is generated in car radios and other remarkable effects not seen in a conventional electric Power steering device.
This invention relates to an electric power steering device for vehicles, and by correcting the non-continuous motor current characteristics for duty ratio D that occur in the vicinity of zero in the duty D of the PWM signal driving the semiconductor devices within a motor drive circuit semiconductor devices connected in an H bridge circuit, this invention can improve the control response, and obtain a more natural feeling when handling the steering wheel.
Number | Date | Country | Kind |
---|---|---|---|
2003-417689 | Dec 2003 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP04/18425 | 12/3/2004 | WO | 6/14/2006 |