The disclosure of Japanese Patent Application No. 2015-061155 filed on Mar. 24, 2015 including the specification, drawings and abstract, is incorporated herein by reference in its entirety.
1. Field of the Invention
The present invention relates to electric power steering systems (EPSs) and gain setting methods thereof.
2. Description of the Related Art
A column assist electric power steering system (hereinafter referred to as the “column EPS”) in which an electric motor and a speed reduction mechanism are placed in a column portion is known as an electric power steering system. The column EPS includes a steering wheel, a steering shaft, an intermediate shaft, a steering operation mechanism, an electric motor, a speed reduction mechanism, etc. The steering shaft is formed by an input shaft coupled to the steering wheel, an output shaft coupled to the intermediate shaft, and a torsion bar coupling the input shaft and the output shaft. The electric motor is coupled to the output shaft via the speed reduction mechanism.
As used herein, the term “column” refers to a portion that is formed by a steering wheel, an input shaft, a torsion bar, and an output shaft. The term “power column” refers to a portion that is formed by a steering wheel, an input shaft, a torsion bar, an output shaft, a speed reduction mechanism, an electric motor, and a control device for the electric motor. The term “common column EPS” refers to a column EPS that does not have a function to compensate for friction of a speed reduction mechanism.
In common column EPSs, motor torque (assist torque) generated by an electric motor is transmitted to an output shaft via a speed reduction mechanism. The assist torque thus transmitted to the output shaft is transmitted via an intermediate shaft to a steering operation mechanism including, e.g., a rack and pinion mechanism. For example, the speed reduction mechanism is a worm gear mechanism that is formed by a worm gear and a worm wheel. Since large friction is generated in the speed reduction mechanism, this friction may affect the response of the steering system to steering input.
Methods for compensating for friction that is generated in a speed change mechanism have been developed in order to improve the response of the steering system to the steering input. The easiest friction compensation method is a method in which a certain frictional force is added to an assist torque command value according to the sign of the steering speed.
Japanese Patent Application Publication No. 2003-170856 (JP 2003-170856 A) discloses a method for compensating for friction based on an assist torque command value calculated based on steering torque detected by a torque sensor, and the detected steering torque. Specifically, the magnitude of the frictional force that is generated in the speed reduction mechanism is estimated based on the assist torque command value. The sign of the frictional force in the speed reduction mechanism is determined based on the detected steering torque. The frictional force in the speed reduction mechanism is estimated in this manner. The estimated frictional force in the speed reduction mechanism is added to the assist torque command value.
It is one object of the present invention to provide an electric power steering system capable of compensating for friction that is generated in a power column and having a non-oscillatory, responsive control system, and a gain setting method in the electric power steering system.
According to one aspect of the present invention, an electric power steering system includes: a power column including an electric motor and a speed reduction mechanism that amplifies motor torque of the electric motor; an assist torque command value calculation unit that sets an assist torque command value of the electric motor; an observer that calculates an estimated value of a rotation angle of the power column and an estimated value of a frictional force that is generated in the power column, by using an observer model in which it is assumed that no friction is generated in the power column and whose characteristic is corrected by using an actual measurement value of a rotation angle of the electric motor and a model correction gain; a reference model in which it is assumed that no friction is generated in the power column and which calculates a target value of the rotation angle of the power column; a feedback manipulated variable calculation unit that calculates a feedback manipulated variable by performing a feedback operation on a deviation between the target value of the rotation angle of the power column and the estimated value of the rotation angle of the power column; a motor torque command value calculation unit that calculates a motor torque command value by correcting the assist torque command value using the estimated value of the frictional force and the feedback manipulated variable; and a motor current control unit that controls a motor current flowing in the electric motor so that the motor torque of the electric motor becomes equal to the motor torque command value. A feedback gain that is used in the feedback manipulated variable calculation unit and the model correction gain that is used in the observer are set so that a characteristic equation corresponding to an equation of motion representing behavior of the electric power steering system has a double root.
The rotation angle of the power column may be a rotation angle of a column shaft (steering shaft) or may be a rotation angle of an output shaft (motor shaft) of the electric motor.
According to this configuration, the estimated value of the frictional force that is generated in the power column is calculated. The motor torque command value is calculated by using the estimated value of the frictional force and the assist torque command value. The friction that is generated in the power column can thus be compensated for. According to this configuration, an electric power steering system with a non-oscillatory, responsive control system is implemented.
Another aspect of the present invention relates to a gain setting method in an electric power steering system including a power column including an electric motor and a speed reduction mechanism that amplifies motor torque of the electric motor, an assist torque command value calculation unit that sets an assist torque command value of the electric motor, an observer that calculates an estimated value of a rotation angle of the power column and an estimated value of a frictional force that is generated in the power column, by using an observer model in which it is assumed that no friction is generated in the power column and whose characteristic is corrected by using an actual measurement value of a rotation angle of the electric motor and a model correction gain, a reference model in which it is assumed that no friction is generated in the power column and which calculates a target value of the rotation angle of the power column, a feedback manipulated variable calculation unit that calculates a feedback manipulated variable by performing a feedback operation on a deviation between the target value of the rotation angle of the power column and the estimated value of the rotation angle of the power column, a motor torque command value calculation unit that calculates a motor torque command value by correcting the assist torque command value using the estimated value of the frictional force and the feedback manipulated variable, and a motor current control unit that controls a motor current flowing in the electric motor so that the motor torque of the electric motor becomes equal to the motor torque command value. A feedback gain that is used in the feedback manipulated variable calculation unit and the model correction gain that is used in the observer are set so that a characteristic equation corresponding to an equation of motion representing behavior of the electric power steering system has a double root.
The rotation angle of the power column may be a rotation angle of a column shaft (steering shaft) or may be a rotation angle of an output shaft (motor shaft) of the electric motor. According to this method, an electric power steering system with a non-oscillatory, responsive control system can be implemented.
The foregoing and further features and advantages of the invention will become apparent from the following description of example embodiments with reference to the accompanying drawings, wherein like numerals are used to represent like elements and wherein:
An embodiment in the case of applying the present invention to a column EPS will be described in detail below with reference to the accompanying drawings.
A column EPS 1 includes a steering wheel 2 serving as a steering member that steers a vehicle, a steering operation mechanism 4 that steers steered wheels 3 according to rotation of the steering wheel 2, and a steering assist mechanism 5 that assists driver's steering operation. The steering wheel 2 and the steering operation mechanism 4 are mechanically coupled to each other via a steering shaft 6, a first universal joint 28, an intermediate shaft 7, and a second universal joint 29.
The steering shaft 6 includes an input shaft 8 coupled to the steering wheel 2 and an output shaft 9 coupled to the intermediate shaft 7. The input shaft 8 and the output shaft 9 are coaxially coupled to each other via a torsion bar 10 so as to be rotatable relative to each other. That is, when the steering wheel 2 is rotated, the input shaft 8 and the output shaft 9 rotate relative to each other and in the same direction. The output shaft 9 is coupled to the intermediate shaft 7 via the first universal joint 28.
A torque sensor 11 is disposed around the steering shaft 6. The torque sensor 11 detects torsion bar torque (steering torque) Ttb being applied to the torsion bar 10, based on the relative rotation displacement between the input shaft 8 and the output shaft 9. The torsion bar torque Ttb detected by the torque sensor 11 is input to an electronic control unit (ECU) 12.
The steering operation mechanism 4 is a rack and pinion mechanism including a pinion shaft 13 and a rack shaft 14 as a steered shaft. The steered wheels 3 are each coupled to an end of the rack shaft 14 via a tie rod 15 and a knuckle arm (not shown). The pinion shaft 13 is coupled to the intermediate shaft 7 via the second universal joint 29. The pinion shaft 13 rotates according to the steering operation of the steering wheel 2. A pinion 16 is coupled to the tip end of the pinion shaft 13.
The rack shaft 14 extends linearly in the lateral direction of the vehicle (the direction perpendicular to the direction in which the vehicle travels straight). A rack 17 that meshes with the pinion 16 is formed in an intermediate portion in the axial direction of the rack shaft 14. The pinion 16 and the rack 17 convert rotation of the pinion shaft 13 to axial movement of the rack shaft 14. The steered wheels 3 can be steered by moving the rack shaft 14 in the axial direction.
When the steering wheel 2 is steered (rotated), this rotation of the steering wheel 2 is transmitted to the pinion shaft 13 via the steering shaft 6 and the intermediate shaft 7. The rotation of the pinion shaft 13 is converted to axial movement of the rack shaft 14 by the pinion 16 and the rack 17. The steered wheels 3 are steered in this manner.
The steering assist mechanism 5 includes an electric motor 18 and a speed reduction mechanism 19. The electric motor 18 generates a steering assist force, and the speed reduction mechanism 19 amplifies output torque of the electric motor 18 and transmits the amplified output torque to the steering operation mechanism 4. The speed reduction mechanism 19 is a worm gear mechanism that includes a worm gear 20 and a worm wheel 21 meshing with the worm gear 20. The speed reduction mechanism 19 is accommodated in a gear housing 22 serving as a transmission mechanism housing. In the following description, “i” represents the speed reduction ratio (gear ratio) of the speed reduction mechanism 19. The speed reduction ratio i is defined as the ratio ωwg/ωww of the angular velocity ωwg of the worm gear 20 to the angular velocity ωww of the worm wheel 21.
The worm gear 20 is rotationally driven by the electric motor 18. The worm wheel 21 is coupled to the steering shaft 6 so as to be rotatable in the same direction as the steering shaft 6. The worm wheel 21 is rotationally driven by the worm gear 20.
When the driver steers the steering wheel 2, the worm gear 20 is rotationally driven by the electric motor 18. The worm wheel 21 is thus rotationally driven, whereby motor torque is applied to the steering shaft 6 and the steering shaft 6 is rotated. The rotation of the steering shaft 6 is transmitted to the pinion shaft 13 via the intermediate shaft 7. Rotation of the pinion shaft 13 is converted to axial movement of the rack shaft 14, whereby the steered wheels 3 are steered. That is, the steering operation can be assisted by the electric motor 18 as the worm gear 20 is rotational driven by the electric motor 18.
Torque that is applied to the speed reduction mechanism 19 includes motor torque that is generated by the electric motor 18 and external torque other than the motor torque. The external torque other than the motor torque includes driver torque that is applied to the steering wheel 2 by the driver and load torque (load) that is applied to the rack shaft 14 (speed reduction mechanism 19) from the steered wheel 3 side. The driver torque is detected as the torsion bar torque Ttb.
The rotation angle (rotor rotation angle) of a rotor of the electric motor 18 is detected by a rotation angle sensor 25 such as a resolver. The vehicle speed is detected by a vehicle speed sensor 26. An output signal of the rotation angle sensor 25 and the vehicle speed V detected by the vehicle speed sensor 26 are input to the ECU 12. The electric motor 18 is controlled by the ECU 12 as a motor control device.
The ECU 12 implements appropriate steering assistance depending on the steering condition by driving the electric motor 18 according to the torsion bar torque Ttb detected by the torque sensor 11, the vehicle speed V detected by the vehicle speed sensor 26, and the rotation angle θm of the electric motor 18 calculated based on the output of the rotation angle sensor 25. The ECU 12 implements friction compensation for reducing the influence of friction in a power column by drivingly controlling the electric motor 18. In the present embodiment, the electric motor 18 is a direct-current (DC) motor with a brush. In the following description, the rotation angle of the steering shaft (column shaft) 6 is referred to as the “column rotation angle θ.” The rotation angle of the steering shaft 6 is an example of the rotation angle of the power column.
The ECU 12 includes a microcomputer 40, a drive circuit (H-bridge circuit) 31, a current detection resistor (shunt resistor) 32, and a current detection circuit 33. The drive circuit 31 is controlled by the microcomputer 40 to supply electric power to the electric motor 18. The current detection resistor 32 and the current detection circuit 33 are provided to detect a current flowing in the electric motor 18 (hereinafter this current is referred to as the “motor current”).
The microcomputer 40 includes a central processing unit (CPU) and a memory (a read only memory (ROM), a random access memory (RAM), a nonvolatile memory, etc.). The microcomputer 40 functions as a plurality of functional processing units by executing a predetermined program. The plurality of functional processing units include a rotation angle calculation unit 41, an assist torque command value calculation unit 42, a reference model 43, an angle deviation calculation unit 44, a proportional-derivative (PD) control unit 45, a first speed reduction ratio division unit 46, an addition unit 47, a plant observer 48, a second speed reduction ratio division unit 49, a current command value calculation unit 50, a current deviation calculation unit 51, a proportional-integral (PI) control unit 52, and a pulse width modulation (PWM) control unit 53.
The rotation angle calculation unit 41 calculates the rotation angle θm of an output shaft of the electric motor 18 (hereinafter this rotation angle is referred to as the “motor rotation angle θm”) based on the output signal of the rotation angle sensor 25.
The assist torque command value calculation unit 42 calculates an assist torque command value Ta based on the vehicle speed V detected by the vehicle speed sensor 26 and the torsion bar torque Ttb detected by the torque sensor 11.
The reference model 43 calculates a target value {circumflex over (θ)} of the column rotation angle θ (hereinafter this target value is referred to as the “column rotation angle target value {circumflex over (θ)}) on the assumption that no friction is generated in the power column, based on the torsion bar torque Ttb and the assist torque command value Ta. A virtual column EPS model in which no friction is generated in a power column is hereinafter referred to as the “frictionless column EPS model.” The reference model 43 is formed by a frictionless column EPS model. The frictionless column EPS model will be described later.
The angle deviation calculation unit 44 calculates the angle deviation Δθ (={circumflex over (θ)}−{tilde over (θ)}) between the column rotation angle target value {circumflex over (θ)} that is output from the reference model 43 and a column rotation angle estimated value {circumflex over (θ)} that is output from the plant observer 48.
The PD control unit 45 perfoilus PD calculation on the angle deviation Δθ calculated by the angle deviation calculation unit 44. Specifically, the PD control unit 45 calculates {kp({circumflex over (θ)}−{tilde over (θ)})+kv(d{circumflex over (θ)}|dt−d{tilde over (θ)}/dt)}, where “kp” represents a proportional gain and “kv” represents a derivative gain. The first speed reduction ratio division unit 46 calculates a first assist torque correction values Ta,PD by dividing the calculation result of the PD control unit 45 by the speed reduction ratio i of the speed reduction mechanism 19.
The second speed reduction ratio division unit 49 calculates a second assist torque correction value Ta,FC (friction compensation value) by dividing a frictional force estimated value {tilde over (μ)}N({tilde over (d)}h) calculated by the plant observer 48 by the speed reduction ratio i of the speed reduction mechanism 19. Operation of the plant observer 48 will be described later.
The addition unit 47 calculates a motor torque command value Tmc by adding the assist torque command value Ta calculated by the assist torque command value calculation unit 42, the first assist torque correction value Ta,PD calculated by the first speed reduction ratio division unit 46, and the second assist torque correction value Ta,FC calculated by the second speed reduction ratio division unit 49.
The current command value calculation unit 50 calculates a current command value Im* by dividing the motor torque command value Tmc calculated by the addition unit 47 by a torque constant of the electric motor 18. The current deviation calculation unit 51 calculates the deviation ΔIm(=Im*−Im) between the current command value Im* calculated by the current command value calculation unit 50 and an actual motor current Im detected by the current detection circuit 33. The PI control unit 52 calculates a voltage command value to be applied to the electric motor 18 by performing PI calculation on the current deviation ΔIm calculated by the current deviation calculation unit 51.
The PWM control unit 53 generates a PWM signal with a duty corresponding to the voltage command value calculated by the PI control unit 52 and applies the PWM signal to the motor drive circuit 31. The motor drive circuit 31 is an H-bridge circuit and includes a plurality of power elements. The plurality of power elements are turned on or off based on the PWM signal received from the PWM control unit 53, whereby a voltage according to the voltage command value is applied to the electric motor 18.
The current deviation calculation unit 51 and the PI control unit 52 form a current feedback controller. The current feedback controller controls the motor current flowing in the electric motor 18 so that the motor current becomes closer to the current command value Im*.
The plant observer 48 includes an observer model 61 formed by a frictionless column EPS model, a third speed reduction ratio division unit 62, an angle deviation calculation unit 63, a first gain multiplication unit 64, a motor speed calculation unit 65, a fourth speed reduction ratio division unit 66, an angular velocity deviation calculation unit 67, a second gain multiplication unit 68, and a frictional force estimation unit 69.
The frictional force estimated value {tilde over (μ)}N({tilde over (d)}h) calculated by the frictional force estimation unit 69, the torsion bar torque Ttb detected by the torque sensor 11, the motor torque command value Tmc calculated by the addition unit 47 (see
The torsion bar torque Ttb detected by the torque sensor 11, the motor torque command value Tmc calculated by the addition unit 47 (see
The third speed reduction ratio division unit 62 calculates an actual column rotation angle θ by dividing the rotation angle θm of the electric motor 18 calculated by the rotation angle calculation unit 41 by the reduction ratio i (=ωwg/ωww) of the speed reduction mechanism 19.
The angle deviation calculation unit 63 calculates the angle deviation Δθ(=θ−{tilde over (θ)}) between the actual column rotation angle θ calculated by the third speed reduction ratio division unit 62 and the column rotation angle estimated value {tilde over (θ)} calculated by the observer model 61. The first gain multiplication unit 64 calculates the first model correction term (position) Ip·Δθ by multiplying the angle deviation Δθ calculated by the angle deviation calculation unit 63 by a preset first gain Ip.
The motor speed calculation unit 65 calculates the angular velocity of the rotor of the electric motor 18 (hereinafter this angular velocity is referred to as the “actual motor angular velocity ωm) by differentiating the motor rotational angle θm calculated by the rotation angle calculation unit 41 with respect to time.
The fourth speed reduction ratio division unit 66 calculates the actual column angular velocity ω(=dθ/dt) by dividing the actual motor angular velocity ωm calculated by the motor speed calculation unit 65 by the speed reduction ratio i(=ωwg/ωww) of the speed reduction mechanism 19.
The angular velocity deviation calculation unit 67 calculates the angular velocity deviation Δω(=ω−{tilde over (ω)}) between the actual column angular velocity ω calculated by the fourth speed reduction ratio division unit 66 and the column angular velocity estimated value {tilde over (ω)} calculated by the observer model 61. The second gain multiplication unit 68 calculates the second model correction term (velocity) lv·Δω by multiplying the angular velocity deviation Δω calculated by the angular velocity deviation calculation unit 67 by a preset second gain lv.
The first model correction term (position) lp·Δθ and the second model correction term (velocity) lv·Δω are used to correct characteristics (structure) of the observer model 61. That is, the characteristics (structure) of the observer model 61 are corrected so that the column rotation angle estimated value {tilde over (θ)} that is calculated by the observer model 61 becomes equal to the actual column rotation angle θ and the column angular velocity estimated value {tilde over (ω)} that is calculated by the observer model 61 becomes equal to the actual column angular velocity ω.
The plant observer 48 outputs the column rotation angle estimated value {tilde over (θ)} calculated by the observer model 61 and the frictional force estimated value {tilde over (μ)}N({tilde over (d)}h) calculated by the frictional force estimation unit 69.
The frictional force estimation unit 69 includes a normal force calculation unit 71, a coefficient-of-friction estimation unit 72, and a frictional force calculation unit 73. The frictional force estimation unit 69 estimates the frictional force that is generated in the power column by using a simulation model and a friction model of a column EPS. The simulation model and the friction model of the column EPS which are used by the frictional force estimation unit 69 will be described.
This complete EPS model 91 is a model with four degrees of freedom. The motor torque command value Tmc, the driver torque Tsw on the steering wheel 2, the load torque Tls that is transmitted through a lower shaft, and the vehicle speed V, not shown, are input in the complete EPS model 91. The torsion bar torque Ttb, the rotation angle θms of a motor shaft, and the vehicle speed V can be detected.
The complete EPS model 91 includes four kinds of inertia, i.e., inertia of the steering wheel, inertia of the worm wheel, inertia of the worm gear, and inertia of the motor shaft. The speed reduction mechanism (worm gear mechanism) is formed by the worm gear and the worm wheel. The driver torque Tsw and the load torque Tls are directly applied to the steering wheel and the worm wheel, respectively. The motor torque command value Tmc is applied to a motor current controller (current controller) in an ECU. The ECU in this simulation model 91 is a common ECU that does not have a friction compensation function. For example, this ECU calculates the motor torque command value Tmc based on the torsion bar torque Ttb and the vehicle speed V and performs feedback control so that a current flowing in the electric motor becomes equal to a current value corresponding to the motor torque command value Tmc.
In
Equations of motion of the four kinds of inertia are given by the following expressions (1) to (4).
Steering Wheel
J
sw{umlaut over (θ)}sw=Tsw−kib(θsw−θww)−ctb({dot over (θ)}sw−{dot over (θ)}ww) (1)
Worm Wheel
J
ww{umlaut over (θ)}ww=ktb(θsw−θww)−ctb({dot over (θ)}sw−{dot over (θ)}ww)+Tc,ww+Tls (2)
Worm Gear
J
wg{umlaut over (θ)}wg=kms(θms−θwg)−cms({dot over (θ)}ms−{dot over (θ)}wg)+Tc,wg (3)
Assist Motor Rotor
J
ms{umlaut over (θ)}ms=Tms−kms(θms−θwg)−cms({dot over (θ)}ms−{dot over (θ)}wg) (4)
In the expressions, “Tc,ww,” and “Tc,wg” represent interaction torque between the worm wheel and the worm gear. The interaction torque Tc,ww, Tc,wg in Expressions (2), (3) can be calculated by using a meshing model of the worm gear and the worm wheel shown in
In
When the EPS system is in a stopped state, each tooth of the worm gear meshing with the worm wheel contacts two points of the worm wheel, namely upper and lower points of the worm wheel, due to a preload F0. This state is herein referred to as the “two-point contact state.”
Interaction forces
{right arrow over (F)}
c,ww
={right arrow over (N)}
1,wg
+
f1,wg
+
2,wg
+
f2,wg (5)
F
c,wg
={right arrow over (N)}
1,ww+
The normal force {right arrow over (N)}1,xx is generated by material strain represented by a spring having a coefficient kc. The amounts of compression of upper and lower springs are given by “h1=(h0+dh)+” and “h2=(h0−dh)+,” respectively, where “h0” represents the amount of compression caused by the preload when the system is in a stopped state, and “dh” represents the relative position of a tooth. “(A)+” is such a function that (A)+=A when A≧0 and (A)+=0 when A<0. The normal force
∥{right arrow over (N)}1,wg∥=∥{right arrow over (N)}1,ww∥=kc(h0+dh)+ (7)
∥{right arrow over (N)}2,wg∥=∥{right arrow over (N)}2,ww∥=kc(h0−dh)+ (8)
If the amount of compression of the upper or lower spring becomes zero, the corresponding contact point is lost. The state where one of the two contact points is lost is herein referred to as the “one-point contact state.”
The amount of compression h0 at the time the system is in the stopped state has a value according to the preload F0, the coefficient of stiffness kc, and the pressure angle γ, as given by the following expression (9).
h
0
=F
0/2kcsin(β) (9)
The relative displacement dh is a function of the relative rotation angle of the worm wheel and the worm gear, as given by the following expression (10).
dh=r
wgθwgsin(γ)−rwwθwwcos(γ) (10)
In this expression, “rwg” represents the pitch radius of the worm gear, and “rww” represents the pitch radius of the worm wheel.
The frictional force Ffi.xx, is given by the following expression (11) by using the normal force ∥{right arrow over (N)}1,xx∥ and the coefficient of friction μ (it is herein assumed that the coefficient of friction μ is the same at the two contact points).
F
f1,xx
=μ∥{right arrow over (N)}
1,xx∥ (11)
The above expressions (5), (6) are rewritten to the following expressions (12), (13) by being projected on the axis of motion by using the above expressions (7), (8), (11).
F
cy,ww
=F
C(dh)cos(γ)cos(β)−μFN(dh)sin(γ) (12)
F
cx,wg
=−F
C(dh)sin(γ)cos(β)−μFN(dh)cos(γ) (13)
In the above expressions (12), (13), “FC(dh)” represents an equivalent contact force, and “FN(dh)” is an equivalent normal force. FC(dh) and FN(dh) are given by the following expressions (14), (15).
F
C(dh)=kc((h0+dh)+(h0−dh)+) (14)
F
N(dh)=kcl ((h0+dh)++(h0−dh)+) (15)
Lastly, the interaction forces Fcy,ww, Fcx,wg are converted to torque Tc,ww, Tc,wg by multiplying the interaction forces Fcy,ww, Fcx,wg by the pitch radius, as given by the following expressions (16), (17).
T
c,ww
=r
ww
F
cy,ww (16)
T
c,wg
=r
ww
F
cx,wg (17)
A friction model that is used to calculate the coefficient of friction μ of a meshing part of a gear will be described. In the present embodiment, a LuGre model is used as the friction model. The coefficient of friction μ in the LuGre model is given by the following expression (18) using the sliding velocity vs between two objects and the amount of deflection p of a brush.
In this expression, “μe” represents a Coulomb friction coefficient, “μba.” represents a maximum friction coefficient, “vsb” represents a sliding velocity that provides the Stribeck effect, “σ0” represents the coefficient of stiffness of the brush, and “σ1” represents the damping coefficient of the brush, and “σ2” represents a coefficient of viscous friction. These six parameters are obtained experimentally. The sliding velocity vs as an input in the LuGre model is given by the following expression (19).
v
s
=r
ww
·dθ
ww
/dt·sin(γ)+rwg·dθwg/dt·cos(γ) (19)
In the present embodiment, the frictional force estimation unit 69 estimates the friction (friction to be compensated for) in the power column by using a simulation model that is a simplified model of the complete EPS model 91 of
In the simplified EPS model 92, the motor torque command value Tme is considered to be equal to the motor shaft torque Tms. Moreover, the rotation angle θms of the motor shaft is considered to be equal to the rotation angle θwg of the worm gear, as given by the following expression (20).
θms=θwg (20)
In the simplified EPS model 92, the rotation angle θww of the worm wheel is considered to be equal to the product of the speed reduction ratio i and the rotation angle 0wg of the worm gear, as given by the following expression (21).
θww(t)=iθwg(t) (21)
In the simplified EPS model 92, the speed reduction ratio i is represented by using the pitch radii rww, rwg and the lead angle γ of the worm wheel and the worm gear, as given by the following expression (22).
i=(rww/rwg)·cot(γ) (22)
That is, in the simplified EPS model 92, the number of kinds of inertia is reduced to one, namely J=Jww+i2(Jwg+Jms) where the rotation angle of the column is θ.
Although the worm wheel and the worm gear are unified in this simplified EPS model 92, the influence of the contact state is calculated as the contact state affects the frictional force.
The torsion bar torque Ttb is directly input in the simplified EPS model 92. The simplified EPS model 92 therefore does not include a steering wheel. A reverse input (load torque) T1s to the lower shaft is not measured. However, the load torque T1s can be measured via a vehicle model. As a first approach, a simple spring-damper shaft is typically used as a self-aligning reaction of a wheel. The load torque T1s is given by the following expression (23).
T
1s
=−kθ−c(dθ/dt) (23)
In this expression, “k” and “c” represent the coefficient of stiffness and the coefficient of viscosity of the vehicle model, respectively.
The sliding velocity vs of a meshing part of a gear for the simplified EPS model 92 is given by the following expression (24) by using the expressions (19), (21), (22).
v
s
=r
ww(dθ/dt)/sin(γ) (24)
In the simplified EPS model 92, the above equations of motion (2), (3), (4) are given by the following expression (25).
J{umlaut over (θ)}=T
tb
+iT
ms
−kθ−{dot over (θ)}−μN(dh) (25)
In this expression, “μ” represents the coefficient of friction, “N(dh)” represents the equivalent normal force torque (hereinafter referred to as the “normal force N(dh)”) according to the load condition dh of the speed reduction mechanism and is given by the following expression (26).
N(dh)={rww/sin(γ)}FN(dh) (26)
Referring back to
The external torque T on the worm wheel is “Tww=TtbT1s.” The inertia on the worm gear side is “Jwg+Jms,” and the external torque is the motor shaft torque Tms. In a stable state, θww=iθwg=iθms.
The following expression is obtained by applying these expressions to the above equations of motion (2), (3), (4).
(1/Jww−)(Tww+rwwcos(γ)cos(β)FC(dh)−rwwμsin(γ)FN(dh)=(1/i(Jwg+Jms))(Tms−rwgsin(γ)cos(β)FC(dh)−rwgμcos(γ)FN(dh)) (27)
If it is assumed that the friction term μFN(dh) can be ignored (μFN(dh)=0) as compared to the normal force term FC(dh), FC(dh) is given by the following expression (28).
F
C(dh)=iJwwTms−i2(Jwg−Jms(Tww)/(rwwcos(γ)cos (β)J) (28)
The normal force calculation unit 71 calculates the value dh based on the expression (28) and the above expression (14) (see the graph of
The coefficient-of-friction estimation unit 72 calculates the sliding velocity vs based on the above expression (24). At this time, the column angular velocity estimated value {tilde over (ω)} calculated by the observer model 61 is used as “dθ/dt” of the above expression (24). The coefficient-of-friction estimation unit 72 calculates a coefficient-of-friction estimated value {tilde over (μ)} by substituting the calculated sliding velocity vs for the above expression (18). The frictional force calculation unit 73 calculates an estimated value {tilde over (μ)}N(d{tilde over (h)}) of the frictional force by multiplying the normal force estimated value N({tilde over (d)}h) calculated by the normal force calculation unit 71 by the coefficient-of-friction estimated value {tilde over (μ)} calculated by the coefficient-of-friction estimation unit 72.
In the present embodiment, the frictional force estimation unit 69 estimates the friction that is generated in the speed reduction mechanism 19, based on the simplified EPS model 92 in which the friction that is generated in the speed reduction mechanism 19 is considered. The motor torque command value is calculated by using the estimated friction and the assist torque command value. The friction that is generated in the speed reduction mechanism 19 can thus be compensated for.
In the present embodiment, the simplified EPS model 92 of
A method for setting the proportional gain kp and the derivative gain (feedback gains) that are used by the PD control unit 45, the first gain lp (model correction gain) that is used by the first gain multiplication unit 64 in the plant observer 48, and the second gain lv (model correction gain) that is used by the second gain multiplication unit 68 in the plant observer 48 will be described.
An equation of motion of this model is given by the following expression (29).
m·d
2
x/dt+c·dx/dt+kx=f (29)
In this expression, “m” represents mass, “c” represents a damping coefficient, “k” represents a coefficient of spring (coefficient of stiffness), “d2x/dt” represents acceleration, “dx/dt” represents a velocity, “x” represents displacement, and “f” represents an external force.
The following expression (30) is obtained by Laplace transform of the expression (29).
(ms2+cs+k)X=F (30)
In this expression, “X” represents Laplace transform of the displacement, “F” represents Laplace transform of the external force, and “s” represents a Laplace operator.
The transfer function H(s) is given by the following expression (31).
H(s)=X(s)/F(s)=1/(ms2+es+k) (31)
The denominator of the right side of the expression (31) is called a characteristic equation (ms2+es+k=0).
The root of the characteristic equation is given by the following expression (32).
s={−c±√(e2−4mk)}/2m (32)
In the case where the root of the characteristic equation is a double root, this corresponds to the boundary between oscillatory behavior and non-oscillatory behavior (critical damping).
When the critical damping coefficient cc is 2√(mk) and the damping ratio ζis c/cc, the characteristic equation is given by the following expression (33).
s
2+2ζ(k/m)·s+k/m=0 (33)
When the natural angular frequency ω0 is √(k/m), the characteristic equation is given by the following expression (34).
s
2+2ζω0s+ω02=0 (34)
When critical damping is achieved (ζ=1), the expression (34) is rewritten to the following expression (35).
s
2+2ω0s+ω02=0 (35)
When critical damping is achieved (ζ=1), the system is responsive and non-oscillatory.
In the present embodiment, the proportional gain kp, the derivative gain kv, the first gain lp, and the second gain lv are set by using the response at the time critical damping is achieved as a target response.
Referring to
J{umlaut over (θ)}=T−kθ−c{dot over (θ)}+k
p({circumflex over (θ)}−{tilde over (θ)})+kv(−)+{tilde over (μ)}N−μN (36)
J
T−k{tilde over (θ)}−c+kp({circumflex over (θ)}−{tilde over (θ)})+kp(−)+lv() (37)
J
=T−k{circumflex over (θ)}−c (38)
T=T
tb
+iT
a (39)
The expression (36) is the equation of motion of the object to be controlled, the expression (37) is the equation of motion of the plant observer 48, and the expression (38) is the equation of motion of the reference model 43. TA of the right side of the expression (36) represents the frictional force estimated value {tilde over (μ)}N(d{tilde over (h)}), and μN represents the actual frictional force μN(dh). {tilde over (μ)}N−μN is a deviation of friction compensation.
φ=θ−{tilde over (θ)} is defined as the error of the plant observer 48, and {tilde over (φ)}={tilde over (θ)}−{circumflex over (θ)} is defined as the error between the plant observer 48 and the reference model 43.
The following two equations (40), (41) representing the behavior of the control system are obtained from the above three equations (36), (37), (38) by using φ and {tilde over (φ)}.
J{umlaut over (φ)}+(c+σ2N+b 1v){dot over (φ)}+(k+1p)φ=+{tilde over (μ)}N−μN (40)
J
(c+kv)+(k+kp){tilde over (φ)}=lpφ+lvφ (41)
Characteristic equations corresponding to the equations (40), (41) are given by the following expressions (42), (43).
s
2+{(c+σ2N+1v)/J}s+(k+1p)/J=0 (42)
s
2+{(c+kv)/J}s+(k+kp)/J=0 (43)
If the proportional gain kp, the derivative gain kv, the first gain lp, and the second gain lv are set so that the characteristic equations (42), (43) have a double root (negative real number), the response corresponding to critical damping is obtained. The following expression (44) need be satisfied in order for the characteristic equation (42) to have a double root of s=−C1 (C1 is a positive real number), and the following expression (45) need be satisfied in order for the characteristic equation (43) to have a double root of s=−C2 (C2 is a positive real number).
(s−(C1))2=s2+2C1·s+C12+0 (44)
(s−(C2))2=s2+2C2·s+C22=0 (45)
The following expression (46) is obtained by comparing the coefficients of the expressions (42), (44), and the following expression (47) is obtained by comparing the coefficients of the expressions (43), (45).
C1 is set to a desired value, and the first gain lp and the second gain l, are decided based on the expression (46). Similarly, C2 is set to a desired value, and the proportional gain kp and the derivative gain are decided based on the expression (47). C1 and C2 are parameters that design an intended response.
A highly responsive, non-oscillatory control system is thus implemented by deciding the proportional gain kp, the derivative gain kv, the first gain lp, and the second gain l, in this manner.
In the above embodiment, the column rotation angle θ is the rotation angle of the steering shaft (column shaft) 6. However, the column rotation angle 0 may be the rotation angle of the electric motor 18 (motor shaft).
In the above embodiment, the electric motor 18 is a DC motor with a brush. However, the electric motor 18 may be an electric motor other than a DC motor with a brush, such as a three-phase brushless motor.
Various design modifications may be made to the present invention without departing from the spirit and scope of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
2015-061155 | Mar 2015 | JP | national |