WO2016208608A1 - 車線維持支援装置 - Google Patents

車線維持支援装置 Download PDF

Info

Publication number
WO2016208608A1
WO2016208608A1 PCT/JP2016/068461 JP2016068461W WO2016208608A1 WO 2016208608 A1 WO2016208608 A1 WO 2016208608A1 JP 2016068461 W JP2016068461 W JP 2016068461W WO 2016208608 A1 WO2016208608 A1 WO 2016208608A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
host vehicle
inclination angle
yaw rate
steering
Prior art date
Application number
PCT/JP2016/068461
Other languages
English (en)
French (fr)
Inventor
淳平 達川
Original Assignee
株式会社デンソー
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社デンソー filed Critical 株式会社デンソー
Priority to US15/739,131 priority Critical patent/US10640110B2/en
Publication of WO2016208608A1 publication Critical patent/WO2016208608A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/10Path keeping
    • B60W30/12Lane keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/103Side slip angle of vehicle body
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/114Yaw movement
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/167Driving aids for lane monitoring, lane changing, e.g. blind spot detection
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001Details of the control system
    • B60W2050/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0008Feedback, closed loop systems or details of feedback error signal
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001Details of the control system
    • B60W2050/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0012Feedforward or open loop systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/12Lateral speed
    • B60W2520/125Lateral acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/14Yaw
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2555/00Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
    • B60W2555/60Traffic rules, e.g. speed limits or right of way
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2710/00Output or target parameters relating to a particular sub-units
    • B60W2710/20Steering systems
    • B60W2710/207Steering angle of wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions
    • B60W40/076Slope angle of the road

