WO2014192719A1 - 車両制御システム - Google Patents

車両制御システム Download PDF

Info

Publication number
WO2014192719A1
WO2014192719A1 PCT/JP2014/063920 JP2014063920W WO2014192719A1 WO 2014192719 A1 WO2014192719 A1 WO 2014192719A1 JP 2014063920 W JP2014063920 W JP 2014063920W WO 2014192719 A1 WO2014192719 A1 WO 2014192719A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
control system
control
line
yaw moment
Prior art date
Application number
PCT/JP2014/063920
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 CN201480029922.3A priority Critical patent/CN105492280B/zh
Priority to KR1020157032075A priority patent/KR101745237B1/ko
Priority to US14/893,680 priority patent/US9643600B2/en
Priority to DE112014002584.4T priority patent/DE112014002584T5/de
Publication of WO2014192719A1 publication Critical patent/WO2014192719A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W10/00—Conjoint control of vehicle sub-units of different type or different function
    • B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T7/00—Brake-action initiating means
    • B60T7/12—Brake-action initiating means for automatic initiation; for initiation not subject to will of driver or passenger
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T8/00—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
    • B60T8/17—Using electrical or electronic regulation means to control braking
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T8/00—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
    • B60T8/17—Using electrical or electronic regulation means to control braking
    • B60T8/1755—Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T8/00—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
    • B60T8/17—Using electrical or electronic regulation means to control braking
    • B60T8/1755—Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve
    • B60T8/17557—Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve specially adapted for lane departure prevention
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W10/00—Conjoint control of vehicle sub-units of different type or different function
    • B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking systems
    • B60W10/184—Conjoint control of vehicle sub-units of different type or different function including control of braking systems with wheel brakes
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Purposes 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/02—Control of vehicle driving stability
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Purposes 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/10—Path keeping
    • B60W30/12—Lane keeping
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D15/00—Steering not otherwise provided for
    • B62D15/02—Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V10/00—Arrangements for image or video recognition or understanding
    • G06V10/40—Extraction of image or video features
    • G06V10/44—Local feature extraction by analysis of parts of the pattern, e.g. by detecting edges, contours, loops, corners, strokes or intersections; Connectivity analysis, e.g. of connected components
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2260/00—Interaction of vehicle brake system with other systems
    • B60T2260/02—Active Steering, Steer-by-Wire
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W10/00—Conjoint control of vehicle sub-units of different type or different function
    • B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking systems
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/10—Longitudinal speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W2552/00—Input parameters relating to infrastructure
    • B60W2552/30—Road curve radius
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W2720/00—Output or target parameters relating to overall vehicle dynamics
    • B60W2720/14—Yaw

