This invention relates to a motor control device that controls an electric motor that applies steering force to an output shaft linked to a steering wheel via a torsion bar.
Patent Document 1 discloses that a disturbance torque, which is a torque other than a motor torque that acts on a motor-driven object, is subtracted from a basic torque command value, and a vibration suppression torque obtained by multiplying steering torque (torsion bar torque) by a predetermined vibration suppression gain is added to the subtraction results, thereby computing a torque command value for an output shaft. The basic torque command value includes a feedback torque obtained by performing PD (proportional derivative) computation with respect to deviation between an automatic steering angle command value and a steering angle detection value or a steering angle estimation value.
In the invention described in Patent Document 1, vibration is suppressed by setting a vibration suppression gain, a proportional gain used in PD computation, and a differential gain used in PD computation, to respective predetermined values.
In the invention described in Patent Document 1, vibration can be suppressed, but resonant frequency of the system is fixed to mechanical natural frequency (resonant frequency) of a steering wheel, and accordingly the resonant frequency of the system cannot be optionally set.
An object of this invention is to provide a motor control device that enables the resonant frequency of the system to be optionally set.
An embodiment of the present invention provides a motor control device that controls an electric motor that applies steering force to an output shaft linked to a steering wheel via a torsion bar, the motor control device including a steering torque detection unit that detects a steering torque applied to the steering wheel, and a motor torque command value setting unit that sets a motor torque command value that is a target value of motor torque of the electric motor, in which the motor torque command value setting unit includes a basic torque command value setting unit that sets a basic torque command value, a correction unit that corrects the basic torque command value set by the basic torque command value setting unit, using a resonance control torque, and a motor torque command value computation unit that computes the motor torque command value based on the basic torque command value following correction by the correction unit, and the resonance control torque is set using a first torque obtained by multiplying a differential value of the steering torque by a predetermined first gain, and a second torque obtained by multiplying the steering torque by a predetermined second gain.
According to this configuration, the resonant frequency of the system can be optionally set.
The above and other objects, features, and effects of the present invention will become apparent from the following description of an embodiment that will be given with reference to the accompanying drawings.
An embodiment of the present invention provides a motor control device that controls an electric motor that applies steering force to an output shaft linked to a steering wheel via a torsion bar, the motor control device including a steering torque detection unit that detects a steering torque applied to the steering wheel, and a motor torque command value setting unit that sets a motor torque command value that is a target value of motor torque of the electric motor, in which the motor torque command value setting unit includes a basic torque command value setting unit that sets a basic torque command value, a correction unit that corrects the basic torque command value set by the basic torque command value setting unit, using a resonance control torque, and a motor torque command value computation unit that computes the motor torque command value based on the basic torque command value following correction by the correction unit, and the resonance control torque is set using a first torque obtained by multiplying a differential value of the steering torque by a predetermined first gain, and a second torque obtained by multiplying the steering torque by a predetermined second gain.
According to this configuration, the resonant frequency of the system can be optionally set.
An embodiment of the present invention further includes a rotational angle detection unit that detects a rotational angle of the electric motor, in which the basic torque command value setting unit includes an angle deviation computation unit that computes a difference between a rotational angle command value that is a target value of a rotational angle of the output shaft and a rotational angle of the output shaft computed from the rotational angle detected by the rotational angle detection unit, and a basic torque command value computation unit that computes the basic torque command value by performing predetermined feedback computation with respect to angle deviation computed by the angle deviation computation unit.
An embodiment of the present invention further includes a rotational angle detection unit that detects a rotational angle of the electric motor, in which the basic torque command value setting unit includes a target torque computation unit that computes a target torque based on a rotational angle command value that is a target value of a rotational angle of the output shaft, a feedback torque computation unit that computes a feedback torque based on the rotational angle detected by the rotational angle detection unit, and a basic torque command value computation unit that computes the basic torque command value by computing a deviation between the target torque and the feedback torque, and a gain used in the computation of the target torque and a gain used in the computation of the feedback torque are different from each other.
An embodiment of the present invention further includes a manual steering command value computation unit that generates a manual steering command value and an integrated angle command value computation unit that computes an integrated angle command value by adding the manual steering command value to an automatic steering angle command value, in which the rotational angle command value is the integrated angle command value.
An embodiment of the present invention further includes a disturbance torque estimation unit that estimates disturbance torque other than the motor torque of the electric motor acting on the output shaft, based on the motor torque command value or the motor torque generated by the electric motor, and a rotational angle of the output shaft, in which the correction unit is configured to correct the basic torque command value by using the resonance control torque and the disturbance torque.
In an embodiment of the present invention, a dead band is set for at least one of the steering torque that is an input value for computing the first torque, and the steering torque that is an input value for computing the second torque.
Embodiments of this invention will be described in detail below with reference to the accompanying drawings.
An electric power steering system 1 includes a steering wheel (handle) 2 that is a steering member for steering a vehicle, a steering operation mechanism 4 that steers steered wheels 3 in conjunction with rotating of the steering wheel 2, and a steering assist mechanism 5 that assists a driver in steering. The steering wheel 2 and the steering operation mechanism 4 are mechanically linked via a steering shaft 6 and an intermediate shaft 7.
The steering shaft 6 includes an input shaft 8 linked to the steering wheel 2 and an output shaft 9 linked to the intermediate shaft 7. The input shaft 8 and the output shaft 9 are linked so as to be rotatable relative to each other via a torsion bar 10.
A torque sensor 12 is disposed near the torsion bar 10. The torque sensor 12 detects steering torque (torsion bar torque) Ttb applied to the steering wheel 2 based on an amount of relative rotational displacement between the input shaft 8 and the output shaft 9. That is to say, the torque sensor 12 detects the steering torque Ttb based on the amount of twisting of the torsion bar 10. In the present embodiment, the steering torque Ttb that is detected by the torque sensor 12 is such that, for example, torque for steering in a left direction is detected as a positive value, torque for steering in a right direction is detected as a negative value, and the greater the absolute value thereof is, the greater the magnitude of the steering torque Ttb becomes.
The steering operation mechanism 4 is made up of a rack and pinion mechanism including a pinion shaft 13 and a rack shaft 14 that is a steered shaft. The steered wheels 3 are linked to the end portions of the rack shaft 14 via tie rods 15 and knuckle arms (omitted from illustration). The pinion shaft 13 is linked to the intermediate shaft 7. The pinion shaft 13 is configured to rotate in conjunction with steering by the steering wheel 2. A pinion 16 is linked to a distal end of the pinion shaft 13.
The rack shaft 14 extends linearly along a right-left direction of the vehicle. A rack 17 that meshes with the pinion 16 is formed on an intermediate portion of the rack shaft 14 in an axial direction. The pinion 16 and the rack 17 convert rotation of the pinion shaft 13 into axial direction movement of the rack shaft 14. The steered wheels 3 can be steered by moving the rack shaft 14 in the axial direction.
When the steering wheel 2 is steered (rotated), this rotation is transmitted to the pinion shaft 13 via the steering shaft 6 and the intermediate shaft 7. The pinion 16 and the rack 17 then convert rotation of the pinion shaft 13 into axial direction movement of the rack shaft 14. The steered wheels 3 are thus steered.
The steering assist mechanism 5 includes an electric motor 18 for generating a steering assist force (assist torque), and a speed reducer 19 for amplifying output torque of the electric motor 18 and transmitting the amplified torque to the steering operation mechanism 4. The speed reducer 19 is made up of 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 serving as a transmission mechanism housing.
Hereinafter, reduction ratio (gear ratio) of the speed reducer 19 may be represented by N in some cases. The reduction ratio N is defined as a ratio (θwg/θww) of a worm gear angle θwg that is a rotational angle of the worm gear 20 as to a worm wheel angle θww that is a rotational angle of the worm wheel 21.
The worm gear 20 is rotationally driven by the electric motor 18. Also, the worm wheel 21 is linked to the output shaft 9 so as to be integrally rotatable therewith.
When the worm gear 20 is rotationally driven by the electric motor 18, the worm wheel 21 is rotationally driven so that motor torque is applied to the steering shaft 6, and also the steering shaft 6 (output shaft 9) is rotated. The rotation of the steering shaft 6 is then transmitted to the pinion shaft 13 via the intermediate shaft 7. The rotation of the pinion shaft 13 is converted into axial direction movement of the rack shaft 14. The steered wheels 3 are thus steered. That is to say, rotationally driving the worm gear 20 by the electric motor 18 enables steering assist by the electric motor 18 and steering of the steered wheels 3. The electric motor 18 is provided with a rotational angle sensor 23 for detecting a rotational angle of a rotor of the electric motor 18.
Torque that is applied to the output shaft 9 (example of an object to be driven by the electric motor 18) includes motor torque from the electric motor 18 and disturbance torque Tlc other than the motor torque. The disturbance torque Tlc other than the motor torque includes steering torque Ttb, road load torque (road reaction torque) Trl, friction torque Tf, and so forth.
The steering torque Ttb is torque that is applied from the steering wheel 2 side to the output shaft 9, due to force that is applied to the steering wheel 2 by the driver (driver torque), force that is generated by steering inertia, and so forth.
Road load torque Trl is torque that is applied from the steered wheel 3 side to the output shaft 9 via the rack shaft 14, due to self-aligning torque that is generated by tires, force that is generated by suspension and tire wheel alignment, friction force of the rack and pinion mechanism, and so forth.
The vehicle is equipped with a CCD (Charge Coupled Device) camera 25 that performs shooting of the road ahead in a direction of travel of the vehicle, a GPS (Global Positioning System) 26 for detecting the position of the own vehicle, a radar 27 for detecting road shape and obstructions, and map information memory 28 that stores map information. The vehicle is further equipped with three mode switches 31, 32, and 33 for manually switching steering modes.
As will be described later, the steering modes include a manual steering mode in which steering is performed by manual driving, an automatic steering mode in which steering is performed by automated driving, and a cooperative steering mode in which steering can be performed based on both manual driving and automated driving. Specific definitions of these steering modes will be described later.
The CCD camera 25, the GPS 26, the radar 27, and the map information memory 28 are connected to a host ECU (ECU: Electronic Control Unit) 201 for performing driver assistance control and automated driving control. The host ECU 201 performs surrounding environment recognition, own vehicle position estimation, route planning, and so forth, based on information obtained by the CCD camera 25, the GPS 26, and the radar 27, and also the map information, and determines control target values for steering and drive actuators.
In the present embodiment, the host 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 course. The automatic steering command value θadac is a target value of a steering angle for causing the vehicle to travel automatically along the target course. Processing of setting such an automatic steering command value θadac is well known, and accordingly detailed description will be omitted here. Note that automatic steering control (driver assistance control) may be, for example, lane keeping assist (LKA) control for keeping the vehicle within its lane.
The host ECU 201 also generates mode setting signals S1, S2, and S3 in accordance with operations of the mode switches 31, 32, and 33. Specifically, when the first mode switch 31 is turned on by the driver, the host ECU 201 outputs a manual steering setting signal S1 for setting the steering mode to the manual steering mode. When the second mode switch 32 is turned on by the driver, the host ECU 201 outputs an automatic steering mode setting signal S2 for setting the steering mode to the automatic steering mode. When the third mode switch 33 is turned on by the driver, the host ECU 201 outputs a cooperative steering mode setting signal S3 for setting the steering mode to the cooperative steering mode.
The automatic steering command value θadac and the mode setting signals S1, S2, and S3 that are set by the host ECU 201 are given to a motor control ECU 202 via an in-vehicle network. The steering torque Ttb detected by the torque sensor 12 and output signals from the rotational angle sensor 23 are input to the motor control ECU 202. The motor control ECU 202 controls the electric motor 18 based on these input signals and information given from the host ECU 201.
The motor control ECU 202 includes a microcomputer 50, a drive circuit (inverter circuit) 41 that is controlled by the microcomputer 50 and that supplies electric power to the electric motor 18, and a current detection circuit 42 for detecting a current flowing through the electric motor 18 (hereinafter referred to as “motor current I”).
The microcomputer 50 includes a CPU and memory (such as ROM, RAM, non-volatile memory, and so forth), and functions as a plurality of functional processing units by executing a predetermined program. This plurality of functional processing units includes an assist torque command value setting unit 51, a manual steering command value generation unit 52, an integrated angle command value computation unit 53, an angle control unit 54, a torque control unit (current control unit) 55, a first weighting unit 56, a second weighting unit 57, a third weighting unit 58, and an addition unit 59. The addition unit 59 in the present embodiment is an example of “motor torque command value computation unit” according to the present invention.
The assist torque command value setting unit 51 sets an assist torque command value Tas that is a target value of the assist torque necessary for manual operations. The assist torque command value setting unit 51 sets the assist torque command value Tas based on the steering torque Ttb detected by the torque sensor 12. An example of setting the assist torque command value Tas with respect to the steering torque Ttb is illustrated in
The assist torque command value Tas is set to a positive value when the electric motor 18 should generate a steering assist force for steering in the left direction, and is set to a negative value when the electric motor 18 should generate a steering assist force for steering in the right direction. The assist torque command value Tas is positive for a positive value of the steering torque Ttb, and is negative for a negative value of the steering torque Ttb. The assist torque command value Tas is set such that the greater an absolute value of the steering torque Ttb is, the greater an absolute value of the assist torque command value Tas becomes.
The assist torque command value setting unit 51 may set the assist torque command value Tas also taking into consideration a vehicle speed detected by a vehicle speed sensor that is omitted from illustration. In this case, the assist torque command value Tas is set such that the greater the absolute value of the steering torque Ttb is, the greater the absolute value of the assist torque command value Tas is, and the greater the vehicle speed is, the smaller the absolute value of the assist torque command value Tas is.
Note that the assist torque command value setting unit 51 may compute the assist torque command value Tas by multiplying the steering torque Ttb by a constant that is set in advance.
The first weighting unit 56 performs first weighting processing with respect to the assist torque command value Tas set by the assist torque command value setting unit 51, in accordance with the mode setting signal that is input. Specifically, when one of the mode setting signals S1, S2, and S3 is input, the first weighting unit 56 first sets a first weight W1 in accordance with the current steering mode and the mode setting signal that is input. Next, the first weighting unit 56 multiplies the assist torque command value Tas by the first weight W1. The first weighting unit 56 then gives a multiplication value W1. Tas to the addition unit 59 as an assist torque command value Tas′ following the first weighting processing.
The manual steering command value generation unit 52 is provided to, when the driver operates the steering wheel 2, set the steering angle (more precisely, rotational angle θ of the output shaft 9) in accordance with this steering wheel operation, as a manual steering command value θmdac. The manual steering command value generation unit 52 generates the manual steering command value θmdac using the steering torque Ttb detected by the torque sensor 12 and the assist torque command value Tas set by the assist torque command value setting unit 51. The manual steering command value generation unit 52 will be described later in detail.
The third weighting unit 58 performs third weighting processing with respect to the manual steering command value θmdac generated by the manual steering command value generation unit 52, in accordance with the mode setting signal that is input. Specifically, when one of the mode setting signals S1, S2, and S3 is input, the third weighting unit 58 first sets a third weight W3 in accordance with the current steering mode and the mode setting signal that is input. Next, the third weighting unit 58 multiplies the manual steering command value θmdac by the third weight W3. The third weighting unit 58 then gives a multiplication value W3·θmdac to the integrated angle command value computation unit 53, as a manual steering command value θmdac′ following the third weighting processing.
The integrated angle command value computation unit 53 computes an integrated angle command value θsint by adding the manual steering command value θmdac′ following the third weighting processing to the automatic steering command value θadac set by the host ECU 201.
The angle control unit 54 computes an integrated motor torque command value Tmint in accordance with the integrated angle command value θsint, based on the integrated angle command value θsint. The angle control unit 54 will be described in detail later.
The second weighting unit 57 performs second weighting processing with respect to the integrated motor torque command value Tmint, in accordance with the mode setting signal that is input. Specifically, when one of the mode setting signals S1, S2, and S3 is input, the second weighting unit 57 first sets a second weight W2 in accordance with the current steering mode and the mode setting signal that is input. Next, the second weighting unit 57 multiplies the integrated motor torque command value Tmint by the second weight W2. The second weighting unit 57 then gives a multiplication value W2·Tmint to the addition unit 59 as the integrated motor torque command value Tmint′ following the second weighting processing.
The addition unit 59 computes a motor torque command value Tm for the electric motor 18 by adding the assist torque command value Tas′ following the first weighting processing and the integrated motor torque command value Tmint′ following the second weighting processing.
The torque control unit 55 drives the drive circuit 41 such that the motor torque of the electric motor 18 is brought closer to the motor torque command value Tm. The torque control unit 55 will be described in detail later.
In the present embodiment, the manual steering command value generation unit 52 uses a reference EPS model to set the manual steering command value θmdac·
This reference EPS model is a single inertia model including a lower column. The lower column corresponds to the output shaft 9 and the worm wheel 21. In
In the present embodiment, the spring constant k and the viscous damping coefficient c are set to predetermined values obtained in advance through experiments, analysis, and so forth.
An equation of motion of the reference EPS model is expressed by the following Expression (2).
The manual steering command value generation unit 52 computes the rotational angle θ, of the lower column by solving the differential equation represented by Expression (2) by substituting the steering torque Ttb detected by the torque sensor 12 into Ttb and substituting the assist torque command value Tas set by the assist torque command value setting unit 51 into Tm. The manual steering command value generation unit 52 then generates the rotational angle θ, of the lower column, which is obtained, as the manual steering command value θmdac.
The angle control unit 54 computes the integrated motor torque command value Tmint based on the integrated angle command value θsint, the steering torque Ttb, and the output signal of the rotational angle sensor 23. The angle control unit 54 includes a low-pass filter (LPF) 61, a feedback control unit 62, a first torque computation unit 63, a second torque computation unit 64, a first torque addition unit 65, a disturbance torque estimation unit 66, a second torque addition unit 67, a first reduction ratio division unit 68, a reduction ratio multiplication unit 69, a rotational angle computation unit 70, and a second reduction ratio division unit 71.
The reduction ratio multiplication unit 69 converts a motor torque command value Tm into an output shaft torque command value N·Tm that acts on the output shaft 9, by multiplying the motor torque command value Tm, which is computed by the addition unit 59 (see
The rotational angle computation unit 70 computes a rotor rotational angle θm of the electric motor 18 based on the output signal from the rotational angle sensor 23. The second reduction ratio division unit 71 converts the rotor rotational angle θm into a rotational angle (actual steering angle) θ of the output shaft 9 by dividing the rotor rotational angle θm, which is computed by the rotational angle computation unit 70, by the speed reduction ratio N.
The low-pass filter 61 performs low-pass filtering processing with respect to the integrated angle command value θsint. An integrated angle command value θsin following the low-pass filter processing is given to the feedback control unit 62.
The feedback control unit 62 is provided to bring the actual steering angle θ computed by the second reduction ratio division unit 71 closer to the integrated angle command value θsin following the low-pass filter processing. The feedback control unit 62 includes an angle deviation computation unit 62A and a PD control unit 62B. The angle deviation computation unit 62A computes deviation Δθ(=θsin−θ) between the integrated angle command value θsin and the actual steering angle θ. Note that the angle deviation computation unit 62A may compute, as the angle deviation Δθ, a deviation (θsin−{circumflex over ( )}θ) between the integrated angle command value θsin and a steering angle estimation value {circumflex over ( )}θ computed by the disturbance torque estimation unit 66.
The PD control unit 62B includes a proportional gain multiplication unit 101, a differential computation unit 102, a differential gain multiplication unit 103, and an addition unit 104. The proportional gain multiplication unit 101 multiplies the angle deviation 40 computed by the angle deviation computation unit 62A by a proportional gain Kp.
The differential computation unit 102 computes a time differential value dΔθ/dt of the angle deviation Δθ. The differential gain multiplication unit 103 multiplies the differential value dΔθ/dt computed by the differential computation unit 102 by a differential gain Kd. The addition unit 104 adds multiplication results Kp·Δθ of the proportional gain multiplication unit 101 and multiplication results Kd·dΔθ/dt of the differential gain multiplication unit 103 to compute feedback control torque Trb. In this embodiment, the feedback control torque Tfb is an example of “basic torque command value” according to the present invention.
The first torque computation unit 63 includes a differential computation unit 63A and a first gain multiplication unit 63B. The differential computation unit 63A computes a time differential value dTtb/dt of the steering torque Ttb. The first gain multiplication unit 63B computes a first torque Gd·dTtb/dt by multiplying the differential value dTtb/dt computed by the differential computation unit 63A by a first gain Ga.
The second torque computation unit 64 computes a second torque Gd·Ttb by multiplying the steering torque Ttb by a second gain Gp.
The first torque addition unit 65 adds the first torque Gd·dTtb/dt and the second torque Gp·Ttb to compute a resonance control torque Tres (=Gd·dTtb/dt+Gp·Ttb).
The disturbance torque estimation unit 66 is provided to estimate non-linear torque (disturbance torque: torque other than the motor torque) that is generated as disturbance in the output shaft 9 (example of object to be controlled by the electric motor 18). The disturbance torque estimation unit 66 estimates the disturbance torque (disturbance load) Tlc, the steering angle θ, and a steering angle differential value (angular velocity) de/dt, based on the output shaft torque command value N·Tm and the actual steering angle θ. Estimated values of the disturbance torque Tlc, the steering angle θ, and the steering angle differential value (angular velocity) de/dt are represented by {circumflex over ( )}Tlc, {circumflex over ( )}θ, and d{circumflex over ( )}θ/dt, respectively. The disturbance torque estimation unit 66 will be described in detail later.
The disturbance torque estimation value {circumflex over ( )}Tlc computed by the disturbance torque estimation unit 66 is given to the second torque addition unit 67 as a disturbance torque compensation value.
The second torque addition unit 67 subtracts the disturbance torque estimation value {circumflex over ( )}Tlc from a value obtained by adding the resonance control torque Tres to the feedback control torque (basic torque command value) Tfb, thereby computing an integrated steering torque command value Tsint (=Tfb+Gd·dTtb/dt+Gp·Ttb−{circumflex over ( )}Tlc).
The integrated steering torque command value Tsint is given to the first reduction ratio division unit 68. The first reduction ratio division unit 68 computes the integrated motor torque command value Tmint by dividing the integrated steering torque command value Tsint by the reduction ratio N. This integrated motor torque command value Tmint is given to the second weighting unit 57 (see
The disturbance torque estimation unit 66 will be described in detail. The disturbance torque estimation unit 66 is made up of a disturbance observer that estimates the disturbance torque Tlc, the steering angle θ, and the angular velocity de/dt using, for example, a physical model 211 of the electric power steering system 1, as illustrated in
This physical model 211 includes the output shaft 9 and a steering column 212 (an example of a plant or a motor-driven object) including the worm wheel 21 fixed to the output shaft 9. The steering column 212 has inertia J. This inertia J includes inertia of the worm wheel 21 (worm wheel inertia), inertia of the worm gear 20 (worm gear inertia), inertia of the shaft of the electric motor 18 (motor shaft inertia), inertia of the pinion shaft 13 (pinion shaft inertia), and so forth. The steering torque Ttb is applied from the steering wheel 2 to the steering column 212 via the torsion bar 10, and also the road load torque Trl is applied thereto from the steered wheels 3 side.
Furthermore, a driving torque N·Tm equivalent to the output shaft torque command value N·Tm is applied to the steering column 212 from the electric motor 18 via the worm gear 20, and also a friction torque Tf is applied by friction between the worm wheel 21 and the worm gear 20.
An equation of motion regarding inertia of the physical model 211 is expressed by the following Expression (3).
An equation of state for the physical model 211 in
In the above Expression (4), x is a state variable vector, u1 is a known input vector, u2 is an unknown input vector, and y is an output vector (measured value). Also, in the above Expression (4), A is a system matrix, B1 is a first input matrix, B2 is a second input matrix, C is an output matrix, and D is a direct feedthrough matrix.
The above equation of state is extended to a system including the unknown input vector u2 as one of the states. An equation of state of the extended system (extended equation of state) is expressed by the following Expression (5).
In the above Expression (5), xe is a state variable vector of the extended system, and is expressed by the following Expression (6).
In the above expression (5), Ae is a system matrix of the extended system, Be is a known input matrix of the extended system, and Ce is an output matrix of the extended system.
A disturbance observer (extended state observer) expressed by an equation of the following Expression (7) is constructed from the extended equation of state expressed by the above Expression (5).
In Expression (7), {circumflex over ( )}xe represents an estimated value of xe. Also, L is an observer gain. Also, {circumflex over ( )}y represents an estimated value of y. {circumflex over ( )}xe is given by the following Expression (8).
In Expression (8), {circumflex over ( )}θ is an estimated value of θ, and {circumflex over ( )}Tlc is an estimated value of Tlc.
The disturbance torque estimation unit 66 computes the state variable vector {circumflex over ( )}xe based on the equation of the above Expression (7).
The disturbance torque estimation unit 66 includes an input vector input unit 81, an output matrix multiplication unit 82, a first addition unit 83, a gain multiplication unit 84, an input matrix multiplication unit 85, a system matrix multiplication unit 86, a second addition unit 87, an integration unit 88, and a state variable vector output unit 89.
The output shaft torque command value N·Tm computed by the reduction ratio multiplication unit 69 (see
Output of the integration unit 88 is the state variable vector {circumflex over ( )}xe (see the above Expression (8)). At the start of computation, an initial value is given as the state variable vector {circumflex over ( )}xe. The initial value of the state variable vector {circumflex over ( )}xe is, for example, 0.
The system matrix multiplication unit 86 multiplies the state variable vector {circumflex over ( )}xe by a system matrix Ae. The output matrix multiplication unit 82 multiplies the state variable vector {circumflex over ( )}xe by an output matrix Ce.
The first addition unit 83 subtracts output (Ce·{circumflex over ( )}xe) of the output matrix multiplication unit 82 from the output vector (measured value) y that is the actual steering angle θ computed by the second reduction ratio division unit 71 (see
The input matrix multiplication unit 85 multiplies the input vector u1 output from the input vector input unit 81 by an input matrix Be. The second addition unit 87 computes a differential value d{circumflex over ( )}xe/dt of the state variable vector by adding output (Be·u1) of the input matrix multiplication unit 85, output (Ae·{circumflex over ( )}xe) of the system matrix multiplication unit 86, and output (L (y−{circumflex over ( )}y)) of the gain multiplication unit 84. The integration unit 88 computes the state variable vector {circumflex over ( )}xe by integrating output (d{circumflex over ( )}x/dt) of the second addition unit 87. The state variable vector output unit 89 computes the disturbance torque estimation value {circumflex over ( )}Tlc, the steering angle estimation value {circumflex over ( )}θ, and the angular velocity estimation value d{circumflex over ( )}θ/dt, based on the state variable vector {circumflex over ( )}xe.
Unlike the extended state observer described above, a typical disturbance observer is made up of an inverse model of a plant and a low-pass filter. An equation of motion of the steering column is expressed by Expression (3), as described above. Thus, the inverse model of the steering column is given by the following Expression (9).
The inputs to the typical disturbance observer are J·d2θ/dt2 and N·Tm, and due to the second derivative of the actual steering angle θ being used, effects of noise of the rotational angle sensor 23 are great. Conversely, the extended state observer according to the embodiment described above estimates the disturbance torque using an integral type, and accordingly, the effects of noise due to differentiation can be reduced.
Note that the typical disturbance observer made up of the inverse model of the steering column and the low-pass filter may be used as the disturbance torque estimation unit 66.
The torque control unit 55 (see
The motor current command value computation unit 91 computes a motor current command value Icmd by dividing the motor torque command value Tm computed by the addition unit 59 (see
The current deviation computation unit 92 computes a deviation ΔI (=Icmd−I) between the motor current command value Icmd obtained by the motor current command value computation unit 91 and the motor current I detected by the current detection circuit 42.
The PI control unit 93 generates a drive command value for controlling the motor current I flowing through the electric motor 18 to the motor current command value Icmd by performing a PI computation (proportional-integral computation) with respect to the current deviation ΔI computed by the current deviation computation unit 92. The PWM control unit 94 generates a PWM control signal with a duty cycle corresponding to the drive command value, and performs supply thereof to the drive circuit 41. Electric power corresponding to the drive command value is thus supplied to the electric motor 18.
Next, actions of the present embodiment will be described.
The automatic steering mode refers to a steering mode in which the electric motor 18 is controlled based only on the automatic steering command value θadac. The manual steering mode refers to a steering mode in which the electric motor 18 is controlled based only on the assist torque command value Tas. The cooperative steering mode refers to a steering mode in which the electric motor 18 is controlled based on the integrated angle command value θsint obtained by taking into consideration both the automatic steering command value θadac and the manual steering command value θmdac.
When the steering mode is set to the cooperative steering mode, the first weight W1 is 0, and the second weight W2 and the third weight W3 are 1.0.
When the steering mode is set to the automatic steering mode, the first weight W1 and the third weight W3 are zero, and the second weight W2 is 1.0.
When the steering mode is set to the manual steering mode, the first weight W1 is 1.0, the second weight W2 is zero, and the third weight W3 is 0 or 1.0.
That is to say, this motor control ECU 202 can switch the steering mode among the normal steering mode, the automatic steering mode, and the manual steering mode, by operation of the mode switches 31, 32, and 33 by the driver.
Examples of setting the first weight W1, the second weight W2, and the third weight W3, in conjunction with switching of the steering mode, are shown in
In
In
In
The absolute value of the assist torque command value Tas′ following the first weighting processing, the absolute value of the integrated motor torque command value Tmint′ following the second weighting processing, and the absolute value of the manual steering command value θmdac′ following the third weighting processing are thus gradually increased or gradually decreased, and accordingly, switching among the steering modes is smoothly performed.
The amount of time T required to switch the first weight W1, the second weight W2, and the third weight W3 between zero and 1.0 is set to a predetermined value obtained in advance through experiments, analysis, and so forth. Also, the amount of time T required to switch the weight between zero and 1.0 may be set to be different among the first weight W1, the second weight W2, and the third weight W3. Also, the first weight W1, the second weight W2, and the third weight W3 may be set to gradually increase or gradually decrease nonlinearly rather than linearly.
In the present embodiment, when an operation of the mode switches 31, 32, and 33 that does not involve changing of the steering mode is performed, this operation is considered to be invalid. Also, in the present embodiment, when any of the mode switches 31, 32, 33 is operated before the predetermined amount of time T has elapsed since one of the mode switches 31, 32, or 33 was operated, this operation is considered to be invalid.
Note that while the switching of the steering mode is performed by the mode switches 31, 32, and 33, the host ECU 201 may switch the steering mode in accordance with an ON/OFF signal of a driver assistance function or an automated driving function, an obstruction, a state of the driver, a driver operation of the accelerator, brake, or the like, and the state of the vehicle traveling. In this case, the host ECU 201 generates a mode setting signal in accordance with the ON/OFF signal of the driver assistance function or the automated driving function, the obstruction, the state of the driver, the driver operation of the accelerator, brake, or the like, or the state of the vehicle traveling, and gives the mode setting signal to the motor control ECU 202.
The two-inertia model 301 includes a steering wheel 2, a torsion bar 10, and a steering column 310.
The steering wheel 2 has inertia of the steering wheel 2 (hereinafter referred to as steering wheel inertia Jsw). The steering column 310 has column inertia Jp. The column inertia Jp includes inertia of the worm wheel 21 (worm wheel inertia), inertia of the worm gear 20 (worm gear inertia), inertia of the shaft of the electric motor 18 (motor shaft inertia), inertia of the pinion shaft 13 (pinion shaft inertia), and so forth.
In
Also, Op is a rotational angle of the steering column 310 (hereinafter referred to as column angle θp), and dθp/dt is angular velocity of the steering column 310 (hereinafter referred to as column angular velocity dθp/dt).
Also, Td is driver torque applied to the steering wheel 2 by the driver, ktb is stiffness of the torsion bar 10 (hereinafter referred to as the torsion bar stiffness ktb), Ttb is the steering torque (torsion bar torque), N is the reduction ratio of the speed reducer 19, and N·Tm is a driving torque N·Tm that is equivalent to the output shaft torque command value N·Tm. The steering torque Ttb is Ttb=ktb (θsw−θp).
In this two-inertia model 301, driver torque Ta is applied to the steering wheel 2 by the driver, and also −Ttb, which is the sign-inverted value of the steering torque Ttb, is applied from the torsion bar 10. The driving torque N·Tm is applied to the steering column 310 from the electric motor 18. However, when the integrated angle command value θsin following low-pass filter processing is 0 degrees, then N·Tm=(−Kp·θp−Kd·dθp/dt+Gp·Ttb+Gd·dTtb/dt) holds.
Note that when load compensation is not performed, the steering torque Ttb and the road load torque Trl are applied to the steering column 310 in addition to the driving torque N·Tm.
The feedback control torque Tfb is generated by PD control with respect to deviation between the integrated angle command value θsin following low-pass filter processing and the column angle θp (actual steering angle θ). Note that in the present embodiment, the proportional gain Kp and the differential gain Kd each include the column inertia Jp, which will be described later.
A resonance control torque Tres (=Gd·dTtb/dt+Gp·Ttb) is added to the feedback control torque Tfb. This added value (Tfb+Gd·dTtb/dt+Gp·Ttb) is equivalent to the output shaft torque command value N·Tm corresponding to a value obtained by multiplying the angular acceleration of the column angle θp (hereinafter referred to as column angular acceleration d2θp/dt2) by the column inertia Jp. A driving torque corresponding to this output shaft torque command value N·Tm is applied from the electric motor 18 to the steering column 310. When the driving torque N·Tm is input to the steering column 310 having inertia that is Jp, the steering column 310 rotates, and of the rotational angle (column angle θp) is measured based on the rotational angle sensor 23, and feedback thereof is performed.
Here, the steering torque Ttb is equivalent to a value obtained by multiplying difference between the column angle θp and the wheel angle θsw (θsw−θp) by the torsion bar stiffness ktb, and Ttb=ktb (θsw−θp) holds. The sum of a value Gd·dTtb/dt obtained by multiplying the differential value of this steering torque Tub by the first gain Ga, and a value Gp·Ttb obtained by multiplying this steering torque Tub by the second gain Gp, is fed back as resonance control torque Tres. Also, when the steering torque Ttb and the driver torque Ta are input to the steering wheel 2, having inertia that is Jsw, the steering wheel 2 rotates thereby.
In the two-inertia model 301 of
In the two-inertia model 301 in
In Expressions (11a) to (11d) and Expressions (12a) and (12b), ωsw is the natural frequency (resonant frequency) of the steering wheel 2 determined by the mechanical characteristics of the steering wheel 2. Also, ω is a variable that represents the resonant frequency of the system.
In the two-inertia model 301 in
In the first embodiment, the resonant frequency ω and damping characteristics can be optionally set, and accordingly the responsivity can be changed. Specifically, the greater a value the resonant frequency ω is set to, the faster the responsivity becomes.
In the first embodiment, load compensation is performed, but load compensation does not necessarily have to be performed. In this case, a value (Tfb+Gd·dTtb/dt+Gp·Ttb), obtained by adding the resonance control torque Tres (=Gd·dTtb/dt+Gp·Ttb) to the feedback control torque (basic torque command value) To becomes the integrated steering torque command value Tsint.
When there is no load compensation, the steering torque Ttb is conceivably being fed back to the steering column 310 in advance, and accordingly with the second gain when there is no load compensation as Gp′, and with the second gain when there is load compensation as Gp, Gp′=(Gp−1) is set.
Also, in the first embodiment described above, switching can be performed among the cooperative steering mode in which the electric motor 18 can be controlled based on the integrated angle command value θsint, the manual steering mode in which the electric motor 18 can be controlled based only on the assist torque command value Tas, and the automatic steering mode in which the electric motor 18 can be controlled based only on the automatic steering command value θadac.
That is to say, in the electric power steering system 1 that can control the electric motor 18 based on the integrated angle command value θsint, the electric motor 18 can be controlled based only on the assist torque command value Tas.
Also, in the first embodiment described above, in the manual steering mode, the electric motor 18 is controlled based only on the assist torque command value Tas, and accordingly the driver can receive the actual road load torque (road reaction torque).
Also, in the first embodiment described above, the basic torque command value (Tfb) is computed based on the integrated angle command value θsint, and the basic torque command value (Tfb) is corrected by the disturbance torque estimation value {circumflex over ( )}Tlc computed by the disturbance torque estimation unit 66. That is to say, in the first embodiment described above, the nonlinear disturbance torque (torque other than the motor torque) that occurs as a disturbance in the output shaft 9 is compensated for (load compensation). Accordingly, the effects of disturbance torque on the angle control performance can be suppressed. Thus, highly precise angle control can be realized.
In the following, an electric power steering system including an angle control unit having a function of performing load compensation and also receiving KR·Ttb as feedback, as described in Patent Document 1, will be referred to as a conventional example. In the conventional example, KR is vibration suppression gain, and KR· Ttb is vibration suppression torque. In the conventional example, the angle control unit is provided with a feedback control unit and a feedforward control unit, but an assumption will be made that the feedforward control unit is not provided, in order to simplify description.
In the conventional example, in the angle control unit, a value obtained by subtracting the disturbance torque estimation value {circumflex over ( )}Tlc from a value obtained by adding the vibration suppression torque KR·Ttb to the feedback control torque Tfb (=Tfb+KR·Ttb−Tlc) becomes the output shaft torque command value N·Tm.
In the two-inertia model 302 in
In this two-inertia model 302, driver torque Ta is applied to the steering wheel 2 by the driver, and also s−Ttb, which is the sign-inverted value of the steering torque Ttb, is applied from the torsion bar 10. The driving torque N·Tm is applied to the steering column 310 from the electric motor 18. Note, however, that assuming the angle command value given to the feedback control unit to be 0 degrees, N·Tm=(−Kp θp−Kd·dθp/dt+KR·Ttb) holds. Kp is proportional gain in the conventional example, and Kd is differential gain in the conventional example.
In the two-inertia model 302 in
In the two-inertia model 302 in
Next, an electric power steering system to which a motor control device according to a second embodiment of the present invention is applied (hereinafter, referred to as “electric power steering system according to second embodiment”) will be described.
In the electric power steering system according to the second embodiment, a configuration of a motor control ECU 202A is different from the configuration of the motor control ECU 202 in
The motor control ECU 202A includes a microcomputer 50A, the drive circuit (inverter circuit) 41 that is controlled by the microcomputer 50A and that supplies electric power to the electric motor 18, and the current detection circuit 42 that detects a current flowing through the electric motor 18 (hereinafter referred to as “motor current I”).
The microcomputer 50A includes a CPU and memory (such as ROM, RAM, non-volatile memory, and so forth), and functions as a plurality of functional processing units by executing a predetermined program. The plurality of functional processing units include an assist torque command value setting unit 151, a first reduction ratio multiplication unit 152, a first torque computation unit 153, a second torque computation unit 154, a first torque addition unit 155, a disturbance torque estimation unit 156, a second torque addition unit 157, a first reduction ratio division unit 158, a torque control unit 159, a second reduction ratio multiplication unit 160, a rotational angle computation unit 161, and a second reduction ratio division unit 162.
The second reduction ratio multiplication unit 160 multiplies the motor torque command value Tm computed by the first reduction ratio division unit 158 by the reduction ratio N of the speed reducer 19, to convert the motor torque command value Tm into the output shaft torque command value N·Tm that acts on the output shaft 9.
The rotational angle computation unit 161 computes the rotor rotational angle θm of the electric motor 18 based on the output signal from the rotational angle sensor 23. The second reduction ratio division unit 162 converts the rotor rotational angle θm computed by the rotational angle computation unit 161 into the rotational angle (actual steering angle) θ of the output shaft 9 by dividing the rotor rotational angle θm by the speed reduction ratio N.
The assist torque command value setting unit 151 sets the assist torque command value Tas that is a target value of the assist torque necessary for manual operations. Actions of the assist torque command value setting unit 151 are similar to those of the assist torque command value setting unit 51 in
The first reduction ratio multiplication unit 152 multiplies the assist torque command value Tas set by the assist torque command value setting unit 151 by the reduction ratio N, to convert the assist torque command value Tas for the electric motor 18 into an assist torque command value N·Tas for the output shaft 9. The assist torque command value Tas is given to the second torque addition unit 157.
The first torque computation unit 153 includes a differential computation unit 153A and a first gain multiplication unit 153B. The differential computation unit 153A computes the time differential value dTtb/dt of the steering torque Ttb. The first gain multiplication unit 153B computes a first torque Gd·dTtb/dt by multiplying the differential value dTtb/dt computed by the differential computation unit 153A by the first gain Ga.
The second torque computation unit 154 computes a second torque Gp·Ttb by multiplying the steering torque Ttb by the second gain Gp.
The first torque addition unit 155 adds the first torque Gd·dTtb/dt and the second torque Gp·Ttb to compute the resonance control torque Tres (=Gd·dTtb/dt+Gp·Ttb). The resonance control torque Tres is given to the second torque addition unit 157.
A disturbance torque estimation unit 156 estimates the disturbance torque (disturbance load) Tlc, the steering angle θ, and the steering angle differential value (angular velocity) dθ/dt, based on the output shaft torque command value N·Tm and the actual steering angle θ. The estimated values of the disturbance torque Tlc, the steering angle θ, and the steering angle differential value (angular velocity) dθ/dt are represented by {circumflex over ( )}Tlc, {circumflex over ( )}θ, and d{circumflex over ( )}θ/dt, respectively. The configuration and actions of the disturbance torque estimation unit 156 are similar to those of the disturbance torque estimation unit 66 in
The disturbance torque estimation value {circumflex over ( )}Tlc computed by the disturbance torque estimation unit 156 is given to the second torque addition unit 157 as a disturbance torque compensation value.
The second torque addition unit 157 computes the output shaft torque command value N·Tm (=N·Tas+Gd·dTtb/dt+Gp·Ttb−{circumflex over ( )}Tlc) by subtracting the disturbance torque estimation value {circumflex over ( )}Tlc from a value obtained by adding the resonance control torque Tres to the assist torque command value N·Tas.
The output shaft torque command value N·Tm is given to the first reduction ratio division unit 158. The first reduction ratio division unit 158 computes the motor torque command value Tm by dividing the output shaft torque command value N·Tm by the reduction ratio N. This motor torque command value Tm is given to the torque control unit 159.
The torque control unit 159 drives the drive circuit 41 such that the motor torque of the electric motor 18 is brought closer the motor torque command value Tm. The configuration and actions of the torque control unit 159 are similar to those of the torque control unit 55 in
In this two-inertia model 303, driver torque Ta is applied to the steering wheel 2 by the driver, and also −Ttb, which is the sign-inverted value of the steering torque Ttb, is applied from the torsion bar 10. Driving torque N·Tm equivalent to the output shaft torque command value N·Tm is applied from the electric motor 18 to the steering column 310. Note that N·Tm=(N·Tas+Gd·dTtb/dt+Gp·Ttb) holds.
In the two-inertia model 303 in
In the two-inertia model 303 in
In the two-inertia model 303 of
In the second embodiment, the resonant frequency ω and damping characteristics can be optionally set, and accordingly the responsivity can be changed. Specifically, the greater a value the resonant frequency ω is set to, the faster the responsivity becomes.
In the second embodiment, load compensation is performed, but load compensation does not necessarily have to be performed. In this case, the second torque addition unit 157 computes the output shaft torque command value N·Tm (=N·Tas+Gd·Ttb/dt+Gp·Ttb) by adding the resonance control torque Tres to the assist torque command value N· Tas.
When there is no load compensation, the steering torque Tub is conceivably being fed back to the steering column 310 in advance, and accordingly with the second gain when there is no load compensation as Gp′, and with the second gain when there is load compensation as Gp, Gp′=(Gp−1) is set.
Next, an electric power steering system to which a motor control device according to a third embodiment of the present invention is applied (hereinafter, referred to as “electric power steering system according to third embodiment”) will be described.
The electric power steering system according to the third embodiment has the same overall configuration as that illustrated in
The angle control unit 54A in
The actions of the first torque computation unit 63, the second torque computation unit 64, the first torque addition unit 65, the disturbance torque estimation unit 66, the first reduction ratio division unit 68, the reduction ratio multiplication unit 69, the rotational angle computation unit 70, and the second reduction ratio division unit 71 in
The feedback control unit 400 includes a target torque computation unit 401, a feedback torque computation unit 402, and a torque deviation computation unit 403.
The target torque computation unit 401 computes a target torque Tta by performing predetermined computation on the integrated angle command value θsint computed by the integrated angle command value computation unit 53 (see
The target torque computation unit 401 includes a proportional gain multiplication unit 411, a first-order differential computation unit 412, a first-order differential gain multiplication unit 413, a second-order differential computation unit 414, a second-order differential gain multiplication unit 415, a third-order differential computation unit 416, a third-order differential gain multiplication unit 417, a fourth-order differential computation unit 418, a fourth-order differential gain multiplication unit 419, and first to fourth addition units 420 to 423.
The proportional gain multiplication unit 411 multiplies the integrated angle command value θsint by a proportional gain K0dot.
The first-order differential computation unit 412 computes a first-order differential value deθsint/dt of the integrated angle command value θsint. The first-order differential gain multiplication unit 413 multiplies the first-order differential value dθsint/dt computed by the first-order differential computation unit 412 by a first-order differential gain K1dot.
The second-order differential computation unit 414 computes a second-order differential value d2θsint/dt2 of the integrated angle command value θsint. The second-order differential gain multiplication unit 415 multiplies the second-order differential value d2θsim/dt2 computed by the second-order differential computation unit 414 by a second-order differential gain K2dot.
The third-order differential computation unit 416 computes a third-order differential value d3θsint/dt3 of the integrated angle command value θsint. The third-order differential gain multiplication unit 417 multiplies the third-order differential value d3θsint/dt3 computed by the third-order differential computation unit 416 by a third-order differential gain K3dot.
The fourth-order differential computation unit 418 computes a fourth-order differential value d4θsint/dt4 of the integrated angle command value θsint. The fourth-order differential gain multiplication unit 419 multiplies the fourth-order differential value d4θsint/dt4 computed by the fourth-order differential computation unit 418 by a fourth-order differential gain K4dot.
The first addition unit 420 adds a multiplication result K4dot·d4θsint/dt4 of the fourth-order differential gain multiplication unit 419 and a multiplication result K3dot′d3θsint/dt3 of the third-order differential gain multiplication unit 417.
The second addition unit 421 adds the addition result of the first addition unit 420 (K3dot′d3θsint/dt3+K4dot′d4θsint/dt4) and the multiplication result K2dot′d2θsint/dt2 of the second-order differential gain multiplication unit 415.
The third addition unit 422 adds the addition result of the second addition unit 421 (K2dot′d2θsint/dt2+K3dot·d3θsint/dt3+K4dot·d4θsint/dt4) and the multiplication result K1dot·dθsint/dt of the first-order differential gain multiplication unit 413.
The fourth addition unit 423 adds the addition result of the third addition unit 422 (K1dot·dθsint/dt+K2dot·d2θsint/dt2+K3dot·d3θsint/dt3+K4dot·d4θsint/dt4) and the multiplication result K0dot·θsint of the proportional gain multiplication unit 411, thereby computing the target torque Tta. The target torque Tta is expressed as (K0dot·θsint+K0dot·dθsint/dt+K2dot′d2θsint/dt2+K3dor·d3θsint/dt3+K4dot·d4θsint/dt4).
The feedback torque computation unit 402 computes feedback torque Tfe by performing predetermined computation with respect to the actual steering angle θ.
The feedback torque computation unit 402 includes a proportional gain multiplication unit 431, a differential computation unit 432, a differential gain multiplication unit 433, and an addition unit 434. The proportional gain multiplication unit 431 multiplies the actual steering angle θ computed by the second reduction ratio division unit 71 by the proportional gain Kp.
The differential computation unit 432 computes a time differential value de/dt of the actual steering angle θ. The differential gain multiplication unit 433 multiplies the differential value dθ/dt computed by the differential computation unit 432 by the differential gain Kd. The addition unit 434 adds the multiplication result Kp·θ of the proportional gain multiplication unit 431 and the multiplication result Kd·dθ/dt of the differential gain multiplication unit 433, thereby computing feedback control torque Tre. The feedback torque Tfe is (Kp·θ+Kd·dθ/dt).
Note that in
The torque deviation computation unit 403 computes the feedback control torque Tfb by subtracting the feedback torque Tfe from the target torque Tta. The feedback control torque Tfb is a control torque for bringing the actual steering angle θ closer to the integrated angle command value θsint. In this embodiment, the feedback control torque Tfb is an example of “basic torque command value” according to the present invention.
The second torque addition unit 67 subtracts the disturbance torque estimation value {circumflex over ( )}Tlc from a value obtained by adding the resonance control torque Tres to the feedback control torque (basic torque command value) Tfb, thereby computing an integrated steering torque command value Tsint (=Tfb+Gd·dTtb/dt+Gp·Ttb−{circumflex over ( )}Tlc).
The integrated steering torque command value Tsint is given to the first reduction ratio division unit 68. The first reduction ratio division unit 68 computes the integrated motor torque command value Tmint by dividing the integrated steering torque command value Tsint by the reduction ratio N. This integrated motor torque command value Tmint is given to the second weighting unit 57 (see
In this two-inertia model 304, the driver torque Ta is applied to the steering wheel 2 by the driver, and also −Ttb, which is the sign-inverted value of the steering torque Ttb, is applied from the torsion bar 10. The driving torque N·Tm is applied to the steering column 310 from the electric motor 18. The driving torque N·Tm is N·Tm=(K0dot·θsint+K1dot·dθsint/dt+K2dot·d2θsint/dt2+K3dot′d3θsint/dt3+K4dot·d4θsint/dt4−Kp·θp−Kd·dθp/dt+Gp·Ttb+Gd·dTtb/dt).
Note that when load compensation is not performed, the steering torque Ttb and the road load torque Trl are applied to the steering column 310 in addition to the driving torque N·Tm.
The feedback torque Tfe computed by the feedback torque computation unit 402 based on the first column angle θp (actual steering angle θ), is subtracted from the target torque Tta computed by the target torque computation unit 401 based on the integrated angle command value θsint, thereby generating the feedback control torque Tfb (=Tta−Tfe). Note that in the present embodiment, the proportional gain Kp and the differential gain Kd each include the column inertia Jp, which will be described later. Also, when the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot are set to significant values other than zero, column inertia Jp is included.
The resonance control torque Tres (=Gd·dTtb/dt+Gp·Ttb) is added to the feedback control torque Trb. This added value (Tfb+Gd·dTtb/dt+Gp·Ttb) is equivalent to the output shaft torque command value N·Tm corresponding to a value obtained by multiplying the angular acceleration of the column angle θp (hereinafter referred to as column angular acceleration d2θp/dt2) by the column inertia Jp. A driving torque corresponding to this output shaft torque command value N·Tm is applied from the electric motor 18 to the steering column 310. When the driving torque N·Tm is input to the steering column 310 having inertia that is Jp, the steering column 310 rotates, and of the rotational angle (column angle θp) is measured based on the rotational angle sensor 23, and feedback thereof is performed.
Here, the steering torque Ttb is equivalent to a value obtained by multiplying difference between the column angle θp and the wheel angle θsw (θsw−θp) by the torsion bar stiffness Ktb, and Ttb=Ktb (θsw−θp) holds. The sum of a value Gd·dTtb/dt obtained by multiplying the differential value of this steering torque Ttb by the first gain Gd, and a value Gp·Ttb obtained by multiplying this steering torque Ttb by the second gain Gp, is fed back as resonance control torque Tres. Also, when the steering torque Ttb and the driver torque Td are input to the steering wheel 2, having inertia that is Jsw, the steering wheel 2 rotates thereby.
In the two-inertia model 304 in
In the two-inertia model 304 of
When the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot are set to values as in the following Expression (21), for example, the configuration of the feedback control unit 400 in
In this case, the gain Kp for the angle θsint (θsin in
In the third embodiment, different gains can be set on the command value side and the feedback side. In the third embodiment, different gains are preferably set on the command value side and the feedback side. In other words, it is preferable that the gain used in the computation of the target torque Tta and the gain used in the computation of the feedback torque Tfe are different from each other.
A specific example of setting the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot will be described below. Note that the proportional gain Kp, the differential gain Kd, the second gain Gp, and the first gain Ga are assumed to be set to the values in the above Expressions (11a), (11b), (11c) and (11d).
In a first setting example, the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot are set to values as in the following Expression (22).
In this case, the transfer function G (θsint→θp) from the integrated angle command value θsint to the column angle θp is expressed by the following Expression (23a), and the transfer function G (θsint→θsw) from the integrated angle command value θsint to the wheel angle θsw is expressed by the following Expression (23b).
In this case, the wheel angle θsw responds with a fourth-order lag. In this case, the resonant frequency ω and the damping ratio ζ can be optionally set, in the same way as in the first embodiment.
In a second setting example, the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot are set to values as in the following Expression (24).
In this case, the transfer function G (θsint→θp) from the integrated angle command value θsint to the column angle θp is expressed by the following Expression (25a), and the transfer function G (θsint→θsw) from the integrated angle command value θsint to the wheel angle θsw is expressed by the following Expression (25b).
In this case, the wheel angle θsw responds with a third-order lag. In this case, the resonant frequency ω can be optionally set, in the same way as in the first embodiment.
In a third setting example, the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot are set as in the following Expression (26).
In this case, the transfer function G (θsint→θp) from the integrated angle command value θsint to the column angle θp is expressed by the following Expression (27a), and the transfer function G (θsint→θsw) from the integrated angle command value θsint to the wheel angle θsw is expressed by the following Expression (27b).
In this case, the wheel angle θsw responds with a second-order lag. In the third setting example, the resonant frequency ω and the damping ratio ζ can be optionally set, in the same way as in the first embodiment.
In a fourth setting example, the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot are set as in the following Expression (28).
In this case, the transfer function G (θsint→θp) from the integrated angle command value θsint to the column angle θp is expressed by the following Expression (29a), and the transfer function G (θsint→θsw) from the integrated angle command value θsint to the wheel angle θsw is expressed by the following Expression (29b).
In this case, the wheel angle θsw responds with a first-order lag. In this case, the resonant frequency ω can be optionally set, in the same way as in the first embodiment.
Note that in this case, a low-pass filter (LPF) of first or higher order, having a cutoff frequency no higher than ω, is preferably provided between the integrated angle command value computation unit 53 (see
In a fifth setting example, the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot are set as in the following Expression (30).
In this case, the transfer function G (θsint→θp) from the integrated angle command value θsint to the column angle θp is expressed by the following Expression (31a), and the transfer function G (θsint→θsw) from the integrated angle command value θsint to the wheel angle θsw is expressed by the following Expression (31b).
In this case, the wheel angle θsw responds without lag.
Note that in this case, a low-pass filter (LPF) of second or higher order, having a cutoff frequency no higher than ω, is preferably provided between the integrated angle command value computation unit 53 (see
In the third embodiment, load compensation is performed, but load compensation does not necessarily have to be performed. In this case, a value (Tfb+Gd·dTtb/dt+Gp·Ttb), obtained by adding the resonance control torque Tres (=Gd·dTtb/dt+Gp·Ttb) to the feedback control torque (basic torque command value) Ttb becomes the integrated steering torque command value Tsint.
When there is no load compensation, the steering torque Ttb is conceivably being fed back to the steering column 310 in advance, and accordingly with the second gain when there is no load compensation as Gp′, and with the second gain when there is load compensation as Gp, Gp′=(Gp−1) is set.
In the third embodiment, setting the proportional gain Kp, the derivative gain Kd, the second gain Gp, the first gain Gd, the proportional gain K0dot, the first-order differential gain K1dot, the second-order differential gain K2dot, the third-order differential gain K3dot, and the fourth-order differential gain K4dot, to the respective values such as described above, enables response characteristics (such as n-th order lag and so forth) to be optionally set, in addition to the resonant frequency ω and the damping ratio ζ.
Also, in the third embodiment, switching can be performed among the cooperative steering mode in which the electric motor 18 can be controlled based on the integrated angle command value θsint, the manual steering mode in which the electric motor 18 can be controlled based only on the assist torque command value Tas, and the automatic steering mode in which the electric motor 18 can be controlled based only on the automatic steering command value θadac.
That is to say, in the electric power steering system that can control the electric motor 18 based on the integrated angle command value θsint, the electric motor 18 can be controlled based only on the assist torque command value Tas.
While the first embodiment, the second embodiment, and the third embodiment of this invention have been described above, this invention can also be carried out in yet other forms.
For example, in the first embodiment, the second embodiment, and the third embodiment, a dead band processing unit may be provided for at least one of the steering torque Ttb input to the first torque computation units 63 and 153, and the steering torque Ttb input to the second torque computation units 64 and 154. The reason for providing the dead band processing unit will be described later.
A case will be described below, with reference to
The steering torque Ttb is input to the dead band processing unit 501.
With a dead band width of W, the dead band processing unit 501 outputs zero as a steering torque Ttb,de following dead band processing in a case in which the steering torque Ttb is within a range of −W/2 or greater and W/2 or smaller (dead band region).
In a region in which the steering torque Ttb is smaller than −W/2, the dead band processing unit 501 outputs [Ttb+ (W/2)] as the steering torque Ttb,de following the dead band processing. In a region in which the steering torque Ttb is greater than W/2, the dead band processing unit 501 outputs [Ttb−(W/2)] as the steering torque Ttb,de following the dead band processing. The dead band width W is set in advance.
In this case, the second torque computation unit 64 computes second torque Gp·Ttb,de by multiplying the steering torque Ttb,de following the dead band processing by the second gain Gp. Accordingly, in this case, the resonance control torque Tress is Gd·dTtb/dt+Gp·Ttb,de.
Note that within a dead band region in which the absolute value of the steering torque Ttb is small, the dead band processing unit 501 may output a value close to zero as the steering torque Ttb,de following the dead band processing. For example, the input/output characteristics of the dead band processing unit 501 may be characteristics such as shown in
In other words, the input/output characteristics of the dead band processing unit 501 may be characteristics such that, within a dead band region (a range of −W/2 or greater and W/2 or smaller) in which the absolute value of the steering torque Ttb is small, the absolute value of the steering torque Ttb,de following the dead band processing gradually increases quadratically as the absolute value of the steering torque Ttb increases, and, in a range in which the absolute value of the steering torque Ttb is greater than the dead band region, the absolute value of the steering torque Ttb,de following the dead band processing increases linearly as the absolute value of the steering torque Ttb increases.
The dead band processing unit 501 may be provided upstream of both the first torque computation unit 63 and the second torque computation unit 64, as illustrated in
In this case, the first torque computation unit 63 computes the first torque Gd·dTtb,de/dt by multiplying the time differential value dTtb,de/dt of the steering torque Ttb,de following the dead band processing by the first gain Ga. The second torque computation unit 64 computes the second torque by multiplying the steering torque Ttb,de following the dead band processing by the second gain Gp. Accordingly, in this case, the resonance control torque Tress is Gd·dTtb,de/dt+Gp·Ttb,de.
The dead band processing unit 501 may be provided upstream of the first torque computation unit 63, as illustrated in
In this case, the first torque computation unit 63 computes the first torque Gd·dTtb,de/dt by multiplying the time differential value dTtb,de/dt of the steering torque Ttb,de following the dead band processing by the first gain Ga. Accordingly, in this case, the resonance control torque Tress is Gd·dTtb,de/dt+Gp·Ttb.
The reason for providing the dead band processing unit 501 will be described. The steering torque Ttb (primarily the sum of the driver torque Ta applied to the steering wheel 2 by the driver and the force generated by steering inertia) may be offset by friction and so forth. Accordingly, even when the absolute value of the actual steering torque Ttb is zero or close to zero, the absolute value of the steering torque Ttb that is detected by the torque sensor 12 may be greater than the absolute value of the actual steering torque Ttb. Hence, when the absolute value of the actual steering torque Ttb is zero or close to zero, a resonance control torque Tres (=Gd·dTtb/dt+Gp·Ttb) that is greater than anticipated will be output, resulting in deviation (steering angle deviation) from the steering angle command value (integrated angle command value θsint).
As illustrated in
Although omitted from illustration, the dead band processing unit 501 described above may be provided only upstream from the second torque computation unit 154 (
In the above first, second, and third embodiments, the first weighting unit 56, the second weighting unit 57, and the third weighting unit 58 are provided, but the third weighting unit 58 may be omitted. In this case, two types of steering modes, i.e., the manual steering mode and the cooperative steering mode, will be available.
In the first, second and third embodiments described above, assumption is made that the steering torque (torsion bar torque) Ttb is expressed as Ttb=ktb (θsw−θp), and this Ttb is fed back, but, as can be understood from the expression Ttb=ktb (θsw−θp), this is equivalent to feeding back the relative angle between the steering wheel 2 and the steering column 310. Accordingly, providing an angle sensor for detecting the rotational angle of the steering wheel 2 enables similar control without using the steering torque Ttb by feedback of the relative angle between the steering wheel 2 and the steering column 310 and the relative speed between the steering wheel 2 and the steering column 310 (which may be detected by a speed sensor or may be the differential value of the relative angle).
In this case, the resonance control torque Tres is expressed as Tres=[{Gp′×(relative angle)}+{Gd′×(relative speed)}]. Here, Gp′=Gp·ktb, and Gd′=Gd·ktb hold.
Although embodiments of the present invention are described in detail above, these are merely specific examples used to clarify the technical content of the present invention, and the present invention should not be construed as being limited to these specific examples, and the scope of the present invention is limited only by the appended claims.
This application corresponds to Japanese Patent Application No. 2022-6684 filed with the Japan Patent Office on Jan. 19, 2022, the entire disclosure of which is incorporated herein by reference.
Number | Date | Country | Kind |
---|---|---|---|
2022-006684 | Jan 2022 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2022/015152 | 3/28/2022 | WO |