Definitions

  • the present invention relates to a lane keeping support device that maintains a state in which a vehicle does not deviate from a traveling lane.
  • a lane keeping assist device that controls steering of a vehicle so that the vehicle does not deviate from the traveling lane is known (see, for example, Patent Document 1).
  • This device detects the inclination of the road surface of the traveling lane and corrects the steering control amount in accordance with the inclination of the road surface, thereby maintaining the vehicle in the traveling lane regardless of the inclination of the road surface.
  • the present invention has been made in view of these problems, and an object thereof is to provide a technique for improving the maintenance performance for maintaining a vehicle in a traveling lane.
  • the lane keeping assist device of the present invention made to achieve the above object includes a traveling lane recognition means, a control amount calculation means, an inclination angle detection means, a lateral flow detection means, and a correction means.
  • the travel lane recognition means recognizes the travel lane in which the host vehicle travels.
  • the control amount calculation means calculates a steering control amount for controlling the steering of the host vehicle so as to prevent the host vehicle from deviating from the travel lane recognized by the travel lane recognition means.
  • the inclination angle detection means detects a road surface inclination angle that is an inclination angle of the road surface of the traveling lane in which the host vehicle is traveling.
  • the lateral flow detection means detects the lateral flow of the host vehicle.
  • the correction unit corrects the steering control amount based on the detection result of the inclination angle detection unit and the detection result of the lateral flow detection unit.
  • the thus configured lane keeping assist device of the present invention detects not only the road surface inclination angle of the traveling lane but also the lateral flow of the host vehicle. Then, based on the road surface inclination angle and the lateral flow, a steering control amount for controlling the steering of the host vehicle is calculated so as to prevent the host vehicle from deviating from the traveling lane. As a result, the lane keeping assist device of the present invention can improve the maintenance performance of keeping the vehicle in the traveling lane by suppressing the departure of the host vehicle from the traveling lane.
  • FIG. 1 It is a figure which shows schematic structure of a driving assistance system. It is a block diagram which shows the flow of the process which LKAECU performs. It is a figure which shows a target track
  • the driving support system 1 of this embodiment is mounted on a vehicle, and includes a torque sensor 2, a motor 3, a camera 4, a vehicle speed sensor 5, a yaw rate sensor 6, an acceleration sensor 7, a steering angle sensor 8, and a current detection.
  • a circuit 9, a lane keeping assist electronic control device 10, and an electric power steering electronic control device 11 are provided.
  • the lane keeping assist electronic control device 10 is referred to as a LKA ECU (Lane Keep Assist Electronic Control Unit) 10.
  • the electric power steering electronic control device 11 is referred to as EPSECU (Electric Power Steering Electronic Control Unit) 11.
  • a vehicle equipped with the driving support system 1 is referred to as a host vehicle.
  • the driving support system 1 performs control to avoid the departure when the host vehicle is about to depart from the lane.
  • the handle 101 of the host vehicle is fixed to the first end of the steering shaft 102.
  • the first end of the torque sensor 2 is connected to the second end of the steering shaft 102, and the second end of the torque sensor 2 is connected to the first end of the intermediate shaft 103.
  • the torque sensor 2 is a sensor for detecting steering torque. Specifically, the torque sensor 2 has a torsion bar that connects the steering shaft 102 and the intermediate shaft 103, and detects the torque applied to the torsion bar based on the twist angle of the torsion bar.
  • the motor 3 has a worm gear at the tip of its rotating shaft.
  • the worm gear meshes with a worm wheel provided on the intermediate shaft 103. Thereby, the rotation of the motor 3 is transmitted to the intermediate shaft 103.
  • the second end of the intermediate shaft 103 is connected to the steering gear box 104.
  • the steering gear box 104 is configured by a gear mechanism including a rack and a pinion gear, and the rack teeth mesh with a pinion gear provided at the second end of the intermediate shaft 103. Therefore, when the driver turns the handle 101, the intermediate shaft 103 rotates (that is, the pinion gear rotates), thereby moving the rack to the left and right.
  • Tie rods 105 are attached to both ends of the rack, and the tie rods 105 reciprocate left and right together with the rack. Thereby, the direction of the tire 107 is changed by pulling or pushing the knuckle arm 106 ahead of the tie rod 105.
  • the camera 4 is attached to the front side of the host vehicle.
  • the camera 4 repeatedly captures the road surface ahead of the host vehicle and outputs image data indicating the captured image.
  • the vehicle speed sensor 5 detects the traveling speed of the host vehicle and outputs a vehicle speed signal indicating the detection result.
  • the yaw rate sensor 6 detects the yaw rate of the host vehicle and outputs a yaw rate signal indicating the detection result.
  • the acceleration sensor 7 detects the lateral acceleration of the host vehicle and outputs a lateral acceleration signal indicating the detection result.
  • the steering angle sensor 8 detects the steering angle of the host vehicle and outputs a steering angle signal indicating the detection result.
  • the current detection circuit 9 detects the current flowing through the motor 3.
  • the LKA ECU 10 is configured around a known microcomputer including a CPU, a ROM, a RAM, an I / O, a bus line connecting these components, and the like.
  • the CPU executes various processes based on a program stored in a non-transitory tangible storage medium such as a ROM while using the temporary storage function of the RAM.
  • the LKA ECU 10 avoids the vehicle from deviating from the lane based on information input from the torque sensor 2, the camera 4, the vehicle speed sensor 5, the yaw rate sensor 6, the acceleration sensor 7, the steering angle sensor 8, and the current detection circuit 9. To perform the operation.
  • the LKAECU 10 then outputs a required torque ⁇ tgt indicating the torque required for the motor 3 to the EPS ECU 11 based on the calculation result.
  • the EPS ECU 11 is configured around a well-known microcomputer including a CPU, a ROM, a RAM, an I / O, a bus line connecting these components, and the like.
  • the CPU executes various processes based on a program stored in a non-transitory tangible storage medium such as a ROM while using the temporary storage function of the RAM.
  • EPSECU 11 applies a drive voltage corresponding to the required torque ⁇ tgt from LKA ECU 10 to motor 3 to cause motor 3 to generate a force for steering both tires 107.
  • the LKA ECU 10 includes a lane recognition unit 21, a target trajectory generation unit 22, a road surface camber correction unit 23, a first adder 24, a feedforward steering angle calculation unit 25, a feedback steering angle calculation unit 26, a second An adder 27, a feed forward torque calculator 28, a feedback torque calculator 29, and a third adder 30 are provided.
  • the lane recognition unit 21 recognizes a white line dividing the left side and the right side of the traveling lane in which the host vehicle is traveling by performing image processing on the image data input from the camera 4.
  • the lane recognition unit 21 calculates the lateral position, the lateral speed, and the departure angle of the host vehicle based on the position where the white line appears in the image data.
  • the lateral position of the host vehicle is the position of the host vehicle along a direction perpendicular to the traveling direction of the travel lane in the travel lane.
  • the lateral speed of the host vehicle is a moving speed of the host vehicle along a direction perpendicular to the traveling direction of the traveling lane.
  • the departure angle is an angle at which the traveling direction of the host vehicle is inclined with respect to the traveling direction of the traveling lane.
  • the target track generation unit 22 is based on the position of the white line recognized by the lane recognition unit 21, the lateral position and departure angle of the host vehicle calculated by the lane recognition unit 21, and the vehicle speed signal input from the vehicle speed sensor 5. It is determined whether or not the vehicle departs from the traveling lane. When the target track generation unit 22 determines that the vehicle departs from the travel lane, the target track generation unit 22 determines the target based on the lateral position and the departure angle calculated by the lane recognition unit 21 and the vehicle speed specified by the vehicle speed signal from the vehicle speed sensor 5. Start generating orbit data.
  • the target track gradually changes the traveling direction of the host vehicle from the outside of the traveling lane toward the inside of the traveling lane so that the host vehicle finally travels in the center of the traveling lane.
  • the target trajectory data includes a plurality of times based on the current time, a lateral position indicating a target trajectory corresponding to each of the plurality of times, a plurality of lateral velocities calculated corresponding to each of the plurality of lateral positions, A plurality of lateral accelerations calculated corresponding to each of the plurality of lateral positions.
  • the road surface camber correction unit 23 is based on the information input from the torque sensor 2, the vehicle speed sensor 5, the yaw rate sensor 6, the acceleration sensor 7, and the current detection circuit 9, and the lateral acceleration correction value a CAL ( (To be described later).
  • a method of calculating the lateral acceleration correction value a CAL will be described later.
  • the first adder 24 uses the lateral acceleration of the lateral position, lateral velocity and lateral acceleration constituting the target trajectory data output from the target trajectory generating unit 22 and the lateral acceleration correction value a output from the road surface camber correcting unit 23.
  • An added value obtained by adding CAL (hereinafter referred to as corrected lateral acceleration) is output to the feedforward steering angle calculation unit 25 and the feedback steering angle calculation unit 26.
  • the first adder 24 outputs the lateral position and lateral velocity of the lateral position, lateral velocity and lateral acceleration constituting the target trajectory data output from the target trajectory generating unit 22 to the feedback steering angle calculating unit 26.
  • the feedforward rudder angle calculation unit 25 calculates a rudder angle when the corrected lateral acceleration output from the first adder 24 acts on the host vehicle based on an arithmetic expression indicating the relationship between the lateral acceleration and the rudder angle. , and it outputs the steering angle as a feedforward steering angle [delta] FF.
  • the feedback rudder angle calculation unit 26 performs feedback control so that the lateral position, lateral speed, and lateral acceleration of the host vehicle MC coincide with the lateral position, lateral speed, and lateral acceleration input from the first adder 24, respectively.
  • the feedback steering angle ⁇ FB is calculated and output.
  • the lateral position and the lateral speed of the host vehicle MC are calculated by the lane recognition unit 21. Further, the lateral acceleration of the host vehicle MC is calculated based on the yaw rate detected by the yaw rate sensor 6 and the vehicle speed detected by the vehicle speed sensor 5.
  • the second adder 27 requests an added value obtained by adding the feed forward steering angle ⁇ FF output from the feed forward steering angle calculation unit 25 and the feedback steering angle ⁇ FB output from the feedback steering angle calculation unit 26. Output as the steering angle ⁇ tgt .
  • the feed forward torque calculation unit 28 converts the required steering angle ⁇ tgt output from the second adder 27 into torque, and outputs this torque as feed forward torque ⁇ FF .
  • the relationship between the lateral acceleration and the torque (hereinafter referred to as the lateral acceleration-torque conversion relationship) is obtained in advance from vehicle specifications, and the feedforward torque calculator 28 calculates the relationship between the lateral acceleration-torque conversion relationship and the required steering angle ⁇ . on the basis of the lateral acceleration corresponding to tgt, it calculates a torque corresponding to the required steering angle [delta] tgt. Note that the lateral acceleration corresponding to the required steering angle ⁇ tgt is calculated based on an arithmetic expression indicating the relationship between the lateral acceleration and the steering angle.
  • the feedback torque calculator 29 calculates a feedback torque ⁇ FB for feedback control so that the steering angle detected by the steering angle sensor 8 matches the required steering angle ⁇ tgt output from the second adder 27. Output.
  • the third adder 30 adds an addition value obtained by adding the feedforward torque ⁇ FF output from the feedforward torque calculation unit 28 and the feedback torque ⁇ FB output from the feedback torque calculation unit 29 as a required torque ⁇ tgt. Output to EPSECU 11.
  • the EPS ECU 11 controls the motor 3 based on the required torque ⁇ tgt output from the third adder 30. As a result, the host vehicle MC travels along the target track.
  • the road surface camber correction process is a process repeatedly executed during the operation of the LKA ECU 10.
  • the CPU of the LKA ECU 10 first determines in S10 whether or not the sensor used for the calculation has failed as shown in FIG. Sensors used for the calculation are the torque sensor 2, the vehicle speed sensor 5, the yaw rate sensor 6, the acceleration sensor 7, and the current detection circuit 9.
  • the road camber correction process is temporarily terminated.
  • the vehicle speed of the host vehicle is equal to or higher than the preset calculation possible vehicle speed (for example, 40 km / h in this embodiment) in S20. Determine whether or not.
  • the vehicle speed of the host vehicle is less than the computable vehicle speed (S20: NO)
  • the road surface camber correction process is temporarily ended.
  • road surface camber estimation calculation is performed in S30.
  • the vehicle speed of the host vehicle is expressed as ⁇ [m / s]
  • the gravitational acceleration is expressed as g [m / s 2 ].
  • the camber angle is ⁇ [rad]
  • the centrifugal acceleration is a CF [m / s 2 ]
  • the yaw rate with respect to the vertical axis Xg is ⁇ [rad / s]
  • the yaw rate with respect to the vehicle vertical axis Xc is ⁇ S.
  • the lateral acceleration detected by the acceleration sensor 7 is expressed as a S [m / s 2 ].
  • the yaw rate ⁇ S is a yaw rate detected by the yaw rate sensor 6.
  • the camber angle ⁇ is expressed by the following equation (4) using the vehicle speed ⁇ detected by the vehicle speed sensor 5, the yaw rate ⁇ S detected by the yaw rate sensor 6, and the lateral acceleration a S detected by the acceleration sensor 7. ).
  • the camber angle ⁇ calculated by the above equation (4) is calculated as the camber estimated angle ⁇ G by the yaw rate sensor 6 and the acceleration sensor 7, and the process ends.
  • the yaw rate ⁇ S detected by the yaw rate sensor 6 is cos ⁇ times the yaw rate ⁇ with respect to the vertical axis Xg. That is, as the camber angle increases, the yaw rate ⁇ S decreases. For this reason, if the turning radius of the road on which the host vehicle is traveling is estimated based on the yaw rate detected by the yaw rate sensor 6, this estimated turning radius is larger than the actual turning radius.
  • the estimated lateral acceleration estimated from the yaw rate ⁇ S detected by the yaw rate sensor 6 is expressed as a E [m / s 2 ]
  • the estimated lateral acceleration a E is calculated by the following equation (5).
  • the estimated lateral acceleration a E estimated from the yaw rate ⁇ S is larger than the lateral acceleration a S detected by the acceleration sensor 7 by g ⁇ sin ⁇ . That is, as the camber angle increases, the difference between the estimated lateral acceleration a E estimated from the yaw rate ⁇ S and the lateral acceleration a S detected by the acceleration sensor 7 increases.
  • the front cornering force 2 ⁇ F f acts on the applied force point Pc behind the ground contact point Pg of the tire 107.
  • the tie rod axial force F t acts on a connection point Pn between the tie rod 105 and the knuckle arm 106.
  • the relationship between the front cornering force 2 ⁇ F f [N] and the tie rod axial force F t [N] can be obtained by the moment around the kingpin axis KP and is expressed by the following equation (7).
  • the effective knuckle arm radius is expressed as R n [m]
  • the caster rail when the caster angle is ⁇ c is expressed as n 0 [m]
  • the pneumatic trail is expressed as n f [m].
  • the effective knuckle arm radius R n [m] is represented by the following formula (9).
  • the steering overwall gear ratio is expressed as N g [ ⁇ ]
  • the stroke ratio (specific list) is expressed as S r [m / rev].
  • the stroke ratio (ratio) Sr is expressed by the following equation (10).
  • the lock-to-lock rotation speed is expressed as ⁇
  • the rack stroke is expressed as L r [m].
  • the tie rod axial force F t [N] is expressed by the following expression (11).
  • the steering torque generated by steering the handle 101 is MT [Nm]
  • the torque transmission efficiency is ⁇ w [ ⁇ ]
  • the value obtained by dividing the rated torque of the motor 3 by the rated current is k t. [Nm / A]
  • the current flowing through the motor 3 is I m [A]
  • the motor gear ratio is iw [ ⁇ ]
  • the efficiency of the gear mechanism composed of the rack and pinion gear of the steering gear box 104 is ⁇ p [ ⁇ ]. It is written.
  • intermediate shaft torque T i the torque T i of the intermediate shaft 103 (hereinafter referred to as intermediate shaft torque T i ) is expressed by the following equation (12).
  • the relationship between the front wheel cornering force F f and the rear wheel cornering force F r is expressed by the following equation (15).
  • the distance between the vehicle center of gravity and the front wheel axis is expressed as l f
  • the distance between the vehicle center of gravity and the rear wheel axis is expressed as l r .
  • the distance l f between the vehicle center of gravity and the front wheel axis and the distance l r between the vehicle center of gravity and the rear wheel axis are expressed by the following expressions (16) and (17), respectively.
  • the vehicle wheel base is denoted by l
  • the front vehicle mass with respect to the vehicle center of gravity is denoted by m f
  • the rear vehicle mass with respect to the vehicle center of gravity is denoted by m r. Yes.
  • planar yaw rate ⁇ std when the vehicle is making a steady circular turn on a flat road.
  • the intermediate shaft torque Ti is calculated based on the motor current value detected by the current detection circuit 9, the steering torque detected by the torque sensor 2, and the above equation (12).
  • the plane yaw rate ⁇ std is calculated based on the above equation (24) and the above equation (25).
  • a yaw rate difference ⁇ between the plane yaw rate ⁇ std and the yaw rate ⁇ S detected by the yaw rate sensor 6 is calculated, and a lateral acceleration ⁇ a (hereinafter, difference) corresponding to the yaw rate difference ⁇ is calculated by the following equation (26).
  • an average value ⁇ ave of the estimated angle difference ⁇ calculated in S50 (hereinafter referred to as difference average ⁇ ave ) is calculated. Further, in S70, as shown in the following equation (29), an addition value obtained by adding the camber estimated angle ⁇ G calculated in S30 and the difference average ⁇ ave calculated in S60 is calculated as a camber correction value ⁇ CAL. To do.
  • FIG. 8 is a graph showing changes with time of calculation results of the camber estimated angle ⁇ G , the estimated angle ⁇ std, and the camber correction value ⁇ CAL .
  • the calculation result of the camber estimated angle ⁇ G is stable over time, but is offset due to the influence of the zero point deviation of the acceleration sensor 7.
  • the calculation result of the estimated angle ⁇ std varies with the passage of time due to the influence of the vehicle model error.
  • the offset amount is reduced more than the camber estimated angle ⁇ G, and the fluctuation amount with respect to time is reduced more than the estimated angle ⁇ std .
  • the lane recognition unit 21 recognizes a travel lane in which the host vehicle travels. Further, the target trajectory generation unit 22, the first adder 24, the feed forward steering angle calculation unit 25, the feedback steering angle calculation unit 26, the second adder 27, the feed forward torque calculation unit 28, the feedback torque calculation unit 29, and the third The adder 30 calculates a required torque ⁇ tgt for controlling the steering of the host vehicle so as to suppress the host vehicle from deviating from the traveling lane.
  • the road surface camber correcting unit 23 detects a camber estimated angle ⁇ G that is an inclination angle of the road surface of the traveling lane in which the host vehicle is traveling (S30). Further, the road surface camber correcting unit 23 detects the lateral flow of the host vehicle by calculating the yaw rate difference ⁇ (S40). Then, the road surface camber correcting unit 23 corrects the required torque ⁇ tgt by calculating the lateral acceleration correction value a CAL based on the camber estimated angle ⁇ G and the yaw rate difference ⁇ (S60 to S80).
  • the LKA ECU 10 detects not only the road camber of the travel lane but also the lateral flow of the host vehicle, and based on the road camber and the lateral flow, steers the host vehicle so as to suppress the departure of the host vehicle from the travel lane.
  • the required torque ⁇ tgt for control can be calculated.
  • LKA ECU10 can improve the maintenance performance which suppresses that the own vehicle deviates from a travel lane, and maintains a vehicle in a travel lane.
  • the lateral flow of the vehicle is a phenomenon in which the vehicle moves toward the right side or the left side against the driver's intention. For example, a lateral flow of the vehicle is occurring when the driver continues to steer the steering wheel to the right or left side even though the vehicle is traveling straight on a flat straight road. Possible causes of the lateral flow of the vehicle include a lateral wind flowing along the width direction of the vehicle and a vehicle alignment shift.
  • the LKA ECU 10 also determines a yaw rate difference ⁇ that is a difference between the plane yaw rate ⁇ std that is a yaw rate estimated based on the intermediate shaft torque T i applied to the intermediate shaft 103 and the yaw rate ⁇ S detected by the yaw rate sensor 6. Based on this, the lateral flow of the host vehicle is detected (S40). In other words, the LKA ECU 10 detects the lateral flow of the host vehicle based on the torque generated by the driver's steering so as to suppress the host vehicle from flowing laterally due to a side wind and a vehicle alignment shift.
  • the LKA ECU 10 calculates an inclination angle corresponding to the yaw rate difference ⁇ as the estimated angle ⁇ std (S40). And LKAECU10 based and camber estimated angle theta G, the sum of the difference average theta ave is an average value of the difference between the camber estimated angle theta G and the estimated angle theta std (camber correction value theta CAL), the required torque ⁇ tgt is corrected (S60 to S80).
  • the LKA ECU 10 can calculate the required torque ⁇ tgt whose value is stable with the passage of time by reducing the influence of the zero point deviation of the acceleration sensor 7 and the influence of the vehicle model error.
  • the LKA ECU 10 is a lane keeping assist device according to the present invention.
  • the lane recognition unit 21 is a traveling lane recognition unit in the present invention.
  • the adder 30 is a control amount calculation means in the present invention.
  • the process of S30 is the inclination angle detection means in this invention.
  • the process of S40 is a cross flow detection means in the present invention.
  • the processes of S60 to S80 are correction means in the present invention.
  • the travel lane is a travel lane in the present invention.
  • the required torque ⁇ tgt is a steering control amount in the present invention.
  • the camber estimated angle ⁇ G is the road surface inclination angle in the present invention.
  • the plane yaw rate ⁇ std is the estimated yaw rate in the present invention.
  • the estimated angle ⁇ std is the lateral flow inclination angle in the present invention.
  • the handle 101, the steering shaft 102, the intermediate shaft 103, the steering gear box 104, the tie rod 105, and the knuckle arm 106 are the steering device in the present invention.
  • the functions of one component in the above embodiment may be distributed as a plurality of components, or the functions of a plurality of components may be integrated into one component.
  • at least a part of the configuration of the above embodiment may be replaced with a known configuration having the same function.
  • at least a part of the configuration of the above embodiment may be added to or replaced with the configuration of the other embodiment.
  • all the aspects included in the technical idea specified only by the wording described in the claim are embodiment of this invention.
  • Driving support system 10 ... LKAECU DESCRIPTION OF SYMBOLS 21 ... Lane recognition part 22 ... Target track generation part 23 ... Road surface camber correction part 24 ... Adder 25 ... Feed forward steering angle calculating part 26 ... Feedback steering angle calculating part 27 ... Adder 28 ... Feed forward torque calculating part 29 ... Feedback Torque calculator 30 ... adder