Definitions

  • the present invention relates to a vehicle control system that recognizes a traveling environment in which a vehicle is traveling and performs driving assistance.
  • Patent Document 1 discloses a technique for calculating a target yaw rate from the traveling locus of the host vehicle and the traveling locus along the recognized road edge and controlling the steering actuator such that the actual yaw rate matches the target yaw rate. It is done.
  • the target yaw rate is divided by the arrival time until reaching the roadside by dividing the angle between the recognized traveling locus along the recognized roadside and the traveling direction imaginary line extending in the traveling direction from the vehicle. It is calculated. Therefore, the yaw rate is gradually corrected as it approaches the roadside, and there is a problem that it takes time to obtain a traveling state along the roadside.
  • An object of the present invention is to provide a vehicle control system capable of early achieving a traveling state along a roadside.
  • a yaw moment control amount is provided according to an angle between a traveling direction imaginary line extending in the traveling direction from the host vehicle and the traveling direction virtual line and the traveling path definition line. did.
  • FIG. 1 is a schematic configuration view showing a vehicle control system of a first embodiment.
  • FIG. 5 is a control block diagram of the electronic control unit of the first embodiment.
  • FIG. 1 is a block diagram showing a configuration of a traveling environment recognition system of a first embodiment.
  • 5 is a flowchart showing image processing in the traveling environment recognition system of the first embodiment. It is the schematic which shows typically the embankment road which has a steep slope part. It is a captured image which shows typically the image at the time of imaging the bank road which has a steep slope part from the own vehicle. It is the schematic showing the feature point simultaneously image
  • FIG. 5 is a schematic view showing polymerization processing of image data in Example 1.
  • FIG. 6 is a flowchart showing a vehicle attitude stabilizing control necessity determination process executed by the electronic control unit of the first embodiment.
  • FIG. It is a schematic diagram showing the case where self-vehicles turn towards a runway regulation line.
  • FIG. 7 is a schematic view illustrating a case where a host vehicle travels along a curved road and turns in a direction away from a travel route definition line.
  • 5 is a flowchart illustrating a vehicle attitude stabilizing control process of the first embodiment.
  • 5 is a flowchart illustrating a vehicle attitude stabilizing control process of the first embodiment.
  • FIG. 7 is a schematic view showing a relationship between an evaluation function Ho (t) and a predetermined value ⁇ in Example 1.
  • FIG. 7 is a schematic explanatory view showing a relationship of a braking force applied to suppress turning in a turning state at a predetermined vehicle speed or more according to the first embodiment.
  • FIG. 10 is a time chart in the case where vehicle attitude stabilizing control processing is performed on the straight path of Embodiment 1.
  • FIG. It is a time chart showing the operation state of the vehicle attitude stabilizing control processing on a curved road at a predetermined vehicle speed or more according to the first embodiment.
  • 7 is a flowchart showing
  • FIG. 1 is a schematic configuration diagram showing a vehicle control system of a first embodiment.
  • the vehicle according to the first embodiment includes a driving environment recognition system 1, an electric power steering 2, a hydraulic brake unit 3, a brake booster 4, a steering wheel 5, a front left wheel 6, a front right wheel 7, a rear left wheel 8, a rear right wheel 9, an electronic A control unit 10 and a vehicle motion detection sensor 11 are provided.
  • the traveling environment recognition system 1 captures data of the traveling environment by imaging the front of the own vehicle using stereo cameras 310a and 310b installed near the rear view mirror in front of and above the vehicle interior of the own vehicle and approximately in the center position. create.
  • the electric power steering 2 calculates an assist torque based on a command according to the driver's steering torque and the steering angle or steering angular velocity of the steering wheel 5, assists the steering torque with the electric motor, and turns the left and right front wheels 6, 7 Steer. Also, steering torque assist control is performed to apply a yaw moment to the vehicle by vehicle attitude stabilizing control described later.
  • the steering wheel may be a steer-by-wire system capable of steering the left and right front wheels 6, 7 independently of the driver's steering wheel operation, and is not particularly limited.
  • the hydraulic brake unit 3 independently controls the wheel cylinder pressure for applying the braking torque to the four wheels according to the driver's brake operation force or according to the vehicle state.
  • the hydraulic brake unit 3 may be a VDC unit for realizing vehicle behavior control such as vehicle dynamics control or vehicle stability control which is existing control, or may be a unique hydraulic unit, and is not particularly limited.
  • the brake booster 4 is a booster that electrically assists a piston stroke force by boosting a driver's brake depression force with respect to a piston in a master cylinder operated by a brake pedal.
  • the force boosted by the brake booster 4 generates a master cylinder pressure, which is output to the hydraulic brake unit 3.
  • the configuration is not limited to the configuration for electrically assisting, and may be a negative pressure booster using the negative pressure of the engine.
  • the vehicle motion detection sensor 11 detects the speed (vehicle speed), longitudinal acceleration, lateral acceleration, yaw rate, steering angle, steering torque and the like of the vehicle.
  • the electronic control unit 10 controls the traveling environment recognition system 1, the electric power steering 2, and the hydraulic brake unit 3 based on the detection values of the vehicle motion detection sensor 11.
  • the electronic control unit 10 determines a traveling path defining line that defines a traveling path on a road recognized from a captured image of the traveling environment recognition system 1 and a traveling direction of the own vehicle (for example, a traveling direction virtual line extending in the traveling direction from the own vehicle)
  • a traveling direction of the own vehicle for example, a traveling direction virtual line extending in the traveling direction from the own vehicle
  • Vehicle attitude stabilizing control is performed.
  • the “traveling path defining line” is a lane boundary line when the center line or the white line is recognized, and a line connecting the positions at which the guard rails are installed when the guard rail is recognized. Or a line indicating the boundary between the flat portion of the embankment and the slope portion (hereinafter, also simply referred to as the roadside). The details of the vehicle attitude stabilizing control will be described later.
  • the hydraulic brake unit 3 applies equal braking forces between the left and right front wheels 6 and 7 and between the left and right rear wheels 8 and 9 when driven by the driver's brake operation force.
  • a yawing moment is applied to the vehicle by generating a left and right braking force by making a difference in the braking force between the left and right front wheels 6, 7 and the left and right rear wheels 8, 9.
  • FIG. 2 is a control block diagram of the electronic control unit 10 of the first embodiment.
  • the electronic control unit 10 includes a deviation tendency calculation unit 20 and a vehicle posture stabilizing control unit 21.
  • the departure tendency calculation unit 20 calculates the departure tendency of the vehicle from the traveling lane, and when the vehicle posture stabilizing control unit 21 detects the departure tendency of the vehicle from the traveling lane by the departure tendency calculation unit 20, the electric power steering 2 And / or drive the hydraulic brake unit 3 to apply yaw moment and / or deceleration to the vehicle to suppress the tendency of departure.
  • the vehicle attitude stabilizing control unit 21 is a virtual traveling path which is a tangential direction of the traveling path defining line at a position where the traveling direction imaginary line extending in the traveling direction from the host vehicle intersects the traveling direction virtual line and the traveling path defining line.
  • the vehicle is controlled to be parallel to the travel route definition line based on the angle (hereinafter referred to as the angle ⁇ formed by the definition line and referred to FIGS. 14 and 15) and the turning state of the vehicle. .
  • the departure tendency calculation unit 20 includes a travel road definition line recognition unit (road edge line recognition unit) 22, a vehicle current position recognition unit 23, a crossing time calculation unit 24, and a virtual travel road specification line calculation unit (virtual road end line A recognition unit) 25 and an operation necessity determination unit 26 are provided.
  • the travel route definition line recognition unit 22 is a white line, a guardrail, a curb, etc., the boundary line of the road edge existing on the left and right of the running lane of the host vehicle. Recognize (including centerline).
  • the current vehicle position recognition unit 23 recognizes the current vehicle position, which is a vehicle end portion ahead of the own vehicle in the traveling direction, and recognizes a traveling direction virtual line from the current vehicle position toward the direction of travel of the own vehicle.
  • the vehicle end in the forward direction of the traveling direction may use the substantially central position of the vehicle as the vehicle current position, or when the traveling direction of the vehicle (the traveling direction imaginary line) intersects with the traveling road definition line on the right side
  • the left side position ahead of the host vehicle may be the current position of the vehicle, or the position set with a margin over the actual vehicle end position It is also good and not particularly limited.
  • intersection time calculation unit 24 calculates intersection time which is the time until the host vehicle reaches the intersection position of the traveling direction virtual line and the travel path definition line from the current position of the vehicle at the current vehicle speed.
  • the virtual travel path definition line calculation unit 25 calculates a virtual travel path definition line which is a tangential direction line of the travel path definition line at the intersection position of the travel path definition line and the traveling direction imaginary line. When a plurality of virtual travel path definition lines intersect in the traveling direction of the host vehicle, a tangent direction at a point where the host vehicle intersects at the closest position is calculated.
  • the operation necessity determination unit 26 determines, based on the intersection time, whether or not operation of the vehicle attitude stabilizing control is necessary, that is, whether or not control intervention of the vehicle attitude stabilizing control is to be performed. Specifically, it is determined whether or not the crossing time is equal to or more than a predetermined time set in advance. If the crossing time is equal to or more than the predetermined time, safety is secured and there is no need to intervene in particular control. Vehicle attitude stabilizing control Is determined to be unnecessary. On the other hand, when the crossing time is less than the predetermined time, it is determined that the vehicle attitude stabilizing control is necessary.
  • the vehicle attitude stabilizing control unit 21 executes the vehicle attitude stabilizing control when it is determined by the operation necessity determination unit 26 that the vehicle attitude stabilizing control is necessary, and when it is determined that the vehicle attitude stabilizing control is unnecessary, the vehicle attitude stabilizing control is performed. Do not execute rising control.
  • FIG. 3 is a block diagram showing the configuration of the traveling environment recognition system of the first embodiment.
  • the traveling environment recognition system 1 is provided with a stereo camera 310 including a pair of cameras 310 a and 310 b as imaging means, and recognizes the environment around the vehicle.
  • each camera is installed at the same distance from the center of the vehicle in the vehicle width direction. At this time, three or more cameras may be provided.
  • Example 1 demonstrates the structure which processes the captured image of a camera in the traveling environment recognition system 1, you may perform an image process etc. by another controller.
  • the traveling environment recognition system 1 uses the difference in appearance (hereinafter referred to as “parallax”) that occurs when imaging with a plurality of cameras 310 a and 310 b, and finds the distance to the object imaged according to the principle of triangulation
  • the configuration is adopted.
  • the distance to the object is Z
  • the distance between the cameras is B
  • the focal distance of the camera is f
  • the parallax is ⁇
  • Z (B ⁇ f) / ⁇
  • the traveling environment recognition system 1 has a RAM 320 for storing a captured image, a CPU 330 for performing arithmetic processing, a data ROM 340 for storing data, and a program ROM 350 for storing a recognition processing program.
  • the stereo camera 310 is attached to a rearview mirror portion in a vehicle cabin, and is configured to pick up an image in front of the host vehicle at a predetermined depression angle and attachment position.
  • the image in front of the host vehicle taken by the stereo camera 310 (hereinafter referred to as a taken image) is taken into the RAM 320, and the CPU 330 takes the recognition processing program stored in the program ROM 350 into the taken image.
  • the result (calculation result) of estimation by the CPU 330 is output to the data ROM 340 and / or the ECU 10.
  • FIG. 4 is a flowchart showing image processing in the traveling environment recognition system of the first embodiment.
  • step 201 an input process of an image of the camera 310a disposed on the left side is performed. Data of an image captured by the camera 310 a is input to the RAM 320.
  • step 202 the input processing of the image of the camera 310b arranged on the right side is performed. Data of an image captured by the camera 310 b is input to the RAM 320.
  • the CPU 330 performs calculation processing of the captured corresponding points.
  • step 205 output processing of distance information is performed.
  • step 206 the CPU 330 determines the presence or absence of an image input signal. If there is an image input signal, the process returns to step 201 to repeat this flow, and if there is no image input signal, the arithmetic processing ends and waits. .
  • FIG. 5 is a schematic view schematically showing a bank road having steep slope portions.
  • the road is formed on the upper side portion of a substantially trapezoidal cross section, and a slope portion is formed between the road and the area outside the road, and a lower portion is present outside the slope portion.
  • the road will be described as a road surface.
  • FIG. 6 is a captured image schematically showing an image obtained by capturing an embankment road having a steep slope portion from the host vehicle.
  • the road edge which is a travel path defining line and the outside of the road are photographed adjacent to each other.
  • the slope angle is larger than the depression angle of the stereo camera 310 (steep slope)
  • a blind spot (a part not to be photographed) occurs, and the slope part is not photographed on the screen.
  • the slope part is not photographed on the screen.
  • FIG. 7 is a schematic view showing feature points captured simultaneously when an actual road is captured. As shown in FIG. 7, on an actual road, particles of asphalt concrete used for pavement, road surface indication, pavement seam, cracks in pavement, tire marks by running vehicle, even if it is not pavement road There are visually distinctive parts like this everywhere. In addition, even in areas lower than the road, visually distinctive parts such as weeds are present everywhere.
  • a characteristic portion on the screen such as a fine crack of asphalt or a tire mark existing on another road surface is extracted from the image in front of the host vehicle taken by the stereo camera 310.
  • the distance of the relevant part is measured by positional deviation on the screen.
  • characteristic portions do not necessarily exist uniformly on the entire road surface, and it is unclear whether they can always be detected even if they exist.
  • characteristic portions may not always be detectable at various places in the area. Therefore, it is necessary to further improve the accuracy. Therefore, the obtained distance data is stored in the data ROM 340, and superposition with the data obtained by the image photographed at the timing after the next time is performed.
  • FIG. 8 is a schematic view showing the polymerization process of image data in the first embodiment. For example, a portion that can be recognized by the captured image captured last time and a portion that can be recognized by the captured image captured this time are overlapped, and even if the distance information can not be obtained in the previous captured image, By superposing the newly obtained distance information, it is possible to improve the detection accuracy of the road and the surrounding environment. As shown in FIG. 8, even when the vehicle is traveling and the obtained image changes with time, if the imaging interval is short due to the vehicle speed, the obtained plural images are Since the same area is shown, it is sufficient to overlap the areas where the same area is shown. The superposition of these is not limited to two, and it is effective to overlap a plurality of times within the possible range.
  • new data may be prioritized. Thereby, recognition accuracy can be improved by using more recent data. Also, an average of multiple data may be adopted. In this way, it is possible to realize stable recognition by eliminating the influence of disturbance or the like included in the data. In addition, it is possible to extract data with less variation with surrounding data. Thereby, calculation can be performed based on stable data, and recognition accuracy can be enhanced. Since these various processing methods can be mentioned, these may be combined or any method may be adopted.
  • FIG. 9 is a schematic view showing the result obtained by imaging and recognizing the causeway in the direction crossing the road.
  • the slope portion is steep and exists in the blind spot of the camera, it does not appear in the captured image, and it appears that the road portion and a portion lower than the road are in direct contact in the image.
  • the point 601 at the end of the adjacent road and the point 602 outside the road are not actually adjacent as shown in FIG. I understand. Therefore, since outputting the point at the road end as the position of the point 602 is inaccurate, the point 601 is output as the point at the road end.
  • the data of the position corresponding to the point 601 is not detected and, for example, the point 603 inside the road from the point 601 is detected as the end point as a point existing on the road surface. .
  • the area between the area corresponding to the point 602 and the area corresponding to the point 603 on the screen also becomes an area where nothing is reflected, and it becomes unclear where the road end is located between these.
  • the point 602 present at a portion lower than the road surface can be observed, it can be inferred that the road does not exist in the direction from the stereo camera 310 to the point 602. Therefore, it is possible to analogize that the roadside is at least in the region between point 603 and point 601 which in this case is not detected. Therefore, the position between the point 603 and the point 602 and on the road side of the boundary equivalent position is output as the road end.
  • FIG. 10 is a schematic view schematically showing an embankment road having gentle slope portions.
  • the road is formed on the upper side portion of a substantially trapezoidal cross section, and a slope portion is formed between the road and the area outside the road, and a lower portion is present outside the slope portion.
  • FIG. 11 is a captured image schematically showing an image obtained by capturing an embankment road having a gentle slope portion from the host vehicle. In this captured image, the road edge and the slope portion are photographed adjacent to each other, and the slope portion and the outside of the road (region lower than the road surface) are photographed adjacent to each other. In the case of this road, since the slope angle is smaller than the depression angle of the stereo camera 310 (slow slope), no blind spot (non-photographed portion) occurs.
  • FIG. 12 is a schematic view showing a result obtained by imaging and recognizing a roadside road having gentle slopes in a road crossing direction.
  • the slope portion is gentle and is captured by the camera, the road portion and the slope portion are adjacent in the image, and the slope portion and the portion lower than the road appear to be adjacent.
  • the recognition of the roadside is important, and it is not necessary to distinguish between the slope part and the low part, and a point not located at the road surface height may be treated uniformly as the outside of the road. Therefore, the point 901 is the end of the road area, and the point 902 is recognized as the point closest to the road in the area outside the road. Therefore, it can be inferred that the actual road end is between point 901 and point 902.
  • this gradient portion can be imaged by the stereo camera 310, and the distance information can be acquired. This makes it possible to detect that this slope portion is a slope portion not suitable for the passage of vehicles, and the boundary between this slope portion and the road portion can be regarded as a road boundary (i.e., road edge).
  • the road is a cliff or if the contrast of the area under the road is vague, the height of the area lower than the road is extremely low and it is not possible to detect this area, There is no change in being able to recognize that it is out of the road.
  • the detected road edge is expected to be an actual road edge, there is actually a deviation due to detection error, and the road edge is vulnerable to the lower structure and travels toward the road edge It may be inappropriate to do.
  • it is also effective to output, as the road end, a position which is closer to the inside of the road than the detected road end.
  • a position closer to the roadside than the roadside is appropriately determined from the viewpoint of suppressing excessive control and warning. It is also effective to output as a road end.
  • a virtual image reflects a distant object, a road surface area closer to the virtual distance than the virtual image exists on the screen farther than the area where the virtual image exists.
  • the virtual image may be greatly distorted because the water surface is not perfectly flat, and as a result, the distance of the puddle region varies.
  • the apparent position of the virtual image changes with time.
  • d If an object appears to be present at a target position across a road object and the road surface (water surface)
  • FIG. 13 is a flowchart showing the vehicle attitude stabilizing control necessity determination process executed by the electronic control unit 10 according to the first embodiment. This process is repeatedly performed, for example, at a calculation cycle of about 10 ms while the vehicle is traveling.
  • the vehicle attitude stabilizing control unit 21 reads detection values of the vehicle speed, longitudinal acceleration, lateral acceleration, yaw rate, steering angle, steering torque and the like received from the vehicle motion detection sensor 11.
  • the travel path definition line recognition unit 22 recognizes the position of the travel path definition line from the captured image in front of the host vehicle received from the travel environment recognition system 1.
  • step S3 the current vehicle position recognition unit 23 recognizes the current vehicle position which is the end of the vehicle ahead of the host vehicle in the traveling direction. Further, in the vehicle current position recognition unit 23, a traveling direction virtual line extending from the host vehicle in the traveling direction is determined.
  • step S4 the intersection time calculation unit 24 calculates the intersection time which is the time from the current position of the vehicle to the intersection position of the traveling direction virtual line and the travel path definition line at the current vehicle speed. Do.
  • the virtual travel road specification line calculation unit 25 calculates a virtual travel road specification line.
  • the virtual travel path definition line is a tangent of the travel path definition line at a point close to the vehicle predicted position.
  • the vehicle predicted position is, for example, a crossing position of the traveling direction imaginary line and the travel path definition line.
  • step S5 the operation necessity determination unit 26 determines whether the crossing time is less than a predetermined time. If the crossing time is less than the predetermined time, the process proceeds to step S6. If the crossing time is equal to or more than the predetermined time, the process ends. When the intersection time is longer than the predetermined time, the driver may feel discomfort if the control amount is given in front of the scene where the driver actually steers along the travel route defining line in front of the vehicle. .
  • step S6 the vehicle attitude stabilizing control unit 21 drives the electric power steering 2 and / or the hydraulic brake unit 3 based on the yaw moment control amount to apply the yaw moment and / or the deceleration to the vehicle to stabilize the vehicle attitude. Execute rising control.
  • the vehicle attitude stabilizing control unit 21 performs vehicle attitude stabilizing control using one or more of the detected values of the vehicle speed, longitudinal acceleration, lateral acceleration, yaw rate, steering angle, steering torque, etc. read in step S1. Run.
  • FIG. 14 is a schematic view showing the case where the host vehicle is turning toward the travel path definition line.
  • FIG. 14 shows a state in which the host vehicle is turning in a direction toward a travel path defining line while traveling on a straight path.
  • the sign of the yaw rate d ⁇ / dt of the host vehicle is defined as positive in the right turn state, negative in the left turn state, and 0 in a state parallel to the travel path definition line.
  • the yaw rate d ⁇ / dt changes to negative because it is a left turn and ⁇ changes to positive, so the yaw rate d ⁇ /
  • the signs of dt and ⁇ do not match.
  • FIG. 15 is a schematic diagram showing a case where a host vehicle travels on a curved road and is turning in a direction away from the travel path definition line.
  • the traveling direction of the vehicle (the traveling direction imaginary line) intersects with the traveling path defining line on the left side.
  • the angle ⁇ changes positively, but the sign of the yaw rate d ⁇ / dt of the host vehicle is positive because it is the right.
  • the relationship between the match / mismatch between the two codes and the control amount will be described below.
  • the evaluation function Ho (t) at a certain time t in consideration of these circumstances is set as follows.
  • Ho (t) A ⁇ (d ⁇ / dt) / V ⁇ (t) -B ⁇ (t)
  • a and B are constants.
  • This evaluation function Ho (t) is assigned according to the difference between the turning state [A ⁇ (d ⁇ / dt) / V ⁇ (t)] in which the host vehicle is traveling and the state of the actual travel path definition line. Indicates the yaw moment control amount to be.
  • the evaluation function Ho (t) shows a positive value and a large value while turning right, it is necessary to apply a left turning yaw moment, so applying a braking force to the left wheel or making it easy to turn left Such steering torque control may be performed.
  • the evaluation function Ho (t) is negative and the absolute value shows a large value during left turn, it is necessary to apply a right turn yaw moment, so braking force is applied to the right wheel or The steering torque control may be performed to facilitate turning.
  • the value of the evaluation function Ho (t) becomes smaller when the driver is steering along the travel path definition line, and the applied yaw moment control amount is also small. I have no sense of incongruity.
  • the value of the evaluation function Ho (t) is large, and the yaw moment control amount to be applied is also large, so that the stability of the vehicle posture can be secured firmly.
  • the yaw moment control amount is provided by the evaluation function Ho (t) based on the difference between the curvature (1 / r) representing the current turning condition of the vehicle and the angle ⁇ , Output a controlled variable that is immediately parallel to the travel route definition line at a stage before actually reaching the travel route definition line regardless of the distance to the line (regardless of the crossing time) And secure control can be realized. Further, since the control amount is calculated using the relationship between the curvature and the angle ⁇ formed, it is assumed that the formed angle ⁇ is generated in a situation where control does not need to be performed such as traveling along the travel path definition line. Also, the vehicle attitude stabilizing control does not intervene, and the driver does not feel discomfort.
  • step S101 an angle ⁇ between the traveling direction of the host vehicle and the travel path definition line is calculated. Specifically, the angle between the traveling direction virtual line calculated in steps S3 and S4 of FIG. 13 and the virtual travel path definition line is determined.
  • step S102 the yaw rate (d ⁇ / dt) of the host vehicle is calculated.
  • the yaw rate may be a yaw rate sensor value detected by the vehicle motion detection sensor 11, or may be calculated from the vehicle speed or the steering angle based on the vehicle motion model, and is not particularly limited.
  • step S103 an evaluation function Ho (t) is calculated from the formed angle ⁇ , the yaw rate (d ⁇ / dt) and the vehicle speed V.
  • step S104 it is determined whether the evaluation function Ho (t) is positive or not. If it is positive, the process proceeds to step S105, and if it is 0 or less, the process proceeds to step S108.
  • step S105 it is determined whether the evaluation function Ho (t) is larger than a predetermined value ⁇ representing a preset dead zone. If larger, the process proceeds to step S106, and if smaller than ⁇ , the process proceeds to step S107.
  • step S106 the control amount H (t) is set to a value obtained by subtracting a predetermined value ⁇ from the evaluation function Ho (t).
  • FIG. 18 is a schematic diagram showing the relationship between the evaluation function Ho (t) and the predetermined value ⁇ .
  • a value for which the evaluation function Ho (t) exceeds the predetermined value ⁇ is calculated as the control amount H (t).
  • the control amount H (t) is set to zero.
  • the control amount H (t) is set to a value obtained by adding a predetermined value ⁇ to the evaluation function Ho (t).
  • the control amount H (t) is set to zero.
  • step S110A it is determined whether the vehicle speed is equal to or higher than a predetermined vehicle speed Vo. If it is equal to or higher than Vo, it is determined that yaw moment control by brake braking torque is effective, and the process proceeds to step S111. When it is determined that the yaw moment control by the steering operation is more effective than the brake, the process proceeds to step S121. In step S111, it is determined whether the control amount H (t) is 0 or more. If it is 0 or more, the process proceeds to step S112. If it is negative, the process proceeds to step S113.
  • step S112 since it can be determined that it is necessary to suppress the right turn, the right wheel basic control amount TR is set to 0, and the left wheel basic control amount TL is set to H (t).
  • step S113 it can be determined that it is necessary to suppress the left turn, so the right wheel basic control amount is set to H (t), and the left wheel basic control amount TL is set to zero.
  • step S114 each wheel braking torque is calculated based on the following relational expression.
  • ⁇ is a constant and is a value set based on the front and rear brake distribution.
  • the wheel wheel cylinder hydraulic pressure is calculated based on the following relational expression.
  • Right front wheel wheel cylinder hydraulic pressure PFR K ⁇ TFR
  • Left front wheel cylinder hydraulic pressure PFL K ⁇ TFL
  • Right rear wheel wheel cylinder hydraulic pressure PRR L ⁇ TRR
  • Left rear wheel cylinder hydraulic pressure PRL L x TRL
  • K and L are constants, which are conversion constants for converting torque into hydraulic pressure.
  • step S121 it is determined whether or not the vehicle is in the normal traveling state. If it is determined that the vehicle is in the normal traveling state, the process proceeds to step S122. Otherwise (the state after collision, the spin state, the road surface deviation state) Finish.
  • step S122 it is determined whether a steering wheel is attached or not. If it is determined that the steering wheel is attached, the process proceeds to step S125. If it is determined that the steering wheel is released, the process proceeds to step S123. Whether or not a hand is attached may be confirmed, for example, by analyzing the inertia of the steering wheel by a resonance frequency component of a torque sensor, or the steering wheel may be provided with a touch sensor or the like to attach a hand.
  • step S123 it is determined whether or not the release time has become longer than a predetermined time. If the release time has become longer than the predetermined time, the process proceeds to step S128 to cancel automatic control. On the other hand, if the predetermined time has not been exceeded, the process proceeds to step S124, the release time is incremented, and the process proceeds to step S125. That is, if automatic steering is allowed in the released state, the driver may over-estimate the control system, which may lead to a state of lack of attention at the time of driving.
  • step S125 it is determined whether or not the state where the steering torque is equal to or more than a predetermined value continues for a predetermined time, and if so, it is determined that the driver intentionally steers, and the process proceeds to step S128 to cancel automatic control. I do.
  • step S128 it is determined that the driver intentionally steers.
  • the process proceeds to step S126 and the high steering torque continuation timer Increment the In step S127, semiautomatic steering control is performed.
  • FIG. 19 is a schematic explanatory view showing a relationship of a braking force applied to suppress turning in a turning state at a predetermined vehicle speed or more according to the first embodiment.
  • the control amount H (t) is positive and represents a right turning state, it is necessary to apply a left turning yaw moment.
  • the control amount H (t) is negative and represents a left turning state, it is necessary to apply a right turning yaw moment. Therefore, the vehicle posture is stabilized by supplying each wheel and wheel cylinder hydraulic pressure calculated in step S115, and a yaw moment parallel to the travel path defining line is applied early.
  • FIG. 20 is a time chart when the vehicle attitude stabilizing control process is performed on the straight path according to the first embodiment.
  • FIG. 20 shows a case where the vehicle turns to the left due to a disturbance such as a side wind when going straight and an angle is formed on the left traveling route defining line.
  • the yaw rate d ⁇ / dt of the left turn is generated by the crosswind, and at the same time, the angle ⁇ formed on the left travel path defining line starts to be generated. Then, the value of the evaluation function Ho (t) also starts to change. In this case, since the angle formed in the left turning state increases, the sign of the angle ⁇ formed with the yaw rate d ⁇ / dt does not match, and the evaluation function Ho (t) changes so that the absolute value becomes larger on the negative side. .
  • the vehicle attitude stabilizing control is not performed until it becomes larger than the predetermined value ⁇ . This prevents the driver from feeling uncomfortable by suppressing excessive control intervention.
  • FIG. 21 is a time chart showing an operating state of vehicle attitude stabilizing control processing on a curved road at a predetermined vehicle speed or more according to the first embodiment.
  • FIG. 21 shows a case where the driver appropriately steers the steering wheel on a curved road and travels along a travel path defining line.
  • a travel route definition line of a curved road appears ahead of the vehicle, and an angle ⁇ formed with the vehicle travel direction (virtual travel direction virtual line) starts to occur.
  • the driver has not steered the steering wheel and the yaw rate d ⁇ / dt has not occurred because the vehicle has not yet reached the curve. Therefore, although the evaluation function Ho (t) starts to calculate a negative value, it is a value smaller than the predetermined value ⁇ .
  • yaw rate d ⁇ / dt begins to occur in the vehicle.
  • the yaw rate d ⁇ / dt agrees with ⁇ , and the absolute value of the evaluation function Ho (t) decreases.
  • the evaluation function Ho (t) takes a value of substantially 0, and in order to continuously take a value within the range of ⁇ ⁇ , basically the vehicle Posture stabilizing control is not performed. Therefore, the sense of discomfort associated with unnecessary control intervention can be avoided.
  • a road control line recognition unit 22 (travel road specification line recognition means) that recognizes the travel road specification line of the travel road from the information of the traveling direction area of the own vehicle.
  • a vehicle current position recognition unit 23 (traveling direction virtual line recognition means) that recognizes a traveling direction virtual line extending from the host vehicle in the traveling direction;
  • a vehicle attitude stabilizing control unit 21 (vehicle attitude stabilizing control means) which applies a control amount H (t) (a yaw moment control amount) in accordance with an angle ⁇ formed by the traveling direction imaginary line and the travel path defining line; It is characterized by having.
  • the vehicle attitude stabilizing control unit 21 is characterized by applying a yaw moment control amount by the brake control of applying the braking torque to the wheels.
  • the vehicle attitude stabilizing control unit 21 is characterized in that the yaw moment control amount is given by the turning control that controls the turning angle. That is, by providing the yaw moment control amount by turning control, yaw moment control with high responsiveness can be realized. In the low vehicle speed region, it is difficult to sufficiently generate a yaw moment with the yaw moment control amount by the brake, but in the case of steering control, the yaw moment is sufficiently generated even in the low vehicle speed region be able to.
  • the vehicle attitude stabilizing control portion 21 sets the yaw moment control amount according to the intersection angle which is the difference between the angle formed by the traveling direction virtual line and the travel path definition line and the curvature according to the turning radius of the host vehicle. It is characterized by giving.
  • control amount is calculated using the relationship between the curvature and the formed angle ⁇ , it is assumed that the formed angle ⁇ is generated in a situation where control does not need to be performed such as traveling along the travel path definition line. Also, the vehicle attitude stabilizing control does not intervene, and the driver does not feel discomfort.
  • the vehicle attitude stabilizing control unit 21 is characterized in that the yaw moment control amount H (t) is given when the evaluation function Ho (t) becomes equal to or more than a predetermined value ⁇ .
  • a crossing time calculation unit 24 (crossing time calculation means) is provided to calculate the crossing time until reaching the intersection of the traveling direction virtual line and the travel path definition line based on the vehicle speed V.
  • the vehicle attitude stabilizing control unit 21 is characterized by applying a yaw moment control amount when the crossing time is less than a predetermined time.
  • the vehicle attitude stabilizing control unit 21 applies a yaw moment control amount by a brake control that applies a braking torque to the wheels when the vehicle speed V is equal to or more than a predetermined value, and when the vehicle speed is less than a predetermined value
  • a yaw moment control amount is provided by steering control that controls a steering angle.
  • the yaw moment control amount is applied by the brake control in the high vehicle speed state, the yaw moment control amount can be applied while decelerating, and control with high safety can be realized.
  • a state parallel to the traveling road specification line can be realized quickly by providing the yaw moment control amount by the steering control having higher responsiveness than the brake control.
  • the traveling route definition line recognition unit 22 is characterized in that it is a stereo camera that measures a distance by using parallax generated when a plurality of cameras 310a and 310b shoot the same object.
  • the distance ahead of the vehicle and the obstacle ahead can be grasped in three dimensions, and different control gains can be set between the obstacle such as a guardrail and the white line.
  • highly safe control can be realized by setting a larger gain.
  • FIG. 22 is a flowchart showing a vehicle attitude stabilizing control process of the second embodiment.
  • the first embodiment whether to perform the brake control or the semi-automatic control by steering is switched depending on whether the vehicle speed V is equal to or higher than the predetermined vehicle speed Vo.
  • both brake control and semiautomatic control are performed.
  • the magnitude of each control amount is limited by the vehicle speed.
  • step S114a constants k and l set to larger values as the vehicle speed V is higher are calculated.
  • each wheel wheel cylinder hydraulic pressure suppressed is calculated as the vehicle speed V is lower.
  • step S126a the control gain ⁇ 'is set to a smaller value as the vehicle speed V is higher. Then, by setting the target steering angle and the target yaw rate by using the value obtained by multiplying the control amount H (t) by the gain ⁇ ′ in step S127, the target steering angle and the target yaw rate which are suppressed as the vehicle speed increases are calculated. Ru.
  • the vehicle attitude stabilizing control unit 21 controls the turning angle to increase the yaw moment control amount to be applied by the brake control for applying braking torque to the wheels as the vehicle speed V increases, and controls the turning angle as the vehicle speed decreases. To increase the yaw moment control amount to be applied.
  • the brake control has priority, so that high responsiveness can be improved by the steering control while performing highly safe control with deceleration. Further, in the low vehicle speed region, although the control with high responsiveness is performed by giving priority to the steering control, since the deceleration is accompanied by the brake control, the control with high safety can be realized.
  • a vehicle control system includes a travel path definition line recognition unit that recognizes a travel path definition line of a travel path from information of a travel direction area of a host vehicle, and a travel direction virtual line extending in the travel direction from the host vehicle. According to the angle between the traveling direction virtual line and the traveling road defining line according to the angle between the traveling direction virtual line and the traveling path defining line, according to the distance between the vehicle and the position And a vehicle attitude stabilizing control unit that applies a yaw moment control amount such that the host vehicle is parallel to the travel path definition line.
  • a vehicle control system measures a distance using parallax generated when a plurality of cameras capture the same object, and a stereo camera that recognizes a travel path definition line of a travel path.
  • a traveling direction virtual line extending in the traveling direction from the host vehicle is recognized, and the traveling direction virtual line intersects the traveling path defining line according to an angle formed by the traveling direction virtual line and the traveling path defining line.
  • a vehicle posture stabilizing control unit that applies a yaw moment control amount such that the vehicle is parallel to the travel path definition line regardless of the distance between the position and the vehicle.
  • the vehicle attitude stabilizing control unit may be configured to apply a yaw moment control amount by a brake control that applies a braking torque to wheels.
  • the vehicle attitude stabilizing control unit may be configured to apply a yaw moment control amount by turning control that controls a turning angle.
  • the vehicle control system further includes a virtual runway definition line recognition unit that recognizes a virtual runway definition line that is a tangent of the runway definition line at an intersection with the runway definition line, and the vehicle posture stabilizing control unit
  • the yaw moment control amount can be provided according to the intersection angle which is the difference between the angle formed by the traveling direction virtual line and the virtual travel path definition line and the curvature according to the turning radius of the host vehicle It is.
  • the vehicle posture stabilizing control unit may be configured to apply a yaw moment control amount when the intersection angle becomes equal to or more than a predetermined angle.
  • a crossing time calculation unit for calculating a crossing time until reaching an intersection point of the traveling direction virtual line and the traveling path definition line based on a vehicle speed
  • the vehicle posture stabilizing control unit The yaw moment control amount may be provided when the intersection time is less than a predetermined time.
  • the vehicle attitude stabilizing control unit when the vehicle speed is equal to or more than a predetermined value, applies a yaw moment control amount by a brake control that applies a braking torque to wheels, and when the vehicle speed is less than a predetermined value. It is possible to provide a yaw moment control amount by turning control that controls the turning angle.
  • the vehicle attitude stabilizing control unit increases a yaw moment control amount to be applied by brake control for applying a braking torque to wheels as the vehicle speed increases, and controls a turning angle as the vehicle speed decreases. It is possible to increase the yaw moment control amount provided by the rudder control.
  • the travel path definition line recognition unit can adopt a stereo camera that measures a distance by using parallax generated when a plurality of cameras shoot the same object.
  • Patent Document 1 Japanese Patent Publication No. 2004-345460
  • Driving environment recognition system Electric power steering 3 Hydraulic brake unit 4 Brake booster 5 Steering wheel 10 Electronic control unit 11 Vehicle motion detection sensor 20 Deviation tendency calculation part 21 Vehicle attitude stabilizing control unit 22 Runway specification line recognition unit 24 Crossing time calculation unit 25 Virtual Road Regulation Line Calculation Unit 26 Operation necessity determination unit 310 stereo camera

