WO2022130701A1 - 車両制御装置 - Google Patents

車両制御装置 Download PDF

Info

Publication number
WO2022130701A1
WO2022130701A1 PCT/JP2021/031904 JP2021031904W WO2022130701A1 WO 2022130701 A1 WO2022130701 A1 WO 2022130701A1 JP 2021031904 W JP2021031904 W JP 2021031904W WO 2022130701 A1 WO2022130701 A1 WO 2022130701A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
lane
control device
blind spot
track
Prior art date
Application number
PCT/JP2021/031904
Other languages
English (en)
French (fr)
Inventor
龍 稲葉
勇樹 堀田
Original Assignee
日立Astemo株式会社
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 日立Astemo株式会社 filed Critical 日立Astemo株式会社
Priority to US18/252,967 priority Critical patent/US20230415749A1/en
Priority to DE112021005361.2T priority patent/DE112021005361T5/de
Publication of WO2022130701A1 publication Critical patent/WO2022130701A1/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
    • 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
    • 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
    • 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
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • 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
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • 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
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • 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
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18163Lane change; Overtaking manoeuvres
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • B60W60/00272Planning or execution of driving tasks using trajectory prediction for other traffic participants relying on extrapolation of current movement
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S13/589Velocity or trajectory determination systems; Sense-of-movement determination systems measuring the velocity vector
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/86Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
    • G01S13/865Combination of radar systems with lidar systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/86Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
    • G01S13/867Combination of radar systems with cameras
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/89Radar or analogous systems specially adapted for specific applications for mapping or imaging
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/10Number of lanes
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/53Road markings, e.g. lane marker or crosswalk
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4042Longitudinal 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4043Lateral 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4046Behavior, e.g. aggressive or erratic
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/801Lateral distance
    • 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/40High definition maps
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9315Monitoring blind spots