Abstract

LKAECU10では、レーン認識部21が、自車両が走行する走行レーンを認識する。また、目標軌道生成部22、第一加算器24、フィードフォワード舵角演算部25、フィードバック舵角演算部26、第二加算器27、フィードフォワードトルク演算部28、フィードバックトルク演算部29および第三加算器30は、走行レーンから自車両が逸脱するのを抑制するように自車両の操舵を制御するための要求トルクτtgtを算出する。また路面キャンバ補正部23は、自車両が走行している走行レーンの路面の傾斜角であるキャンバ推定角度θを検出する。また路面キャンバ補正部23は、ヨーレート差分Δωを算出することにより、自車両の横流れを検出する。そして路面キャンバ補正部23は、キャンバ推定角度θと、ヨーレート差分Δωとに基づいて、要求トルクτtgtを補正する。

Description

車線維持支援装置
 本発明は、車両が走行車線から逸脱しない状態を維持する車線維持支援装置に関する。
 車両が走行車線から逸脱しないように車両の操舵を制御する車線維持支援装置が知られている(例えば、特許文献1を参照)。この装置は、走行車線の路面の傾斜を検知し、路面の傾斜に応じて操舵制御量を補正することにより、路面の傾斜に関わらず車両を走行車線内に維持するものである。
特開2006-236238号公報
 しかし、傾斜している道路を車両が走行している場合において、走行車線の路面の傾斜の検知結果に基づいた補正のみでは、車両を走行車線内に維持するのが困難になる場合があるという問題があった。
 本発明は、こうした問題に鑑みてなされたものであり、車両を走行車線内に維持する維持性能を向上させる技術を提供することを目的とする。
 上記目的を達成するためになされた本発明の車線維持支援装置は、走行車線認識手段と、制御量算出手段と、傾斜角検出手段と、横流れ検出手段と、補正手段とを備える。
 走行車線認識手段は、自車両が走行する走行車線を認識する。制御量算出手段は、走行車線認識手段により認識された走行車線から自車両が逸脱するのを抑制するように自車両の操舵を制御するための操舵制御量を算出する。傾斜角検出手段は、自車両が走行している走行車線の路面の傾斜角である路面傾斜角を検出する。横流れ検出手段は、自車両の横流れを検出する。補正手段は、傾斜角検出手段の検出結果と、横流れ検出手段の検出結果とに基づいて、操舵制御量を補正する。
 このように構成された本発明の車線維持支援装置は、走行車線の路面傾斜角だけではなく、自車両の横流れを検出する。そして、路面傾斜角と横流れに基づいて、走行車線から自車両が逸脱するのを抑制するように自車両の操舵を制御するための操舵制御量を算出する。これにより、本発明の車線維持支援装置は、走行車線から自車両が逸脱するのを抑制して車両を走行車線内に維持する維持性能を向上させることができる。
走行支援システムの概略構成を示す図である。 LKAECUが行う処理の流れを示すブロック図である。 目標軌道を示す図である。 路面キャンバ補正処理を示すフローチャートである。 傾斜している道路を走行している車両を示す背面図である。 接地点と着力点を示すタイヤの平面図である。 接地点と着力点を示すタイヤの側面図である。 θ,θstd,θCALの時間経過に伴う変化を示すグラフである。
 以下に本発明の実施形態を図面とともに説明する。
 図1に示すように、本実施形態の走行支援システム1は車両に搭載され、トルクセンサ2、モータ3、カメラ4、車速センサ5、ヨーレートセンサ6、加速度センサ7、舵角センサ8、電流検出回路9、車線維持支援電子制御装置10および電動パワーステアリング電子制御装置11を備える。以下、車線維持支援電子制御装置10をLKAECU(Lane Keep Assist Electronic Control Unit)10という。また、電動パワーステアリング電子制御装置11をEPSECU(Electric Power Steering Electronic Control Unit)11という。まさらに、走行支援システム1を搭載する車両を自車両という。
 走行支援システム1は、自車両が車線から逸脱しそうになった場合にその逸脱を回避するための制御を行う。
 自車両のハンドル101は、ステアリングシャフト102の第一端に固定される。トルクセンサ2の第一端はステアリングシャフト102の第二端に接続され、トルクセンサ2の第二端はインターミディエイトシャフト103の第一端に接続される。
 トルクセンサ2は、操舵トルクを検出するためのセンサである。具体的には、トルクセンサ2は、ステアリングシャフト102とインターミディエイトシャフト103とを連結するトーションバーを有し、このトーションバーのねじれ角に基づいてそのトーションバーに加えられているトルクを検出する。
 モータ3は、その回転軸の先端にウォームギアを備える。このウォームギアは、インターミディエイトシャフト103に設けられたウォームホイールと噛み合っている。これにより、モータ3の回転がインターミディエイトシャフト103に伝達される。
 インターミディエイトシャフト103の第二端は、ステアリングギアボックス104に接続されている。ステアリングギアボックス104は、ラックとピニオンギアからなるギア機構にて構成されており、インターミディエイトシャフト103の第二端に設けられたピニオンギアに、ラックの歯が噛み合っている。そのため、運転者がハンドル101を回すと、インターミディエイトシャフト103が回転(すなわち、ピニオンギアが回転)し、これによりラックが左右に移動する。ラックの両端にはそれぞれタイロッド105が取り付けられており、ラックとともにタイロッド105が左右の往復運動を行う。これにより、タイロッド105がその先のナックルアーム106を引っ張ったり押したりすることで、タイヤ107の向きが変わる。
 カメラ4は、詳細には図示しないが、自車両の前側に取り付けられている。このカメラ4は、自車両の前方の路面を繰り返し撮影し、その撮影画像を示す画像データを出力する。
 車速センサ5は、自車両の走行速度を検出し、その検出結果を示す車速信号を出力する。ヨーレートセンサ6は、自車両のヨーレートを検出し、その検出結果を示すヨーレート信号を出力する。加速度センサ7は、自車両の横加速度を検出し、その検出結果を示す横加速度信号を出力する。舵角センサ8は、自車両の舵角を検出し、その検出結果を示す舵角信号を出力する。電流検出回路9は、モータ3に流れる電流を検出する。
 LKAECU10は、CPU、ROM、RAM、I/O及びこれらの構成を接続するバスラインなどからなる周知のマイクロコンピュータを中心に構成される。CPUは、RAMの一時記憶機能を利用しつつ、ROMなどの非遷移的実体的記録媒体(non-transitory tangible storage media)に記憶されているプログラムに基づいて各種処理を実行する。LKAECU10は、トルクセンサ2、カメラ4、車速センサ5、ヨーレートセンサ6、加速度センサ7、舵角センサ8および電流検出回路9から入力される情報に基づいて、自車両が車線から逸脱するのを回避するための演算を行う。そしてLKAECU10は、この演算結果に基づいて、モータ3へ要求するトルクを示す要求トルクτtgtをEPSECU11へ出力する。
 EPSECU11は、CPU、ROM、RAM、I/O及びこれらの構成を接続するバスラインなどからなる周知のマイクロコンピュータを中心に構成される。CPUは、RAMの一時記憶機能を利用しつつ、ROMなどの非遷移的実体的記録媒体(non-transitory tangible storage media)に記憶されているプログラムに基づいて各種処理を実行する。EPSECU11は、LKAECU10からの要求トルクτtgtに応じた駆動電圧をモータ3へ印加することにより、両タイヤ107を操舵するための力をモータ3に発生させる。
 LKAECU10は、図2に示すように、レーン認識部21、目標軌道生成部22、路面キャンバ補正部23、第一加算器24、フィードフォワード舵角演算部25、フィードバック舵角演算部26、第二加算器27、フィードフォワードトルク演算部28、フィードバックトルク演算部29および第三加算器30を備える。
 レーン認識部21は、カメラ4から入力された画像データを画像処理することにより、自車両が走行している走行レーンの左側と右側とを区画する白線を認識する。そしてレーン認識部21は、画像データ内において白線が写っている位置に基づいて、自車両の横位置、横速度および逸脱角度を算出する。自車両の横位置は、走行レーン内において走行レーンの進行方向に対して垂直な方向に沿った自車両の位置である。自車両の横速度は、走行レーンの進行方向に対して垂直な方向に沿った自車両の移動速度である。逸脱角度は、走行レーンの進行方向に対して自車両の進行方向が傾いている角度である。
 目標軌道生成部22は、レーン認識部21が認識した白線の位置と、レーン認識部21が算出した自車両の横位置および逸脱角度と、車速センサ5から入力される車速信号とに基づいて、自車両が走行レーンから逸脱するか否かを判断する。そして目標軌道生成部22は、走行レーンから逸脱すると判断した場合に、レーン認識部21が算出した横位置および逸脱角度と、車速センサ5からの車速信号により特定される車速とに基づいて、目標軌道データの生成を開始する。
 目標軌道は、図3に示すように、自車両の進行方向を走行レーンの外側から走行レーンの内側に向かうように徐々に変化させ、最終的に走行レーンの中央を自車両が走行するように設定される軌道である。目標軌道データは、現時点を基点とした複数の時間と、複数の時間のそれぞれに対応した目標軌道を示す横位置と、複数の横位置のそれぞれに対応して算出された複数の横速度と、複数の横位置のそれぞれに対応して算出された複数の横加速度とを備える。
 路面キャンバ補正部23は、図2に示すように、トルクセンサ2、車速センサ5、ヨーレートセンサ6、加速度センサ7および電流検出回路9から入力される情報に基づいて、横加速度補正値aCAL(後述)を算出する。横加速度補正値aCALの算出方法は後述する。
 第一加算器24は、目標軌道生成部22から出力される目標軌道データを構成する横位置、横速度および横加速度のうち横加速度と、路面キャンバ補正部23から出力される横加速度補正値aCALとを加算した加算値(以下、補正横加速度という)を、フィードフォワード舵角演算部25とフィードバック舵角演算部26へ出力する。また第一加算器24は、目標軌道生成部22から出力される目標軌道データを構成する横位置、横速度および横加速度のうち横位置および横速度をフィードバック舵角演算部26へ出力する。
 フィードフォワード舵角演算部25は、横加速度と舵角との関係を示す演算式に基づいて、第一加算器24から出力される補正横加速度が自車両に作用するときの舵角を算出し、この舵角をフィードフォワード舵角δFFとして出力する。
 フィードバック舵角演算部26は、自車両MCの横位置、横速度および横加速度がそれぞれ、第一加算器24から入力される横位置、横速度および横加速度に一致するようにフィードバック制御するためのフィードバック舵角δFBを算出して出力する。なお、自車両MCの横位置と横速度は、レーン認識部21により算出される。また、自車両MCの横加速度は、ヨーレートセンサ6で検出されるヨーレートと、車速センサ5で検出される車速とに基づいて算出される。
 第二加算器27は、フィードフォワード舵角演算部25から出力されるフィードフォワード舵角δFFと、フィードバック舵角演算部26から出力されるフィードバック舵角δFBとを加算した加算値を、要求舵角δtgtとして出力する。
 フィードフォワードトルク演算部28は、第二加算器27から出力される要求舵角δtgtをトルクへ変換し、このトルクをフィードフォワードトルクτFFとして出力する。横加速度とトルクとの関係(以下、横加速度-トルク換算関係という)は車両諸元から予め求められており、フィードフォワードトルク演算部28は、この横加速度-トルク換算関係と、要求舵角δtgtに対応する横加速度とに基づいて、要求舵角δtgtに対応するトルクを算出する。なお、要求舵角δtgtに対応する横加速度は、横加速度と舵角との関係を示す演算式に基づいて算出される。
 フィードバックトルク演算部29は、舵角センサ8で検出される舵角が、第二加算器27から出力される要求舵角δtgtに一致するようにフィードバック制御するためのフィードバックトルクτFBを算出して出力する。
 第三加算器30は、フィードフォワードトルク演算部28から出力されるフィードフォワードトルクτFFと、フィードバックトルク演算部29から出力されるフィードバックトルクτFBとを加算した加算値を、要求トルクτtgtとしてEPSECU11へ出力する。
 EPSECU11は、第三加算器30から出力された要求トルクτtgtに基づいてモータ3を制御する。これにより、自車両MCが、目標軌道に沿って走行する。
 次に、路面キャンバ補正部23が実行する路面キャンバ補正処理を説明する。
 路面キャンバ補正処理は、LKAECU10の動作中において繰り返し実行される処理である。
 この路面キャンバ補正処理が実行されると、LKAECU10のCPUは、図4に示すように、まずS10にて、演算に用いるセンサが故障しているか否かを判断する。なお、演算に用いるセンサは、トルクセンサ2、車速センサ5、ヨーレートセンサ6、加速度センサ7および電流検出回路9である。
 ここで、演算に用いるセンサが故障している場合には(S10:YES)、路面キャンバ補正処理を一旦終了する。一方、演算に用いるセンサが故障していない場合には(S10:NO)、S20にて、自車両の車速が予め設定された演算可能車速(本実施形態では、例えば40km/h)以上であるか否かを判断する。ここで、自車両の車速が演算可能車速未満である場合には(S20:NO)、路面キャンバ補正処理を一旦終了する。一方、自車両の車速が演算可能車速以上である場合には(S20:YES)、S30にて、路面キャンバ推定演算を行う。
 ここで、自車両の車速をν[m/s]、重力加速度をg[m/s]と表記する。また図5に示すように、キャンバ角度をθ[rad]、遠心加速度をaCF[m/s]、鉛直軸Xgに対するヨーレートをω[rad/s]、車両鉛直軸Xcに対するヨーレートをω[rad/s]、加速度センサ7が検出した横加速度をa[m/s]と表記する。なお、ヨーレートωは、ヨーレートセンサ6が検出するヨーレートである。
 キャンバ角度がθである道路を自車両が車速νで定常円旋回している場合に、自車両の遠心加速度aCF、ヨーレートω、横加速度aは、下式(1)、(2)、(3)で算出される。なお、下式(1)、(2)、(3)では、縦勾配の影響は少ないと仮定して無視している。
Figure JPOXMLDOC01-appb-M000001
したがって、キャンバ角度θは、車速センサ5で検出される車速νと、ヨーレートセンサ6で検出されるヨーレートωと、加速度センサ7で検出される横加速度aとを用いて、下式(4)で算出される。
Figure JPOXMLDOC01-appb-M000002
 S30では、上式(4)で算出されるキャンバ角度θを、ヨーレートセンサ6と加速度センサ7によるキャンバ推定角度θとして算出して、処理を終了する。
 なお、上式(2)に示すように、キャンバ角度がθである道路では、ヨーレートセンサ6で検出されるヨーレートωは、鉛直軸Xgに対するヨーレートωのcosθ倍である。すなわち、キャンバ角度が大きくなるほど、ヨーレートωが小さくなる。このため、ヨーレートセンサ6で検出されるヨーレートに基づいて、自車両が走行している道路の旋回半径を推定すると、この推定旋回半径は、実際の旋回半径よりも大きくなってしまう。
 また、ヨーレートセンサ6で検出されるヨーレートωから推定される推定横加速度をa[m/s]と表記すると、推定横加速度aは、下式(5)で算出される。
Figure JPOXMLDOC01-appb-M000003
 上式(3)、(5)より、ヨーレートωから推定される推定横加速度aは、加速度センサ7で検出される横加速度aよりg×sinθだけ大きい。すなわち、キャンバ角度が大きくなるほど、ヨーレートωから推定される推定横加速度aと、加速度センサ7で検出される横加速度aとの差が大きくなる。
 なお、路面キャンバに起因した横加速度をaCMB[m/s]と表記すると、横加速度aCMBは、下式(6)で算出される。