Abstract

　走行路に沿った走行状態を早期に達成可能な車両制御システムを提供すること。　本発明では、自車両から進行方向に延びる進行方向仮想線と、この進行方向仮想線と走行路規定線とのなす角に応じてヨーモーメント制御量を付与することとした。

Description

車両制御システム
　本発明は、車両が走行している走行環境を認識し、運転支援を行う車両制御システムに関する。
　特許文献１には、自車両の走行軌跡と、認識された路端に沿った走行軌跡とから目標ヨーレイトを算出し、実ヨーレイトが目標ヨーレイトと一致するように操舵用アクチュエータを制御する技術が開示されている。
特開２００４－３４５４６０号公報
　しかしながら、上記従来技術では、認識した路端に沿った走行軌跡と自車両から進行方向に延びる進行方向仮想線とのなす角を、路端に到達するまでの到達時間で除して目標ヨーレイトを算出している。よって、路端に近づくにつれて徐々にヨーレイトが修正されることとなり、路端に沿った走行状態を得るまでに時間がかかるという問題があった。
　本発明の目的は、路端に沿った走行状態を早期に達成可能な車両制御システムを提供することにある。
　上記目的を達成するため、本発明では、自車両から進行方向に延びる進行方向仮想線と、この進行方向仮想線と走行路規定線とのなす角に応じてヨーモーメント制御量を付与することとした。
実施例１の車両制御システムを表す概略構成図である。 実施例１の電子制御ユニットの制御ブロック図である。 実施例１の走行環境認識システムの構成を表すブロック図である。 実施例１の走行環境認識システム内における画像処理を表すフローチャートである。 急峻な斜面部分を有する土手道路を模式的に示す概略図である。 急峻な斜面部分を有する土手道路を自車両から撮像した際の映像を模式的に示す撮像画像である。 実際の道路を撮像した際に同時に撮影される特徴点を表す概略図である。 実施例１における画像データの重合処理を表す概略図である。 土手道路を撮像して認識した結果を道路横断方向で表す模式図である。 緩やかな斜面部分を有する土手道路を模式的に示す概略図である。 緩やかな斜面部分を有する土手道路を自車両から撮像した際の映像を模式的に示す撮像画像である。 土手道路を撮像して認識した結果を道路横断方向で表す模式図である。 実施例１の電子制御ユニットで実行される車両姿勢スタビライジング制御要否判断処理を示すフローチャートである。 自車両が走行路規定線に向かって旋回している場合を表す概略図である。 カーブ路を走行し、自車両が走行路規定線から離れる方向に向かって旋回している場合を表す概略図である。 実施例１の車両姿勢スタビライジング制御処理を表すフローチャートである。 実施例１の車両姿勢スタビライジング制御処理を表すフローチャートである。 実施例１の評価関数Ho(t)と所定値δとの関係を表す概略図である。 実施例１の所定車速以上の旋回状態において旋回を抑制するために付与する制動力の関係を表す概略説明図である。 実施例１の直進路で車両姿勢スタビライジング制御処理を行った場合のタイムチャートである。 実施例１の所定車速以上においてカーブ路での車両姿勢スタビライジング制御処理の作動状態を表すタイムチャートである。 実施例２の車両姿勢スタビライジング制御処理を表すフローチャートである。
　〔実施例１〕
  図１は、実施例１の車両制御システムを表す概略構成図である。
  実施例１の車両は、走行環境認識システム1、電動パワーステアリング2、油圧ブレーキユニット3、ブレーキブースタ4、ステアリングホイール5、左前輪6、右前輪7、左後輪8、右後輪9、電子制御ユニット10および車両運動検出センサ11を備える。
  走行環境認識システム1は、自車両の車室内前方かつ上方のバックミラー付近であって略中央位置に取り付けられたステレオカメラ310a,310bを用い、自車両の前方を撮像して走行環境のデータを作成する。