Definitions

  • the present invention relates to a vehicle control device having a function of generating a target trajectory and controlling follow-up of a vehicle such as an automobile, particularly an own vehicle during automatic driving.
  • An object of the present invention is to realize a vehicle control device capable of suppressing unnecessary lane change operation of the own vehicle and suppressing deterioration of riding comfort.
  • the present invention is configured as follows.
  • the periphery of the own vehicle is based on the peripheral condition detection sensor that detects the peripheral condition of the own vehicle and the feature amount extracted from the peripheral condition and the map information of the own vehicle detected by the peripheral condition detection sensor.
  • the blind spot object estimation processing unit that calculates the blind spot area and estimates the behavior tendency of the object existing in the blind spot region and the object, and the behavior tendency of the object estimated by the blind spot object estimation processing unit.
  • the potential risk map generation unit that generates a region where the risk of the own vehicle approaching the object is latent, and the lane change track of the own vehicle generated from the surrounding situation of the own vehicle and the map information.
  • the operation of the own vehicle is controlled according to the automatic driving planning unit that compares the changed track with the latent risk map and determines whether or not the lane of the own vehicle can be changed, and the automatic driving planning unit that determines whether or not the lane can be changed. It is equipped with a vehicle motion control unit.
  • FIG. It is a block diagram of the control device for automatic driving mounted on the vehicle control device. It is a block diagram of the risk map generation part included in the control device for a vehicle. It is a block diagram of a blind spot object estimation processing unit. It is a block diagram of the automatic operation planning part. It is a block diagram of a lane change track generation part. It is a state transition diagram of the lane change state management unit. It is a flowchart of the process executed in the lane change start determination state. It is a flowchart of the process executed in the lane change execution state. It is a flowchart of the process executed in the lane change completion state.
  • FIG. 1 It is a flowchart of the process executed in the lane change cancel state. It is explanatory drawing of the operation which changes a lane based on the prediction result of an object. It is a state transition diagram of the lane change track generation part in Example 2.
  • FIG. It is a flowchart of the lane change start judgment state. It is a flowchart of the blind spot safety confirmation state. It is explanatory drawing which showed the movement of own vehicle in Example 2.
  • FIG. It is explanatory drawing about the orbit generated after the blind spot reduction is completed. It is explanatory drawing of the state when the lane change is completed. It is explanatory drawing of the blind spot area. It is an operation explanatory diagram of the latent risk map generation part.
  • FIG. 1 It is a flowchart of the process executed in the lane change cancel state. It is explanatory drawing of the operation which changes a based on the prediction result of an object. It is a state transition diagram of the lane change track generation part in Example 2.
  • FIG. It
  • FIG. 3 is an operation explanatory diagram of a scene in which the own vehicle is traveling in the merging lane and is about to merge into the traveling lane which is the main lane in the third embodiment.
  • FIG. 3 is an explanatory diagram of a method of generating a blind spot reduction track so as to reduce the blind spot of a vehicle in the third embodiment.
  • FIG. 1 is an explanatory diagram showing an overall configuration of a vehicle 500 equipped with a vehicle control device 1 according to a first embodiment of the present invention.
  • the FL wheel means the left front wheel
  • the FR wheel means the right front wheel
  • the RL wheel means the left rear wheel
  • the RR wheel means the right rear wheel.
  • the vehicle 500 has command values to the steering control mechanism 10, the brake control mechanism 13, and the throttle control mechanism 20 for controlling the traveling direction of the vehicle 500 based on the information from the sensors 2, 3, 4, and 5 that recognize the outside world.
  • the vehicle control device 1 for calculating the above is provided.
  • the vehicle 500 controls the steering control device 8 that controls the steering control mechanism 10 based on the command value from the vehicle control device 1, and the brake control mechanism 13 that controls the brake control mechanism 13 based on the command value from the vehicle control device 1 to brake each wheel.
  • a braking control device 15 that adjusts the force distribution
  • an acceleration control device 19 that controls the throttle control mechanism 20 based on the command value from the vehicle control device 1 and adjusts the torque output of the engine, and a travel plan of the vehicle 500 and its surroundings. It is provided with a display device 24 for displaying the behavior prediction of the moving body.
  • the sensors 2, 3, 4, and 5 that recognize the outside world are a camera 2 in front, a laser radar 3, 4 in the left and right sides, and a millimeter wave radar 5 in the rear, and are relative to the vehicle 500, which is the own vehicle, and surrounding vehicles. Distance and relative velocity can be detected. Further, the communication device 23 for communicating between road vehicles or vehicles is provided. In the first embodiment, the combination of the above sensors is shown as an example of the sensor configuration, but the present invention is not limited to this, and a combination with an ultrasonic sensor, a stereo camera, an infrared camera, or the like may be used. The sensor signal is input to the vehicle control device 1.
  • the vehicle control device 1 includes, for example, a CPU, a ROM, a RAM, and an input / output device.
  • the ROM stores the flow of vehicle travel control described below.
  • the vehicle control device 1 calculates the command values of the steering control mechanism 10, the brake control mechanism 13, and the throttle control mechanism 20, which are actuators for controlling the vehicle travel according to the generated travel plan.
  • the steering control mechanism 10, the brake control mechanism 13, the steering control device 8, the braking control device 15, and the acceleration control device 19, which are the control devices of the throttle control mechanism 20, receive the command value of the vehicle control device 1 by communication, and the command is given. Control each actuator based on the value.
  • the pedaling force of the driver stepping on the brake pedal 12 is boosted by the brake booster (not shown), and the master cylinder (not shown) generates hydraulic pressure according to the force. ..
  • the generated hydraulic pressure is supplied to the foil cylinders 16FL, 16FR, 16RL, and 16RR via the brake control mechanism 13.
  • the foil cylinders 16FL, 16FR, 16RL, 16RR are composed of a cylinder (not shown), a piston, a pad, etc., and the piston is propelled by the hydraulic fluid supplied from the master cylinder 9, and the pad connected to the piston is formed. Pressed by the disc rotor. The disc rotor rotates together with the wheels (not shown). Therefore, the brake torque acting on the disc rotor becomes the braking force acting between the wheel and the road surface.
  • braking force can be generated on each wheel according to the driver's brake pedal operation.
  • the braking control device 15 has, for example, a CPU, a ROM, a RAM, and an input / output device like the vehicle control device 1.
  • the braking control device 15 includes a combine sensor 14 capable of detecting front-rear acceleration, lateral acceleration, and yaw rate, wheel speed sensors 11FL, 11FR, 11RL, and 11RR installed on each wheel, and a brake from the above-mentioned braking control device 15.
  • a force command and a sensor signal from the handle angle detecting device 21 are input via the steering control device 8 described later.
  • the output of the braking control device 15 is connected to a brake control mechanism 13 having a pump (not shown) and a control valve, and generates an arbitrary braking force on each wheel independently of the driver's brake pedal operation. be able to.
  • the braking control device 15 estimates the spin, drift-out, and wheel lock of the vehicle based on the above information, generates the braking force of the corresponding wheel so as to suppress them, and plays a role of improving the steering stability of the driver. ing.
  • the vehicle control device 1 can generate an arbitrary braking force on the vehicle 500 by communicating a brake command to the braking control device 15, and automatically brakes in automatic driving in which the driver does not operate. It has a role to play.
  • the present invention is not limited to the braking control device 15, and other actuators such as a brake-by-wire may be used.
  • the steering torque detection device 7 and the steering wheel angle detection device 21 detect the steering torque and the steering wheel angle input by the driver via the steering wheel 6, respectively, and steer based on the information.
  • the control device 8 controls a motor (not shown) to generate an assist torque.
  • the steering control device 8 is not shown in detail in FIG. 1, it also has, for example, a CPU, a ROM, a RAM, and an input / output device, like the vehicle control device 1.
  • the steering control mechanism 10 is movable by the resultant force of the steering torque of the driver and the assist torque of the motor, and the front wheels FL and FR are cut off.
  • the reaction force from the road surface is transmitted to the steering control mechanism 10 according to the turning angles of the front wheels FL and FR, and is transmitted to the driver as the road surface reaction force.
  • the steering control device 8 can control the steering control mechanism 10 by generating torque by a motor independently of the steering operation of the driver. Therefore, the vehicle control device 1 can control the front wheel FL and FR to an arbitrary turning angle by communicating the steering force command to the steering control device 8, and is automatically in automatic driving without driver operation. It plays the role of steering.
  • the present invention is not limited to the steering control device 8, and other actuators such as steer-by-wire may be used.
  • the acceleration control device 19 is not shown in detail in FIG. 1, it also has, for example, a CPU, a ROM, a RAM, and an input / output device, like the vehicle control device 1.
  • the acceleration control device 19 controls the engine by adjusting the throttle opening according to the accelerator pedal depression amount.
  • the vehicle can be accelerated according to the driver's accelerator pedal operation.
  • the acceleration control device 19 can control the throttle opening independently of the accelerator operation of the driver. Therefore, the vehicle control device 1 can generate an arbitrary acceleration in the vehicle 500 by communicating the acceleration command to the acceleration control device 19, and automatically accelerates in the automatic driving in which the driver does not operate. It has a role.
  • the vehicle control device 1 includes an automatic driving planning unit 201 that plans the operation of the own vehicle for automatically driving the own vehicle to a destination, which will be described later, and automatically puts the own vehicle in a parking frame in a parking lot or the like. Controls each actuator such as the automatic parking planning unit 202 that plans the operation of the own vehicle for parking, the vehicle motion control unit 203 that generates command values for controlling the vehicle motion of the autonomous driving vehicle, and the engine, brake, and steering. It is assumed that there are an actuator control unit 204 and a risk map generation unit 205 for the purpose, and they are mounted on different controllers.
  • a vehicle network 206 for communicating between each controller is required.
  • the vehicle network 206 may be wirelessly connected in addition to the wired connection.
  • the automatic parking calculation unit 202 and the automatic operation planning unit 201 are mounted on the same hardware.
  • the actuator control unit 204 may be mounted on different hardware such as an engine control controller and a brake control controller.
  • the vehicle motion control unit 203 controls the operation of the own vehicle 81 according to the determination by the automatic driving planning unit 201 whether or not the lane can be changed.
  • the information of the surrounding environment obtained based on the information of the radar 301, the stereo camera 302, the vehicle sensor 303, and the rider 304 is input to the sensor information processing unit 305, and the moving object existing around the own vehicle is input. Convert to object information.
  • the radar 301, stereo camera 302, vehicle sensor 303, and rider 304 are sensors that recognize the outside world.
  • the radar 301 emits radio waves toward an object and measures the reflected wave to measure the distance and direction to the object.
  • the stereo camera 302 can also record information in the depth direction by simultaneously photographing an object from a plurality of different directions.
  • the vehicle sensor 303 is a sensor that measures the speed of the vehicle and the number of rotations of the tires, information that calculates the average position of the automatically driven vehicle using GNSS (Global Positioning Satellite System), and navigation by a person occupying the automatically driven vehicle.
  • GNSS Global Positioning Satellite System
  • the lidar 304 measures the scattered light with respect to the laser irradiation emitted in a pulse shape, and detects the distance to an object at a long distance.
  • attribute information such as pedestrians, bicycles, and vehicles, and their current positions and current velocity vectors are extracted.
  • moving objects include parked vehicles that may move in the future even if the speed obtained at the current time is zero.
  • a storage unit 308 that stores road information and traffic light information about the target point and its surroundings from the point where the own vehicle starts automatic driving, route information from the current position to the target point, a traffic rule database of the section to be traveled, and the like. ..
  • the self-position estimation processing unit 310 There is also a point cloud database used by the self-position estimation processing unit 310. In addition, based on the lane center line information of the road and the traffic light information necessary for performing automatic driving based on the information stored in the storage unit 308, the lighting information of the traffic light that the automatically driving vehicle is scheduled to pass is organized. There is a map information processing unit 306 for making it a usable format. Further, the self-position estimation processing unit 310, which will be described later, estimates the location of the own vehicle based on the peripheral information obtained by the sensor, the point cloud database, the steering angle of the vehicle, the vehicle speed, and the information obtained by the GNSS. do.
  • the three-dimensional object behavior prediction unit 307 calculates future position and velocity information (object prediction information) of each moving object based on the input information.
  • the position R (X (T), Y (T)) of each object at the future time T is predicted based on the object information.
  • the following linear prediction formula (1) is used. , A method of performing prediction calculation can be considered.
  • the calculation method here assumes a constant velocity linear motion in which each object moves while maintaining its current velocity in the future time. This makes it possible to predict many objects in a short time.
  • the three-dimensional object behavior prediction result and map information, and the blind spot object estimation information generated by the blind spot object estimation processing unit 311 described later are input to the latent risk map generation unit 309.
  • the autonomous driving vehicle does not collide with other vehicles and three-dimensional objects existing around the own vehicle, and the route information and the current vehicle state (speed, position, orientation, etc.) are displayed. Based on this, the potential risk map around the own vehicle is calculated.
  • the blind spot object estimation processing unit 311 is based on the peripheral situation of the own vehicle 81 detected by the peripheral situation detection sensors such as the radar 301, the stereo camera 302, the vehicle sensor 303, and the rider 304, and the feature amount extracted from the map information.
  • the blind spot area around 81 is calculated, and the object existing in the calculated blind spot area and the behavioral tendency of the object are estimated.
  • the blind spot object estimation processing unit 311 will be described with reference to FIG. Here, first, the blind spot area is detected based on the road information stored in the storage unit 308, the map information as a result of processing them, and the information of each in-vehicle sensor.
  • the blind spot area is a state in which the background of the object cannot be detected by the peripheral vehicle 1901 existing around the own vehicle 81, the fence or the hedge 1902 existing on the road, or the like as shown in FIG. Defined as a blind spot area. If there is a blind spot area 1903 on the road on which the own vehicle 81 is going to pass, an object may pop out from the blind spot area 1903, and there is a possibility of collision with the own vehicle 81 or a collision with the object. If it is necessary to make an emergency stop to prevent it, the ride quality may deteriorate in those cases.
  • the blind spot area detection unit 401 detects the blind spot area based on the road information, the map information as a result of processing them, and the information in the range that can be detected by each in-vehicle sensor. Then, the blind spot area detection unit 401 outputs the detected blind spot area information to the blind spot object estimation unit 402.
  • the blind spot object estimation unit 402 estimates the type or type or behavioral tendency of an object that may be hidden in the blind spot area, or all of them, based on the blind spot area information.
  • the type of the object hidden in the blind spot area is estimated based on the following road conditions.
  • the latent risk map generation unit 309 generates a region where the risk of the own vehicle 81 approaching the object is latent, based on the behavior tendency of the object estimated by the blind spot object estimation processing unit 311.
  • the method of calculating the potential risk is the following four steps.
  • Step 1 Obtain the time for the own vehicle 81 to reach the lane change position Pc.
  • the time (T_self [sec]) for the own vehicle 81 to reach the lane change position Pc that completes the lane change is calculated based on the following equation (2).
  • the lane change position Pc at which the lane change is completed is an intersection with a curve that smoothly connects to the center line of the lane change destination lane.
  • V_old (t) in the equation (2) is the speed profile planned at the pre-sampling time
  • M is the distance to the position where the lane change is completed.
  • Step 2 Determine the length of potential risk LIRP .
  • the length L IRP of the latent risk is defined as (predicted speed u [m / s] of the popping object) ⁇ (time [s] for the own vehicle 81 to reach the position where the lane change is completed). , Calculate with the following equation (3).
  • Step 3 Obtain the pop-out coordinate position PA.
  • the jump-out coordinate position PA is an extension of the area boundary (one-dot chain line in the figure) that divides the blind spot that cannot be detected by the sensor by the following vehicle 82, and the extension of the lane to which the lane change destination PA is located (broken line). It is the intersection with)).
  • Step 4 Generate a potential risk map.
  • the point PB is calculated based on the pop-out coordinate position PA and the length L IRP of the latent risk map obtained in step 3, and the region from the pop-out coordinate position PA to the point PB is used as the latent risk map.
  • the shape of the latent risk map may be a quadrangle whose length is LIRP and whose width is the lane width, or it may be a partial shape of an ellipse whose width becomes narrower as it gets closer to the point PB from the coordinate position PA. ..
  • the automatic driving planning unit 201 generates a lane change track of the own vehicle 81 from the surrounding conditions and map information of the own vehicle 81, compares the generated lane change track with the latent risk map, and determines whether or not the lane change of the own vehicle 81 is possible. to decide.
  • the automated driving planning unit 201 calculates (calculates) the target trajectory based on the latent risk map, environmental information, lane information, and map information.
  • the automatic operation planning unit 201 includes an operation planning unit 501 and a track planning unit 506. Each block will be described below.
  • the operation planning unit 501 calculates the target action candidate weights that the own vehicle 81 can take based on the route information, the environmental information, and the like.
  • the target action candidate weight is the own vehicle 81 such as maintaining the current lane (LK), changing lanes from the current lane to the adjacent lane (LC), and avoiding obstacles in front (OA). It is a weight for possible actions.
  • the track planning unit 506 includes a lane keeping track generation unit 502, a lane change track generation unit 503, an obstacle avoidance track generation unit 504, and a track arbitration unit 505.
  • the lane keeping track generation unit 502 generates a track for maintaining the center of the lane in which the own vehicle 81 is currently traveling.
  • the lane change track generation unit 503 generates a lane for changing lanes to the adjacent lane of the lane in which the own vehicle 81 is currently traveling.
  • the obstacle avoidance track generation unit 504 generates a track that avoids an object that is in the lane in which the own vehicle 81 is currently traveling and that is an obstacle for traveling.
  • the track arbitration unit 505 evaluates each track based on the safety level with surrounding objects and the target action candidate weight for the lane keeping track, lane change track, and obstacle avoidance track, and determines the track with the best evaluation. select.
  • the lane change track generation unit 503 in the first embodiment will be described with reference to FIG. It is conceivable that the lane change track generation unit 503 includes a lane change state management unit 601, a lane change route generation unit 602, and a lane change speed generation unit 603. The details of the lane change state management unit 601 will be described later.
  • the lane change route generation unit 602 generates a target route for changing lanes based on the lane change state.
  • a method of generating a target path a method of generating a spline curve for a target position or the like can be considered.
  • the lane change speed generation unit 603 calculates a speed profile when the vehicle travels on the target route for the target route generated by the lane change route generation unit 602. For example, a time-series point having a velocity of 50 points is calculated at intervals of 0.1 seconds when traveling on the path for 5 seconds.
  • a method for calculating a velocity profile it is conceivable to generate velocity sequence information satisfying the following equation (4) as a candidate for the velocity profile.
  • w4 to w6 are weighting coefficients.
  • the lane change state management unit 601 is a part that manages a state when changing lanes to an adjacent lane.
  • the states include a lane change start determination state S701, a lane change execution state S702, a lane change completion state S703, and a lane change cancellation state S704. If it is determined in the lane change start determination state S701 that the lane change is possible, the state transitions to the lane change execution state S702, and if it is determined that the lane change is impossible, the transition to the lane change cancel state S704 is performed.
  • the state transitions to the lane change complete state S703, and when it is determined that the lane change is impossible due to changes in environmental conditions or the like during the lane change, the lane is changed. Transition to the change cancel state S704.
  • the process executed in the lane change start determination state S701 will be described with reference to the flowchart shown in FIG.
  • the lane change request confirmation S801 is performed.
  • the process proceeds to the lane change track generation S802.
  • the lane change route generation unit 602 and the lane change speed generation unit 603 are used to generate a track required for lane change.
  • the overlap determination between the latent risk map and the generated lane change track is performed. If it is determined that the tracks do not overlap, the process proceeds to the lane change execution state transition process S804. If it is determined in the track crossing determination S803 that there is an overlap, the lane change cancel state transition process S805 is executed. That is, the automatic driving planning unit 201 determines that the lane change is not possible when the lane change track and the potential risk map intersect.
  • each transition process the process for transitioning the state is performed based on the state transition diagram shown in FIG.
  • the process executed in the lane change execution state S702 will be described with reference to the flowchart shown in FIG.
  • the lane change track generation S802 is executed.
  • the cancel trajectory generation S902 is executed.
  • the lane change route generation unit 602 and the lane change speed generation unit 603 are used to generate a track required for lane change to cancel the lane change from the current position and return to the original lane.
  • the lane change continuation determination S903 is executed.
  • the generated lane change track and the cancel track are compared, and evaluation is performed based on the index of safety and ride quality. For example, if it is expected that there is a risk of sudden approach to other vehicles or surrounding objects when the vehicle is driven based on the lane change track, it is determined that the lane change cannot be continued, and the lane change is canceled.
  • the transition process S805 is executed.
  • the lane change control S904 is executed.
  • the generated lane change track is transmitted to the track arbitration unit 505, and when the track is selected by the track arbitration unit 505, each actuator command value is set so as to follow the track. Create and change the lane of the own vehicle 81.
  • the lane change completion determination S905 it is determined whether the position of the own vehicle 81 has completed the lane change to the adjacent lane based on the self-position information, the lane information, and the like. If it is determined to be completed in the lane change completion determination S905, the process proceeds to the lane change completion state transition process S906. If it is determined in the lane change completion determination S905 that the lane change is not completed, the lane change track generation S802 is executed again. In the lane change complete state transition process S906, a process for transitioning the lane change complete state is performed based on the state transition diagram shown in FIG. 7.
  • the process executed in the lane change completed state S703 will be described with reference to the flowchart shown in FIG.
  • the lane keeping track generation S1001 is executed.
  • a track that maintains the position of the own vehicle in the current lane is generated by using the lane change route generation unit 602 and the lane change speed generation unit 603.
  • the lane keeping control S1005 is executed.
  • the generated lane keeping track is transmitted to the track arbitration unit 505, and when the track is selected by the track arbitration unit 505, each actuator command value is set so as to follow the track. Create and keep the own vehicle 81 in the lane.
  • the lane keeping determination S1002 is executed. Here, it is determined whether the current lane can be maintained. It is determined whether the lane can be maintained for a predetermined time, and if it is determined that the lane cannot be maintained, the process returns to the lane keeping track generation S1001. If it is determined in the lane keeping determination S1002 that the lane can be maintained, the driving mode is changed to the lane keeping by the driving mode change process S1003. Then, the lane change start determination state transition process S1004 is executed. In the lane change start determination state transition process S1004, a process for transitioning to the lane change start determination state is performed based on the state transition diagram shown in FIG. 7.
  • the process executed in the lane change cancel state S704 will be described with reference to the flowchart shown in FIG.
  • the cancel track generation S1101 is executed.
  • the track for returning the own vehicle position to the original lane is generated by using the lane change route generation unit 602 and the lane change speed generation unit 603.
  • the cancel trajectory follow-up control S1105 is executed.
  • the generated cancel trajectory is transmitted to the track arbitration unit 505, and when the trajectory is selected by the track arbitration unit 505, each actuator command value is set so as to follow the trajectory. Create and return the own vehicle 81 to the original lane.
  • the lane keeping determination S1002 is executed. Here, it is determined whether the current lane can be maintained. It is determined whether the lane can be maintained for a predetermined time, and if it is determined that the lane cannot be maintained, the process returns to the canceled track generation S1101. If it is determined in the lane keeping determination S1002 that the lane can be maintained, the driving mode is changed to the lane keeping by the driving mode change process S1003. Then, the lane change start determination state transition process S1004 is executed. The lane change start determination state transition process S1004 performs a process for transitioning to the lane change start determination state based on the state transition diagram shown in FIG. 7.
  • the operation of changing lanes based on the prediction result of the object that may exist in the blind spot of the first embodiment will be described with reference to the schematic diagram of the typical scene shown in FIG.
  • the own vehicle 81 is automatically driving and traveling, and a large vehicle 1201 exists behind the own vehicle 81.
  • the millimeter-wave radar 5 which is a rear sensor tries to detect the rear of the own vehicle 81, the sensor blind spot is on the left side in the traveling direction from the blind spot branch point 1204 due to the influence of the large vehicle 1201.
  • the own vehicle 81 detects that a blind spot exists in the lane change direction of the own vehicle 81 based on the map information and the information of the sensor that recognizes the surroundings. Therefore, the own vehicle 81 generates a latent risk map 1205 of the existing area in the event that the object jumps out from the blind spot, and then generates a lane change track 1202 that does not impair the riding comfort. Therefore, the lane change track 1202 and the latent risk map 1205 are compared, and it is determined that the lane cannot be changed if the predetermined overlap condition is satisfied. In that case, the own vehicle 81 is controlled so as to follow the lane keeping track 1203 without changing the lane.
  • a risk map is generated based on the prediction of the vehicle jumping out from the blind spot, and by comparing it with the lane change track, even if the vehicle jumps out from the blind spot, the own vehicle will be the jumping vehicle. It is possible to prevent deterioration of riding comfort by eliminating the need for rapid acceleration and deceleration.
  • the first embodiment of the present invention it is possible to realize a vehicle control device capable of suppressing an unnecessary lane change operation of the own vehicle 81 and suppressing deterioration of riding comfort.
  • Example 2 Next, the vehicle control device according to the second embodiment of the present invention will be described with reference to FIG. As shown in the state transition of the lane change track generation unit 503 shown in FIG. 13, the vehicle control device 1 of the second embodiment of the present invention includes the blind spot safety confirmation state S1301. It is different from Example 1. Since the configurations shown in FIGS. 2 to 6 in the first embodiment are the same as those in the second embodiment, illustration and detailed description thereof will be omitted.
  • the automatic driving planning unit 201 determines that the lane cannot be changed
  • the blind spot reduction track 1603 is calculated, and the vehicle motion control unit 203 causes the own vehicle 81 to travel on the blind spot reduction track 1603. To control.
  • the state transition condition in the lane change start determination state S701 of FIG. 13 will be described with reference to the flowchart shown in FIG. In the first embodiment, when it is determined in the track crossing determination S803 (FIG. 8) that the crossing is performed, the state is changed to the lane change cancel state S704, but in the second embodiment, the blind spot safety confirmation state is performed. Perform the process of transitioning to S1301.
  • the blind spot safety confirmation state S1301 will be described with reference to the flowchart shown in FIG.
  • the blind spot safety confirmation state S1301 is entered, the blind spot reduction trajectory generation S1501 is executed.
  • the track is generated so that the position of the own vehicle approaches the boundary lane with the lane to which the lane is changed in the current lane.
  • the cancellation trajectory generation S1502 is executed. This is a trajectory for returning from the position when the blind spot is reduced to the position where the original lane center position is targeted.
  • the blind spot reduction continuation determination S1503 is executed.
  • the vehicle is detected from the blind spot area and is approaching the own vehicle 81, or a new object is detected, and the running safety of the own vehicle 81 cannot be guaranteed.
  • the continuation cannot be performed, and the lane change cancel state transition process S805 is executed.
  • blind spot reduction continuation S1504 controls the own vehicle 81 so as to follow the generated blind spot reduction track.
  • the blind spot reduction completion determination S1505 determines that the vehicle is sufficiently close to the boundary lane with the target lane change destination lane. As a determination method, it is conceivable to utilize the fact that the wheel on the side of reducing the blind spot of the own vehicle or the side surface of the vehicle is at a position substantially coincided with the boundary line. If the blind spot reduction is completed, the lane change track generation S802 is executed, and if it is not completed, S1501 is executed again. The operation after S802 is the same as that in FIG.
  • the lane change track 1202 was generated, but it was determined that the lane change was not possible based on the intersection determination with the potential risk map 1205. Therefore, by transitioning to the blind spot safety confirmation state S1301 (FIG. 13), a blind spot reduction track 1603 is generated, and based on the track, the own vehicle 81 travels toward the lane boundary line 1604 with the lane change destination lane. is doing. Further, it is assumed that the cancel track 1605 is generated during the blind spot reduction running, and that the vehicle returns to the center of the original traveling lane when the blind spot reduction running cannot be performed.
  • the trajectory generated after the blind spot reduction is completed will be described with reference to FIG.
  • the positional relationship with the large vehicle 1201 that generates the blind spot has changed, so that the potential risk area is relatively changed to the rear of the own vehicle 81. Therefore, when the lane change track 1701 is generated and the intersection is determined with the potential risk map 1205, it may be determined that the lane change is possible.
  • the track 1702 to the center of the original lane is selected and the original traveling position is restored. If it is determined that the lane can be changed, the lane will be changed.
  • the blind spot reduction track 1603 is a track that changes the track of the own vehicle 81 so as to reduce the lateral distance between the own vehicle 81 and the lane boundary line 1604.
  • the amount of change that reduces the lateral distance between the own vehicle 81 and the lane boundary line 1604 is smaller as the speed of the own vehicle 81 increases.
  • the same effect as that of the first embodiment can be obtained, and as described above, the convenience of the lane change function can be improved.
  • the vehicle control device 1 according to the third embodiment of the present invention will be described with reference to FIG. 21.
  • the blind spot reduction control S1504 of FIG. 15 is in a situation where the lane change destination lane is not currently running in parallel with the own lane (merging). It is a point in the scene).
  • Others have the same configuration as in the first and second embodiments, so illustration and detailed description thereof will be omitted.
  • FIG. 21 is an operation explanatory diagram of a scene in which the own vehicle 81 is traveling in the merging lane 2107 and is about to merge into the traveling lane 2106 which is the main lane.
  • the main lane is formed by a traveling lane 2106 and an overtaking lane 2109.
  • the own vehicle 81 is lane-keep controlled at the speed of the speed vector 2102 along the lane center line 2105 of the merging lane 2107.
  • the confluence area of the traveling lane 2106 is a blind spot. Therefore, the pop-out latent risk map 2104 is generated in the region of the size of the latent risk length LIRP from the pop-out position PA. Therefore, if the vehicle continues to travel in the lane keep as it is, the own vehicle 81 and the other vehicle 83 may suddenly accelerate or decelerate in the vicinity of the other vehicle 83 traveling in the traveling lane 2106.
  • the own vehicle 81 generates the blind spot reduction track 2103 so as to reduce the blind spot.
  • the generation method will be described with reference to FIG.
  • the blind spot reduction track 2103 in the merging scene is calculated by the velocity vector 2102 of the own vehicle 81 and the longitudinal vector 2201 of the latent risk map 2104.
  • the proportional vector 2204 obtained by multiplying the longitudinal vector 2201 by k is calculated.
  • the proportionality coefficient k is set so as to become smaller as the vehicle speed increases. That is, the proportional vector 2204 is calculated by multiplying the proportional coefficient k, which becomes smaller as the speed component of the own vehicle 81 increases. This is because if the own vehicle 81 is controlled so as to deviate significantly from the lane center line of the own vehicle 81 in a state where the speed of the own vehicle 81 is high, the occupant may feel uncomfortable.
  • a blind spot reduction track 2103 which is a target track for smoothly controlling the own vehicle 81, is calculated for the target position. For example, a method of using a spline interpolation curve from the current position of the own vehicle with respect to the target position can be considered.
  • blind spot reduction control can be performed not only in the scene of changing lanes to the blind spot area that occurs in the lane that runs parallel to the current lane, but also in the scene of merging into the blind spot area that occurs in the main lane as in Example 3 of this example. By doing so, it is possible to prevent sudden approach to another vehicle 83 that has jumped out of the blind spot area, and as a result, it is possible to prevent sudden acceleration / deceleration of the own vehicle 81 and the other vehicle 83.
  • the same effect as that of the first embodiment can be obtained, and as described above, even in a situation (merging scene) in which the lane change destination lane is not currently running in parallel with the own lane.
  • Vehicle 81 and other vehicles 83 can be prevented from sudden acceleration / deceleration.
  • the radar 301, stereo camera 302, vehicle sensor 303, and rider 304 can be collectively referred to as peripheral condition detection sensors that detect the peripheral condition of the own vehicle 81.
  • the deceleration frequency of the own vehicle 81 and surrounding vehicles is reduced, the vehicle steering amount is reduced, and the riding comfort is deteriorated. Can be suppressed.
  • Vehicle control device 1 ... Vehicle control device, 2 ... Camera (outside world recognition sensor), 3, 4 ... Laser radar (outside world recognition sensor), 5 ... Millimeter wave radar (outside world recognition sensor), 81 ... Own vehicle, 82 ... following vehicle, 83 ... other vehicle, 201 ... automatic driving planning unit, 202 ... automatic parking planning unit, 203 ... vehicle motion control unit, 204 ... actuator control Department, 205 ... Risk map generation unit, 206 ... Vehicle network, 301 ... Radar, 302 ... Stereo camera, 303 ... Vehicle sensor, 304 ... Rider, 305 ... Sensor information Processing unit, 306 ... Map information processing unit, 307 ... Three-dimensional object behavior prediction unit, 308 ... Storage unit, 309 ...
  • Latent risk map generation unit 310 ... Self-position estimation processing unit, 311 ... Blind spot object estimation processing unit, 401 ... Blind spot area detection unit, 402 ... Blind spot object estimation unit, 500 ... Vehicle, 501 ... Operation planning unit, 502 ... Lane maintenance track generation unit , 503 ... lane change track generation unit, 504 ... obstacle avoidance track generation unit, 505 ... track arbitration unit, 506 ... track planning unit, 601 ... lane change state management unit, 602. ⁇ ⁇ Vehicle change route generation unit, 603 ⁇ ⁇ ⁇ lane change speed generation unit, 1603, 2103 ⁇ ⁇ ⁇ blind spot reduction track

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • Mathematical Physics (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

自車両の不要な車線変更動作を抑制し、乗心地の悪化を抑制可能な車両制御装置を実現する。車両制御装置1は自車両の周辺状況を検知する周辺状況検知センサ301-304と、検知した自車両の周辺状況及び地図情報の特徴量に基づき自車両の周辺の死角領域を算出し、死角領域に存在する物体及び物体の行動傾向を推定する死角物体推定処理部311と、死角物体推定処理部311が推定した物体の行動傾向に基づき自車両が物体と接近するリスクが潜在する領域を生成する潜在リスクマップ生成部309とを備える。さらに、車両制御装置1は、自車両の周辺状況及び前記地図情報から車線変更軌道を生成し、車線変更軌道と潜在リスクマップとを比較し自車両の車線変更可否を判断する自動運転計画部201と、車線変更可否の判断に従って自車両の動作を制御する車両運動制御部203とを備える。

Description

車両制御装置
 本発明は、自動車等の車両、特に自動運転走行中の自車両の目標軌道生成および追従制御する機能を備えた車両用制御装置に関する。
 従来、自車両の周辺の物体情報を取得し、取得した物体情報および地図情報に基づき自車両の運転行動を計画し、それに基づき軌道を生成し追従するように制御するシステムが開発されている(例えば、特許文献1を参照)。
 また、住宅地などの死角が存在する道路環境において、死角に潜むオブジェクトの種類をヒヤリハットデータに基づいて予測し、そのオブジェクトの飛び出しを予測することで、より安定な自動運転を実現する手法が開発されている(例えば、特許文献2を参照)。
特開2018-62261号公報 特開2019-069659号公報
 しかしながら、従来技術における車線変更の考え方では、物体の死角からオブジェクトが実際に飛び出してきた場合には急減速が必要となり、乗り心地が悪化する可能性があった。
 本発明の目的は、自車両の不要な車線変更動作を抑制し、乗心地の悪化を抑制可能な車両制御装置を実現することである。
 上記目的を達成するため、本発明は次のように構成される。
 車両制御装置において、自車両の周辺状況を検知する周辺状況検知センサと、前記周辺状況検知センサが検知した自車両の前記周辺状況及び地図情報から抽出される特徴量に基づき、前記自車両の周辺の死角領域を算出し、算出した前記死角領域に存在する物体及び前記物体の行動傾向を推定する死角物体推定処理部と、前記死角物体推定処理部が推定した前記物体の行動傾向に基づいて、前記自車両が前記物体と接近するリスクが潜在する領域を生成する潜在リスクマップ生成部と、前記自車両の周辺状況及び前記地図情報から前記自車両の車線変更軌道を生成し、生成した前記車線変更軌道と前記潜在リスクマップとを比較し、前記自車両の車線変更可否を判断する自動運転計画部と、前記自動運転計画部による前記車線変更可否の判断に従って、前記自車両の動作を制御する車両運動制御部と、を備える。
 本発明によれば、自車両の不要な車線変更動作を抑制し、乗心地の悪化を抑制可能な車両制御装置を実現することができる。本発明のその他の構成、作用、効果については以下の実施例において詳細に説明する。
実施例1による車両制御装置を搭載した車両の全体構成を示した説明図である。 車両制御装置に実装されている自動運転用制御装置のブロック図である。 車両用制御装置に含まれるリスクマップ生成部のブロック図である。 死角物体推定処理部のブロック図である。 自動運転計画部のブロック図である。 車線変更軌道生成部のブロック図である。 車線変更状態管理部の状態遷移図である。 車線変更開始判断状態において実行される処理のフローチャートである。 車線変更実行状態において実行される処理のフローチャートである。 車線変更完了状態において実行される処理のフローチャートである。 車線変更キャンセル状態において実行される処理のフローチャートである。 オブジェクトの予測結果に基づいて車線変更する動作の説明図である。 実施例2における車線変更軌道生成部の状態遷移図である。 車線変更開始判断状態のフローチャートである。 死角安全性確認状態のフローチャートである。 実施例2における自車両の動きを示した説明図である。 死角低減完了後に生成する軌道についての説明図である。 車線変更が完了された際の状態の説明図である。 死角領域の説明図である。 潜在リスクマップ生成部の動作説明図である。 実施例3において、自車両が合流車線を走行し、本線である走行車線に合流しようとしているシーンの動作説明図である。 実施例3において、車両の死角を低減させるように死角低減軌道を生成する方法の説明図である。
 以下、本発明の実施形態を図面に基づいて詳細に説明する。
 (実施例1)
 図1は、本発明の実施例1による車両制御装置1を搭載した車両500の全体構成を示した説明図である。
 図1において、FL輪は左前輪、FR輪は右前輪、RL輪は左後輪、RR輪は右後輪をそれぞれ意味する。
 車両500は、外界を認識するセンサ2、3、4、5からの情報に基づき、車両500の進行方向を制御するためのステアリング制御機構10、ブレーキ制御機構13、スロットル制御機構20への指令値を演算する車両制御装置1を備える。
 また、車両500は、車両制御装置1からの指令値に基づきステアリング制御機構10を制御する操舵制御装置8と、車両制御装置1からの指令値に基づきブレーキ制御機構13を制御し各輪のブレーキ力配分を調整する制動制御装置15と、車両制御装置1からの指令値に基づきスロットル制御機構20を制御しエンジンのトルク出力を調整する加速制御装置19と、車両500の走行計画や周辺に存在する移動体の行動予測等を表示する表示装置24とを備える。
 外界を認識するセンサ2、3、4、5は、前方にカメラ2、左右側方にレーザレーダ3、4、後方にミリ波レーダ5であり、自車である車両500と周囲車両との相対距離及び相対速度を検出することができる。また、路車間または車々間の通信を行う通信装置23を備える。なお、本実施例1では、センサ構成の一例として上記センサの組み合わせを示しているが、それに限定するものではなく、超音波センサ、ステレオカメラ、赤外線カメラなどとの組み合わせでもよい。上記センサ信号が、車両制御装置1に入力される。
 車両制御装置1は、図1に詳細には示していないが、例えば、CPU、ROM、RAM及び入出力装置を有する。上記ROMには、以下で説明する車両走行制御のフローが記憶されている。詳細は後述するが、車両制御装置1は、生成した走行計画に従って車両走行を制御するためのアクチュエータであるステアリング制御機構10、ブレーキ制御機構13、スロットル制御機構20の指令値を演算する。ステアリング制御機構10、ブレーキ制御機構13、スロットル制御機構20の制御装置である操舵制御装置8、制動制御装置15、加速制御装置19は、車両制御装置1の指令値を通信により受信し、当該指令値に基づき各アクチュエータを制御する。
 次に、ブレーキの動作について説明する。ドライバが車両500を運転している状態では、ドライバのブレーキペダル12を踏む踏力を、ブレーキブースタ(不図示)で倍力し、マスタシリンダ(不図示)によって、その力に応じた油圧を発生させる。発生した油圧は、ブレーキ制御機構13を介して、ホイルシリンダ16FL、16FR、16RL、16RRに供給される。
 ホイルシリンダ16FL、16FR、16RL、16RRは、シリンダ(不図示)、ピストン、パッド、等から構成されており、マスタシリンダ9から供給された作動液によってピストンが推進され、ピストンに連結されたパッドがディスクロータに押圧される。なお、ディスクロータは、車輪(不図示)とともに回転している。そのため、ディスクロータに作用したブレーキトルクは、車輪と路面との間に作用するブレーキ力となる。
 以上により、ドライバのブレーキペダル操作に応じて、各輪に制動力が発生させることができる。
 制動制御装置15は、図1に詳細に示していないが、車両制御装置1と同様に例えばCPU、ROM、RAM及び入出力装置を有する。制動制御装置15には、前後加速度、横加速度、ヨーレートを検出可能なコンバインセンサ14と、各輪に設置された車輪速センサ11FL、11FR、11RL、11RRと、上述の制動制御装置15からのブレーキ力指令と、後述する操舵制御装置8を介しハンドル角検出装置21からのセンサ信号が入力されている。
 また、制動制御装置15の出力は、ポンプ(不図示)、制御バルブを有するブレーキ制御機構13に接続されており、ドライバのブレーキペダル操作とは独立に、各輪に任意の制動力を発生させることができる。制動制御装置15は、上記情報に基づいて車両のスピン、ドリフトアウト、車輪のロックを推定し、それらを抑制するように該当輪の制動力を発生させ、ドライバの操縦安定性を高める役割を担っている。
 また、車両制御装置1が、制動制御装置15にブレーキ指令を通信することで、車両500に任意のブレーキ力を発生させることができ、ドライバの操作が生じない自動運転においては自動的に制動を行う役割を担っている。ただし、本発明では上記制動制御装置15に限定するものではなく、ブレーキバイワイヤ等のほかのアクチュエータを用いてもよい。
 次に、ステアリングの動作について説明する。ドライバが車両500を運転している状態では、ドライバがハンドル6を介して入力した操舵トルクとハンドル角をそれぞれ操舵トルク検出装置7とハンドル角検出装置21で検出し、それらの情報に基づいて操舵制御装置8はモータ(不図示)を制御しアシストトルクを発生させる。
 なお、操舵制御装置8も、図1に詳細に示していないが、車両制御装置1と同様に、例えばCPU、ROM、RAM及び入出力装置を有する。
 上記ドライバの操舵トルクと、モータによるアシストトルクの合力により、ステアリング制御機構10が可動し、前輪FL、FRが切れる。一方で、前輪FL、FRの切れ角に応じて、路面からの反力がステアリング制御機構10に伝わり、路面反力としてドライバに伝わる構成となっている。
 操舵制御装置8は、ドライバのステアリング操作とは独立に、モータによりトルクを発生し、ステアリング制御機構10を制御することができる。従って、車両制御装置1は、操舵制御装置8に操舵力指令を通信することで、前輪FL、FRを任意の切れ角に制御することができ、ドライバの操作が生じない自動運転においては自動的に操舵を行う役割を担っている。ただし、本発明では上記操舵制御装置8に限定するものではなく、ステアバイワイヤ等のほかのアクチュエータを用いてもよい。
 次に、アクセルについて説明する。ドライバのアクセルペダル17の踏み込み量はストロークセンサ18で検出され、加速制御装置19に入力される。なお、加速制御装置19も、図1に詳細には示していないが、車両制御装置1と同様に、例えばCPU、ROM、RAM及び入出力装置を有する。
 加速制御装置19は、上記アクセルペダル踏み込み量に応じてスロットル開度を調節し、エンジンを制御する。
 以上により、ドライバのアクセルペダル操作に応じて車両を加速させることができる。
 また、加速制御装置19はドライバのアクセル操作とは独立にスロットル開度を制御することができる。従って、車両制御装置1は、加速制御装置19に加速指令を通信することで、車両500に任意の加速度を発生させることができ、ドライバの操作が生じない自動運転においては自動的に加速を行う役割を担っている。
 次に、本実施例1の車両制御装置1に実装されている自動運転用制御装置の構成について、図2に示したブロック図を用いて説明する。
 車両制御装置1には、後述する自車両を自動的に目的地へ自動で運転するための自車両の動作を計画する自動運転計画部201、駐車場などで自車両を自動的に駐車枠に駐車させるための自車両の動作を計画する自動駐車計画部202、自動運転車両の車両運動を制御するための指令値を生成する車両運動制御部203、エンジン・ブレーキ・ステアリングなどの各アクチュエータを制御するためのアクチュエータ制御部204、リスクマップ生成部205があり、それらは異なるコントローラに実装されているとする。
 そのため、各コントローラ間の通信を行なうための車両ネットワーク206が必要となる。ただし、車両ネットワーク206は有線接続以外にも無線接続されている場合も考えられる。また、各コントローラへの実装方法としては、自動駐車演算部202と自動運転計画部201が同一のハードウェアに実装されている場合なども考えられる。また、アクチュエータ制御部204の実装についても、エンジン制御用コントローラやブレーキ制御用コントローラなど異なるハードウェアに実装される場合も考えられる。車両運動制御部203は、自動運転計画部201による車線変更可否の判断に従って、自車両81の動作を制御する。
 次に、本実施例1の車両用制御装置1に含まれるリスクマップ生成部205の構成について、図3に示したブロック図を用いて説明する。
 図3において、レーダ301、ステレオカメラ302、車両センサ303、ライダー304の情報に基づいて得られた周囲の環境の情報をセンサ情報処理部305に入力し、自車の周囲に存在する移動物体の物体情報に変換する。
 レーダ301、ステレオカメラ302、車両センサ303、ライダー304は、外界を認識するセンサである。レーダ301は、電波を対象物に向けて発射し、その反射波を測定することにより、対象物までの距離や方向を測る。ステレオカメラ302は、対象物を複数の異なる方向から同時に撮影することにより、その奥行き方向の情報も記録できる。車両センサ303は、車両の速度やタイヤの回転数を測定するセンサ、GNSS(全球測位衛星システム)を用いた自動運転車両の平均位置を算出した情報、自動運転車両に乗員している人がナビゲーションシステムをインターフェースとして入力した目的地情報、電話回線などの無線通信を活用して遠隔地にいるオペレータなどが指定した目的地情報などの車両状態を検知できるセンサ群としてのセンサである。ライダー304は、パルス状に発光するレーザー照射に対する散乱光を測定し、遠距離にある対象までの距離を検知する。
 具体的な物体情報としては、歩行者、自転車、車両などの属性情報や、それらの現在位置および現在速度ベクトルを抽出する。
 ここで、移動物体は、現時刻で得られた速度がゼロであったとしても、将来において動く可能性がある駐車車両などは含めるとする。また、自車両が自動運転を開始する地点から目標地点およびその周辺に関する道路情報や信号機情報、現在位置から目標地点までのルート情報、走行する区間の交通ルールデータベースなどを記憶する記憶部308がある。
 また、自己位置推定処理部310で用いる点群データベースがある。また、記憶部308の記憶している情報に基づいて自動運転を行なうために必要な道路の車線中心線情報や信号機情報に基づいて、自動運転車両が通行予定である信号機の点灯情報などを整理して利用できる形式にするための地図情報処理部306がある。また、後述する自己位置推定処理部310では、センサで得られた周辺情報と点群データベースおよび車両のステアリング角度および車両速度やGNSSで得られた情報に基づいて、自車両が存在する場所を推定する。
 次に、その物体情報および地図情報を立体物行動予測部307に入力する。立体物行動予測部307では、入力情報に基づいて、各移動物体の将来の位置および速度情報(物体予測情報)を演算する。
 各移動物体の動きを方法するために、物体情報に基づいて各物体の将来時間Tにおける位置R(X(T),Y(T))を予測する。予測する具体的な方法としては、移動物体の現在位置Rn0(Xn(0),Yn(0))、現在速度Vn(Vxn,Vyn)とした場合、以下の線形予測式(1)に基づいて、予測演算を行なう方法が考えられる。
Figure JPOXMLDOC01-appb-M000001
 ここでの演算方法は、各物体は将来時間において現在速度を維持して移動する等速直線運動を仮定している。これにより、短時間に多くの物体の予測が可能となる。
 次に、立体物行動予測結果および地図情報、後述する死角物体推定処理部311において生成した死角物体推定情報を潜在リスクマップ生成部309に入力する。潜在リスクマップ生成部309では後述するように、自動運転車両が他車両および自車両周辺に存在する立体物に衝突せず、かつ、ルート情報および現在の車両状態(速度、位置、向きなど)に基づいて、自車両周辺の潜在リスクマップを演算する。
 次に、死角物体推定処理部311について説明する。死角物体推定処理部311は、レーダ301、ステレオカメラ302、車両センサ303及びライダー304等の周辺状況検知センサが検知した自車両81の周辺状況及び地図情報から抽出される特徴量に基づき、自車両81の周辺の死角領域を算出し、算出した死角領域に存在する物体及び物体の行動傾向を推定する。
 死角物体推定処理部311について、図4を用いて説明する。ここでは、まず、記憶部308に保存されている道路情報及びそれらを処理した結果の地図情報と、各車載センサの情報に基づいて、死角領域を検出する。
 ここで、死角領域とは、図19に示すように自車両81の周辺に存在する周辺車両1901や、道路上に存在する塀や生垣1902などによって、そのオブジェクトの背後が検知不可能な状態を死角領域と定義する。自車両81が通過しようとする道路上に死角領域1903が存在する場合、その死角領域1903からオブジェクトが飛び出してくる可能性があり、自車両81と衝突する可能性や、そのオブジェクトとの衝突を防ぐために緊急停止する必要が考えら、それらの場合には乗り心地が悪化する恐れがある。
 そのため、道路情報及びそれらを処理した結果の地図情報と、各車載センサの検知できる範囲の情報に基づいて、死角領域検知部401が死角領域を検知する。そして、死角領域検知部401は、検知した死角領域情報を死角物体推定部402に出力する。
 次に、死角物体推定部402は、死角領域情報に基づいて、死角領域に潜んでいる可能性がある物体の種別もしくは種類もしくは行動傾向、もしくはそれらすべてを推定する。推定する方法としては、次のような道路状況に基づいて死角領域に潜む物体の種別を推定する。
 道路と歩道の間の柵の有無、周辺の公園および時間情報(子供が遊んでいる時間かどうか)、スクールゾーンの有無、信号の色(赤色、黄色点滅)、道路標識、過去の統計情報に基づく事故頻発地点、駐車車両が普通車か救急車か、スクールバスが停止している、対向車線が渋滞時の対抗車両間からの飛び出し、ドライブスルーや店舗の入り口、スーパーの駐車場の入り口付近などである。もしくは、車載されているセンサによって得られる点群情報やカメラによって撮像された画像情報をニューラルネットワークなどの統計モデルに入力することにより、事前に学習された情報に基づいて、死角物体の種類を統計的に予測する方法も考えられる。
 潜在リスクマップ生成部309は、死角物体推定処理部311が推定した物体の行動傾向に基づいて、自車両81が物体と接近するリスクが潜在する領域を生成する。
 次に、潜在リスクマップ生成部309の動作について、図20を用いて述べる。潜在リスクの演算方法は以下の4ステップである。
 ステップ1:自車両81が車線変更位置Pcまでに到達する時間を求める。
 自車両81が車線変更を完了する車線変更位置Pcまでに到達する時間(T_self[sec])を以下の式(2)に基づき演算する。車線変更が完了する車線変更位置Pcは、車線変更先車線の中心線に対して、滑らかに接続する曲線との交点となる。ここで、式(2)のV_old(t)は前サンプリング時刻において計画した速度プロファイル、Mは車線変更が完了する位置までの距離である。
Figure JPOXMLDOC01-appb-M000002
 ステップ2:潜在リスクの長さLIRPを求める。
 潜在リスクの長さLIRPを、(飛び出してくる物体の予測される速度u[m/s])×(自車両81が車線変更を完了する位置までに到達する時間[s])と定義し、以下の式(3)で演算する。
Figure JPOXMLDOC01-appb-M000003
 ステップ3:飛び出し座標位置PAを求める。
 飛び出し座標位置PAは、後続車両82によってセンサ検知が出来ない死角を分ける領域境界(図中の一点鎖線)の延長線と、車線変更先車線(車線変更位置PAが位置する車線の延長線(破線図示))との交点とする。
 ステップ4:潜在リスクマップを生成する。
 上記ステップ3で求めた飛び出し座標位置PA、潜在リスクマップの長さLIRPに基づいて、点PBを算出し、飛び出し座標位置PAから点PBまでの領域を潜在リスクマップとする。潜在リスクマップの形状は、長さをLIRPとし、幅を車線幅とする四角形としてもよいし、座標位置PAから点PBに近くなるほど、幅が狭くなる楕円の一部形状とすることができる。
 自動運転計画部201は、自車両81の周辺状況及び地図情報から自車両81の車線変更軌道を生成し、生成した車線変更軌道と潜在リスクマップとを比較し、自車両81の車線変更可否を判断する。
 次に、自動運転計画部201について、図5を用いて説明する。
 自動運転計画部201は潜在リスクマップおよび環境情報、車線情報、地図情報に基づいて、目標軌道を演算する(算出する)。自動運転計画部201の中には、運転計画部501、軌道計画部506が存在する。各ブロックについて以下に説明する。
 運転計画部501では、ルート情報および環境情報などに基づき、自車両81が取り得る目標行動候補重みを算出する。目標行動候補重みとは、現在いる車線を維持する(LK)や、現在いる車線から隣接車線へ車線変更する(LC)、前方に存在する障害物を回避する(OA)などの自車両81が取り得る行動に対しての重みである。
 例えば、直線路を走行時において、前方に避けるべき車両や物体が存在せず、またルート情報からも隣接車線へ車線変更する必要がないと考えられる状況においては、LK=100、LC=0、OA=0などとなる。
 軌道計画部506には、車線維持軌道生成部502、車線変更軌道生成部503、障害物回避軌道生成部504、軌道調停部505が存在する。車線維持軌道生成部502は、自車両81が現在走行している車線の中央を維持するための軌道を生成する。車線変更軌道生成部503は自車両81が現在走行している車線の隣接車線への車線変更行うための軌道を生成する。障害物回避軌道生成部504は自車両81が現在走行している車線内に存在する走行するためには障害となる物体を避けるような軌道を生成する。軌道調停部505は車線維持軌道、車線変更軌道、障害物回避軌道に対して、周辺物体との安全度と、目標行動候補重みに基づいて、各軌道の評価を行い、最も評価が良い軌道を選択する。
 走行モード管理部507は軌道調停部505によって選択された走行モードと各行動候補に基づく軌道評価値に基づいて、次回サンプリング時間における目標行動候補重みを算出するための前回選択情報を演算する。例えば、LK=60、LC=40、OA=0という評価値によって、LKが選択された場合には、次回サンプリング時間においても、行動の継続性のためにLKが選択される可能性が高くなるように前回選択情報を生成する。
 次に、本実施例1における車線変更軌道生成部503について図6を用いて説明する。車線変更軌道生成部503には車線変更状態管理部601、車線変更経路生成部602および車線変更速度生成部603が存在することが考えられる。車線変更状態管理部601の詳細は後述する。
 車線変更経路生成部602は車線変更状態に基づいて、車線変更するための目標経路を生成する。目標経路の生成方法としては、目標とする位置に対して、スプライン曲線を生成する方法などが考えられる。車線変更速度生成部603は、車線変更経路生成部602が生成した目標経路に対して、その目標経路上を車両が走行するときの速度プロファイルを演算する。例えば、経路上を5秒間進んだ場合の0.1秒間隔で50点の速度の時系列点を演算する。例えば、速度プロファイルの演算方法としては、下記の方程式(4)を満たすような速度列情報を速度プロファイルの候補として生成することが考えられる。
Figure JPOXMLDOC01-appb-M000004
 ただし、方程式(4)において、w4~w6は重み係数である。
 次に、車線変更状態管理部601の状態遷移について、図7を用いて説明する。図7において、車線変更状態管理部601は、隣接車線へ車線変更する際に状態を管理する部分である。状態としては、車線変更開始判断状態S701、車線変更実行状態S702、車線変更完了状態S703、車線変更キャンセル状態S704が存在する。車線変更開始判断状態S701で車線変更が可能と判断された場合には車線変更実行状態S702に遷移し、車線変更が不可能と判断された場合には、車線変更キャンセル状態S704へ遷移する。
 車線変更実行状態S702において、車線変更が完了した場合には車線変更完了状態S703に遷移し、車線変更の途中で環境条件などが変化し、車線変更が不可能と判断された場合には、車線変更キャンセル状態S704へ遷移する。
 以下、それぞれの状態について説明する。
 車線変更開始判断状態S701において実行される処理について、図8に示したフローチャートを用いて説明する。車線変更開始判断状態S701に遷移した場合に、車線変更要求確認S801を行う。ここでは、運転計画部501が生成した目標行動候補重みのLCの値が所定値以上になった場合には車線変更軌道生成S802へ遷移する。ここでは、車線変更経路生成部602および車線変更速度生成部603を用いて車線変更に必要な軌道を生成する。
 次に、軌道交差判定S803において、潜在リスクマップと生成した車線変更軌道の重なり判定を行う。軌道の重なりがないと判断された場合には、車線変更実行状態遷移処理S804へ進む。軌道交差判定S803で重なりがあると判断された場合には車線変更キャンセル状態遷移処理S805を実行する。つまり、自動運転計画部201は、車線変更軌道と潜在リスクマップとが交差する場合には、車線変更を不可と判断する。
 それぞれの遷移処理では、図7に示した状態遷移図に基づいて、状態を遷移するための処理を行う。
 車線変更実行状態S702において実行される処理について、図9に示すフローチャートを用いて説明する。車線変更実行状態S702に遷移した場合に、車線変更軌道生成S802を実行する。そして、キャンセル軌道生成S902を実行する。ここでは、現在位置から車線変更をキャンセルして元の車線へ戻るための軌道を車線変更経路生成部602および車線変更速度生成部603を用いて車線変更に必要な軌道を生成する。
 そして、車線変更継続判定S903を実行する。車線変更継続判定S903では、生成した車線変更軌道およびキャンセル軌道を比較し、安全性および乗り心地の指標に基づいて評価を行う。例えば、車線変更軌道に基づいて自車を走行させた場合に他車両や周辺オブジェクトと急接近する恐れが生じることが予期された場合には車線変更の継続が不可と判断され、車線変更キャンセル状態遷移処理S805を実行する。車線変更の継続が可能と判断された場合には、車線変更制御S904が実行される。車線変更制御S904では、生成した車線変更軌道を軌道調停部505へ送信し、軌道調停部505でその軌道が選択された場合には、その軌道に対して追従するように各々のアクチュエータ指令値を作成し、自車両81を車線変更させる。
 車線変更完了判定S905においては、自己位置情報や車線情報などに基づいて、自車両81の位置が隣接車線への車線変更が完了したかを判定する。車線変更完了判定S905にて完了と判定された場合には車線変更完了状態遷移処理S906へ進む。車線変更完了判定S905にて未完了と判定された場合には、再び車線変更軌道生成S802を実行する。車線変更完了状態遷移処理S906では、図7に示した状態遷移図に基づいて、車線変更完了状態を遷移するための処理を行う。
 車線変更完了状態S703において実行される処理について、図10に示すフローチャートを用いて説明する。車線変更完了状態S703に遷移した場合に、車線維持軌道生成S1001を実行する。ここでは、自車位置を現在車線内に維持する軌道を車線変更経路生成部602および車線変更速度生成部603を用いて軌道を生成する。
 次に、車線維持制御S1005を実行する。車線維持制御S1005では、生成した車線維持軌道を軌道調停部505へ送信し、軌道調停部505でその軌道が選択された場合には、その軌道に対して追従するように各々のアクチュエータ指令値を作成し、自車両81を車線維持させる。
 次に、車線維持判定S1002を実行する。ここでは、現在車線を維持できるかを判定する。所定時間にわたって車線維持できているかを判定し、維持できていないと判定されれば、車線維持軌道生成S1001に戻る。車線維持判定S1002で維持できていると判定されれば走行モード変更処理S1003により、走行モードを車線維持に変更する。そして、車線変更開始判断状態遷移処理S1004を実行する。車線変更開始判断状態遷移処理S1004においては、図7に示した状態遷移図に基づいて、車線変更開始判断状態へ遷移するための処理を行う。
 車線変更キャンセル状態S704において実行される処理について、図11に示したフローチャートを用いて説明する。車線変更キャンセル状態S704に遷移した場合に、キャンセル軌道生成S1101を実行する。ここでは、自車位置を元の車線内に戻す軌道を車線変更経路生成部602および車線変更速度生成部603を用いて軌道を生成する。
 次に、キャンセル軌道追従制御S1105を実行する。キャンセル軌道追従制御S1105では、生成したキャンセル軌道を軌道調停部505へ送信し、軌道調停部505でその軌道が選択された場合には、その軌道に対して追従するように各々のアクチュエータ指令値を作成し、自車両81を元の車線内に戻す。
 次に、車線維持判定S1002を実行する。ここでは、現在車線を維持できるかを判定する。所定時間にわたって車線維持できているかを判定し、維持できていないと判定されれば、キャンセル軌道生成S1101に戻る。車線維持判定S1002にて、維持できていると判定されれば走行モード変更処理S1003により、走行モードを車線維持に変更する。そして、車線変更開始判断状態遷移処理S1004を実行する。車線変更開始判断状態遷移処理S1004では、図7に示した状態遷移図に基づいて、車線変更開始判断状態へ遷移するための処理を行う。
 次に、本実施例1の死角に存在する可能性があるオブジェクトの予測結果に基づいて車線変更する動作について、図12に示した代表的なシーンの模式図を用いて説明する。図12に示したシーンにおいて、自車両81が自動運転走行を行なっており、自車両81の後方には大型車両1201が存在している。後方のセンサであるミリ波レーダ5において、自車両81の後方を検知しようとすると、大型車両1201の影響によって、死角分岐点1204から進行方向左側がセンサ死角になる。
 ここで、自車両81は地図情報および周辺を認識するセンサの情報に基づいて、自車両81の車線変更方向に対して死角が存在することを検知する。そのため、自車両81は死角からオブジェクトが万が一飛び出してきた場合の存在するエリアの潜在リスクマップ1205を生成し、次に乗り心地を損ねることがないような車線変更軌道1202を生成する。そこで、車線変更軌道1202と潜在リスクマップ1205を比較し、所定の重なり条件を満たしている場合には車線変更ができないと判定される。その場合には車線変更を行わずに、車線維持軌道1203に追従するように自車両81は制御される。
 このようにすることで、死角からの車両などの飛び出し予測に基づいてリスクマップを生成し、車線変更軌道と比較することにより、万が一死角から車両が飛び出してきたとしても、自車両が飛び出し車両と接近することがなくなり、急加減速が不要となることで乗り心地の悪化を防止することが可能となる。
 以上のように、本発明の実施例1によれば、自車両81の不要な車線変更動作を抑制し、乗心地の悪化を抑制可能な車両制御装置を実現することができる。
 (実施例2)
 次に、図13を参照して、本発明の実施例2に係る車両制御装置を説明する。本発明の実施例2の車両制御装置1は、図13に示す車線変更軌道生成部503の状態遷移に示すように、死角安全性確認状態S1301を備えている点で、図7に示した実施例1と異なっている。実施例1における図2~図6に示した構成は、実施例2も同様な構成であるので、図示及び詳細な説明は省略する。
 実施例2においては、自動運転計画部201は、車線変更不可と判断した場合には、死角低減軌道1603を算出し、車両運動制御部203は、自車両81が死角低減軌道1603を走行するように制御する。
 図13の車線変更開始判断状態S701においての状態遷移条件について図14に示したフローチャートを用いて説明する。実施例1においては軌道交差判定S803(図8)において、交差していることが判定された場合には、車線変更キャンセル状態S704へ遷移させていたが、本実施例2では死角安全性確認状態S1301へ遷移させる処理を行う。
 死角安全性確認状態S1301について図15に示すフローチャートを用いて説明する。死角安全性確認状態S1301に遷移した場合に、死角低減軌道生成S1501を実行する。ここでは、自車位置を現在車線内において車線変更先の車線との境界車線に接近するように軌道を生成する。
 次に、キャンセル軌道生成S1502を実行する。これは死角低減した場合の位置から、元の車線中心位置を目標とする位置へ戻るための軌道となる。
 次に、死角低減継続判定S1503を実行する。ここでは、死角低減動作を継続した際に、死角領域から車両が検知され、自車両81に接近している場合や、新たな物体を検知して、自車両81の走行の安全性が担保できない場合に、継続ができないと判定し、車線変更キャンセル状態遷移処理S805を実行する。
 死角低減継続判定S1503において、継続できると判定された場合には、死角低減御S1504を実行する。死角低減制御S1504では生成した死角低減軌道に追従するように自車両81を制御する。
 次に、死角低減完了判定S1505を実施する。死角低減完了判定S1505は目標とする車線変更先の車線との境界車線に十分に接近していることを判定する。判定方法としては、自車両死角低減方向側の車輪もしくは車両側面が境界線とほぼ一致した位置となっていることを利用する方法が考えられる。死角低減が完了している場合には車線変更軌道生成S802を実行し、完了していない場合には再度S1501を実行する。S802以下は図8と同様の動作となる。
 次に、実施例2を実行した場合の自車両81の動きについて、図16を用いて説明する。
 自車両81が車線変更しようとした場合に、車線変更軌道1202を生成したが、潜在リスクマップ1205との交差判定に基づいて、車線変更ができないと判定されている。そのため、死角安全性確認状態S1301(図13)に遷移することで、死角低減軌道1603を生成し、その軌道に基づいて、自車両81を車線変更先車線との車線境界線1604へ向かって走行している。また、死角低減走行実施中にはキャンセル軌道1605を生成し、死角低減走行できない場合には元の走行車線中央へ戻ることを想定している。
 次に、死角低減完了後において、生成する軌道について図17を用いて説明する。死角低減した結果、死角を発生させている大型車両1201との位置関係が変わったことで、潜在リスク領域が相対的に自車両81の後方に交代している。そのため、車線変更軌道1701を生成し、潜在リスクマップ1205と交差判定をした場合に、車線変更が可能と判定される可能性がある。
 この状態においても車線変更ができないと判定された場合には元の車線中央への軌道1702を選択し、元の走行位置の状態へ戻る。車線変更が可能と判定された場合には車線変更を実施する。
 死角低減軌道1603は、自車両81と車線境界線1604との横距離を小さくするように自車両81の軌道を変更する軌道である。自車両81と車線境界線1604との横距離を小さくする変化量は、自車両81の速度が大きいほど、小である。
 次に、車線変更が完了された際の状態について、図18を用いて説明する。車線変更が完了した場合には、車線変更先車線を追従するような軌道1801を生成し車線追従を行い、車線変更完了状態S703(図13)で車線が一致されていることを判定した場合には、車線変更完了とする。
 このようにすることで、死角を低減する方向に自車両81の位置を変更することにより、潜在リスクマップ1205の領域と車線変更軌道との交差がなくなることで、死角が存在することで車線変更が不可能な状況だった場合においても、車線変更が可能となり、車線変更機能の利便性が向上することが期待される。
 本発明の実施例2によれば、実施例1と同様な効果が得られる他、上述したように、車線変更機能の利便性が向上することができる。
 (実施例3)
 次に、図21を参照して、本発明の実施例3に係る車両制御装置1を説明する。本実施例3の車両制御装置1は、図15の死角低減制御S1504について、前述の実施例2と異なり、車線変更先車線が現在自車線と概並走(並列)になっていない状況(合流シーン)における点である。その他は、実施例1及び実施例2と同様な構成であるので、図示及び詳細な説明は省略する。
 図21は、自車両81が合流車線2107を走行しており、本線である走行車線2106に合流しようとしているシーンの動作説明図である。本線は走行車線2106と追い越し車線2109で形成されている。
 自車両81は合流車線2107の車線中心線2105に沿って速度ベクトル2102の速度でレーンキープ制御されている。ここでは道路構造物として死角を生じさせているフェンス2108(もしくはガードレール)が存在することにより、走行車線2106の合流先領域が死角となっている。そのため、飛び出し位置PAから潜在リスクの長さLIRPの大きさの領域に飛び出し潜在リスクマップ2104が生じている。そのため、このままレーンキープで走行していくと走行車線2106を走行している他車両83と接近して自車両81および他車両83が急加減速する可能性がある。
 そのため、自車両81は死角を低減させるように死角低減軌道2103を生成する。その生成方法について、図22を用いて説明する。
 図22において、合流シーンにおける死角低減軌道2103は自車両81の速度ベクトル2102および潜在リスクマップ2104の長手方向ベクトル2201によって演算される。長手方向ベクトル2201をk倍した比例ベクトル2204を演算する。ここで、比例係数kは、自車速度が高いほど小さくなるように設定されることが望ましい。つまり、比例ベクトル2204は、自車両81の速度成分が大きくなるほど、小さくなる比例係数kを掛けて算出される。これは、自車両81の速度が高い状態で自車両81の車線中心線から大きく逸脱するように自車両81を制御すると、乗員が違和感を生じる可能性があるからである。
 自車両81の速度ベクトル2102とk倍したベクトル2204のベクトル和を演算し、死角低減目標位置ベクトル2205を算出する。そして、その目標位置に対して、滑らかに自車両81を制御するための目標軌道である死角低減軌道2103を算出する。例えば、目標位置に対して、現在自車両位置からスプライン補間曲線を用いる方法などが考えられる。
 この手法により、現在車線と並走する車線に生じた死角領域への車線変更のシーンだけでなく、本実施例3のような本線車線に生じた死角領域への合流シーンにおいても死角低減制御を実施することで、死角領域から飛び出してきた他車両83への急接近を防ぐことが可能となり、その結果、自車両81および他車両83の急加減速を防ぐことが可能となる。
 本発明の実施例3によれば、実施例1と同様な効果が得られる他、上述したように、車線変更先車線が現在自車線と概並走になっていない状況(合流シーン)においても、車両81および他車両83の急加減速を防ぐことが可能となる。
 なお、レーダ301、ステレオカメラ302、車両センサ303及びライダー304は自車両81の周辺状況を検知する周辺状況検知センサと総称することができる。
 以上のように、本発明によれば、自車両81の不要な車線変更動作を防ぐことで、自車両81および周辺車両の減速頻度の低減や車両操舵量を低減し、乗心地が悪化することを抑制することができる。
 つまり、自車両の不要な車線変更動作を抑制し、乗心地の悪化を抑制可能な車両制御装置を実現することができる。
1・・・車両制御装置、2・・・カメラ(外界認識センサ)、3、4・・・レーザレーダ(外界認識センサ)、5・・・ミリ波レーダ(外界認識センサ)、81・・・自車両、82・・・後続車両、83・・・他車両、201・・・自動運転計画部、202・・・自動駐車計画部、203・・・車両運動制御部、204・・・アクチュエータ制御部、205・・・リスクマップ生成部、206・・・車両ネットワーク、301・・・レーダ、302・・・ステレオカメラ、303・・・車両センサ、304・・・ライダー、305・・・センサ情報処理部、306・・・地図情報処理部、307・・・立体物行動予測部、308・・・記憶部、309・・・潜在リスクマップ生成部、310・・・自己位置推定処理部、311・・・死角物体推定処理部、401・・・死角領域検知部、402・・・死角物体推定部、500・・・車両、501・・・運転計画部、502・・・車線維持軌道生成部、503・・・車線変更軌道生成部、504・・・障害物回避軌道生成部、505・・・軌道調停部、506・・・軌道計画部、601・・・車線変更状態管理部、602・・・車線変更経路生成部、603・・・車線変更速度生成部、1603、2103・・・死角低減軌道

Claims (7)

  1.  自車両の周辺状況を検知する周辺状況検知センサと、
     前記周辺状況検知センサが検知した自車両の前記周辺状況及び地図情報から抽出される特徴量に基づき、前記自車両の周辺の死角領域を算出し、算出した前記死角領域に存在する物体及び前記物体の行動傾向を推定する死角物体推定処理部と、
     前記死角物体推定処理部が推定した前記物体の行動傾向に基づいて、前記自車両が前記物体と接近するリスクが潜在する領域を生成する潜在リスクマップ生成部と、
     前記自車両の前記周辺状況及び前記地図情報から前記自車両の車線変更軌道を生成し、生成した前記車線変更軌道と前記潜在リスクマップ生成部が生成した潜在リスクマップとを比較し、前記自車両の車線変更可否を判断する自動運転計画部と、
     前記自動運転計画部による前記車線変更可否の判断に従って、前記自車両の動作を制御する車両運動制御部と、
     を備えることを特徴とする車両制御装置。
  2.  請求項1に記載の車両制御装置において、
     前記自動運転計画部は、車線変更不可と判断した場合には、死角低減軌道を算出し、車両運動制御部は、前記自車両が前記死角低減軌道を走行するように制御することを特徴とする車両制御装置。
  3.  請求項1に記載の車両制御装置において、
     前記自動運転計画部は、前記車線変更軌道と前記潜在リスクマップとが交差する場合には、車線変更を不可と判断することを特徴とする車両制御装置。
  4.  請求項2に記載の車両制御装置において、
     前記死角低減軌道は、前記自車両と車線境界線との横距離を小さくするように前記自車両の軌道を変更する軌道であることを特徴とする車両制御装置。
  5.  請求項4に記載の車両制御装置において、
     前記自車両と車線境界線との横距離を小さくする変化量は、前記自車両の速度が大きいほど、小であることを特徴とする車両制御装置。
  6.  請求項2に記載の車両制御装置において、
     前記死角低減軌道は、前記死角領域の長手方向のベクトルに比例する比例ベクトルと前記自車両の目標速度ベクトルとのベクトル和に基づいて算出されることを特徴とする車両制御装置。
  7.  請求項6に記載の車両制御装置において、
     前記比例ベクトルは、前記自車両の速度成分が大きくなるほど、小さくなる比例係数を掛けて算出されることを特徴とする車両制御装置。
PCT/JP2021/031904 2020-12-18 2021-08-31 車両制御装置 WO2022130701A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
US18/252,967 US20230415749A1 (en) 2020-12-18 2021-08-31 Vehicle control device
DE112021005361.2T DE112021005361T5 (de) 2020-12-18 2021-08-31 Fahrzeugsteuervorrichtung

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020-210520 2020-12-18
JP2020210520A JP7446216B2 (ja) 2020-12-18 2020-12-18 車両制御装置

Publications (1)

Publication Number Publication Date
WO2022130701A1 true WO2022130701A1 (ja) 2022-06-23

Family

ID=82059412

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/031904 WO2022130701A1 (ja) 2020-12-18 2021-08-31 車両制御装置

Country Status (4)

Country Link
US (1) US20230415749A1 (ja)
JP (1) JP7446216B2 (ja)
DE (1) DE112021005361T5 (ja)
WO (1) WO2022130701A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115257728A (zh) * 2022-10-08 2022-11-01 杭州速玛科技有限公司 一种用于自动驾驶的盲区风险区检测方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005122260A (ja) * 2003-10-14 2005-05-12 Nissan Motor Co Ltd 車両のリスク回避ガイド装置
JP2019214318A (ja) * 2018-06-13 2019-12-19 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
JP2020194309A (ja) * 2019-05-27 2020-12-03 日立オートモティブシステムズ株式会社 電子制御装置

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018062261A (ja) 2016-10-13 2018-04-19 本田技研工業株式会社 車両制御装置
JP2019069659A (ja) 2017-10-06 2019-05-09 トヨタ自動車株式会社 運転支援装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005122260A (ja) * 2003-10-14 2005-05-12 Nissan Motor Co Ltd 車両のリスク回避ガイド装置
JP2019214318A (ja) * 2018-06-13 2019-12-19 本田技研工業株式会社 車両制御装置、車両制御方法、およびプログラム
JP2020194309A (ja) * 2019-05-27 2020-12-03 日立オートモティブシステムズ株式会社 電子制御装置

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115257728A (zh) * 2022-10-08 2022-11-01 杭州速玛科技有限公司 一种用于自动驾驶的盲区风险区检测方法
CN115257728B (zh) * 2022-10-08 2022-12-23 杭州速玛科技有限公司 一种用于自动驾驶的盲区风险区检测方法

Also Published As

Publication number Publication date
US20230415749A1 (en) 2023-12-28
JP7446216B2 (ja) 2024-03-08
JP2022097120A (ja) 2022-06-30
DE112021005361T5 (de) 2023-08-31

Similar Documents

Publication Publication Date Title
CN110053619B (zh) 车辆控制装置
JP6839770B2 (ja) 移動体制御システム、および、管制装置
JP6294247B2 (ja) 車両走行制御装置
JP7234103B2 (ja) 車両制御装置、および、車両制御システム
JP7295012B2 (ja) 車両制御システム、および、車両制御方法
EP4014157A1 (en) Cost-based path determination
JP7373914B2 (ja) 車両およびその制御方法
JP7253908B2 (ja) 車両制御装置
JP6932662B2 (ja) 車両走行制御装置
JP7227072B2 (ja) 車両制御装置
JP2019160032A (ja) 車両制御装置、車両制御方法、およびプログラム
JP2019156075A (ja) 車両制御装置、車両制御方法、及びプログラム
WO2019155880A1 (ja) 車両制御装置
JP2019043396A (ja) 運転支援車両の走行制御方法及び走行制御装置
US11745763B2 (en) Vehicle travel assistance method and vehicle travel assistance device
JP7377359B2 (ja) 車両制御装置および車両制御システム
WO2022130701A1 (ja) 車両制御装置
WO2024147236A1 (ja) 車両制御装置及び車両制御方法
WO2023112385A1 (ja) 車両制御装置
JP2021160494A (ja) 車両制御装置、車両制御方法、及びプログラム
JP2021109576A (ja) 車両の走行支援方法および走行支援装置
JP7508270B2 (ja) 車両の走行支援方法および走行支援装置
JP7483529B2 (ja) 制御装置、制御方法、およびプログラム
EP4306382A1 (en) Planning trajectories for controlling autonomous vehicles
WO2022123278A1 (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: 21906066

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 18252967

Country of ref document: US

122 Ep: pct application non-entry in european phase

Ref document number: 21906066

Country of ref document: EP

Kind code of ref document: A1