Figure JPOXMLDOC01-appb-M000004
 S30の処理が終了すると、図4に示すように、S40にて、車両の横流れ推定演算を行う。
 図6と図7に示すように、フロントコーナリングフォース2×Fは、タイヤ107の接地点Pgよりも後方の着力点Pcに作用する。タイロッド軸力Fは、タイロッド105とナックルアーム106との連結点Pnに作用する。そして、フロントコーナリングフォース2×F[N]とタイロッド軸力F[N]との関係は、キングピン軸KP周りのモーメントで求めることが可能であり、下式(7)で表される。下式(7)において、有効ナックルアーム半径をR[m]、キャスター角がθであるときのキャスタートレールをn[m]、ニューマテイックトレールをn[m]と表記している。
Figure JPOXMLDOC01-appb-M000005
 このため、フロントコーナリングフォース2×F[N]は、下式(8)で表される。
Figure JPOXMLDOC01-appb-M000006
 また、有効ナックルアーム半径R[m]は、下式(9)で表される。下式(9)において、ステアリングオーバーウォールギヤ比をN[-]、ストロークレシオ(比スト)をS[m/rev]と表記している。
Figure JPOXMLDOC01-appb-M000007
 そして、ストロークレシオ(比スト)Sは、下式(10)で表される。下式(10)において、ロック・ツー・ロック回転数をθ、ラックストロークをL[m]と表記している。
Figure JPOXMLDOC01-appb-M000008
 また、タイロッド軸力F[N]は、下式(11)で表される。下式(11)において、ハンドル101が操舵されることにより発生する操舵トルクをMT[Nm]、トルク伝達効率をη[-]、モータ3の定格トルクを定格電流で除した値をk[Nm/A]、モータ3に流れる電流をI[A]、モータのギア比をiw[-]、ステアリングギアボックス104のラックとピニオンギアからなるギア機構の効率をη[-]と表記している。
Figure JPOXMLDOC01-appb-M000009
 また、インターミディエイトシャフト103のトルクT(以下、インターミディエイトシャフトトルクTという)は、下式(12)で表される。
Figure JPOXMLDOC01-appb-M000010
 したがって、タイロッド軸力F[N]は、下式(13)で表される。
Figure JPOXMLDOC01-appb-M000011
 さらに、上式(13)を上式(8)に代入すると、下式(14)が得られる。
Figure JPOXMLDOC01-appb-M000012
 次に、前輪コーナリングフォースFと後輪コーナリングフォースFとの関係は、下式(15)で表される。下式(15)において、車両重心と前輪軸との間の距離をl、車両重心と後輪軸との間の距離をlと表記している。
Figure JPOXMLDOC01-appb-M000013
 また、車両重心と前輪軸との間の距離lと、車両重心と後輪軸との間の距離lはそれぞれ、下式(16)と下式(17)で表される。下式(16)と下式(17)において、車両のホイールベースをl、車両重心に対して前側の車両質量をm、車両重心に対して後側の車両質量をmと表記している。
Figure JPOXMLDOC01-appb-M000014
 さらに、上式(16)と上式(17)を上式(15)に代入すると、下式(18)が得られる。このため、前輪コーナリングフォースFと後輪コーナリングフォースFとの関係は、下式(19)で表される。
Figure JPOXMLDOC01-appb-M000015
 上式(14)と上式(19)により、後輪コーナリングフォースFは下式(20)で表される。
Figure JPOXMLDOC01-appb-M000016
 また、車両の質量と、車両の横加速度と、車両に作用する力Fcentとの関係式は、下式(21)で表される。そして、車両に作用する力Fcentに、前輪コーナリングフォースFと後輪コーナリングフォースFを代入すると、下式(22)が得られる。
Figure JPOXMLDOC01-appb-M000017
 したがって、車両の横加速度は、下式(23)で表される。
Figure JPOXMLDOC01-appb-M000018
 このため、車両の横加速度と、インターミディエイトシャフトトルクTとの関係は、下式(24)で表される。
Figure JPOXMLDOC01-appb-M000019
 そして、下式(25)に示すように、インターミディエイトシャフトトルクTから算出される横加速度を車速Vで除することによって、車両が平面路で定常円旋回を行っているときのヨーレートωstd(以下、平面ヨーレートωstdという)を算出することができる。
Figure JPOXMLDOC01-appb-M000020
 S40では、電流検出回路9で検出されたモータ電流値と、トルクセンサ2で検出された操舵トルクと、上式(12)とに基づいて、インターミディエイトシャフトトルクTiを算出する。その後、S40では、上式(24)と上式(25)に基づいて、平面ヨーレートωstdを算出する。そして、S40では、平面ヨーレートωstdと、ヨーレートセンサ6で検出されるヨーレートωとのヨーレート差分Δωを算出し、下式(26)により、ヨーレート差分Δωに相当する横加速度Δa(以下、差分横加速度Δaという)を算出する。
Figure JPOXMLDOC01-appb-M000021
 そしてS40では、差分横加速度Δaに相当する推定角度θstdを下式(27)により算出し、S40の処理を終了する。
Figure JPOXMLDOC01-appb-M000022
 次に、図4に示すように、S50にて、下式(28)に示すように、S40で算出された推定角度θstdから、S30で算出されたキャンバ推定角度θを減算した推定角度差分Δθを算出する。