　電動パワーステアリング2は、運転者の操舵トルク及びステアリングホイール5の操舵角もしくは操舵角速度に応じた指令に基づいてアシストトルクを算出し、電動モータによって操舵トルクをアシストし、左右前輪6,7を転舵する。また、後述する車両姿勢スタビライジング制御によって車両にヨーモーメントを付与するような操舵トルクアシスト制御を実行する。尚、運転者のステアリングホイール操作とは独立して左右前輪6,7を転舵することも可能なステアバイワイヤシステムであってもよく特に限定しない。
　油圧ブレーキユニット3は、運転者のブレーキ操作力に応じて、又は、車両状態に応じて４輪に制動トルクを付与するホイルシリンダ圧を独立に制御する。この油圧ブレーキユニット3は、既存の制御であるビークルダイナミクス制御やビークルスタビリティ制御といった車両挙動制御を実現するVDCユニットでもよいし、独自の油圧ユニットでもよく特に限定しない。
　ブレーキブースタ4は、ブレーキペダルによって作動するマスタシリンダ内のピストンに対し、運転者のブレーキ踏力を倍力してピストンストローク力を電気的にアシストする倍力装置である。ブレーキブースタ4によって倍力された力によってマスタシリンダ圧が発生し、油圧ブレーキユニット3へ出力する。尚、電気的にアシストする構成に限らず、エンジンの負圧を用いた負圧ブースタであってもよく特に限定しない。
　車両運動検出センサ11は、車両の速度（車速）、前後加速度、横加速度、ヨーレイト、操舵角、操舵トルク等を検出する。
  電子制御ユニット10は、車両運動検出センサ11の各検出値に基づいて、走行環境認識システム1、電動パワーステアリング2、油圧ブレーキユニット3を制御する。電子制御ユニット10は、走行環境認識システム1の撮像画像から認識した道路における走行路を規定する走行路規定線と自車両の進行方向（例えば、自車両から進行方向に延びる進行方向仮想線）とが交差している場合には、電動パワーステアリング2及び／又は油圧ブレーキユニット3を駆動し、車両にヨーモーメント及び／又は減速度を付与して車両の進行方向と車線とが平行となるように車両姿勢スタビライジング制御を行う。ここで、「走行路規定線」とは、センターラインや、白線を認識している場合には車線境界線であり、ガードレールを認識している場合にはガードレールが設置されている位置を結ぶ線であり、または土手道路の平らな部分と斜面部分との境界を示す線等である（以下、単に路端とも称す。）。尚、車両姿勢スタビライジング制御の詳細については後述する。
  油圧ブレーキユニット3は、運転者のブレーキ操作力によって駆動される場合には、左右前輪6,7間および左右後輪8,9間にそれぞれ等しい制動力を作用させる。一方、車両姿勢スタビライジング制御では、左右前輪6,7間および左右後輪8,9間の制動力に差を付けて左右制動力を発生させることで車両にヨーモーメントを付与する。
　（車両姿勢スタビライジング制御システムについて）
　図２は、実施例１の電子制御ユニット10の制御ブロック図である。電子制御ユニット10は、逸脱傾向算出部20と車両姿勢スタビライジング制御部21とを備える。逸脱傾向算出部20は、車両の走行車線からの逸脱傾向を算出し、車両姿勢スタビライジング制御部21は、逸脱傾向算出部20によって車両の走行車線からの逸脱傾向を検出したとき電動パワーステアリング2及び／又は油圧ブレーキユニット3を駆動し、車両に対してヨーモーメント及び／又は減速度を付与して逸脱傾向を抑制する。車両姿勢スタビライジング制御部21は、自車両から進行方向に延びる進行方向仮想線と、この進行方向仮想線と走行路規定線とが交差する位置における走行路規定線の接線方向である仮想走行路規定線とによって生じる角度（以下、なす角θと記載する。図１４、１５を参照。）と、自車両の旋回状態とに基づいて自車両が走行路規定線と平行となるように制御する。
  逸脱傾向算出部20は、走行路規定線認識部（路端線認識部）22と、車両現在位置認識部23と、交差時間算出部24と、仮想走行路規定線算出部(仮想路端線認識部)25と、作動要否判定部26とを有する。
　走行路規定線認識部22は、走行環境認識システム1により撮像された自車両前方の画像から、白線、ガードレール、縁石等、自車両の走行している車線の左右に存在する路端の境界線（センターラインを含む）を認識する。
  車両現在位置認識部23は、自車両の進行方向前方の車両端部である車両現在位置を認識すると共に、車両現在位置から自車両の進行方向に向けて進行方向仮想線を認識する。この進行方向前方の車両端部は、自車両の略中央位置を車両現在位置としてもよいし、自車両進行方向（進行方向仮想線）が右側の走行路規定線と交差する場合は自車両前方の右側位置を、左側の走行路規定線と交差する場合は自車両前方の左側位置を車両現在位置としてもよいし、実際の車両端部位置よりも余裕を持って設定した位置を車両現在位置としてもよく、特に限定しない。
  交差時間算出部24は、自車両が、現在の車速で、車両現在位置から進行方向仮想線と走行路規定線との交差位置に到達するまでの時間である交差時間を演算する。
　仮想走行路規定線算出部25は、走行路規定線と進行方向仮想線との交差位置における走行路規定線の接線方向の線である仮想走行路規定線を算出する。仮想走行路規定線は、自車両の進行方向において複数交差する場合には、自車両からもっとも近い位置で交差した点における接線方向を算出する。
  作動要否判定部26は、交差時間に基づいて、車両姿勢スタビライジング制御の作動要否、つまり、車両姿勢スタビライジング制御の制御介入をすべきか否かを判定する。具体的には、交差時間が予め設定された所定時間以上か否かを判断し、所定時間以上であれば、安全性が確保されており、特に制御介入する必要はなく、車両姿勢スタビライジング制御が不要と判定する。一方、交差時間が所定時間未満の場合は車両姿勢スタビライジング制御が必要と判定する。
  車両姿勢スタビライジング制御部21は、作動要否判定部26により車両姿勢スタビライジング制御が必要と判定された場合には車両姿勢スタビライジング制御を実行し、不要と判定された場合には車両姿勢スタビライジング制御を実行しない。
　（走行路規定線の認識について）
　次に、走行路規定線の認識にかかる詳細について説明する。図３は実施例１の走行環境認識システムの構成を表すブロック図である。走行環境認識システム1は、撮像手段として一対のカメラ310a及び310bから構成されたステレオカメラ310が備えられ、車両周囲の環境を認識する。実施例１の場合は、車両中心から車幅方向に同一距離だけ離れた位置にそれぞれのカメラが設置されている。このとき、カメラは３つ以上備えていても良い。尚、実施例１では、走行環境認識システム１においてカメラの撮像画像を処理する構成について説明するが、画像処理等を他のコントローラで行っても良い。
　走行環境認識システム1は、複数のカメラ310a及び310bで撮像した際に生じる見え方の違い（以降、視差と記載する。）を用い、三角測量の原理によって撮像された対象物までの距離を求める構成を採用している。例えば、対象物までの距離をZ、カメラ間の距離をB、カメラの焦点距離をf、視差をδとした場合、以下の関係式が成立する。
Z＝（B×f）／δ
　走行環境認識システム1には、撮像画像を記憶するRAM320と、演算処理を行うCPU330と、データを記憶するデータROM340と、認識処理プログラムが記憶されたプログラムROM350とを有する。また、ステレオカメラ310は車室内のルームミラー部に取り付けられ、自車両前方の様子を所定の俯角、取り付け位置で撮像するように構成されている。ステレオカメラ310により撮像された自車両前方の画像（以下、撮像画像と記載する。）は、RAM320に取り込まれ、CPU330が、プログラムROM350に記憶された認識処理プログラムを、RAM320に取り込まれた撮像画像に対して実行することにより、自車両前方の車線及び立体物を検出すると共に、道路形状を推定する。CPU330による推定の結果（演算結果）は、データROM340及び／又はECU10に出力される。
　図４は実施例１の走行環境認識システム内における画像処理を表すフローチャートである。
　ステップ２０１では、左側に配置されたカメラ310aの画像の入力処理を行う。カメラ310aで撮像された画像のデータがRAM320に入力される。
　ステップ２０２では、右側に配置されたカメラ310bの画像の入力処理を行う。カメラ310bで撮像された画像のデータがRAM320に入力される。
　ステップ２０３では、CPU330によって、撮像された対応点の算出処理を行う。
　ステップ２０４では、CPU330によって、算出された対応点までの距離算出処理を行う。距離算出処理は、上述した関係式：Z＝（B×f）／δに基づいて行う。ステップ２０５では、距離情報の出力処理を行う。
　ステップ２０６では、CPU330によって、画像入力信号の有無を判断し、画像入力信号がある場合にはステップ２０１に戻って本フローを繰り返し、画像入力信号が無い場合には演算処理を終了して待機する。
　（急峻な斜面を有する道路における認識処理について）
　ここで、道路外（自車両が走行している道路の両脇等）が路面より低くなっている場合における画像処理について説明する。図５は急峻な斜面部分を有する土手道路を模式的に示す概略図である。この土手道路は、道路が断面略台形状の上辺部分に形成され、道路と道路外の領域との間には、斜面部分が形成され、その更に外側に低い部分が存在している場合を示す。以下、道路のことを路面とも記載する。図６は急峻な斜面部分を有する土手道路を自車両から撮像した際の映像を模式的に示す撮像画像である。この撮像画像では、走行路規定線である路端と道路外（道路面より低くなっている領域）とは隣接して撮影される。この道路の場合、斜面の角度がステレオカメラ310の俯角より大きな角度を持つ（急峻な斜面）ため死角（撮影されない部分）が生じ、画面上においては斜面部分が撮影されず、路端と低い部分とが隣接して撮像される。そこで、画面上で道路領域とそれ以外の低い部分を表す領域とを検出し、両者の領域の画面上における境界のうち、道路側を実際の道路端として抽出することで、実際の道路環境に合致した検出を行う。
　（画像処理の精度向上について）
　道路や道路外の領域が視覚的に完全に均質である場合、二つのカメラで撮像されたそれぞれの画像内において、同一の領域である箇所を抽出するということが困難となる。図７は実際の道路を撮像した際に同時に撮影される特徴点を表す概略図である。図７に示すように、実際の道路では、舗装に用いられるアスファルトコンクリートの粒や、路面表示、舗装の継ぎ目、舗装に入ったヒビ、走行車両によるタイヤ痕、舗装路でない場合であっても轍といった視覚的に特徴的な部分が随所に存在する。また、道路より低い領域においても、雑草などの視覚的に特徴的な部分が随所に存在する。すなわち、車両の走行に供するために舗装や整地などの処理を施した路面と、そのような処置を行っていない路面より低い域とでは視覚的に差異があり、その境界部分が視覚的に特徴的と成る可能性が高い。
　このように、道路と道路外そしてその境界には多くの視覚的特徴点が存在するため、これらの領域を二つのカメラ310a及び310bによって撮像された画像内において比較し、カメラ310a及び310bからの方向と距離を算出し、それぞれの特徴的な箇所の位置を知ることができる。よって、道路上に存在する特徴点の集合はほぼ同一平面に存在することが理解でき、道路より低い部分に存在する特徴点は、道路外領域に位置することが理解できる。
　（重合処理について）
　路面形状はステレオカメラ310により撮像された自車両前方の画像から道路標示の他路面に存在するアスファルトの細かいヒビやタイヤ痕といった画面上の特徴的な部分を抽出し、二つのカメラの撮像画像における画面上での位置ずれにより当該部分の距離を計測する。しかしながら、このような特徴的部分は路面の全体に満遍なく存在するとは限らず、また、存在したとしても常時検出可能か否かは不明である。同様に、路面より低い領域においても、その領域の各所で特徴的な部分が常に検出可能とは限らない。よって、更なる精度の向上を図る必要がある。そこで、得られた距離データをデータＲＯＭ３４０内に蓄積し、次回以降のタイミングで撮影された画像により得られるデータとの重合を行う。
　図８は実施例１における画像データの重合処理を表す概略図である。例えば前回撮影した撮像画像により認識できる部分と、今回撮影して撮像画像により認識できる部分とを重ねあわせ、前回の撮像画像では距離情報を得られなかった箇所であっても、今回の撮像画像で新たに得られた距離情報を重ね合わせることで、道路や周辺環境の検出精度を高めることができる。尚、図８に示すように、自車両が走行中であり、得られる画像が時間により変化する場合であっても、その撮像間隔が車速によって移動する距離が短ければ、得られる複数の画像は同じ領域が写っているため、これら同じ領域が写った領域を重ね合わせればよい。これらの重ね合わせは２回に限らず可能な範囲において複数回分を重ね合わせることが有効である。
　尚、撮像画像間において同一箇所と認識された位置における距離データに相違が生じた場合には、新しいデータを優先させてもよい。これにより、より新しいデータを用いることで認識精度を高めることができる。また、複数データの平均を採用してもよい。これにより、データに含まれる外乱等の影響を排除して安定した認識を実現できる。また、周囲のデータとのばらつきが少ないものを抽出するようにしてもよい。これにより、安定したデータに基づいて演算でき、認識精度を高めることができる。これら種々の処理方法が挙げられるため、これらを組み合わせてもよいし、いずれかの方法を採用してもよい。
　（路端認識処理について）
　図９は土手道路を撮像して認識した結果を道路横断方向で表す模式図である。この場合、斜面部分が急峻であり、カメラの死角に存在しているため、撮像画像内には映らず、映像内では道路部分と道路より低い部分が直接接しているように見えている。しかしながら、画面上では隣接している道路の端部の点601と道路外の点602は、実際には図９に示すように隣接しておらず、若干離れた位置に存在していることが分かる。したがって、路端の点を点602の位置として出力することは不正確となるため、点601を路端の点として出力する。
　図９において、仮に点601に相当する位置のデータが検出されず、例えば点601よりも道路内側の点603が路面に存在する点として一番端の点であると検出された場合を想定する。この場合は、画面上も点602に相当する領域と点603に相当する領域の間が何も写っていない領域となり、路端がこの間のどこに位置するかが不明となる。しかしながら、路面より低い部分に存在する点602が観測可能なことから、ステレオカメラ310から点602を俯瞰する方向には道路は存在しないことが類推できる。従って、路端は少なくとも点603と、この場合は検出されていない点601の間の領域に存在することが類推可能である。よって、点603と点602の間であって境界部相当位置よりも道路側の位置を路端として出力する。
　（緩やかな斜面を有する道路における路端認識処理について）
　図１０は緩やかな斜面部分を有する土手道路を模式的に示す概略図である。この土手道路は、道路が断面略台形状の上辺部分に形成され、道路と道路外の領域との間には、斜面部分が形成され、その更に外側に低い部分が存在している場合を示す。図１１は緩やかな斜面部分を有する土手道路を自車両から撮像した際の映像を模式的に示す撮像画像である。この撮像画像では、路端と斜面部分とが隣接して撮影され、斜面部分と道路外（道路面より低くなっている領域）とが隣接して撮影される。この道路の場合、斜面の角度がステレオカメラ310の俯角より小さな角度を持つ（緩やかな斜面）ため死角（撮影されない部分）は生じない。
　図１２は、緩やかな斜面を有する土手道路を撮像して認識した結果を道路横断方向で表す模式図である。この場合、斜面部分が緩やかであり、カメラに撮像されているため、映像内では、道路部分と斜面部分とが隣接し、斜面部分と道路より低い部分とが隣接しているように見えている。ここでは路端の認識が重要であり、斜面部分と低い部分とを区別する必要は無く、路面高さに位置しない点を一律に道路外と扱えばよい。従って、点901が道路領域の端部であり、点902が道路外領域で最も道路寄りの点と認識される。よって、実際の路端は点901と点902との間に存在すると類推できる。
　（路端認識精度の向上について）
　尚、道路と道路外との間が緩やかな勾配で接続されている場合においては、この勾配部をステレオカメラ310で撮像することができ、その距離情報を取得することができる。これにより、この勾配部分は車両の通行に適さない斜面部分であることが検出可能であり、この勾配部分と道路部分との境界を道路境界（すなわち路端）とみなすことができる。
　また、例えば、断崖絶壁の道路である場合や、道路下領域のコントラストがあいまいである場合など、道路より低い領域の高さが著しく低く、この領域を検出することができない場合であっても、道路外であると認識できることに変わりは無い。
　また、検出された道路端は実際の道路の端部であると期待されるが、実際には検出誤差によるずれがあり、また、路端は下部構造が脆弱であり、路端に寄って走行することは不適である場合もある。こうした可能性に対処するべく、検出された路端より適宜道路内側に寄った位置を路端として出力することも有効である。また、これとは逆に、実施例１のように車両姿勢スタビライジング制御システムと組み合わせて使用する場合には、過剰な制御や警告を抑止する観点から路端より適宜道路外側に寄った位置を路端として出力することも有効である。
　（虚像撮影時の対処について）
　道路より低い領域の存在を抽出し、これを道路外と判断する場合において、道路上に水溜りが生じ、これに反射する虚像を検出する場合、見かけ上、この虚像は路面より下に位置することから、水溜り領域が路面より低い領域であると誤認識するおそれがある。ここで、水溜りに写る虚像には、実像とは異なる特徴を持つことから、これを実際に路面より低い領域とは区別して排除する。具体的には、以下のような特徴が挙げられる。
　ａ）虚像は遠方の物体が写り込んでいるため、画面上では虚像が存在する領域より遠方に虚像の見かけ上の距離より近傍となる路面領域が存在する。
　ｂ）水面が完全な平面でないことにより虚像は大きく歪んでいる場合があり、その結果水溜り領域の距離がばらつく
　ｃ）水面が安定しない場合、時間経過により虚像の見かけ上の位置が変化する
　ｄ）路上物体と路面（水面）を挟んで対象となる位置に物体が存在するように見える
　ｅ）走行車両の虚像である場合、路面より低い領域にあるにもかかわらず移動する
　といった実像では起こる可能性の極めて低い特徴を有する。こうした特徴を検出することで、実像ではない、すなわち虚像であると判断できる。
　［車両姿勢スタビライジング制御］
  図１３は、実施例１の電子制御ユニット10で実行される車両姿勢スタビライジング制御要否判断処理を示すフローチャートである。この処理は、車両の走行中、例えば、10ms程度の演算周期で繰り返し実行される。
  ステップS1では、車両姿勢スタビライジング制御部21において、車両運動検出センサ11から受信した車両の速度、前後加速度、横加速度、ヨーレイト、操舵角、操舵トルクなどの検出値を読み込む。
  ステップS2では、走行路規定線認識部22において、走行環境認識システム1から受信した自車両前方の撮像画像から走行路規定線の位置を認識する。
  ステップS3では、車両現在位置認識部23において、自車両の進行方向前方の車両端部である車両現在位置を認識する。また、車両現在位置認識部23において、自車両から進行方向に延びる進行方向仮想線を求める。
　ステップS4では、交差時間算出部24において、自車両が、現在の車速で、車両現在位置から、進行方向仮想線と走行路規定線との交差位置に到達するまでの時間である交差時間を演算する。また、仮想走行路規定線算出部25において、仮想走行路規定線を算出する。仮想走行路規定線は、車両予測位置に近い点での走行路規定線の接線とする。車両予測位置は、例えば、進行方向仮想線と走行路規定線との交差位置である。
　ステップS5では、作動要否判定部26において、交差時間が所定時間未満か否かを判定し、所定時間未満の場合にはステップS6へ進み、所定時間以上の場合には処理を終了する。交差時間が所定時間よりも長いときは、実際に運転者が車両前方の走行路規定線に沿って操舵する場面よりも手前で制御量を与えてしまうと、運転者に違和感となるからである。
  ステップS6では、車両姿勢スタビライジング制御部21において、ヨーモーメント制御量に基づく電動パワーステアリング2及び／又は油圧ブレーキユニット3を駆動してヨーモーメント及び／又は減速度を車両に付与し、車両姿勢スタビライジング制御を実行する。車両姿勢スタビライジング制御部21は、ステップS1で読み込んだ車両の速度、前後加速度、横加速度、ヨーレイト、操舵角、操舵トルクなどの検出値の１又は複数を使用して、車両姿勢スタビライジング制御を実行する。
　（車両姿勢スタビライジング制御の詳細）
　次に、車両姿勢スタビライジング制御処理の詳細について説明する。図１４は自車両が走行路規定線に向かって旋回している場合を表す概略図である。図１４は、直進路を走行中に自車両が走行路規定線に向かう方向に旋回している状態を示す。自車両のヨーレイトdφ/dtの符合は、右旋回状態を正、左旋回状態を負、走行路規定線と平行な状態を０と定義する。このとき、図１４に示す場合におけるヨーレイトdφ/dtとなす角θとの関係を見ると、ヨーレイトdφ/dtは左旋回であるから負に変化し、θは正に変化するため、ヨーレイトdφ/dtとθの符合は不一致となる。
　図１５は、カーブ路を走行し、自車両が走行路規定線から離れる方向に向かって旋回している場合を表す概略図である。図１５の場合、走行路が右にカーブしているため、自車両の進行方向（進行方向仮想線）は左側の走行路規定線と交差する。運転者はカーブを認識してステアリングホイールを右旋回状態に操舵すると、なす角θは正に変化するものの、自車両のヨーレイトdφ/dtの符合は、右旋回状態であるため正であり、なす角θの符合と一致する。以下、両者の符合の一致・不一致と制御量との関係について説明する。
　例えば、上述の図１４に示すように、直進時に走行路規定線に向かって旋回する場合は、車両姿勢として安定しているとは言い難く、走行路規定線から離れる方向にヨーモーメントを付与すべきである。一方、図１５に示すように、カーブ路で進行方向仮想線と走行路規定線とが交差する場合であっても、運転者がステアリングホイールを操舵しており、自車両の旋回方向がカーブ路と一致している場合には、車両姿勢として安定していると言える。
　よって、これらの走行状態を考慮した上で、車両姿勢を安定化（スタビライジング）するためのヨーモーメント制御量を付与することが望まれる。今、旋回半径をrとすると、ヨーレイト（dφ/dt）と車速Vとの関係は下記のように表される。
（dφ/dt）＝V/r
以上から
1/r＝（dφ/dt）/V
と表される。ここで、（1/r）は曲率であり、車速によらず旋回状態を表すことができる値であるため、なす角θと同様に扱える。
　よって、これらの事情を考慮したある時刻tにおける評価関数Ho(t)を下記のように設定する。
Ho(t)＝A｛（dφ/dt）/V｝(t)－Bθ(t)
ここで、A,Bは定数である。
この評価関数Ho(t)は、自車両が走行している旋回状態［A｛（dφ/dt）/V｝(t)］と、実際の走行路規定線の状態との差分に応じて付与すべきヨーモーメント制御量を表す。右旋回中に評価関数Ho(t)が正で大きな値を示す場合は、左旋回ヨーモーメントを付与する必要があることから、左側輪に制動力を付与する、もしくは左側に旋回しやすくするような操舵トルク制御を行えばよい。一方、左旋回中に評価関数Ho(t)が負で絶対値が大きな値を示す場合は、右旋回ヨーモーメントを付与する必要があることから、右側輪に制動力を付与する、もしくは右側に旋回しやすくするような操舵トルク制御を行えばよい。
　この評価関数Ho(t)を用いることで、運転者が走行路規定線に沿って操舵している場合は評価関数Ho(t)の値は小さくなり、付与されるヨーモーメント制御量も小さいため違和感がない。一方、走行路規定線に向かって操舵している場合は評価関数Ho(t)の値が大きくなり、付与されるヨーモーメント制御量も大きいため、車両姿勢の安定性をしっかりと確保できる。
　ここで、上記実施例１にかかる発明と比較する比較例として、認識した走行路規定線に沿った走行軌跡と進行方向仮想線とのなす角を、走行路規定線に到達するまでの到達時間で除して目標ヨーレイトを算出する技術を説明する。比較例のように、到達時間で除した値をヨーモーメント制御量として用いると、走行路規定線に近づく過程で徐々にヨーレイトを修正することになり、走行路規定線に沿った走行状態を得るまでに時間がかかるという問題がある。
　これに対し、実施例１では現在の車両の旋回状態を表す曲率(1/r)となす角θとの差分に基づく評価関数Ho(t)によってヨーモーメント制御量を付与するため、走行路規定線までの距離によらず（交差時間によらず）、実際に走行路規定線に到達するよりも前の段階で、即座に走行路規定線と平行となるような制御量を出力することができ、安全性の高い制御が実現できる。また、曲率となす角θとの関係を用いて制御量を演算するため、走行路規定線に沿って走行しているような制御不要な状況にあっては、なす角θが生じていたとしても車両姿勢スタビライジング制御が介入することがなく、運転者に違和感を与えることもない。
　図１６,１７は実施例１の車両姿勢スタビライジング制御処理を表すフローチャートである。このフローは、図１３の車両姿勢スタビライジング制御要否判断において必要と判断された場合に、車両姿勢スタビライジング制御部21により実行される制御処理である。
　ステップS101では、自車両の進行方向と走行路規定線とのなす角θを演算する。具体的には、図１３のステップS3,S4で算出した進行方向仮想線と仮想走行路規定線となす角を求める。
　ステップS102では、自車両のヨーレイト（dφ/dt）を演算する。このヨーレイトは車両運動検出センサ11により検出されたヨーレイトセンサ値でもよいし、車両運動モデルに基づいて車速や操舵角から演算してもよく、特に限定しない。
　ステップS103では、なす角θ及びヨーレイト（dφ/dt）及び車速Vから評価関数Ho(t)を演算する。
　ステップS104では、評価関数Ho(t)が正か否かを判断し、正の場合はステップS105へ進み、0以下の場合はステップS108へ進む。
　ステップS105では、評価関数Ho(t)が予め設定された不感帯を表す所定値δより大きいか否かを判断し、大きいときはステップS106へ進み、δ未満のときはステップS107へ進む。
　ステップS106では、制御量H(t)を評価関数Ho(t)から所定値δを差し引いた値に設定する。図１８は評価関数Ho(t)と所定値δとの関係を表す概略図である。評価関数Ho(t)が所定値δを超えた分の値が制御量H(t)として演算される。
　ステップS107では、制御量H(t)を０にセットする。
　ステップS108では、評価関数Ho(t)にマイナスを掛けた値（評価関数Ho(t)は負の値であり、マイナスを掛けると正値となる。）が所定値δより大きいか否かを判断し、大きいときはステップS109へ進み、δ未満のときはステップS110へ進む。
　ステップS109では、制御量H(t)を評価関数Ho(t)に所定値δを加算した値に設定する。
　ステップS110では、制御量H(t)を０にセットする。
　ステップS110Aでは、車速が所定車速Vo以上か否かを判断し、Vo以上のときはブレーキ制動トルクによるヨーモーメント制御が有効であると判断してステップS111に進み、車速Vが所定車速Vo未満のときは、ブレーキよりもステアリング操作によるヨーモーメント制御が効果的であると判断してステップS121へ進む。
　ステップS111では、制御量H(t)が０以上か否かを判断し、０以上の場合はステップS112に進み、負の場合はステップS113へ進む。
　ステップS112では、右旋回を抑制する必要があると判断できるため、右側輪基本制御量TRを０に設定し、左側輪基本制御量TLをH(t)に設定する。
　ステップS113では、左旋回を抑制する必要があると判断できるため、右側輪基本制御量をH(t)に設定し、左側輪基本制御量TLを０に設定する。
　ステップS114では、以下の関係式に基づいて各輪制動トルクを算出する。
　右前輪制動トルクTFR＝TR×α
　右後輪制動トルクTRR＝TR－TFR
　左前輪制動トルクTFL＝TL×α
　左後輪制動トルクTRL＝TL－TFL
　ただし、αは定数であり、前後ブレーキ配分に基づいて設定される値である。
　　ステップS115では、以下の関係式に基づいて各輪ホイルシリンダ液圧を算出する。
　右前輪ホイルシリンダ液圧PFR＝K×TFR
　左前輪ホイルシリンダ液圧PFL＝K×TFL
　右後輪ホイルシリンダ液圧PRR＝L×TRR
　左後輪ホイルシリンダ液圧PRL＝L×TRL
　ただし、K,Lは定数であり、トルクを液圧に変換する変換定数である。
　ステップS121では、通常走行状態か否かを判断し、通常走行状態と判断したときはステップS122に進み、それ以外の場合（衝突後の状態、スピン状態、路面逸脱状態）の場合は本制御フローを終了する。
　ステップS122では、ステアリングホイールに手が添えられているか否かを判断し、添えられていると判断した場合はステップS125に進み、手放し状態と判断した場合はステップS123に進む。手が添えられているか否かは、例えばトルクセンサの共振周波数成分によりステアリングホイールのイナーシャを分析することで確認してもよいし、ステアリングホイールにタッチセンサ等を設けて手が添えられていることの判断を行ってもよい。
　ステップS123では、手放し時間が所定時間より長くなったか否かを判断し、所定時間より長くなった場合にはステップS128に進んで自動制御解除を行う。一方、所定時間を超えていない場合は、ステップS124に進んで手放し時間をインクリメントし、ステップS125へ進む。すなわち、手放し状態で自動操舵を許容してしまうと、運転者が本制御システムを過信し、運転時の注意力が欠如する状態を招く恐れがあるからである。
　ステップS125では、操舵トルクが所定値以上の状態が所定時間継続したか否かを判断し、継続した場合は運転者が意図的に操舵していると判断してステップS128に進み、自動制御解除を行う。一方、操舵トルクが所定値以上の状態が所定時間継続していない場合、すなわち操舵トルクが小さい、もしくは強くても継続的に与えられていないといった場合は、ステップS126に進み、高操舵トルク継続タイマのインクリメントを行う。
　ステップS127では、半自動操舵制御を行う。ここで、半自動操舵制御とは、運転者の意図にかかわらず車両の走行状態に応じて自動操舵を行いつつも、手放し状態が確定したときや、大きな操舵トルクが継続的に付与されたときは、自動操舵制御を終了して通常の操舵アシスト制御に切り替える制御である。自動操舵制御としては、制御量H(t)を実現するための目標操舵角及び目標ヨーレイトを設定し、電動モータの制御として、アシストトルクを付与するトルク制御から回転角制御に切り替え、目標転舵速度によって目標操舵角まで転舵させるよう、電動モータに駆動指令を出力する。
　図１９は実施例１の所定車速以上の旋回状態において旋回を抑制するために付与する制動力の関係を表す概略説明図である。制御量H(t)が正であり、右旋回状態を表す時には左旋回ヨーモーメントを付与する必要がある。一方、制御量H(t)が負であり、左旋回状態を表す時には右旋回ヨーモーメントを付与する必要がある。よって、上記ステップS115において算出された各輪ホイルシリンダ液圧を供給することで車両姿勢を安定化させ、走行路規定線と平行となるようなヨーモーメントを早期に付与する。
　図２０は実施例１の直進路で車両姿勢スタビライジング制御処理を行った場合のタイムチャートである。図２０では直進時に横風等の外乱によって左旋回し、左側走行路規定線になす角が生じた場合を示す。
　時刻ｔ１において、横風により左旋回のヨーレイトdφ/dtが発生すると同時に左側の走行路規定線になす角θが生じ始める。そして、評価関数Ho(t)の値も変化し始める。この場合、左旋回状態でなす角が増大していることから、ヨーレイトdφ/dtとなす角θの符合が不一致となり、評価関数Ho(t)は負側に絶対値が大きくなるように変化する。ここで、所定値δよりも大きくなるまでは車両姿勢スタビライジング制御は行わない。これにより過度な制御介入を抑制することで運転者への違和感を回避する。
　時刻ｔ２において、評価関数Ho(t)が所定値δ以上となり、制御量H(t)が算出されると、右側輪基本制御量TRが算出され、右前輪制動トルクTFR及び右後輪制動トルクTRRが算出される。このとき、左前輪制動トルクTFL及び左前輪制動トルクTRLは０に設定される。これにより、車両には右旋回ヨーモーメントが付与されるため、車両進行方向（進行方向仮想線）が走行路規定線の方向と平行となるように旋回する。
　図２１は実施例１の所定車速以上においてカーブ路での車両姿勢スタビライジング制御処理の作動状態を表すタイムチャートである。図２１ではカーブ路で運転者がステアリングホイールを適切に操舵し、走行路規定線に沿って走行している場合を示す。
　時刻ｔ２１において、車両前方にカーブ路の走行路規定線が出現し、車両進行方向（進行方向仮想線）との間でなす角θが生じ始める。この時点では、まだカーブに差し掛かっていないため、運転者はステアリングホイールを操舵しておらず、ヨーレイトdφ/dtは発生していない。よって、評価関数Ho(t)は負の値を算出し始めるものの、所定値δよりも小さな値である。
　時刻ｔ２２において、運転者がカーブ路を走行するためにステアリングホイールを操舵すると、車両にヨーレイトdφ/dtが生じ始める。このヨーレイトdφ/dtはθとの符合が一致し、評価関数Ho(t)の絶対値は小さくなる。そして、車両が走行路規定線に沿って走行している場合には、評価関数Ho(t)は略０の値となり、±δの範囲内の値を継続的にとるため、基本的に車両姿勢スタビライジング制御が行われることはない。よって、不要な制御介入に伴う違和感を回避できる。
　以上説明したように、実施例１にあっては下記に列挙する作用効果を得ることができる。
　（１）車両制御システムは、自車両の進行方向領域の情報から走行路の走行路規定線を認識する走行路規定線認識部22（走行路規定線認識手段）と、
　自車両から進行方向に延びる進行方向仮想線を認識する車両現在位置認識部23（進行方向仮想線認識手段）と、
　進行方向仮想線と走行路規定線とのなす角θに応じて制御量H(t)（ヨーモーメント制御量）を付与する車両姿勢スタビライジング制御部21（車両姿勢スタビライジング制御手段）と、
　を備えたことを特徴とする。
　よって、自車両から走行路規定線までの距離によらず、実際に走行路規定線に到達するよりも前の段階で、走行路規定線と平行となるような制御量を出力することができ、安全性の高い制御が実現できる。
　（２）車両姿勢スタビライジング制御部21は、車輪に制動トルクを付与するブレーキ制御によってヨーモーメント制御量を付与することを特徴とする。
　すなわち、ブレーキ制御によってヨーモーメント制御量を付与することで、運転者にステアリングホイールが動くような違和感を与えることなくヨーモーメント制御量を付与できる。また、制動トルクの発生により減速するため、より安全性の高い制御が実現できる。
　（３）車両姿勢スタビライジング制御部21は、転舵角を制御する転舵制御によってヨーモーメント制御量を付与することを特徴とする。
すなわち、転舵制御によってヨーモーメント制御量を付与することで、応答性の高いヨーモーメント制御を実現できる。尚、低車速領域であれば、ブレーキによるヨーモーメント制御量では十分にヨーモーメントを発生させることが困難であるが、転舵制御の場合は低車速領域であっても十分にヨーモーメントを発生させることができる。
　（４）車両姿勢スタビライジング制御分21は、進行方向仮想線と走行路規定線のなす角と、自車両の旋回半径に応じた曲率との差分である交差角に応じてヨーモーメント制御量を付与することを特徴とする。
　よって、曲率となす角θとの関係を用いて制御量を演算するため、走行路規定線に沿って走行しているような制御不要な状況にあっては、なす角θが生じていたとしても車両姿勢スタビライジング制御が介入することがなく、運転者に違和感を与えることもない。
　（５）車両姿勢スタビライジング制御部21は、評価関数Ho(t)が所定値δ以上となったときにヨーモーメント制御量H(t)を付与することを特徴とする。
　よって、わずかな制御量の発生に伴って制御介入が行われることによる違和感を回避できる。
　（６）車速Vに基づいて進行方向仮想線と走行路規定線との交点に到達するまでの交差時間を算出する交差時間算出部24（交差時間算出手段）を設け、
　車両姿勢スタビライジング制御部21は、交差時間が所定時間未満となったときにヨーモーメント制御量を付与することを特徴とする。
　よって、車両からかなり離れた前方位置においてなす角θが生じた場合であれば、まだ運転者は操舵することもないし、すぐに車線逸脱等が生じる恐れもないため、この場合はヨーモーメント制御量が付与されないため、運転者に違和感を与えることがない。
　（７）車両姿勢スタビライジング制御部21は、車速Vが所定値以上のときは、車輪に制動トルクを付与するブレーキ制御によってヨーモーメント制御量を付与し、車速が所定値未満のときは、転舵角を制御する転舵制御によってヨーモーメント制御量を付与することを特徴とする。
　よって、高車速状態であればブレーキ制御によってヨーモーメント制御量を付与するため、減速しながらヨーモーメント制御量を付与でき、安全性の高い制御が実現できる。また、低車速状態であればブレーキ制御よりも応答性の高い転舵制御によってヨーモーメント制御量を付与することで素早く走行路規定線に平行な状態を実現できる。
　（８）走行路規定線認識部22は、複数のカメラ310a,310bが同一の対象物を撮影したときに発生する視差を利用して距離を計測するステレオカメラであることを特徴とする。
　よって、車両前方の距離や前方障害物を立体的に把握することができ、ガードレールなどの障害物と白線とで異なる制御ゲインを設定することができる。この場合、障害物に対して衝突のおそれがある場合には、より大きなゲインを設定することで安全性の高い制御が実現できる。
　[実施例２]
　次に、実施例２について説明する。基本的な構成は実施例１と同じであるため、異なる点についてのみ説明する。図２２は実施例２の車両姿勢スタビライジング制御処理を表すフローチャートである。実施例１では、車速Vが所定車速Vo以上か否かでブレーキ制御を行うか、操舵による半自動制御を行うかを切り替えた。これに対し、実施例２では、ブレーキ制御及び半自動制御の両方を行う。このとき、車速によってそれぞれの制御量の大きさを制限するものである。
　ステップS114aでは、車速Vが高いほど大きな値に設定された定数k,lを算出する。そして、ステップS115において車速Vが低いほど抑制された各輪ホイルシリンダ液圧が算出される。
　また、ステップS126aでは、車速Vが高いほど小さな値に設定された制御ゲインα’を算出する。そして、ステップS127において制御量H(t)にゲインα’を乗算した値を用いて目標操舵角及び目標ヨーレイトを設定することで、車速が高いほど抑制された目標操舵角及び目標ヨーレイトが算出される。
　以上説明したように、実施例２にあっては下記の作用効果が得られる。
　（９）車両姿勢スタビライジング制御部21は、車速Vが高いほど車輪に制動トルクを付与するブレーキ制御によって付与するヨーモーメント制御量を大きくし、車速が低いほど転舵角を制御する転舵制御によって付与するヨーモーメント制御量を大きくすることを特徴とする。
　よって、高車速域にあってはブレーキ制御が優先することで減速を伴う安全性の高い制御を行いつつも、操舵制御によって更なる応答性を向上できる。また、低車速域にあっては操舵制御が優先することで応答性の高い制御を行いつつも、ブレーキ制御によって減速を伴うため安全性の高い制御が実現できる。
　よって、上述した実施形態によれば、自車両から走行路規定線までの距離にかかわらず、走行路規定線の状態と運転者の操舵状態との乖離を修正できるため、早期に走行路規定線に沿った走行状態とすることにより、安全性の高い車両制御システムが実現できる。
　本発明の一側面に係る車両制御システムは、自車両の進行方向領域の情報から走行路の走行路規定線を認識する走行路規定線認識部と、自車両から進行方向に延びる進行方向仮想線を認識し、前記進行方向仮想線と前記走行路規定線とのなす角に応じて、前記進行方向仮想線と前記走行路規定線とが交差する位置と前記自車両との間の距離によらず、前記自車両が前記走行路規定線と平行となるようなヨーモーメント制御量を付与する車両姿勢スタビライジング制御部と、を備える。
　本発明の一側面に係る車両制御システムは、複数のカメラが同一の対象物を撮影したときに発生する視差を利用して距離を計測し、走行路の走行路規定線を認識するステレオカメラと、自車両から進行方向に延びる進行方向仮想線を認識し、前記進行方向仮想線と前記走行路規定線とのなす角に応じて、前記進行方向仮想線と前記走行路規定線とが交差する位置と前記自車両との間の距離によらず、前記自車両が前記走行路規定線と平行となるようなヨーモーメント制御量を付与する車両姿勢スタビライジング制御部と、を備える。
　前記車両制御システムにおいて、前記車両姿勢スタビライジング制御部は、車輪に制動トルクを付与するブレーキ制御によってヨーモーメント制御量を付与する構成とすることが可能である。
　前記車両制御システムにおいて、前記車両姿勢スタビライジング制御部は、転舵角を制御する転舵制御によってヨーモーメント制御量を付与する構成とすることが可能である。
　前記車両制御システムにおいて、前記走行路規定線との交点における前記走行路規定線の接線である仮想走行路規定線を認識する仮想走行路規定線認識部を備え、前記車両姿勢スタビライジング制御部は、前記進行方向仮想線と前記仮想走行路規定線のなす角と、自車両の旋回半径に応じた曲率との差分である交差角に応じてヨーモーメント制御量を付与する構成とすることが可能である。
　前記車両制御システムにおいて、前記車両姿勢スタビライジング制御部は、前記交差角が所定以上となったときにヨーモーメント制御量を付与する構成とすることが可能である。
　前記車両制御システムにおいて、車速に基づいて前記進行方向仮想線と前記走行路規定線との交点に到達するまでの交差時間を算出する交差時間算出部を設け、前記車両姿勢スタビライジング制御部は、前記交差時間が所定時間未満となったときにヨーモーメント制御量を付与する構成とすることが可能である。
　前記車両制御システムにおいて、前記車両姿勢スタビライジング制御部は、車速が所定値以上のときは、車輪に制動トルクを付与するブレーキ制御によってヨーモーメント制御量を付与し、車速が所定値未満のときは、転舵角を制御する転舵制御によってヨーモーメント制御量を付与する構成とすることが可能である。
　前記車両制御システムにおいて、前記車両姿勢スタビライジング制御部は、車速が高いほど車輪に制動トルクを付与するブレーキ制御によって付与するヨーモーメント制御量を大きくし、車速が低いほど転舵角を制御する転舵制御によって付与するヨーモーメント制御量を大きくする構成とすることが可能である。
　前記車両制御システムにおいて、前記走行路規定線認識部は、複数のカメラが同一の対象物を撮影したときに発生する視差を利用して距離を計測するステレオカメラを採用することが可能である。
　以上、本発明の幾つかの実施形態のみを説明したが、本発明の新規の教示や利点から実質的に外れることなく例示の実施形態に、多様な変更または改良を加えることが可能であることが当業者には容易に理解できるであろう。従って、その様な変更または改良を加えた形態も本発明の技術的範囲に含むことを意図する。
　本願は、２０１３年５月３１日出願の日本特許出願番号２０１３－１１６３１９号に基づく優先権を主張する。２０１３年５月３１日出願の日本特許出願番号２０１３－１１６３１９号の明細書、特許請求の範囲、図面及び要約書を含む全ての開示内容は、参照により全体として本願に組み込まれる。
　日本特許公開公報第２００４-３４５４６０号（特許文献１）の明細書、特許請求の範囲、図面及び要約書を含む全ての開示は、参照により全体として本願に組み込まれる。
1　　走行環境認識システム
2　　電動パワーステアリング
3　　油圧ブレーキユニット
4　　ブレーキブースタ
5　　ステアリングホイール
10　　電子制御ユニット
11　　車両運動検出センサ
20　　逸脱傾向算出部
21　　車両姿勢スタビライジング制御部
22　　走行路規定線認識部
24　　交差時間算出部
25　　仮想走行路規定線算出部
26　　作動要否判定部
310　　ステレオカメラ

