The disclosure of Japanese Patent Application No. 2012-257462 filed on Nov. 26, 2012 and No. 2013-191024 filed on Sep. 13, 2013, each including the specification, drawings, and abstract, is incorporated herein by reference in its entirety.
1. Field of the Invention
The invention relates to a control system including an electric motor and a speed reducer that amplifies motor torque generated by the electric motor. An example of such a control system is an electric power steering system (EPS).
2. Description of the Related Art
A column assist-type electric power steering system in which an electric motor and a speed reducer are arranged at a column part has been known as an electric power steering system. Hereinafter, such a system will be referred to as a column-type EPS. The column-type EPS includes, for example, a steering wheel, a steering shaft, an intermediate shaft, a steered mechanism, an electric motor, and a speed reducer. The steering shaft is formed of an input shaft connected to the steering wheel, an output shaft connected to the intermediate shaft, and a torsion bar that connects the input shaft and the output shaft to each other. The electric motor is connected to the output shaft via the speed reducer.
A column in this specification means a part including a steering wheel, an input shaft, a torsion bar, and an output shaft. A power column in this specification means a part including a steering wheel, an input shaft, a torsion bar, an output shaft, a speed reducer, an electric motor, and a control device for the electric motor. A typical column-type EPS in this specification means a column-type EPS that does not have a function of compensating for friction of the speed reducer.
In a typical column-type EPS, motor torque generated by an electric motor is transmitted to an output shaft via a speed reducer. Hereinafter, the motor torque that is transmitted to the output shaft will be referred to as an assist torque. The assist torque transmitted to the output shaft is then transmitted via an intermediate shaft to a steered mechanism including, for example, a rack-and-pinion mechanism. The speed reducer is, for example, a worm gear formed of a worm and a worm wheel. Because friction generated in the speed reducer is large, a response of steering to a steering input may deteriorate due to the influence of the friction.
Therefore, a method of compensating for friction generated in a speed reducer has been developed in order to improve a response of steering to a steering input. A simplest friction compensation method is a method in which a certain value of frictional force is added to an assist torque command value depending on a sign of a steering velocity.
Japanese Patent Application Publication No. 2003-170856 (JP 2003-170856 A), Japanese Patent Application Publication No. 2000-103349 (JP 2000-103349 A), and Japanese Patent Application Publication No. 2003-291834 (JP 2003-291834 A) each describe a method of compensating for friction on the basis of an assist torque command value, which is computed on the basis of a detected steering torque detected by a torque sensor, and the detected steering torque. Specifically, the magnitude of a frictional force of a speed reducer is estimated on the basis of the assist torque command value. The sign of the frictional force of the speed reducer is determined on the basis of the detected steering torque. The frictional force of the speed reducer is estimated in this way. The value of the estimated frictional force of the speed reducer is added to the assist torque command value.
One object of the invention is to provide a control system capable of compensating for friction generated in a speed reducer by a novel friction compensation method.
1) A control system according to an aspect of the invention is a control system including an electric motor and a speed reducer that amplifies motor torque generated by the electric motor, the control system further including:
a basic motor torque command value computation unit that computes a basic motor torque command value for the electric motor;
an external torque specifying unit that specifies external torque that is applied to the speed reducer and that is other than the motor torque;
a motor angular velocity computation unit that computes an angular velocity of the electric motor with use of a model formed on an assumption that friction is not generated in the speed reducer or with use of a model obtained by modifying the model formed on the assumption that friction is not generated in the speed reducer, based on an actually-measured motor angular velocity;
a friction compensation control unit that estimates friction to be compensated for, with use of the external torque specified by the external torque specifying unit, the angular velocity computed by the motor angular velocity computation unit, the basic motor torque command value computed by the basic motor torque command value computation unit, and a simulation model of the control system in which the friction to be compensated for including at least friction generated in the speed reducer out of friction generated in the control system is taken into account;
a motor torque command value computation unit that computes a motor torque command value that is a target value of the motor torque to be generated from the electric motor, with use of the friction estimated by the friction compensation control unit and the basic motor torque command value computed by the basic motor torque command value computation unit;
and a controller that controls the electric motor based on the motor torque command value computed by the motor torque command value computation unit.
According to the aspect of the invention, the friction to be compensated for, is estimated with use of the external torque that is applied to the speed reducer and that is other than the motor torque, the angular velocity of the electric motor in the case where the assumption is made that friction is not generated in the speed reducer, and the simulation model of the control system. Then, the motor torque command value is computed with use of the estimated friction and the basic motor torque command value. Thus, it is possible to compensate for the friction generated in the speed reducer by the novel friction compensation method.
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:
Hereinafter, embodiments in which the invention is applied to a column-type EPS will be described in detail with reference to the accompanying drawings.
The steering shaft 6 includes an input shaft 8 connected to the steering wheel 2 and an output shaft 9 connected to the intermediate shaft 7. The input shaft 8 and the output shaft 9 are connected to each other via a torsion bar 10 so as to be rotatable relative to each other on the same axis. That is, when the steering wheel 2 is rotated, the input shaft 8 and the output shaft 9 rotate in the same direction while rotating relative to each other. The output shaft 9 is connected 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 a torsion bar torque applied to the torsion bar 10 on the basis of a relative rotational displacement between the input shaft 8 and the output shaft 9. Hereinafter, the torsion bar torque will be referred to as a steering torque Ttb. The steering torque Ttb detected by the torque sensor 11 is input into an electronic control unit 12. Hereinafter, the electronic control unit will be referred to as an ECU.
The steered mechanism 4 is formed of a rack-and-pinion mechanism including a pinion shaft 13 and a rack shaft 14 that serves as a steered shaft. The steered wheels 3 are connected to respective ends of the rack shaft 14 via tie rods 15 and knuckle arms (not illustrated). The pinion shaft 13 is connected to the intermediate shaft 7 via the second universal joint 29. The pinion shaft 13 rotates in response to a steering operation of the steering wheel 2. A pinion 16 is connected to a distal end of the pinion shaft 13.
The rack shaft 14 extends linearly along the lateral direction of a vehicle. The lateral direction is a direction perpendicular to a direction in which the vehicle travels straight ahead. A rack 17 that engages with the pinion 16 is formed in an intermediate portion of the rack shaft 14 in its axial direction. The rotation of the pinion shaft 13 is converted into an axial movement of the rack shaft 14 by the pinion 16 and the rack 17. The steered wheels 3 are steered by moving the rack shaft 14 in the axial direction.
When the steering wheel 2 is steered, the rotation thereof 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 into an axial movement of the rack shaft 14 by the pinion 16 and the rack 17. Thus, the steered wheels 3 are steered. The steering assist mechanism 5 includes an electric motor 18 that generates a steering assist force and a speed reducer 19 that amplifies the torque output from the electric motor 18 and transmits the amplified torque to the steered mechanism 4. In the present embodiment, the electric motor 18 is formed of a three-phase brushless motor. The speed reducer 19 is formed of a worm gear including a worm 20 and a worm wheel 21 engaged with the worm 20. The speed reducer 19 is accommodated in a gear housing 22 that serves as a transmission mechanism housing.
The worm 20 is driven to be rotated by the electric motor 18. The worm wheel 21 is connected to the steering shaft 6 so as to be rotatable in the same direction as the rotation direction of the steering shaft 6. The worm wheel 21 is driven to be rotated by the worm 20. The worm 20 is driven to be rotated by the electric motor 18. Thus, the worm wheel 21 is driven to be rotated, and the motor torque is applied to the steering shaft 6, causing the steering shaft 6 to rotate. The rotation of the steering shaft 6 is transmitted to the pinion shaft 13 via the intermediate shaft 7. The rotation of the pinion shaft 13 is converted into an axial movement of the rack shaft 14. Thus, the steered wheels 3 are turned. That is, when the worm 20 is driven to be rotated by the electric motor 18, it is possible to realize steering assist with the use of the electric motor 18.
The torque applied to the speed reducer 19 includes motor torque generated by the electric motor 18 and external torque other than the motor torque. The external torque other than the motor torque includes steering torque applied to the steering wheel 2 by a driver and load torque applied to the rack shaft 14 and the speed reducer 19 from the steered wheel 3 side.
A rotation angle of a rotor of the electric motor 18 is detected by a rotation angle sensor 25 such as a resolver. A vehicle speed is detected by a vehicle speed sensor 26. A signal output from the rotation angle sensor 25 and a vehicle speed V detected by the vehicle speed sensor 26 are input into the ECU 12. The electric motor 18 is controlled by the ECU 12 that serves as a motor controller.
The ECU 12 includes a microcomputer 40, a drive circuit 31 that is controlled by the microcomputer 40 and that supplies electric power to the electric motor 18, and a current sensing resistor 32 and a current detecting circuit 33 that are used to detect a current passing through the electric motor 18. Hereinafter, the current passing through the electric motor 18 will be referred to as a motor current. The microcomputer 40 includes a CPU and memories, and serves as multiple functional processing units by executing predetermined programs. The memories include a ROM, a RAM, a nonvolatile memory, and the like. The multiple functional processing units include a rotation angle computation unit 41, a motor angular velocity computation unit 42, a motor angular velocity estimation unit 43 in which mathematical models are used, a friction compensation control unit 44, an angular velocity deviation computation unit 45, a PI control unit 46, a basic assist torque command value computation unit 47, a first addition unit 48, a second addition unit 49, a current command value computation unit 50, a current deviation computation unit 51, a PI control unit 52, and a PWM control unit 53. PI is an abbreviation for proportional integral, and PWM is an abbreviation for pulse width modulation.
The rotation angle computation unit 41 computes a rotation angle θm of the electric motor 18 on the basis of a signal output from the rotation angle sensor 25. The motor angular velocity computation unit 42 computes an angular velocity of a rotor of the electric motor 18 by subjecting the rotation angle θm, which is computed by the rotation angle computation unit 41, to temporal differentiation. Hereinafter, the angular velocity of the rotor of the electric motor will be referred to as an actual motor angular velocity ωm,meas. The motor angular velocity estimation unit 43 estimates an angular velocity (hereinafter, referred to as “estimated motor angular velocity ωm,ref”) of the rotor of the electric motor 18 when the assumption is made that friction is not generated in the power column, on the basis of the detected steering torque Ttb detected by the torque sensor 11, and includes a mathematical vehicle model 54 and a mathematical frictionless column-type EPS model 55. Hereinafter, the angular velocity of the rotor of the electric motor estimated by the motor angular velocity estimation unit 43 will be referred to as an estimated motor angular velocity ωm,ref In the present embodiment, the vehicle model 54 is a two-wheeled model described in “Automotive Vehicle Dynamics, Theory and Applications”, written by Masato ABE, published by the Tokyo Denki University Press, second printing of the first edition, Sep. 20, 2009. The two-wheeled model is a model equivalent to a four-wheeled vehicle.
The vehicle model 54 receives, as an input, the estimated motor angular velocity ωm,ref computed by the frictionless column-type EPS model 55, and outputs an estimated load torque Tload. The estimated load torque Tload is a value obtained by converting an estimated value of a load applied from the steered wheel 3 side to the rack shaft 14, into a load torque of the power column.
The frictionless column-type EPS model 55 is a virtual column-type EPS model in which friction is not generated in the power column. The frictionless column-type EPS model 55 receives, as inputs, the detected steering torque Ttb detected by the torque sensor 11 and the estimated load torque Tload computed by the vehicle model 54, and outputs the estimated motor angular velocity ωm,ref. The detected steering torque Ttb detected by the torque sensor 11 and the estimated load torque Tload computed by the vehicle model 54 serve as external torque, which is applied to the speed reducer 19 and which is other than the motor torque. That is, the torque sensor 11 is a first external torque specifying unit and the vehicle model 54 is a second external torque specifying unit. Details of the frictionless column-type EPS model 55 will be described later.
The angular velocity deviation computation unit 45 computes an angular velocity deviation Δωm=ωm,ref−ωm,meas between the estimated motor angular velocity ωm,ref estimated by the motor angular velocity estimation unit 43 and the actual motor angular velocity ωm,meas computed by the motor angular velocity computation unit 42. The PT control unit 46 is provided to improve robustness of friction compensation. The PI control unit 46 outputs a first assist torque correction value Ta,PI by executing PI computation on the angular velocity deviation Δωm computed by the angular velocity deviation computation unit 45.
The basic assist torque command value computation unit 47 computes a basic assist torque command value Tb on the basis of the vehicle speed V detected by the vehicle speed sensor 26 and the detected steering for torque Ttb detected by the torque sensor 11. The basic assist torque command value computation unit 47 corresponds to the basic motor torque command value computation unit in this invention. The first addition unit 48 computes a first assist torque command value Tab by adding together the basic assist torque command value Tb computed by the basic assist torque command value computation unit 47 and the first assist torque correction value Ta,PI computed by the PI control unit 46.
The detected steering torque Ttb detected by the torque sensor 11, the estimated motor angular velocity ωm,ref computed by the frictionless column-type EPS model 55, the estimated load torque Tload computed by the vehicle model 54, and the first assist torque command value Tab are input into the friction compensation control unit 44. The friction compensation control unit will be also referred to as a friction controller. The friction compensation control unit 44 estimates a frictional force generated in the power column with the use of the above-described inputs and a control model 71 (described later), and outputs a second assist torque correction value Ta,FC corresponding to the estimated frictional force. Details of the friction compensation control unit 44 will be described later. The second addition unit 49 computes a second assist torque command value Tabc by adding the second assist torque correction value Ta,FC computed by the friction compensation control unit 44 to the first assist torque command value Tab computed by the first addition unit 48.
The current command value computation unit 50 computes a current command value Im* by dividing the assist torque command value Tabc by a torque constant of the electric motor 18. The current deviation computation unit 51 computes a deviation ΔIm=Im*−Im between the current command value Im* computed by the current command value computation unit 50 and an actual motor current Im detected by the current detecting circuit 33. The PI control unit 52 computes a voltage command value, which is a value of the voltage that should be applied to the electric motor 18, by executing PI computation on the current deviation ΔIm computed by the current deviation computation unit 51.
The PWM control unit 53 produces a PWM signal with a duty ratio corresponding to the voltage command value computed by the PI control unit 52, and supplies the produced PWM signal to the motor driving circuit 31. The motor driving circuit 31 is an H-bridge circuit and includes multiple power elements. The multiple power elements are turned on and off on the basis of the PWM signals supplied from the PWM control unit, whereby a voltage corresponding to the voltage command value is applied to the electric motor 18.
The current deviation computation unit 51 and the PI control unit 52 constitute a current feedback controller. By the operation of the current feedback controller, the motor current passing through the electric motor 18 is controlled so as to approach the current command value Im*.
Next, the friction compensation control unit 44 will be described with reference to
The simulation model 60 includes a power column 61, an intermediate shaft, two universal joints, and a rack-and-pinion gear. The power column 61 includes a steering wheel, an assist motor system, a worm, and a worm wheel. The worm and the worm wheel constitute a speed reducer. The assist motor system includes an assist motor and a motor controller that controls the assist motor. The motor controller included in the simulation model 60 is a typical motor controller that does not have a friction compensation function. For example, the motor controller computes a current command value on the basis of the input torque signal Ereq and the vehicle speed signal Eveh, and executes feedback control such that the current passing through the assist motor becomes equal to the current command value. The rack-and-pinion gear includes a pinion and a rack.
In
The power column 61 in the simulation model 60 illustrated in
Equations of motion are expressed by Expressions (1), (2) from
m
wg{right arrow over ({dot over (v)}wg={right arrow over (F)}wg,tot+{right arrow over (N)}1,wg+{right arrow over (N)}2,wg+{right arrow over (F)}cf1,wg+{right arrow over (F)}cf2,wg (1)
m
ww{right arrow over ({dot over (v)}ww={right arrow over (F)}ww,tot+{right arrow over (N)}1,ww+{right arrow over (N)}2,ww+{right arrow over (F)}cf1,ww+{right arrow over (F)}cf2,ww (2)
Here, vwg and vww represent velocities of the worm and the worm wheel, respectively. The x component and the y component of the velocities vwg, vww of the worm and the warm wheel are expressed by products of the pitch circle radii rwg, rww and the angular velocities ωwg, ωww of the gears. Fwg,tot represents the sum of an external force Fwg that acts on the worm and the torque loss (which depends on a radial force Fbr,wg and an axial force Fba,wg) due to the friction of the bearing that supports the worm. In the following description, the assumption is made that the torque loss is zero. Fww,tot represents the sum of an external force F, that acts on the worm wheel and the torque loss due to the friction of the bearing that supports the worm wheel. The torque loss depends on a radial force Fbr,ww and an axial force Fba,ww. In the following description, the assumption is made that the torque loss is zero.
A normal force Ni,j of the tooth surface is expressed by Expression (3) with the use of a stiffness coefficient k, and a viscosity coefficient ccw of the engagement point between the teeth.
N
i,j
=k
cw(Δhi,cw+h0,cw)+ccwΔ{dot over (h)}i,cwi=1,2j=wg,ww (3)
Here, a subscript i represents engagement points on the upper side and the lower side in
Δhi,cw=±(xwg sin(γw)−yww cos(γw)), where i=1,2 (4)
The frictional force Fcfi,j of the tooth surface is expressed by Expressions (5), (6) with the use of a friction coefficient μcw that depends on the normal force and the sliding velocity vcw.
F
cfi,j=μcw(vcw)|Ni,j|i=1,2j=wg,ww (5)
{right arrow over (v)}
cw
={right arrow over (v)}
wg
−{right arrow over (v)}
ww (6)
The friction coefficient can be obtained on the basis of a LuGre model (described later). In the present embodiment, the friction compensation control unit 44 estimates the friction in the power column, which is to be compensated for, with the use of a simulation model that is obtained by simplifying the model 61 of the power column illustrated in
In the control model 71, the assist motor, the worm and the worm wheel in the model 61 of the power column illustrated in
An equation of motion regarding the steering wheel in the control model 71 and an equation of motion regarding the lower column (the worm and the worm wheel) are expressed by Expressions (7), (8), respectively.
Here, Jsw represents inertia of the steering wheel. dωsw/dt represents an acceleration of the steering wheel. Tsw represents a torque applied to the steering wheel. Ttb represents a torsion bar torque, that is, a steering torque. Tload represents a load torque transmitted from the rack to the lower column including the speed reducer. Ta represents an assist torque applied to the work by the assist motor. Jww+(Jwg+Jm)i2η the left side of Expression (8) is inertia J1 of the lower column. Jww represents inertia of the worm wheel, Jwg represents inertia of the worm, and Jm represents inertia of the assist motor. dω1/dt represents an acceleration of the lower column.
The worm is pressed against the worm wheel by a preload mechanism (not illustrated). F0 represents a force with which the worm is pressed against the worm wheel by the preload mechanism, and will be referred to as a preload. The preload is applied to the worm in its radial direction. μ represents a friction coefficient of the power column, and includes a friction coefficient of the engagement portion of the worm gear, a friction coefficient between the worm and the bearing that supports the worm, and a friction coefficient between the worm wheel and the bearing that supports the worm wheel. rww represents a pitch circle radius of the worm wheel. βw represents a pressure angle of the worm gear. γw represents a lead angle of the worm gear. Here, i represents a gear ratio, that is, a reduction ratio, of the worm gear, and is defined as a ratio ωwg/ωww of the angular velocity of the worm to the angular velocity of the worm wheel, η represents an efficiency of the worm gear.
The reduction ratio i and the efficiency η of the worm gear are expressed by Expressions (9), (10), respectively.
Here, rwg represents a pitch circle radius of the worm. As can be apparently seen from Expressions (8), (10), the friction coefficient μ of the power column is included in an equation of motion regarding the worm wheel, and the forces that act on the worm wheel and the lower column are influenced by the friction generated in the power column. Because the worm is pressed against the worm wheel by the preload F0, the state of contact between the worm and the world wheel is classified into a single contact state in which the worm and the worm wheel contact each other at one point and a double contact state in which the worm and the worm wheel contact with each other at two points, Hereinafter, the state of contact between the worm and the worm wheel will be referred to as a contact state of the speed reducer. The contact state of the speed reducer changes depending on the magnitude of the torque transmitted to the speed reducer.
τ0 in Expression (8) and τ1 in Expression (10) are variables that vary depending on the contact state of the speed reducer. The values of the variables τ0, τ1 are determined on the basis of the initial contact force due to the preload F0, that is, the contact force N0 in the direction of a normal to the tooth surface, and a contact force variation dNc. The contact force variation dNc can be calculated, for example, as follows.
The equations of motion expressed by Expressions (1), (2) can be expressed by Expressions (11), (12) with the use of Expression (3) and
Equations of motion (13), (14) in the rotation direction are obtained from Expressions (11), (12).
J
wg{right arrow over (ω)}wg=Twg+rwg cos(βw)sin(γw)(−kcw(Δh1,cw+h0,cw)+kcw(Δh2,cw+h0,cw))+rwgμ cos(γw)(−kcw(Δh1,cw+h0,cw)−kcw(Δh2,cw+h0,cw)) (13)
J
ww{right arrow over (ω)}ww=Tww+rww cos(βw)cos(γw)(kcw(Δh1,cw+h0,cw)−kcw(Δh1,cw+h0,cw))+rwwμ sin(γw)−kcw(Δh1,cw+h0,cw)−kcw(Δh2,cw+h0,cw)) (14)
Twg in Expression (13) represents a torque that acts on the worm. Tww in Expression (14) represents a torque that acts on the worm wheel. Tww=Ttb+Tload is established. Because the relationship Δh2,cw=Δh1,cw is established, the terms of a normal force in Expressions (13), (14) can be expressed by Expressions (15), (16), respectively.
In Expressions (15), (16), notation (A)+ indicates that (A)+=A is established when A≧0, and (A)+=0 is established when (A)<0.
On the other hand, the terms of the frictional force in Expressions (13), (14) can be expressed by Expressions (17), (18), respectively.
When kcw((h0,cw+Δh1,cw)+−(h0,cw−Δh1,cw)+) in Expressions (15), (16) is set as the contact force variation dNc, and kcw((h0,cw+Δh1,cw)+)+(h0,cw−Δh1,cw)+) in Expressions (17), (18) is set as the normal force dNf, the equations of motion (13), (14) in the rotation direction can be expressed by Expressions (19), (20), respectively.
J
wg{dot over (ω)}wg=Twg−rwg cos(βw)sin(γw)dNc−rwgμdNf cos(γw) (19)
J
ww
{dot over (ω)}
ww
=T
tb
+T
load
+r
ww cos(βw)cos(γw)dNc−rwwμdNf sin(γw) (20)
When dNf=0 is set and the relationship ωwg=i×ωww is used, the contact force variation dNc can be calculated from Expressions (19), (20). At this time, the first assist torque command value Tab is used as Twg. The steering torque Ttb detected by the torque sensor 11 is used as the torsion bar torque Ttb. The load torque Tload output from the vehicle model 54 is used as the load torque Tload. The basic assist torque command value Tb may be used as Twg.
The initial contact force N0 can be calculated from F0/sin βw. It is determined that the contact state is the double contact state when N0−|dNc|>0 is satisfied, whereas it is determined that the contact state is the single contact state when N0−|dNc≦0 is satisfied.
Table 1 shows conditions for discriminating the contact state of the speed reducer.
When N0−|dNc|>0 is satisfied, it is determined that the contact state is the double contact state, the value of τ0 is 1, and the value of τ1 is 0. When N0−|dNc|≦0 and dNc≧0 are satisfied, it is determined that the contact state is the single contact state, the value of τ0 is 0, and the value of τ1 is 1. When N0−|dNc|≦0 and dNc≦0 are satisfied, it is determined that the contact state is the single contact state, the value of τ0 is 0, and the value of τ1 is 1. The contact state determination unit 61 illustrated in
When the assumption is made that friction is not generated in the control model 71 illustrated in
(Jww+(Jwg+Jm)i2){dot over (ω)}1=Ttb+Tload (21)
When friction is not generated in the control model 71, μ in Expressions (8), (10) is 0. Therefore, η is 1. Expression (21) can be induced by setting η in Expression (8) to 1 and setting Ta and μ in Expression (8) to 0. Expression (8) is an equation of motion in the case where the friction in the power column is taken into account, whereas Expression (21) is an equation of motion in the case where the assumption is made that friction is not generated in the power column. The frictional force estimation unit 63 illustrated in
The method of computing the second assist torque correction value Ta,FC as a method of estimating a frictional force varies depending on the contact state of the speed reducer. First, the method of computing the second assist torque correction value Ta,FC when the contact state of the speed reducer is the double contact state will be described. In the control model 71 illustrated in
Therefore, the equation of motion regarding the worm wheel in the case where the contact state of the speed reducer is the double contact state is expressed by Expression (22) by substituting τ0=1 and τ1=0 into Expression (8).
When the term [Tai−μF0 {rww/sin(γw)sin(βw)}] in the right side of Expression (22) can be brought to be zero, the equation of motion (21) in the case where the assumption is made that there is no friction is established. Therefore, the frictional force estimation unit 63 (see
The expression for computing the second assist torque correction value Ta,FC when the contact state of the speed reducer is the double contact state is expressed by Expression (23).
Here, the friction coefficient μ estimated by the friction coefficient estimation unit 62 (described later) is used as the friction coefficient μ.
The method of computing the second assist torque correction value Ta,FC when the contact state of the speed reducer is the single contact state will be described. In the control model 71 illustrated in
Therefore, the equation of motion regarding the worm wheel in the case where the contact state of the speed reducer is the single contact state is expressed by Expression (24) by substituting τ0=0 into Expression (8).
The form of the equation of motion (21) in the case where the assumption is made that there is no friction is modified as shown in Expression (21a) so as to correspond to the form of Expression (24).
When the term Δx1 in the left side of Expression (21a) is transposed to the right side, Expression (21b) is obtained.
When the second term Tai in the right side of Expression (24) is equal to the term (Δx1·dω1/dt+Δx2) in the right side of Expression (21a), the equation of motion (21b) in the case where the assumption is made that there is no friction is established. Therefore, the frictional force estimation unit 63 computes the assist torque Ta at which Tai=−Δx1·dω1/dt+Δx is established, as the second assist torque correction value Ta,FC. In other words, the term (Δx1·dω1/dt+Δx2) obtained by inverting the sign of the term (−Δx1·dω1/dt+Δx2) in the right side of Expression (21b) represents a frictional force generated in the power column when the contact state of the speed reducer is the single contact state. Therefore, the frictional force estimation unit 63 computes the assist torque Ta for cancelling out the frictional force, as the second assist torque correction value Ta,FC.
The expression for computing the second assist torque correction value Ta,FC when the contact state of the speed reducer is the single contact state is expressed by Expression (25).
Here, the efficiency η estimated from the friction coefficient μ estimated by the friction coefficient estimation unit 62 and Expression (10) is used as the efficiency η. The angular velocity ω1 of the lower column is calculated as a product (ωm,ref·i) of the estimated motor angular velocity ωm,ref estimated by the motor angular velocity estimation unit 43 and the gear ratio i. The angular acceleration dω1/dt of the lower column is calculated from the angular velocity ω1 of the lower column. The steering torque Ttb detected by the torque sensor 11 is used as the torsion bar torque Ttb. The load torque Tload output from the vehicle model 54 is used as the load torque Tload.
That is, when it is determined that the contact state of the speed reducer is the double contact state, the frictional force estimation unit 63 computes the second assist torque correction value Ta,FC on the basis of Expression (23). On the other hand, when it is determined that the contact state of the speed reducer is the single contact state, the frictional force estimation unit 63 computes the second assist torque correction value Ta,FC on the basis of Expression (25).
The friction coefficient estimation unit 62 will be described below. The friction coefficient estimation unit 62 estimates the friction coefficient of the power column with the use of a LuGre model. The friction coefficient μ based on the LuGre model is expressed by Expression (26) with the use of the sliding velocity vs between two objects and the deflection p of the brush.
Here, μc represents a coulomb friction coefficient. μba represents a maximum friction coefficient. vsb represents a sliding velocity at which a Stribeck effect is exhibited. σ0 represents a stiffness coefficient of the brush. σ1 represents an attenuation coefficient of the brush. σ2 represents a viscous friction coefficient. These six parameters are empirically obtained.
The sliding velocity vs that is an input into the LuGre model is computed on the basis of Expression (27).
v
s
=r
wg·ωm,ref/cos(γm) (27)
That is, the friction coefficient estimation unit 62 estimates the friction coefficient μ of the power column with the use of the estimated motor angular velocity ωm,ref estimated by the motor angular velocity estimation unit 43 and the LuGre model expressed by Expression (26).
A model obtained by excluding the frictions Fcf,ww, Fcf,wg, Tf,ww, Tf,wg in the power column, from the typical column-type EPS simulation model 60 illustrated in
In the first embodiment, the friction compensation control unit 44 estimates the friction generated in the speed reducer 19 on the basis of the control model 71 in which the friction generated in the speed reducer 19 is taken into account and the load torque Tload applied to the speed reducer 19 is included as an input. Accordingly, in the first embodiment, the friction that depends on the load transmitted to the speed reducer 19 can be taken into account. In the first embodiment, because the friction compensation control unit 44 estimates the friction generated in the speed reducer 19 with the use of the friction coefficient μ that depends on the sliding velocity vs of the speed reducer 19, it is possible to compensate for the variation of the friction coefficient that depends on the sliding velocity vs of the speed reducer 19.
The effect of the friction compensation in the first embodiment is verified with the use of a power column test bench.
An output shaft of the power column 100 is connected to a second rotary shaft 106 via a shaft coupling 105. Instead of actual rack load, a load is applied to the second rotary shaft 106 by a torsion spring 107. The torsion spring constant of the torsion spring 107 is 0.6 Nm/rad in this example. A second torque sensor 112 that detects a torque output from the power column 100 is disposed around the second rotary shaft 106. The power column 100 is provided with a rotation angle sensor 113 that detects a rotation angle of an assist motor (electric motor 18). A sinusoidal input torque with a small amplitude (1 Nm in this example) and a low frequency (0.1 Hz in this example) is applied to the power column 100 by the servo-motor 104.
It can be understood from
While the first embodiment of the invention has been described, the invention may be implemented in various other embodiments. For example, the friction compensation control unit 44 may be replaced with a friction compensation control unit 44A as illustrated in
The normal force computation unit 64 and the frictional force estimation unit 66 will be described below. As described above, Expressions (19), (20) are expressions obtained by simplifying the equations of motion (13), (14) in the rotation direction with the use of the contact force variation dNc and the normal force dNf.
J
wg{dot over (ω)}wg=Twg−rwg cos(βw)sin(γw)dNc−rwgμdNf cos(γw) (19)
J
ww{dot over (ω)}ww=Ttb+Tload+rww cos(βw)cos(γw)dNc−rwwμdNf sin(γw) (20)
With the use of the relationship ωwg=i×ωww, by erasing dNf in Expressions (19), (20), an equation of motion (28) is obtained.
Because the fourth term in the right side of the equation of motion (28) represents a frictional torque generated in the lower column, the torque (μdNf·rww/sin(γw)) for compensating for the frictional torque is added, as the second assist torque correction value Ta,FC, to the first assist torque command value Tab.
The normal force computation unit 64 calculates the contact force variation dNc from Expressions (19), (20) by setting dNf in Expressions (19), (20) to 0, with the use of the relationship ωwg=i×ωww. At this time, the first assist torque command value Tab is used as Twg. The steering torque Ttb detected by the torque sensor 11 is used as the torsion bar torque Ttb. The load torque Tload output from the vehicle model 54 is used as the load torque Tload. The basic assist torque command value Tb may be used as Twg.
The normal force computation unit 64 calculates the initial contact force No on the basis of N0=F0/sin βw. When N0−|dNc|>0 is satisfied, the contact state is the double contact state. When N0−|dNc|≦0 is satisfied, the contact state is the single contact state. The normal force computation unit 64 computes the normal force dNf on the basis of Expression (29).
dN
f=max(|dNc|,N0) (29)
That is, the normal force dNf is set to the larger value of |dNc| and N0. The frictional force Ffric,comp is expressed by Expression (30).
F
fric,comp (30)
The friction coefficient estimation unit 65 computes the second assist torque correction value Ta,FC on the basis of Expression (31).
T
a,FC
=μdN
f
·r
ww/sin(γw) (31)
When the friction compensation control unit 44A is used, the friction that depends on the load transmitted to the speed reducer 19 can be taken into account and the variation of the friction coefficient that depends on the sliding velocity vs of the speed reducer 19 can be compensated for.
In the first embodiment, the vehicle model 54 is the two-wheeled vehicle model, but the vehicle model 54 may be a vehicle model other than the two-wheeled vehicle model. Similarly, the frictionless column-type EPS model 55 may be a model other than the above-mentioned two types of models. Similarly, the control model 71 may be a model other than the model illustrated in
In the first embodiment, the second assist torque command value Tabc is computed by adding the second assist torque correction value Ta,FC to the first assist torque command value Tab that is obtained by adding the first assist torque correction value Ta,PI to the basic assist torque command value Tb. Alternatively, the second assist torque command value Tabc may be computed by adding the second assist torque correction value Tabc to the basic assist torque command value Tb. In this case, the basic assist torque command value Tb instead of the first assist torque command value Tab is input into the friction compensation control units 44, 44A. By employing this method, the angular velocity deviation computation unit 45, the PI control unit 46, and the first addition unit 48 may be omitted.
A second embodiment of the invention will be described below with reference to
The ECU 12A realizes steering assist suitable for steering conditions by driving the electric motor 18 on the basis of the detected steering torque Ttb detected by the torque sensor 11 illustrated in
The ECU 12A includes a microcomputer 40A, a drive circuit 31 that is controlled by the microcomputer 40A and that supplies electric power to the electric motor 18, and a current sensing resistor 32 and a current detecting circuit 33 that are used to detect a current passing through the electric motor 18. Hereinafter, the current passing through the electric motor 18 will be referred to as a motor current. The microcomputer 40A includes a CPU and memories, and serves as multiple functional processing units by executing predetermined programs. The memories include a ROM, a RAM, a nonvolatile memory, and the like. The multiple functional processing units include a rotation angle computation unit 41, a target motor rotation angle setting unit 81, an angle deviation computation unit 82, a PD control unit 83, a basic assist torque command value computation unit 47, a first addition unit 84, a second addition unit 85, a plant observer unit 86, a friction compensation control unit 87, a current command value computation unit 50, a current deviation computation unit 51, a PI control unit 52, and a PWM control unit 53. PD is an abbreviation for proportional differential, PI is an abbreviation for proportional integral, and PWM is an abbreviation for pulse width modulation.
The rotation angle computation unit 41 computes a rotation angle θm of the electric motor 18 on the basis of a signal output from the rotation angle sensor 25. The target motor rotation angle setting unit 81 sets a target motor rotation angle θm,tag on the basis of the detected steering torque Ttb detected by the torque sensor 11. The target motor rotation angle setting unit 81 includes a vehicle model 88 and an EPS reference model 89 used to define a desired EPS characteristic. In the present embodiment, the EPS reference model 89 is a virtual column-type EPS model in which friction is not generated in the power column. Hereinafter, the EPS reference model will be referred to as a frictionless column-type EPS model 89.
The vehicle model 88 receives, as an input, the target motor rotation angle θm,tag set by the frictionless column-type EPS model 89, and outputs an estimated load torque Tload1. The estimated load torque Tload1 is a value obtained by converting an estimated value of a load applied to the rack shaft 14 from the steered wheel 3 side illustrated in
The frictionless column-type EPS model 89 receives, as an input, the detected steering torque Ttb detected by the torque sensor 11 and the estimated load torque Tload1 computed by the vehicle model 88, and outputs the target motor rotation angle θm,tag. Details of the frictionless column-type EPS model 89 will be described later.
The angle deviation computation unit 82 computes an angle deviation Δθm1=θm,tag−θm,obs between the target motor rotation angle θm,tag output from the target motor rotation angle setting unit 81 and an estimated motor rotation angle θm,obs output from the plant observer unit 86 (described later). The PD control unit 83 outputs the first assist torque correction value Ta,PD by executing PD computation on the angle deviation Δθm1 computed by the angle deviation computation unit 82.
The basic assist torque command value computation unit 47 computes the basic assist torque command value Tb on the basis of the vehicle speed V detected by the vehicle speed sensor 26 and the detected steering torque Ttb detected by the torque sensor 11. The first addition unit 84 computes the first assist torque command value Tab by adding together the basic assist torque command value Tb computed by the basic assist torque command value computation unit 47 and the first assist torque correction value Ta,PD computed by the PD control unit 83. The second addition unit 85 computes a second assist torque command value Tabc by adding the second assist torque correction value Ta,FC output from the friction compensation control unit 87 (described later) to the first assist torque command value Tab computed by the first addition unit 84.
The current command value computation unit 50 computes a current command value Im* by dividing the assist torque command value Tabc, computed by the second addition unit 85 by a torque constant of the electric motor 18. The current deviation computation unit 51 computes a deviation ΔIm=Im*−Im between the current command value Im* computed by the current command value computation unit 50 and the actual motor current Im detected by the current detecting circuit 33. The PI control unit 52 computes a voltage command value, which is a value of the voltage to be applied to the electric motor 18, by executing PI computation on the current deviation ΔIm computed by the current deviation computation unit 51.
The PWM control unit 53 produces a PWM signal with a duty ratio corresponding to the voltage command value computed by the PI control unit 52, and supplies the produced PWM signal to the motor driving circuit 31. The motor driving circuit 31 is an H-bridge circuit and includes multiple power elements. The multiple power elements are turned on and off on the basis of the PWM signals supplied from the PWM control unit, whereby a voltage corresponding to the voltage command value is applied to the electric motor 18. The current deviation computation unit 51 and the PI control unit 52 constitute a current feedback controller. By the operation of the current feedback controller, the motor current passing through the electric motor 18 is controlled so as to approach the current command value Im*.
The plant observer unit 86 and the friction compensation control unit 87 will be described below in detail.
The vehicle model 91 receives, as an input, an estimated worm wheel angular velocity ωww,obs computed by the frictionless column-type EPS model 92, and outputs an estimated load torque Tload2. The estimated load torque Tload2 is an estimated value of the load torque that is applied from the steered wheel 3 side to the rack shaft 14. In the present embodiment, the vehicle model 91 is a two-wheeled model described in “Automotive Vehicle Dynamics, Theory and Applications”, written by Masato ABE, published by the Tokyo Denki University Press, second printing of the first edition, Sep. 20, 2009. The two-wheeled model is a model equivalent to a four-wheeled vehicle.
The frictionless column-type EPS model 92 is a virtual column-type EPS model in which friction is not generated in the power column. Note that, the configuration of the frictionless column-type EPS model 92 is corrected by a first model correction term G1·Δθm2 and a second model correction term G2·Δωm (described later).
The detected steering torque Ttb detected by the torque sensor 11, the estimated load torque Tload2 computed by the vehicle model 91, the first assist torque command value Tab computed by the first addition unit 84 illustrated in
The estimated worm wheel torque Tww,obs is the sum (Ttb+Tload2) of the detected steering torque Ttb detected by the torque sensor 11 and the estimated load torque Tload2 computed by the vehicle model 91. Therefore, the estimated worm wheel torque Tww,obs is an estimated value of an external torque, which is applied to the speed reducer 19 and which is other than the motor torque. That is, the external torque specifying unit corresponds to the frictionless column-type EPS model 92 and the plant observer unit 86 including the model 92.
The first reduction ratio multiplying unit 93 computes the estimated motor rotation angle θm,obs by multiplying the estimated worm wheel rotation angle θww,obs computed by the frictionless column-type EPS model 92 by the reduction ratio i=ωwg/ωww of the speed reducer 19. The angle deviation computation unit 94 computes an angle deviation Δθm2=θm,obs−θm between the motor rotation angle θm computed by the rotation angle computation unit 41 illustrated in
The motor angular velocity computation unit 96 computes the angular velocity of a rotor of the electric motor 18 by subjecting the motor rotation angle θm computed by the rotation angle computation unit 41, to temporal differentiation. Hereinafter, the angular velocity of the electric motor 18 computed through the temporal differentiation will be referred to as an actual motor angular velocity ωm,meas. The second reduction ratio multiplying unit 97 computes the estimated motor angular velocity ωm,obs by multiplying the estimated worm wheel angular velocity ωww,obs computed by the frictionless column-type EPS model 92 by the reduction ratio i=ωwg/ωww of the speed reducer 19.
The angular velocity deviation computation unit 98 computes an angular velocity deviation Δωm2=ωm,obs−ωm,meas between the actual motor angular velocity ωm,meas computed by the motor angular velocity computation unit 96 and the estimated motor angular velocity ωm,obs computed by the second reduction ratio multiplying unit 97. The second gain multiplying unit 99 computes the second model correction term G2·Δωm2 regarging the velocity by multiplying the angular velocity deviation Δωm computed by the angular velocity deviation computation unit 98 by a predetermined second gain G2.
The first model correction term G1·Δωm2 regarding the angle and the second model correction term G2·Δωm2 regarding the velocity are used to correct the configuration of the frictionless column-type EPS model 92. That is, the configuration of the frictionless column-type EPS model 92 is corrected such that the estimated motor rotation angle θm,obs computed on the basis of the output from the frictionless column-type EPS model 92 becomes equal to the actual motor rotation angle θm and the estimated motor angular velocity ωm,obs computed on the basis of the output of the frictionless column-type EPS model 92 becomes equal to the actual motor angular velocity ωm,meas.
The plant observer unit 86 includes a model obtained by correcting the model, which is formed on the assumption that friction is not generated in the power column, with the use of an actually-measured value. By the computation executed with the use of the same model, the estimated motor rotation angle θm,obs that is the output from the first reduction ratio multiplying unit 93, the actual motor angular velocity ωm,meas that is the output from the second reduction ratio multiplying unit 97, and the estimated worm wheel torque Tww,obs are output from the plant observer unit 86.
The friction compensation control unit 87 includes a normal force computation unit 201, a friction coefficient estimation unit 202, and a frictional force estimation unit 203. The operation of the friction coefficient estimation unit 202 is the same as the operation of the friction coefficient estimation unit 62 illustrated in
As described above, Expressions (19), (20) are expressions obtained by simplifying the equations of motion (13), (14) in the rotation direction with the use of the contact force variation dNc and the normal force dNf.
J
wg{dot over (ω)}wg=Twg−rwg cos(βw)sin(γw)dNc−rwgμdNf cos(γw) (19)
J
ww{dot over (ω)}ww=Ttb+Tload+rww cos(βw)cos(γw)dNc−rwwμdNf sin(γw) (20)
Because Ttb+Tload=Tww is established, Expression (20) can be expressed by Expression (20a) using Tww.
J
ww{dot over (ω)}ww=Tww+rww cos(βw)cos(γw)dNc−rwwμdNf sin(γw) (20a)
With the use of the relationship of ωwg=i×ωww, by erasing dNf in Expressions (19), (20a), an equation of motion (28a) is obtained.
Because the fourth term in the right side of the equation of motion (28a) represents a frictional torque generated in the lower column, the torque (μdNf·rww/sin(γw)) for compensating for the frictional torque is added, as the second assist torque correction value Ta,FC, to the first assist torque command value Tab. The normal force computation unit 201 calculates the contact force variation dNc from Expressions (19), (20a) by setting dNf in Expressions (19), (20a) to 0, with the use of the relationship ωwg=i×ωww. At this time, the first assist torque command value Tab is used as Twg. The estimated worm wheel torque Tww,obs computed by the plant observer unit 86 is used as Tww. The basic assist torque command value Tb may be used as Twg.
The normal force computation unit 201 calculates the initial contact force N0 on the basis of N0=F0/sin βw. When N0|dNc|>0 is satisfied, the contact state is the double contact state. When N0−|dNc|≦0 is satisfied, the contact state is the single contact state. The normal force computation unit 201 computes the normal force dNf on the basis of Expression (32).
dN
f=max(|dNc|,N0) (32)
The frictional force Ffric,comp is expressed by Expression (33).
F
fric,comp
=μdN
f (33)
The frictional force estimation unit 203 computes the second assist torque correction value Ta,FC on the basis of Expression (34).
T
a,FC
=μdN
f
·r
ww/sin(γw) (34)
In the second embodiment as well as in the first embodiment, the friction that depends on the load transmitted to the speed reducer 19 can be taken into account and the variation of the friction coefficient that depends on the sliding velocity vs of the speed reducer 19 can be compensated for.
A model obtained by excluding the friction Fcf,ww, Fcf,wg, Tf,ww, and Tf,wg in the power column from the typical column-type EPS simulation model 60 illustrated, for example, in
The vehicle models 88, 91 may be a vehicle model other than the above-mentioned two-wheeled vehicle model. Similarly, the frictionless column-type EPS models 89, 92 may be a model other than the above-mentioned two types of models. In the second embodiment, the frictionless column-type EPS model is used as the EPS reference model 89. Alternatively, another model having a desired EPS characteristic may be used.
In the second embodiment, the second assist torque command value Tabc is computed by adding the second assist torque correction value Ta,FC to the first assist torque command value Tab that is obtained by adding the first assist torque correction value Ta,PD to the basic assist torque command value Tb. Alternatively, the second assist torque command value Tabc may be computed by adding the second assist torque correction value Ta,FC to the basic assist torque command value Tb. In this case, the basic assist torque command value Tb instead of the first assist torque command value Tab is input into the plant observer unit 86 and the friction compensation control unit 87. By employing this method, the target motor rotation angle setting unit 81, the angle deviation computation unit 82, the PD control unit 83, and the first addition unit 84 may be omitted.
In the first and second embodiments, the electric motor 18 is a DC motor with a brush. Alternatively, the electric motor 18 may be, for example, an electric motor other than the DC motor with a brush, such as a three-phase brushless motor, or may be a linearly-driven motor such as a linear motor. The invention may be applied to a control system other than the column-type EPS, as long as the control system is a control system including an electric motor and a speed reducer that amplifies or reduces the torque output from the electric motor, such as a power window system of a vehicle, a wiper driving system, or a system using a ball screw. Note that, the invention may be implemented in various modified embodiments within the scope of the appended claims.
Number | Date | Country | Kind |
---|---|---|---|
2012-257462 | Nov 2012 | JP | national |
2013-191024 | Sep 2013 | JP | national |