Figure JPOXMLDOC01-appb-M000023
 そしてS60にて、S50で算出された推定角度差分Δθの平均値θave(以下、差分平均θaveという)を算出する。さらにS70にて、下式(29)に示すように、S30で算出されたキャンバ推定角度θと、S60で算出された差分平均θaveとを加算した加算値をキャンバ補正値θCALとして算出する。
Figure JPOXMLDOC01-appb-M000024
 そしてS80にて、下式(30)に示すように、S70で算出されたキャンバ補正値θCALを、横加速度補正値aCALに換算し、路面キャンバ補正処理を一旦終了する。
Figure JPOXMLDOC01-appb-M000025
 図8は、キャンバ推定角度θ、推定角度θstdおよびキャンバ補正値θCALの算出結果の時間経過に伴う変化を示すグラフである。図8に示すように、キャンバ推定角度θの算出結果は、時間経過に対して安定しているものの、加速度センサ7のゼロ点ズレなどの影響でオフセットしている。また推定角度θstdの算出結果は、車両モデル誤差の影響で時間経過に応じて変動する。一方、キャンバ補正値θCALの算出結果は、キャンバ推定角度θよりもオフセット量が低減されるとともに、推定角度θstdよりも時間経過に対する変動量が低減されている。
 このように構成されたLKAECU10では、レーン認識部21が、自車両が走行する走行レーンを認識する。また、目標軌道生成部22、第一加算器24、フィードフォワード舵角演算部25、フィードバック舵角演算部26、第二加算器27、フィードフォワードトルク演算部28、フィードバックトルク演算部29および第三加算器30は、走行レーンから自車両が逸脱するのを抑制するように自車両の操舵を制御するための要求トルクτtgtを算出する。
 また路面キャンバ補正部23は、自車両が走行している走行レーンの路面の傾斜角であるキャンバ推定角度θを検出する(S30)。また路面キャンバ補正部23は、ヨーレート差分Δωを算出することにより、自車両の横流れを検出する(S40)。そして路面キャンバ補正部23は、キャンバ推定角度θと、ヨーレート差分Δωとに基づいて、横加速度補正値aCALを算出することにより、要求トルクτtgtを補正する(S60~S80)。
 このようにLKAECU10は、走行レーンの路面キャンバだけではなく、自車両の横流れを検出し、路面キャンバと横流れに基づいて、走行レーンから自車両が逸脱するのを抑制するように自車両の操舵を制御するための要求トルクτtgtを算出することができる。これにより、LKAECU10は、走行レーンから自車両が逸脱するのを抑制して車両を走行レーン内に維持する維持性能を向上させることができる。
 なお、車両の横流れとは、運転者の意図に反して車両が右側または左側に向かって移動してしまう現象である。例えば、車両が平坦な直線道路を直進しているにも関わらず運転者がハンドルを右側または左側に操舵している状態が継続しているときには、車両の横流れが発生している。車両の横流れの原因としては、車両の幅方向に沿って流れる横風および車両アライメントのズレなどが考えられる。
 またLKAECU10は、インターミディエイトシャフト103に加えられるインターミディエイトシャフトトルクTに基づいて推測されるヨーレートである平面ヨーレートωstdと、ヨーレートセンサ6で検出されるヨーレートωとの差分であるヨーレート差分Δωに基づいて、自車両の横流れを検出する(S40)。すなわち、LKAECU10は、横風および車両アライメントのズレなどにより自車両が横に流れるのを抑制するように運転者が操舵することで発生するトルクにより、自車両の横流れを検出する。
 またLKAECU10は、ヨーレート差分Δωに相当する傾斜角を推定角度θstdとして算出する(S40)。そしてLKAECU10は、キャンバ推定角度θと、キャンバ推定角度θと推定角度θstdとの差分の平均値である差分平均θaveとの加算値(キャンバ補正値θCAL)に基づいて、要求トルクτtgtを補正する(S60~S80)。
 これにより、LKAECU10は、加速度センサ7のゼロ点ズレなどの影響と、車両モデル誤差の影響を低減し、時間経過に対して値が安定した要求トルクτtgtを算出することができる。
 以上説明した実施形態において、LKAECU10は本発明における車線維持支援装置である。また、レーン認識部21は本発明における走行車線認識手段である。
 また、目標軌道生成部22、第一加算器24、フィードフォワード舵角演算部25、フィードバック舵角演算部26、第二加算器27、フィードフォワードトルク演算部28、フィードバックトルク演算部29および第三加算器30は本発明における制御量算出手段である。
 また、S30の処理は本発明における傾斜角検出手段である。さらに、S40の処理は本発明における横流れ検出手段である。そして、S60~S80の処理は本発明における補正手段である。
 また、走行レーンは本発明における走行車線ある。さらに、要求トルクτtgtは本発明における操舵制御量ある。さらにまた、キャンバ推定角度θは本発明における路面傾斜角ある。また、平面ヨーレートωstdは本発明における推測ヨーレートある。そして、推定角度θstdは本発明における横流れ傾斜角である。
 また、ハンドル101、ステアリングシャフト102、インターミディエイトシャフト103、ステアリングギアボックス104、タイロッド105およびナックルアーム106は本発明における操舵装置である。
 以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、本発明の技術的範囲に属する限り種々の形態を採ることができる。
 (変形例1)
 例えば上記実施形態では、LKAECU10が要求トルクτtgtを算出してEPSECU11を出力するものを示した。しかしながら、自車両の操舵を制御するための操舵制御量はこれに限定されるものではない。
 また、上記実施形態における1つの構成要素が有する機能を複数の構成要素として分散させたり、複数の構成要素が有する機能を1つの構成要素に統合させたりしてもよい。また、上記実施形態の構成の少なくとも一部を、同様の機能を有する公知の構成に置き換えてもよい。また、上記実施形態の構成の一部を省略してもよい。また、上記実施形態の構成の少なくとも一部を、他の上記実施形態の構成に対して付加または置換してもよい。なお、特許請求の範囲に記載した文言のみによって特定される技術思想に含まれるあらゆる態様が本発明の実施形態である。
 1…走行支援システム
10…LKAECU
21…レーン認識部
22…目標軌道生成部
23…路面キャンバ補正部
24…加算器
25…フィードフォワード舵角演算部
26…フィードバック舵角演算部
27…加算器
28…フィードフォワードトルク演算部
29…フィードバックトルク演算部
30…加算器

Claims (3)

  1.  自車両が走行する走行車線を認識する走行車線認識手段(21)と、
     前記走行車線認識手段により認識された前記走行車線から前記自車両が逸脱するのを抑制するように前記自車両の操舵を制御するための操舵制御量を算出する制御量算出手段(22,24,25,26,27,28,29,30)と、
     前記自車両が走行している前記走行車線の路面の傾斜角である路面傾斜角を検出する傾斜角検出手段(23,S30)と、
     前記自車両の横流れを検出する横流れ検出手段(23,S40)と、
     前記傾斜角検出手段の検出結果と、前記横流れ検出手段の検出結果とに基づいて、前記操舵制御量を補正する補正手段(23,S60~S80)とを備える
     ことを特徴とする車線維持支援装置(10)。
  2.  前記横流れ検出手段は、前記自車両の操舵装置に加えられるトルクに基づいて推測されるヨーレートである推測ヨーレートと、前記自車両のヨーレートとの差分であるヨーレート差分に基づいて、前記自車両の前記横流れを検出する
     ことを特徴とする請求項1に記載の車線維持支援装置。
  3.  前記横流れ検出手段は、前記ヨーレート差分に相当する傾斜角を、横流れ傾斜角として算出し、
     前記補正手段は、前記傾斜角検出手段および前記横流れ検出手段の検出結果として、前記傾斜角検出手段が検出した前記路面傾斜角と、前記路面傾斜角と前記横流れ傾斜角との差分の平均値との加算値に基づいて、前記操舵制御量を補正する
     ことを特徴とする請求項2に記載の車線維持支援装置。
