WO2018038110A1 - 電動パワーステアリング装置の制御装置 - Google Patents
電動パワーステアリング装置の制御装置 Download PDFInfo
- Publication number
- WO2018038110A1 WO2018038110A1 PCT/JP2017/029971 JP2017029971W WO2018038110A1 WO 2018038110 A1 WO2018038110 A1 WO 2018038110A1 JP 2017029971 W JP2017029971 W JP 2017029971W WO 2018038110 A1 WO2018038110 A1 WO 2018038110A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- steering angle
- steering
- angle
- actual
- control
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
- B62D5/0457—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
- B62D5/0481—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such monitoring the steering system, e.g. failures
- B62D5/049—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such monitoring the steering system, e.g. failures detecting sensor failures
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/021—Determination of steering angle
- B62D15/0235—Determination of steering angle by measuring or deriving directly at the electric power steering motor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
- B62D5/0457—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
- B62D5/0481—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such monitoring the steering system, e.g. failures
- B62D5/0484—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such monitoring the steering system, e.g. failures for reaction to failures, e.g. limp home
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/04—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits responsive only to forces disturbing the intended course of the vehicle, e.g. forces acting transversely to the direction of vehicle travel
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/021—Determination of steering angle
- B62D15/0245—Means or methods for determination of the central position of the steering system, e.g. straight ahead position
Definitions
- the present invention relates to a control device for an electric power steering device.
- an electric power steering device (EPS: Electric Power Steering) has been proposed and put into practical use in an automobile steering system.
- EPS Electric Power Steering
- the development of an electric power steering device that generates an auxiliary steering torque by an electric motor in accordance with the steering torque applied to the steering wheel and transmits the auxiliary steering torque to the steering shaft has been underway.
- the motor is connected to the steering shaft via a speed reduction mechanism, and the rotation of the motor is transmitted to the steering shaft after being decelerated by the speed reduction mechanism.
- ⁇ Problem 1 (Discomfort at the time of driver intervention during automatic driving, compatibility between steering angle control and assist control)>
- the position control unit has P control (proportional control), PI control (proportional integral control) is used for the speed control unit.
- the actual speed of the motor becomes slower than the rudder angular speed command value, so that a deviation occurs between the rudder angular speed command value and the actual speed, and the integral value of I control (integral control) in the speed control is By accumulating, a larger steering angle control command value is output from the speed control.
- the restriction due to the gradually changing gain is relaxed, so that the steering angle control command value becomes an excessive value as the gradually changing gain increases.
- the steering wheel responds excessively to the rudder angular velocity command value, giving the driver a sense of incongruity and discomfort in the form of a feeling of catching.
- the present invention has been made in view of the circumstances described above, and at least solves any of the above-described problems, that is, intervenes when steering operation (steering) by a driver intervenes during automatic driving of a vehicle.
- Provide an electric power steering device that can fully reflect the operation and reduce the uncomfortable feeling and discomfort that the driver may feel when the operation intervenes, or provide an angle sensor with something
- Provided is a control device for an electric power steering device that, when an abnormality is detected, instead of using an angle sensor, obtains an estimated value of the rudder angle and performs rudder angle control using the obtained estimated value of the rudder angle For the purpose.
- a control device for an electric power steering device is a control device for an electric power steering device that applies a steering assist force to a steering mechanism of a vehicle by the rotational force of a motor.
- the steering angle command value ⁇ ref calculated based on the target track of the vehicle is input, and the steering angle control unit controls the steering angle of the steering mechanism based on the input steering angle command value ⁇ ref.
- the detected steering angle ⁇ h is output as the actual steering angle ⁇ r, while the steering angle abnormality determination signal is abnormal.
- the steering angle calculation unit uses the steering torque Tt that is input together with the motor angle ⁇ m to determine the actual steering angle.
- a mode in which the estimated value ⁇ r is obtained is preferable.
- the steering angle abnormality determination signal indicates that the steering angle abnormality determination signal is abnormal
- the past value Z ⁇ r of the normal actual steering angle and the relative angle ⁇ m of the motor An embodiment in which the actual steering angle estimated value ⁇ r is derived using the torsional relative angle ⁇ of the torsion bar is preferable.
- the rudder angle abnormality determination signal indicates that the rudder angle abnormality determination signal is abnormal
- the past actual value Z ⁇ r of the normal steering angle and the relative angle ⁇ m of the motor It is preferable that the actual steering angle estimated value ⁇ r is derived using the above.
- a control device for an electric power steering device is a control device for an electric power steering device that applies a steering assist force to the steering mechanism of the vehicle by the rotational force of the motor, and is a target trajectory of the vehicle.
- the steering angle command value ⁇ ref calculated based on the steering angle is input, and the steering angle control unit controls the steering angle of the steering mechanism based on the input steering angle command value ⁇ ref.
- the detected steering angle ⁇ h is output as the actual steering angle ⁇ r, while when the steering angle abnormality determination signal indicates abnormality, it is input.
- an estimated value ⁇ r of the actual steering angle of the steering mechanism is obtained, and a steering angle calculation unit that outputs the actual steering angle estimated value ⁇ r, the input target steering angle ⁇ t, and the actual steering angle ⁇ r It is based on the actual steering angle estimated value [theta] r, comprising a position control unit for deriving a steering angular velocity command value .omega.ref.
- the steering angle calculation unit uses the steering torque Tt that is input together with the actual steering angular velocity ⁇ r to perform actual steering.
- a mode in which the estimated angle value ⁇ r is obtained is preferable.
- the rudder angle abnormality determination signal indicates that the rudder angle abnormality determination signal is abnormal
- the past value Z ⁇ r of the normal actual steering angle and the time of the actual rudder angular velocity ⁇ r are normal.
- a mode in which the actual steering angle estimated value ⁇ r is derived using the integral value S and the torsional relative angle ⁇ of the torsion bar is preferable.
- the steering angle calculation unit when the steering angle abnormality determination signal indicates that the steering angle abnormality determination signal is abnormal, the steering angle calculation unit indicates the past value Z ⁇ r of the normal actual steering angle and the actual steering angular velocity ⁇ r.
- a mode in which the actual steering angle estimated value ⁇ r is derived using the time integral value S is preferable.
- the intervening operation when steering operation (steering) by the driver intervenes during automatic driving of the vehicle, the intervening operation can be sufficiently reflected, and the driver can learn when the operation intervenes. If there is a sense of incongruity or discomfort, or if any abnormality is detected in the angle sensor, instead of using the angle sensor, an estimated value of the rudder angle is obtained and the estimated value of the rudder angle is used. Steering angle control can be performed.
- the electric power steering device 100 is a device that applies a steering assist force to a vehicle steering mechanism by a rotational force of a motor.
- a column shaft (steering shaft) 2 of the steering wheel (steering wheel) 1 passes through a reduction gear 3, universal joints 4a and 4b, a pinion rack mechanism 5, tie rods 6a and 6b, and further steered wheels 8L via hub units 7a and 7b. , 8R.
- a torsion bar and a handle shaft are arranged on the same axis as the column shaft 2.
- the column shaft 2 is provided with a steering angle sensor 14 for detecting the steering angle ⁇ r of the handle 1 and a torque sensor 10 for detecting the steering torque Tt, and the motor 20 for assisting the steering force of the handle 1 is a reduction gear.
- 3 is connected to the column shaft 2 through 3.
- the control unit (ECU) 30 that controls the electric power steering device 100 is supplied with electric power from the battery 13 and also receives an ignition key signal IG via the ignition key 11.
- the control unit 30 calculates a current command value for assist control based on the steering torque Tt detected by the torque sensor 10 and the vehicle speed Vs detected by the vehicle speed sensor 12, and a voltage obtained by compensating the current command value.
- the current supplied to the motor 20 is controlled by the control command value Vref.
- a steering angle ⁇ r is detected from the steering angle sensor 14, while a motor angle ⁇ s is obtained from a rotation sensor connected to the motor 20 (details will be described later).
- the steering angle ⁇ r is detected from the rudder angle sensor 14 but can also be obtained from a rotation sensor connected to the motor 20.
- the control unit 30 is connected to a CAN (Controller Area Network) 40 that transmits and receives various types of vehicle information, and the vehicle speed Vs can also be received from the CAN 40.
- the control unit 30 can be connected to a non-CAN 41 that exchanges communications, analog / digital signals, radio waves, and the like other than the CAN 40.
- the control unit 30 is mainly composed of a CPU (including MPU and MCU), and general functions executed by programs in the CPU are as shown in FIG.
- the function and operation of the control unit 30 will be described with reference to FIG. 2.
- the steering torque Tt detected by the torque sensor 10 and the vehicle speed Vs detected by the vehicle speed sensor 12 (or from the CAN 40) are represented by the current command value Iref 1.
- the current command value calculation unit 31 to be calculated is input.
- the current command value calculation unit 31 calculates a current command value lrefl, which is a control target value of the current supplied to the motor 20, using an assist map or the like based on the input steering torque Tt and the vehicle linkage vs.
- Assist map is information indicating the correspondence between steering torque and steering assist command value (current value).
- the assist map includes, for example, information indicating the correspondence relationship between the steering torque and the steering assist command value in each of the low speed, medium speed, and high speed ranges.
- the information indicating the correspondence relationship may be expressed by a plurality of linear function parameters or may be expressed by a high-order polynomial.
- the current command value Irefl is input to the current limiting unit 33 via the adding unit 32A, and the current command value Iref3 whose maximum current is limited under the overheat protection condition is input to the subtracting unit 32B, and is fed back to the motor current value Im fed back.
- the voltage control command value Vref whose characteristics are improved by the PI control unit 35 is input to the PWM control unit 36, and the motor 20 is PWM driven via an inverter 37 as a drive unit.
- the current value Im of the motor 20 is detected by the motor current detector 38 and fed back to the subtraction unit 32B.
- a rotation sensor 21 such as a resolver is connected to the motor 20, and the motor rotation angle ⁇ s is detected.
- the adder 32A is added with the compensation signal CM from the compensator 34, and the compensation of the system system is performed by adding the compensation signal CM so as to improve the convergence and inertia characteristics.
- the compensator 34 adds the self-aligning torque (SAT) 343 and the inertia 342 by the adder 344, further adds the convergence 341 to the addition result by the adder 345, and the addition result of the adder 345 is the compensation signal CM. It is said.
- automatic driving support for example, when a driver inputs torque with a steering wheel or other device, the electric power steering device detects steering torque with a torque sensor, and the information is controlled in the vehicle or the electric power steering device. For example, the automatic driving support is canceled to return to normal assist control (manual steering control).
- an electric power steering apparatus which is a premise of the present invention, that is, a general electric power steering apparatus 100 having functions of an automatic steering control mode and a manual steering control mode and having a function of switching the steering control mode will be described. To explain.
- a rotation sensor 151 such as a resolver for detecting the motor rotation angle ⁇ s is connected to the motor 150, and the motor 150 is driven and controlled via a vehicle ECU 130 and an EPS (electric power steering device) ECU 140.
- the vehicle-side ECU 130 outputs a switching command unit 131 that outputs a switching command SW for automatic steering control or manual steering control based on buttons, switches, and the like indicating the driver's intention, and signals such as a camera (image) and a laser radar.
- a target steering angle generator 132 for generating a target steering angle ⁇ t based on the target steering angle ⁇ t.
- the actual steering angle ⁇ r detected by the steering angle sensor 14 provided on the column shaft (steering shaft, steering wheel shaft) is input to the steering angle control unit 200 in the EPS side ECU 140 via the vehicle side ECU 130.
- the switching command unit 131 is based on a signal for identifying that the vehicle enters the automatic steering control, for example, a signal indicating a vehicle state by a button or a switch provided on the dashboard or around the steering wheel or a parking mode provided for a shift.
- the switching command SW is output to the switching unit 142 in the EPS side ECU 140.
- the target steering angle generation unit 132 generates a target steering angle ⁇ t by a known method based on data such as a camera (image) and a laser radar, and the generated target steering angle ⁇ t is controlled by the steering angle control in the EPS side ECU 140. Input to the unit 200.
- the EPS-side ECU 140 outputs a motor current command value Itref calculated based on the steering torque Tt and the vehicle speed Vs, and based on the target steering angle ⁇ t, the actual steering angle ⁇ r, the motor angular speed ⁇ , and the steering torque Tt.
- a steering angle control unit 200 that calculates and outputs a motor current command value Imref for steering angle automatic control, a switching unit 142 that switches between motor current command values Itref and Imref by a switching command SW, and a motor from the switching unit 142
- a motor angular speed calculation unit 144 that calculates the motor angular velocity ⁇ based on the motor rotation angle ⁇ s from the rotation sensor 151.
- the current control / driving unit 143 includes a PI current control unit, a PWM control unit, an inverter, and the like.
- step SP1 torque control (manual steering control mode) is first performed by the torque control unit 141 (step SP1), and the motor 150 is driven by the current control / drive unit 143 using the motor current command value Itref. (Step SP2).
- the manual steering operation is repeated until the switching command unit 131 outputs a switching command SW for automatic steering control (step SP3).
- the target steering angle ⁇ t is input from the target steering angle generation unit 132 (step SP4), and the actual steering angle ⁇ r is input from the steering angle sensor 14.
- the steering torque Tt is input from the torque sensor 154 (step SP6)
- the motor angular speed ⁇ is input from the motor angular speed calculation unit 144 (step SP7)
- the motor current command value Imref is calculated by the steering angle control unit 200. It is generated (step SP10). Note that the input order of the target steering angle ⁇ t, the actual steering angle ⁇ r, the steering torque Tt, and the motor angular velocity ⁇ can be changed as appropriate.
- Step SP11 the switching unit 142 is switched by a switching command SW from the switching command unit 131 (step SP11), and the motor 150 is driven by the current control / drive unit 143 using the motor current command value Imref from the steering angle control unit 200.
- Step SP12 the process returns to step SP3.
- the drive control automated steering control
- based on the motor current command value Imref is repeated until the switching command SW is changed from the switching command unit 131.
- FIG. 5 shows a configuration of a vehicle side ECU 130, an EPS side ECU 140, and a plant 160 related to the electric power steering apparatus 100 of the present embodiment (see FIG. 5).
- the double line in FIG. 5 means that a plurality of signals are transmitted or received.
- the vehicle-side ECU 130 includes a vehicle state quantity detector 130a, a switching command unit 131, a target trajectory calculation unit 134, and a vehicle motion control unit 135.
- the vehicle state quantity detector 130a detects a vehicle state quantity based on each data detected by a camera, a distance sensor, an angular velocity sensor, an acceleration sensor, and the like mounted on the vehicle. It transmits to the track
- FIG. 1 The vehicle state quantity detector 130a detects a vehicle state quantity based on each data detected by a camera, a distance sensor, an angular velocity sensor, an acceleration sensor, and the like mounted on the vehicle. It transmits to the track
- the switching command unit 131 outputs a switching command SW to the EPS-side ECU 140 (the switching determination / gradual change gain generating unit 145) based on the above-described vehicle state quantities and signals from buttons, switches, and the like.
- the target trajectory calculation unit 134 operates the target trajectory data based on the vehicle state quantity and outputs it to the vehicle motion control unit 135.
- the vehicle motion control unit 135 generates a steering angle command value ⁇ ref by the steering angle command value generation unit 135a based on the vehicle state quantity, and outputs the steering angle command value ⁇ ref to the steering angle control unit 200 of the EPS side ECU 140.
- the EPS-side ECU 140 includes a switching unit 142, a current control / drive unit 143, a switching determination / gradual change gain generation unit 145, an EPS state quantity detector 146, an assist control unit 147, and a steering angle control unit 200 (see FIG. 5). .
- the EPS state quantity detector 146 outputs the steering wheel steering angle ⁇ h output from the plant 160, and various data detected by an angle sensor (handle side, column side), motor angle sensor, torque sensor, etc. mounted on the vehicle. An EPS state quantity is detected based on this. EPS state quantity detected by the EPS state quantity detector 146 (steering wheel steering angle ⁇ h, column steering angle (steering angle below the torsion bar), steering wheel steering angle (steering angle above the torsion bar), motor angle, steering torque, Other) is output to each of the switching determination / gradual change gain generation unit 145 and the assist control unit 147. In the vehicle system illustrated in FIG. 5, the steering wheel steering angle ⁇ h is detected by the EPS side ECU 140, but may be detected by the vehicle side ECU 130 instead.
- the switching determination / gradual gain generating unit 145 performs switching determination based on the switching command SW (for assist control and steering angle control) from the switching command unit 131 of the vehicle-side ECU 130 and the steering torque Tt, and each gradually varying gain. And output to each function.
- the switching determination / gradual change gain generation unit 145 of the present embodiment outputs a speed control gradual change gain GFA2, a speed command gradual change gain GFA3, and a steering angle command gradual change gain GFA4 to the steering angle control unit 200, and an assist control unit
- the assist map gradual change gain GFT2 is output to 147, and the steering angle control output gradual change gain GFA1 and the assist control output gradual change gain GFT1 are output to the switching unit 142.
- Assist control unit 147 outputs steering angle control current command value IrefP1 to switching unit 142 based on steering torque Tt and assist map gradual gain GFT2.
- the steering angle control unit 200 calculates the steering angle control current command value IrefP1 based on the steering angle command value ⁇ ref, the speed control gradual change gain GFA2, the speed command gradual change gain GFA3, the steering angle command gradual change gain GFA4, and the EPS state quantity. And output to the switching unit 142.
- the switching unit 142 converts the steering angle control current command value IrefP1 from the steering angle control unit 200 and the current command value IrefT1 from the assist control unit 147 into a steering angle control output gradual change gain from the switching determination / gradual change gain generation unit 145. Switching is performed according to GFA1 and the assist control output gradual change gain GFT1.
- the current control / drive unit 143 performs feedback control so that the detected current value follows the motor current command value Iref. Thereby, the driving torque of the motor 150 can be controlled.
- the current control / drive unit 143 may have a configuration related to a generally used motor control system.
- the plant 160 has or exhibits a mechanical transmission characteristic (related to the EPS and the vehicle) according to a motor drive control signal (motor current) from the current control / drive unit 143 and a driver steering transmission characteristic according to a steering hand input by the driver ( (See FIG. 5).
- a mechanical transmission characteristic related to the EPS and the vehicle
- motor drive control signal motor current
- driver steering transmission characteristic according to a steering hand input by the driver (See FIG. 5).
- the “plant” in this specification refers to a general term for objects to be controlled, such as the mechanical characteristics of the vehicle and the electric power steering apparatus 100, the characteristics of the driver, and the like.
- the steering angle calculation unit 201 controls the steering angle ⁇ h output from the steering angle sensor 14, the motor angle ⁇ m output from the rotation sensor 151, the steering torque Tt output from the torque sensor 154, the steering The actual steering angle ⁇ r or the estimated value ⁇ r of the actual steering angle is obtained using the steering angle abnormality determination signal Flg_ ⁇ h output from the angle abnormality determination unit 148.
- the steering angle calculation unit 201 determines that the steering angle ⁇ h Is output as the actual steering angle ⁇ r.
- the steering angle calculation unit 201 calculates the past actual value Z ⁇ r of the normal steering angle and the motor relative angle.
- the estimated value ⁇ r of the actual steering angle is output using ⁇ m and the torsional relative angle ⁇ of the torsion bar.
- the steering angle abnormality determination signal Flg_ ⁇ h is a determination signal output from, for example, a steering angle abnormality determination unit (not shown) of the ESP ECU 140.
- the steering angle abnormality determination unit outputs a steering angle abnormality determination signal Flg_ ⁇ h indicating that it is normal to the steering angle calculation unit 201, while the steering wheel steering angle ⁇ h is within the normal range. If the steering angle is not within the range, a steering angle abnormality determination signal Flg_ ⁇ h indicating an abnormality is output to the steering angle calculation unit 201.
- an upper / lower limit variable limiter (Also referred to as a steering angle command value upper / lower limit variable limiter) 202.
- the upper and lower limiter values are successively changed to appropriate values according to the steering angle command gradual change gain GFA4.
- variable rate limiter 204 performs rate limit processing on the steering angle command value ⁇ ref in order to avoid a sudden change in the steering angle control current command value as the steering angle control output due to a sudden change in the steering angle command value ⁇ ref. Such processing by the variable rate limiter 204 also leads to an improvement in safety to the driver due to a sudden steering behavior.
- the rate limiter value is sequentially changed to an appropriate value according to the steering angle command gradual change gain GFA4 in accordance with the switching operation between the steering angle control and the assist control.
- ⁇ Handle vibration removing means 206 When the steering angle command is changing during automatic steering, a frequency component (about 10 Hz) that excites vibration due to the spring property of the torsion bar and the inertial moment of the steering wheel is generated in the steering angle command value ⁇ ref3.
- a frequency component about 10 Hz
- a low-pass filter, notch filter These filters are used for 206), or vibration frequency components can be reduced by phase delay compensation.
- the position control unit 208 calculates the steering angular velocity command value ⁇ ref by multiplying the deviation between the target steering angle ⁇ t and the actual steering angle ⁇ r or the actual steering angle (estimated value) ⁇ r by a proportional gain. With this function, it is possible to generate a steering angular velocity command value for bringing the actual steering angle ⁇ r or the actual steering angle (estimated value) ⁇ r closer to the target steering angle ⁇ t.
- the position control referred to in this specification is to control the position of the steering angle in the circumferential direction. In other words, it can also be expressed as “angle control of the steering wheel steering angle”.
- the speed command value upper / lower limit variable limiter 210 is processed for the steering angular speed command value ⁇ ref1 after the gradual gain multiplication, and the target steering angular speed ⁇ t is output.
- the speed command value upper / lower limit variable limiter 210 can sequentially change the limit value to an appropriate value by the speed command gradual change gain GFA3, and the upper / lower limit limiter value is made smaller if the gradual change gain GFA3 is less than a certain threshold value, and more than that. By increasing the value, the steering angular speed command value is limited.
- ⁇ Rudder angular velocity control unit 212 In the rudder angle control unit 200 of the present embodiment, the target rudder angular velocity ⁇ t and the actual rudder angular velocity ⁇ r are input to the rudder angular velocity control unit 212, and a current command value is calculated such that the actual rudder angular velocity ⁇ r follows the target rudder angular velocity ⁇ t. .
- the calculation of the actual steering angular velocity ⁇ r is performed by performing a calculation generally used in an actual steering angular velocity calculation unit (not shown).
- the actual steering angular speed may be calculated from the difference calculation of the motor angle sensor and the gear ratio, or the actual steering angular speed may be calculated from the difference calculation of the steering wheel steering angle or the column steering angle.
- an LPF low pass filter
- ⁇ Rudder angle control output upper / lower limiter 214> The steering angle control output upper / lower limiter 214 limits the steering angle control current command value in order to prevent excessive output.
- Steering intervention compensation and steering vibration damping means 220 functions as steering vibration damping means based on the torque signal detected by the torque sensor. According to this, the vibration damping effect of the steering wheel vibration during the automatic steering is further improved as compared with the case where only the steering wheel vibration removing means 206 is used.
- the steering intervention compensation and steering vibration damping means 220 of the present embodiment realizes a steering vibration damping function by gain and phase compensation.
- the phase compensation may be configured with a primary filter.
- a current command value is output in a direction to eliminate torsion of the torsion bar.
- the steering intervention compensation / steering vibration damping means 220 works in a direction to reduce the twist angle, and also has an effect of reducing the uncomfortable feeling of catching at the time of manual input intervention by the driver.
- the FF (feed forward) filter 230 is an optional configuration that can be set in the position control unit 208 (see the embodiment described later shown in FIG. 8 and the like). According to the FF filter 230, the followability to the target steering angle ⁇ t is improved.
- the FF filter 230 has an effect of being, for example, a first-order phase advance filter. However, the FF filter 230 may perform other phase compensation, or may use pseudo-differentiation or HPF (high-pass filter).
- ⁇ Steering angle control output gradual change gain GFA1> The steering angle control output gradual change gain GFA1 is multiplied by the current command value of the output of the steering angle control output upper / lower limiter 214.
- the rudder angle control output gradual change gain GFA1 is used to smoothly switch between assist control and rudder angle control, and to realize a sense of incongruity, safety, and the like for the driver.
- the speed control gradual change gain GFA2 is multiplied by a signal in the rudder angular speed control unit 212 and used to realize smooth switching. It is mainly used to mitigate the effect of accumulation of integral values in the rudder angular velocity control at the time of switching.
- the speed command gradual change gain GFA3 is mainly used to realize smooth switching when switching from assist control to steering angle control.
- a speed command gradual change gain GFA3 is multiplied to the steering angular speed command value ⁇ ref of the position control output.
- ⁇ Steering angle command gradual gain GFA4> The steering angle command gradual gain GFA4 is multiplied by the steering angle command value from the variable rate limiter 204.
- ⁇ Assist control output gradual gain GFT1> The assist control output gradual change gain GFT1 is multiplied by a current command value that is an output from the assist control unit 147.
- the assist control output gradual change gain GFT1 is used for smoothing the switching operation between the steering angle control and the assist control and for realizing the steering intervention by the driver during the automatic driving.
- the assist map gradual change gain GFT2 refers to the assist map output current in the assist control (see the graph of FIG. 2 in which an example of the assist map output current is described (the vertical axis represents the current command value, and the horizontal axis represents the steering torque Tt). ).
- the assist map gradual change gain GFT2 is used for smoothing the switching operation between the steering angle control and the assist control and for realizing the steering intervention by the driver during the automatic driving.
- the steering angle calculation unit 201 controls the steering angle ⁇ h output from the steering angle sensor 14, the motor angle ⁇ m output from the rotation sensor 151, the steering torque Tt output from the torque sensor 154, the steering A steering angle abnormality determination signal Flg_ ⁇ h output from the angle abnormality determination unit 148 is acquired (step S1).
- the steering angle calculation unit 201 determines whether or not the detected steering angle is normal based on the steering angle abnormality determination signal Flg_ ⁇ h (step S2).
- step S2 When the steering angle calculation unit 201 determines that the detected steering angle is normal (step S2; YES), the steering angle calculation unit 201 proceeds to step S3, and outputs the steering wheel steering angle ⁇ h as the actual steering angle ⁇ r. Then, the steering angle calculation unit 201 sets the actual steering angle ⁇ r, the motor angle ⁇ m, and the steering torque Tt obtained this time as the actual steering angle past value Z ⁇ r, the motor angle past value Z ⁇ m, and the steering torque past value ZTt, respectively.
- the data is stored in a memory (not shown) (step S3 ⁇ step S4 ⁇ step S5), and the process ends.
- step S2 determines in step S2 that the detected rudder angle is abnormal (step S2; NO)
- the steering angle calculation unit 201 proceeds to step S6 and calculates for the first time after the rudder angle abnormality is detected (that is, 1). It is determined whether or not the second calculation).
- step S6 determines that the steering angle abnormality is detected and is not the first calculation (step S6; NO)
- step S6 determines that the steering angle abnormality is detected and is not the first calculation
- step S8 determines step S7 and proceeds to step S8.
- step S6 determines that the rudder angle abnormality is detected and is the first calculation
- step S6 detects that the rudder angle abnormality is detected and is the first calculation (step S6; YES)
- the motor angle past value Z ⁇ m and the steering torque past value ZTt are used to determine the motor.
- the rudder angle calculation unit 201 obtains the motor relative angle ⁇ m by subtracting the motor initial angle ⁇ 0 from the current motor angle ⁇ m, and calculates the initial torsion angle of the torsion bar from the current torsion angle Tt / Ktor of the torsion bar. By subtracting ⁇ 0, the torsional bar relative angle ⁇ is obtained (step S8).
- the steering angle calculation unit 201 multiplies the motor relative angle ⁇ m by a predetermined coefficient Cg (reciprocal of the reduction ratio between the column shaft and the motor shaft), and then calculates the torsional bar relative torsion angle ⁇ m and the actual steering angle.
- the past value Z ⁇ r is added to obtain an estimated value ⁇ r of the actual steering angle (step S9), and the process is terminated.
- FIG. 8 is a diagram showing a second configuration of the rudder angle control unit 200 in the EPS-side ECU 140, and corresponds to FIG. Since the other configuration except for the rudder angle calculation unit 201a is the same as that shown in FIG. 6, the corresponding parts are denoted by the same reference numerals, and detailed description thereof is omitted.
- the steering angle calculation unit 201a does not use the steering torque Tt in the steering angle control mode, and determines the steering angle ⁇ h output from the steering angle sensor 14, the motor angle ⁇ m output from the rotation sensor 151, and the steering angle abnormality determination. 6 differs from the steering angle calculation unit 201 shown in FIG. 6 in that the actual steering angle ⁇ r or the estimated value ⁇ r of the actual steering angle is obtained using the steering angle abnormality determination signal Flg_ ⁇ h output from the unit 148.
- the actual steering angle ⁇ r or the estimated value ⁇ r of the actual steering angle can be obtained more easily.
- step Sa2 When the rudder angle calculation unit 201 determines that the detected rudder angle is normal (step Sa2; YES), the steering angle calculation unit 201 proceeds to step Sa3 and outputs the steering wheel rudder angle ⁇ h as the actual steering angle ⁇ r.
- the steering angle calculation unit 201 stores the actual steering angle ⁇ r and the motor angle ⁇ m obtained this time in a memory (not shown) as the past actual value Z ⁇ r and the past motor angle value Z ⁇ m (step Sa3).
- step Sa4 ⁇ Step Sa5
- step Sa2 determines in step Sa2 that the detected rudder angle is abnormal (step Sa2; NO)
- the steering angle calculation unit 201 proceeds to step Sa6 to calculate for the first time when a rudder angle abnormality is detected (ie, 1). It is determined whether or not the second calculation).
- step Sa6 determines that the rudder angle abnormality is detected and is not the first calculation (step Sa6; NO)
- the rudder angle calculation unit 201 determines that the rudder angle abnormality is detected and is the first calculation (step Sa6; YES)
- the rudder angle calculation unit 201 obtains the motor relative angle ⁇ m by subtracting the motor initial angle ⁇ 0 from the current motor angle ⁇ m (step Sa8).
- the steering angle calculation unit 201 adds the past value Z ⁇ r of the actual steering angle after multiplying the motor relative angle ⁇ m by a predetermined coefficient Cg (the reciprocal of the reduction ratio between the column shaft and the motor shaft). Then, an estimated value ⁇ r of the actual steering angle is obtained (step Sa9), and the process is terminated.
- ⁇ Simulation results> 10A and 10B show simulation results of vehicle behavior when an offset value of 1 [sec] +90 [deg] is intentionally added to the actual steering angle or the actual steering angle (estimated value).
- the target value of the vehicle lateral position is set to 0 [m]
- the differential leading type PI-D control is applied to the lateral position.
- the value ⁇ ref is output to the rudder angle control unit 200 (see FIG. 5) of the EPS side ECU 140, it can be seen that the lateral position converges to the target 0 [m] (see FIG. 10B). This is considered that the proportionality and integral compensation of the above-described PI-D control is effective.
- an offset occurs in the lateral position even when there is no integration, but it can be eliminated by setting the proportional gain to a larger value.
- Gradual gains GFA1 to 4 are determined sequentially from 100% after manual input determination. In this embodiment, which decreases and transitions to 0%, it is changed linearly. In order to make the switching operation smoother, transition may be made along an S-shaped curve, or a value obtained by passing an LPF (low-pass filter) for a linearly changing signal may be used as each gradually changing gain. Good (for example, primary LPF, cutoff frequency 2 [Hz]). However, the gradual gains GFA1 to GFA4 do not need to be linked as the same transition, and may be transitions that are independent as adjustment elements.
- Steping angle command gradual gain GFA4 The change rate setting value of the variable rate limiter of the steering angle command value is set to zero. That is, ⁇ ref2 is set to a constant value. Although illustration of a flowchart etc. is omitted in this regard, it can be realized by changing the change rate setting value when the steering angle command gradual change gain GFA4 changes from 100% to 0%. That is, when entering the switching state, ⁇ ref2 is set to a constant value, and by multiplying the constant value by the steering angle command gradual change gain GFA4, ⁇ ref3 and the target steering angle ⁇ t approach zero.
- the target steering angle ⁇ t being switched is brought close to 0 [deg], and the steering angle control is applied to the neutral state.
- the steering vibration frequency component generated by the multiplication of the steering angle command gradual change gain GFA4 is removed by multiplying the steering angle command gradual change gain GFA4 before the steering wheel vibration removal means 206.
- the assist map gradual change gain GFT2 may be set to 100% or more (in the example shown in FIG. 11, it is set to 300%). Thereby, at the time of operation intervention by the driver, it is possible to reduce a feeling of being caught and an uncomfortable feeling due to the interference of the steering angle control.
- the assist control output gradual change gain GFT1 and the assist map gradual change gain GFT2 may be shifted along the S-curve, or in response to a linearly changing signal.
- a value that has passed through an LPF (low-pass filter) may be used as each gradually changing gain.
- the assist control output gradual change gain GFT1 may be always set to 100% or more, but may be as shown in FIG.
- the stability of the system may affect the unstable side, and vibration may occur.
- the assist control output gradual change gain GFT1 as an adjustment factor to 120%, the occurrence of vibration can be suppressed.
- FIG. 12 and the like the target steering angle ⁇ t at the rear stage of the steering wheel vibration removing means 206 (see FIG. 6) and the subsequent configuration are illustrated.
- the rudder angular speed control unit 212 of the rudder angle control unit 200 shown in FIG. 12 performs PI control for the rudder angular speed control, and performs pseudo-integration for the I control. More specifically, the deviation ⁇ e between the target rudder angular velocity ⁇ t and the actual rudder angular velocity ⁇ r is multiplied by Kvi to obtain an operation amount D1 proportional to the magnitude of the deviation, and I control is performed by pseudo-integration (see FIG. 12). .
- symbol Ir1 represents a pseudo-integrated signal
- Ir2 represents a proportional gain Kvp
- Ir3 represents a signal after addition (the same applies to other embodiments).
- the added signal Ir3 is multiplied by the speed control gradual gain GFA2, and is output from the steering angular speed control unit 212 as a signal IrefW.
- the speed control gradual change gain GFA2 is multiplied by a signal in the rudder angular speed control unit 212 and used to realize smooth switching.
- the pseudo-integration in the rudder angular velocity control unit 212 can be configured as [1 / (Ts + 1)] ⁇ T with a first-order lag transfer function and gain, for example.
- the rudder angular speed control unit 212 of the rudder angle control unit 200 shown in FIG. 13 performs PI control for the rudder angular speed control, and performs pseudo-integration for the I control. More specifically, the deviation between the target rudder angular velocity ⁇ t and the actual rudder angular velocity ⁇ r is multiplied by Kvi to obtain an operation amount D1 proportional to the magnitude of the deviation, and I control is performed by pseudo-integration (see FIG. 13).
- the added signal Ir3 is multiplied by the speed control gradual change gain GFA2, and is output from the steering angular speed control unit 212 as the signal IrefW.
- rudder angle speed control unit 212 of the rudder angle control unit 200 shown in FIG. 14 performs PI control for the rudder angular speed control, and performs pseudo-integration for the I control.
- the difference between the target steering angular speed ⁇ t and the actual steering angular speed ⁇ r is multiplied by the speed control gradual change gain GFA2 to generate the signal ⁇ e1, and the signal ⁇ e1 is multiplied by Kvi to obtain the magnitude of the deviation.
- the operation amount D1 is proportional to, and I control is performed by pseudo integration (see FIG. 14).
- the steering angle speed control unit 212 of the steering angle control unit 200 shown in FIG. 15 performs phase delay compensation.
- the signal after the phase delay compensation is performed by multiplying the deviation between the target steering angular speed ⁇ t and the actual steering angular speed ⁇ r by Kvp to obtain an operation amount D1 proportional to the magnitude of the deviation.
- Ir1 is multiplied by a speed control gradual change gain GFA2, and is output from the steering angular speed control unit 212 as a signal IrefW (see FIG. 15).
- ⁇ Fifth form of rudder angle control> The steering angle speed control unit 212 of the steering angle control unit 200 shown in FIG. 16 performs phase delay compensation.
- the operation amount D1 proportional to the magnitude of the deviation is obtained by multiplying the deviation between the target steering angular speed ⁇ t and the actual steering angular speed ⁇ r by Kvp.
- the signal Ir1 after the phase lag compensation is multiplied by the speed control gradual change gain GFA2, and is output from the steering angular speed control unit 212 as a signal IrefW (see FIG. 16).
- the pseudo-integral PI control is equivalently replaced by phase delay compensation and gain.
- rudder angle control The steering angular speed control unit 212 of the steering angle control unit 200 shown in FIGS. 17 and 18 performs proportional control (P control).
- P control proportional control
- the signal Ir1 of the operation amount proportional to the magnitude of the deviation is multiplied by Kvp by the deviation between the target steering angular speed ⁇ t and the actual steering angular speed ⁇ r, and the speed control gradual change gain GFA2 is obtained. It is output from the rudder angular velocity control unit 212 as IrefW (see FIGS. 17 and 18).
- Example 1> (Grounds for solving Problem 1 and Problem 2) Based on a simulation that takes into account the driver's steering model, actual steering is performed for the driver target angle ⁇ arm (see thick line in the figure) during automatic driving (however, the steering angle command value ⁇ ref is fixed to 0 [deg]).
- the time response of the angle hereinafter also referred to as the steering angle of the steering wheel and represented by the symbol ⁇ h; see the thin line
- Tt see the broken line
- FIG. 22 shows a plant model (mechanical model) used for the simulation.
- the vehicle speed V is assumed to be constant.
- Column moment of inertia Jc is the sum of motor moment of inertia, shaft, rack & pinion, and tire moment of inertia converted to column axis.
- the motor angle ⁇ m and the column angle ⁇ c are related to the worm reduction ratio.
- the column angle ⁇ c and the tire turning angle ⁇ are related to the overall ratio Nover.
- the torsion bar torque and the steering torque are the same signal and are Tt. It was modeled as a single column inertia from the column to the tire.
- Jc Column inertia [kgm ⁇ 2]
- Dc Column damping coefficient [Nm / (rad / s)]
- Jh Handle inertia [kgm ⁇ 2]
- Dh Handle damping coefficient [Nm / (rad / s)]
- Ks Torsion bar spring constant [Nm / rad]
- Ds Torsion bar damping constant [Nm / (rad / s)]
- Kt Motor torque constant [Nm / A]
- Tc Motor shaft torque conversion [Nm] However, motor generated torque is converted to column shaft torque (considering the reduction gear).
- Equation 1 The differential equations of the vehicle are as shown in Equations 1 and 2.
- the side slip angle ⁇ and the yaw rate ⁇ after Laplace conversion are shown in Equation 3.
- Equation 4 shows the moment that the tire receives from the road surface around the kingpin.
- Equation 5 shows the lateral acceleration at the center of gravity of the vehicle under the approximate condition.
- Equation 6 shows the lateral movement distance at the center of gravity of the vehicle.
- the vehicle motion model only needs to take into consideration the transmission characteristics from the tire turning angle ⁇ to the moment Tsat ′ acting around the kingpin due to the road surface reaction force.
- the vehicle model and the steering model used for the simulation are not limited to the above, and general literatures and the like may be referred to.
- the relational expressions of the vehicle model, such as Formula 1, Formula 2, Formula 4, and Formula 5 are shown in, for example, Tokyo Denki University Press, “Movement and Control of Automobile” (by Masato Abe).
- Steering models are described in, for example, Mie University Master's Thesis, "Study on Evaluation of Car Steering Feeling Considering Musculoskeletal Characteristics of Arms" (Daisuke Yokoi).
- FIG. 23 shows an example of a driver steering model.
- the steering model shown in FIG. 23 is used, the steering angle ⁇ h output from the mechanical model (see FIG. 22) is input to the steering model, and the manual input torque Th output from the steering model is input to the mechanical model. Output to.
- the target angle (the steering target angle of the driver) is ⁇ arm.
- the speed control PI control is performed by “pseudo-integration” (in the case of FIG. 21, the P control is performed), the steering can be performed.
- the reason can be as follows.
- the broken line indicates that the steering wheel steering angle ⁇ h is cut to 7.5 [deg], but the speed deviation (the deviation between the steering angular speed command value and the actual steering angular speed) is continuously accumulated due to the influence of the pure integration of the speed control PI.
- the assist control command value is 0 [deg], but it is omitted because steering is more difficult than the broken line.
- the vibration of the steering wheel during automatic steering can be suppressed by using the steering wheel vibration removing means 206 and the steering intervention compensation and steering vibration damping means 220. can do.
- the electric power steering apparatus 100 so far performs steering angle control using the angle sensor when no abnormality has occurred in the angle sensor, while some abnormality has been detected in the angle sensor.
- an estimated value of the rudder angle is obtained and the rudder angle control is performed using the obtained estimated value of the rudder angle.
- the electric power steering apparatus 100 realizes a high-performance human-machine interface in automatic driving of a vehicle.
- the LPF is used as the handle vibration removing means 206.
- this is only a preferable example.
- a notch filter matched to the handle vibration frequency (about 10 Hz) reduces the component. May be.
- the primary phase lead compensation is used for the steering intervention compensation and steering vibration damping means 220, but a secondary or higher-order phase compensation filter may be used.
- each gradual gain described above is not limited to the one exemplified in the embodiment, and may be updated according to the situation.
- the assist control output gradual change gain GFT1 and the assist map gradual change gain GFT2 are not limited to 100% or more, and may be set to values of 0% or more and less than 100% depending on the situation.
- the vehicle motion behavior when the steering angle control and the vehicle control in the embodiment described above are combined is only an example.
- the steering angle control is not limited to that shown in each of the above embodiments, and the steering angle sensor 14 can be used as long as the actual steering angle (estimated value) follows the steering angle command value.
- a similar vehicle motion can be realized without using.
- vehicle control for example, when a lateral disturbance (for example, side wind) occurs, the vehicle control may be performed in a manner such as correcting the target value of the lateral position of the vehicle.
- the present invention is suitable for application to electric power steering.
- SAT Self-aligning torque
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
角度センサに何らかの異常が検出された場合には、角度センサを用いる代わりに、舵角の推定値を求め、求めた舵角の推定値を利用して舵角制御を行う電動パワーステアリング装置の制御装置を提供する。舵角演算部201は、舵角異常判定信号Flg_θhに基づいて、検出される舵角が正常であると判断すると、ハンドル舵角θhを実操舵角θrとして出力する。一方、舵角演算部201は、検出される舵角が異常であると判断すると、正常時の実操舵角の過去の値Zθrと、モータ相対角度Δθmと、トーションバーの捩れ相対角Δθを用いて、実操舵角の推定値θrを求め、出力する。
Description
本発明は、電動パワーステアリング装置の制御装置に関する。
従来、自動車用操舵系において、電動式のパワーステアリング装置(EPS:Electric Power Steering)が提案され、実用化されている。現在においては、ステアリングホイールに付加された操舵トルクに応じて、電動モータで補助操舵トルクを発生し、この補助操舵トルクをステアリング軸に伝達する電動パワーステアリング装置の開発が進められている。このような電動パワーステアリング装置では、モータが減速機構を介してステアリング軸に接続され、モータの回転は、減速機構により減速された後、ステアリング軸に伝達される。
また、近年においては、車両を自動操舵する自動運転技術が着目されており、様々な技術が開発されている。電動パワーステアリング装置において自動操舵を実現する場合、舵角制御(ステアリングの舵角を所望の角度に追従させるためのモータ電流指令値を演算・制御すること)とアシスト制御(ステアリング機構にモータの回転力で操舵補助力(アシスト)を付与する際、操舵補助力のトルクを正確に発生させるためのモータ電流のフィードバック制御等)を独立して保有し、これらの出力を切り換える構成などが採用されている(例えば、特許文献1~3参照)。舵角の制御方法について詳述すると、ステアリングの舵角(絶対舵角)を何らかの方法で検出する必要があり、従来は、ハンドル舵角センサ、コラム舵角センサ、車輪舵角センサ等の角度センサを用いて舵角を検出していた(例えば、特許文献4参照)。
しかしながら、自動運転中、ドライバーによるハンドル操作(ステアリング操舵)が介入したとき、介入した操作が十分に反映されない場合がある。また、同操作が介入したとき、ドライバーが違和感、不快感を覚えることがある。さらに、舵角を検出するために用いる角度センサに異常が生じた場合には、実際の舵角と検出される舵角に大きな乖離が生じ、適切な舵角制御が行えないという課題もある。
<課題1(自動運転中のドライバー介入時の違和感、舵角制御とアシスト制御の両立)>
舵角制御には、舵角指令に対する応答性、路面反力などに対する外乱抑圧性で優れた性能を持つ位置速度制御が用いられており、例えば、位置制御部にはP制御(比例制御)、速度制御部にはPI制御(比例積分制御)が用いられている。舵角制御とアシスト制御のそれぞれの出力である指令値を切り換える際、例えばドライバーによるスイッチ入力によって急な切換が生じると、指令値が急変動し、ハンドル挙動が不自然になるため、ドライバーへ違和感を与える。このため、舵角制御指令値とアシスト制御指令値にそれぞれの徐変ゲイン(徐々に変化するゲイン)を乗じ、徐々に出力を切り換えることによって、電流指令値の急変動を抑制する手法が用いられている(特許文献3等参照)。
しかし、この手法では、切換中は舵角制御指令値が徐変ゲインで制限され、電流指令値へ出力されるため、舵角制御指令値に対し、電流指令値の出力が、制限されたぶん小さくなってしまう。この制限により、舵角速度指令値に対し、モータの実速度が遅くなるため、舵角速度指令値と実速度との間に偏差が発生し、速度制御内のI制御(積分制御)の積分値が蓄積してしまうことで、速度制御から更に大きな舵角制御指令値が出力されてしまう。この結果、アシスト制御指令値に対する徐変ゲインが徐々に大きくなっていく状態では、徐変ゲインによる制限が緩和されていくため、徐変ゲインが大きくなるに従って舵角制御指令値が過剰な値となり、ハンドルが舵角速度指令値に対して過剰に応答し、引っ掛かり感といった形でドライバーに違和感と不快感を与える。
舵角制御には、舵角指令に対する応答性、路面反力などに対する外乱抑圧性で優れた性能を持つ位置速度制御が用いられており、例えば、位置制御部にはP制御(比例制御)、速度制御部にはPI制御(比例積分制御)が用いられている。舵角制御とアシスト制御のそれぞれの出力である指令値を切り換える際、例えばドライバーによるスイッチ入力によって急な切換が生じると、指令値が急変動し、ハンドル挙動が不自然になるため、ドライバーへ違和感を与える。このため、舵角制御指令値とアシスト制御指令値にそれぞれの徐変ゲイン(徐々に変化するゲイン)を乗じ、徐々に出力を切り換えることによって、電流指令値の急変動を抑制する手法が用いられている(特許文献3等参照)。
しかし、この手法では、切換中は舵角制御指令値が徐変ゲインで制限され、電流指令値へ出力されるため、舵角制御指令値に対し、電流指令値の出力が、制限されたぶん小さくなってしまう。この制限により、舵角速度指令値に対し、モータの実速度が遅くなるため、舵角速度指令値と実速度との間に偏差が発生し、速度制御内のI制御(積分制御)の積分値が蓄積してしまうことで、速度制御から更に大きな舵角制御指令値が出力されてしまう。この結果、アシスト制御指令値に対する徐変ゲインが徐々に大きくなっていく状態では、徐変ゲインによる制限が緩和されていくため、徐変ゲインが大きくなるに従って舵角制御指令値が過剰な値となり、ハンドルが舵角速度指令値に対して過剰に応答し、引っ掛かり感といった形でドライバーに違和感と不快感を与える。
<課題2>
そもそも、上記課題1を含む先行技術(例えば特許文献3参照)に係る方法では、舵角偏差にP制御、速度制御にPI制御を行っており、舵角制御中にドライバーによる手入力の介入があった場合に、当然、舵角制御が舵角指令値に追従するよう動作し、舵角制御からアシスト制御への「切換動作」が行われるまで、手動による舵を切ることは困難である。また、「手入力検出」「切換動作」により、時間的な遅れが発生し、ドライバーによる操舵介入動作が十分に行えないことがある。
そもそも、上記課題1を含む先行技術(例えば特許文献3参照)に係る方法では、舵角偏差にP制御、速度制御にPI制御を行っており、舵角制御中にドライバーによる手入力の介入があった場合に、当然、舵角制御が舵角指令値に追従するよう動作し、舵角制御からアシスト制御への「切換動作」が行われるまで、手動による舵を切ることは困難である。また、「手入力検出」「切換動作」により、時間的な遅れが発生し、ドライバーによる操舵介入動作が十分に行えないことがある。
<課題3>
角度センサに異常が生じていない場合には、角度センサを利用して舵角制御を行う一方、角度センサに何らかの異常が検出された場合には、角度センサを用いる代わりに、舵角の推定値を求め、求めた舵角の推定値を利用して舵角制御を行うことができれば、角度センサに異常が発生しても、精度の高い舵角制御を実現することが可能となるが、このような機能を実現する装置は未だ提供されていない。
角度センサに異常が生じていない場合には、角度センサを利用して舵角制御を行う一方、角度センサに何らかの異常が検出された場合には、角度センサを用いる代わりに、舵角の推定値を求め、求めた舵角の推定値を利用して舵角制御を行うことができれば、角度センサに異常が発生しても、精度の高い舵角制御を実現することが可能となるが、このような機能を実現する装置は未だ提供されていない。
本発明は、以上説明した事情を鑑みてなされたものであり、少なくとも上述したいずれかの課題を解消すること、すなわち車両の自動運転中、ドライバーによるハンドル操作(操舵)が介入したとき、介入した操作を十分に反映することができ、尚かつ、同操作が介入したときにドライバーが覚えることがある違和感、不快感を低減することができる電動パワーステアリング装置を提供する、または、角度センサに何らかの異常が検出された場合には、角度センサを用いる代わりに、舵角の推定値を求め、求めた舵角の推定値を利用して舵角制御を行う電動パワーステアリング装置の制御装置を提供することを目的とする。
かかる課題を解決するべく、本発明の一実施形態に係る電動パワーステアリング装置の制御装置は、車両のステアリング機構にモータの回転力で操舵補助力を付与する電動パワーステアリング装置の制御装置であって、車両の目標軌道に基づき演算された舵角指令値θrefが入力され、入力された舵角指令値θrefに基づきステアリング機構の舵角を制御する舵角制御部を備え、舵角制御部は、入力される舵角異常判定信号が正常であることを示す場合には、検出されるハンドル舵角θhを実操舵角θrとして出力する一方、舵角異常判定信号が異常であることを示す場合には、入力されるモータ角度θmを用いて、ステアリング機構の実操舵角の推定値θrを求め、実操舵角推定値θrとして出力する舵角演算部と、入力される目標操舵角θtと、実操舵角θrまたは実操舵角推定値θrとに基づき、舵角速度指令値ωrefを導出する位置制御部とを具備する。
ここで、上記構成にあっては、舵角演算部は、舵角異常判定信号が異常であることを示す場合には、モータ角度θmとともに、入力される操舵トルクTtを用いて、実操舵角推定値θrを求める態様が好ましい。
また、上記構成にあっては、舵角演算部は、舵角異常判定信号が異常であることを示す場合には、正常時の実操舵角の過去の値Zθrと、モータの相対角度Δθmと、トーションバーの捩れ相対角Δθを利用して実操舵角推定値θrを導出する態様が好ましい。
さらにまた、上記構成にあっては、舵角演算部は、舵角異常判定信号が異常であることを示す場合には、正常時の実操舵角の過去の値Zθrと、モータの相対角度Δθmを利用して実操舵角推定値θrを導出する態様が好ましい。
また、本発明の他の形態に係る電動パワーステアリング装置の制御装置は、車両のステアリング機構にモータの回転力で操舵補助力を付与する電動パワーステアリング装置の制御装置であって、車両の目標軌道に基づき演算された舵角指令値θrefが入力され、入力された舵角指令値θrefに基づきステアリング機構の舵角を制御する舵角制御部を備え、舵角制御部は、入力される舵角異常判定信号が正常であることを示す場合には、検出されるハンドル舵角θhを実操舵角θrとして出力する一方、舵角異常判定信号が異常であることを示す場合には、入力される実舵角速度ωrを用いて、ステアリング機構の実操舵角の推定値θrを求め、実操舵角推定値θrとして出力する舵角演算部と、入力される目標操舵角θtと、実操舵角θrまたは実操舵角推定値θrとに基づき、舵角速度指令値ωrefを導出する位置制御部とを具備する。
ここで、上記構成にあっては、舵角演算部は、舵角異常判定信号が異常であることを示す場合には、実舵角速度ωrとともに、入力される操舵トルクTtを用いて、実操舵角推定値θrを求める態様が好ましい。
また、上記構成にあっては、舵角演算部は、舵角異常判定信号が異常であることを示す場合には、正常時の実操舵角の過去の値Zθrと、実舵角速度ωrの時間積分値Sと、トーションバーの捩れ相対角Δθを利用して実操舵角推定値θrを導出する態様が好ましい。
さらにまた、上記構成にあっては、舵角演算部は、舵角異常判定信号が異常であることを示す場合には、正常時の実操舵角の過去の値Zθrと、実舵角速度ωrの時間積分値Sを利用して実操舵角推定値θrを導出する態様が好ましい。
本発明によれば、車両の自動運転中、ドライバーによるハンドル操作(操舵)が介入したとき、介入した操作を十分に反映することができ、尚かつ、同操作が介入したときにドライバーが覚えることがある違和感、不快感を低減する、または角度センサに何らかの異常が検出された場合には、角度センサを用いる代わりに、舵角の推定値を求め、求めた舵角の推定値を利用して舵角制御を行うことができる。
以下、図面を参照しつつ本発明に係る電動パワーステアリング装置の好適な実施形態について詳細に説明する(図1等参照)。なお、本明細書および図面において、実質的に同一の機能構成を有する構成要素については、同一の符号を付することにより重複説明を省略する。
電動パワーステアリング装置100の構成を図に示して説明する(図1参照)。電動パワーステアリング装置100は、車両のステアリング機構にモータの回転力で操舵補助力を付与する装置である。ハンドル(ステアリングホイール)1のコラム軸(ステアリングシャフト)2は減速ギア3、ユニバーサルジョイント4a,4b、ピニオンラック機構5、タイロッド6a,6bを経て、さらにハブユニット7a,7bを介して操向車輪8L,8Rに連結されている。コラム軸2と同一軸上に、トーションバーとハンドル軸が配置されている。
また、コラム軸2には、ハンドル1の操舵角θrを検出する舵角センサ14および操舵トルクTtを検出するトルクセンサ10が設けられており、ハンドル1の操舵力を補助するモータ20が減速ギア3を介してコラム軸2に連結されている。
電動パワーステアリング装置100を制御するコントロールユニット(ECU)30には、バッテリー13から電力が供給されるとともに、イグニッションキー11を経てイグニッションキー信号IGが入力される。コントロールユニット30は、トルクセンサ10で検出された操舵トルクTtと車速センサ12で検出された車速Vsとに基づいてアシスト制御の電流指令値の演算を行い、電流指令値に補償等を施した電圧制御指令値Vrefによってモータ20に供給する電流を制御する。なお、舵角センサ14からハンドル舵角θrが検出される一方、モータ20に連結された回転センサからモータ角度θsを得る(詳細は後述)。なお、舵角センサ14からは操舵角θrが検出されるが、モータ20に連結された回転センサから得ることもできる。
コントロールユニット30には、車両の各種情報を授受するCAN(Controller Area Network)40が接続されており、車速VsはCAN40から受信することも可能である。また、コントロールユニット30には、CAN40以外の通信、アナログ/デジタル信号、電波等を授受する非CAN41も接続可能である。
コントロールユニット30は主としてCPU(MPUやMCUも含む)で構成されるが、そのCPU内部においてプログラムで実行される一般的な機能を示すと図2のようになる。
図2を参照してコントロールユニット30の機能及び動作を説明すると、トルクセンサ10で検出された操舵トルクTt及び車速センサ12で検出された(若しくはCAN40からの)車速Vsは、電流指令値Iref1を演算する電流指令値演算部31に入力される。電流指令値演算部31は、入力された操舵トルクTt及び車連vsに基づいてアシストマップ等を用いて、モータ20に供給する電流の制御目標値である電流指令値lreflを演算する。
アシストマップとは、操舵トルクと操舵補助指令値(電流値)との対応関係を示す情報である。アシストマップは、例えば、低速、中速、及び高速の各速度域における、操舵トルク及び操舵補助指令値の対応関係を示す情報を含む。対応関係を示す情報は、複数の一次関数のパラメータにより表される場合もあれば、高次多項式で表される場合もある。
電流指令値Ireflは加算部32Aを経て電流制限部33に入力され、過熱保護条件で最大電流を制限された電流指令値Iref3が減算部32Bに入力され、フィードバックされているモータ電流値Imとの偏差Iref4(=Iref3-Im)が演算され、その偏差Iref4が操舵動作の特性改善のためのPI制御部35に入力される。PI制御部35で特性改善された電圧制御指令値VrefがPWM制御部36に入力され、更に駆動部としてのインバータ37を介してモータ20がPWM駆動される。モータ20の電流値Imはモータ電流検出器38で検出され、減算部32Bにフィードバックされる。
また、モータ20にはレゾルバ等の回転センサ21が接続されており、モータ回転角θsが検出される。加算部32Aには補償部34からの補償信号CMが加算されており、補償信号CMの加算によってシステム系の補償を行い、収れん性や慣性特性等を改善するようになっている。補償部34は、セルフアライニングトルク(SAT)343と慣性342を加算部344で加算し、その加算結果に更に収れん性341を加算部345で加算し、加算部345の加算結果を補償信号CMとしている。
近年、車両に搭載されているカメラ、レーザレーダ等を利用して、自動的にブレーキをかけて安全に止まることとか、自動運転支援をさせることなどの取り組みが行われている。自動運転支援としては、例えば、運転者がハンドル又はその他の装置でトルクを入力することで、電動パワーステアリング装置はトルクセンサで操舵トルクを検出し、その情報を車両や電動パワーステアリング装置内の制御の切換に利用し、自動運転支援を解除して通常のアシスト制御(手動操舵制御)に戻ることなどが行われている。
まず本発明の前提となる電動パワーステアリング装置、つまり自動操舵制御モード及び手動操舵制御モードの機能を具備し、操舵制御モードを切り換える機能を有する一般的な電動パワーステアリング装置100について、図3を参照して説明する。
モータ150にはモータ回転角θsを検出するためのレゾルバ等の回転センサ151が接続されており、モータ150は車両側ECU130及びEPS(電動パワーステアリング装置)側ECU140を介して駆動制御される。車両側ECU130は、運転者の意思を示すボタン、スイッチ等に基づいて、自動操舵制御又は手動操舵制御の切換指令SWを出力する切換指令部131と、カメラ(画像)やレーザレーダなどの信号に基づいて目標操舵角θtを生成する目標操舵角生成部132とを具備している。また、コラム軸(ステアリングシャフト、ハンドル軸)に設けられた舵角センサ14で検出された実操舵角θrは、車両側ECU130を経てEPS側ECU140内の舵角制御部200に入力される。
切換指令部131は、自動操舵制御に入ることを識別する信号、例えば運転者の意思をダッシュボードやハンドル周辺に設けたボタンやスイッチ、或いはシフトに設けた駐車モードなどによる車両状態の信号を基に切換指令SWを出力し、切換指令SWをEPS側ECU140内の切換部142に入力する。また、目標操舵角生成部132は、カメラ(画像)、レーザレーダなどのデータを基に公知の手法で目標操舵角θtを生成し、生成した目標操舵角θtをEPS側ECU140内の舵角制御部200に入力する。
EPS側ECU140は、操舵トルクTt及び車速Vsに基づいて演算されたモータ電流指令値Itrefを出力するトルク制御部141と、目標操舵角θt、実操舵角θr、モータ角速度ω及び操舵トルクTtに基づいて舵角自動制御のためのモータ電流指令値Imrefを演算して出力する舵角制御部200と、切換指令SWによってモータ電流指令値Itref及びImrefを切り換える切換部142と、切換部142からのモータ電流指令値Iref(=Itref又はImref)に基づいてモータ150を駆動制御する電流制御/駆動部143と、回転センサ151からのモータ回転角θsに基づいてモータ角速度ωを演算するモータ角速度演算部144と、を具備している。切換部142は、車両側ECU130の切換指令部131からの切換指令SWに基づいて、トルク制御部141によるトルク制御モード(手動操舵制御)と、舵角制御部200による位置/速度制御モード(自動操舵制御)とを切り換え、手動操舵制御ではモータ電流指令値Itrefを出力し、自動操舵制御ではモータ電流指令値Imrefを出力する。また、電流制御/駆動部143は、PI電流制御部、PWM制御部、インバータ等で構成されている。
このような構成における概略動作例を、フローチャートを参照しながら以下に説明する(図4参照)。
操舵系の動作がスタートすると、先ずトルク制御部141によるトルク制御(手動操舵制御モード)が実施され(ステップSP1)、モータ電流指令値Itrefを用いて電流制御/駆動部143によりモータ150が駆動される(ステップSP2)。上記手動操舵の動作は切換指令部131より、自動操舵制御への切換指令SWが出力されるまで繰り返される(ステップSP3)。
自動操舵制御モードとなり、切換指令部131より切換指令SWが出力されると、目標操舵角生成部132から目標操舵角θtが入力され(ステップSP4)、舵角センサ14から実操舵角θrが入力され(ステップSP5)、トルクセンサ154から操舵トルクTtが入力され(ステップSP6)、モータ角速度演算部144からモータ角速度ωが入力され(ステップSP7)、舵角制御部200でモータ電流指令値Imrefが生成される(ステップSP10)。なお、目標操舵角θt、実操舵角θr、操舵トルクTt、モータ角速度ωの入力順番は適宜変更可能である。
その後、切換部142が切換指令部131からの切換指令SWにより切り換えられ(ステップSP11)、舵角制御部200からのモータ電流指令値Imrefを用いて電流制御/駆動部143によりモータ150を駆動し(ステップSP12)、上記ステップSP3にリターンする。モータ電流指令値Imrefによる駆動制御(自動操舵制御)は、切換指令部131から切換指令SWが変更されるまで繰り返される。
本実施形態では、上述したごとき一般的な構成の電動パワーステアリング装置100を備えた車両において、自動運転中、ドライバーによるハンドル操作(操舵)が介入したとき、介入した操作を十分に反映させ、尚かつ、同操作が介入したときのドライバーへの違和感や不快感を低減させるとともに、舵角センサ14に異常が生じていない場合には、舵角センサ14を利用して舵角制御を行う一方、舵角センサ14に何らかの異常が検出された場合には、舵角センサ14を用いる代わりに、舵角の推定値を求め、求めた舵角の推定値を利用して舵角制御を行う。以下、本実施形態の電動パワーステアリング装置100における各構成について説明する(図5等参照)。
本実施形態の電動パワーステアリング装置100に関する車両側ECU130、EPS側ECU140、プラント160の構成を示す(図5参照)。なお、図5中における二重線は複数の信号が送信ないし受信されることを意味する。
車両側ECU130は、車両状態量検出器130a、切換指令部131、目標軌道演算部134、車両運動制御部135を備える。
車両状態量検出器130aは、車両に搭載されたカメラ、距離センサ、角速度センサ、加速度センサなどで検出される各データに基づき車両状態量を検出し、該車両状態量を切換指令部131、目標軌道演算部134、車両運動制御部135に送信する。
切換指令部131は、上記の車両状態量、およびボタンやスイッチ等からの信号に基づき、EPS側ECU140(の切換判定/徐変ゲイン生成部145)に切換指令SWを出力する。
目標軌道演算部134は、車両状態量に基づいて目標軌道データを演算子し、車両運動制御部135に出力する。
車両運動制御部135は、車両状態量に基づき、舵角指令値生成部135aによって舵角指令値θrefを生成し、EPS側ECU140の舵角制御部200に該舵角指令値θrefを出力する。
EPS側ECU140は、切換部142、電流制御/駆動部143、切換判定/徐変ゲイン生成部145、EPS状態量検出器146、アシスト制御部147、舵角制御部200を備える(図5参照)。
EPS状態量検出器146は、プラント160から出力されるハンドル舵角θh、さらに、車両に搭載された角度センサ(ハンドル側、コラム側)、モータ角度センサ、トルクセンサなどで検出された各種データに基づいてEPS状態量を検出する。EPS状態量検出器146によって検出されたEPS状態量(ハンドル舵角θh、コラム舵角(トーションバー下側の舵角)、ハンドル舵角(トーションバー上側の舵角)、モータ角度、操舵トルク、その他)は、切換判定/徐変ゲイン生成部145、アシスト制御部147のそれぞれへと出力される。なお、図5に例示する車両システムにおいてはハンドル舵角θhをEPS側ECU140で検出するが、代わりに車両側ECU130側で検出してもよい。
切換判定/徐変ゲイン生成部145は、車両側ECU130の切換指令部131からの(アシスト制御と舵角制御との)切換指令SWと、操舵トルクTtに基づき切換判定を行い、各徐変ゲインを管理し、各機能へ出力する。本実施形態の切換判定/徐変ゲイン生成部145は、舵角制御部200へ、速度制御徐変ゲインGFA2、速度指令徐変ゲインGFA3および舵角指令徐変ゲインGFA4を出力し、アシスト制御部147へアシストマップ徐変ゲインGFT2を出力し、切換部142へ舵角制御出力徐変ゲインGFA1およびアシスト制御出力徐変ゲインGFT1を出力する。
アシスト制御部147は、操舵トルクTtおよびアシストマップ徐変ゲインGFT2に基づいて、舵角制御電流指令値IrefP1を切換部142に出力する。
舵角制御部200は、舵角指令値θref、速度制御徐変ゲインGFA2、速度指令徐変ゲインGFA3、舵角指令徐変ゲインGFA4、EPS状態量に基づいて舵角制御電流指令値IrefP1を算出し、切換部142に出力する。切換部142は、舵角制御部200からの舵角制御電流指令値IrefP1とアシスト制御部147からの電流指令値IrefT1を、切換判定/徐変ゲイン生成部145からの舵角制御出力徐変ゲインGFA1およびアシスト制御出力徐変ゲインGFT1に応じて切り換える。電流制御/駆動部143は、電流検出値がモータ電流指令値Irefに追従するようにフィードバック制御する。これにより、モータ150の駆動トルクを制御できる。電流制御/駆動部143は、一般に用いられるモータ制御のシステムに係る構成でよい。
プラント160は、電流制御/駆動部143からのモータ駆動制御信号(モータ電流)に従うメカ伝達特性(EPSおよび車両に関する)と、ドライバーによる操舵手入力に従うドライバー操舵伝達特性とを備え、あるいは発揮する(図5参照)。なお、本明細書でいう「プラント」とは、車両と電動パワーステアリング装置100のメカ特性、ドライバーの特性など、要は制御対象を総称したものを指している。
続いて、本実施形態において特徴的なEPS側ECU140における舵角制御部200の概略と各構成について説明する(図6参照)。
A.舵角制御部200の第1の構成
<舵角演算部201>
舵角演算部201は、舵角制御モード時において、舵角センサ14から出力されるハンドル舵角θh、回転センサ151から出力されるモータ角度θm、トルクセンサ154から出力される操舵トルクTt、舵角異常判定部148から出力される舵角異常判定信号Flg_θhを利用して実操舵角θrまたは実操舵角の推定値θrを求める。詳述すると、舵角異常判定信号Flg_θhに基づいて、検出される舵角(本実施形態では、ハンドル舵角)が正常であると判断される場合、舵角演算部201は、ハンドル舵角θhを実操舵角θrとして出力する。一方、舵角異常判定信号Flg_θhに基づいて、検出される舵角が異常であると判断される場合、舵角演算部201は、正常時の実操舵角の過去の値Zθrと、モータ相対角度Δθmと、トーションバーの捩れ相対角Δθを用いて、実操舵角の推定値θrを出力する。これにより、舵角制御モード時にハンドル舵角の舵角異常が発生したとしても、実際の操舵角を精度よく推定することができるため、自動運転中の車両・EPSの挙動に支障はなく、事故の発生等を防止することができる。また、舵角異常の発生により、ドライバーが違和感を覚えることもない。なお、舵角異常判定信号Flg_θhは、例えばESP側ECU140の舵角異常判定部(図示略)から出力される判定信号である。舵角異常判定部は、ハンドル舵角θhが正常範囲内にある場合には、正常である旨の舵角異常判定信号Flg_θhを舵角演算部201に出力する一方、ハンドル舵角θhが正常範囲から外れている場合には、異常である旨の舵角異常判定信号Flg_θhを舵角演算部201に出力する。
<舵角演算部201>
舵角演算部201は、舵角制御モード時において、舵角センサ14から出力されるハンドル舵角θh、回転センサ151から出力されるモータ角度θm、トルクセンサ154から出力される操舵トルクTt、舵角異常判定部148から出力される舵角異常判定信号Flg_θhを利用して実操舵角θrまたは実操舵角の推定値θrを求める。詳述すると、舵角異常判定信号Flg_θhに基づいて、検出される舵角(本実施形態では、ハンドル舵角)が正常であると判断される場合、舵角演算部201は、ハンドル舵角θhを実操舵角θrとして出力する。一方、舵角異常判定信号Flg_θhに基づいて、検出される舵角が異常であると判断される場合、舵角演算部201は、正常時の実操舵角の過去の値Zθrと、モータ相対角度Δθmと、トーションバーの捩れ相対角Δθを用いて、実操舵角の推定値θrを出力する。これにより、舵角制御モード時にハンドル舵角の舵角異常が発生したとしても、実際の操舵角を精度よく推定することができるため、自動運転中の車両・EPSの挙動に支障はなく、事故の発生等を防止することができる。また、舵角異常の発生により、ドライバーが違和感を覚えることもない。なお、舵角異常判定信号Flg_θhは、例えばESP側ECU140の舵角異常判定部(図示略)から出力される判定信号である。舵角異常判定部は、ハンドル舵角θhが正常範囲内にある場合には、正常である旨の舵角異常判定信号Flg_θhを舵角演算部201に出力する一方、ハンドル舵角θhが正常範囲から外れている場合には、異常である旨の舵角異常判定信号Flg_θhを舵角演算部201に出力する。
<上下限可変リミッタ202>
車両側ECU130から受信した自動運転などのための舵角指令値θrefに対して、通信エラー等による異常な値、過剰な値が舵角制御に入力されるのを防止するため上下限可変リミッタ(舵角指令値上下限可変リミッタとも呼ぶ)202で制限する。舵角制御とアシスト制御の切換動作に伴い、舵角指令徐変ゲインGFA4に応じて、上下限リミッタ値が逐次適切な値に可変となっている。
車両側ECU130から受信した自動運転などのための舵角指令値θrefに対して、通信エラー等による異常な値、過剰な値が舵角制御に入力されるのを防止するため上下限可変リミッタ(舵角指令値上下限可変リミッタとも呼ぶ)202で制限する。舵角制御とアシスト制御の切換動作に伴い、舵角指令徐変ゲインGFA4に応じて、上下限リミッタ値が逐次適切な値に可変となっている。
<可変レートリミッタ204>
可変レートリミッタ204は、舵角指令値θrefの急変によって舵角制御出力としての舵角制御電流指令値が急激に変動することを避けるため、舵角指令値θrefをレートリミット処理する。可変レートリミッタ204によるこのような処理は、急なハンドル挙動によるドライバーへの安全性向上にもつながる。本実施形態の可変レートリミッタ204においては、舵角制御とアシスト制御の切換動作に伴い、舵角指令徐変ゲインGFA4に応じて、レートリミッタ値が逐次適切な値に可変となっている。
可変レートリミッタ204は、舵角指令値θrefの急変によって舵角制御出力としての舵角制御電流指令値が急激に変動することを避けるため、舵角指令値θrefをレートリミット処理する。可変レートリミッタ204によるこのような処理は、急なハンドル挙動によるドライバーへの安全性向上にもつながる。本実施形態の可変レートリミッタ204においては、舵角制御とアシスト制御の切換動作に伴い、舵角指令徐変ゲインGFA4に応じて、レートリミッタ値が逐次適切な値に可変となっている。
<ハンドル振動除去手段206>
自動操舵中、舵角指令が変化しているときに、舵角指令値θref3に、トーションバーのバネ性とステアリングホイールの慣性モーメントによる振動を励起する周波数(約10Hz前後)成分が発生する。舵角指令値上下限可変リミッタ202、可変レートリミッタ204、舵角指令徐変の後の舵角指令値θref3に含まれるハンドル振動周波数成分を低減するためにローパスフィルタ、ノッチフィルタ(ハンドル振動除去手段206にはこれらのフィルタが用いられる)、または、位相遅れ補償により、振動周波数成分を低減させることができる。
自動操舵中、舵角指令が変化しているときに、舵角指令値θref3に、トーションバーのバネ性とステアリングホイールの慣性モーメントによる振動を励起する周波数(約10Hz前後)成分が発生する。舵角指令値上下限可変リミッタ202、可変レートリミッタ204、舵角指令徐変の後の舵角指令値θref3に含まれるハンドル振動周波数成分を低減するためにローパスフィルタ、ノッチフィルタ(ハンドル振動除去手段206にはこれらのフィルタが用いられる)、または、位相遅れ補償により、振動周波数成分を低減させることができる。
<位置制御部208>
位置制御部208は、目標操舵角θtと実操舵角θrまたは実操舵角(推定値)θrの偏差に比例ゲインを乗じて舵角速度指令値ωrefを算出する。この機能により、目標操舵角θtに対し実操舵角θrまたは実操舵角(推定値)θrを近づけるための舵角速度指令値を生成することができる。なお、本明細書でいう位置制御とは、周方向における舵角の位置を制御することであり、別言すれば、「ハンドル舵角の角度制御」と表現することもできる。
位置制御部208は、目標操舵角θtと実操舵角θrまたは実操舵角(推定値)θrの偏差に比例ゲインを乗じて舵角速度指令値ωrefを算出する。この機能により、目標操舵角θtに対し実操舵角θrまたは実操舵角(推定値)θrを近づけるための舵角速度指令値を生成することができる。なお、本明細書でいう位置制御とは、周方向における舵角の位置を制御することであり、別言すれば、「ハンドル舵角の角度制御」と表現することもできる。
<速度指令値上下限可変リミッタ210>
徐変ゲイン乗算後の舵角速度指令値ωref1に対し、速度指令値上下限可変リミッタ210による処理を行い、目標舵角速度ωtを出力する。この速度指令値上下限可変リミッタ210は制限値を、速度指令徐変ゲインGFA3により、逐次適値に変更可能で、上下限リミッタ値を徐変ゲインGFA3がある閾値未満では小さくし、それ以上で大きくすることにより、舵角速度指令値が制限される。
徐変ゲイン乗算後の舵角速度指令値ωref1に対し、速度指令値上下限可変リミッタ210による処理を行い、目標舵角速度ωtを出力する。この速度指令値上下限可変リミッタ210は制限値を、速度指令徐変ゲインGFA3により、逐次適値に変更可能で、上下限リミッタ値を徐変ゲインGFA3がある閾値未満では小さくし、それ以上で大きくすることにより、舵角速度指令値が制限される。
<舵角速度制御部212>
本実施形態の舵角制御部200では、目標舵角速度ωtと実舵角速度ωrを舵角速度制御部212に入力し、実舵角速度ωrが目標舵角速度ωtに追従するような電流指令値を算出する。ここで、実舵角速度ωrの算出は、図示しない実舵角速度演算部で一般的に用いられている演算をすることによって行っている。具体的には、例えばモータ角度センサの差分演算とギア比から実舵角速度を算出してもよいし、ハンドル舵角もしくはコラム舵角の差分演算から実舵角速度を算出してもよい。高周波のノイズを低減するために、演算システムの最終段に図示しないLPF(ローパスフィルタ)が挿入されている。
本実施形態の舵角制御部200では、目標舵角速度ωtと実舵角速度ωrを舵角速度制御部212に入力し、実舵角速度ωrが目標舵角速度ωtに追従するような電流指令値を算出する。ここで、実舵角速度ωrの算出は、図示しない実舵角速度演算部で一般的に用いられている演算をすることによって行っている。具体的には、例えばモータ角度センサの差分演算とギア比から実舵角速度を算出してもよいし、ハンドル舵角もしくはコラム舵角の差分演算から実舵角速度を算出してもよい。高周波のノイズを低減するために、演算システムの最終段に図示しないLPF(ローパスフィルタ)が挿入されている。
<舵角制御出力上下限リミッタ214>
舵角制御の電流指令値に対して過出力防止のため、舵角制御出力上下限リミッタ214で制限する。
舵角制御の電流指令値に対して過出力防止のため、舵角制御出力上下限リミッタ214で制限する。
<操舵介入補償兼ハンドル制振手段220>
操舵介入補償兼ハンドル制振手段220は、トルクセンサが検出したトルク信号に基づくハンドル制振手段として機能する。これによれば、自動操舵中のハンドル振動の制振効果がハンドル振動除去手段206のみを用いた場合と比べてさらに向上する。本実施形態の操舵介入補償兼ハンドル制振手段220は、ゲインと位相補償によりハンドル制振機能を実現する。例えば、位相補償は1次フィルタで構成してもよい。これによりトーションバーの捩れを解消する方向に電流指令値が出力される。また、操舵介入補償兼ハンドル制振手段220は、捩れ角を低減する方向に働き、ドライバーによる手入力の介入時の引っ掛かりの違和感を低減する効果も兼ねている。
操舵介入補償兼ハンドル制振手段220は、トルクセンサが検出したトルク信号に基づくハンドル制振手段として機能する。これによれば、自動操舵中のハンドル振動の制振効果がハンドル振動除去手段206のみを用いた場合と比べてさらに向上する。本実施形態の操舵介入補償兼ハンドル制振手段220は、ゲインと位相補償によりハンドル制振機能を実現する。例えば、位相補償は1次フィルタで構成してもよい。これによりトーションバーの捩れを解消する方向に電流指令値が出力される。また、操舵介入補償兼ハンドル制振手段220は、捩れ角を低減する方向に働き、ドライバーによる手入力の介入時の引っ掛かりの違和感を低減する効果も兼ねている。
<FFフィルタ230>
FF(フィードフォワード)フィルタ230は、位置制御部208内に設定可能なオプションの構成である(図8等に示す後述の実施形態等参照)。FFフィルタ230によれば、目標操舵角θtへの追従性が向上する。FFフィルタ230は例えば1次の位相進みフィルタであるという効果を奏するものであるが、それ以外の位相補償をするものでもよいし、擬似微分、HPF(ハイパスフィルタ)を利用したものでもよい。
FF(フィードフォワード)フィルタ230は、位置制御部208内に設定可能なオプションの構成である(図8等に示す後述の実施形態等参照)。FFフィルタ230によれば、目標操舵角θtへの追従性が向上する。FFフィルタ230は例えば1次の位相進みフィルタであるという効果を奏するものであるが、それ以外の位相補償をするものでもよいし、擬似微分、HPF(ハイパスフィルタ)を利用したものでもよい。
なお、ここで、本実施形態における各種徐変ゲインについて説明しておくと以下のとおりである(図5及び図6参照)。
<舵角制御出力徐変ゲインGFA1>
舵角制御出力徐変ゲインGFA1は、舵角制御出力上下限リミッタ214の出力の電流指令値に対して乗じられる。舵角制御出力徐変ゲインGFA1は、アシスト制御と舵角制御の切換動作を円滑に行い、ドライバーへの違和感、安全性、等を実現するために用いられる。
舵角制御出力徐変ゲインGFA1は、舵角制御出力上下限リミッタ214の出力の電流指令値に対して乗じられる。舵角制御出力徐変ゲインGFA1は、アシスト制御と舵角制御の切換動作を円滑に行い、ドライバーへの違和感、安全性、等を実現するために用いられる。
<速度制御徐変ゲインGFA2>
速度制御徐変ゲインGFA2は、舵角速度制御部212の中の信号に乗じられ、円滑な切換を実現するために用いられる。主に切換時の舵角速度制御内の積分値の蓄積の影響を緩和するために用いられる。
速度制御徐変ゲインGFA2は、舵角速度制御部212の中の信号に乗じられ、円滑な切換を実現するために用いられる。主に切換時の舵角速度制御内の積分値の蓄積の影響を緩和するために用いられる。
<速度指令徐変ゲインGFA3>
速度指令徐変ゲインGFA3は、主にアシスト制御から舵角制御への切換時に円滑な切換を実現するために用いられる。位置制御出力の舵角速度指令値ωrefに対し、速度指令徐変ゲインGFA3が乗じられる。
速度指令徐変ゲインGFA3は、主にアシスト制御から舵角制御への切換時に円滑な切換を実現するために用いられる。位置制御出力の舵角速度指令値ωrefに対し、速度指令徐変ゲインGFA3が乗じられる。
<舵角指令徐変ゲインGFA4>
舵角指令徐変ゲインGFA4は、可変レートリミッタ204からの舵角指令値に対して乗じられる。
舵角指令徐変ゲインGFA4は、可変レートリミッタ204からの舵角指令値に対して乗じられる。
<アシスト制御出力徐変ゲインGFT1>
アシスト制御出力徐変ゲインGFT1は、アシスト制御部147からの出力である電流指令値に対して乗じられる。アシスト制御出力徐変ゲインGFT1は、舵角制御とアシスト制御の切換動作を円滑にするのと、自動運転中のドライバーによる操舵介入を実現するために用いられる。
アシスト制御出力徐変ゲインGFT1は、アシスト制御部147からの出力である電流指令値に対して乗じられる。アシスト制御出力徐変ゲインGFT1は、舵角制御とアシスト制御の切換動作を円滑にするのと、自動運転中のドライバーによる操舵介入を実現するために用いられる。
<アシストマップ徐変ゲインGFT2>
アシストマップ徐変ゲインGFT2は、アシスト制御内のアシストマップ出力電流(アシストマップ出力電流の一例が記載されている図2のグラフ(縦軸は電流指令値、横軸は操舵トルクTtを表す)参照)に対して乗じられる。アシストマップ徐変ゲインGFT2は、舵角制御とアシスト制御の切換動作を円滑にするのと、自動運転中のドライバーによる操舵介入を実現するために用いられる。
アシストマップ徐変ゲインGFT2は、アシスト制御内のアシストマップ出力電流(アシストマップ出力電流の一例が記載されている図2のグラフ(縦軸は電流指令値、横軸は操舵トルクTtを表す)参照)に対して乗じられる。アシストマップ徐変ゲインGFT2は、舵角制御とアシスト制御の切換動作を円滑にするのと、自動運転中のドライバーによる操舵介入を実現するために用いられる。
A-1.舵角演算部201による演算処理
次に、舵角演算部201によって実行される演算処理(第1演算処理)について、図7に示すフローチャートを参照しながら説明する。
舵角演算部201は、舵角制御モード時において、舵角センサ14から出力されるハンドル舵角θh、回転センサ151から出力されるモータ角度θm、トルクセンサ154から出力される操舵トルクTt、舵角異常判定部148から出力される舵角異常判定信号Flg_θhを取得する(ステップS1)。舵角演算部201は、舵角異常判定信号Flg_θhに基づき、検出される舵角が正常であるか否かを判断する(ステップS2)。舵角演算部201は、検出される舵角が正常であると判断すると(ステップS2;YES)、ステップS3に進み、ハンドル舵角θhを実操舵角θrとして出力する。そして、舵角演算部201は、今回求めた実操舵角θr、モータ角度θm、操舵トルクTtのそれぞれを、実操舵角の過去値Zθr、モータ角度の過去値Zθm、操舵トルクの過去値ZTtとしてメモリ(図示略)に格納し(ステップS3→ステップS4→ステップS5)、処理を終了する。
次に、舵角演算部201によって実行される演算処理(第1演算処理)について、図7に示すフローチャートを参照しながら説明する。
舵角演算部201は、舵角制御モード時において、舵角センサ14から出力されるハンドル舵角θh、回転センサ151から出力されるモータ角度θm、トルクセンサ154から出力される操舵トルクTt、舵角異常判定部148から出力される舵角異常判定信号Flg_θhを取得する(ステップS1)。舵角演算部201は、舵角異常判定信号Flg_θhに基づき、検出される舵角が正常であるか否かを判断する(ステップS2)。舵角演算部201は、検出される舵角が正常であると判断すると(ステップS2;YES)、ステップS3に進み、ハンドル舵角θhを実操舵角θrとして出力する。そして、舵角演算部201は、今回求めた実操舵角θr、モータ角度θm、操舵トルクTtのそれぞれを、実操舵角の過去値Zθr、モータ角度の過去値Zθm、操舵トルクの過去値ZTtとしてメモリ(図示略)に格納し(ステップS3→ステップS4→ステップS5)、処理を終了する。
一方、舵角演算部201は、ステップS2において、検出される舵角が異常であると判断すると(ステップS2;NO)、ステップS6に進み、舵角異常が検出されて初めての演算(すなわち1回目の演算)であるであるか否かを判断する。舵角演算部201は、舵角異常が検出されて1回目の演算でないと判断すると(ステップS6;NO)、ステップS7をスキップし、ステップS8に進む。一方、舵角演算部201は、舵角異常が検出されて1回目の演算であると判断すると(ステップS6;YES)、モータ角度の過去値Zθm、操舵トルクの過去値ZTtを用いて、モータ初期角度θ0(=Zθm)、トーションバーの初期捩れ角Δθ0(=ZTt/Ktor;Ktorはトーションバーバネ定数)を求める(ステップS7)。そして、舵角演算部201は、現時点でのモータ角度θmからモータ初期角度θ0を減じることでモータ相対角度Δθmを求めるとともに、現時点でのトーションバーの捩れ角Tt/Ktorからトーションバーの初期捩れ角Δθ0を減じることでトーションバーの捩れ相対角Δθを求める(ステップS8)。さらに、舵角演算部201は、モータ相対角度Δθmに所定の係数Cg(コラム軸とモータ軸の間の減速比の逆数)を乗じたうえで、トーションバーの捩れ相対角度Δθmと、実操舵角の過去値Zθrを加算することで、実操舵角の推定値θrを求め(ステップS9)、処理を終了する。
B.舵角制御部200の第2の構成
図8は、EPS側ECU140における舵角制御部200の第2の構成を示す図であり、前掲図6に対応している。なお、舵角演算部201aを除く他の構成は、前掲図6と同様であるため、対応する部分には同一符号を付し、詳細な説明は割愛する。
図8は、EPS側ECU140における舵角制御部200の第2の構成を示す図であり、前掲図6に対応している。なお、舵角演算部201aを除く他の構成は、前掲図6と同様であるため、対応する部分には同一符号を付し、詳細な説明は割愛する。
<舵角演算部201a>
舵角演算部201aは、舵角制御モード時において、操舵トルクTtを用いることなく、舵角センサ14から出力されるハンドル舵角θh、回転センサ151から出力されるモータ角度θm、舵角異常判定部148から出力される舵角異常判定信号Flg_θhを利用して実操舵角θrまたは実操舵角の推定値θrを求める点において、図6に示す舵角演算部201と異なる。このように、操舵トルクTtを利用しない場合には、より簡易に実操舵角θrまたは実操舵角の推定値θrを求めることが可能となる。
舵角演算部201aは、舵角制御モード時において、操舵トルクTtを用いることなく、舵角センサ14から出力されるハンドル舵角θh、回転センサ151から出力されるモータ角度θm、舵角異常判定部148から出力される舵角異常判定信号Flg_θhを利用して実操舵角θrまたは実操舵角の推定値θrを求める点において、図6に示す舵角演算部201と異なる。このように、操舵トルクTtを利用しない場合には、より簡易に実操舵角θrまたは実操舵角の推定値θrを求めることが可能となる。
B-1.舵角演算部201aによる演算処理
次に、舵角演算部201aによって実行される演算処理(第2演算処理)について、図9に示すフローチャートを参照しながら説明する。
舵角演算部201aは、舵角制御モード時において、舵角センサ14から出力されるハンドル舵角θh、回転センサ151から出力されるモータ角度θm、舵角異常判定部148から出力される舵角異常判定信号Flg_θhを取得する(ステップSa1)。舵角演算部201は、舵角異常判定信号Flg_θhに基づき、検出される舵角が正常であるか否かを判断する(ステップSa2)。舵角演算部201は、検出される舵角が正常であると判断すると(ステップSa2;YES)、ステップSa3に進み、ハンドル舵角θhを実操舵角θrとして出力する。そして、舵角演算部201は、今回求めた実操舵角θr、モータ角度θmのそれぞれを、実操舵角の過去値Zθr、モータ角度の過去値Zθmとしてメモリ(図示略)に格納し(ステップSa3→ステップSa4→ステップSa5)、処理を終了する。
次に、舵角演算部201aによって実行される演算処理(第2演算処理)について、図9に示すフローチャートを参照しながら説明する。
舵角演算部201aは、舵角制御モード時において、舵角センサ14から出力されるハンドル舵角θh、回転センサ151から出力されるモータ角度θm、舵角異常判定部148から出力される舵角異常判定信号Flg_θhを取得する(ステップSa1)。舵角演算部201は、舵角異常判定信号Flg_θhに基づき、検出される舵角が正常であるか否かを判断する(ステップSa2)。舵角演算部201は、検出される舵角が正常であると判断すると(ステップSa2;YES)、ステップSa3に進み、ハンドル舵角θhを実操舵角θrとして出力する。そして、舵角演算部201は、今回求めた実操舵角θr、モータ角度θmのそれぞれを、実操舵角の過去値Zθr、モータ角度の過去値Zθmとしてメモリ(図示略)に格納し(ステップSa3→ステップSa4→ステップSa5)、処理を終了する。
一方、舵角演算部201は、ステップSa2において、検出される舵角が異常であると判断すると(ステップSa2;NO)、ステップSa6に進み、舵角異常が検出されて初めての演算(すなわち1回目の演算)であるであるか否かを判断する。舵角演算部201は、舵角異常が検出されて1回目の演算でないと判断すると(ステップSa6;NO)、ステップSa7をスキップし、ステップSa8に進む。一方、舵角演算部201は、舵角異常が検出されて1回目の演算であると判断すると(ステップSa6;YES)、モータ角度の過去値Zθmを用いて、モータ初期角度θ0(=Zθm)を求める(ステップSa7)。そして、舵角演算部201は、現時点でのモータ角度θmからモータ初期角度θ0を減じることでモータ相対角度Δθmを求める(ステップSa8)。さらに、舵角演算部201は、モータ相対角度Δθmに所定の係数Cg(コラム軸とモータ軸の間の減速比の逆数)を乗じたうえで、実操舵角の過去値Zθrを加算することで、実操舵角の推定値θrを求め(ステップSa9)、処理を終了する。
<シミュレーション結果>
図10A及び図10Bは、意図的に実操舵角または実操舵角(推定値)に1[sec]+90[deg]のオフセット値を加算した際の車両挙動のシミュレーション結果を示す。車両側ECU130の舵角指令値生成部(図5参照)において、車両横位置の目標値を0[m]で、横位置に対して微分先行型のPI-D制御を適応し、舵角指令値θrefをEPS側ECU140の舵角制御部200(図5参照)に出力したところ、横位置が目標の0[m]に収束することがわかる(図10B参照)。これは、上述のPI-D制御の比例と積分の補償が効果を示していると考えられる。なお、図示はしていないが、積分がない場合でも横位置にはオフセットが発生するが、比例ゲインを大きめに設定すれば解消され得る。
図10A及び図10Bは、意図的に実操舵角または実操舵角(推定値)に1[sec]+90[deg]のオフセット値を加算した際の車両挙動のシミュレーション結果を示す。車両側ECU130の舵角指令値生成部(図5参照)において、車両横位置の目標値を0[m]で、横位置に対して微分先行型のPI-D制御を適応し、舵角指令値θrefをEPS側ECU140の舵角制御部200(図5参照)に出力したところ、横位置が目標の0[m]に収束することがわかる(図10B参照)。これは、上述のPI-D制御の比例と積分の補償が効果を示していると考えられる。なお、図示はしていないが、積分がない場合でも横位置にはオフセットが発生するが、比例ゲインを大きめに設定すれば解消され得る。
C.手入力判定後のアシスト制御への遷移
ここで、手入力判定後のアシスト制御への遷移について説明しておく(図11参照)。以下、自動運転状態(舵角制御とアシスト制御の両方が介在している状態)中に、ドライバーによる手入力の検知後の各徐変ゲインについて説明する。
ここで、手入力判定後のアシスト制御への遷移について説明しておく(図11参照)。以下、自動運転状態(舵角制御とアシスト制御の両方が介在している状態)中に、ドライバーによる手入力の検知後の各徐変ゲインについて説明する。
徐変ゲインGFA1~4(舵角制御出力徐変ゲインGFA1、速度制御徐変ゲインGFA2、速度指令徐変ゲインGFA3、舵角指令徐変ゲインGFA4)については、手入力判定後、100%から逐次減少していき、0%に遷移する本実施形態では、直線的に変化させている。なお、切換動作をより円滑にするために、S字カーブに沿うように遷移させてもよいし、直線的に変化する信号に対しLPF(ローパスフィルタ)を通した値を各徐変ゲインとしてもよい(例えば、1次LPF、カットオフ周波数2[Hz])。ただし、徐変ゲインGFA1~4は同じ遷移として連動させる必要はなく、それぞれ、調整要素として独立させた遷移にしてもよい。
(舵角指令徐変ゲインGFA4)
舵角指令値の可変レートリミッタの変化率設定値を0にする。つまり、θref2を一定値にする。これに関しフローチャートなどの図示は割愛するが舵角指令徐変ゲインGFA4が100%の状態から0%側に変化した際に変化率設定値を変更すれば実現できる。すなわち、切換状態に入ったらθref2を一定値にし、一定値に舵角指令徐変ゲインGFA4を乗じることでθref3と目標操舵角θtが0に近づく。また、θref2に対して、舵角指令徐変ゲインGFA4を乗じることで、切換中の目標操舵角θtを0[deg]に近づけ、舵角制御を中立状態に作用させる。また、舵角指令徐変ゲインGFA4の乗算をハンドル振動除去手段206の手前で行うことで、舵角指令徐変ゲインGFA4の乗算により発生するハンドル振動周波数成分を取り除かせる。
舵角指令値の可変レートリミッタの変化率設定値を0にする。つまり、θref2を一定値にする。これに関しフローチャートなどの図示は割愛するが舵角指令徐変ゲインGFA4が100%の状態から0%側に変化した際に変化率設定値を変更すれば実現できる。すなわち、切換状態に入ったらθref2を一定値にし、一定値に舵角指令徐変ゲインGFA4を乗じることでθref3と目標操舵角θtが0に近づく。また、θref2に対して、舵角指令徐変ゲインGFA4を乗じることで、切換中の目標操舵角θtを0[deg]に近づけ、舵角制御を中立状態に作用させる。また、舵角指令徐変ゲインGFA4の乗算をハンドル振動除去手段206の手前で行うことで、舵角指令徐変ゲインGFA4の乗算により発生するハンドル振動周波数成分を取り除かせる。
(アシストマップ徐変ゲインGFT2)
車両の自動運転状態においては、このアシストマップ徐変ゲインGFT2を100%以上に設定してもよい(なお、図11に示す例では300%に設定している)。これにより、ドライバーによる操作介入時に、舵角制御の干渉による引っ掛かり感、違和感を低減することができる。なお、切換動作をより円滑にするために、アシスト制御出力徐変ゲインGFT1、アシストマップ徐変ゲインGFT2を、S字カーブに沿うように遷移させてもよいし、直線的に変化する信号に対しLPF(ローパスフィルタ)を通した値を各徐変ゲインとしてもよい。
車両の自動運転状態においては、このアシストマップ徐変ゲインGFT2を100%以上に設定してもよい(なお、図11に示す例では300%に設定している)。これにより、ドライバーによる操作介入時に、舵角制御の干渉による引っ掛かり感、違和感を低減することができる。なお、切換動作をより円滑にするために、アシスト制御出力徐変ゲインGFT1、アシストマップ徐変ゲインGFT2を、S字カーブに沿うように遷移させてもよいし、直線的に変化する信号に対しLPF(ローパスフィルタ)を通した値を各徐変ゲインとしてもよい。
(アシスト制御出力徐変ゲインGFT1)
自動運転状態、手動アシスト状態においては、このアシスト制御出力徐変ゲインGFT1を常に100%以上に設定してもよいが、図11に示すようにしてもよい。
自動運転状態、手動アシスト状態においては、このアシスト制御出力徐変ゲインGFT1を常に100%以上に設定してもよいが、図11に示すようにしてもよい。
自動運転状態において、アシストマップ徐変ゲインGFT2を100%以上に上げることにより、システムの安定性が不安定側に影響することで、振動が発生する場合がある。安定性を確保するために、アシスト制御出力徐変ゲインGFT1を調整要素として、例えば、120%に設定することで、振動の発生を抑えることが可能となる。
続いて、舵角制御の実施形態を示す(図12等参照)。なお、図12等においては、ハンドル振動除去手段206(図6参照)の後段の目標操舵角θtおよびそれ以降の構成を図示している。
<舵角制御の第1の形態>
図12に示す舵角制御部200の舵角速度制御部212は、舵角速度制御にPI制御を行い、I制御には擬似積分を行う。より具体的には、目標舵角速度ωtと実舵角速度ωrとの偏差ωeにKviを乗じて偏差の大きさに比例した操作量D1とし、さらに、擬似積分によるI制御をする(図12参照)。図中の記号Ir1は擬似積分後、Ir2は比例ゲインKvp後、Ir3は加算後の信号をそれぞれ表す(他の実施形態においても同様)。舵角制御の第1の形態では、加算後の信号Ir3に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される。前述したように、速度制御徐変ゲインGFA2は、舵角速度制御部212の中の信号に乗じられ、円滑な切換を実現するために用いられる。なお、舵角速度制御部212における擬似積分は、例えば1次遅れの伝達関数とゲインで [1/(Ts+1)]×T として構成することができる。
図12に示す舵角制御部200の舵角速度制御部212は、舵角速度制御にPI制御を行い、I制御には擬似積分を行う。より具体的には、目標舵角速度ωtと実舵角速度ωrとの偏差ωeにKviを乗じて偏差の大きさに比例した操作量D1とし、さらに、擬似積分によるI制御をする(図12参照)。図中の記号Ir1は擬似積分後、Ir2は比例ゲインKvp後、Ir3は加算後の信号をそれぞれ表す(他の実施形態においても同様)。舵角制御の第1の形態では、加算後の信号Ir3に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される。前述したように、速度制御徐変ゲインGFA2は、舵角速度制御部212の中の信号に乗じられ、円滑な切換を実現するために用いられる。なお、舵角速度制御部212における擬似積分は、例えば1次遅れの伝達関数とゲインで [1/(Ts+1)]×T として構成することができる。
<舵角制御の第2の形態>
図13に示す舵角制御部200の舵角速度制御部212は、舵角速度制御にPI制御を行い、I制御には擬似積分を行う。より具体的には、目標舵角速度ωtと実舵角速度ωrとの偏差にKviを乗じて偏差の大きさに比例した操作量D1とし、さらに、擬似積分によるI制御をする(図13参照)。舵角制御の第2の形態では、上述した第1の形態と同様、加算後の信号Ir3に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される。
図13に示す舵角制御部200の舵角速度制御部212は、舵角速度制御にPI制御を行い、I制御には擬似積分を行う。より具体的には、目標舵角速度ωtと実舵角速度ωrとの偏差にKviを乗じて偏差の大きさに比例した操作量D1とし、さらに、擬似積分によるI制御をする(図13参照)。舵角制御の第2の形態では、上述した第1の形態と同様、加算後の信号Ir3に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される。
<舵角制御の第3の形態>
図14に示す舵角制御部200の舵角速度制御部212は、舵角速度制御にPI制御を行い、I制御には擬似積分を行う。舵角制御の第3の形態では、目標舵角速度ωtと実舵角速度ωrとの偏差に速度制御徐変ゲインGFA2を乗じて信号ωe1を生成し、この信号ωe1にKviを乗じて偏差の大きさに比例した操作量D1とし、さらに、擬似積分によるI制御をする(図14参照)。
図14に示す舵角制御部200の舵角速度制御部212は、舵角速度制御にPI制御を行い、I制御には擬似積分を行う。舵角制御の第3の形態では、目標舵角速度ωtと実舵角速度ωrとの偏差に速度制御徐変ゲインGFA2を乗じて信号ωe1を生成し、この信号ωe1にKviを乗じて偏差の大きさに比例した操作量D1とし、さらに、擬似積分によるI制御をする(図14参照)。
<舵角制御の第4の形態>
図15に示す舵角制御部200の舵角速度制御部212は、位相遅れ補償を行う。舵角制御の第4の形態では、目標舵角速度ωtと実舵角速度ωrとの偏差にKvpを乗じて偏差の大きさに比例した操作量D1とし、さらに、位相遅れ補償を行った後の信号Ir1に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される(図15参照)。
図15に示す舵角制御部200の舵角速度制御部212は、位相遅れ補償を行う。舵角制御の第4の形態では、目標舵角速度ωtと実舵角速度ωrとの偏差にKvpを乗じて偏差の大きさに比例した操作量D1とし、さらに、位相遅れ補償を行った後の信号Ir1に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される(図15参照)。
<舵角制御の第5の形態>
図16に示す舵角制御部200の舵角速度制御部212は、位相遅れ補償を行う。舵角制御の第5の形態では、上述した第4の形態と同様、目標舵角速度ωtと実舵角速度ωrとの偏差にKvpを乗じて偏差の大きさに比例した操作量D1とし、さらに、位相遅れ補償を行った後の信号Ir1に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される(図16参照)。擬似積分のPI制御は、等価的に位相遅れ補償とゲインに置き換えられる。
図16に示す舵角制御部200の舵角速度制御部212は、位相遅れ補償を行う。舵角制御の第5の形態では、上述した第4の形態と同様、目標舵角速度ωtと実舵角速度ωrとの偏差にKvpを乗じて偏差の大きさに比例した操作量D1とし、さらに、位相遅れ補償を行った後の信号Ir1に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される(図16参照)。擬似積分のPI制御は、等価的に位相遅れ補償とゲインに置き換えられる。
<舵角制御の第6の形態>
図17、図18に示す舵角制御部200の舵角速度制御部212は、比例制御(P制御)を行う。舵角制御の第6の形態では、目標舵角速度ωtと実舵角速度ωrとの偏差にKvpを乗じて偏差の大きさに比例した操作量の信号Ir1に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される(図17、図18参照)。
図17、図18に示す舵角制御部200の舵角速度制御部212は、比例制御(P制御)を行う。舵角制御の第6の形態では、目標舵角速度ωtと実舵角速度ωrとの偏差にKvpを乗じて偏差の大きさに比例した操作量の信号Ir1に速度制御徐変ゲインGFA2を乗じ、信号IrefWとして舵角速度制御部212から出力される(図17、図18参照)。
上述した舵角制御の第1~第5の各形態によれば、車両の自動運転中において「手入力検出」、「切換動作」が無くとも、引っ掛かり感等の違和感の無い操舵介入を実現することができる。以下、その根拠となる結果等を実施例1として説明する(図19~図21参照)。
<実施例1>
(課題1および課題2の解決の根拠)
ドライバーの操舵モデルを考慮したシミュレーションにより、自動運転中(ただし、舵角指令値θrefは0[deg]固定とする。)に、ドライバー目標角度θarm(図中の太線参照)に対して、実操舵角(以下、ハンドル舵角とも呼び、記号θhで表す。細線参照)、操舵トルクTt(破線参照)の時間応答を一例として図19等に示す。
(課題1および課題2の解決の根拠)
ドライバーの操舵モデルを考慮したシミュレーションにより、自動運転中(ただし、舵角指令値θrefは0[deg]固定とする。)に、ドライバー目標角度θarm(図中の太線参照)に対して、実操舵角(以下、ハンドル舵角とも呼び、記号θhで表す。細線参照)、操舵トルクTt(破線参照)の時間応答を一例として図19等に示す。
ここで、シミュレーションに用いたプラントモデルについて説明して置く(図22、図23参照)。
図22に、シミュレーションに用いたプラントモデル(メカモデル)を示す。このプラントモデルでは、電流指令値に対するモータ電流値の追従性は十分に早いものとし、電流制御部の詳細説明は割愛し、電流指令値=モータ電流 とし、信号名 Iref として扱っている。車速Vは一定としている。コラム慣性モーメント Jc は、モータ慣性モーメント、シャフト、ラック&ピニオン、タイヤの慣性モーメントをコラム軸に換算した合計としている。モータ角度θm と コラム角度θc は、ウォーム減速比の関係とする。コラム角θc と タイヤ転舵角δはオーバーオールレイシオ Nover の比の関係とする。トーションバートルクと操舵トルクは同じ信号で、Ttとする。コラムからタイヤに掛けて、一つのコラム慣性としてモデル化した。
Jc : コラム慣性[kgm^2]
Dc : コラム減衰係数[Nm/(rad/s)]
Jh : ハンドル慣性[kgm^2]
Dh : ハンドル減衰係数[Nm/(rad/s)]
Ks : トーションバーバネ定数[Nm/rad]
Ds : トーションバー減衰定数[Nm/(rad/s)]
Kt : モータトルク定数[Nm/A]
減速比 : ng
Tc : モータ発生トルクのコラム軸換算[Nm]
ただし、モータ発生トルクはコラム軸のトルクに換算(減速機分考慮)。また、電流指令値Irefに対し実際のモータ電流は一致しているものとして扱っているため、電流制御は省略している。
Th : ハンドル手入力トルク[Nm]
Tt : トーションバートルク[Nm]
Iref : 電流指令値[A]
θh : ハンドル舵角[rad]
θc : コラム舵角[rad]
V : 車速[m/s]
Yveh : 車両重心での横方向移動距離[m]
δ : タイヤ転舵角[rad]
Fd : 車両重心に働く横方向外力[N]
Tsat : Tsat ' のコラム軸換算[Nm]
Tsat ' : 路面反力によりキングピン周りに働くモーメント[Nm]
Jc : コラム慣性[kgm^2]
Dc : コラム減衰係数[Nm/(rad/s)]
Jh : ハンドル慣性[kgm^2]
Dh : ハンドル減衰係数[Nm/(rad/s)]
Ks : トーションバーバネ定数[Nm/rad]
Ds : トーションバー減衰定数[Nm/(rad/s)]
Kt : モータトルク定数[Nm/A]
減速比 : ng
Tc : モータ発生トルクのコラム軸換算[Nm]
ただし、モータ発生トルクはコラム軸のトルクに換算(減速機分考慮)。また、電流指令値Irefに対し実際のモータ電流は一致しているものとして扱っているため、電流制御は省略している。
Th : ハンドル手入力トルク[Nm]
Tt : トーションバートルク[Nm]
Iref : 電流指令値[A]
θh : ハンドル舵角[rad]
θc : コラム舵角[rad]
V : 車速[m/s]
Yveh : 車両重心での横方向移動距離[m]
δ : タイヤ転舵角[rad]
Fd : 車両重心に働く横方向外力[N]
Tsat : Tsat ' のコラム軸換算[Nm]
Tsat ' : 路面反力によりキングピン周りに働くモーメント[Nm]
車両運動モデルについて説明しておく。車両の微分方程式は数式1、数式2のようになる。
ラプラス変換後の横滑り角βとヨーレートγを数式3に示す。
キングピン周りに働く、タイヤが路面から受けるモーメントを数式4に示す。
近似条件下での車両重心での横方向加速度を数式5に示す。
車両重心での横方向移動距離を数式6に示す。
ラプラス変換後の横滑り角βとヨーレートγを数式3に示す。
キングピン周りに働く、タイヤが路面から受けるモーメントを数式4に示す。
近似条件下での車両重心での横方向加速度を数式5に示す。
車両重心での横方向移動距離を数式6に示す。
なお、車両運動モデルは、タイヤ転舵角δから、路面反力によりキングピン周りに働くモーメントTsat ' への伝達特性を考慮したものならばよい。なお、シミュレーションに用いる車両モデルと操舵モデルについては、上記に限らず、一般の文献等を参照してもよい。また、車両モデルの関係式である、数式1、数式2、数式4、数式5については、例えば、東京電機大学出版局、「自動車の運動と制御」(安部正人著)に示されている。操舵モデルについては、例えば、三重大学修士論文、「腕の筋骨格特性を考慮した車のステアリング操舵感評価に関する研究」(横井大介著)に示されている。
図23に、ドライバーの操舵モデルの一例を示す。ドライバーによる操舵をシミュレーションする際、図23に示す操舵モデルを用い、メカモデル(図22参照)から出力されるハンドル舵角θh を操舵モデルへ入力し、操舵モデルから出力される手入力トルクTh をメカモデルへ出力した。ここでは、目標角度(ドライバーの操舵目標角度)をθarm としている。
一例として示した条件は、以下に説明する「擬似積分、アシスト制御出力徐変ゲインGFT1=1倍、アシストマップ徐変ゲインGFT2=3倍」「ただし、舵角制御出力徐変ゲインGFA1、速度制御徐変ゲインGFA2、速度指令徐変ゲインGFA3および舵角指令徐変ゲインGFA4は1倍」とした。
図19に示したドライバー目標角度θarmを入力した際のそれぞれの条件でのハンドル舵角θhと操舵トルク Tt(=トーションバートルク)を比較した(図19~図21参照)。
太線・・・擬似積分(図21ではP制御)、アシスト制御出力徐変ゲインGFT1=1倍、アシストマップ徐変ゲインGFT2=1倍
細線・・・擬似積分(図21ではP制御)、アシスト制御出力徐変ゲインGFT1=1倍、アシストマップ徐変ゲインGFT2=3倍
破線・・・純積分(図21ではPI制御)、アシスト制御出力徐変ゲインGFT1=1倍、アシストマップ徐変ゲインGFT2=1倍
ただし、舵角制御出力徐変ゲインGFA1、速度制御徐変ゲインGFA2、速度指令徐変ゲインGFA3および舵角指令徐変ゲインGFA4は1倍とした。
細線・・・擬似積分(図21ではP制御)、アシスト制御出力徐変ゲインGFT1=1倍、アシストマップ徐変ゲインGFT2=3倍
破線・・・純積分(図21ではPI制御)、アシスト制御出力徐変ゲインGFT1=1倍、アシストマップ徐変ゲインGFT2=1倍
ただし、舵角制御出力徐変ゲインGFA1、速度制御徐変ゲインGFA2、速度指令徐変ゲインGFA3および舵角指令徐変ゲインGFA4は1倍とした。
太線と破線から、速度制御のPI制御を「擬似積分」で行った方が(図21の場合は、P制御で行った方が)、操舵できていることがわかる。その理由としては以下を挙げることができる。
すなわち、破線は、7.5[deg] までハンドル舵角θhを切れているが、速度制御PIの純積分の影響により、速度偏差(舵角速度指令値と実舵角速度の偏差)が蓄積され続けることで、最終的に舵角指令値θref(=0[deg])まで強制的に戻されてしまい、さらに、非常に大きな操舵トルクが発生してしまい、よって、ドライバーによる操舵は困難となる(0[deg]で15[Nm]以上の操舵トルク発生)。ただし、従来技術においては、切換前の舵角制御中において、アシスト制御指令値は 0[deg] であるが、破線よりも操舵が困難であるため割愛している。また、本実施形態に係る電動パワーステアリング装置との比較のために、GFT1=1倍、GFT2=1倍として、積分方式の違いを見ることにした。
これに対して、太線では、約14[deg]まで操舵できており、舵角指令値0[deg]に引き戻されることもない。これは、擬似積分(図21ではP制御)を用いることにより、速度偏差の蓄積が限定されること(図21では、積分による速度偏差の蓄積が無いこと)に起因する。さらに、細線(アシストマップ徐変ゲインGFT2=3倍)では、太線よりも軽い操舵が実現できることが確認できる。アシストマップ徐変ゲインGFT2を大きくすることでドライバーによる操舵介入が軽い操舵で実現できるのが分かる。
また、上述した舵角制御の第1~第5の各形態によれば、ハンドル振動除去手段206と操舵介入補償兼ハンドル制振手段220を用いることで、自動操舵中のハンドルの振動抑制を実現することができる。
ここまで説明した本実施形態に係る電動パワーステアリング装置100は、角度センサに異常が生じていない場合には、角度センサを利用して舵角制御を行う一方、角度センサに何らかの異常が検出された場合には、角度センサを用いる代わりに、舵角の推定値を求め、求めた舵角の推定値を利用して舵角制御を行う。これにより、舵角制御モード時にハンドル舵角の舵角異常が発生したとしても、実際の操舵角を精度よく推定することができるため、自動運転中の車両・EPSの挙動に支障はなく、事故の発生等を防止することができる。また、舵角異常の発生により、ドライバーが違和感を覚えることもない。また、別の側面において、本実施形態に係る電動パワーステアリング装置100は、車両の自動運転での高性能なヒューマン・マシン・インターフェースを実現する。すなわち、自動運転中のドライバーによる操舵の介入時に、「手入力検出」「切換動作」が無い状態においても手動操舵を実現し、ドライバーによる緊急操舵時の高い安全性を確保して、舵角制御とアシスト制御を両立する制御方法を実現する。また、舵角制御からアシスト制御への切換時も、引っ掛かり感等のドライバーの違和感、不快感を低減する。また、アシスト制御から舵角制御への切換も違和感なく円滑に実施される。
なお、上述の実施形態は本発明の好適な実施の一例ではあるがこれに限定されるものではなく本発明の要旨を逸脱しない範囲において種々変形実施可能である。例えば上述した実施形態ではハンドル振動除去手段206にLPFを用いているがこれは好適な一例にすぎず、この他、例えばハンドル振動周波数(約10Hz前後)に合わせたノッチフィルタにより、成分を低減してもよい。
また、上述した実施形態では操舵介入補償兼ハンドル制振手段220に1次の位相進み補償を用いているが、2次以上の位相補償フィルタを利用してもよい。
また、上述した各徐変ゲインは、実施形態に例示したものに限らず、状況に応じて更新してもよい。例えば、アシスト制御出力徐変ゲインGFT1やアシストマップ徐変ゲインGFT2は、100%以上に設定することに限らず、状況に応じて0%以上100%未満の値に設定してもよい。
上述した実施形態における舵角制御と車両制御を組み合わせた場合の車両運動挙動はあくまで一例にすぎない。例えば図10A及び図10Bのシミュレーションでは、単純に舵角制御のみを実施した場合の車両制御の挙動を把握することを前提としているため、アシスト制御出力徐変ゲインGFT1=0%としている。ここで、舵角制御は、上記各実施形態に示したものに限定する趣旨ではなく、舵角指令値に対して実操舵角(推定値)が追従する制御構成であれば、舵角センサ14を用いずに同様の車両運動を実現し得る。なお、車両制御についても、例えば横方向の外乱(例えば横風)が発生した場合には、車両の横位置の目標値に修正を加える等の態様で車両制御を行うようにすればよい。
本発明は、電動パワーステアリングに適用して好適である。
1…ハンドル(ステアリングホイール)
2…コラム軸(トーションバー)
3…減速ギア
4a,4b…ユニバーサルジョイント
5…ピニオンラック機構
6a,6b…タイロッド
7a,7b…ハブユニット
8L,8R…操向車輪
10…トルクセンサ
12…車速センサ
14…舵角センサ
20…モータ
21…回転センサ
30…コントロールユニット
31…電流指令値演算部
32A…加算部
32B…減算部
33…電流制限部
34…補償部
35…PI制御部
36…PWM制御部
37…インバータ
38…モータ電流検出器
40…CAN
100…電動パワーステアリング装置
130…車両側ECU
130a…車両状態量検出器
131…切換指令部
132…目標操舵角生成部
134…目標軌道演算部
135…車両運動制御部
135a…舵角指令値生成部
140…EPS(電動パワーステアリング装置)側ECU
141…トルク制御部
142…切換部
143…電流制御/駆動部
144…モータ角速度演算部
145…切換判定/徐変ゲイン生成部
146…EPS状態量検出器
147…アシスト制御部
150…モータ
151…回転センサ
154…トルクセンサ
160…プラント
200…舵角制御部
201、201a…舵角演算部
202…上下限可変リミッタ
204…可変レートリミッタ
206…ハンドル振動除去手段
208…位置制御部
210…速度指令値上下限可変リミッタ
212…舵角速度制御部
214…舵角制御出力上下限リミッタ
220…操舵介入補償兼ハンドル制振手段
230…FFフィルタ
341…収れん性
342…慣性
343…セルフアライニングトルク(SAT)
344…加算部
345…加算部
CM…補償信号
GFA1…舵角制御出力徐変ゲイン
GFA2…速度制御徐変ゲイン
GFA3…速度指令徐変ゲイン
GFA4…舵角指令徐変ゲイン
GFT1…アシスト制御出力徐変ゲイン
GFT2…アシストマップ徐変ゲイン
IrefP1…舵角制御電流指令値
Th…操舵トルク
Vs…車速
Flg_θh…舵角異常判定信号
θh…ハンドル舵角
θm…モータ角度
θr…実操舵角(または実操舵角の推定値)
θref…舵角指令値
θs…モータ回転角
θt…目標操舵角
ωr…実舵角速度
ωref…舵角速度指令値
2…コラム軸(トーションバー)
3…減速ギア
4a,4b…ユニバーサルジョイント
5…ピニオンラック機構
6a,6b…タイロッド
7a,7b…ハブユニット
8L,8R…操向車輪
10…トルクセンサ
12…車速センサ
14…舵角センサ
20…モータ
21…回転センサ
30…コントロールユニット
31…電流指令値演算部
32A…加算部
32B…減算部
33…電流制限部
34…補償部
35…PI制御部
36…PWM制御部
37…インバータ
38…モータ電流検出器
40…CAN
100…電動パワーステアリング装置
130…車両側ECU
130a…車両状態量検出器
131…切換指令部
132…目標操舵角生成部
134…目標軌道演算部
135…車両運動制御部
135a…舵角指令値生成部
140…EPS(電動パワーステアリング装置)側ECU
141…トルク制御部
142…切換部
143…電流制御/駆動部
144…モータ角速度演算部
145…切換判定/徐変ゲイン生成部
146…EPS状態量検出器
147…アシスト制御部
150…モータ
151…回転センサ
154…トルクセンサ
160…プラント
200…舵角制御部
201、201a…舵角演算部
202…上下限可変リミッタ
204…可変レートリミッタ
206…ハンドル振動除去手段
208…位置制御部
210…速度指令値上下限可変リミッタ
212…舵角速度制御部
214…舵角制御出力上下限リミッタ
220…操舵介入補償兼ハンドル制振手段
230…FFフィルタ
341…収れん性
342…慣性
343…セルフアライニングトルク(SAT)
344…加算部
345…加算部
CM…補償信号
GFA1…舵角制御出力徐変ゲイン
GFA2…速度制御徐変ゲイン
GFA3…速度指令徐変ゲイン
GFA4…舵角指令徐変ゲイン
GFT1…アシスト制御出力徐変ゲイン
GFT2…アシストマップ徐変ゲイン
IrefP1…舵角制御電流指令値
Th…操舵トルク
Vs…車速
Flg_θh…舵角異常判定信号
θh…ハンドル舵角
θm…モータ角度
θr…実操舵角(または実操舵角の推定値)
θref…舵角指令値
θs…モータ回転角
θt…目標操舵角
ωr…実舵角速度
ωref…舵角速度指令値
Claims (8)
- 車両のステアリング機構にモータの回転力で操舵補助力を付与する電動パワーステアリング装置の制御装置であって、
前記車両の目標軌道に基づき演算された舵角指令値θrefが入力され、入力された舵角指令値θrefに基づき前記ステアリング機構の舵角を制御する舵角制御部を備え、
前記舵角制御部は、
入力される舵角異常判定信号が正常であることを示す場合には、検出されるハンドル舵角θhを実操舵角θrとして出力する一方、前記舵角異常判定信号が異常であることを示す場合には、入力されるモータ角度θmを用いて、前記ステアリング機構の実操舵角の推定値θrを求め、実操舵角推定値θrとして出力する舵角演算部と、
入力される目標操舵角θtと、前記実操舵角θrまたは前記実操舵角推定値θrとに基づき、舵角速度指令値ωrefを導出する位置制御部とを具備する、電動パワーステアリング装置の制御装置。 - 前記舵角演算部は、
前記舵角異常判定信号が異常であることを示す場合には、前記モータ角度θmとともに、入力される操舵トルクTtを用いて、前記実操舵角推定値θrを求める、請求項1に記載の電動パワーステアリング装置の制御装置。 - 前記舵角演算部は、
前記舵角異常判定信号が異常であることを示す場合には、正常時の実操舵角の過去の値Zθrと、モータの相対角度Δθmと、トーションバーの捩れ相対角Δθを利用して前記実操舵角推定値θrを導出する、請求項1または2に記載の電動パワーステアリング装置の制御装置。 - 前記舵角演算部は、
前記舵角異常判定信号が異常であることを示す場合には、正常時の実操舵角の過去の値Zθrと、モータの相対角度Δθmを利用して前記実操舵角推定値θrを導出する、請求項1または2に記載の電動パワーステアリング装置の制御装置。 - 車両のステアリング機構にモータの回転力で操舵補助力を付与する電動パワーステアリング装置の制御装置であって、
前記車両の目標軌道に基づき演算された舵角指令値θrefが入力され、入力された舵角指令値θrefに基づき前記ステアリング機構の舵角を制御する舵角制御部を備え、
前記舵角制御部は、
入力される舵角異常判定信号が正常であることを示す場合には、検出されるハンドル舵角θhを実操舵角θrとして出力する一方、前記舵角異常判定信号が異常であることを示す場合には、入力される実舵角速度ωrを用いて、前記ステアリング機構の実操舵角の推定値θrを求め、実操舵角推定値θrとして出力する舵角演算部と、
入力される目標操舵角θtと、前記実操舵角θrまたは前記実操舵角推定値θrとに基づき、舵角速度指令値ωrefを導出する位置制御部とを具備する、電動パワーステアリング装置の制御装置。 - 前記舵角演算部は、
前記舵角異常判定信号が異常であることを示す場合には、前記実舵角速度ωrとともに、入力される操舵トルクTtを用いて、前記実操舵角推定値θrを求める、請求項4に記載の電動パワーステアリング装置の制御装置。 - 前記舵角演算部は、
前記舵角異常判定信号が異常であることを示す場合には、正常時の実操舵角の過去の値Zθrと、実舵角速度ωrの時間積分値Sと、トーションバーの捩れ相対角Δθを利用して前記実操舵角推定値θrを導出する、請求項5または6に記載の電動パワーステアリング装置の制御装置。 - 前記舵角演算部は、
前記舵角異常判定信号が異常であることを示す場合には、正常時の実操舵角の過去の値Zθrと、実舵角速度ωrの時間積分値Sを利用して前記実操舵角推定値θrを導出する、請求項5または6に記載の電動パワーステアリング装置の制御装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP17843588.9A EP3459823B1 (en) | 2016-08-26 | 2017-08-22 | Control device for electric power steering device |
CN201780051101.3A CN109641619A (zh) | 2016-08-26 | 2017-08-22 | 电动助力转向装置的控制装置 |
US16/311,330 US10689026B2 (en) | 2016-08-26 | 2017-08-22 | Control device for electric power steering device |
JP2018535702A JP6481800B2 (ja) | 2016-08-26 | 2017-08-22 | 電動パワーステアリング装置の制御装置 |
Applications Claiming Priority (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016165765 | 2016-08-26 | ||
JP2016-165765 | 2016-08-26 | ||
JP2016165948 | 2016-08-26 | ||
JP2016-165948 | 2016-08-26 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2018038110A1 true WO2018038110A1 (ja) | 2018-03-01 |
Family
ID=61246132
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2017/029971 WO2018038110A1 (ja) | 2016-08-26 | 2017-08-22 | 電動パワーステアリング装置の制御装置 |
Country Status (5)
Country | Link |
---|---|
US (1) | US10689026B2 (ja) |
EP (1) | EP3459823B1 (ja) |
JP (1) | JP6481800B2 (ja) |
CN (1) | CN109641619A (ja) |
WO (1) | WO2018038110A1 (ja) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021172222A (ja) * | 2020-04-24 | 2021-11-01 | 株式会社Subaru | 操舵角検出装置 |
US20220297757A1 (en) * | 2020-04-08 | 2022-09-22 | Nsk Ltd. | Rotation angle detection device and electric power steering device |
KR20230134637A (ko) * | 2022-03-14 | 2023-09-22 | 주식회사 에이치엘클레무브 | 운전자 보조 시스템 및 운전자 보조 방법 |
US11807317B2 (en) * | 2019-11-20 | 2023-11-07 | Robert Bosch Gmbh | Method for operating a vehicle |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10144448B2 (en) * | 2014-12-02 | 2018-12-04 | Nsk Ltd. | Electric power steering apparatus |
EP3363698B1 (en) * | 2017-02-15 | 2021-05-26 | Volvo Car Corporation | Safety stoppage device and autonomous road vehicle equipped therewith |
JP6494050B2 (ja) * | 2017-03-31 | 2019-04-03 | 株式会社Subaru | 自動操舵制御装置 |
EP3808621B1 (en) * | 2019-01-31 | 2023-05-24 | Nsk Ltd. | Actuator control device used in steering of vehicle |
JP7259574B2 (ja) * | 2019-06-17 | 2023-04-18 | 株式会社ジェイテクト | 制御装置、および転舵装置 |
KR20210085611A (ko) * | 2019-12-31 | 2021-07-08 | 현대모비스 주식회사 | 전동식 조향장치의 제어장치 및 그 방법 |
JP7404143B2 (ja) * | 2020-04-17 | 2023-12-25 | 株式会社東海理化電機製作所 | 操作装置 |
KR102341112B1 (ko) * | 2020-04-23 | 2021-12-21 | 현대모비스 주식회사 | 전동식 파워 스티어링 시스템의 제어 장치 및 방법 |
DE102021202482B4 (de) * | 2021-03-15 | 2023-06-29 | Continental Automotive Technologies GmbH | Regelungseinrichtung und Verfahren zur Lenkwinkelregelung eines Fahrzeugs |
CN115593510A (zh) * | 2022-11-30 | 2023-01-13 | 禾多科技(北京)有限公司(Cn) | 车辆的控制方法及装置、存储介质及电子装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6127763A (ja) * | 1984-07-17 | 1986-02-07 | Nissan Motor Co Ltd | 車両の運動目標値設定装置 |
JP2004291923A (ja) * | 2003-03-28 | 2004-10-21 | Toyoda Mach Works Ltd | 電気式動力舵取装置 |
JP2013193490A (ja) * | 2012-03-16 | 2013-09-30 | Nsk Ltd | 電動パワーステアリング装置 |
WO2014136516A1 (ja) * | 2013-03-07 | 2014-09-12 | 日本精工株式会社 | 電動パワーステアリング装置 |
WO2014162769A1 (ja) * | 2013-04-04 | 2014-10-09 | 日本精工株式会社 | 電動パワーステアリング装置 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0834360A (ja) * | 1994-07-25 | 1996-02-06 | Honda Motor Co Ltd | 車両用操舵装置 |
JP3409753B2 (ja) * | 1999-10-29 | 2003-05-26 | トヨタ自動車株式会社 | 車両の電動パワーステアリング装置 |
JP3917008B2 (ja) | 2002-05-30 | 2007-05-23 | 株式会社ジェイテクト | 自動操舵制御装置 |
JP2004017881A (ja) | 2002-06-19 | 2004-01-22 | Toyoda Mach Works Ltd | 電動パワーステアリング装置 |
JP4097134B2 (ja) | 2002-11-28 | 2008-06-11 | 三菱電機株式会社 | 車輌用自動操舵装置 |
JP3912279B2 (ja) | 2002-12-24 | 2007-05-09 | 三菱自動車工業株式会社 | 自動操舵制御装置付き自動車 |
JP4378151B2 (ja) * | 2003-11-04 | 2009-12-02 | 株式会社デンソー | モータ駆動装置 |
JP3886991B2 (ja) * | 2004-09-10 | 2007-02-28 | 三菱電機株式会社 | モータ制御装置 |
JP5453714B2 (ja) * | 2007-02-08 | 2014-03-26 | 株式会社ジェイテクト | モータ制御装置および電動パワーステアリング装置 |
JP5286357B2 (ja) * | 2008-05-28 | 2013-09-11 | 本田技研工業株式会社 | 電動ステアリング装置 |
JP5822108B2 (ja) * | 2011-03-31 | 2015-11-24 | Kyb株式会社 | ステアリングシャフト回転角度検出装置 |
JP5641008B2 (ja) * | 2012-04-04 | 2014-12-17 | 日本精工株式会社 | モータ制御装置及びそれを搭載した電動パワーステアリング装置 |
WO2014119359A1 (ja) * | 2013-01-29 | 2014-08-07 | 日本精工株式会社 | 電動パワーステアリング装置 |
JP6136803B2 (ja) * | 2013-09-19 | 2017-05-31 | 日本精工株式会社 | モータ制御装置及びそれを用いた電動パワーステアリング装置 |
-
2017
- 2017-08-22 WO PCT/JP2017/029971 patent/WO2018038110A1/ja active Search and Examination
- 2017-08-22 CN CN201780051101.3A patent/CN109641619A/zh active Pending
- 2017-08-22 US US16/311,330 patent/US10689026B2/en not_active Expired - Fee Related
- 2017-08-22 EP EP17843588.9A patent/EP3459823B1/en active Active
- 2017-08-22 JP JP2018535702A patent/JP6481800B2/ja not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6127763A (ja) * | 1984-07-17 | 1986-02-07 | Nissan Motor Co Ltd | 車両の運動目標値設定装置 |
JP2004291923A (ja) * | 2003-03-28 | 2004-10-21 | Toyoda Mach Works Ltd | 電気式動力舵取装置 |
JP2013193490A (ja) * | 2012-03-16 | 2013-09-30 | Nsk Ltd | 電動パワーステアリング装置 |
WO2014136516A1 (ja) * | 2013-03-07 | 2014-09-12 | 日本精工株式会社 | 電動パワーステアリング装置 |
WO2014162769A1 (ja) * | 2013-04-04 | 2014-10-09 | 日本精工株式会社 | 電動パワーステアリング装置 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11807317B2 (en) * | 2019-11-20 | 2023-11-07 | Robert Bosch Gmbh | Method for operating a vehicle |
US20220297757A1 (en) * | 2020-04-08 | 2022-09-22 | Nsk Ltd. | Rotation angle detection device and electric power steering device |
JP2021172222A (ja) * | 2020-04-24 | 2021-11-01 | 株式会社Subaru | 操舵角検出装置 |
JP7487995B2 (ja) | 2020-04-24 | 2024-05-21 | 株式会社Subaru | 操舵角検出装置 |
US12043305B2 (en) | 2020-04-24 | 2024-07-23 | Subaru Corporation | Steering angle detecting apparatus |
KR20230134637A (ko) * | 2022-03-14 | 2023-09-22 | 주식회사 에이치엘클레무브 | 운전자 보조 시스템 및 운전자 보조 방법 |
KR102676463B1 (ko) | 2022-03-14 | 2024-06-20 | 주식회사 에이치엘클레무브 | 운전자 보조 시스템 및 운전자 보조 방법 |
Also Published As
Publication number | Publication date |
---|---|
JPWO2018038110A1 (ja) | 2019-02-07 |
CN109641619A (zh) | 2019-04-16 |
EP3459823A1 (en) | 2019-03-27 |
EP3459823A4 (en) | 2019-07-10 |
US10689026B2 (en) | 2020-06-23 |
EP3459823B1 (en) | 2020-02-12 |
JP6481800B2 (ja) | 2019-03-13 |
US20190193776A1 (en) | 2019-06-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6388187B2 (ja) | 電動パワーステアリング装置 | |
JP6481800B2 (ja) | 電動パワーステアリング装置の制御装置 | |
JP6481799B2 (ja) | 電動パワーステアリング装置の制御装置 | |
JP6512539B2 (ja) | 電動パワーステアリング装置 | |
US10703405B2 (en) | Steering control device | |
US10239554B2 (en) | Electric power steering apparatus | |
JP6098764B2 (ja) | 電動パワーステアリング装置 | |
CN113891827B (zh) | 车辆用转向装置 | |
JP6736028B2 (ja) | 電動パワーステアリング装置の制御装置 | |
US20200156698A1 (en) | Electric power steering apparatus | |
WO2020115973A1 (ja) | 車両用操向装置 | |
JP7129003B2 (ja) | モータ制御装置 | |
JP2020029194A (ja) | 操舵制御装置 | |
JP7199643B2 (ja) | 車両用操向装置 | |
JP7222309B2 (ja) | 車両用操向装置 | |
WO2020170602A1 (ja) | 車両用操向装置 | |
JP7268488B2 (ja) | 車両用操向装置 | |
WO2023062853A1 (ja) | モータ制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
DPE1 | Request for preliminary examination filed after expiration of 19th month from priority date (pct application filed from 20040101) | ||
ENP | Entry into the national phase |
Ref document number: 2018535702 Country of ref document: JP Kind code of ref document: A |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 17843588 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2017843588 Country of ref document: EP Effective date: 20181219 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |