The present invention relates to a motor control device that controls drive of an electric motor for steering angle control.
Patent Document 1 below discloses the following vehicle steering device. That is, a steering assist current is calculated in a driving assist mode. A risk level is calculated and a steering reaction force gain is calculated based on the risk level. A steering reaction force control current is calculated by multiplying a deviation between a target steering angle for steering assist and a steering angle by the steering reaction force gain, and a steering assist correction gain is calculated based on the steering reaction force gain. Then, an actuator drive current is calculated by adding a value obtained by multiplying the steering assist current by the steering assist correction gain and the steering reaction force control current, and drive of the actuator (electric motor) is controlled based on the actuator drive current. Thus, a reaction force based on the risk is generated and a driver is notified about the risk state.
An object of an embodiment of the present invention is to provide a motor control device that can apply a steering reaction force to a driver by a novel method in a driving assist mode.
An embodiment of the present invention provides a motor control device that controls drive of an electric motor for steering angle control. The motor control device includes: an assist torque command value generation unit that generates an assist torque command value using steering torque; a manual steering command value generation unit that generates a manual steering command value using the steering torque and the assist torque command value; an integrated angle command value calculation unit that calculates an integrated angle command value by adding the manual steering command value to an automatic steering command value for driving assist; and a switching unit that switches between a first control mode in which the electric motor is controlled based on the assist torque command value or the manual steering command value and a second control mode in which the electric motor is controlled based on the integrated angle command value according to a lateral position of a vehicle with respect to a lane in a driving assist mode.
The above and other objects, features, and effects of the present invention will become apparent from the following description of an embodiment that will be given with reference to the accompanying drawings.
An embodiment of the present invention provides a motor control device that controls drive of an electric motor for steering angle control. The motor control device includes: an assist torque command value generation unit that generates an assist torque command value using steering torque; a manual steering command value generation unit that generates a manual steering command value using the steering torque and the assist torque command value; an integrated angle command value calculation unit that calculates an integrated angle command value by adding the manual steering command value to an automatic steering command value for driving assist; and a switching unit that switches between a first control mode in which the electric motor is controlled based on the assist torque command value or the manual steering command value and a second control mode in which the electric motor is controlled based on the integrated angle command value according to a lateral position of a vehicle with respect to a lane in a driving assist mode.
In the embodiment of the present invention, a first lateral position that is the lateral position at which the first control mode is switched to the second control mode and a second lateral position that is the lateral position at which the second control mode is switched to the first control mode are set in advance, and a steering reaction force applied to the vehicle when the vehicle moves from a lane boundary of the lane to the second lateral position has a first characteristic in which a rate of decrease in the steering reaction force is high, and a second characteristic that is continuous with the first characteristic and in which the rate of decrease in the steering reaction force is lower than the rate of decrease in the steering reaction force in the first characteristic.
In the embodiment of the present invention, a first lateral position that is the lateral position at which the first control mode is switched to the second control mode and a second lateral position that is the lateral position at which the second control mode is switched to the first control mode are set to different positions.
In the embodiment of the present invention, the second lateral position is set closer to a center of the lane than the first lateral position.
In the embodiment of the present invention, the first lateral position is set closer to a center of the lane than the second lateral position.
In the embodiment of the present invention, the manual steering command value is calculated in consideration of a virtual road load torque.
In the embodiment of the present invention, the virtual road load torque is set according to the lateral position of the vehicle with respect to the lane.
The embodiment of the present invention, the virtual road load torque is set according to an angle of a traveling direction of the vehicle with respect to the lane.
In the embodiment of the present invention, the virtual road load torque is set based on information on outside of the lane where the vehicle is traveling.
An embodiment of the present invention will be described in detail below with reference to the accompanying drawings.
An electric power steering system 1 includes: a steering wheel 2 that is a steering member for steering a vehicle; a steering operation mechanism 4 that steers steered wheels 3 in conjunction with rotation of the steering wheel 2; and a steering assist mechanism 5 that assists a driver in steering. The steering wheel 2 and the steering operation mechanism 4 are mechanically connected via a steering shaft 6 and an intermediate shaft 7.
The steering shaft 6 includes an input shaft 8 connected to the steering wheel 2 and an output shaft 9 connected to the intermediate shaft 7. The input shaft 8 and the output shaft 9 are connected via a torsion bar 10 so as to be relatively rotatable.
A torque sensor 12 is disposed near the torsion bar 10. The torque sensor 12 detects torsion bar torque Ttb applied to the steering wheel 2 based on the amount of relative rotational displacement between the input shaft 8 and the output shaft 9. In the present embodiment, the torsion bar torque Ttb that is detected by the torque sensor 12 is such that, for example, the torque for steering to the left is detected as a positive value and the torque for steering to the right is detected as a negative value. It is herein assumed that the magnitude of the torsion bar torque Ttb increases as the absolute value thereof increases. The torsion bar torque Ttb is an example of the “steering torque” according to the present invention.
The steering operation mechanism 4 is a rack and pinion mechanism including a pinion shaft 13 and a rack shaft 14 that is a steered shaft. The steered wheels 3 are connected to the ends of the rack shaft 14 via tie rods 15 and knuckle arms (not shown). The pinion shaft 13 is connected to the intermediate shaft 7. The pinion shaft 13 is configured to rotate in conjunction with steering of the steering wheel 2. A pinion 16 is connected to a distal end of the pinion shaft 13.
The rack shaft 14 extends linearly along the right-left direction of the vehicle. A rack 17 that meshes with the pinion 16 is formed on an intermediate portion of the rack shaft 14 in the axial direction. The pinion 16 and the rack 17 convert rotation of the pinion shaft 13 into axial movement of the rack shaft 14. The steered wheels 3 can be steered by moving the rack shaft 14 in the axial direction.
When the steering wheel 2 is steered (rotated), this rotation is transferred to the pinion shaft 13 via the steering shaft 6 and the intermediate shaft 7. The pinion 16 and the rack 17 convert rotation of the pinion shaft 13 into axial movement of the rack shaft 14. The steered wheels 3 are thus steered.
The steering assist mechanism 5 includes an electric motor 18 that generates a steering assist force (assist torque), and a speed reducer 19 that amplifies output torque of the electric motor 18 and transfers the amplified torque to the steering operation mechanism 4. The speed reducer 19 is a worm gear mechanism including a worm gear 20 and a worm wheel 21 that meshes with the worm gear 20. The speed reducer 19 is housed in a gear housing 22 that is a transfer mechanism housing.
Hereinafter, the speed reduction ratio (gear ratio) of the speed reducer 19 may be represented by N. The speed reduction ratio N is defined as the ratio (θwg/θww) of a worm gear angle θwg, that is, the rotational angle of the worm gear 20, to a worm wheel angle θww, that is, the rotational angle of the worm wheel 21.
The worm gear 20 is rotationally driven by the electric motor 18. The worm wheel 21 is connected to the output shaft 9 so as to be rotatable together.
When the worm gear 20 is rotationally driven by the electric motor 18, the worm wheel 21 is rotationally driven so that motor torque is applied to the steering shaft 6 and the steering shaft 6 (output shaft 9) is rotated. Rotation of the steering shaft 6 is transferred to the pinion shaft 13 via the intermediate shaft 7. Rotation of the pinion shaft 13 is converted into axial movement of the rack shaft 14. The steered wheels 3 are thus steered. That is, rotationally driving the worm gear 20 using the electric motor 18 enables steering assist by the electric motor 18 and steering of the steered wheels 3. The electric motor 18 is provided with a rotational angle sensor 23 that detects the rotational angle of a rotor of the electric motor 18.
The torque that is applied to the output shaft 9 (example of the object to be driven by the electric motor 18) includes motor torque from the electric motor 18 and disturbance torque Tlc other than the motor torque. The disturbance torque Tlc other than the motor torque includes the torsion bar torque Ttb, road load torque (road reaction torque) Tri, and friction torque Tf.
The torsion bar torque Ttb is torque that is applied from the steering wheel 2 side to the output shaft 9 due to a force that is applied to the steering wheel 2 by the driver, a force that is generated by steering inertia, etc.
The road load torque Tri is torque that is applied from the steered wheel 3 side to the output shaft 9 via the rack shaft 14 due to self-aligning torque that is generated in tires, a force that is generated by suspensions and tire wheel alignment, a friction force of the rack and pinion mechanism, etc.
The vehicle is equipped with a CCD (Charge Coupled Device) camera 25 that captures an image of the road ahead of the vehicle in the advancing direction, a GPS (Global Positioning System) 26 that detects the position of the vehicle, a radar 27 that detects a road shape and obstacles, a map information memory 28 that stores map information, and a vehicle speed sensor 29.
The CCD camera 25, the GPS 26, the radar 27, the map information memory 28, and the vehicle speed sensor 29 are connected to a higher-level ECU (ECU: Electronic Control Unit) 201 that performs driving assist control. The higher-level ECU 201 performs surrounding environment recognition, vehicle position estimation, route planning, etc. based on information obtained by the CCD camera 25, the GPS 26, the radar 27, and the vehicle speed sensor 29 and the map information, and determines control target values for steering and drive actuators.
In the present embodiment, the driving mode includes a normal mode and a driving assist mode. The higher-level ECU 201 sets an automatic steering command value θAD,cmd for driving assist in the driving assist mode. In the present embodiment, the driving assist is lane keep assist (LKA) for the vehicle to avoid deviating from its lane. The automatic steering command value θAD,cmd is a target value of the steering angle for causing the vehicle to travel along a target travel line.
The automatic steering command value θAD,cmd is set based on, for example, the vehicle speed, the lateral deviation from the target travel line, and the yaw deviation of the vehicle from the target travel line. A process of setting such an automatic steering command value θAD,cmd is well known, and therefore will not be described in detail herein.
The higher-level ECU 201 outputs a mode signal Smode indicating whether the driving mode is the normal mode or the driving assist mode, a right/left discrimination signal SLR indicating whether the vehicle reference position is on the right or left side with respect to the center of the lane, and a vehicle lateral position Plat. The vehicle reference position is a predetermined reference position at the width center of the vehicle.
The vehicle lateral position Plat is a distance from a boundary of the lane where the vehicle is currently traveling (hereinafter referred to as “lane boundary”) to the vehicle reference position. Specifically, when the vehicle reference position is on the left side with respect to the center, the vehicle lateral position Plat is a distance from a left lane boundary to the vehicle reference position. When the vehicle reference position is on the right side with respect to the center of the lane, the vehicle lateral position Plat is a distance from a right lane boundary to the vehicle reference position.
The mode signal Smode, the right/left discrimination signal SLR, the vehicle lateral position Plat, and the automatic steering command value θAD,cmd are provided to a motor control ECU 202 via an in-vehicle network. The torsion bar torque Ttb detected by the torque sensor 12 and an output signal from the rotational angle sensor 23 are input to the motor control ECU 202. The motor control ECU 202 controls the electric motor 18 based on these input signals and information provided from the higher-level ECU 201.
Operation for a case where the driving mode is the driving assist mode will be mainly described below.
The motor control ECU 202 includes a microcomputer 40, a drive circuit (inverter circuit) 31 that is controlled by the microcomputer 40 and supplies electric power to the electric motor 18, and a current detection circuit 32 that detects a current (hereinafter referred to as “motor current Im”) that flows through the electric motor 18.
The microcomputer 40 includes a CPU and a memory (such as a ROM, a RAM, and a non-volatile memory), and functions as a plurality of functional processing units by executing a predetermined program. The plurality of functional processing units includes an assist torque command value setting unit 41, a manual steering command value generation unit 42, an integrated angle command value calculation unit 43, an angle control unit 44, a first weight multiplication unit 45, a second weight multiplication unit 46, an addition unit 47, a torque control unit (current control unit) 48, and a weight setting unit 49.
The first weight multiplication unit 45, the second weight multiplication unit 46, the addition unit 47, and the weight setting unit 49 are examples of the “switching unit” according to the present invention.
The assist torque command value setting unit 41 sets an assist torque command value Tasst that is a target value of the assist torque necessary for a manual operation. The assist torque command value setting unit 41 sets the assist torque command value Tasst based on the torsion bar torque Ttb detected by the torque sensor 12. An example of setting the assist torque command value Tasst with respect to the torsion bar torque Ttb is shown in
The assist torque command value Tasst is set to a positive value when the electric motor 18 should generate a steering assist force for steering to the left, and is set to a negative value when the electric motor 18 should generate a steering assist force for steering to the right. The assist torque command value Tasst is positive for a positive value of the torsion bar torque Ttb, and is negative for a negative value of the torsion bar torque Ttb. The assist torque command value Tasst is set so that its absolute value increases as the absolute value of the torsion bar torque Ttb increases.
The assist torque command value setting unit 41 may acquire the vehicle speed from the higher-level ECU 201, and set the assist torque command value Tasst based on the vehicle speed and the torsion bar torque Ttb. In this case, the assist torque command value Tasst is set according to the torsion bar torque Ttb as described above, and set so that the absolute value of the assist torque command value Tasst decreases as a vehicle speed V increases.
The assist torque command value setting unit 41 may calculate the assist torque command value Tasst by multiplying the torsion bar torque Ttb by a preset constant.
The manual steering command value generation unit 42 is provided to, when the driver operates the steering wheel 2, set the steering angle (more exactly, a rotational angle θ of the output shaft 9) that matches the steering wheel operation as a manual steering command value θMD,cmd. The manual steering command value generation unit 42 generates the manual steering command value θMD,cmd using the torsion bar torque Ttb detected by the torque sensor 12 and the assist torque command value Tasst set by the assist torque command value setting unit 41. The manual steering command value generation unit 42 will be described in detail later.
The integrated angle command value calculation unit 43 calculates an integrated angle command value θint,cmd by adding the manual steering command value θMD,cmd to the automatic steering command value θAD,cmd set by the higher-level ECU 201.
The angle control unit 44 calculates an integrated motor torque command value Tmint,cmd that matches the integrated angle command value θint,cmd based on the integrated angle command value θint,cmd. The angle control unit 44 will be described in detail later.
The first weight multiplication unit 45 multiplies the assist torque command value Tasst set by the assist torque command value setting unit 41 by a first weight W1. The second weight multiplication unit 46 multiplies the integrated motor torque command value Tmint,cmd by a second weight W2. The first weight W1 and the second weight W2 are set by the weight setting unit 49. The weight setting unit 49 will be described in detail later.
The addition unit 47 calculates a motor torque command value Tm,cmd for the electric motor 18 by adding an assist torque command value W1·Tasst after first weight multiplication (after a first weighting process) and an integrated motor torque command value W2·Tmint,cmd after second weight multiplication (after a second weighting process).
The torque control unit 48 drives a drive circuit 31 so that the motor torque of the electric motor 18 is brought closer to the motor torque command value Tm,cmd.
In the present embodiment, the manual steering command value generation unit 42 uses a reference EPS model to set the manual steering command value θMD,cmd.
This reference EPS model is a single inertia model including a lower column. The lower column corresponds to the output shaft 9 and the worm wheel 21. In
where kvl=kvl(Plat) and cvl=cvl(Plat).
As shown in expression (1) above, the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient ci are set in association with the vehicle lateral position Plat.
When the vehicle lateral position Plat is equal to or greater than a predetermined value PL_start with respect to the left lane boundary or equal to or greater than a predetermined value PR_start with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl is set to a predetermined value kvl,start. For example, PL_start is set to about 60 cm. For example, PR_start is set to about 70 cm.
When the vehicle lateral position Plat is equal to or greater than a predetermined value PL_small smaller than PL_start and is smaller than PL start with respect to the left lane boundary, the virtual load spring stiffness coefficient kvl is set according to a characteristic that it gradually increases from kvl,start to kvl,L_max as the vehicle lateral position Plat decreases from PL_start (as the vehicle reference position approaches the left lane boundary). For example, PL_small is set to about 40 cm.
When the vehicle lateral position Plat is equal to or greater than a predetermined value PR_small smaller than PR_start and is smaller than PR_start with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl is set according to a characteristic that it gradually increases from kvl,start to kvl,R_max as the vehicle lateral position Plat decreases from PR_start (as the vehicle reference position approaches the right lane boundary). For example, PR_small is set to about 50 cm.
When the vehicle lateral position Plat is smaller than PL_small with respect to the left lane boundary, the virtual load spring stiffness coefficient kvl is set to kvl,L_max. When the vehicle lateral position Plat is smaller than PR_small with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl is set to kvl,R_max. The virtual load spring stiffness coefficient kvl is limited in this way to prevent the virtual road load torque Trl from increasing excessively so that the driver cannot intervene in steering.
When the vehicle lateral position Plat is equal to or greater than the predetermined value PL_start with respect to the left lane boundary or equal to or greater than the predetermined value PR_start with respect to the right lane boundary, the virtual load viscous damping coefficient cvi is set to a predetermined value cvl,start.
When the vehicle lateral position Plat is equal to or greater than the predetermined value PL_small smaller than PL start and is smaller than PL start with respect to the left lane boundary, the virtual load viscous damping coefficient cvi is set according to a characteristic that it gradually increases from cvl,start to cvl,L_max as the vehicle lateral position Plat decreases from PL_start (as the vehicle reference position approaches the left lane boundary).
When the vehicle lateral position Plat is equal to or greater than the predetermined value PR_small smaller than PR_start and is smaller than PR_start with respect to the right lane boundary, the virtual load viscous damping coefficient cvi is set according to a characteristic that it gradually increases from cvl,start to cyl,R_max as the vehicle lateral position Plat decreases from PR_start (as the vehicle reference position approaches the right lane boundary).
When the vehicle lateral position Plat is smaller than PL_small with respect to the left lane boundary, the virtual load viscous damping coefficient cvi is set to cvl,L_max. When the vehicle lateral position Plat is smaller than PR_small with respect to the right lane boundary, the virtual load viscous damping coefficient cvl is set to cvl,R_max.
An equation of motion of the reference EPS model is given by expression (2) below.
The manual steering command value generation unit 42 calculates the manual steering command value θMD,cmd by solving the differential equation given by expression (2) by substituting the torsion bar torque Ttb detected by the torque sensor 12 into Ttb and substituting the assist torque command value Tasst set by the assist torque command value setting unit 41 into Tasst.
The virtual load spring stiffness coefficient kvl associated with the vehicle lateral position Plat is determined, for example, based on the vehicle lateral position Plat provided from the higher-level ECU 201 and a map that stores the virtual load spring stiffness coefficient kvl with respect to the vehicle lateral position Plat in
The virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl may be set so that the characteristic of the virtual road load torque Trl changes depending on information on the outside of the lane where the vehicle is currently traveling. For example, the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl may be set so that the characteristic of the virtual road load torque Trl changes depending on whether there is a lane adjacent to the lane, there is no lane adjacent to the lane, or there is a protective fence such as a guardrail for the lane. In this case, the information on the outside of the lane is provided from the higher-level ECU 201 to the motor control ECU 202.
The angle control unit 44 calculates the integrated motor torque command value Tmint,cmd based on the integrated angle command value θint,cmd. The angle control unit 44 includes a low-pass filter (LPF) 51, a feedback control unit 52, a feedforward control unit 53, a disturbance torque estimation unit 54, a torque addition unit 55, a disturbance torque compensation unit 56, a first speed reduction ratio division unit 57, a speed reduction ratio multiplication unit 58, a rotational angle calculation unit 59, and a second speed reduction ratio division unit 60.
The speed reduction ratio multiplication unit 58 converts the motor torque command value Tm,cmd calculated by the addition unit 47 (see
The rotational angle calculation unit 59 calculates a rotor rotational angle θm of the electric motor 18 based on an output signal from the rotational angle sensor 23. The second speed reduction ratio division unit 60 converts the rotor rotational angle θm calculated by the rotational angle calculation unit 59 into a rotational angle (actual steering angle) θ of the output shaft 9 by dividing the rotor rotational angle θm by the speed reduction ratio N.
The low-pass filter 51 performs a low-pass filtering process on the integrated angle command value θint,cmd. An integrated angle command value θintL,cmd after the low-pass filtering process is provided to the feedback control unit 52 and the feedforward control unit 53.
The feedback control unit 52 is provided to bring an estimated steering angle value {circumflex over ( )}θ calculated by the disturbance torque estimation unit 54 closer to the integrated angle command value θintL,cmd after the low-pass filtering process. The feedback control unit 52 includes an angle deviation calculation unit 52A and a PD control unit 52B. The angle deviation calculation unit 52A calculates a deviation Δθ (=θintL,cmd−{circumflex over ( )}θ) between the integrated angle command value θintL,cmd and the estimated steering angle value {circumflex over ( )}θ. The angle deviation calculation unit 52A may calculate, as the angle deviation Δθ, a deviation (BintL,cmd−θ) between the integrated angle command value θintL,cmd and the actual steering angle θ calculated by the second speed reduction ratio division unit 60.
The PD control unit 52B calculates feedback control torque Tfb by performing PD calculation (proportional-derivative calculation) for the angle deviation Δθ calculated by the angle deviation calculation unit 52A. The feedback control torque Tfb is provided to the torque addition unit 55.
The feedforward control unit 53 is provided to improve control response by compensating for a delay in response due to the inertia of the electric power steering system 1. The feedforward control unit 53 includes an angular acceleration calculation unit 53A and an inertia multiplication unit 53B. The angular acceleration calculation unit 53A calculates a target angular acceleration d2θintL,cmd/dt2 by obtaining the second derivative of the integrated angle command value θintL,cmd.
The inertia multiplication unit 53B calculates feedforward control torque Tff (=J·d2θintL,cmd/dt2) by multiplying the target angular acceleration d2θintL,cmd/dt2 calculated by the angular acceleration calculation unit 53A by an inertia J of the electric power steering system 1. The inertia J is obtained from, for example, a physical model (see
The torque addition unit 55 calculates a basic torque command value (Tfb+Tff) by adding the feedforward control torque Tff to the feedback control torque Tff.
The disturbance torque estimation unit 54 is provided to estimate non-linear torque (disturbance torque: torque other than the motor torque) that is generated as disturbance in a plant (object to be controlled by the electric motor 18). The disturbance torque estimation unit 54 estimates the disturbance torque (disturbance load) Tlc, the steering angle θ, and a steering angle differential value (angular velocity) dθ/dt based on the output shaft torque command value N·Tm,cmd and the actual steering angle θ. The estimated values of the disturbance torque Tlc, the steering angle θ, and the steering angle differential value (angular velocity) dθ/dt are represented by {circumflex over ( )}Tlc, {circumflex over ( )}θ, and d{circumflex over ( )}θ/dt, respectively. The disturbance torque estimation unit 54 will be described in detail later.
The estimated disturbance torque value {circumflex over ( )}Tlc calculated by the disturbance torque estimation unit 54 is provided to the disturbance torque compensation unit 56 as a disturbance torque compensation value. The estimated steering angle value {circumflex over ( )}θ calculated by the disturbance torque estimation unit 54 is provided to the angle deviation calculation unit 52A.
The disturbance torque compensation unit 56 calculates an integrated steering torque command value Tsint,cmd (=Tfb+Tff−{circumflex over ( )}Tlc) by subtracting the estimated disturbance torque value {circumflex over ( )}Tlc from the basic torque command value (Tfb+Tff). The integrated steering torque command value Tsint,cmd (torque command value for the output shaft 9) with the disturbance torque compensated for is thus obtained.
The integrated steering torque command value Tsint,cmd is provided to the first speed reduction ratio division unit 57. The first speed reduction ratio division unit 57 calculates the integrated motor torque command value Tmint,cmd by dividing the integrated steering torque command value Tsint,cmd by the speed reduction ratio N. The integrated motor torque command value Tmint,cmd is provided to the second weight multiplication unit 46 (see
The disturbance torque estimation unit 54 will be described in detail. The disturbance torque estimation unit 54 is a disturbance observer that estimates the disturbance torque Tlc, the steering angle θ, and the angular velocity dθ/dt using, for example, a physical model 101 of the electric power steering system 1 shown in
The physical model 101 includes a plant (example of an object to be driven by the motor) 102 that includes the output shaft 9 and the worm wheel 21 fixed to the output shaft 9. The torsion bar torque Ttb is applied from the steering wheel 2 to the plant 102 via the torsion bar 10, and the road load torque Trl is applied from the steered wheel 3 side to the plant 102.
Moreover, the output shaft torque command value N·Tm,cmd is applied to the plant 102 via the worm gear 20, and the friction torque Tf is applied to the plant 102 due to the friction between the worm wheel 21 and the worm gear 20.
An equation of motion for the inertia of the physical model 101 is given by expression (3) below, where J is the inertia of the plant 102.
d2θ/dt2 is the angular acceleration of the plant 102. N is the speed reduction ratio of the speed reducer 19. Tlc represents the disturbance torque other than the motor torque that is applied to the plant 102. While the disturbance torque Tlc is shown as the sum of the torsion bar torque Ttb, the road load torque Trl, and the friction torque Tf in the present embodiment, the disturbance torque Tlc actually includes torque other than these.
An equation of state for the physical model 101 in
In expression (4) above, x is a state variable vector, u1 is a known input vector, u2 is an unknown input vector, and y is an output vector (measured value). In expression (4) above, A is a system matrix, B1 is a first input matrix, B2 is a second input matrix, C is an output matrix, and D is a direct feedthrough matrix.
The above equation of state is extended to a system including the unknown input vector u2 as one of the states. An equation of state of the extended system (extended equation of state) is given by expression (5) below.
In expression (5) above, xe is a state variable vector of the extended system, and is given by expression (6) below.
In expression (5) above, Ae is a system matrix of the extended system, Be is a known input matrix of the extended system, and Ce is an output matrix of the extended system.
A disturbance observer (extended state observer) given by the equation of expression (7) below is constructed from the extended equation of state given by expression (5) above.
In expression (7), {circumflex over ( )}xe represents an estimated value of xe. L is an observer gain. {circumflex over ( )}y represents an estimated value of y. {circumflex over ( )}xe is given by expression (8) below.
In expression (8), {circumflex over ( )}θ is an estimated value of 0, and {circumflex over ( )}Tlc is an estimated value of Tic.
The disturbance torque estimation unit 54 calculates the state variable vector {circumflex over ( )}xe based on the equation of expression (7) above.
The disturbance torque estimation unit 54 includes an input vector input unit 71, an output matrix multiplication unit 72, a first addition unit 73, a gain multiplication unit 74, an input matrix multiplication unit 75, a system matrix multiplication unit 76, a second addition unit 77, an integration unit 78, and a state variable vector output unit 79.
The output shaft torque command value N·Tm,cmd calculated by the speed reduction ratio multiplication unit 58 (see
The output of the integration unit 78 is the state variable vector {circumflex over ( )}xe (see expression (8) above). At the start of the calculation, an initial value is given as the state variable vector {circumflex over ( )}xe. The initial value of the state variable vector {circumflex over ( )}xe is, for example, 0.
The system matrix multiplication unit 76 multiplies the state variable vector {circumflex over ( )}xe by the system matrix Ae. The output matrix multiplication unit 72 multiplies the state variable vector {circumflex over ( )}xe by the output matrix Ce.
The first addition unit 73 subtracts the output (Ce{circumflex over ( )}xe) of the output matrix multiplication unit 72 from the output vector (measured value) y that is the actual steering angle θ calculated by the second speed reduction ratio division unit 60 (see
The input matrix multiplication unit 75 multiplies the input vector u1 output from the input vector input unit 71 by the input matrix Be. The second addition unit 77 calculates a differential value d{circumflex over ( )}xe/dt of the state variable vector by adding the output (Be·u1) of the input matrix multiplication unit 75, the output (Ae{circumflex over ( )}xe) of the system matrix multiplication unit 76, and the output (L(y−{circumflex over ( )}y)) of the gain multiplication unit 74. The integration unit 78 calculates the state variable vector {circumflex over ( )}xe by integrating the output (d{circumflex over ( )}xe/dt) of the second addition unit 77. The state variable vector output unit 79 calculates the estimated disturbance torque value {circumflex over ( )}Tlc, the estimated steering angle value {circumflex over ( )}θ, and the estimated angular velocity value d{circumflex over ( )}/dt based on the state variable vector {circumflex over ( )}xe.
Unlike the extended state observer described above, a typical disturbance observer is composed of an inverse model of the plant and a low-pass filter. An equation of motion of the plant is given by expression (3) as described above. Thus, the inverse model of the plant is given by expression (9) below.
The inputs to the typical disturbance observer are J·d2θ/dt2 and N·Tm,cmd. Since the second derivative of the actual steering angle θ is used, noise of the rotational angle sensor 23 has a great influence. On the other hand, the extended state observer according to the embodiment described above estimates the disturbance torque using an integral type. Therefore, the influence of noise due to differentiation can be reduced.
The typical disturbance observer composed of the inverse model of the plant and the low-pass filter may be used as the disturbance torque estimation unit 54.
The torque control unit 48 (see
The motor current command value calculation unit 81 calculates a motor current command value Im,cmd by dividing the motor torque command value Tm,cmd calculated by the addition unit 47 (see
The current deviation calculation unit 82 calculates a deviation ΔI (=Im,cmd−Im) between the motor current command value Im,cmd obtained by the motor current command value calculation unit 81 and the motor current Im detected by the current detection circuit 32.
The PI control unit 83 generates a drive command value for controlling the motor current Im flowing through the electric motor 18 to the motor current command value Im,cmd by performing PI calculation (proportional-integral calculation) for the current deviation ΔI calculated by the current deviation calculation unit 82. The PWM control unit 84 generates a PWM control signal with a duty ratio corresponding to the drive command value, and supplies the PWM control signal to the drive circuit 31. Electric power corresponding to the drive command value is thus supplied to the electric motor 18.
When the driving mode is the driving assist mode, the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S1). The control mode of the electric motor 18 thus becomes a first control mode in which the drive of the electric motor 18 is controlled only by the assist torque command value Tasst.
When the driving mode is the driving assist mode, the automatic steering command value θAD,cmd is set by the higher-level ECU 201, and the automatic steering command value θAD,cmd, the mode signal Smode, the right/left discrimination signal SLR, and the vehicle lateral position Plat are provided to the motor control ECU 202.
Next, the weight setting unit 49 determines whether the vehicle reference position is on the left side of the center of the lane based on the right/left discrimination signal SLR (step S2).
When the vehicle reference position is on the left side of the center of the lane (step S2: YES), the weight setting unit 49 determines whether the vehicle lateral position Plat is smaller than PL_start (see
When Plat≥PL_start (step S3: NO), the weight setting unit 49 returns to step S2.
When determination is made in step S3 that Plat<PL_start (step S3: YES), the weight setting unit 49 sets the first weight W1 to 0, and sets the second weight W2 to 1 (step S4). At this time, it is preferable that the weight setting unit 49 gradually reduce the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1. The time for gradually reducing the first weight W1 from 1 to 0 (time for gradually increasing the second weight W2 from 0 to 1) may be, for example, about 0.1 seconds.
The control mode of the electric motor 18 thus becomes a second control mode in which the drive of the electric motor 18 is controlled by the integrated motor torque command value Tmint,cmd. While the first weight W1 is being gradually reduced (while the second weight W2 is being gradually increased), the electric motor 18 is controlled based on the sum of the assist torque command value W1·Tasst after the first weight multiplication and the integrated motor torque command value W2·Tmint,cmd after the second weight multiplication.
In the second control mode, the electric motor 18 is controlled based on the integrated angle command value θint,cmd that is the sum of the manual steering command value θMD,cmd and the automatic steering command value θAD,cmd. A steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is thus reflected.
Next, the weight setting unit 49 determines whether the vehicle lateral position Plat is smaller than a predetermined value PL_return (see
When Plat≤PL_return (step S5: NO), the weight setting unit 49 returns to step S5.
When determination is made in step S5 that Plat>PL_return (step S5: YES), the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S6). At this time, it is preferable that the weight setting unit 49 gradually increase the first weight W1 from 0 to 1 and gradually reduce the second weight W2 from 1 to 0. The time for gradually increasing the first weight W1 from 0 to 1 (time for gradually reducing the second weight W2 from 1 to 0) may be, for example, about 0.1 seconds.
The control mode of the electric motor 18 thus becomes the first control mode. While the first weight W1 is being gradually increased (while the second weight W2 is being gradually reduced), the electric motor 18 is controlled based on the sum of the assist torque command value W1·Tasst after the first weight multiplication and the integrated motor torque command value W2·Tmint,cmd after the second weight multiplication.
In the first control mode, the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is not reflected.
After the process of step S6 is performed, the weight setting unit 49 returns to step S2.
When determination is made in step S2 that the vehicle reference position is on the right side of the center of the lane (step S2: NO), the weight setting unit 49 determines whether the vehicle lateral position Plat is smaller than PR_start (see
When Plat≥PR_start (step S7: NO), the weight setting unit 49 returns to step S2.
When determination is made in step S7 that Plat<PR_start (step S7: YES), the weight setting unit 49 sets the first weight W1 to 0, and sets the second weight W2 to 1 (step S8). At this time, it is preferable that the weight setting unit 49 gradually reduce the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1.
The control mode of the electric motor 18 thus becomes the second control mode. In the second control mode, the steering reaction force based on the virtual road load torque Trl is reflected.
Next, the weight setting unit 49 determines whether the vehicle lateral position Plat is smaller than a predetermined value PR_return (see
When Plat PR_return (step S9: NO), the weight setting unit 49 returns to step S9.
When determination is made in step S9 that Plat>PR_return (step S9: YES), the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S10). At this time, it is preferable that the weight setting unit 49 gradually increase the first weight W1 from 0 to 1 and gradually reduce the second weight W2 from 1 to 0.
The control mode of the electric motor 18 thus becomes the first control mode. In the first control mode, the steering reaction force based on the virtual road load torque Trl is not reflected.
After the process of step S10 is performed, the weight setting unit 49 returns to step S2.
When the driving mode is the normal mode, the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0. Thus, in the normal mode, the drive of the electric motor 18 is controlled based only on the assist torque command value Tasst.
When the vehicle lateral position Plat is equal to or greater than PL_start with respect to the left lane boundary or equal to or greater than PR_start with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl is kvl,start and the virtual load viscous damping coefficient cvl is cvl,start. Therefore, the absolute value |Trl| of the virtual road load torque is a constant value.
When the vehicle lateral position Plat is equal to or greater than PL_small and smaller than PL_start with respect to the left lane boundary, the absolute value |Trl| of the virtual road load torque increases as the vehicle lateral position Plat decreases from PL_start (as the vehicle reference position approaches the left lane boundary). In the example of
When the vehicle lateral position Plat is smaller than PL_small, the absolute value |Trl| of the virtual road load torque is fixed to an absolute value |Trl| of the virtual road load torque when the vehicle lateral position Plat is PL_small.
When the vehicle lateral position Plat is equal to or greater than PR_small and smaller than PR_start with respect to the right lane boundary, the absolute value |Trl| of the virtual road load torque increases as the vehicle lateral position Plat decreases from PR_start (as the vehicle reference position approaches the right lane boundary). In the example of
When the vehicle lateral position Plat is smaller than PR_small, the absolute value |Trl| of the virtual road load torque Trl is fixed to an absolute value |Trl| of the virtual road load torque when the vehicle lateral position Plat is PR_small.
In the example of
At time to, the control mode is the first mode and the vehicle reference position is at the center of the lane. Since the control mode is the first control mode, W1=1 and W2=0, and the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is 0.
The driver steers to the right immediately after time t0. The vehicle therefore starts to move to the right. When the vehicle lateral position Plat reaches PR_start at time t1, W1 is gradually reduced and W2 is gradually increased. At time t2, W1=0 and W2=1. That is, the control mode becomes the second control mode.
From time t0 to time t1, the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is 0. From time t1 to t2, the steering reaction force gradually increases because part of the steering reaction force based on the virtual road load torque Ti is reflected. Since the control mode becomes the second control mode from time t2, the steering reaction force based on the virtual road load torque Trl further increases.
When the vehicle reference position reaches the right lane boundary (time t3), the steering reaction force reaches the maximum reaction force value. When the driver feels the steering reaction force and stops steering to the right, the vehicle moves toward the center of the lane. When the vehicle reference position is shifted toward the center of the lane from the right lane boundary (time t4), the steering reaction force based on the virtual road load torque Trl decreases. When the vehicle lateral position Plat reaches PR_start (time t5), the steering reaction force based on the virtual road load torque Trl reaches a constant value.
When the vehicle lateral position Plat then reaches PR_return (time t6), W1 is gradually increased and W2 is gradually reduced. At time t7, W1=1 and W2=0. That is, the control mode becomes the first control mode. As can be seen from
In
From time t6 to t7, the steering reaction force gradually decreases because part of the steering reaction force based on the virtual road load torque Trl is reflected. Since the control mode becomes the first control mode from time t7, the steering reaction force based on the virtual road load torque Trl is 0.
In the embodiment described above, the manual steering command value generation unit 42 can set the steering reaction force independently of the assist control and the steering angle control for driving assist.
In the embodiment described above, the driver can feel the reaction force corresponding to the lateral position of the vehicle as the steering torque, thereby improving the effect of preventing lane departure.
In the embodiment described above, the first vehicle lateral position for switching the first weight W1 from 1 to 0 (the second weight W2 from 0 to 1) is set different from the second vehicle lateral position for switching the first weight W1 from 0 to 1 (the second weight W2 from 1 to 0). Specifically, the second vehicle lateral position is set closer to the center of the lane than the first vehicle lateral position. It is thus possible to simultaneously achieve both the generation of the reaction force for the driver when the vehicle moves in the lane departure direction and the stabilization of the vehicle behavior when the vehicle returns to the center of the lane.
In other words, if the second vehicle lateral position is set to the same position as the first vehicle lateral position, the control mode is switched from the second control mode to the first control mode while a large steering reaction force is acting. The vehicle behavior may therefore become unstable.
In the embodiment described above, the driver can intuitively recognize, via the steering wheel, the danger level depending on the environment outside the current traveling lane (the presence or absence of an adjacent lane, the presence or absence of a guardrail, etc.).
Modifications of the procedure of the weight setting process performed by the weight setting unit 49 in the driving assist mode (modifications of the weight setting unit 49) will be described below.
In a first modification, the first vehicle lateral position for switching the first weight W1 from 1 to 0 (the second weight W2 from 0 to 1) is set to the same position as the second vehicle lateral position for switching the first weight W1 from 0 to 1 (the second weight W2 from 1 to 0).
It is assumed that PL_return is set as the first vehicle position and the second vehicle position when the vehicle is on the left side of the center of the lane and PR_return is set as the first vehicle position and the second vehicle position when the vehicle is on the right side of the center of the lane.
In this case, the procedure of the weight setting process performed by the weight setting unit 49 in the driving assist mode is substantially the same as the procedure shown in
At time to, the control mode is the first mode and the vehicle reference position is at the center of the lane. Since the control mode is the first control mode, W1=1 and W2=0, and the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is 0.
The driver steers to the right immediately after time t0. The vehicle therefore starts to move to the right. When the vehicle lateral position Plat crosses PR_return toward the right lane boundary at time t1, W1 is gradually reduced and W2 is gradually increased. At time t2, W1=0 and W2=1. That is, the control mode becomes the second control mode.
From time t0 to time t1, the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is 0. From time t1 to t2, the steering reaction force gradually increases because part of the steering reaction force based on the virtual road load torque Trl is reflected. Since the control mode becomes the second control mode from time t2, the steering reaction force based on the virtual road load torque Trl further increases.
When the vehicle reference position reaches the right lane boundary (time t3), the steering reaction force reaches the maximum reaction force value. When the driver feels the steering reaction force and stops steering to the right, the vehicle moves toward the center of the lane. When the vehicle reference position is shifted toward the center of the lane from the right lane boundary (time t4), the steering reaction force based on the virtual road load torque Trl decreases. When the vehicle lateral position Plat reaches PR_start (time t5), the steering reaction force based on the virtual road load torque Trl reaches a constant value.
When the vehicle lateral position Plat then crosses PR_return toward the center of the lane at time t6, W1 is gradually increased and W2 is gradually reduced. At time t7, W1=1 and W2=0. That is, the control mode becomes the first control mode. As can be seen from
In
From time t6 to t7, the steering reaction force gradually decreases because part of the steering reaction force based on the virtual road load torque Trl is reflected. Since the control mode becomes the first control mode from time t7, the steering reaction force based on the virtual road load torque Trl is 0.
The motor control ECU 202 in
For example, the hands-on/off determination unit 50 may estimate driver torque that is torque applied to the steering wheel 2 by the driver based on the torsion bar torque Ttb and the actual steering angle θ or the rotor rotational angle θm, determine that the driver is in the gripping state when the driver torque is equal to or greater than a predetermined threshold value, and determine that the driver is in the released state when the driver torque continues to be smaller than the threshold value for a predetermined time or longer. In this case, determination is made that the driver is in the gripping state until determination is made that the driver is in the released state after the driver torque has changed from a value equal to or greater than the threshold value to a value smaller than the threshold value. Examples of such a hands-on/off determination unit 50 may include “steering wheel operation state determination units” described in Japanese Unexamined Patent Application Publication Nos. 2017-114324 (JP 2017-114324 A), 2018-165156 (JP 2018-165156 A), 2020-142703 (JP 2020-142703 A), 2020-59361 (JP 2020-59361 A), and 2020-59362 (JP 2020-59362 A).
For example, the hands-on/off determination unit 50 may determine that the driver is in the gripping state when the torsion bar torque Ttb is equal to or greater than a predetermined threshold value, and determine that the driver is in the released state when the torsion bar torque Ttb continues to be smaller than the threshold value for a predetermined time or longer. In this case, determination is made that the driver is in the gripping state until determination is made that the driver is in the released state after the torsion bar torque Ttb has changed from a value equal to or greater than the threshold value to a value smaller than the threshold value.
When the driving mode is the driving assist mode, the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S11). The control mode of the electric motor 18 thus becomes the first control mode in which the drive of the electric motor 18 is controlled only by the assist torque command value Tasst.
When the driving mode is the driving assist mode, the automatic steering command value θAD,cmd is set by the higher-level ECU 201, and the automatic steering command value θAD,cmd, the mode signal Smode, the right/left discrimination signal SLR, and the vehicle lateral position Plat are provided to the motor control ECU 202.
Next, the weight setting unit 49 determines whether the vehicle reference position is on the left side of the center of the lane based on the right/left discrimination signal SLR (step S12).
When the vehicle reference position is on the left side of the center of the lane (step S12: YES), the weight setting unit 49 determines whether the vehicle lateral position Plat is smaller than PL_start (see
When Plat≥PL_start (step S13: NO), the weight setting unit 49 returns to step S12.
When determination is made in step S13 that Plat<PL_start (step S13: YES), the weight setting unit 49 sets the first weight W1 to 0, and sets the second weight W2 to 1 (step S14). At this time, it is preferable that the weight setting unit 49 gradually reduce the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1. The time for gradually reducing the first weight W1 from 1 to 0 (time for gradually increasing the second weight W2 from 0 to 1) may be, for example, about 0.1 seconds.
The control mode of the electric motor 18 thus becomes the second control mode in which the drive of the electric motor 18 is controlled by the integrated motor torque command value Tmint,cmd. While the first weight W1 is being gradually reduced (while the second weight W2 is being gradually increased), the electric motor 18 is controlled based on the sum of the assist torque command value W1·Tasst after the first weight multiplication and the integrated motor torque command value W2·Tmint,cmd after the second weight multiplication.
In the second control mode, the electric motor 18 is controlled based on the integrated angle command value θint,cmd that is the sum of the manual steering command value θMD,cmd and the automatic steering command value θAD,cmd. The steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is thus reflected.
Next, the weight setting unit 49 determines whether either a first condition that the vehicle lateral position Plat is greater than the predetermined value PL_return (see
When neither the first condition nor the second condition is satisfied (step S15: NO), the weight setting unit 49 returns to step S15.
When determination is made in step S15 that either the first condition or the second condition is satisfied (step S15: YES), the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S16). At this time, it is preferable that the weight setting unit 49 gradually increase the first weight W1 from 0 to 1 and gradually reduce the second weight W2 from 1 to 0. The time for gradually increasing the first weight W1 from 0 to 1 (time for gradually reducing the second weight W2 from 1 to 0) may be, for example, about 0.1 seconds.
The control mode of the electric motor 18 thus becomes the first control mode. While the first weight W1 is being gradually increased (while the second weight W2 is being gradually reduced), the electric motor 18 is controlled based on the sum of the assist torque command value W1·Tasst after the first weight multiplication and the integrated motor torque command value W2·Tmint,cmd after the second weight multiplication.
In the first control mode, the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is not reflected.
After the process of step S16 is performed, the weight setting unit 49 returns to step S12.
When determination is made in step S12 that the vehicle reference position is on the right side of the center of the lane (step S12: NO), the weight setting unit 49 determines whether the vehicle lateral position Plat is smaller than PR_start (see
When Plat≥PR_start (step S17: NO), the weight setting unit 49 returns to step S12.
When determination is made in step S17 that Plat<PR_start (step S17: YES), the weight setting unit 49 sets the first weight W1 to 0, and sets the second weight W2 to 1 (step S18). At this time, it is preferable that the weight setting unit 49 gradually reduce the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1.
The control mode of the electric motor 18 thus becomes the second control mode. In the second control mode, the steering reaction force based on the virtual road load torque Trl is reflected.
Next, the weight setting unit 49 determines whether either a third condition that the vehicle lateral position Plat is greater than the predetermined value PR_return (see
When neither the third condition nor the fourth condition is satisfied (step S19: NO), the weight setting unit 49 returns to step S19.
When determination is made in step S19 that either the third condition or the fourth condition is satisfied (step S19: YES), the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S20). At this time, it is preferable that the weight setting unit 49 gradually increase the first weight W1 from 0 to 1 and gradually reduce the second weight W2 from 1 to 0.
The control mode of the electric motor 18 thus becomes the first control mode. In the first control mode, the steering reaction force based on the virtual road load torque Trl is not reflected.
After the process of step S20 is performed, the weight setting unit 49 returns to step S12.
The operation from time t0 to time t5 in
When the hands-on/off result indicates the gripping state (time t8) before the vehicle lateral position Plat crosses PR_return toward the center of the lane, the fourth condition in step S19 of
That is, when the gripping state is determined with the vehicle lateral position Plat shifted toward the center of the lane across PR_start, determination is made that the driver is steering the vehicle to return to the center of the lane. The second control mode is switched to the first control mode even if the vehicle lateral position Plat has not crossed PR_return toward the center of the lane.
From time t8 to t9, the steering reaction force gradually decreases because part of the steering reaction force based on the virtual road load torque Trl is reflected. Since the control mode becomes the first control mode from time t9, the steering reaction force based on the virtual road load torque Trl is 0.
A modification of the manual steering command value generation unit 42 will be described below.
In the embodiment described above, the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient ci are set in association with the vehicle lateral position Plat.
In the modification of the manual steering command value generation unit 42, the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are set in association with the vehicle lateral position Plat and a heading angle θvh. As shown in
The heading angle θvh is provided from the higher-level ECU 201 to the manual steering command value generation unit 42 in the motor control ECU 202 as indicated by the long dashed double-short dashed line in
In the modification of the manual steering command value generation unit 42, when the rotational angle of the lower column in
T
rl
=−k
vl·θMD,cmd−cvl(dθMD,cmd/dt) (10)
where kvl=kvl(Plat, θvh) and cvl=cvl(Plat, θvh).
As shown in expression (10) above, the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are set in association with the vehicle lateral position Plat and the heading angle θvh.
The affix L of each symbol in
PL_return, PL_start, PR_return, and PR_start in
When the vehicle lateral position Plat is equal to or greater than a predetermined value PL1 closer to the center of the lane than PL_return with respect to the left lane boundary or equal to or greater than a predetermined value PR1 closer to the center of the lane than PR_return with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl is set to 0. For example, PL1 and PR1 are set to about 110 cm.
When the vehicle lateral position Plat is on the left side of the center of the lane and the vehicle lateral position Plat is equal to or greater than 0 and smaller than PL1, the virtual load spring stiffness coefficient kvl is set according to a characteristic that it gradually increases as the vehicle lateral position Plat decreases from PL1 (as the vehicle reference position approaches the left lane boundary) depending on the vehicle lateral position Plat and the heading angle θvh. In
The virtual load spring stiffness coefficient kvl in this section increases as the heading angle θvh increases when the heading angle θvh is positive (when the traveling direction of the vehicle is a direction toward the left lane boundary). On the other hand, the virtual load spring stiffness coefficient kvl decreases as the absolute value of the heading angle θvh increases when the heading angle θvh is negative (when the traveling direction of the vehicle is a direction toward the center of the lane).
When the vehicle lateral position Plat is on the right side of the center of the lane and the vehicle lateral position Plat is equal to or greater than 0 and smaller than PR1, the virtual load spring stiffness coefficient kvl is set according to a characteristic that it gradually increases as the vehicle lateral position Plat decreases from PR1 (as the vehicle reference position approaches the right lane boundary) depending on the vehicle lateral position Plat and the heading angle θvh. In
The virtual load spring stiffness coefficient kvl in this section increases as the heading angle θvh increases when the heading angle θvh is positive (when the traveling direction of the vehicle is a direction toward the right lane boundary). On the other hand, the virtual load spring stiffness coefficient kvl decreases as the absolute value of the heading angle θvh increases when the heading angle θvh is negative (when the traveling direction of the vehicle is a direction toward the left lane boundary).
An example of a method for setting the virtual load spring stiffness coefficient characteristics as shown in
First, the characteristic of the virtual load spring stiffness coefficient kvl with respect to the vehicle lateral position Plat when the heading angle θvh is 0 [deg] (hereinafter referred to as “basic characteristic of spring stiffness coefficient kvl”) is set. An example of the basic characteristic of the spring stiffness coefficient kvl is shown in
Next, a weight for the heading angle θvh (heading weight) is set. An example of a weighting characteristic with respect to the heading angle θvh is shown in
Based on the basic characteristic of the spring stiffness coefficient kvl in
The characteristics of the virtual load viscous damping coefficient cvl with respect to the vehicle lateral position Plat are similar to the characteristics of the virtual load spring stiffness coefficient kvl with respect to the vehicle lateral position Plat. The characteristics of the virtual load viscous damping coefficient cvl with respect to the vehicle lateral position Plat are set by a method similar to the method for setting the characteristics of the virtual load spring stiffness coefficient kvl with respect to the vehicle lateral position Plat as described above.
The manual steering command value generation unit 42 calculates the manual steering command value θMD,cmd using the equation given by expression (2) above as in the embodiment described above. However, the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl associated with the vehicle lateral position Plat and the heading angle θvh as shown in expression (10) are used as the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl.
The virtual load spring stiffness coefficient kvl associated with the vehicle lateral position Plat and the heading angle θvh is determined, for example, based on the vehicle lateral position Plat provided from the higher-level ECU 201 and a map that stores the virtual load spring stiffness coefficient kvl with respect to the vehicle lateral position Plat for each of the plurality of heading angles θvh (see the graph of
When the vehicle lateral position Plat is equal to or greater than PL1 with respect to the left lane boundary or equal to or greater than PR1 with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are 0. Therefore, the absolute value |Trl| of the virtual road load torque is 0.
When the vehicle lateral position Plat is on the left side of the center of the lane and the vehicle lateral position Plat is equal to or greater than 0 and smaller than PL1, the absolute value |Trl| of the virtual road load torque increases as the vehicle lateral position Plat decreases from PL1 (as the vehicle reference position approaches the left lane boundary). In the example of
When the vehicle lateral position Plat is on the right side of the center of the lane and the vehicle lateral position Plat is equal to or greater than 0 and smaller than PR1, the absolute value |Trl| of the virtual road load torque increases as the vehicle lateral position Plat decreases from PR1 (as the vehicle reference position approaches the right lane boundary). In the example of
Next, description will be given of the operation of the weight setting unit 49 when the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are set in association with the vehicle lateral position Plat and the heading angle θvh.
When PL_return is set between PL1 and PL_start and PR_return is set between PR1 and PR_start as shown in
When the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl are set in association with the vehicle lateral position Plat and the heading angle θvh, the weight setting unit 49 can perform the weight setting process by another procedure described below. For convenience of the following description, the positions corresponding to PL_return and PL_start in
In a third modification, when the vehicle is on the left side of the center of the lane, the first vehicle lateral position for switching the first weight W1 from 1 to 0 (the second weight W2 from 0 to 1) is set within a range greater than PL2 (position corresponding to PL_return in
When the vehicle is on the right side of the center of the lane, the first vehicle lateral position for switching the first weight W1 from 1 to 0 (the second weight W2 from 0 to 1) is set within a range greater than PR2 (position corresponding to PR_return in
When the driving mode is the driving assist mode, the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S21). The control mode of the electric motor 18 thus becomes the first control mode in which the drive of the electric motor 18 is controlled only by the assist torque command value Tasst.
When the driving mode is the driving assist mode, the automatic steering command value θAD,cmd is set by the higher-level ECU 201, and the automatic steering command value θAD,cmd, the mode signal Smode, the right/left discrimination signal SLR, and the vehicle lateral position Plat are provided to the motor control ECU 202.
Next, the weight setting unit 49 determines whether the vehicle reference position is on the left side of the center of the lane based on the right/left discrimination signal SLR (step S22).
When the vehicle reference position is on the left side of the center of the lane (step S22: YES), the weight setting unit 49 determines whether a fifth condition that the vehicle lateral position Plat is smaller than PL1 (see
When the fifth condition is not satisfied (step S23: NO), the weight setting unit 49 returns to step S22.
When determination is made in step S23 that the fifth condition is satisfied (step S23: YES), the weight setting unit 49 sets the first weight W1 to 0, and sets the second weight W2 to 1 (step S24). At this time, it is preferable that the weight setting unit 49 gradually reduce the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1. The time for gradually reducing the first weight W1 from 1 to 0 (time for gradually increasing the second weight W2 from 0 to 1) may be, for example, about 0.1 seconds.
The control mode of the electric motor 18 thus becomes the second control mode in which the drive of the electric motor 18 is controlled by the integrated motor torque command value Tmint,cmd. While the first weight W1 is being gradually reduced (while the second weight W2 is being gradually increased), the electric motor 18 is controlled based on the sum of the assist torque command value W1·Tasst after the first weight multiplication and the integrated motor torque command value W2·Tmint,cmd after the second weight multiplication.
In the second control mode, the electric motor 18 is controlled based on the integrated angle command value θint,cmd that is the sum of the manual steering command value θMD,cmd and the automatic steering command value θAD,cmd. The steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is thus reflected.
Next, the weight setting unit 49 determines whether a sixth condition that the vehicle lateral position Plat is greater than PL2 (see
When the sixth condition is not satisfied (step S25: NO), the weight setting unit 49 returns to step S25.
When determination is made in step S25 that the sixth condition is satisfied (step S25: YES), the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S26). At this time, it is preferable that the weight setting unit 49 gradually increase the first weight W1 from 0 to 1 and gradually reduce the second weight W2 from 1 to 0. The time for gradually increasing the first weight W1 from 0 to 1 (time for gradually reducing the second weight W2 from 1 to 0) may be, for example, about 0.1 seconds.
The control mode of the electric motor 18 thus becomes the first control mode. While the first weight W1 is being gradually increased (while the second weight W2 is being gradually reduced), the electric motor 18 is controlled based on the sum of the assist torque command value W1·Tasst after the first weight multiplication and the integrated motor torque command value W2·Tmint,cmd after the second weight multiplication.
In the first control mode, the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is not reflected.
After the process of step S26 is performed, the weight setting unit 49 returns to step S22.
When determination is made in step S22 that the vehicle reference position is on the right side of the center of the lane (step S22: NO), the weight setting unit 49 determines whether a seventh condition that the vehicle lateral position Plat is smaller than PR1 (see
When the seventh condition is not satisfied (step S27: NO), the weight setting unit 49 returns to step S22.
When determination is made in step S27 that the seventh condition is satisfied (step S27: YES), the weight setting unit 49 sets the first weight W1 to 0, and sets the second weight W2 to 1 (step S28). At this time, it is preferable that the weight setting unit 49 gradually reduce the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1.
The control mode of the electric motor 18 thus becomes the second control mode. In the second control mode, the steering reaction force based on the virtual road load torque Trl is reflected.
Next, the weight setting unit 49 determines whether an eighth condition that the vehicle lateral position Plat is greater than PR2 (see
When the eighth condition is not satisfied (step S29: NO), the weight setting unit 49 returns to step S29.
When determination is made in step S29 that the eighth condition is satisfied (step S29: YES), the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S30). At this time, it is preferable that the weight setting unit 49 gradually increase the first weight W1 from 0 to 1 and gradually reduce the second weight W2 from 1 to 0.
The control mode of the electric motor 18 thus becomes the first control mode. In the first control mode, the steering reaction force based on the virtual road load torque Trl is not reflected.
After the process of step S30 is performed, the weight setting unit 49 returns to step 522.
At time to, the control mode is the first mode and the vehicle reference position is at the center of the lane. Since the control mode is the first control mode, W1=1 and W2=0, and the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is 0.
The driver steers to the right immediately after time t0. The vehicle 25 therefore starts to move to the right. Assuming that θvh>0 when the vehicle lateral position Plat crosses PR1 toward the right lane boundary at time t1, the seventh condition in step S27 of
From time t0 to time t1, the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is 0. From time t1 to t2, the steering reaction force gradually increases because part of the steering reaction force based on the virtual road load torque Trl is reflected. Since the control mode becomes the second control mode from time t2, the steering reaction force based on the virtual road load torque Trl further increases.
When the vehicle reference position reaches the right lane boundary (time t3), the steering reaction force reaches the maximum reaction force value. When the driver feels the steering reaction force and stops steering to the right, the vehicle moves toward the center of the lane. When the vehicle reference position is shifted toward the center of 10 the lane from the right lane boundary (time t4), the steering reaction force based on the virtual road load torque Trl decreases. Assuming that θvh<0 when the vehicle lateral position Plat crosses PR2 toward the center of the lane at time t5, the eighth condition in step S29 of
From time t5 to t6, the steering reaction force gradually decreases because part of the steering reaction force based on the virtual road load torque Trl is reflected. Since the control mode becomes the first control mode from time t6, the steering reaction force based on the virtual road load torque Trl is 0.
In the third modification, the following effects can be obtained compared to the embodiment described above with reference to
In a fourth modification, when the vehicle is on the left side of the center of the lane, the first vehicle lateral position for switching the first weight W1 from 1 to 0 (the second weight W2 from 0 to 1) is set to PL3 (position corresponding to PL_start in
When the vehicle is on the right side of the center of the lane, the first vehicle lateral position for switching the first weight W1 from 1 to 0 (the second weight W2 from 0 to 1) is set to PR3 (position corresponding to PR_start in
When the driving mode is the driving assist mode, the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S31). The control mode of the electric motor 18 thus becomes the first control mode in which the drive of the electric motor 18 is controlled only by the assist torque command value Tasst.
When the driving mode is the driving assist mode, the automatic steering command value θAD,cmd is set by the higher-level ECU 201, and the automatic steering command value θAD,cmd, the mode signal Smode, the right/left discrimination signal SLR, and the vehicle lateral position Plat are provided to the motor control ECU 202.
Next, the weight setting unit 49 determines whether the vehicle reference position is on the left side of the center of the lane based on the right/left discrimination signal SLR (step S32).
When the vehicle reference position is on the left side of the center of the lane (step S32: YES), the weight setting unit 49 determines whether a ninth condition that the vehicle lateral position Plat is smaller than PL3 (see
When the ninth condition is not satisfied (step S33: NO), the weight setting unit 49 returns to step S32.
When determination is made in step S33 that the ninth condition is satisfied (step S33: YES), the weight setting unit 49 sets the first weight W1 to 0, and sets the second weight W2 to 1 (step S34). At this time, it is preferable that the weight setting unit 49 gradually reduce the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1. The time for gradually reducing the first weight W1 from 1 to 0 (time for gradually increasing the second weight W2 from 0 to 1) may be, for example, about 0.1 seconds.
The control mode of the electric motor 18 thus becomes the second control mode in which the drive of the electric motor 18 is controlled by the integrated motor torque command value Tmint,cmd. While the first weight W1 is being gradually reduced (while the second weight W2 is being gradually increased), the electric motor 18 is controlled based on the sum of the assist torque command value W1·Tasst after the first weight multiplication and the integrated motor torque command value W2·Tmint,cmd after the second weight multiplication.
In the second control mode, the electric motor 18 is controlled based on the integrated angle command value θint,cmd that is the sum of the manual steering command value θMD,cmd and the automatic steering command value θAD,cmd. The steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is thus reflected.
Next, the weight setting unit 49 determines whether a tenth condition that the vehicle lateral position Plat is greater than PL4 (see
When the tenth condition is not satisfied (step S35: NO), the weight setting unit 49 returns to step S35.
When determination is made in step S35 that the tenth condition is satisfied (step S35: YES), the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S36). At this time, it is preferable that the weight setting unit 49 gradually increase the first weight W1 from 0 to 1 and gradually reduce the second weight W2 from 1 to 0. The time for gradually increasing the first weight W1 from 0 to 1 (time for gradually reducing the second weight W2 from 1 to 0) may be, for example, about 0.1 seconds.
The control mode of the electric motor 18 thus becomes the first control mode. While the first weight W1 is being gradually increased (while the second weight W2 is being gradually reduced), the electric motor 18 is controlled based on the sum of the assist torque command value W1·Tasst after the first weight multiplication and the integrated motor torque command value W2·Tmint,cmd after the second weight multiplication.
In the first control mode, the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is not reflected.
After the process of step S36 is performed, the weight setting unit 49 returns to step S32.
When determination is made in step S32 that the vehicle reference position is on the right side of the center of the lane (step S32: NO), the weight setting unit 49 determines whether an eleventh condition that the vehicle lateral position Plat is smaller than PR3 (see
When the eleventh condition is not satisfied (step S37: NO), the weight setting unit 49 returns to step S32.
When determination is made in step S37 that the eleventh condition is satisfied (step S37: YES), the weight setting unit 49 sets the first weight W1 to 0, and sets the second weight W2 to 1 (step S38). At this time, it is preferable that the weight setting unit 49 gradually reduce the first weight W1 from 1 to 0 and gradually increase the second weight W2 from 0 to 1.
The control mode of the electric motor 18 thus becomes the second control mode. In the second control mode, the steering reaction force based on the virtual road load torque Trl is reflected.
Next, the weight setting unit 49 determines whether a twelfth condition that the vehicle lateral position Plat is greater than PR4 (see
When the twelfth condition is not satisfied (step S39: NO), the weight setting unit 49 returns to step S39.
When determination is made in step S39 that the twelfth condition is satisfied (step S39: YES), the weight setting unit 49 sets the first weight W1 to 1, and sets the second weight W2 to 0 (step S40). At this time, it is preferable that the weight setting unit 49 gradually increase the first weight W1 from 0 to 1 and gradually reduce the second weight W2 from 1 to 0.
The control mode of the electric motor 18 thus becomes the first control mode. In the first control mode, the steering reaction force based on the virtual road load torque Trl is not reflected.
After the process of step S40 is performed, the weight setting unit 49 returns to step S32.
At time to, the control mode is the first mode and the vehicle reference position is at the center of the lane. Since the control mode is the first control mode, W1=1 and W2=0, and the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is 0.
The driver steers to the right immediately after time t0. The vehicle therefore starts to move to the right. Assuming that θvh>0 when the vehicle lateral position Plat crosses PR3 toward the right lane boundary at time t1, the eleventh condition in step S37 of
From time t0 to time t1, the steering reaction force based on the virtual road load torque Trl used to calculate the manual steering command value θMD,cmd is 0. From time t1 to t2, the steering reaction force gradually increases because part of the steering reaction force based on the virtual road load torque Trl is reflected. Since the control mode becomes the second control mode from time t2, the steering reaction force based on the virtual road load torque Trl further increases.
When the vehicle reference position reaches the right lane boundary (time t3), the steering reaction force reaches the maximum reaction force value. When the driver feels the steering reaction force and stops steering to the right, the vehicle moves toward the center of the lane. When the vehicle reference position is shifted toward the center of the lane from the right lane boundary (time t4), the steering reaction force based on the 15 virtual road load torque Trl decreases. Assuming that θvh<0 when the vehicle lateral position Plat crosses PR4 toward the center of the lane at time t5, the twelfth condition in step S39 of
From time t5 to t6, the steering reaction force gradually decreases because part of the steering reaction force based on the virtual road load torque Trl is reflected. Since the control mode becomes the first control mode from time t6, the steering reaction force based on the virtual road load torque Trl is 0.
In the fourth modification, the following effects can be obtained compared to the embodiment described above with reference to
Although the embodiment and modifications of the present invention are described above, the present invention may also be implemented in other forms.
In the embodiment or modifications described above, the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient ci are set to change depending on the vehicle lateral position Plat or depending on the vehicle lateral position Plat and the heading angle θvh, but may be set to change depending on a time differential value of the vehicle lateral position Plat, a differential value of the heading angle, etc.
Preset fixed values may be used for the virtual load spring stiffness coefficient kvl and the virtual load viscous damping coefficient cvl.
In the embodiment described above, the vehicle lateral position Plat is the distance from the boundary of the lane where the vehicle is currently traveling (lane boundary) to the vehicle reference position. The vehicle lateral position Plat may be a distance from the center of the lane where the vehicle is currently traveling to the vehicle reference position.
In the embodiment described above, the assist torque command value Tasst is multiplied by the first weight W1, and the assist torque command value W1·Tasst after the first weight multiplication is provided to the addition unit 47. Instead, however, a manual torque command value according to the manual steering command value θMD,cmd may be multiplied by the first weight W1, and the manual torque command value after the first weight multiplication may be provided to the addition unit 47.
In the embodiment described above, the angle control unit 44 (see
The driving assist control (LKA) according to the present embodiment can be used in combination with lane centering assist (LCA) control that causes the vehicle to travel along the center of the lane.
Comparing the motor control ECU 202A of
Specifically, the microcomputer 40A of
The first weight W1 used in the first weight multiplication unit 45 and the second weight W2 used in the second weight multiplication unit 46 are set to predetermined values in advance. For example, when the lane keep assist (LKA) control and the lane centering assist (LCA) control are used in combination, the first weight W1 is set to 0 and the second weight W2 is set to 1. When fully manual steering is performed, the first weight W1 is set to 1 and the second weight W2 is set to 0. It is herein assumed that the first weight W1 is set to 0 and the second weight W2 is set to 1.
The operations of the assist torque command value setting unit 41, the angle control unit 44, and the torque control unit 48 are the same as the operations of the assist torque command value setting unit 41, the angle control unit 44, and the torque control unit 48 of
The operation of the manual steering command value generation unit 42 will be described.
The road load torque (virtual road load torque) Trl is given by expression (1) above using the virtual load spring stiffness coefficient kvl, the virtual load viscous damping coefficient cvl, and the manual steering command value θMD,cmd.
When the vehicle lateral position Plat is equal to or greater than a predetermined value PLA with respect to the left lane boundary or equal to or greater than a predetermined value PRA with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl is set to a predetermined value k1.
When the vehicle lateral position Plat is equal to or greater than a predetermined value PLB smaller than PLA and is smaller than PLA with respect to the left lane boundary, the virtual load spring stiffness coefficient kvl is set according to a characteristic that it gradually increases from kvl to kmax as the vehicle lateral position Plat decreases from PLA (as the vehicle reference position approaches the left lane boundary).
When the vehicle lateral position Plat is equal to or greater than a predetermined value PRB smaller than PRA and is smaller than PRA with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl is set according to a characteristic that it gradually increases from kvl to kmax as the vehicle lateral position Plat decreases from PRA (as the vehicle reference position approaches the right lane boundary).
When the vehicle lateral position Plat is smaller than PLB with respect to the left lane boundary, the virtual load spring stiffness coefficient kvl is set to kmax. When the vehicle lateral position Plat is smaller than PRB with respect to the right lane boundary, the virtual load spring stiffness coefficient kvl is set to kmax.
The characteristics of the virtual load viscous damping coefficient cvl with respect to the vehicle lateral position Plat are set similarly to the characteristics of the virtual load spring stiffness coefficient kvl with respect to the vehicle lateral position Plat. Detailed description of the virtual load viscous damping coefficient cvl with respect to the vehicle lateral position Plat will be omitted.
The manual steering command value generation unit 42 calculates the manual steering command value θMD,cmd based on expression (2) above. Specifically, the manual steering command value generation unit 42 calculates the manual steering command value θMD,cmd by solving the differential equation given by expression (2) by substituting the torsion bar torque Ttb detected by the torque sensor 12 into Ttb of expression (2) and substituting the assist torque command value Tasst set by the assist torque command value setting unit 41 into Tasst of expression (2).
Referring to
When the vehicle lateral position Plat is equal to or smaller than PLB with respect to the left lane boundary and is equal to or smaller than PRB with respect to the right lane boundary, the higher-level ECU generates a vibration angle command value θcv,cmd according to a waveform of alert vibration to be given to the steering wheel 2 (hereinafter referred to as “target vibration waveform”), and provides the vibration angle command value θev,cmd to the motor control ECU 202A. The vibration angle command value θev,cmd indicates an instantaneous value of the target vibration waveform in terms of the rotational angle of the output shaft (steering shaft) 9. The target vibration waveform has a specified target amplitude and a predetermined target frequency.
The manual steering command value θMD,cmd calculated by the manual steering command value generation unit 42 is provided to the integrated angle command value calculation unit 43. The automatic steering command value θAD,cmd and the vibration angle command value θcv,cmd are further provided to the integrated angle command value calculation unit 43 from the higher-level ECU.
When the vibration angle command value θcv,cmd is not provided from the higher-level ECU, the integrated angle command value calculation unit 43 calculates the integrated angle command value θint,cmd by adding the manual steering command value θMD,cmd to the automatic steering command value θAD,cmd. When the vibration angle command value θcv,cmd is provided from the higher-level ECU, the integrated angle command value calculation unit 43 calculates the integrated angle command value θint,cmd by adding the vibration angle command value θcv,cmd and the manual steering command value θMD,cmd to the automatic steering command value θAD,cmd.
The angle control unit 44 calculates the integrated motor torque command value Tmint,cmd that matches the integrated angle command value θint,cmd based on the integrated angle command value θint,cmd. In this example, the first weight W1 is set to 0 and the second weight W2 is set to 1. Therefore, the integrated motor torque command value Tmint,cmd is provided to the torque control unit 48 as the motor torque command value Tm,cmd.
When the vehicle lateral position Plat is equal to or greater than PLA with respect to the left lane boundary, the absolute value |Treac| of the steering reaction force Treac (absolute value |Trl| of the virtual road load torque Trl) gradually increases from 0 to Treac1 as it approaches PLA from the center of the lane. In the example of
When the vehicle lateral position Plat is equal to or greater than PLB and smaller than PLA with respect to the left lane boundary, the absolute value |Treac| of the steering reaction force Treac (absolute value |Trl| of the virtual road load torque Trl) gradually increases from Treac1 to Treac2 as the vehicle lateral position Plat decreases from PLA (as the vehicle reference position approaches the left lane boundary). In the example of
When the vehicle lateral position Plat is smaller than PLB, the absolute value |Treac| of the steering reaction force Treac is a value obtained by adding a vibration torque Tcv according to the vibration angle command value θcv,cmd to Treac2. The alert vibration can thus be transferred to the driver when the vehicle lateral position Plat is smaller than PLB.
When the vehicle lateral position Plat is equal to or greater than PRA with respect to the right lane boundary, the absolute value |Treac| of the steering reaction force Treac (absolute value |Trl| of the virtual road load torque Trl) gradually increases from 0 to Treac1 as it approaches PRA from the center of the lane. In the example of
When the vehicle lateral position Plat is equal to or greater than PRB and smaller than PRA with respect to the right lane boundary, the absolute value |Treac| of the steering reaction force Treac (absolute value |Trl| of the virtual road load torque Trl) gradually increases from Treac1 to Treac2 as the vehicle lateral position Plat decreases from PRA (as the vehicle reference position approaches the right lane boundary). In the example of
When the vehicle lateral position Plat is smaller than PRB, the absolute value |Treac| of the steering reaction force Treac is a value obtained by adding the vibration torque Tcv according to the vibration angle command value θcv,cmd to Treac2. The alert vibration can thus be transferred to the driver when the vehicle lateral position Plat is smaller than PRB.
The embodiment and modifications described above illustrate an example in which the present invention is applied to a column type EPS. However, the present invention is also applicable to EPSs other than the column type. The present invention is also applicable to a steer-by-wire system.
Although the embodiment of the present invention is described in detail above, this is merely a specific example used to clarify the technical content of the present invention, and the present invention should not be construed as being limited to the specific example, and the scope of the present invention is limited only by the appended claims.
This application corresponds to an international patent application (PCT/JP2021/041059) filed with the Japan Patent Office as the receiving office on Nov. 8, 2021, the entire disclosure of which is incorporated herein by reference.
Number | Date | Country | Kind |
---|---|---|---|
PCT/JP2021/041059 | Nov 2021 | WO | international |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2022/020124 | 5/12/2022 | WO |