PCT/JP2016/068461 2015-06-26 2016-06-22 車線維持支援装置 WO2016208608A1 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
US15/739,131 US10640110B2 (en) 2015-06-26 2016-06-22 Lane keep assist device

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2015128887A JP6332167B2 (ja) 2015-06-26 2015-06-26 車線維持支援装置
JP2015-128887 2015-06-26

Publications (1)

Publication Number Publication Date
WO2016208608A1 true WO2016208608A1 (ja) 2016-12-29

Family

ID=57586402

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2016/068461 WO2016208608A1 (ja) 2015-06-26 2016-06-22 車線維持支援装置

Country Status (3)

Country Link
US (1) US10640110B2 (ja)
JP (1) JP6332167B2 (ja)
WO (1) WO2016208608A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109606362A (zh) * 2018-11-19 2019-04-12 江苏大学 一种基于道路曲率的可拓前馈车道保持控制方法
CN109849900A (zh) * 2019-03-14 2019-06-07 武汉理工大学 一种基于车路协同的汽车主动转向控制系统及方法

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IT201600109633A1 (it) * 2016-10-31 2018-05-01 Magneti Marelli Spa Procedimento e sistema di controllo adattivo in un veicolo terrestre per l'inseguimento di un percorso, particolarmente in uno scenario di guida autonoma.
WO2018140022A1 (en) * 2017-01-26 2018-08-02 Ford Global Technologies, Llc Autonomous vehicle providing driver education
US10723380B2 (en) * 2017-02-24 2020-07-28 Ford Global Technologies, Llc Systems and methods to control steering of a vehicle
FR3066985B1 (fr) * 2017-06-06 2020-10-30 Renault Sas Dispositif d'assistance a la conduite d'un vehicule automobile dans une voie de circulation
KR102335985B1 (ko) * 2017-07-04 2021-12-07 현대자동차주식회사 조향각 제어 장치, 그를 포함한 차로 추종 보조 시스템 및 그 방법
WO2020008515A1 (ja) * 2018-07-03 2020-01-09 三菱電機株式会社 車両制御装置
JP7028115B2 (ja) * 2018-09-11 2022-03-02 トヨタ自動車株式会社 車両用操舵支援装置
US11604476B1 (en) * 2018-10-05 2023-03-14 Glydways Inc. Road-based vehicle guidance system
CN113104037B (zh) * 2019-12-24 2022-08-30 浙江吉利汽车研究院有限公司 一种车辆方向盘转向角度确定方法及系统
DE102020208391A1 (de) * 2020-07-03 2022-01-05 Continental Automotive Gmbh Verfahren zur teil- oder vollautonomen Führung eines Kraftfahrzeugs
CN113415276B (zh) * 2021-07-30 2022-10-14 东风商用车有限公司 一种智能驾驶预瞄控制方法、装置和存储介质
DE102021212019B4 (de) * 2021-10-25 2023-07-06 Volkswagen Aktiengesellschaft Verfahren zum sicheren Beenden einer Bankettfahrt eines Kraftfahrzeugs
CN115123294A (zh) * 2022-06-16 2022-09-30 中国第一汽车股份有限公司 车辆控制方法、车辆、存储介质及电子装置

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005280368A (ja) * 2004-03-26 2005-10-13 Mitsubishi Motors Corp 車両用パワーステアリング装置及び車両用外乱推定装置
JP2006236238A (ja) * 2005-02-28 2006-09-07 Aisin Seiki Co Ltd 車両のレーン走行支援装置
JP2014024448A (ja) * 2012-07-26 2014-02-06 Fuji Heavy Ind Ltd 車両の操舵支援装置

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB9317983D0 (en) * 1993-08-28 1993-10-13 Lucas Ind Plc A driver assistance system for a vehicle
US7451032B2 (en) * 2004-06-02 2008-11-11 Ford Global Technologies, Llc System and method for determining desired yaw rate and lateral velocity for use in a vehicle dynamic control system
KR101567207B1 (ko) * 2014-04-16 2015-11-13 현대자동차주식회사 차량 제어 시스템 및 그의 자율 주행 방법
JP5947849B2 (ja) * 2014-09-17 2016-07-06 富士重工業株式会社 車両の車線逸脱防止制御装置
US20160096546A1 (en) * 2014-10-03 2016-04-07 Delphi Technologies, Inc. Lane departure steering correction with road camber and crosswind compensation
DE102015012560A1 (de) * 2014-10-07 2016-04-07 Bomag Gmbh Fahrstand für eine Baumaschine und Baumaschine mit einem Fahrstand

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005280368A (ja) * 2004-03-26 2005-10-13 Mitsubishi Motors Corp 車両用パワーステアリング装置及び車両用外乱推定装置
JP2006236238A (ja) * 2005-02-28 2006-09-07 Aisin Seiki Co Ltd 車両のレーン走行支援装置
JP2014024448A (ja) * 2012-07-26 2014-02-06 Fuji Heavy Ind Ltd 車両の操舵支援装置

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109606362A (zh) * 2018-11-19 2019-04-12 江苏大学 一种基于道路曲率的可拓前馈车道保持控制方法
CN109606362B (zh) * 2018-11-19 2020-06-09 江苏大学 一种基于道路曲率的可拓前馈车道保持控制方法
CN109849900A (zh) * 2019-03-14 2019-06-07 武汉理工大学 一种基于车路协同的汽车主动转向控制系统及方法

Also Published As

Publication number Publication date
JP6332167B2 (ja) 2018-05-30
JP2017013520A (ja) 2017-01-19
US20180170377A1 (en) 2018-06-21
US10640110B2 (en) 2020-05-05

Similar Documents

Publication Publication Date Title
JP6332167B2 (ja) 車線維持支援装置
JP4492471B2 (ja) パワーステアリング装置。
EP1862374B1 (en) Steering control device for vehicles
CN104002860B (zh) 电动转向设备
US20150183460A1 (en) Lane keeping control device of vehicle
JP5170496B2 (ja) 電動パワーステアリング装置
WO2016208627A1 (ja) 車線維持支援装置
US11820425B2 (en) Steering angle calculation apparatus and motor control apparatus including the same
JP2007296947A (ja) 車両の操舵装置
US8186477B2 (en) Rear-wheel steering vehicle
JP5525357B2 (ja) サーボ制御装置
JPH11198844A (ja) 操舵力制御装置
JP2019031169A (ja) 車両の操舵制御装置
JP4692403B2 (ja) 車両の操舵装置
JP2015151048A (ja) 車両用軌跡制御装置
JP2010234935A (ja) 車両の後輪トー角制御装置
JP2008174168A (ja) 車両の後輪転舵制御装置
JP2010167817A (ja) 操舵制御装置及びプログラム
JP5617499B2 (ja) 車両用舵角制御装置
JP6535490B2 (ja) 車両の車線逸脱防止制御装置
JP5088008B2 (ja) 車体スリップ角制御装置及びプログラム
JP5303333B2 (ja) 車両の後輪操舵制御装置
JP5326019B2 (ja) 後輪トー角制御装置
JP2013018381A (ja) 電動パワーステアリング装置
JP5055941B2 (ja) 電動パワーステアリング装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 16814378

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 15739131

Country of ref document: US

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 16814378

Country of ref document: EP

Kind code of ref document: A1