The disclosure of Japanese Patent Application No. 2018-079319 filed on Apr. 17, 2018 and No. 2018-134213 filed on Jul. 17, 2018 including the specification, drawings and abstract, is incorporated herein by reference in its entirety.
The present invention relates to a driver torque estimation apparatus capable of estimating a driver torque applied to a steering wheel by a driver, and also relates to a steering system including the driver torque estimation apparatus.
Japanese Patent Application Publication No. 2017-114324 (JP 2017-114324 A) discloses a steering wheel operation state determination apparatus for a vehicle steering system. The vehicle steering system includes an input shaft, an output shaft, and an electric motor. A steering wheel is coupled to the input shaft. The output shaft is coupled to the input shaft via a torsion bar. The electric motor is coupled to the output shaft via a speed reducer. The steering wheel operation state determination apparatus described in JP 2017-114324 A includes a driver torque estimation unit configured to estimate a driver torque by using a disturbance observer based on a torsion bar torque applied to the torsion bar and a rotation angle of the output shaft.
It is one object of the present invention to provide a driver torque estimation apparatus capable of estimating a driver torque with high accuracy, and also provide a steering system including the driver torque estimation apparatus.
A driver torque estimation apparatus according to one aspect of the present invention has the following features in its configuration. That is, the driver torque estimation apparatus includes a first shaft, a second shaft, a torque detection unit, a rotation angle acquisition unit, a basic driver torque estimation unit, a gravity torque calculation unit, and a driver torque estimation unit. A steering wheel to be used for steering a vehicle is coupled to the first shaft. The second shaft is coupled to the first shaft via a torsion bar. The torque detection unit is configured to detect a torsion bar torque applied to the torsion bar. The rotation angle acquisition unit is configured to acquire a rotation angle of the second shaft. The basic driver torque estimation unit is configured to estimate a basic driver torque by using a disturbance observer based on the torsion bar torque and the rotation angle of the second shaft. The gravity torque calculation unit is configured to calculate, by using a rotation angle of the steering wheel, a gravity torque applied to the first shaft by gravity acting on a center of gravity of the steering wheel. The driver torque estimation unit is configured to estimate a driver torque by using the basic driver torque estimated by the basic driver torque estimation unit and the gravity torque calculated by the gravity torque calculation unit.
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:
First, a first embodiment of the present invention is described.
The column type EPS 1 includes a steering wheel 2, a steering operation mechanism 4, and a steering assist mechanism 5. The steering wheel 2 is a steering member to be used for steering a vehicle. The steering operation mechanism 4 turns steered wheels 3 in association with rotation of the steering wheel 2. The steering assist mechanism 5 assists a driver's steering operation. The steering wheel 2 and the steering operation mechanism 4 are mechanically coupled together 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 a first shaft 8 and a second shaft 9. The first shaft 8 is coupled to the steering wheel 2. The second shaft 9 is coupled to the intermediate shaft 7 via the first universal joint 28. The first shaft 8 and the second shaft 9 are coupled together via a torsion bar 10 so as to be rotatable relative to each other. A torque sensor 11 is provided on the periphery of the steering shaft 6. The torque sensor 11 detects a torsion bar torque Ttb applied to the torsion bar 10 based on a relative rotation displacement amount between the first shaft 8 and the second 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 serving as a steering operation shaft. The steered wheels 3 are coupled to the ends of the rack shaft 14 via tie rods 15 and knuckle arms (not illustrated), respectively. The pinion shaft 13 is coupled to the intermediate shaft 7 via the second universal joint 29. A pinion 16 is coupled to the distal end of the pinion shaft 13.
The rack shaft 14 linearly extends along a lateral direction of the vehicle. A rack 17 is formed in the middle of the rack shaft 14 in its axial direction. The rack 17 meshes with the pinion 16. The pinion 16 and the rack 17 convert rotation of the pinion shaft 13 to axial movement of the rack shaft 14. Through the axial movement of the rack shaft 14, the steered wheels 3 can be turned.
When the steering wheel 2 is steered (rotated), the rotation is transmitted to the pinion shaft 13 via the steering shaft 6 and the intermediate shaft 7. The pinion 16 and the rack 17 convert the rotation of the pinion shaft 13 to the axial movement of the rack shaft 14. Thus, the steered wheels 3 are turned. The steering assist mechanism 5 includes an electric motor 18 and a speed reducer 19. The electric motor 18 generates a steering assist force. The speed reducer 19 amplifies a torque output from the electric motor 18, and transmits the torque to the steering operation mechanism 4. In this embodiment, the electric motor 18 is a three-phase brushless motor. The speed reducer 19 is constituted by a worm gear mechanism including a worm gear 20 and a worm wheel 21 that meshes with the worm gear 20. The speed reducer 19 is housed in a gear housing 22. A speed reducing ratio (gear ratio) of the speed reducer 19 may hereinafter be represented by “N”. The speed reducing ratio N is defined as a ratio ωwg/ωww of an angular velocity ωwg of the worm gear 20 to an angular velocity ωww of the worm wheel 21.
The worm gear 20 is driven to rotate by the electric motor 18. The worm wheel 21 is coupled to the second shaft 9 so as to be rotatable together with the second shaft 9. The worm wheel 21 is driven to rotate by the worm gear 20. The electric motor 18 is driven depending on a driver's steering state, and the worm gear 20 is driven to rotate by the electric motor 18. Thus, the worm wheel 21 is driven to rotate, thereby applying the motor torque to the steering shaft 6 and rotating the steering shaft 6 (second shaft 9). 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 to the axial movement of the rack shaft 14. Thus, the steered wheels 3 are turned. That is, when the worm gear 20 is driven to rotate by the electric motor 18, the steering can be assisted by the electric motor 18.
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 V is detected by a vehicle speed sensor 26. A signal output from 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.
The ECU 12 includes a microcomputer 40, a drive circuit (three-phase inverter circuit) 31, and a current detection unit 32. The drive circuit 31 is controlled by the microcomputer 40, and supplies electric power to the electric motor 18. The current detection unit 32 detects a current flowing through the electric motor 18 (hereinafter referred to as “motor current”). The microcomputer 40 includes a central processing unit (CPU) and memories (such as a read-only memory (ROM), a random-access memory (RAM), and a non-volatile memory), and functions as a plurality of functional processing units by executing a predetermined program. The functional processing units include a motor control unit 41 and a steering wheel operation state determination unit 42.
The motor control unit 41 controls driving of the drive circuit 31 based on the vehicle speed V, the torsion bar torque Ttb, the rotor rotation angle, and the motor current, thereby achieving appropriate steering assist depending on steering conditions. The vehicle speed V is detected by the vehicle speed sensor 26. The torsion bar torque Ttb is detected by the torque sensor 11. The rotor rotation angle is calculated based on an output from the rotation angle sensor 25. The motor current is detected by the current detection unit 32. Specifically, the motor control unit 41 sets a current command value based on the torsion bar torque Ttb and the vehicle speed V. The current command value is a target value of the motor current flowing through the electric motor 18. The current command value corresponds to a target value of the steering assist force (assist torque) depending on the steering conditions. The motor control unit 41 controls the driving of the drive circuit 31 so that the motor current detected by the current detection unit 32 approaches the current command value.
The steering wheel operation state determination unit 42 determines whether a steering wheel operation state is a hands-on state or a hands-off state based on the torsion bar torque Ttb and the rotor rotation angle. In the hands-on state, the driver is gripping the steering wheel 2. In the hands-off state, the driver is not gripping the steering wheel 2. The torsion bar torque Ttb is detected by the torque sensor 11. The rotor rotation angle is calculated based on the output from the rotation angle sensor 25.
The steering wheel operation state determination unit 42 includes a driver torque estimation unit 51 and a hands-on/off determination unit 52. The driver torque estimation unit 51 estimates a driver torque Td based on the signal output from the rotation angle sensor 25 and the torsion bar torque Ttb detected by the torque sensor 11. The hands-on/off determination unit 52 determines whether the steering wheel operation state is the hands-on state or the hands-off state based on the driver torque Td estimated by the driver torque estimation unit 51 (estimated driver torque).
First, the driver torque estimation unit 51 is described. The torsion bar torque Ttb is represented by Expression (1).
T
tb
=T
d
−J
sw
·d
2θsw/dt2+Tc+Tg+Tf (1)
Jsw: steering wheel inertia
θsw: steering wheel rotation angle
d2θsw/dt2: steering wheel angular acceleration
Jsw·d2θsw/dt2: steering wheel inertia torque
Tc: viscous friction torque acting on steering wheel 2
Tg: gravity torque applied to first shaft 8 by gravity acting on center of gravity of steering wheel 2
Tf: Coulomb friction torque acting on first shaft 8 and steering wheel 2
In this embodiment, the positive or negative signs of the torsion bar torque Ttb and the driver torque Td are positive in a case of a torque in a leftward steering direction, and are negative in a case of a torque in a rightward steering direction. The steering wheel rotation angle θsw indicates the amount of forward or backward rotation from the neutral position of the steering wheel 2. In this embodiment, the amount of leftward rotation from the neutral position is a positive value, and the amount of rightward rotation from the neutral position is a negative value.
The viscous friction torque T and the Coulomb friction torque Tf act in a direction opposite to a direction of a steering wheel angular velocity dθsw/dt. Therefore, the positive or negative signs of the viscous friction torque Tc and the Coulomb friction torque Tf are opposite to the positive or negative sign of the steering wheel angular velocity dθsw/dt. The viscous friction torque Tc may be represented by Tc=−Csw·dθsw/dt, where “Csw” represents a steering wheel viscosity. The positive or negative sign of the gravity torque Tg may be identical or opposite to the positive or negative sign of the driver torque Td depending on the steering wheel rotation angle θsw.
Based on Expression (1), the driver torque Td is represented by Expression (2).
In Expression (2), Tdo=Ttb+Jsw·d2θsw/dt2−Tc. The symbol “Tdo” represents a driver torque determined in consideration of the steering wheel inertia torque Jsw·d2θsw/dt2 and the viscous friction torque Tc but not in consideration of the gravity torque Tg and the Coulomb friction torque Tf. The driver torque Tdo is an example of a basic driver torque of the present invention. In this embodiment, the driver torque Td, represented by Tdo=Ttb+Jsw·d2θsw/dt2−T may be referred to as the basic driver torque.
The driver torque estimation unit 51 includes a worm wheel rotation angle calculation unit 61, an extended state observer (disturbance observer) 62, a gravity torque calculation unit 63, a friction torque calculation unit 64, and an estimated driver torque calculation unit 65. The worm wheel rotation angle calculation unit 61 calculates a rotation angle of an output shaft of the electric motor 18 (hereinafter referred to as “rotor rotation angle θm”) based on the signal output from the rotation angle sensor 25. The worm wheel rotation angle calculation unit 61 calculates a rotation angle of the worm wheel 21 (hereinafter referred to as “worm wheel rotation angle θww”) based on the obtained rotor rotation angle θm. Specifically, the worm wheel rotation angle calculation unit 61 calculates the worm wheel rotation angle θww by dividing the rotor rotation angle θm by the speed reducing ratio N of the speed reducer 19.
The extended state observer 62 estimates the basic driver torque Tdo, the steering wheel rotation angle θsw, and the steering wheel angular velocity dθsw/dt based on the worm wheel rotation angle θww and the torsion bar torque Ttb. The worm wheel rotation angle θww is calculated by the worm wheel rotation angle calculation unit 61. The torsion bar torque Ttb is detected by the torque sensor 11. The extended state observer 62 estimates the basic driver torque Tdo, the steering wheel rotation angle θsw, and the steering wheel angular velocity dθsw/dt by using a physical model of the column type EPS.
The dual inertia system model M2 includes the steering wheel and a lower column. The lower column includes an assist motor, the worm gear, and the worm wheel. The worm gear and the worm wheel constitute the speed reducer. The driver torque Tsw is input to the steering wheel. A torque corresponding to a value N·Tms and a load torque Tls are input to the lower column. The value N·Tms is obtained by multiplying the motor torque Tms by the speed reducing ratio N of the speed reducer. The load torque Tls is applied to the lower column from the steered wheels.
The symbols in
Jsw: steering wheel inertia
Tsw: driver torque
Ttb: torsion bar torque
ktb: torsion bar rigidity
csw: steering wheel viscosity
N: speed reducing ratio
θsw: steering wheel rotation angle
dθsw/dt: steering wheel angular velocity
Jeg: lower column inertia
θww: worm wheel rotation angle
dθww/dt: worm wheel angular velocity
Tls: load torque (reverse input torque)
In this embodiment, the extended state observer 62 uses the single inertia system model M1, and estimates the driver torque Tsw by using an extended disturbance state observer (disturbance observer). As described later, the driver torque Tsw estimated by the extended state observer 62 corresponds to the basic driver torque Tdo described above.
An equation of motion of the single inertia system model M1 in terms of the steering wheel inertia is represented by Expression (3).
J
sw{umlaut over (θ)}sw=Tsw−ktb(θsw−θww)−csw·{dot over (θ)}sw (3)
The symbol “d2θsw/dt2” represents the angular acceleration of the steering wheel. In Expression (3), ktb(θsw−θww) corresponds to the torsion bar torque Ttb of Expression (1), and csw·(dθsw/dt) corresponds to the viscous friction torque Tdo of Expression (1). The driver torque Tsw of Expression (3) corresponds to the driver torque Tdo of Expression (2).
Equations of state of the single inertia system model M1 may be represented by Expression (4).
In Expression (4), “{circumflex over (x)}e” represents a state variable vector, which is represented by Expression (5).
In Expression (4), “u1” represents an input vector, which is represented by Expression (6).
u
1=θww (6)
In Expression (4), “y” represents an output vector (measured value), which is represented by Expression (7). In Expression (4), “ŷ” represents an output vector estimation value.
y=T
tb
=k
tb(θsw−θww) (7)
In Expression (4), “Ae” represents a system matrix, which is represented by Expression (8).
In Expression (4), “Bc” represents an input matrix, which is represented by Expression (9).
In Expression (4), “Le” represents an observer gain matrix, which is represented by Expression (10).
In Expression (10), “L1”, “L2”, and “L3” represent first, second, and third observer gains, respectively, which are set in advance. In Expression (4), “Ce” represents an output matrix, which is represented by Expression (11).
C
e=[ktb O O] (11)
In Expression (4), “De” represents a feedthrough matrix, which is represented by Expression (12).
D
e
=−k
tb (12)
The extended state observer 62 calculates the state variable vector {circumflex over (x)}{circumflex over (x)}e based on the equations of state represented by Expression (4). Thus, the basic driver torque Tdo (=Tsw) is obtained.
The worm wheel rotation angle θww (corresponding to the input vector u1) calculated by the worm wheel rotation angle calculation unit 61 is supplied to the De multiplier 71 and to the Be multiplier 77. Outputs from the first integrator 84, the second integrator 85, and the third integrator 86 correspond to the steering wheel rotation angle θsw, the steering wheel angular velocity dθsw/dt, and the basic driver torque IT, (=Tdo) included in the state variable vector {circumflex over (x)}e (see Expression (5)), respectively. At the start of calculation, initial values are given as θsw, dθsw/dt, and Tsw. For example, the initial values of θsw, dθsw/dt, and Tsw are 0.
The −ktb/Jsw multiplier 78 multiplies θsw by −ktb/Jsw. The −csw/Jsw multiplier 79 multiplies dθsw/dt by −csw/Jsw. The 1/Jsw multiplier 80 multiplies Tdo (Tsw) by 1/Jsw. The second adder 81 adds multiplication results of the three multipliers 78, 79, and 80 together. The Cc multiplier 72 multiplies θsw by ktb. That is, the Ce multiplier 72 calculates Ce·{circumflex over (x)}e of Expression (4). The De multiplier 71 multiplies the worm wheel rotation angle θww calculated by the worm wheel rotation angle calculation unit 61 by −ktb. That is, the Ce multiplier 72 calculates De·u1 of Expression (4).
The first adder 73 subtracts the output from the Ce multiplier 72 (Ce·{circumflex over (x)}e) and the output from the De multiplier 71 (De·u1) from the output vector (measured value) y corresponding to the torsion bar torque Ttb detected by the torque sensor 11. That is, the first adder 73 calculates the difference (y−ŷ) between the output vector y and the output vector estimation value ŷ (=Ce·{circumflex over (x)}e+De·u1).
The L1 multiplier 74 multiplies the output from the first adder 73 (y−ŷ) by the first observer gain L1 (see Expression (10)). The L2 multiplier 75 multiplies the output from the first adder 73 (y−ŷ) by the second observer gain L2. The L3 multiplier 76 calculates a derivative of the basic driver torque Tsw (=Tdo) by multiplying the output from the first adder 73 (y−ŷ) by the third observer gain L3.
The Be multiplier 77 multiplies the worm wheel rotation angle θww calculated by the worm wheel rotation angle calculation unit 61 by ktb/Jsw. That is, the Be multiplier 77 calculates Be·u1 of Expression (4). The third adder 82 calculates a derivative of the steering wheel rotation angle θsw by adding dθsw/dt to the output from the L1 multiplier 74 (L1·(y−ŷ)). The first integrator 84 calculates the steering wheel rotation angle θsw by integrating the derivative of θsw.
The fourth adder 83 adds the output from the Be multiplier 77 and the output from the second adder 81 to the output from the L2 multiplier 75 (L2·(y−ŷ)). Thus, a derivative of the steering wheel angular velocity dθsw/dt is calculated. The second integrator 85 calculates the steering wheel angular velocity dθsw/dt by integrating the derivative of dθsw/dt. The third integrator 86 calculates the basic driver torque Tsw (=Tdo) by integrating the output from the L3 multiplier 76 (L3·(y−ŷ)).
Referring back to
The gravity torque calculation unit 63 calculates the gravity torque Tg based on the steering wheel rotation angle θsw estimated by the extended state observer 62. The gravity torque Tg is applied to the first shaft 8 by the gravity acting on the center of gravity of the steering wheel 2. As illustrated in
Long dashed short dashed lines in
As illustrated in
The gravity torque calculation unit 63 calculates the gravity torque Tg based on Expression (13).
T
g
=−G
gr·sin(θsw) (13)
The symbol “Ggr” represents a gravity torque coefficient, which is a value determined based on a product m gcg·dcg·cos(δ) that is a product of the mass m of the steering wheel 2, the gravitational acceleration gcg, the offset distance dcg, and a cosine value cos(δ) of the steering wheel inclination angle δ. The symbol “sin(θsw)” represents a sine value of the steering wheel rotation angle θsw.
If the offset distance dcg, the mass m of the steering wheel 2, and the steering wheel inclination angle δ are known, the gravity torque coefficient Ggr can be determined based on an expression of Ggr=m·dcg·gcg·cos(δ). Alternatively, the gravity torque coefficient Ggr may be determined as follows. That is, a steady-state torsion bar torque Ttb is measured by using a steering wheel rotation angle θsw in the hands-off state as a parameter. The absolute value of a torsion bar torque Ttb when the steering wheel rotation angle θsw is 90° is determined as the gravity torque coefficient Ggr.
The Coulomb friction torque Tf acts on the first shaft 8 and the steering wheel 2. The Coulomb friction torque Tf is generated in, for example, a bearing that supports the first shaft 8. The friction torque calculation unit 64 calculates the Coulomb friction torque Tf based on Expression (14).
T
f
=−G
f·tanh(η·LPF(dθsw/dt)) (14)
Gf: Coulomb friction torque coefficient
η: Coulomb friction torque change gradient (absolute value)
LPF(dθsw/dt): value obtained by subjecting steering wheel angular velocity dθsw/dt to filtering of first-order lag system (hereinafter referred to as “filtered steering wheel angular velocity LPF(dθsw/dt)”)
The Coulomb friction torque coefficient Gf can be determined as follows. In the hands-off state, the motor torque to be applied to the second shaft 9 by the electric motor 18 is gradually increased, and the absolute value of a torsion bar torque Ttb when the absolute value of the steering wheel angular velocity dθsw/dt is larger than 0, that is, when the steering wheel 2 starts to move is determined as the Coulomb friction torque coefficient Gf. The Coulomb friction torque change gradient η is determined by tuning.
A map indicating a relationship between the filtered steering wheel angular velocity LPF(dθsw/dt) and the Coulomb friction torque Tf may be created in advance, and the Coulomb friction torque Tf may be calculated based on the map. In this case, the relationship between the filtered steering wheel angular velocity LPF(dθsw/dt) and the Coulomb friction torque Tf may be a relationship illustrated in
Referring back to
Next, the hands-on/off determination unit 52 is described.
The “hands-on state over threshold (ST1)” is a hands-on state in which the absolute value of the driver torque Td is larger than a predetermined threshold α (>0). The “hands-on state at threshold or less (ST2)” is a hands-on state in which the absolute value of the driver torque Td is equal to or smaller than the threshold α. The “hands-off state at threshold or less (ST3)” is a hands-off state in which the absolute value of the driver torque Td is equal to or smaller than the threshold α. The “hands-off state over threshold (ST4)” is a hands-off state in which the absolute value of the driver torque Td is larger than the threshold α. For example, the threshold α is set to a value within a range of 0.1 [Nm] or larger and 0.3 [Nm] or smaller.
When the absolute value of the driver torque Td is larger than the threshold α at the start of calculation, the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-on state over threshold (ST1)”. Then, the hands-on/off determination unit 52 sets an output signal (out) to “1”, and sets a time counter value hod_timer to 0. The output signal (out) indicates a determination result. A value “1” indicates that the determination result shows “hands-on”, and a value “0” indicates that the determination result shows “hands-off”.
When the absolute value of the driver torque Td is equal to or smaller than the threshold α in the “hands-on state over threshold (ST1)”, the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-on state at threshold or less (ST2)”. Then, the hands-on/off determination unit 52 sets the output signal (out) to “1”. When the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-on state at threshold or less (ST2)”, the hands-on/off determination unit 52 updates the time counter value hod_timer to a value obtained by adding a predetermined time Ts1 [sec] to the current value (hod_timer) every time Ts1 elapses.
When the absolute value of the driver torque Td is larger than the threshold α in the “hands-on state at threshold or less (ST2)” before the time counter value hod_timer reaches a predetermined hands-off determination threshold β (>0), the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-on state over threshold (ST1)”, and sets the time counter value hod_timer to 0.
When the absolute value of the driver torque Td is not larger than the threshold α and the time counter value hod_timer reaches the hands-off determination threshold β in the “hands-on state at threshold or less (ST2)”, the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-off state at threshold or less (ST3)”. Then, the hands-on/off determination unit 52 sets the output signal (out) to “0”, and sets the time counter value hod_timer to 0. For example, the hands-off determination threshold β is set to a value within a range of 0.5 [sec] or larger and 1.0 [sec] or smaller.
When the absolute value of the driver torque Td is larger than the threshold α in the “hands-off state at threshold or less (ST3)”, the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-off state over threshold (ST4)”, and sets the output signal (out) to “0”. When the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-off state over threshold (ST4)”, the hands-on/off determination unit 52 updates the time counter value hod_timer to a value obtained by adding a predetermined time Ts2 [see] to the current value (hod_timer) every time Ts2 elapses. The value of Ts2 may be identical to or different from the value of Ts1.
When the absolute value of the driver torque Td is equal to or smaller than the threshold α in the “hands-off state over threshold (ST4)” before the time counter value hod_timer reaches a predetermined hands-on determination threshold γ (>0), the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-off state at threshold or less (ST3)”. Then, the hands-on/off determination unit 52 sets the time counter value hod_timer to 0. For example, the hands-on determination threshold γ is set to a value within a range of 0.05 [sec] or larger and 0.1 [see] or smaller.
When the absolute value of the driver torque Td is not equal to or smaller than the threshold α and the time counter value hod_timer reaches the hands-on determination threshold γ in the “hands-off state over threshold (ST4)”, the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-on state over threshold (ST1)”. Then, the hands-on/off determination unit 52 sets the output signal (out) to “1”, and sets the time counter value hod_timer to 0.
When the absolute value of the driver torque Td is equal to or smaller than the threshold α at the start of calculation, the hands-on/off determination unit 52 determines that the steering wheel operation state is the “hands-off state at threshold or less (ST3)”. Then, the hands-on/off determination unit 52 sets the output signal (out) to “0”, and sets the time counter value hod_timer to 0. In the embodiment described above, the driver torque Td is calculated in consideration of the gravity torque Tg applied to the first shaft 8 by the gravity acting on the center of gravity G of the steering wheel 2. Thus, the driver torque can be estimated with high accuracy. In this configuration, the driver torque Td is calculated in consideration of not only the gravity torque Tg but also the Coulomb friction torque Tf acting on the first shaft 8 and the steering wheel 2. Thus, the driver torque can be estimated with higher accuracy.
In the embodiment described above, the hands-on/off determination is made by using the torque threshold α and the time counter value hod_timer based on the highly accurate driver torque Td estimated by the driver torque estimation unit 51. Thus, determination can be made with high accuracy as to whether the steering wheel operation state is the hands-on state in which the driver is gripping the steering wheel 2 or the hands-off state in which the driver is not gripping the steering wheel 2.
For example, the hands-on/off determination results can be used for mode switching control in a vehicle having an automatic driving mode and a manual driving mode prepared as driving modes, as typified by a case where the driving mode is switched from the automatic driving mode to the manual driving mode after confirming that the steering wheel operation state is the hands-on state. Although the first embodiment of the present invention is described above, the present invention may be carried out based on other embodiments. For example, in the embodiment described above, the steering wheel rotation angle θsw estimated by the extended state observer 62 is used for calculating the gravity torque Tg by the gravity torque calculation unit 63. The steering wheel angular velocity dθsw/dt estimated by the extended state observer 62 is used for calculating the Coulomb friction torque Tf by the friction torque calculation unit 64. A steering angle sensor configured to detect the rotation angle of the steering wheel 2 may be provided, and a steering wheel rotation angle θsw detected by the steering angle sensor may be used for calculating the gravity torque Tg by the gravity torque calculation unit 63. A steering wheel angular velocity dθsw/dt obtained by determining a time derivative of the steering wheel rotation angle θsw detected by the steering angle sensor may be used for calculating the Coulomb friction torque Tf by the friction torque calculation unit 64.
In the embodiment described above, the electric motor 18 is the three-phase brushless motor, but may be a brushed direct current (DC) motor. The embodiment described above is directed to the case where the present invention is applied to the column type EPS. The present invention is also applicable to a pinion assist type EPS in which the assist electric motor 18 is coupled to the pinion shaft 13 via a speed reducer. In this case as well, the model of
In the pinion assist type EPS, an electric motor, a speed reducer, a torque sensor, and a torsion bar are provided on a pinion shaft. For example, the speed reducer is constituted by a worm gear to be rotated by the electric motor, and a worm wheel that is provided on the pinion shaft and meshes with the worm gear. The torsion bar is provided on the pinion shaft at a part closer to the steering wheel with respect to the worm wheel. A worm wheel rotation angle (rotation angle of the pinion shaft) is calculated based on a signal from a rotation angle sensor configured to detect a rotor rotation angle of the electric motor. A pinion shaft rotation angle sensor configured to detect the rotation angle of the pinion shaft may be provided on the pinion shaft at a part closer to the worm wheel with respect to the torsion bar, and the rotation angle of the pinion shaft may be calculated based on a signal from the pinion shaft rotation angle sensor. The steering shaft is not provided with a torsion bar or a speed reducer.
In the case of the pinion assist type EPS having the structure described above, the physical model may be illustrated in
Next, a second embodiment of the present invention is described.
A charge coupled device (CCD) camera 125, a global positioning system (GPS) 126, a radar 127, and a map information memory 128 are mounted on a vehicle. The CCD camera 125 photographs a road in front of the vehicle in its traveling direction. The GPS 126 detects the position of the vehicle itself. The radar 127 detects a road shape and an obstacle. The map information memory 128 stores map information.
The CCD camera 125, the GPS 126, the radar 127, and the map information memory 128 are connected to a higher-level electronic control unit (ECU) 201 configured to perform automatic assist control or automatic driving control. For example, the higher-level ECU 201 recognizes a surrounding environment, estimates the position of the vehicle itself, and performs route planning based on information obtained by the CCD camera 125, the GPS 126, and the radar 127 and also based on the map information, and performs steering and determines a target control value of a drive actuator.
In this embodiment, the higher-level ECU 201 sets an automatic steering command value θadac for automatic steering. In this embodiment, automatic steering control is, for example, control for causing the vehicle to travel along a target track. The automatic steering command value θadac is a target value of a steering angle for causing the vehicle to automatically travel along the target track. Processing for setting the automatic steering command value θadac is well known, and therefore detailed description is omitted herein.
The automatic steering command value θadac set by the higher-level ECU 201 is supplied to a motor control ECU 202 via an on-board network. The torque sensor 11, the rotation angle sensor 25, and the like are connected to the motor control ECU 202 in addition to the higher-level ECU 201. The torque sensor 11 detects the torsion bar torque Ttb applied to the torsion bar 10 based on a relative rotation displacement amount between the first shaft 8 and the second shaft 9. The rotation angle sensor 25 detects the rotation angle of the rotor of the electric motor 18 (hereinafter referred to as “rotor rotation angle”). The motor control ECU 202 controls the electric motor 18 based on signals output from the sensors and information supplied from the higher-level ECU 201.
The microcomputer 140 includes a CPU and memories (such as a ROM, a RAM, and a non-volatile memory), and functions as a plurality of functional processing units by executing a predetermined program. The functional processing units include the driver torque estimation unit 51, a manual steering command value generation unit 141, an integrated angle command value calculation unit 142, and a control unit 143.
The driver torque estimation unit 51 estimates the driver torque Td based on the signal output from the rotation angle sensor 25 and the torsion bar torque Ttb detected by the torque sensor 11. The configuration of the driver torque estimation unit 51 is similar to that of the driver torque estimation unit 51 of
The integrated angle command value calculation unit 142 calculates an integrated angle command value θacmd by adding the manual steering command value θmdac to the automatic steering command value θadac set by the higher-level ECU 201.
The control unit 143 performs angle control for the electric motor 18 based on the integrated angle command value θacmd. More specifically, the control unit 143 controls driving of the drive circuit 131 so that the steering angle θ (rotation angle θ of the second shaft 9) approaches the integrated angle command value θacmd.
For example, the control unit 143 includes an angle control unit 144 and a torque control unit (current control unit) 145. The angle control unit 144 performs proportional-derivative (PD) calculation for a deviation between the integrated angle command value θacmd and the steering angle θ calculated based on the signal output from the rotation angle sensor 25. Thus, a motor torque command value Tmc is calculated. The motor torque command value Tmc is a target value of the motor torque of the electric motor 18. For example, the torque control unit 145 first calculates a current command value Icmd by dividing the motor torque command value Tmc by a torque constant Kt of the electric motor 18. Then, the torque control unit 145 drives the drive circuit 131 so that the value of the motor current I detected by the current detection circuit 132 approaches the current command value Icmd.
The assist torque command value setting unit 151 sets an assist torque command value Tac that is a target value of an assist torque necessary for manual steering. The assist torque command value setting unit 151 sets the assist torque command value Tac based on the driver torque Td estimated by the driver torque estimation unit 51.
The assist torque command value Tac takes a positive value when the driver torque Td takes a positive value. The assist torque command value Tac takes a negative value when the driver torque Td takes a negative value. The absolute value of the assist torque command value Tac is set to increase as the absolute value of the driver torque Td increases.
The assist torque command value setting unit 151 may calculate the assist torque command value Tac by multiplying the driver torque Td by a constant set in advance.
In this embodiment, the command value setting unit 152 sets the manual steering command value θmdac by using a reference EPS model.
T
rl
=−k·θ
c
−c(dθc/dt) (15)
In this embodiment, predetermined values obtained in advance through an experiment, analysis, and the like are set as the spring rate k and the viscous damping coefficient c. An equation of motion of the reference EPS model is represented by Expression (16).
J
c
·d
2θc/dt2=Ttb+N·Tmc−k·θc−c(dθc/dt) (16)
The command value setting unit 152 sets the manual steering command value θmdac by using Expression (16). At this time, the assist torque command value Tac set by the assist torque command value setting unit 151 (see
The column angle θc is calculated by substituting the torsion bar torque Ttb detected by the torque sensor 11 as Ttb of Expression (16) and solving the differential equation of Expression (16). The obtained column angle θC may be set as the manual steering command value θmdac. However, the torsion bar torque Ttb detected by the torque sensor 11 also includes a disturbance other than the driver torque actually applied to the steering wheel 2 by the driver. When the manual steering command value θmdac is calculated by substituting the torsion bar torque Ttb as Ttb of Expression (16), the manual steering command value θmdac may be set based on the disturbance other than the driver torque even while the driver is not operating the steering wheel 2.
In this embodiment, the command value setting unit 152 calculates the column angle θc by substituting the driver torque Td estimated by the driver torque estimation unit 51 as Ttb of Expression (16) and solving the differential equation of Expression (16). Then, the command value setting unit 152 sets the obtained column angle θc as the manual steering command value θmdac. Thus, it is possible to reduce the occurrence of the case where the manual steering command value θmdac is set based on the disturbance other than the driver torque while the driver is not operating the steering wheel 2.
In the electric power steering system 1A of
In the electric power steering system 1A of
When an absolute value |Td| of the driver torque Td is equal to or larger than a predetermined threshold ϕ (ϕ>0), the command value setting unit 152A substitutes the torsion bar torque Ttb and the assist torque command value Tac input to the command value setting unit 152A as Ttb and N·Tmc of Expression (16), respectively, and solves the differential equation of Expression (16). Thus, the manual steering command value θmdac (=θc) is set. When the absolute value |Td| of the driver torque Td is smaller than the threshold ϕ, the manual steering command value θmdac (=θc) is set by substituting 0 as Ttb and N·Tmc of Expression (16) and solving the differential equation of Expression (16).
The manual steering command value generation unit 141A sets the manual steering command value θmdac by using the torsion bar torque Ttb. When the absolute value |Td| of the driver torque Td is smaller than the threshold ϕ, the torsion bar torque Ttb input to the manual steering command value generation unit 141A is substantially set to 0. Thus, it is possible to reduce the occurrence of the case where the manual steering command value θmdac is set based on the disturbance other than the driver torque while the driver is not operating the steering wheel 2. The manual steering command value θmdac is set by using the torsion bar torque Ttb. Thus, a time lag of the manual steering command value θmdac with respect to the driver's steering wheel operation can be reduced as compared to the case of using the driver torque Td estimated by the driver torque estimation unit 51.
The steering wheel operation state determination unit 42 determines, based on the signal output from the rotation angle sensor 25 and the torsion bar torque Ttb, whether the steering wheel operation state is the hands-on state in which the driver is gripping the steering wheel or the hands-off state in which the driver is not gripping the steering wheel. The configuration of the steering wheel operation state determination unit 42 is similar to that of the steering wheel operation state determination unit 42 of
The manual steering command value generation unit 141B generates the manual steering command value θmdac by using the signal output from the steering wheel operation state determination unit 42 (hands-on/off state signal) and the torsion bar torque Ttb detected by the torque sensor 11. Details of the manual steering command value generation unit 141B are described later. The integrated angle command value calculation unit 142 calculates the integrated angle command value θmdac by adding the manual steering command value θmdac to the automatic steering command value θadac set by the higher-level ECU 201.
The control unit 143 performs angle control for the electric motor 18 based on the integrated angle command value θacmd. The configuration of the control unit 143 is similar to that of the control unit 143 of
The assist torque command value setting unit 151A sets the assist torque command value Tac that is the target value of the assist torque necessary for manual steering. The operation of the assist torque command value setting unit 151A is similar to the operation of the assist torque command value setting unit 151A of
When the signal output from the steering wheel operation state determination unit 42 is the hands-on state signal, the command value setting unit 152B substitutes the torsion bar torque Ttb and the assist torque command value Tac input to the command value setting unit 152B as Ttb and N·Tmc of Expression (16), respectively, and solves the differential equation of Expression (16). Thus, the manual steering command value θmdac (=θc) is set. When the signal output from the steering wheel operation state determination unit 42 is the hands-off state signal, the command value setting unit 152B substitutes 0 as Ttb and N·Tmc of Expression (16), and solves the differential equation of Expression (16). Thus, the manual steering command value θmdac (=θc) is set.
The manual steering command value generation unit 141B sets the manual steering command value θmdac by using the torsion bar torque Ttb. When the signal output from the steering wheel operation state determination unit 42 is the hands-off state signal, the torsion bar torque Ttb input to the manual steering command value generation unit 141B is substantially set to 0. Thus, it is possible to reduce the occurrence of the case where the manual steering command value θmdac is set based on the disturbance other than the driver torque while the driver is not operating the steering wheel 2. The manual steering command value θmdac is set by using the torsion bar torque Ttb. Thus, the time lag of the manual steering command value θmdac with respect to the driver's steering wheel operation can be reduced as compared to the case of using the driver torque Td estimated by the driver torque estimation unit 51.
Although the second embodiment of the present invention is described above, the present invention may be carried out based on other embodiments. For example, in the embodiment described above, the command value setting units 152, 152A, and 152B (see
For example, the command value setting units 152, 152A, and 152B may set the manual steering command value θmdac by using a map that stores a relationship between the driver torque Td (in the case of
Various other design changes may be made to the present invention within the scope of matters described in the claims.
Number | Date | Country | Kind |
---|---|---|---|
2018-079319 | Apr 2018 | JP | national |
2018-134213 | Jul 2018 | JP | national |