Claims (17)

  1. 　車両制御システムであって、
    　自車両の進行方向領域の情報から走行路の走行路規定線を認識する走行路規定線認識部と、
    　自車両から進行方向に延びる進行方向仮想線を認識し、前記進行方向仮想線と前記走行路規定線とのなす角に応じてヨーモーメント制御量を付与する車両姿勢スタビライジング制御部と、を備えた車両制御システム。
  2. 　請求項１に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、車輪に制動トルクを付与するブレーキ制御によってヨーモーメント制御量を付与する、車両制御システム。
  3. 　請求項１に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、転舵角を制御する転舵制御によってヨーモーメント制御量を付与する、車両制御システム。
  4. 　請求項１に記載の車両制御システムにおいて、
    　前記走行路規定線との交点における前記走行路規定線の接線である仮想走行路規定線を認識する仮想走行路規定線認識部を備え、
    　前記車両姿勢スタビライジング制御部は、前記進行方向仮想線と前記仮想走行路規定線のなす角と、自車両の旋回半径に応じた曲率との差分である交差角に応じてヨーモーメント制御量を付与する、車両制御システム。
  5. 　請求項４に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、前記交差角が所定以上となったときにヨーモーメント制御量を付与する、車両制御システム。
  6. 　請求項１に記載の車両制御システムにおいて、
    　車速に基づいて前記進行方向仮想線と前記走行路規定線との交点に到達するまでの交差時間を算出する交差時間算出部を設け、
    　前記車両姿勢スタビライジング制御部は、前記交差時間が所定時間未満となったときにヨーモーメント制御量を付与する、車両制御システム。
  7. 　請求項１に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、車速が所定値以上のときは、車輪に制動トルクを付与するブレーキ制御によってヨーモーメント制御量を付与し、車速が所定値未満のときは、転舵角を制御する転舵制御によってヨーモーメント制御量を付与する、車両制御システム。
  8. 　請求項１に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、車速が高いほど車輪に制動トルクを付与するブレーキ制御によって付与するヨーモーメント制御量を大きくし、車速が低いほど転舵角を制御する転舵制御によって付与するヨーモーメント制御量を大きくする、車両制御システム。
  9. 　請求項１に記載の車両制御システムにおいて、
    　前記走行路規定線認識部は、複数のカメラが同一の対象物を撮影したときに発生する視差を利用して距離を計測するステレオカメラである車両制御システム。
  10. 　車両制御システムであって、
    　複数のカメラが同一の対象物を撮影したときに発生する視差を利用して距離を計測し、走行路の走行路規定線を認識するステレオカメラと、
    　自車両から進行方向に延びる進行方向仮想線を認識し、前記進行方向仮想線と前記走行路規定線とのなす角に応じてヨーモーメント制御量を付与する車両姿勢スタビライジング制御部と、を備えている車両制御システム。
  11. 　請求項１０に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、車輪に制動トルクを付与するブレーキ制御によってヨーモーメント制御量を付与する、車両制御システム。
  12. 　請求項１１に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、転舵角を制御する転舵制御によってヨーモーメント制御量を付与する、車両制御システム。
  13. 　請求項１２に記載の車両制御システムにおいて、
    　前記走行路規定線との交点における前記走行路規定線の接線である仮想走行路規定線を認識する仮想走行路規定線認識部を備え、
    　前記車両姿勢スタビライジング制御部は、前記進行方向仮想線と前記仮想走行路規定線のなす角と、自車両の旋回半径に応じた曲率との差分である交差角に応じてヨーモーメント制御量を付与する、車両制御システム。
  14. 　請求項１３に記載の車両制御システムにおいて、
    前記車両姿勢スタビライジング制御部は、前記交差角が所定以上となったときにヨーモーメント制御量を付与する、車両制御システム。
  15. 　請求項１０に記載の車両制御システムにおいて、
    　車速に基づいて前記進行方向仮想線と前記走行路規定線との交点に到達するまでの交差時間を算出する交差時間算出部を設け、
    　前記車両姿勢スタビライジング制御部は、前記交差時間が所定時間未満となったときにヨーモーメント制御量を付与する、車両制御システム。
  16. 　請求項１０に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、車速が所定値以上のときは、車輪に制動トルクを付与するブレーキ制御によってヨーモーメント制御量を付与し、車速が所定値未満のときは、転舵角を制御する転舵制御によってヨーモーメント制御量を付与する、車両制御システム。
  17. 　請求項１０に記載の車両制御システムにおいて、
    　前記車両姿勢スタビライジング制御部は、車速が高いほど車輪に制動トルクを付与するブレーキ制御によって付与するヨーモーメント制御量を大きくし、車速が低いほど転舵角を制御する転舵制御によって付与するヨーモーメント制御量を大きくする、車両制御システム。
PCT/JP2014/063920 2013-05-31 2014-05-27 車両制御システム WO2014192719A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN201480029922.3A CN105492280B (zh) 2013-05-31 2014-05-27 车辆控制系统
KR1020157032075A KR101745237B1 (ko) 2013-05-31 2014-05-27 차량 제어 시스템
US14/893,680 US9643600B2 (en) 2013-05-31 2014-05-27 Vehicle control system
DE112014002584.4T DE112014002584T5 (de) 2013-05-31 2014-05-27 Fahrzeugsteuerungssystem

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2013-116319 2013-05-31
JP2013116319A JP6049541B2 (ja) 2013-05-31 2013-05-31 車両制御システム

Publications (1)

Publication Number Publication Date
WO2014192719A1 true WO2014192719A1 (ja) 2014-12-04

Family

ID=51988748

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2014/063920 WO2014192719A1 (ja) 2013-05-31 2014-05-27 車両制御システム

Country Status (6)

Country Link
US (1) US9643600B2 (ja)
JP (1) JP6049541B2 (ja)
KR (1) KR101745237B1 (ja)
CN (1) CN105492280B (ja)
DE (1) DE112014002584T5 (ja)
WO (1) WO2014192719A1 (ja)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102015203270A1 (de) * 2015-02-24 2016-08-25 Robert Bosch Gmbh Verfahren und Vorrichtung zum Anpassen einer Fahrzeuggeschwindigkeit für ein Fahrzeug
JP6456761B2 (ja) * 2015-04-21 2019-01-23 本田技研工業株式会社 道路環境認識装置、車両制御装置及び車両制御方法
JP6460039B2 (ja) * 2016-04-27 2019-01-30 トヨタ自動車株式会社 レーン維持制御装置
JP6617654B2 (ja) * 2016-07-15 2019-12-11 株式会社デンソー 車両の運転支援装置
JP6809023B2 (ja) * 2016-08-02 2021-01-06 いすゞ自動車株式会社 操舵補助装置及び操舵補助方法
KR102416765B1 (ko) 2016-12-15 2022-07-04 현대자동차주식회사 주행 안정성 확보를 위한 후륜 제동 제어 방법
WO2018123641A1 (ja) * 2016-12-27 2018-07-05 日立オートモティブシステムズ株式会社 走行可能領域検出装置及び走行支援システム
DE102017000526A1 (de) 2017-01-20 2018-07-26 Trw Automotive Gmbh Horizontstabilisierte Fahrzeug-Lateralsteuerung
JP6766798B2 (ja) * 2017-12-15 2020-10-14 株式会社デンソー 道路地図生成システム及び道路地図生成方法
JP7024372B2 (ja) * 2017-12-18 2022-02-24 日産自動車株式会社 車両の操舵状態判定方法および車両の操舵状態判定装置
CN111523471B (zh) * 2020-04-23 2023-08-04 阿波罗智联(北京)科技有限公司 车辆所在车道的确定方法、装置、设备以及存储介质
JP2022095041A (ja) * 2020-12-16 2022-06-28 株式会社Subaru 車両制御装置

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004034792A (ja) * 2002-07-02 2004-02-05 Nissan Motor Co Ltd 車線逸脱防止方法、及び車線逸脱防止装置
JP2006182308A (ja) * 2004-12-28 2006-07-13 Nissan Motor Co Ltd 車線逸脱防止装置
JP2010009361A (ja) * 2008-06-27 2010-01-14 Denso Corp 車線逸脱警報装置
JP2010089701A (ja) * 2008-10-10 2010-04-22 Hitachi Automotive Systems Ltd 走行支援装置
JP2011073530A (ja) * 2009-09-30 2011-04-14 Hitachi Automotive Systems Ltd 走行支援装置
JP2012123495A (ja) * 2010-12-07 2012-06-28 Hitachi Automotive Systems Ltd 走行環境認識装置
JP2012131428A (ja) * 2010-12-22 2012-07-12 Fuji Heavy Ind Ltd 車両の統合制御装置
JP2013018326A (ja) * 2011-07-08 2013-01-31 Mitsubishi Motors Corp 車両旋回挙動制御装置

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004345460A (ja) 2003-05-21 2004-12-09 Koyo Seiko Co Ltd 自動操舵システム
JP4419997B2 (ja) * 2006-08-28 2010-02-24 トヨタ自動車株式会社 電動パワーステアリング装置
DE102013100578B4 (de) * 2012-01-25 2024-02-01 Denso Corporation Spurhalte-Steuersystem

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004034792A (ja) * 2002-07-02 2004-02-05 Nissan Motor Co Ltd 車線逸脱防止方法、及び車線逸脱防止装置
JP2006182308A (ja) * 2004-12-28 2006-07-13 Nissan Motor Co Ltd 車線逸脱防止装置
JP2010009361A (ja) * 2008-06-27 2010-01-14 Denso Corp 車線逸脱警報装置
JP2010089701A (ja) * 2008-10-10 2010-04-22 Hitachi Automotive Systems Ltd 走行支援装置
JP2011073530A (ja) * 2009-09-30 2011-04-14 Hitachi Automotive Systems Ltd 走行支援装置
JP2012123495A (ja) * 2010-12-07 2012-06-28 Hitachi Automotive Systems Ltd 走行環境認識装置
JP2012131428A (ja) * 2010-12-22 2012-07-12 Fuji Heavy Ind Ltd 車両の統合制御装置
JP2013018326A (ja) * 2011-07-08 2013-01-31 Mitsubishi Motors Corp 車両旋回挙動制御装置

Also Published As

Publication number Publication date
JP2014234062A (ja) 2014-12-15
JP6049541B2 (ja) 2016-12-21
US20160107640A1 (en) 2016-04-21
CN105492280A (zh) 2016-04-13
CN105492280B (zh) 2018-06-29
KR101745237B1 (ko) 2017-06-08
KR20150143618A (ko) 2015-12-23
US9643600B2 (en) 2017-05-09
DE112014002584T5 (de) 2016-03-31

Similar Documents

Publication Publication Date Title
JP6035207B2 (ja) 車両制御システム
WO2014192719A1 (ja) 車両制御システム
JP6108974B2 (ja) 車両制御システム
JP6183799B2 (ja) 車両制御システム
WO2014192721A1 (ja) 車両制御システム
US11511741B2 (en) Lane keep assist device
EP3357777B1 (en) Lane change system
JP5080602B2 (ja) 車両制御装置
JP5783204B2 (ja) 運転支援装置および運転支援方法
US9238463B2 (en) Driving assistance system for vehicle and system for estimating frictional state of road surface
JP5774966B2 (ja) 車両の障害物回避装置

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 201480029922.3

Country of ref document: CN

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

Ref document number: 14804231

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 20157032075

Country of ref document: KR

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 14893680

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 112014002584

Country of ref document: DE

122 Ep: pct application non-entry in european phase

Ref document number: 14804231

Country of ref document: EP

Kind code of ref document: A1