WO2017199750A1 - 車両制御システム、車両制御方法、および車両制御プログラム - Google Patents
車両制御システム、車両制御方法、および車両制御プログラム Download PDFInfo
- Publication number
- WO2017199750A1 WO2017199750A1 PCT/JP2017/017143 JP2017017143W WO2017199750A1 WO 2017199750 A1 WO2017199750 A1 WO 2017199750A1 JP 2017017143 W JP2017017143 W JP 2017017143W WO 2017199750 A1 WO2017199750 A1 WO 2017199750A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- vehicle
- deviation
- target
- unit
- control unit
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 18
- 238000012937 correction Methods 0.000 claims description 65
- 238000001514 detection method Methods 0.000 claims description 22
- 230000007423 decrease Effects 0.000 claims description 20
- 230000001133 acceleration Effects 0.000 description 62
- 230000008859 change Effects 0.000 description 30
- 230000009471 action Effects 0.000 description 24
- 238000004364 calculation method Methods 0.000 description 24
- 238000010586 diagram Methods 0.000 description 23
- 238000004891 communication Methods 0.000 description 11
- 238000001914 filtration Methods 0.000 description 8
- 230000008569 process Effects 0.000 description 7
- 238000012545 processing Methods 0.000 description 7
- 230000010354 integration Effects 0.000 description 5
- 230000003247 decreasing effect Effects 0.000 description 4
- 238000011156 evaluation Methods 0.000 description 4
- 230000005484 gravity Effects 0.000 description 4
- 239000000446 fuel Substances 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000033228 biological regulation Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000002485 combustion reaction Methods 0.000 description 2
- 230000036461 convulsion Effects 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000000284 extract Substances 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000001172 regenerating effect Effects 0.000 description 2
- LFQSCWFLJHTTHZ-UHFFFAOYSA-N Ethanol Chemical compound CCO LFQSCWFLJHTTHZ-UHFFFAOYSA-N 0.000 description 1
- UFHFLCQGNIYNRP-UHFFFAOYSA-N Hydrogen Chemical compound [H][H] UFHFLCQGNIYNRP-UHFFFAOYSA-N 0.000 description 1
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 239000013256 coordination polymer Substances 0.000 description 1
- 238000005401 electroluminescence Methods 0.000 description 1
- 229910052739 hydrogen Inorganic materials 0.000 description 1
- 239000001257 hydrogen Substances 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 229910044991 metal oxide Inorganic materials 0.000 description 1
- 150000004706 metal oxides Chemical class 0.000 description 1
- 238000005192 partition Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
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
- 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
- B60W30/10—Path keeping
-
- 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
- B60W30/14—Adaptive cruise control
- B60W30/143—Speed control
-
- 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
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18163—Lane change; Overtaking manoeuvres
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/082—Selecting or switching between different modes of propelling
-
- 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/005—Handover processes
- B60W60/0051—Handover processes from occupants to vehicle
-
- 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/005—Handover processes
- B60W60/0053—Handover processes from vehicle to occupant
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0008—Feedback, closed loop systems or details of feedback error signal
-
- 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- 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
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/20—Steering systems
- B60W2510/202—Steering torque
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/14—Yaw
-
- 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
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- 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/05—Type of road, e.g. motorways, local streets, paved or unpaved roads
-
- 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/10—Number of lanes
-
- 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/15—Road slope, i.e. the inclination of a road segment in the longitudinal direction
-
- 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
- B60W2554/00—Input parameters relating to objects
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/406—Traffic density
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/802—Longitudinal distance
-
- 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
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
-
- 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/10—Longitudinal speed
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/166—Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
Definitions
- the present invention relates to a vehicle control system, a vehicle control method, and a vehicle control program.
- a vehicle control system generates a trajectory that includes a position recognition unit that recognizes the position of a vehicle and a plurality of future target positions that the vehicle should reach continuously in time series. And a target speed for driving the vehicle along the track based on the distance between the target positions included in the track and the plurality of target positions included in the track and recognized by the position recognition unit. Travel control for correcting the target speed based on a first deviation between the position of the vehicle and a first target position corresponding to a recognition time at which the position of the vehicle is recognized among the plurality of target positions.
- the travel control unit selects a second target position corresponding to a future time at which a first predetermined time has elapsed from the recognition time, from the plurality of target positions.
- a speed obtained by extracting and dividing the length of the trajectory from the first target position to the second target position by the first predetermined time may be derived as the target speed.
- the travel control unit further corresponds to a future time corresponding to a future time when a second predetermined time shorter than the first predetermined time has elapsed from the recognition time.
- the target speed may be corrected based on a second deviation between the target position 3 and a predicted position where the vehicle is predicted to arrive at the future time.
- a restriction is provided on one or both of the correction amount of the target speed based on the first deviation and the correction amount of the target speed based on the second deviation.
- the travel control unit may correct the derived target speed with a correction amount within the limit range.
- an area in which the correction amount of the target speed is decreased according to each deviation with respect to at least one of the first deviation and the second deviation When the calculated deviation is within at least one of the first deviation and the second deviation, or when the calculated deviation is outside the area
- the target speed may be corrected with a smaller correction amount than the target speed correction amount.
- the vehicle may further include an external recognition unit that recognizes another vehicle that travels around the vehicle, and the travel control unit is configured to detect the other vehicle recognized by the external recognition unit.
- the region range of the region may be set wider as the distance between the vehicle and one or both of the preceding vehicle traveling in front of the vehicle and the subsequent vehicle traveling behind the vehicle increases.
- the travel control unit when the travel control unit has at least one of the first deviation and the second deviation equal to or less than a threshold value, the obtained deviation satisfies the threshold value.
- the derived target speed may be corrected with a correction amount smaller than the correction amount of the target speed in the case of exceeding.
- the vehicle may further include an external recognition unit that recognizes another vehicle that travels around the vehicle, and the travel control unit is configured to detect the other vehicle recognized by the external recognition unit.
- the threshold may be increased as the distance between the vehicle and one or both of the preceding vehicle traveling in front of the vehicle and the subsequent vehicle traveling behind the vehicle increases.
- the vehicle may further include a detection unit that detects the speed of the vehicle, and the traveling control unit detects the speed detected by the detection unit. As the value decreases, the correction amount of the target speed based on the first deviation or the correction amount of the target speed based on the second deviation may be reduced.
- the in-vehicle computer recognizes the position of the vehicle, and generates a trajectory in which a plurality of future target positions to be reached by the vehicle are continuously included in time series. Then, based on the distance between the plurality of target positions included in the track, a target speed for driving the vehicle along the track is derived, the recognized position of the vehicle, and the plurality of targets The target speed is corrected based on a first deviation from a first target position corresponding to a recognition time at which the vehicle position is recognized among the positions.
- a vehicle control program causes an in-vehicle computer to recognize a position of a vehicle, and generates a trajectory including a plurality of future target positions to be reached by the vehicle continuously in time series.
- a target speed for driving the vehicle along the track based on distances between the plurality of target positions included in the track, and the recognized position of the vehicle, The target speed is corrected based on a first deviation from a first target position corresponding to a recognition time at which the vehicle position is recognized among the target positions.
- FIG. 6 is a diagram representing trajectory candidates generated by a trajectory candidate generation unit using trajectory points.
- FIG. 1 is a diagram illustrating components of a vehicle (hereinafter referred to as a host vehicle M) on which the vehicle control system 100 of each embodiment is mounted.
- the vehicle on which the vehicle control system 100 is mounted is, for example, a motor vehicle such as a two-wheel, three-wheel, or four-wheel vehicle.
- a hybrid vehicle having an internal combustion engine and an electric motor.
- An electric vehicle is driven using electric power discharged by a battery such as a secondary battery, a hydrogen fuel cell, a metal fuel cell, or an alcohol fuel cell.
- the host vehicle M includes a finder 20-1 to 20-7, a radar 30-1 to 30-6, a sensor such as a camera 40, a navigation device 50 (route guidance device), a vehicle A control system 100 is mounted.
- the finders 20-1 to 20-7 are, for example, LIDAR (Light Detection and Ranging) that measures scattered light with respect to irradiation light and measures the distance to the target.
- LIDAR Light Detection and Ranging
- the finder 20-1 is attached to a front grill or the like
- the finders 20-2 and 20-3 are attached to a side surface of a vehicle body, a door mirror, the inside of a headlamp, a side lamp, and the like.
- the finder 20-4 is attached to a trunk lid or the like
- the finders 20-5 and 20-6 are attached to the side surface of the vehicle body, the interior of the taillight, or the like.
- the above-described viewfinders 20-1 to 20-6 have a detection area of about 150 degrees in the horizontal direction, for example.
- the finder 20-7 is attached to a roof or the like.
- the finder 20-7 has a detection area of 360 degrees in the horizontal direction, for example.
- the radars 30-1 and 30-4 are, for example, long-range millimeter wave radars that have a detection area in the depth direction wider than that of other radars.
- Radars 30-2, 30-3, 30-5, and 30-6 are medium-range millimeter-wave radars that have a narrower detection area in the depth direction than radars 30-1 and 30-4.
- finders 20-1 to 20-7 are not particularly distinguished, they are simply referred to as “finder 20”, and when the radars 30-1 to 30-6 are not particularly distinguished, they are simply referred to as “radar 30”.
- the radar 30 detects an object by, for example, FM-CW (Frequency Modulated Continuous Wave) method.
- FM-CW Frequency Modulated Continuous Wave
- the camera 40 is a digital camera using a solid-state imaging device such as a CCD (Charge Coupled Device) or a CMOS (Complementary Metal Oxide Semiconductor).
- the camera 40 is attached to the upper part of the front windshield, the rear surface of the rearview mirror, or the like. For example, the camera 40 periodically images the front of the host vehicle M repeatedly.
- the camera 40 may be a stereo camera including a plurality of cameras.
- FIG. 1 is merely an example, and a part of the configuration may be omitted, or another configuration may be added.
- FIG. 2 is a functional configuration diagram centering on the vehicle control system 100 according to the first embodiment.
- the host vehicle M includes a detection device DD including a finder 20, a radar 30, and a camera 40, a navigation device 50, a communication device 55, a vehicle sensor 60, a display device 62, a speaker 64, and an operation device 70.
- the operation detection sensor 72, the changeover switch 80, the vehicle control system 100, the driving force output device 200, the steering device 210, and the brake device 220 are mounted. These devices and devices are connected to each other by a multiple communication line such as a CAN (Controller Area Network) communication line, a serial communication line, a wireless communication network, or the like.
- the vehicle control system in the claims does not only indicate “vehicle control system 100”, but may include a configuration other than the vehicle control system 100 (such as a detection device DD).
- the navigation device 50 includes a GNSS (Global Navigation Satellite System) receiver, map information (navigation map), a touch panel display device that functions as a user interface, a speaker, a microphone, and the like.
- the navigation device 50 identifies the position of the host vehicle M using the GNSS receiver, and derives a route from the position to the destination specified by the user.
- the route derived by the navigation device 50 is provided to the target lane determining unit 110 of the vehicle control system 100.
- the position of the host vehicle M may be specified or supplemented by an INS (Inertial Navigation System) using the output of the vehicle sensor 60.
- the navigation device 50 provides guidance on the route to the destination by voice or navigation display when the vehicle control system 100 is executing the manual operation mode.
- the configuration for specifying the position of the host vehicle M may be provided independently of the navigation device 50.
- the navigation apparatus 50 may be implement
- information is transmitted and received between the terminal device and the vehicle control system 100 by wireless or wired communication.
- the communication device 55 performs wireless communication using, for example, a cellular network, a Wi-Fi network, Bluetooth (registered trademark), DSRC (Dedicated Short Range Communication), or the like.
- the vehicle sensor 60 includes a vehicle speed sensor that detects a vehicle speed, an acceleration sensor that detects acceleration, a yaw rate sensor that detects an angular velocity around a vertical axis, a direction sensor that detects the direction of the host vehicle M, and the like.
- the vehicle sensor 60 is an example of a “detection unit”.
- the display device 62 displays information as an image.
- the display device 62 includes, for example, an LCD (Liquid Crystal Display), an organic EL (Electroluminescence) display device, and the like.
- the display device 62 will be described as a head-up display that reflects an image on the front window of the host vehicle M and displays the image in the field of view of the vehicle occupant.
- the display device 62 may be a display device provided in the navigation device 50 or an instrument panel display device that displays the state (speed, etc.) of the host vehicle M.
- the speaker 64 outputs information as sound.
- the operation device 70 includes, for example, an accelerator pedal, a steering wheel, a brake pedal, a shift lever, and the like.
- the operation device 70 is provided with an operation detection sensor 72 that detects the presence / absence and amount of operation by the driver.
- the operation detection sensor 72 includes, for example, an accelerator opening sensor, a steering torque sensor, a brake sensor, a shift position sensor, and the like.
- the operation detection sensor 72 outputs the accelerator opening, the steering torque, the brake depression amount, the shift position, and the like as detection results to the travel control unit 160.
- the detection result of the operation detection sensor 72 may be directly output to the driving force output device 200, the steering device 210, or the brake device 220.
- the changeover switch 80 is a switch operated by a vehicle occupant.
- the change-over switch 80 receives the operation of the vehicle occupant, generates a control mode designation signal that designates the control mode by the traveling control unit 160 as either the automatic driving mode or the manual driving mode, and outputs the control mode designation signal to the switching control unit 150.
- the automatic operation mode is an operation mode that travels in a state where the driver does not perform an operation (or the operation amount is small or the operation frequency is low compared to the manual operation mode). More specifically, the automatic operation mode is an operation mode that controls part or all of the driving force output device 200, the steering device 210, and the brake device 220 based on the action plan.
- the changeover switch 80 may accept various operations in addition to the operation for switching the automatic operation mode. For example, when the information output from the vehicle control system 100 side is presented to the vehicle occupant via the display device 62, the changeover switch 80 may accept a response operation or the like.
- the driving force output device 200 the steering device 210, and the brake device 220 will be described.
- the driving force output device 200 outputs a driving force (torque) for driving the vehicle to driving wheels.
- the driving force output device 200 includes, for example, an engine, a transmission, and an engine ECU (Electronic Control Unit) that controls the engine when the host vehicle M is an automobile using an internal combustion engine as a power source.
- the driving force output device 200 includes a travel motor and a motor ECU that controls the travel motor.
- driving force output device 200 includes an engine, a transmission, an engine ECU, a travel motor, and a motor ECU.
- the engine ECU adjusts the throttle opening, the shift stage, and the like of the engine according to information input from the travel control unit 160 described later.
- the motor ECU adjusts the duty ratio of the PWM signal applied to the traveling motor in accordance with information input from the traveling control unit 160.
- driving force output apparatus 200 includes an engine and a traveling motor, engine ECU and motor ECU control traveling driving force in cooperation with each other in accordance with information input from traveling control unit 160.
- the steering device 210 includes, for example, a steering ECU and an electric motor.
- the electric motor changes the direction of the steered wheels by applying a force to a rack and pinion mechanism.
- the steering ECU drives the electric motor in accordance with information input from the vehicle control system 100 or information of the input steering steering angle or steering torque, and changes the direction of the steered wheels.
- the brake device 220 is, for example, an electric servo brake device that includes a brake caliper, a cylinder that transmits hydraulic pressure to the brake caliper, an electric motor that generates hydraulic pressure in the cylinder, and a braking control unit.
- the braking control unit of the electric servo brake device controls the electric motor according to the information input from the travel control unit 160 so that the brake torque corresponding to the braking operation is output to each wheel.
- the electric servo brake device may include, as a backup, a mechanism that transmits the hydraulic pressure generated by operating the brake pedal to the cylinder via the master cylinder.
- the brake device 220 is not limited to the electric servo brake device described above, but may be an electronically controlled hydraulic brake device.
- the electronically controlled hydraulic brake device controls the actuator in accordance with information input from the travel control unit 160 and transmits the hydraulic pressure of the master cylinder to the cylinder.
- the brake device 220 may include a regenerative brake by a traveling motor that can be included in the driving force output device 200. This regenerative brake uses electric power generated by a traveling motor that can be included in the driving force output device 90.
- the vehicle control system 100 is realized by, for example, one or more processors or hardware having an equivalent function.
- the vehicle control system 100 includes a combination of a processor such as a CPU (Central Processing Unit), a storage device, and an ECU (Electronic Control Unit) in which a communication interface is connected by an internal bus, or an MPU (Micro-Processing Unit). It may be.
- a processor such as a CPU (Central Processing Unit), a storage device, and an ECU (Electronic Control Unit) in which a communication interface is connected by an internal bus, or an MPU (Micro-Processing Unit). It may be.
- the vehicle control system 100 includes, for example, a target lane determination unit 110, an automatic driving control unit 120, a travel control unit 160, and a storage unit 190.
- the automatic driving control unit 120 includes, for example, an automatic driving mode control unit 130, an own vehicle position recognition unit 140, an external environment recognition unit 142, an action plan generation unit 144, a track generation unit 146, and a switching control unit 150. Prepare.
- Part or all of the target lane determining unit 110, the automatic operation control unit 120, and the travel control unit 160 are realized by a processor executing a program (software). Some or all of these may be realized by hardware such as LSI (Large Scale Integration) or ASIC (Application Specific Integrated Circuit), or may be realized by a combination of software and hardware.
- LSI Large Scale Integration
- ASIC Application Specific Integrated Circuit
- the storage unit 190 stores information such as high-precision map information 192, target lane information 194, action plan information 196, and the like.
- the storage unit 190 is realized by a ROM (Read Only Memory), a RAM (Random Access Memory), an HDD (Hard Disk Drive), a flash memory, or the like.
- the program executed by the processor may be stored in advance in the storage unit 190, or may be downloaded from an external device via an in-vehicle internet facility or the like. Further, the program may be installed in the storage unit 190 by attaching a portable storage medium storing the program to a drive device (not shown).
- the vehicle control system 100 may be distributed by a plurality of computer devices.
- the target lane determining unit 110 is realized by an MPU, for example.
- the target lane determining unit 110 divides the route provided from the navigation device 50 into a plurality of blocks (for example, every 100 [m] with respect to the vehicle traveling direction), and refers to the high-precision map information 192 for each block.
- the target lane determination unit 110 performs determination such as how many lanes from the left are to be traveled.
- the target lane determination unit 110 determines the target lane so that the host vehicle M can travel on a reasonable travel route for proceeding to the branch destination when there is a branch point or a merge point in the route.
- the target lane determined by the target lane determining unit 110 is stored in the storage unit 190 as target lane information 194.
- the high-precision map information 192 is map information that is more accurate than the navigation map that the navigation device 50 has.
- the high-precision map information 192 includes, for example, information on the center of the lane or information on the boundary of the lane.
- the high-precision map information 192 may include road information, traffic regulation information, address information (address / postal code), facility information, telephone number information, and the like.
- Road information includes information indicating the type of road such as expressway, toll road, national road, prefectural road, road lane number, width of each lane, road gradient, road position (longitude, latitude, height). Information including 3D coordinates), curvature of lane curves, lane merging and branch point positions, signs provided on roads, and the like.
- the traffic regulation information includes information that the lane is blocked due to construction, traffic accidents, traffic jams, or the like.
- the automatic operation mode control unit 130 determines an automatic operation mode performed by the automatic operation control unit 120.
- the modes of automatic operation in the present embodiment include the following modes. In addition, the following is an example to the last, and the number and kind of modes of automatic driving
- [Mode A] Mode A is the mode with the highest degree of automatic driving. When the mode A is implemented, all vehicle control such as complicated merge control is automatically performed, so that the vehicle occupant does not need to monitor the surroundings and state of the host vehicle M.
- [Mode B] Mode B is a mode in which the degree of automatic driving is the second highest after Mode A. When mode B is implemented, in principle, all vehicle control is performed automatically, but the driving operation of the host vehicle M is left to the vehicle occupant depending on the situation.
- Mode C is a mode in which the degree of automatic driving is the second highest after mode B.
- mode C the vehicle occupant needs to perform a confirmation operation on the changeover switch 80 according to the scene.
- mode C for example, when the vehicle occupant is notified of the lane change timing and the vehicle occupant performs an operation to instruct the changeover switch 80 to change the lane, automatic lane change is performed. For this reason, the vehicle occupant needs to monitor the periphery and state of the own vehicle M.
- the automatic driving mode control unit 130 determines the mode of automatic driving based on the operation of the vehicle occupant with respect to the changeover switch 80, the event determined by the action plan generation unit 144, the travel mode determined by the track generation unit 146, and the like. .
- a limit corresponding to the performance of the detection device DD of the host vehicle M may be set. For example, when the performance of the detection device DD is low, the mode A may not be performed. In any mode, it is possible to switch to the manual operation mode (override) by operating the changeover switch 80.
- the vehicle position recognition unit 140 of the automatic driving control unit 120 includes high-precision map information 192 stored in the storage unit 190 and information input from the finder 20, the radar 30, the camera 40, the navigation device 50, or the vehicle sensor 60. Based on the above, the lane (traveling lane) in which the host vehicle M is traveling and the relative position of the host vehicle M with respect to the traveling lane are recognized.
- the own vehicle position recognition unit 140 is, for example, a road partition line pattern recognized from the high-precision map information 192 (for example, an array of solid lines and broken lines) and the periphery of the own vehicle M recognized from an image captured by the camera 40.
- the road lane is recognized by comparing the road lane marking pattern. In this recognition, the position of the host vehicle M acquired from the navigation device 50 and the processing result by INS may be taken into account.
- FIG. 3 is a diagram showing how the vehicle position recognition unit 140 recognizes the relative position of the vehicle M with respect to the travel lane L1.
- the own vehicle position recognition unit 140 for example, with respect to a line connecting the deviation OS of the reference point G (for example, the center of gravity) of the own vehicle M from the travel lane center CL and the travel lane center CL in the traveling direction of the own vehicle M.
- the formed angle ⁇ is recognized as a relative position of the host vehicle M with respect to the traveling lane L1.
- the host vehicle position recognition unit 140 recognizes the position of the reference point of the host vehicle M with respect to any side end of the host lane L1 as the relative position of the host vehicle M with respect to the traveling lane. Also good.
- the relative position of the host vehicle M recognized by the host vehicle position recognition unit 140 is provided to the target lane determination unit 110.
- the external environment recognition unit 142 recognizes the positions of surrounding vehicles and the state such as speed and acceleration based on information input from the finder 20, the radar 30, the camera 40, and the like.
- the peripheral vehicle is, for example, a vehicle that travels around the host vehicle M and travels in the same direction as the host vehicle M.
- the position of the surrounding vehicle may be represented by a representative point such as the center of gravity or corner of the other vehicle, or may be represented by a region expressed by the contour of the other vehicle.
- the “state” of the surrounding vehicle may include the acceleration of the surrounding vehicle, whether the lane is changed (or whether the lane is going to be changed), which is grasped based on the information of the various devices.
- the external environment recognition unit 142 may recognize the positions of guardrails, utility poles, parked vehicles, pedestrians, and other objects.
- the action plan generation unit 144 sets a starting point of automatic driving and / or a destination of automatic driving.
- the starting point of the automatic driving may be the current position of the host vehicle M or a point where an operation for instructing automatic driving is performed.
- the action plan generation unit 144 generates an action plan in a section between the start point and the destination for automatic driving. In addition, not only this but the action plan production
- the action plan is composed of, for example, a plurality of events that are sequentially executed.
- Examples of the event include a deceleration event for decelerating the host vehicle M, an acceleration event for accelerating the host vehicle M, a lane keeping event for driving the host vehicle M so as not to deviate from the traveling lane, and a lane change event for changing the traveling lane.
- the branch event in which the own vehicle M is driven so as not to deviate from the current traveling lane, or the main line Accelerates and decelerates the own vehicle M in the merging lane of the vehicle a merging event that changes the driving lane, shifts from the manual driving mode to the automatic driving mode at the start point of the automatic driving, or manually from the automatic driving mode at the scheduled end point of the automatic driving.
- a handover event or the like for shifting to the operation mode is included.
- the action plan generation unit 144 sets a lane change event, a branch event, or a merge event at a location where the target lane determined by the target lane determination unit 110 is switched.
- Information indicating the action plan generated by the action plan generation unit 144 is stored in the storage unit 190 as action plan information 196.
- FIG. 4 is a diagram illustrating an example of an action plan generated for a certain section.
- the action plan generation unit 144 generates an action plan necessary for the host vehicle M to travel on the target lane indicated by the target lane information 194.
- the action plan generation unit 144 may dynamically change the action plan regardless of the target lane information 194 according to a change in the situation of the host vehicle M.
- the action plan generation unit 144 may determine that the speed of the surrounding vehicle recognized by the external recognition unit 142 exceeds the threshold while the vehicle travels, or the movement direction of the surrounding vehicle traveling in the lane adjacent to the own lane is the own lane direction.
- the event set in the driving section where the host vehicle M is scheduled to travel is changed.
- the vehicle from the rear of the lane to which the lane is changed becomes greater than the threshold during the lane keep event according to the recognition result of the external recognition unit 142.
- the action plan generation unit 144 may change the event next to the lane keep event from a lane change event to a deceleration event, a lane keep event, or the like. As a result, the vehicle control system 100 can automatically drive the host vehicle M safely even when a change occurs in the external environment.
- FIG. 5 is a diagram illustrating an example of the configuration of the trajectory generation unit 146.
- the track generation unit 146 includes, for example, a travel mode determination unit 146A, a track candidate generation unit 146B, and an evaluation / selection unit 146C.
- the travel mode determination unit 146A determines one of the travel modes such as constant speed travel, follow-up travel, low-speed follow-up travel, deceleration travel, curve travel, and obstacle avoidance travel. .
- the traveling mode determination unit 146A determines that the traveling mode is constant speed traveling when there is no other vehicle ahead of the host vehicle M.
- the traveling mode determination unit 146A determines the traveling mode to follow running when traveling following the preceding vehicle.
- the traveling mode determination unit 146A determines the traveling mode as low-speed following traveling in a traffic jam scene or the like.
- the travel mode determination unit 146A determines the travel mode to be decelerated when the outside recognition unit 142 recognizes the deceleration of the preceding vehicle or when an event such as stopping or parking is performed. In addition, when the outside recognition unit 142 recognizes that the host vehicle M has reached a curved road, the travel mode determination unit 146A determines the travel mode to be curved travel. In addition, the travel mode determination unit 146A determines the travel mode to be obstacle avoidance travel when the external environment recognition unit 142 recognizes an obstacle in front of the host vehicle M. In addition, when executing a lane change event, an overtaking event, a branching event, a merging event, a handover event, and the like, the traveling mode determination unit 146A determines a traveling mode according to each event.
- the trajectory candidate generation unit 146B generates trajectory candidates based on the travel mode determined by the travel mode determination unit 146A.
- FIG. 6 is a diagram illustrating an example of trajectory candidates generated by the trajectory candidate generation unit 146B.
- FIG. 6 shows candidate tracks generated when the host vehicle M changes lanes from the lane L1 to the lane L2.
- the trajectory candidate generation unit 146B follows the trajectory as shown in FIG. 6, for example, at a target position (orbit point K) at which the reference position G (for example, the center of gravity or the center of the rear wheel axis) of the host vehicle M should arrive at a predetermined future time. ).
- the future predetermined time interval is assumed to be 1 second.
- FIG. 7 is a diagram in which trajectory candidates generated by the trajectory candidate generation unit 146B are expressed by trajectory points K.
- the trajectory candidate generation unit 146B gradually widens the distance between the trajectory points K when it wants to accelerate, and gradually narrows the distance between the trajectory points K when it wants to decelerate.
- the trajectory candidate generation unit 146B needs to give a target speed to each of the trajectory points K.
- the target speed may be determined according to the travel mode determined by the travel mode determination unit 146A.
- the track candidate generation unit 146B first sets a lane change target position (or a merge target position).
- the lane change target position is set as a relative position with respect to the surrounding vehicles, and determines “with which surrounding vehicle the lane is to be changed”.
- the trajectory candidate generation unit 146B pays attention to three surrounding vehicles with the lane change target position as a reference, and determines a target speed when the lane change is performed.
- FIG. 8 is a diagram illustrating the lane change target position TA.
- L1 represents the own lane
- L2 represents the adjacent lane.
- the preceding vehicle mA is set as the surrounding vehicle that runs immediately before the own vehicle M
- the front reference vehicle mB and the lane change target position TA is set as the surrounding vehicle that runs immediately before the lane changing target position TA.
- a surrounding vehicle traveling immediately after is defined as a rear reference vehicle mC.
- the host vehicle M needs to perform acceleration / deceleration in order to move to the side of the lane change target position TA.
- the trajectory candidate generation unit 146B predicts the future state of the three neighboring vehicles, and determines the target speed so as not to interfere with or contact each neighboring vehicle.
- FIG. 9 is a diagram showing a speed generation model when the speeds of the three surrounding vehicles are assumed to be constant.
- straight lines extending from the points mA, mB, and mC indicate displacements in the traveling direction when it is assumed that each surrounding vehicle travels at a constant speed.
- the own vehicle M must be between the front reference vehicle mB and the rear reference vehicle mC at the point CP at which the lane change is completed, and must be behind the preceding vehicle mA before that.
- the track candidate generation unit 146B derives a plurality of time-series patterns of the target speed until the lane change is completed. Then, a plurality of trajectory candidates as shown in FIG.
- the motion patterns of the three surrounding vehicles are not limited to the constant speed as shown in FIG. 9, and may be predicted on the assumption of a constant acceleration and a constant jerk (jumping degree).
- the evaluation / selection unit 146C evaluates the track candidates generated by the track candidate generation unit 146B from, for example, two viewpoints of planability and safety, and selects a track to be output to the travel control unit 160. .
- the viewpoint of planability for example, the track is highly evaluated when the followability with respect to an already generated plan (for example, an action plan) is high and the total length of the track is short.
- an already generated plan for example, an action plan
- a trajectory in which the lane is once changed in the left direction and returned is evaluated as low.
- viewpoint of safety for example, at each track point, the distance between the host vehicle M and the object (peripheral vehicle or the like) is longer, and the higher the acceleration / deceleration or the change amount of the steering angle, the higher the evaluation.
- the switching control unit 150 switches between the automatic operation mode and the manual operation mode based on a signal input from the changeover switch 80. Further, the switching control unit 150 switches from the automatic operation mode to the manual operation mode based on an operation for instructing the operation device 70 to accelerate, decelerate, or steer. For example, the switching control unit 150 switches from the automatic operation mode to the manual operation mode (override) when the state in which the operation amount indicated by the signal input from the operation device 70 exceeds the threshold value continues for a reference time or longer. Further, the switching control unit 150 may return to the automatic operation mode when an operation on the operation device 70 is not detected for a predetermined time after switching to the manual operation mode by the override.
- the traveling control unit 160 includes a steering control unit 162 and an acceleration / deceleration control unit 164.
- the travel control unit 160 controls the driving force output device 200, the steering device 210, and the brake device 220 so that the host vehicle M passes the track generated by the track generation unit 146 at a scheduled time.
- FIG. 10 is a diagram showing the relationship between the steering control unit 162 and the acceleration / deceleration control unit 164 and the controlled objects.
- the steering control unit 162 controls the steering device 210 based on the track generated by the track generation unit 146 and the position of the host vehicle M (host vehicle position) recognized by the host vehicle position recognition unit 140.
- the steering controller 162 determines the turning angle ⁇ i corresponding to the trajectory point K (i) included in the trajectory generated by the trajectory generator 146, the vehicle speed (or acceleration or jerk) acquired from the vehicle sensor 60, the vertical A steering angle is determined based on information such as an angular velocity (yaw rate) around the shaft, and a control amount of the electric motor in the steering device 210 is determined so that a displacement corresponding to the steering angle is given to the wheel.
- the acceleration / deceleration control unit 164 controls the driving force output device 200 and the brake device 220 based on the speed v and acceleration ⁇ of the host vehicle M detected by the vehicle sensor 60 and the track generated by the track generation unit 146. To do.
- FIG. 11 is a diagram illustrating an example of the configuration of the acceleration / deceleration control unit 164 according to the first embodiment.
- the acceleration / deceleration control unit 164 includes, for example, a first calculation unit 165, a second calculation unit 166, a third calculation unit 167, a fourth calculation unit 168, subtracters 169 and 170, a proportional integration control unit 171, and the like.
- Some or all of these configurations may be included in the trajectory generation unit 146 (particularly the trajectory candidate generation unit 146B).
- FIG. 12 is a flowchart illustrating an example of a processing flow of the acceleration / deceleration control unit 164 according to the first embodiment.
- various positions are treated as positive values on the traveling direction side of the own vehicle M with reference to the position of the own vehicle M at a certain point in time (for example, current time t i ), and are opposite to the traveling direction.
- the side is treated as a negative value.
- the first calculation unit 165 derives a target speed when the host vehicle M travels along the track, based on the distance between the plurality of track points K included in the track generated by the track generation unit 146. .
- the first calculation unit 165 selects a track point K () that the host vehicle M should reach from the plurality of track points K included in the track until the time of n seconds elapses from the current time t i. K (i + n) is extracted from i), and the average velocity is derived by dividing the length of the trajectory including K (i + n) from these trajectory points K (i) by the time of n seconds (step S100). ).
- This average speed is treated as the target speed of the host vehicle M on the track including the track points K (i) to K (i + n).
- the time of n seconds is an example of “first predetermined time”.
- the second calculation unit 166 extracts a trajectory point K (i) corresponding to the current time t i from a plurality of trajectory points K included in the trajectory generated by the trajectory generation unit 146.
- Third arithmetic unit 167 extracts the current time t i than the n seconds of time shorter predetermined time (e.g. 1 second) elapsed time t i + 1 to the corresponding trajectory point K (i + 1).
- the predetermined time shorter than the time of n seconds from the current time t i is an example of “second predetermined time”.
- the fourth calculation unit 168 determines the current time based on the host vehicle position P act (i) recognized by the host vehicle position recognition unit 140 and the speed v and acceleration ⁇ of the host vehicle M detected by the vehicle sensor 60.
- a predicted position P pre (i + 1) at which the host vehicle M is predicted to arrive at time t i + 1 when 1 second has elapsed from t i is derived (step S102).
- the fourth calculation unit 168 derives the predicted position P pre (i + 1) based on the following formula (1).
- T in the formula is a time t i and the time t i + 1 and the difference between the time of. That is, t in the equation corresponds to the time interval (sampling time) of the orbit point K.
- the subtractor 169 derives a deviation (hereinafter referred to as a current deviation) obtained by subtracting the own vehicle position P act (i) from the track point K (i) extracted by the second arithmetic unit 166 (step S104). Then, the subtractor 169 outputs the derived current deviation to the proportional-plus-integral control unit 171.
- the current deviation is an example of a “first deviation”.
- the subtracter 170 subtracts the predicted position P pre (i + 1) derived by the fourth computing unit 168 from the trajectory point K (i + 1) extracted by the third computing unit 167 (hereinafter referred to as future deviation). Is derived (step S106). Then, the subtractor 170 outputs the derived future deviation to the proportional control unit 172.
- the future deviation is an example of a “second deviation”.
- the proportional integral control unit 171 multiplies the current deviation output from the subtractor 169 by a predetermined proportional gain, and multiplies the time integral value of the current deviation by a predetermined integral gain. Then, the proportional-integral control unit 171 adds the current deviation multiplied by the proportional gain and the time integral value of the current deviation multiplied by the integral gain, so that the host vehicle M is tracked from the host vehicle position P act (i).
- a speed correction amount that approximates the point K (i) (hereinafter referred to as a first correction amount) is derived as an operation amount (step S108).
- the vehicle position P act of the current time t i the (i) can be brought closer to the track point K (i) is a target position corresponding to the current time t i.
- the proportional control unit 172 multiplies the future deviation output from the subtracter 170 by a predetermined proportional gain, and moves the host vehicle M from the predicted position P pre (i + 1) to the track point K (i + 1) at a time point one second later.
- a speed correction amount (hereinafter referred to as a second correction amount) that approximates the speed is derived as an operation amount (step S110). In this way, the proportional control unit 172 performs proportional control that allows for future deviations including uncertain elements.
- the first output adjustment unit 173 is, for example, a filter circuit that limits the first correction amount derived by the proportional integration control unit 171. For example, the first output adjustment unit 173 performs filtering on the first correction amount so that the speed indicated by the first correction amount does not increase or decrease by 15 km / h or more (step S112).
- the second output adjustment unit 174 is a filter circuit that limits the second correction amount derived by the proportional control unit 172, for example. For example, like the first output adjustment unit 173, the second output adjustment unit 174 performs filtering on the second correction amount so that the speed indicated by the second correction amount does not increase or decrease by 15 km / h or more (step S114). .
- the limitation at the time of increase of speed and the limitation at the time of decrease may be different.
- the adder 176 adds the first correction amount adjusted by the first output adjustment unit 173 and the second correction amount adjusted by the second output adjustment unit 174, and adds these correction amounts to a third correction The amount is output to the third output adjustment unit 175.
- the third output adjustment unit 175 is a filter circuit that limits the third correction amount output by the adder 176, for example.
- the third output adjustment unit 175 performs filtering on the third correction amount so that the speed indicated by the third correction amount does not increase or decrease by 5 km / h or more (step S116).
- the adder 177 adds the third correction amount adjusted by the third output adjustment unit 175 to the average speed derived by the first calculation unit 165 and adds the third correction amount adjusted by the third output adjustment unit 175 for n seconds from the current time t i .
- the target speed is output (step S118).
- the acceleration / deceleration control unit 164 determines the control amounts of the driving force output device 200 and the brake device 220 according to the target speed.
- Such control can suppress frequent acceleration / deceleration.
- the own vehicle position P act (i) recognized by the own vehicle position recognition unit 140 and the time when the position of the own vehicle M among the plurality of track points K is recognized (recognition time, for example, the current time t i ).
- the vehicle M is moved from the predicted position P pre (i + 1) to the track point K at the second correction amount, that is, 1 second later.
- the target speed is corrected only by the speed correction amount that approaches (i + 1).
- a steady offset (deviation) that always overtakes or cannot always overtake each trajectory point K may occur due to a sensor error or the like.
- frequent acceleration / deceleration may occur.
- the offset with respect to the trajectory point K can be reduced. More specifically, since the proportional integral controller 171 derives the first correction amount by performing a time integration of the current deviation, the vehicle position P act of the current time t i the (i), the current time t i Can be made closer to the trajectory point K (i), which is the target position corresponding to. Further, when the proportional control unit 172 performs proportional control, a future deviation including an uncertain element can be allowed to some extent. As a result, frequent acceleration / deceleration can be suppressed.
- the host vehicle position recognition unit 140 that recognizes the position of the host vehicle M and the track point K that indicates the future target position that the host vehicle M should reach are continuous in time series. Then, based on the track generation unit 146 that generates a plurality of tracks included, and the distance between the plurality of track points K included in the track, a target speed for driving the vehicle M along the track is derived.
- the track point K (first time) corresponding to the position (recognition time) of the position of the host vehicle M recognized by the host vehicle position recognition unit 140 and the position of the host vehicle M among the plurality of track points K is recognized.
- the second embodiment is different from the first embodiment in that a dead zone DZ is set for one or both of the future deviation and the current deviation in order to suppress frequent acceleration / deceleration. To do.
- the dead zone DZ is an area provided to reduce the correction amount corresponding to each deviation.
- the difference will be mainly described.
- FIG. 13 is a diagram illustrating an example of the configuration of the acceleration / deceleration control unit 164A according to the second embodiment.
- the acceleration / deceleration control unit 164A further includes a proportional integral gain adjustment unit 180 and a proportional gain adjustment unit 181 in addition to the configuration of the acceleration / deceleration control unit 164 in the first embodiment described above.
- the proportional integral gain adjusting unit 180 sets the first dead zone DZ1 for the current deviation, and when the current deviation derived by the subtracter 169 is within the first dead zone DZ1, the current deviation is the first dead zone DZ1.
- One or both of the proportional gain and the integral gain in the proportional-plus-integral control unit 171 is reduced as compared with the case where the ratio is not within. “Decrease in gain” refers to bringing a positive gain closer to zero or a negative value, or bringing a negative gain closer to zero or a positive value.
- FIGS. 14 and 15 are diagrams illustrating an example of the first dead zone DZ1 with respect to the current deviation.
- the first dead zone DZ1 is only on the positive side of the current deviation (the side on which the track point K (i) is ahead of the own vehicle position P act (i)). Or may be set to be biased toward the positive side. “Biased to the positive side” means, for example, that the center of gravity of the region of the first dead zone DZ1 exists on the positive side of the current deviation.
- the region from the current deviation to zero and the threshold value Th1 (positive value) is set as the first dead zone DZ1.
- FIG. 14 is set as the first dead zone DZ1.
- the region from the threshold Th2 (negative value) to the threshold Th1 (positive value) is set as the first dead zone DZ1.
- the proportional gain and the integral gain take zero. Therefore, if the current deviation is within the first dead zone DZ1, the first correction amount derived by the proportional-plus-integral control unit 171 is zero or about zero.
- the proportional gain adjustment unit 181 sets the second dead zone DZ2 for the future deviation, and when the future deviation derived by the subtractor 170 is within the second dead zone DZ2, the future deviation is within the second dead zone DZ2. Compared with the case where it is not, the proportional gain in the proportional control part 172 is reduced.
- 16 and 17 are diagrams illustrating an example of the second dead zone DZ2 with respect to the future deviation.
- the second dead zone DZ2 may be set only on the positive side of the current deviation or biased to the positive side, similarly to the first dead zone DZ1.
- a region from the current deviation to zero and the threshold Th1 (positive value) is set as the second dead zone DZ2.
- a region from the threshold Th2 (negative value) to the threshold Th1 (positive value) is set as the second dead zone DZ2.
- the proportional gain is zero.
- the second correction amount derived by the proportional control unit 172 is zero or about zero.
- the first dead zone DZ1 and the second dead zone DZ2 described above may have different sizes in their areas, one of which is set only on the positive side of the deviation and the other on the positive side. It may be set unevenly.
- FIG. 18 is a diagram illustrating an example of acceleration / deceleration control for each scene.
- FIG. 18A shows one scene where the current deviation is not within the first dead zone DZ1.
- FIG. 18B shows a scene where the current deviation is in the first dead zone DZ1.
- the acceleration / deceleration control unit 164 needs to control the driving force output device 200 to accelerate the host vehicle M.
- the first correction amount is added to the average speed, and the host vehicle M accelerates from the current average speed.
- the first correction amount decreases. In this case, it is easy to maintain the average speed derived by the first calculation unit 165 without performing acceleration control. By such processing, it is possible to suppress frequent acceleration when the host vehicle M has not reached the track point K (0).
- the dead zone DZ is set for the deviation when the track point K (i) is ahead of the own vehicle position P act (i).
- the dead zone DZ may be set for the deviation when the trajectory point K (i) is behind the position P act (i).
- FIGS. 19 and 20 are diagrams showing another example of the first dead zone DZ1 with respect to the current deviation.
- the first dead zone DZ1 is only the negative side of the current deviation (lateral vehicle position P act (i) in comparison with the track point K (i) is a rear side) Or may be set biased to the negative side.
- a region where the current deviation is from the threshold value Th3 (negative value) to zero is set as the first dead zone DZ1.
- the region from the threshold Th3 (negative value) to the threshold Th4 (positive value) is set as the first dead zone DZ1.
- FIGS. 21 and 22 are diagrams showing another example of the second dead zone DZ2 with respect to the future deviation.
- the second dead zone DZ2 may be set only on the negative side of the current deviation or on the negative side.
- the region where the current deviation is from the threshold value Th3 (negative value) to zero is set as the second dead zone DZ2.
- a region from the threshold Th3 (negative value) to the threshold Th4 (positive value) is set as the second dead zone DZ2.
- the first dead zone DZ1 and the second dead zone DZ2 may have different sizes of areas, one of which is set only on the negative side of the deviation, and the other is negative. It may be set biased to the side.
- FIG. 23 is a diagram illustrating an example of acceleration / deceleration control for each scene.
- FIG. 23A shows a scene where the current deviation is not within the first dead zone DZ1.
- FIG. 23B shows a scene in which the current deviation is within the first dead zone DZ1.
- the course point than the vehicle position P act at the current time t 0 (0) K (0 ) is positioned behind. That is, the vehicle M is greater than the track point K (0) to be reached at the current time t 0.
- the acceleration / deceleration control unit 164 needs to control the driving force output device 200 to decelerate the host vehicle M.
- the first correction amount is added to the average speed, and the host vehicle M decelerates from the current average speed.
- the first correction amount decreases.
- the average speed derived by the first calculation unit 165 is easily maintained without performing the deceleration control. By such processing, it is possible to suppress frequent deceleration when the host vehicle M exceeds the track point K (0).
- the proportional integral gain adjusting unit 180 described above includes a preceding vehicle that travels immediately before the host vehicle M and a subsequent vehicle that travels immediately after the host vehicle M among the surrounding vehicles whose states are recognized by the external field recognition unit 142.
- the area size of the first dead zone DZ1 that is set for the current deviation may be changed based on the distance between one or both and the host vehicle M.
- the proportional gain adjustment unit 181 determines the future deviation based on the distance between the host vehicle M and one or both of the preceding vehicle traveling immediately before the host vehicle M and the following vehicle traveling immediately after the host vehicle M.
- the area size of the second dead zone DZ2 that is set for may be changed.
- 24 and 25 are diagrams for explaining a method of changing the area size of the dead zone DZ.
- the proportional integral gain adjusting unit 180 or the proportional gain adjusting unit 181 is set in the dead zone.
- the threshold value Th1 on the positive side of DZ is increased on the positive side as the inter-vehicle distance with the subsequent vehicle increases, and is decreased on the positive side as the inter-vehicle distance with the subsequent vehicle decreases.
- the acceleration / deceleration control unit 164 can frequently accelerate the vehicle by narrowing the dead zone DZ in consideration of safety when the inter-vehicle distance from the succeeding vehicle is reduced. Further, the acceleration / deceleration control unit 164 can reduce the frequency of acceleration by widening the dead zone DZ when the inter-vehicle distance from the following vehicle is increased.
- the proportional integral gain adjusting unit 180 or the proportional gain adjusting unit 181 is set when the track point K (i) is behind the own vehicle position P act (i).
- the threshold value Th3 on the negative side of the dead zone DZ is increased on the negative side as the inter-vehicle distance with the preceding vehicle increases, and is decreased on the negative side as the inter-vehicle distance with the preceding vehicle decreases. .
- the acceleration / deceleration control unit 164 can frequently reduce the speed by narrowing the dead zone DZ in consideration of safety when the distance between the vehicle and the preceding vehicle is reduced. Further, the acceleration / deceleration control unit 164 can reduce the frequency of deceleration by widening the dead zone DZ when the inter-vehicle distance from the preceding vehicle is increased.
- FIG. 26 is a flowchart illustrating an example of a process flow of the acceleration / deceleration control unit 164A according to the second embodiment.
- the first calculation unit 165 selects a track point K () that the host vehicle M should reach from the plurality of track points K included in the track until the time of n seconds elapses from the current time t i.
- K (i + n) is extracted from i), and the average velocity is derived by dividing the length of the trajectory including K (i + n) from these trajectory points K (i) by the time of n seconds (step S200). ).
- the fourth calculation unit 168 is based on the own vehicle position P act (i) recognized by the own vehicle position recognition unit 140 and the speed v and acceleration ⁇ of the own vehicle M detected by the vehicle sensor 60.
- a predicted position P pre (i + 1) at which the host vehicle M is predicted to arrive at time t i + 1 after 1 second has elapsed from the current time t i is derived (step S202).
- the subtractor 169 derives a current deviation obtained by subtracting the vehicle position P act (i) from the track point K (i) extracted by the second calculation unit 166 (step S204).
- the subtractor 170 derives a future deviation obtained by subtracting the predicted position P pre (i + 1) derived by the fourth computing unit 168 from the trajectory point K (i + 1) extracted by the third computing unit 167 ( Step S206).
- the proportional integral gain adjustment unit 180 determines whether or not the current deviation is within the first dead zone DZ1 (step S208). If the current deviation is within the first dead zone DZ1, the proportional integral control unit One or both of the proportional gain and the integral gain at 171 are reduced (step S210). On the other hand, if the current deviation is not within the first dead zone DZ1, the proportional integral gain adjustment unit 180 moves the process to S212.
- the proportional integral control unit 171 multiplies the current deviation output from the subtractor 169 by a predetermined proportional gain, multiplies the time integral value of the current deviation by a predetermined integral gain, and adds these.
- the first correction amount is derived (step S212).
- the first output adjustment unit 173 performs filtering on the first correction amount (step S214).
- the proportional gain adjustment unit 181 determines whether or not the future deviation is within the second dead zone DZ2 (step S216). When the future deviation is within the second dead zone DZ2, the proportional control unit 172 The proportional gain is reduced (step S218). On the other hand, if the future deviation is not within the second dead zone DZ2, the proportional gain adjustment unit 181 moves the process to S220.
- the proportional control unit 172 derives the second correction amount by multiplying the future deviation output from the subtractor 170 by a predetermined proportional gain (step S220).
- the second output adjustment unit 174 performs filtering on the second correction amount (step S222).
- the third output adjustment unit 175 performs filtering on the third correction amount obtained by adding the first correction amount and the second correction amount (step S224).
- the adder 177 adds the third correction amount adjusted by the third output adjustment unit 175 to the average speed derived by the first calculation unit 165, and automatically adds it for n seconds from the current time t i.
- the target speed of the vehicle M is output (step S226). Thereby, the process of this flowchart is complete
- the dead zone DZ is set for one or both of the future deviation and the current deviation, the occurrence of more frequent acceleration / deceleration can be suppressed. As a result, passenger discomfort can be reduced while considering the safety of the vehicle.
- the area of the dead zone DZ is changed based on the inter-vehicle distance from the preceding vehicle or the following vehicle, it is possible to efficiently suppress the occurrence of frequent acceleration / deceleration.
- the third embodiment is different from the first and third embodiments in that the output gain of the third correction amount is adjusted when the speed of the host vehicle M is low.
- the difference will be mainly described.
- FIG. 27 is a diagram illustrating an example of the configuration of the acceleration / deceleration control unit 164B according to the third embodiment.
- the acceleration / deceleration control unit 164B includes, for example, a first calculation unit 165, a second calculation unit 166, a third calculation unit 167, a fourth calculation unit 168, subtracters 169 and 170, and a proportional integration control unit 171.
- the third gain adjustment unit 183 decreases the output gain for adjusting the third correction amount obtained by adding the first correction amount and the second correction amount as the speed v of the host vehicle M decreases.
- Multiplier 184 multiplies the output gain adjusted by third gain adjustment section 183 and the third correction amount output by adder 176 and outputs the result to adder 177.
- FIG. 28 is a diagram illustrating an example of a change in the output gain with respect to the speed v of the host vehicle M.
- the output gain decreases to 1 or less as the speed v decreases. For this reason, when the host vehicle M gradually decelerates and stops, the third correction amount decreases, and therefore the occurrence of acceleration / deceleration is further suppressed.
- the third correction amount is decreased as the speed of the host vehicle M decreases, for example, frequent acceleration / deceleration is suppressed when the host vehicle M stops. it can. Thereby, a smooth stop can be performed.
- the third correction amount is increased as the speed of the host vehicle M increases, the host vehicle M can be smoothly accelerated from the stopped state. As a result, passenger discomfort can be reduced.
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Human Computer Interaction (AREA)
- Aviation & Aerospace Engineering (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Business, Economics & Management (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Game Theory and Decision Science (AREA)
- Medical Informatics (AREA)
Abstract
車両制御システムは、車両の位置を認識する位置認識部と、車両が到達すべき将来の目標位置が、時系列に連続して数含まれる軌道を生成する軌道生成部と、前記軌道に含まれる複数の目標位置間の距離に基づいて、軌道に沿って車両を走行させる際の目標速度を導出すると共に、位置認識部により認識された車両の位置と、複数の目標位置のうち車両の位置認識がおこなわれた認識時刻に対応した第1の目標位置との第1の偏差に基づいて、前記目標速度を補正する走行制御部とを備える。
Description
本発明は、車両制御システム、車両制御方法、および車両制御プログラムに関する。
本願は、2016年5月16日に出願された日本国特願2016-098048号に基づき優先権を主張し、その内容をここに援用する。
本願は、2016年5月16日に出願された日本国特願2016-098048号に基づき優先権を主張し、その内容をここに援用する。
近年、車両の加減速と操舵とのうち、少なくとも一方を自動的に制御する技術(以下、自動運転)について研究が進められている。これに関連して、自車速度及び前走車速度の速度差をあらかじめ定めた所定値と比較し、その比較結果に基づき自車速度又は前走車速度に応じて自車と前走車との車間距離を調整するために加減速を制御し、自車速度及び前走車速度の速度差が所定値以上であるとき、自車速度に応じて加減速を修正する自動走行車が知られている(例えば、特許文献1参照)。
しかしながら、従来の技術では、自動運転中に加減速が頻繁に行われる可能性があった。このため、車両の乗員が自動運転を不快に感じることが想定される。
本発明の態様は、乗員の不快感を低減させることができる車両制御システム、車両制御方法、および車両制御プログラムを提供することを目的の一つとする。
(1)本発明の一態様に係る車両制御システムは、車両の位置を認識する位置認識部と、前記車両が到達すべき将来の目標位置が、時系列に連続して複数含まれる軌道を生成する軌道生成部と、前記軌道に含まれる前記複数の目標位置間の距離に基づいて、前記軌道に沿って前記車両を走行させる際の目標速度を導出すると共に、前記位置認識部により認識された前記車両の位置と、前記複数の目標位置のうち前記車両の位置認識がおこなわれた認識時刻に対応した第1の目標位置との第1の偏差に基づいて、前記目標速度を補正する走行制御部と、を備える。
(2)上記(1)の態様において、前記走行制御部が、前記複数の目標位置の中から、前記認識時刻から第1の所定時間が経過した将来の時刻に対応する第2の目標位置を抽出し、前記第1の目標位置から、前記第2の目標位置までの前記軌道の長さを、前記第1の所定時間で除算した速度を、前記目標速度として導出してもよい。
(3)上記(2)の態様において、前記走行制御部が、更に、前記認識時刻から、前記第1の所定時間に比して短い第2の所定時間が経過した将来の時刻に対応した第3の目標位置と、前記将来の時刻において前記車両が到達することが予測される予測位置との第2の偏差に基づいて、前記目標速度を補正してもよい。
(4)上記(3)の態様において、前記第1の偏差に基づく前記目標速度の補正量と、前記第2の偏差に基づく前記目標速度の補正量との一方または双方には制限が設けられてもよく、前記走行制御部が、前記制限の範囲内の補正量で前記導出した目標速度を補正してもよい。
(5)上記(3)または(4)の態様において、前記第1の偏差および前記第2の偏差の少なくとも一方に対して、それぞれの偏差に応じて前記目標速度の補正量を減少させる領域が設けられてもよく、前記走行制御部が、求められた偏差が前記第1の偏差および前記第2の偏差の少なくとも一方の前記領域内にある場合、求められた偏差が前記領域外にある場合の前記目標速度の補正量に比して少ない補正量で前記目標速度を補正してもよい。
(6)上記(5)の態様において、前記車両の周辺を走行する他車両を認識する外界認識部を更に備えてもよく、前記走行制御部が、前記外界認識部により認識された他車両のうち、前記車両の前方を走行する前走車両および前記車両の後方を走行する後続車両の一方または双方と、前記車両との車間距離が大きくなるほど、前記領域の領域範囲を広く設定してもよい。
(7)上記(3)または(4)の態様において、前記走行制御部が、前記第1の偏差および前記第2の偏差の少なくとも一方が閾値以下である場合、求められた偏差が前記閾値を超える場合の前記目標速度の補正量に比して少ない補正量で前記導出した目標速度を補正してもよい。
(8)上記(7)の態様において、前記車両の周辺を走行する他車両を認識する外界認識部を更に備えてもよく、前記走行制御部が、前記外界認識部により認識された他車両のうち、前記車両の前方を走行する前走車両および前記車両の後方を走行する後続車両の一方または双方と、前記車両との車間距離が大きくなるほど、前記閾値を大きくしてもよい。
(9)上記(3)から(8)のいずれか一項の態様において、前記車両の速度を検出する検出部を更に備えてもよく、前記走行制御部が、前記検出部により検出された速度が低下するほど、前記第1の偏差に基づく前記目標速度の補正量、または前記第2の偏差に基づく前記目標速度の補正量を少なくしてもよい。
(10)本発明の一態様に係る車両制御方法は、車載コンピュータが、車両の位置を認識し、前記車両が到達すべき将来の目標位置が、時系列に連続して複数含まれる軌道を生成し、前記軌道に含まれる前記複数の目標位置間の距離に基づいて、前記軌道に沿って前記車両を走行させる際の目標速度を導出し、前記認識した前記車両の位置と、前記複数の目標位置のうち前記車両の位置認識がおこなわれた認識時刻に対応した第1の目標位置との第1の偏差に基づいて、前記目標速度を補正する。
(11)本発明の一態様に係る車両制御プログラムは、車載コンピュータに、車両の位置を認識させ、前記車両が到達すべき将来の目標位置が、時系列に連続して複数含まれる軌道を生成させ、前記軌道に含まれる前記複数の目標位置間の距離に基づいて、前記軌道に沿って前記車両を走行させる際の目標速度を導出させ、前記認識させた前記車両の位置と、前記複数の目標位置のうち前記車両の位置認識がおこなわれた認識時刻に対応した第1の目標位置との第1の偏差に基づいて、前記目標速度を補正させる。
上記(1)~(11)の態様によれば、乗員の不快感を低減させることができる。
以下、図面を参照し、本発明の車両制御システム、車両制御方法、および車両制御プログラムの実施形態について説明する。
<共通構成>
図1は、各実施形態の車両制御システム100が搭載される車両(以下、自車両Mと称する)の構成要素を示す図である。車両制御システム100が搭載される車両は、例えば、二輪や三輪、四輪等の自動車であり、ディーゼルエンジンやガソリンエンジン等の内燃機関を動力源とした自動車や、電動機を動力源とした電気自動車、内燃機関および電動機を兼ね備えたハイブリッド自動車等を含む。電気自動車は、例えば、二次電池、水素燃料電池、金属燃料電池、アルコール燃料電池等の電池により放電される電力を使用して駆動される。
図1は、各実施形態の車両制御システム100が搭載される車両(以下、自車両Mと称する)の構成要素を示す図である。車両制御システム100が搭載される車両は、例えば、二輪や三輪、四輪等の自動車であり、ディーゼルエンジンやガソリンエンジン等の内燃機関を動力源とした自動車や、電動機を動力源とした電気自動車、内燃機関および電動機を兼ね備えたハイブリッド自動車等を含む。電気自動車は、例えば、二次電池、水素燃料電池、金属燃料電池、アルコール燃料電池等の電池により放電される電力を使用して駆動される。
図1に示すように、自車両Mには、ファインダ20-1から20-7、レーダ30-1から30-6、およびカメラ40等のセンサと、ナビゲーション装置50(経路誘導装置)と、車両制御システム100とが搭載される。
ファインダ20-1から20-7は、例えば、照射光に対する散乱光を測定し、対象までの距離を測定するLIDAR(Light Detection and Ranging、或いはLaser Imaging Detection and Ranging)である。例えば、ファインダ20-1は、フロントグリル等に取り付けられ、ファインダ20-2および20-3は、車体の側面やドアミラー、前照灯内部、側方灯付近等に取り付けられる。ファインダ20-4は、トランクリッド等に取り付けられ、ファインダ20-5および20-6は、車体の側面や尾灯内部等に取り付けられる。上述したファインダ20-1から20-6は、例えば、水平方向に関して150度程度の検出領域を有している。また、ファインダ20-7は、ルーフ等に取り付けられる。
ファインダ20-7は、例えば、水平方向に関して360度の検出領域を有している。
レーダ30-1および30-4は、例えば、奥行き方向の検出領域が他のレーダよりも広い長距離ミリ波レーダである。また、レーダ30-2、30-3、30-5、30-6は、レーダ30-1および30-4よりも奥行き方向の検出領域が狭い中距離ミリ波レーダである。
ファインダ20-7は、例えば、水平方向に関して360度の検出領域を有している。
レーダ30-1および30-4は、例えば、奥行き方向の検出領域が他のレーダよりも広い長距離ミリ波レーダである。また、レーダ30-2、30-3、30-5、30-6は、レーダ30-1および30-4よりも奥行き方向の検出領域が狭い中距離ミリ波レーダである。
以下、ファインダ20-1から20-7を特段区別しない場合は、単に「ファインダ20」と記載し、レーダ30-1から30-6を特段区別しない場合は、単に「レーダ30」と記載する。レーダ30は、例えば、FM-CW(Frequency Modulated Continuous Wave)方式によって物体を検出する。
カメラ40は、例えば、CCD(Charge Coupled Device)やCMOS(Complementary Metal Oxide Semiconductor)等の固体撮像素子を利用したデジタルカメラである。カメラ40は、フロントウインドシールド上部やルームミラー裏面等に取り付けられる。カメラ40は、例えば、周期的に繰り返し自車両Mの前方を撮像する。カメラ40は、複数のカメラを含むステレオカメラであってもよい。
なお、図1に示す構成はあくまで一例であり、構成の一部が省略されてもよいし、更に別の構成が追加されてもよい。
<第1の実施形態>
図2は、第1の実施形態に係る車両制御システム100を中心とした機能構成図である。
自車両Mには、ファインダ20、レーダ30、およびカメラ40などを含む検知デバイスDDと、ナビゲーション装置50と、通信装置55と、車両センサ60と、表示装置62と、スピーカ64と、操作デバイス70と、操作検出センサ72と、切替スイッチ80と、車両制御システム100と、駆動力出力装置200と、ステアリング装置210と、ブレーキ装置220とが搭載される。
これらの装置や機器は、CAN(Controller Area Network)通信線等の多重通信線やシリアル通信線、無線通信網等によって互いに接続される。
なお、特許請求の範囲における車両制御システムは、「車両制御システム100」のみを指しているのではなく、車両制御システム100以外の構成(検知デバイスDDなど)を含んでもよい。
図2は、第1の実施形態に係る車両制御システム100を中心とした機能構成図である。
自車両Mには、ファインダ20、レーダ30、およびカメラ40などを含む検知デバイスDDと、ナビゲーション装置50と、通信装置55と、車両センサ60と、表示装置62と、スピーカ64と、操作デバイス70と、操作検出センサ72と、切替スイッチ80と、車両制御システム100と、駆動力出力装置200と、ステアリング装置210と、ブレーキ装置220とが搭載される。
これらの装置や機器は、CAN(Controller Area Network)通信線等の多重通信線やシリアル通信線、無線通信網等によって互いに接続される。
なお、特許請求の範囲における車両制御システムは、「車両制御システム100」のみを指しているのではなく、車両制御システム100以外の構成(検知デバイスDDなど)を含んでもよい。
ナビゲーション装置50は、GNSS(Global Navigation Satellite System)受信機や地図情報(ナビ地図)、ユーザインターフェースとして機能するタッチパネル式表示装置、スピーカ、マイク等を有する。ナビゲーション装置50は、GNSS受信機によって自車両Mの位置を特定し、その位置からユーザによって指定された目的地までの経路を導出する。
ナビゲーション装置50により導出された経路は、車両制御システム100の目標車線決定部110に提供される。自車両Mの位置は、車両センサ60の出力を利用したINS(Inertial Navigation System)によって特定または補完されてもよい。
また、ナビゲーション装置50は、車両制御システム100が手動運転モードを実行している際に、目的地に至る経路について音声やナビ表示によって案内を行う。
なお、自車両Mの位置を特定するための構成は、ナビゲーション装置50とは独立して設けられてもよい。
また、ナビゲーション装置50は、例えば、ユーザの保有するスマートフォンやタブレット端末等の端末装置の機能によって実現されてもよい。この場合、端末装置と車両制御システム100との間で、無線または有線による通信によって情報の送受信が行われる。
ナビゲーション装置50により導出された経路は、車両制御システム100の目標車線決定部110に提供される。自車両Mの位置は、車両センサ60の出力を利用したINS(Inertial Navigation System)によって特定または補完されてもよい。
また、ナビゲーション装置50は、車両制御システム100が手動運転モードを実行している際に、目的地に至る経路について音声やナビ表示によって案内を行う。
なお、自車両Mの位置を特定するための構成は、ナビゲーション装置50とは独立して設けられてもよい。
また、ナビゲーション装置50は、例えば、ユーザの保有するスマートフォンやタブレット端末等の端末装置の機能によって実現されてもよい。この場合、端末装置と車両制御システム100との間で、無線または有線による通信によって情報の送受信が行われる。
通信装置55は、例えば、セルラー網やWi-Fi網、Bluetooth(登録商標)、DSRC(Dedicated Short Range Communication)などを利用した無線通信を行う。
車両センサ60は、車速を検出する車速センサ、加速度を検出する加速度センサ、鉛直軸回りの角速度を検出するヨーレートセンサ、自車両Mの向きを検出する方位センサ等を含む。車両センサ60は、「検出部」の一例である。
表示装置62は、情報を画像として表示する。表示装置62は、例えばLCD(Liquid Crystal Display)や、有機EL(Electroluminescence)表示装置等を含む。本実施形態では、表示装置62は、自車両Mのフロントウィンドウに画像を反射させて、車両乗員の視野内に画像を表示するヘッドアップディスプレイであるものとして説明する。なお、表示装置62は、ナビゲーション装置50が備える表示装置や、自車両Mの状態(速度等)を表示するインストルメントパネルの表示装置であってもよい。スピーカ64は、情報を音声として出力する。
操作デバイス70は、例えば、アクセルペダルやステアリングホイール、ブレーキペダル、シフトレバー等を含む。操作デバイス70には、運転者による操作の有無や量を検出する操作検出センサ72が取り付けられている。
操作検出センサ72は、例えば、アクセル開度センサ、ステアリングトルクセンサ、ブレーキセンサ、シフト位置センサ等を含む。操作検出センサ72は、検出結果としてのアクセル開度、ステアリングトルク、ブレーキ踏量、シフト位置等を走行制御部160に出力する。
なお、これに代えて、操作検出センサ72の検出結果が、直接的に駆動力出力装置200、ステアリング装置210、またはブレーキ装置220に出力されてもよい。
操作検出センサ72は、例えば、アクセル開度センサ、ステアリングトルクセンサ、ブレーキセンサ、シフト位置センサ等を含む。操作検出センサ72は、検出結果としてのアクセル開度、ステアリングトルク、ブレーキ踏量、シフト位置等を走行制御部160に出力する。
なお、これに代えて、操作検出センサ72の検出結果が、直接的に駆動力出力装置200、ステアリング装置210、またはブレーキ装置220に出力されてもよい。
切替スイッチ80は、車両乗員によって操作されるスイッチである。切替スイッチ80は、車両乗員の操作を受け付け、走行制御部160による制御モードを自動運転モードまたは手動運転モードのいずれか一方に指定する制御モード指定信号を生成し、切替制御部150に出力する。
自動運転モードとは、上述したように、運転者が操作を行わない(或いは手動運転モードに比して操作量が小さい、または操作頻度が低い)状態で走行する運転モードである。より具体的には、自動運転モードとは、行動計画に基づいて駆動力出力装置200、ステアリング装置210、およびブレーキ装置220の一部または全部を制御する運転モードである。
また、切替スイッチ80は、自動運転モードを切り替える操作の他に、種々の操作を受け付けてもよい。例えば、車両制御システム100側から出力された情報が表示装置62を介して車両乗員に提示された場合、切替スイッチ80は、これに対する応答操作などを受け付けてよい。
自動運転モードとは、上述したように、運転者が操作を行わない(或いは手動運転モードに比して操作量が小さい、または操作頻度が低い)状態で走行する運転モードである。より具体的には、自動運転モードとは、行動計画に基づいて駆動力出力装置200、ステアリング装置210、およびブレーキ装置220の一部または全部を制御する運転モードである。
また、切替スイッチ80は、自動運転モードを切り替える操作の他に、種々の操作を受け付けてもよい。例えば、車両制御システム100側から出力された情報が表示装置62を介して車両乗員に提示された場合、切替スイッチ80は、これに対する応答操作などを受け付けてよい。
車両制御システム100の説明に先立って、駆動力出力装置200、ステアリング装置210、およびブレーキ装置220について説明する。
駆動力出力装置200は、車両が走行するための走行駆動力(トルク)を駆動輪に出力する。駆動力出力装置200は、例えば、自車両Mが内燃機関を動力源とした自動車である場合、エンジン、変速機、およびエンジンを制御するエンジンECU(Electronic Control Unit)を備える。また、自車両Mが電動機を動力源とした電気自動車である場合、駆動力出力装置200は、走行用モータおよび走行用モータを制御するモータECUを備える。また、自車両Mがハイブリッド自動車である場合、駆動力出力装置200は、エンジン、変速機、およびエンジンECUと走行用モータおよびモータECUとを備える。
駆動力出力装置200がエンジンのみを含む場合、エンジンECUは、後述する走行制御部160から入力される情報に従って、エンジンのスロットル開度やシフト段等を調整する。
駆動力出力装置200が走行用モータのみを含む場合、モータECUは、走行制御部160から入力される情報に従って、走行用モータに与えるPWM信号のデューティ比を調整する。
駆動力出力装置200がエンジンおよび走行用モータを含む場合、エンジンECUおよびモータECUは、走行制御部160から入力される情報に従って、互いに協調して走行駆動力を制御する。
駆動力出力装置200がエンジンのみを含む場合、エンジンECUは、後述する走行制御部160から入力される情報に従って、エンジンのスロットル開度やシフト段等を調整する。
駆動力出力装置200が走行用モータのみを含む場合、モータECUは、走行制御部160から入力される情報に従って、走行用モータに与えるPWM信号のデューティ比を調整する。
駆動力出力装置200がエンジンおよび走行用モータを含む場合、エンジンECUおよびモータECUは、走行制御部160から入力される情報に従って、互いに協調して走行駆動力を制御する。
ステアリング装置210は、例えば、ステアリングECUと、電動モータとを備える。
電動モータは、例えば、ラックアンドピニオン機構に力を作用させて転舵輪の向きを変更する。
ステアリングECUは、車両制御システム100から入力される情報、或いは入力されるステアリング操舵角またはステアリングトルクの情報に従って電動モータを駆動し、転舵輪の向きを変更させる。
電動モータは、例えば、ラックアンドピニオン機構に力を作用させて転舵輪の向きを変更する。
ステアリングECUは、車両制御システム100から入力される情報、或いは入力されるステアリング操舵角またはステアリングトルクの情報に従って電動モータを駆動し、転舵輪の向きを変更させる。
ブレーキ装置220は、例えば、ブレーキキャリパーと、ブレーキキャリパーに油圧を伝達するシリンダと、シリンダに油圧を発生させる電動モータと、制動制御部とを備える電動サーボブレーキ装置である。
電動サーボブレーキ装置の制動制御部は、走行制御部160から入力される情報に従って電動モータを制御し、制動操作に応じたブレーキトルクが各車輪に出力されるようにする。
電動サーボブレーキ装置は、ブレーキペダルの操作によって発生させた油圧を、マスターシリンダを介してシリンダに伝達する機構をバックアップとして備えてよい。
なお、ブレーキ装置220は、上記説明した電動サーボブレーキ装置に限らず、電子制御式油圧ブレーキ装置であってもよい。電子制御式油圧ブレーキ装置は、走行制御部160から入力される情報に従ってアクチュエータを制御して、マスターシリンダの油圧をシリンダに伝達する。
また、ブレーキ装置220は、駆動力出力装置200に含まれ得る走行用モータによる回生ブレーキを含んでもよい。この回生ブレーキは、駆動力出力装置90に含まれ得る走行用モータにより発電された電力を利用する。
電動サーボブレーキ装置の制動制御部は、走行制御部160から入力される情報に従って電動モータを制御し、制動操作に応じたブレーキトルクが各車輪に出力されるようにする。
電動サーボブレーキ装置は、ブレーキペダルの操作によって発生させた油圧を、マスターシリンダを介してシリンダに伝達する機構をバックアップとして備えてよい。
なお、ブレーキ装置220は、上記説明した電動サーボブレーキ装置に限らず、電子制御式油圧ブレーキ装置であってもよい。電子制御式油圧ブレーキ装置は、走行制御部160から入力される情報に従ってアクチュエータを制御して、マスターシリンダの油圧をシリンダに伝達する。
また、ブレーキ装置220は、駆動力出力装置200に含まれ得る走行用モータによる回生ブレーキを含んでもよい。この回生ブレーキは、駆動力出力装置90に含まれ得る走行用モータにより発電された電力を利用する。
[車両制御システム]
以下、車両制御システム100について説明する。車両制御システム100は、例えば、一以上のプロセッサまたは同等の機能を有するハードウェアにより実現される。車両制御システム100は、CPU(Central Processing Unit)などのプロセッサ、記憶装置、および通信インターフェースが内部バスによって接続されたECU(Electronic Control Unit)、或いはMPU(Micro-Processing Unit)などが組み合わされた構成であってよい。
以下、車両制御システム100について説明する。車両制御システム100は、例えば、一以上のプロセッサまたは同等の機能を有するハードウェアにより実現される。車両制御システム100は、CPU(Central Processing Unit)などのプロセッサ、記憶装置、および通信インターフェースが内部バスによって接続されたECU(Electronic Control Unit)、或いはMPU(Micro-Processing Unit)などが組み合わされた構成であってよい。
図2に戻り、車両制御システム100は、例えば、目標車線決定部110と、自動運転制御部120と、走行制御部160と、記憶部190とを備える。
自動運転制御部120は、例えば、自動運転モード制御部130と、自車位置認識部140と、外界認識部142と、行動計画生成部144と、軌道生成部146と、切替制御部150とを備える。
自動運転制御部120は、例えば、自動運転モード制御部130と、自車位置認識部140と、外界認識部142と、行動計画生成部144と、軌道生成部146と、切替制御部150とを備える。
目標車線決定部110、自動運転制御部120の各部、および走行制御部160のうち一部または全部は、プロセッサがプログラム(ソフトウェア)を実行することにより実現される。また、これらのうち一部または全部は、LSI(Large Scale Integration)やASIC(Application Specific Integrated Circuit)等のハードウェアによって実現されてもよいし、ソフトウェアとハードウェアの組み合わせによって実現されてもよい。
記憶部190には、例えば、高精度地図情報192、目標車線情報194、行動計画情報196などの情報が格納される。
記憶部190は、ROM(Read Only Memory)やRAM(Random Access Memory)、HDD(Hard Disk Drive)、フラッシュメモリ等で実現される。プロセッサが実行するプログラムは、予め記憶部190に格納されていてもよいし、車載インターネット設備等を介して外部装置からダウンロードされてもよい。
また、プログラムは、そのプログラムを格納した可搬型記憶媒体が図示しないドライブ装置に装着されることで記憶部190にインストールされてもよい。
また、車両制御システム100は、複数のコンピュータ装置によって分散化されたものであってもよい。
記憶部190は、ROM(Read Only Memory)やRAM(Random Access Memory)、HDD(Hard Disk Drive)、フラッシュメモリ等で実現される。プロセッサが実行するプログラムは、予め記憶部190に格納されていてもよいし、車載インターネット設備等を介して外部装置からダウンロードされてもよい。
また、プログラムは、そのプログラムを格納した可搬型記憶媒体が図示しないドライブ装置に装着されることで記憶部190にインストールされてもよい。
また、車両制御システム100は、複数のコンピュータ装置によって分散化されたものであってもよい。
目標車線決定部110は、例えば、MPUにより実現される。目標車線決定部110は、ナビゲーション装置50から提供された経路を複数のブロックに分割し(例えば、車両進行方向に関して100[m]毎に分割し)、高精度地図情報192を参照してブロックごとに目標車線を決定する。目標車線決定部110は、例えば、左から何番目の車線を走行するといった決定を行う。目標車線決定部110は、例えば、経路において分岐箇所や合流箇所などが存在する場合、自車両Mが、分岐先に進行するための合理的な走行経路を走行できるように、目標車線を決定する。目標車線決定部110により決定された目標車線は、目標車線情報194として記憶部190に記憶される。
高精度地図情報192は、ナビゲーション装置50が有するナビ地図よりも高精度な地図情報である。高精度地図情報192は、例えば、車線の中央の情報あるいは車線の境界の情報等を含んでいる。
また、高精度地図情報192には、道路情報、交通規制情報、住所情報(住所・郵便番号)、施設情報、電話番号情報などが含まれてよい。
道路情報には、高速道路、有料道路、国道、都道府県道といった道路の種別を表す情報や、道路の車線数、各車線の幅員、道路の勾配、道路の位置(経度、緯度、高さを含む3次元座標)、車線のカーブの曲率、車線の合流および分岐ポイントの位置、道路に設けられた標識等の情報が含まれる。
交通規制情報には、工事や交通事故、渋滞等によって車線が封鎖されているといった情報が含まれる。
また、高精度地図情報192には、道路情報、交通規制情報、住所情報(住所・郵便番号)、施設情報、電話番号情報などが含まれてよい。
道路情報には、高速道路、有料道路、国道、都道府県道といった道路の種別を表す情報や、道路の車線数、各車線の幅員、道路の勾配、道路の位置(経度、緯度、高さを含む3次元座標)、車線のカーブの曲率、車線の合流および分岐ポイントの位置、道路に設けられた標識等の情報が含まれる。
交通規制情報には、工事や交通事故、渋滞等によって車線が封鎖されているといった情報が含まれる。
自動運転モード制御部130は、自動運転制御部120が実施する自動運転のモードを決定する。本実施形態における自動運転のモードには、以下のモードが含まれる。なお、以下はあくまで一例であり、自動運転のモードの数や種類は任意に決定されてよい。
[モードA]
モードAは、最も自動運転の度合が高いモードである。モードAが実施されている場合、複雑な合流制御など、全ての車両制御が自動的に行われるため、車両乗員は自車両Mの周辺や状態を監視する必要が無い。
[モードB]
モードBは、モードAの次に自動運転の度合が高いモードである。モードBが実施されている場合、原則として全ての車両制御が自動的に行われるが、場面に応じて自車両Mの運転操作が車両乗員に委ねられる。このため、車両乗員は自車両Mの周辺や状態を監視している必要がある。
[モードC]
モードCは、モードBの次に自動運転の度合が高いモードである。モードCが実施されている場合、車両乗員は、場面に応じた切替スイッチ80に対する確認操作を行う必要がある。モードCでは、例えば、車線変更のタイミングが車両乗員に通知され、車両乗員が切替スイッチ80に対して車線変更を指示する操作を行った場合に、自動的な車線変更が行われる。このため、車両乗員は自車両Mの周辺や状態を監視している必要がある。
[モードA]
モードAは、最も自動運転の度合が高いモードである。モードAが実施されている場合、複雑な合流制御など、全ての車両制御が自動的に行われるため、車両乗員は自車両Mの周辺や状態を監視する必要が無い。
[モードB]
モードBは、モードAの次に自動運転の度合が高いモードである。モードBが実施されている場合、原則として全ての車両制御が自動的に行われるが、場面に応じて自車両Mの運転操作が車両乗員に委ねられる。このため、車両乗員は自車両Mの周辺や状態を監視している必要がある。
[モードC]
モードCは、モードBの次に自動運転の度合が高いモードである。モードCが実施されている場合、車両乗員は、場面に応じた切替スイッチ80に対する確認操作を行う必要がある。モードCでは、例えば、車線変更のタイミングが車両乗員に通知され、車両乗員が切替スイッチ80に対して車線変更を指示する操作を行った場合に、自動的な車線変更が行われる。このため、車両乗員は自車両Mの周辺や状態を監視している必要がある。
自動運転モード制御部130は、切替スイッチ80に対する車両乗員の操作、行動計画生成部144により決定されたイベント、軌道生成部146により決定された走行態様などに基づいて、自動運転のモードを決定する。
自動運転のモードには、自車両Mの検知デバイスDDの性能等に応じた限界が設定されてもよい。例えば、検知デバイスDDの性能が低い場合には、モードAは実施されないものとしてよい。
いずれのモードにおいても、切替スイッチ80に対する操作によって、手動運転モードに切り替えること(オーバーライド)は可能である。
自動運転のモードには、自車両Mの検知デバイスDDの性能等に応じた限界が設定されてもよい。例えば、検知デバイスDDの性能が低い場合には、モードAは実施されないものとしてよい。
いずれのモードにおいても、切替スイッチ80に対する操作によって、手動運転モードに切り替えること(オーバーライド)は可能である。
自動運転制御部120の自車位置認識部140は、記憶部190に格納された高精度地図情報192と、ファインダ20、レーダ30、カメラ40、ナビゲーション装置50、または車両センサ60から入力される情報とに基づいて、自車両Mが走行している車線(走行車線)、および、走行車線に対する自車両Mの相対位置を認識する。
自車位置認識部140は、例えば、高精度地図情報192から認識される道路区画線のパターン(例えば実線と破線の配列)と、カメラ40によって撮像された画像から認識される自車両Mの周辺の道路区画線のパターンとを比較することで、走行車線を認識する。
この認識において、ナビゲーション装置50から取得される自車両Mの位置やINSによる処理結果が加味されてもよい。
この認識において、ナビゲーション装置50から取得される自車両Mの位置やINSによる処理結果が加味されてもよい。
図3は、自車位置認識部140により走行車線L1に対する自車両Mの相対位置が認識される様子を示す図である。自車位置認識部140は、例えば、自車両Mの基準点G(例えば重心)の走行車線中央CLからの乖離OS、および自車両Mの進行方向の走行車線中央CLを連ねた線に対してなす角度θを、走行車線L1に対する自車両Mの相対位置として認識する。
なお、これに代えて、自車位置認識部140は、自車線L1のいずれかの側端部に対する自車両Mの基準点の位置などを、走行車線に対する自車両Mの相対位置として認識してもよい。自車位置認識部140により認識される自車両Mの相対位置は、目標車線決定部110に提供される。
なお、これに代えて、自車位置認識部140は、自車線L1のいずれかの側端部に対する自車両Mの基準点の位置などを、走行車線に対する自車両Mの相対位置として認識してもよい。自車位置認識部140により認識される自車両Mの相対位置は、目標車線決定部110に提供される。
外界認識部142は、ファインダ20、レーダ30、カメラ40等から入力される情報に基づいて、周辺車両の位置、および速度、加速度等の状態を認識する。
周辺車両とは、例えば、自車両Mの周辺を走行する車両であって、自車両Mと同じ方向に走行する車両である。周辺車両の位置は、他車両の重心やコーナー等の代表点で表されてもよいし、他車両の輪郭で表現された領域で表されてもよい。
周辺車両の「状態」とは、上記各種機器の情報に基づいて把握される、周辺車両の加速度、車線変更をしているか否か(あるいは車線変更をしようとしているか否か)を含んでもよい。
また、外界認識部142は、周辺車両に加えて、ガードレールや電柱、駐車車両、歩行者その他の物体の位置を認識してもよい。
周辺車両とは、例えば、自車両Mの周辺を走行する車両であって、自車両Mと同じ方向に走行する車両である。周辺車両の位置は、他車両の重心やコーナー等の代表点で表されてもよいし、他車両の輪郭で表現された領域で表されてもよい。
周辺車両の「状態」とは、上記各種機器の情報に基づいて把握される、周辺車両の加速度、車線変更をしているか否か(あるいは車線変更をしようとしているか否か)を含んでもよい。
また、外界認識部142は、周辺車両に加えて、ガードレールや電柱、駐車車両、歩行者その他の物体の位置を認識してもよい。
行動計画生成部144は、自動運転のスタート地点、および/または自動運転の目的地を設定する。自動運転のスタート地点は、自車両Mの現在位置であってもよいし、自動運転を指示する操作がなされた地点でもよい。行動計画生成部144は、そのスタート地点と自動運転の目的地との間の区間において、行動計画を生成する。なお、これに限らず、行動計画生成部144は、任意の区間について行動計画を生成してもよい。
行動計画は、例えば、順次実行される複数のイベントで構成される。
イベントには、例えば、自車両Mを減速させる減速イベントや、自車両Mを加速させる加速イベント、走行車線を逸脱しないように自車両Mを走行させるレーンキープイベント、走行車線を変更させる車線変更イベント、自車両Mに前走車両を追い越させる追い越しイベント、分岐ポイントにおいて所望の車線に変更させたり、現在の走行車線を逸脱しないように自車両Mを走行させたりする分岐イベント、本線に合流するための合流車線において自車両Mを加減速させ、走行車線を変更させる合流イベント、自動運転の開始地点で手動運転モードから自動運転モードに移行させたり、自動運転の終了予定地点で自動運転モードから手動運転モードに移行させたりするハンドオーバイベント等が含まれる。
行動計画生成部144は、目標車線決定部110により決定された目標車線が切り替わる箇所において、車線変更イベント、分岐イベント、または合流イベントを設定する。
行動計画生成部144によって生成された行動計画を示す情報は、行動計画情報196として記憶部190に格納される。
イベントには、例えば、自車両Mを減速させる減速イベントや、自車両Mを加速させる加速イベント、走行車線を逸脱しないように自車両Mを走行させるレーンキープイベント、走行車線を変更させる車線変更イベント、自車両Mに前走車両を追い越させる追い越しイベント、分岐ポイントにおいて所望の車線に変更させたり、現在の走行車線を逸脱しないように自車両Mを走行させたりする分岐イベント、本線に合流するための合流車線において自車両Mを加減速させ、走行車線を変更させる合流イベント、自動運転の開始地点で手動運転モードから自動運転モードに移行させたり、自動運転の終了予定地点で自動運転モードから手動運転モードに移行させたりするハンドオーバイベント等が含まれる。
行動計画生成部144は、目標車線決定部110により決定された目標車線が切り替わる箇所において、車線変更イベント、分岐イベント、または合流イベントを設定する。
行動計画生成部144によって生成された行動計画を示す情報は、行動計画情報196として記憶部190に格納される。
図4は、ある区間について生成された行動計画の一例を示す図である。図4に示すように、行動計画生成部144は、目標車線情報194が示す目標車線上を自車両Mが走行するために必要な行動計画を生成する。なお、行動計画生成部144は、自車両Mの状況変化に応じて、目標車線情報194に拘わらず、動的に行動計画を変更してもよい。
例えば、行動計画生成部144は、車両走行中に外界認識部142によって認識された周辺車両の速度が閾値を超えたり、自車線に隣接する車線を走行する周辺車両の移動方向が自車線方向に向いたりした場合に、自車両Mが走行予定の運転区間に設定されたイベントを変更する。
例えば、レーンキープイベントの後に車線変更イベントが実行されるようにイベントが設定されている場合において、外界認識部142の認識結果によって当該レーンキープイベント中に車線変更先の車線後方から車両が閾値以上の速度で進行してきたことが判明した場合、行動計画生成部144は、レーンキープイベントの次のイベントを、車線変更イベントから減速イベントやレーンキープイベント等に変更してよい。この結果、車両制御システム100は、外界の状態に変化が生じた場合においても、安全に自車両Mを自動走行させることができる。
例えば、行動計画生成部144は、車両走行中に外界認識部142によって認識された周辺車両の速度が閾値を超えたり、自車線に隣接する車線を走行する周辺車両の移動方向が自車線方向に向いたりした場合に、自車両Mが走行予定の運転区間に設定されたイベントを変更する。
例えば、レーンキープイベントの後に車線変更イベントが実行されるようにイベントが設定されている場合において、外界認識部142の認識結果によって当該レーンキープイベント中に車線変更先の車線後方から車両が閾値以上の速度で進行してきたことが判明した場合、行動計画生成部144は、レーンキープイベントの次のイベントを、車線変更イベントから減速イベントやレーンキープイベント等に変更してよい。この結果、車両制御システム100は、外界の状態に変化が生じた場合においても、安全に自車両Mを自動走行させることができる。
図5は、軌道生成部146の構成の一例を示す図である。軌道生成部146は、例えば、走行態様決定部146Aと、軌道候補生成部146Bと、評価・選択部146Cとを備える。
走行態様決定部146Aは、例えば、レーンキープイベントを実施する際に、定速走行、追従走行、低速追従走行、減速走行、カーブ走行、障害物回避走行などのうちいずれかの走行態様を決定する。
この場合、走行態様決定部146Aは、自車両Mの前方に他車両が存在しない場合に、走行態様を定速走行に決定する。
また、走行態様決定部146Aは、前走車両に対して追従走行するような場合に、走行態様を追従走行に決定する。
また、走行態様決定部146Aは、渋滞場面などにおいて、走行態様を低速追従走行に決定する。
また、走行態様決定部146Aは、外界認識部142により前走車両の減速が認識された場合や、停車や駐車などのイベントを実施する場合に、走行態様を減速走行に決定する。
また、走行態様決定部146Aは、外界認識部142により自車両Mがカーブ路に差し掛かったことが認識された場合に、走行態様をカーブ走行に決定する。
また、走行態様決定部146Aは、外界認識部142により自車両Mの前方に障害物が認識された場合に、走行態様を障害物回避走行に決定する。
また、走行態様決定部146Aは、車線変更イベント、追い越しイベント、分岐イベント、合流イベント、ハンドオーバイベントなどを実施する場合に、それぞれのイベントに応じた走行態様を決定する。
この場合、走行態様決定部146Aは、自車両Mの前方に他車両が存在しない場合に、走行態様を定速走行に決定する。
また、走行態様決定部146Aは、前走車両に対して追従走行するような場合に、走行態様を追従走行に決定する。
また、走行態様決定部146Aは、渋滞場面などにおいて、走行態様を低速追従走行に決定する。
また、走行態様決定部146Aは、外界認識部142により前走車両の減速が認識された場合や、停車や駐車などのイベントを実施する場合に、走行態様を減速走行に決定する。
また、走行態様決定部146Aは、外界認識部142により自車両Mがカーブ路に差し掛かったことが認識された場合に、走行態様をカーブ走行に決定する。
また、走行態様決定部146Aは、外界認識部142により自車両Mの前方に障害物が認識された場合に、走行態様を障害物回避走行に決定する。
また、走行態様決定部146Aは、車線変更イベント、追い越しイベント、分岐イベント、合流イベント、ハンドオーバイベントなどを実施する場合に、それぞれのイベントに応じた走行態様を決定する。
軌道候補生成部146Bは、走行態様決定部146Aにより決定された走行態様に基づいて、軌道の候補を生成する。図6は、軌道候補生成部146Bにより生成される軌道の候補の一例を示す図である。図6は、自車両Mが車線L1から車線L2に車線変更する場合に生成される軌道の候補を示している。
軌道候補生成部146Bは、図6に示すような軌道を、例えば、将来の所定時間ごとに、自車両Mの基準位置G(例えば重心や後輪軸中心)が到達すべき目標位置(軌道点K)の集まりとして決定する。本実施形態では、一例として、将来の所定時間の間隔を1秒として説明する。
図7は、軌道候補生成部146Bにより生成される軌道の候補を軌道点Kで表現した図である。軌道点Kの間隔が広いほど、自車両Mの速度は速くなり、軌道点Kの間隔が狭いほど、自車両Mの速度は遅くなる。従って、軌道候補生成部146Bは、加速したい場合には軌道点Kの間隔を徐々に広くし、減速したい場合は軌道点Kの間隔を徐々に狭くする。
このように、軌道点Kは速度成分を含むものであるため、軌道候補生成部146Bは、軌道点Kのそれぞれに対して目標速度を与える必要がある。目標速度は、走行態様決定部146Aにより決定された走行態様に応じて決定されてよい。
ここで、車線変更(分岐を含む)を行う場合の目標速度の決定手法について説明する。
軌道候補生成部146Bは、まず、車線変更ターゲット位置(或いは合流ターゲット位置)を設定する。車線変更ターゲット位置は、周辺車両との相対位置として設定されるものであり、「どの周辺車両の間に車線変更するか」を決定するものである。軌道候補生成部146Bは、車線変更ターゲット位置を基準として3台の周辺車両に着目し、車線変更を行う場合の目標速度を決定する。図8は、車線変更ターゲット位置TAを示す図である。
図8において、L1は自車線を表し、L2は隣接車線を表している。
ここで、自車両Mと同じ車線で、自車両Mの直前を走行する周辺車両を前走車両mA、車線変更ターゲット位置TAの直前を走行する周辺車両を前方基準車両mB、車線変更ターゲット位置TAの直後を走行する周辺車両を後方基準車両mCと定義する。
自車両Mは、車線変更ターゲット位置TAの側方まで移動するために加減速を行う必要があるが、この際に前走車両mAに追いついてしまうことを回避しなければならない。このため、軌道候補生成部146Bは、3台の周辺車両の将来の状態を予測し、各周辺車両と干渉、又は接触しないように目標速度を決定する。
軌道候補生成部146Bは、まず、車線変更ターゲット位置(或いは合流ターゲット位置)を設定する。車線変更ターゲット位置は、周辺車両との相対位置として設定されるものであり、「どの周辺車両の間に車線変更するか」を決定するものである。軌道候補生成部146Bは、車線変更ターゲット位置を基準として3台の周辺車両に着目し、車線変更を行う場合の目標速度を決定する。図8は、車線変更ターゲット位置TAを示す図である。
図8において、L1は自車線を表し、L2は隣接車線を表している。
ここで、自車両Mと同じ車線で、自車両Mの直前を走行する周辺車両を前走車両mA、車線変更ターゲット位置TAの直前を走行する周辺車両を前方基準車両mB、車線変更ターゲット位置TAの直後を走行する周辺車両を後方基準車両mCと定義する。
自車両Mは、車線変更ターゲット位置TAの側方まで移動するために加減速を行う必要があるが、この際に前走車両mAに追いついてしまうことを回避しなければならない。このため、軌道候補生成部146Bは、3台の周辺車両の将来の状態を予測し、各周辺車両と干渉、又は接触しないように目標速度を決定する。
図9は、3台の周辺車両の速度を一定と仮定した場合の速度生成モデルを示す図である。図9において、ポイントmA、mBおよびmCから延出する直線は、それぞれの周辺車両が定速走行したと仮定した場合の進行方向における変位を示している。自車両Mは、車線変更が完了するポイントCPにおいて、前方基準車両mBと後方基準車両mCとの間にあり、且つ、それ以前において前走車両mAよりも後ろにいなければならない。このような制約の下、軌道候補生成部146Bは、車線変更が完了するまでの目標速度の時系列パターンを、複数導出する。そして、目標速度の時系列パターンをスプライン曲線等のモデルに適用することで、図7に示すような軌道の候補を複数導出する。
なお、3台の周辺車両の運動パターンは、図9に示すような定速度に限らず、定加速度、定ジャーク(躍度)を前提として予測されてもよい。
なお、3台の周辺車両の運動パターンは、図9に示すような定速度に限らず、定加速度、定ジャーク(躍度)を前提として予測されてもよい。
評価・選択部146Cは、軌道候補生成部146Bにより生成された軌道の候補に対して、例えば、計画性と安全性の二つの観点で評価を行い、走行制御部160に出力する軌道を選択する。計画性の観点からは、例えば、既に生成されたプラン(例えば行動計画)に対する追従性が高く、軌道の全長が短い場合に軌道が高く評価される。例えば、右方向に車線変更することが望まれる場合に、一旦左方向に車線変更して戻るといった軌道は、低い評価となる。安全性の観点からは、例えば、それぞれの軌道点において、自車両Mと物体(周辺車両等)との距離が遠く、加減速度や操舵角の変化量などが小さいほど高く評価される。
切替制御部150は、切替スイッチ80から入力される信号に基づいて自動運転モードと手動運転モードとを相互に切り替える。また、切替制御部150は、操作デバイス70に対する加速、減速または操舵を指示する操作に基づいて、自動運転モードから手動運転モードに切り替える。例えば、切替制御部150は、操作デバイス70から入力された信号の示す操作量が閾値を超えた状態が、基準時間以上継続した場合に、自動運転モードから手動運転モードに切り替える(オーバーライド)。また、切替制御部150は、オーバーライドによる手動運転モードへの切り替えの後、所定時間の間、操作デバイス70に対する操作が検出されなかった場合に、自動運転モードに復帰させてもよい。
走行制御部160は、操舵制御部162と、加減速制御部164とを含む。走行制御部160は、軌道生成部146によって生成された軌道を、予定の時刻通りに自車両Mが通過するように、駆動力出力装置200、ステアリング装置210、およびブレーキ装置220を制御する。
図10は、操舵制御部162および加減速制御部164と、その制御対象との関係を示す図である。
操舵制御部162は、軌道生成部146によって生成された軌道と、自車位置認識部140により認識された自車両Mの位置(自車位置)とに基づいて、ステアリング装置210を制御する。例えば、操舵制御部162は、軌道生成部146によって生成された軌道に含まれる軌道点K(i)に対応した転向角φiや、車両センサ60から取得した車速(或いは加速度や躍度)、鉛直軸回りの角速度(ヨーレート)などの情報に基づいて、操舵角を決定し、この操舵角分の変位を車輪に与えるようにステアリング装置210における電動モータの制御量を決定する。
操舵制御部162は、軌道生成部146によって生成された軌道と、自車位置認識部140により認識された自車両Mの位置(自車位置)とに基づいて、ステアリング装置210を制御する。例えば、操舵制御部162は、軌道生成部146によって生成された軌道に含まれる軌道点K(i)に対応した転向角φiや、車両センサ60から取得した車速(或いは加速度や躍度)、鉛直軸回りの角速度(ヨーレート)などの情報に基づいて、操舵角を決定し、この操舵角分の変位を車輪に与えるようにステアリング装置210における電動モータの制御量を決定する。
加減速制御部164は、車両センサ60により検出された自車両Mの速度vおよび加速度αと、軌道生成部146によって生成された軌道とに基づいて、駆動力出力装置200およびブレーキ装置220を制御する。
[加減速制御]
図11は、第1の実施形態における加減速制御部164の構成の一例を示す図である。
加減速制御部164は、例えば、第1演算部165と、第2演算部166と、第3演算部167と、第4演算部168と、減算器169および170と、比例積分制御部171と、比例制御部172と、第1出力調整部173と、第2出力調整部174と、第3出力調整部175と、加算器176および177とを備える。
なお、これらの構成のうち一部または全部は、軌道生成部146(特に軌道候補生成部146B)に含まれてもよい。
図11は、第1の実施形態における加減速制御部164の構成の一例を示す図である。
加減速制御部164は、例えば、第1演算部165と、第2演算部166と、第3演算部167と、第4演算部168と、減算器169および170と、比例積分制御部171と、比例制御部172と、第1出力調整部173と、第2出力調整部174と、第3出力調整部175と、加算器176および177とを備える。
なお、これらの構成のうち一部または全部は、軌道生成部146(特に軌道候補生成部146B)に含まれてもよい。
以下、フローチャートに即して、図11に示す加減速制御部164における各構成の処理内容について説明する。図12は、第1の実施形態における加減速制御部164の処理の流れの一例を示すフローチャートである。以下の説明において、各種位置は、ある時点(例えば現在時刻ti)での自車両Mの位置を基準に、自車両Mの進行方向側のものは正値として扱われ、進行方向と反対方向側のものは負値として扱われる。
まず、第1演算部165は、軌道生成部146によって生成された軌道に含まれる複数の軌道点K間の距離に基づいて、軌道に沿って自車両Mを走行させる際の目標速度を導出する。例えば、第1演算部165は、軌道に含まれる複数の軌道点Kの中から、現在の時刻tiからn秒分の時間が経過するまで間に自車両Mが到達すべき軌道点K(i)からK(i+n)を抽出して、これらの軌道点K(i)からK(i+n)を含む軌道の長さを、n秒分の時間で除算して平均速度を導出する(ステップS100)。この平均速度は、軌道点K(i)からK(i+n)を含む軌道上の自車両Mの目標速度として扱われる。n秒分の時間は、「第1の所定時間」の一例である。
第2演算部166は、軌道生成部146によって生成された軌道に含まれる複数の軌道点Kの中から、現在の時刻tiに対応した軌道点K(i)を抽出する。
第3演算部167は、現在の時刻tiからn秒分の時間に比して短い所定時間(例えば1秒)経過した時刻ti+1に対応した軌道点K(i+1)を抽出する。現在の時刻tiからn秒分の時間に比して短い所定時間は、「第2の所定時間」の一例である。
第4演算部168は、自車位置認識部140により認識された自車位置Pact(i)と、車両センサ60により検出された自車両Mの速度vおよび加速度αに基づいて、現在の時刻tiから1秒経過した時刻ti+1において自車両Mが到達することが予測される予測位置Ppre(i+1)を導出する(ステップS102)。例えば、第4演算部168は、以下の数式(1)に基づき予測位置Ppre(i+1)を導出する。式中tは、時刻tiと時刻ti+1との差分の時間である。すなわち、式中tは、軌道点Kの時間間隔(サンプリング時間)に相当する。
減算器169は、第2演算部166により抽出された軌道点K(i)から、自車位置Pact(i)を差し引いた偏差(以下、現在偏差と称する)を導出する(ステップS104)。そして、減算器169は、導出した現在偏差を比例積分制御部171に出力する。
現在偏差は、「第1の偏差」の一例である。
現在偏差は、「第1の偏差」の一例である。
減算器170は、第3演算部167により抽出された軌道点K(i+1)から、第4演算部168により導出された予測位置Ppre(i+1)を差し引いた偏差(以下、将来偏差と称する)を導出する(ステップS106)。そして、減算器170は、導出した将来偏差を比例制御部172に出力する。将来偏差は、「第2の偏差」の一例である。
比例積分制御部171は、減算器169により出力された現在偏差に所定の比例ゲインを乗算すると共に、現在偏差の時間積分値に所定の積分ゲインを乗算する。そして、比例積分制御部171は、比例ゲインを乗算した現在偏差と、積分ゲインを乗算した現在偏差の時間積分値とを加算することで、自車両Mを自車位置Pact(i)から軌道点K(i)に近づけるような速度の補正量(以下、第1補正量と称する)を、操作量として導出する(ステップS108)。このように積分項を入れることによって、現在偏差がゼロに近づくように目標速度を補正することができる。この結果、加減速制御部164は、現在の時刻tiの自車位置Pact(i)を、現在の時刻tiに対応した目標位置である軌道点K(i)により近づけることができる。
比例制御部172は、減算器170により出力された将来偏差に所定の比例ゲインを乗算して、1秒後の時点で自車両Mを予測位置Ppre(i+1)から軌道点K(i+1)に近づけるような速度の補正量(以下、第2補正量と称する)を、操作量として導出する(ステップS110)。このように比例制御部172は、不確定な要素を含む将来偏差を許容した比例制御を行う。
第1出力調整部173は、例えば、比例積分制御部171により導出された第1補正量に制限をかけるフィルタ回路である。例えば、第1出力調整部173は、第1補正量が示す速度が15km/h以上増加または減少しないように第1補正量にフィルタリングを行う(ステップS112)。
第2出力調整部174は、例えば、比例制御部172により導出された第2補正量に制限をかけるフィルタ回路である。例えば、第2出力調整部174は、第1出力調整部173と同様に、第2補正量が示す速度が15km/h以上増加または減少しないように第2補正量にフィルタリングを行う(ステップS114)。
なお、第1出力調整部173によるフィルタリングの速度制限、および第2出力調整部174によるフィルタリングの速度制限の一方または双方において、速度の増加時の制限と減少時の制限とが異なってもよい。
加算器176は、第1出力調整部173により調整された第1補正量と、第2出力調整部174により調整された第2補正量とを加算し、これらの補正量を加算した第3補正量を第3出力調整部175に出力する。
第3出力調整部175は、例えば、加算器176により出力された第3補正量に制限をかけるフィルタ回路である。例えば、第3出力調整部175は、第3補正量が示す速度が5km/h以上増加または減少しないように第3補正量にフィルタリングを行う(ステップS116)。
加算器177は、第1演算部165により導出された平均速度に、第3出力調整部175により調整された第3補正量を加算して、現在の時刻tiからn秒間における自車両Mの目標速度として出力する(ステップS118)。これによって加減速制御部164は、目標速度に応じて駆動力出力装置200およびブレーキ装置220の制御量を決定する。
係る制御によって、加減速が頻繁に発生するのを抑制することができる。例えば、自車位置認識部140により認識された自車位置Pact(i)と、複数の軌道点Kのうち自車両Mの位置認識をおこなった時刻(認識時刻、例えば現在の時刻ti)に対応した軌道点K(i)との現在偏差を用いて目標速度を補正しない場合、第2補正量、すなわち1秒後の時点で自車両Mを予測位置Ppre(i+1)から軌道点K(i+1)に近づけるような速度の補正量のみで目標速度を補正することになる。この場合、センサ誤差等により各軌道点Kに対して常に追い越すような、或いは常に追いつかないような定常的なオフセット(偏差)が生じる可能性がある。また、不確定な要素を含む将来偏差のみで目標速度を補正することになるため、頻繁な加減速が生じる場合がある。
これに対し、本実施形態では、現在偏差を用いた第1補正量と第2補正量との双方により目標速度を補正するため、軌道点Kに対するオフセットを小さくすることができる。より詳細には、比例積分制御部171が現在偏差の時間積分を行うことにより第1補正量を導出するため、現在の時刻tiの自車位置Pact(i)を、現在の時刻tiに対応した目標位置である軌道点K(i)により近づけることができる。また、比例制御部172が比例制御を行うことにより、不確定な要素を含む将来偏差をある程度許容することができる。この結果、加減速が頻繁に発生するのを抑制することができる。
以上説明した第1の実施形態によれば、自車両Mの位置を認識する自車位置認識部140と、自車両Mが到達すべき将来の目標位置を示す軌道点Kが、時系列に連続して複数含まれる軌道を生成する軌道生成部146と、前記軌道に含まれる複数の軌道点K間の距離に基づいて、軌道に沿って自車両Mを走行させる際の目標速度を導出すると共に、自車位置認識部140により認識された自車両Mの位置と、複数の軌道点Kのうち自車両Mの位置認識がおこなわれた時刻(認識時刻)に対応した軌道点K(第1の目標位置)との現在偏差(第1の偏差)に基づいて目標速度を補正する走行制御部160の加減速制御部164と、を備えることにより、加減速が頻繁に発生するのを抑制することができる。この結果、乗員の不快感を低減させることができる。
<第2の実施形態>
以下、第2の実施形態について説明する。第2の実施形態では、加減速が頻繁に行われるのを抑制するために、将来偏差および現在偏差のいずれか一方または双方に対してそれぞれ不感帯DZを設定する点で第1の実施形態と相違する。不感帯DZとは、それぞれの偏差に応じた補正量を低下させるために設けられる領域である。以下、係る相違点を中心に説明する。
以下、第2の実施形態について説明する。第2の実施形態では、加減速が頻繁に行われるのを抑制するために、将来偏差および現在偏差のいずれか一方または双方に対してそれぞれ不感帯DZを設定する点で第1の実施形態と相違する。不感帯DZとは、それぞれの偏差に応じた補正量を低下させるために設けられる領域である。以下、係る相違点を中心に説明する。
図13は、第2の実施形態における加減速制御部164Aの構成の一例を示す図である。加減速制御部164Aは、例えば、上述した第1の実施形態における加減速制御部164の構成に加えて、更に比例積分ゲイン調整部180と、比例ゲイン調整部181とを備える。
比例積分ゲイン調整部180は、現在偏差に対して第1の不感帯DZ1を設定し、減算器169により導出された現在偏差が第1の不感帯DZ1内である場合、現在偏差が第1の不感帯DZ1内でない場合に比して、比例積分制御部171における比例ゲインおよび積分ゲインの一方または双方を低下させる。「ゲインの低下」とは、正値のゲインをゼロまたは負値に近づけること、あるいは負値のゲインをゼロまたは正値に近づけることをいう。
図14および図15は、現在偏差に対する第1の不感帯DZ1の一例を示す図である。
図14および図15に示す例のように、第1の不感帯DZ1は、現在偏差の正側(自車位置Pact(i)に比して軌道点K(i)が前方である側)のみ、または正側に偏って設定されてよい。
「正側に偏る」とは、例えば、第1の不感帯DZ1の領域の重心などが現在偏差の正側に存在することをいう。
図14の例では、現在偏差がゼロから閾値Th1(正値)までの領域が第1の不感帯DZ1として設定されている。
また、図15の例では、閾値Th2(負値)から閾値Th1(正値)までの領域が第1の不感帯DZ1として設定されている。
図14および図15に示すように、第1の不感帯DZ1では、比例ゲインや積分ゲインはゼロをとる。従って、現在偏差が第1の不感帯DZ1内であれば、比例積分制御部171により導出される第1補正量は、ゼロまたはゼロ程度になる。
図14および図15に示す例のように、第1の不感帯DZ1は、現在偏差の正側(自車位置Pact(i)に比して軌道点K(i)が前方である側)のみ、または正側に偏って設定されてよい。
「正側に偏る」とは、例えば、第1の不感帯DZ1の領域の重心などが現在偏差の正側に存在することをいう。
図14の例では、現在偏差がゼロから閾値Th1(正値)までの領域が第1の不感帯DZ1として設定されている。
また、図15の例では、閾値Th2(負値)から閾値Th1(正値)までの領域が第1の不感帯DZ1として設定されている。
図14および図15に示すように、第1の不感帯DZ1では、比例ゲインや積分ゲインはゼロをとる。従って、現在偏差が第1の不感帯DZ1内であれば、比例積分制御部171により導出される第1補正量は、ゼロまたはゼロ程度になる。
比例ゲイン調整部181は、将来偏差に対して第2の不感帯DZ2を設定し、減算器170により導出された将来偏差が第2の不感帯DZ2内である場合、将来偏差が第2の不感帯DZ2内でない場合に比して、比例制御部172における比例ゲインを低下させる。
図16および図17は、将来偏差に対する第2の不感帯DZ2の一例を示す図である。
図16および図17に示す例のように、第2の不感帯DZ2は、第1の不感帯DZ1と同様に、現在偏差の正側のみ、または正側に偏って設定されてよい。
図16の例では、現在偏差がゼロから閾値Th1(正値)までの領域が第2の不感帯DZ2として設定されている。
また、図17の例では、閾値Th2(負値)から閾値Th1(正値)までの領域が第2の不感帯DZ2として設定されている。
図16および図17に示すように、第2の不感帯DZ2では、比例ゲインはゼロをとる。従って、将来偏差が第2の不感帯DZ2内であれば、比例制御部172により導出される第2補正量は、ゼロまたはゼロ程度になる。
なお、上述した第1の不感帯DZ1と第2の不感帯DZ2とは、その領域の大きさが互いに異なっていてもよいし、いずれか一方が偏差の正側のみに設定され、他方が正側に偏って設定されてもよい。
図16および図17に示す例のように、第2の不感帯DZ2は、第1の不感帯DZ1と同様に、現在偏差の正側のみ、または正側に偏って設定されてよい。
図16の例では、現在偏差がゼロから閾値Th1(正値)までの領域が第2の不感帯DZ2として設定されている。
また、図17の例では、閾値Th2(負値)から閾値Th1(正値)までの領域が第2の不感帯DZ2として設定されている。
図16および図17に示すように、第2の不感帯DZ2では、比例ゲインはゼロをとる。従って、将来偏差が第2の不感帯DZ2内であれば、比例制御部172により導出される第2補正量は、ゼロまたはゼロ程度になる。
なお、上述した第1の不感帯DZ1と第2の不感帯DZ2とは、その領域の大きさが互いに異なっていてもよいし、いずれか一方が偏差の正側のみに設定され、他方が正側に偏って設定されてもよい。
図18は、場面ごとの加減速制御の一例を示す図である。図18(a)は、現在偏差が第1の不感帯DZ1内でない一場面を表している。また、図18(b)は、現在偏差が第1の不感帯DZ1内である一場面を表している。
いずれの場面においても、現在の時刻t0における自車位置Pact(0)に比して軌道点K(0)が前方に位置している。すなわち、自車両Mが現在の時刻t0において到達すべき軌道点K(0)に到達していない。
このため、加減速制御部164は、駆動力出力装置200を制御して、自車両Mを加速させる必要がある。
いずれの場面においても、現在の時刻t0における自車位置Pact(0)に比して軌道点K(0)が前方に位置している。すなわち、自車両Mが現在の時刻t0において到達すべき軌道点K(0)に到達していない。
このため、加減速制御部164は、駆動力出力装置200を制御して、自車両Mを加速させる必要がある。
例えば、図18(a)に示す場面では、現在偏差が第1の不感帯DZ1外であるため、第1補正量が平均速度に加算され、自車両Mは現在の平均速度から加速することになる。
一方、図18(b)に示す場面では、現在偏差が第1の不感帯DZ1内であるため、第1補正量が減少する。この場合、加速制御が行われずに第1演算部165により導出された平均速度が維持されやすくなる。このような処理によって、自車両Mが軌道点K(0)に到達していない場合に頻繁に加速するのを抑制することができる。
一方、図18(b)に示す場面では、現在偏差が第1の不感帯DZ1内であるため、第1補正量が減少する。この場合、加速制御が行われずに第1演算部165により導出された平均速度が維持されやすくなる。このような処理によって、自車両Mが軌道点K(0)に到達していない場合に頻繁に加速するのを抑制することができる。
また、上述した例では、自車位置Pact(i)に比して軌道点K(i)が前方である場合に偏差に不感帯DZを設定するものとして説明したがこれに限られず、自車位置Pact(i)に比して軌道点K(i)が後方である場合に偏差に不感帯DZを設定してもよい。
図19および図20は、現在偏差に対する第1の不感帯DZ1の他の例を示す図である。
図19および図20に示す例のように、第1の不感帯DZ1は、現在偏差の負側(自車位置Pact(i)に比して軌道点K(i)が後方である側)のみ、または負側に偏って設定されてよい。
図19の例では、現在偏差が閾値Th3(負値)からゼロまでの領域が第1の不感帯DZ1として設定されている。
また、図20の例では、閾値Th3(負値)から閾値Th4(正値)までの領域が第1の不感帯DZ1として設定されている。
図19および図20に示す例のように、第1の不感帯DZ1は、現在偏差の負側(自車位置Pact(i)に比して軌道点K(i)が後方である側)のみ、または負側に偏って設定されてよい。
図19の例では、現在偏差が閾値Th3(負値)からゼロまでの領域が第1の不感帯DZ1として設定されている。
また、図20の例では、閾値Th3(負値)から閾値Th4(正値)までの領域が第1の不感帯DZ1として設定されている。
図21および図22は、将来偏差に対する第2の不感帯DZ2の他の例を示す図である。
図21および図22に示す例のように、第2の不感帯DZ2は、現在偏差の負側のみ、または負側に偏って設定されてよい。
図21の例では、現在偏差が閾値Th3(負値)からゼロまでの領域が第2の不感帯DZ2として設定されている。
また、図22の例では、閾値Th3(負値)から閾値Th4(正値)までの領域が第2の不感帯DZ2として設定されている。
上述した例においても、第1の不感帯DZ1と第2の不感帯DZ2とは、その領域の大きさが互いに異なっていてもよいし、いずれか一方が偏差の負側のみに設定され、他方が負側に偏って設定されてもよい。
図21および図22に示す例のように、第2の不感帯DZ2は、現在偏差の負側のみ、または負側に偏って設定されてよい。
図21の例では、現在偏差が閾値Th3(負値)からゼロまでの領域が第2の不感帯DZ2として設定されている。
また、図22の例では、閾値Th3(負値)から閾値Th4(正値)までの領域が第2の不感帯DZ2として設定されている。
上述した例においても、第1の不感帯DZ1と第2の不感帯DZ2とは、その領域の大きさが互いに異なっていてもよいし、いずれか一方が偏差の負側のみに設定され、他方が負側に偏って設定されてもよい。
図23は、場面ごとの加減速制御の一例を示す図である。図23(a)は、現在偏差が第1の不感帯DZ1内でない一場面を表している。また、図23(b)は、現在偏差が第1の不感帯DZ1内である一場面を表している。
いずれの場面においても、現在の時刻t0における自車位置Pact(0)に比して軌道点K(0)が後方に位置している。すなわち、自車両Mが現在の時刻t0において到達すべき軌道点K(0)を超えている。このため、加減速制御部164は、駆動力出力装置200を制御して、自車両Mを減速させる必要がある。
いずれの場面においても、現在の時刻t0における自車位置Pact(0)に比して軌道点K(0)が後方に位置している。すなわち、自車両Mが現在の時刻t0において到達すべき軌道点K(0)を超えている。このため、加減速制御部164は、駆動力出力装置200を制御して、自車両Mを減速させる必要がある。
例えば、図23(a)に示す場面では、現在偏差が第1の不感帯DZ1外であるため、第1補正量が平均速度に加算され、自車両Mは現在の平均速度から減速することになる。
一方、図23(b)に示す場面では、現在偏差が第1の不感帯DZ1内であるため、第1補正量が減少する。この場合、減速制御が行われずに第1演算部165により導出された平均速度が維持されやすくなる。このような処理によって、自車両Mが軌道点K(0)を超えた場合に頻繁に減速するのを抑制することができる。
一方、図23(b)に示す場面では、現在偏差が第1の不感帯DZ1内であるため、第1補正量が減少する。この場合、減速制御が行われずに第1演算部165により導出された平均速度が維持されやすくなる。このような処理によって、自車両Mが軌道点K(0)を超えた場合に頻繁に減速するのを抑制することができる。
[不感帯の領域変更処理]
また、上述した比例積分ゲイン調整部180は、外界認識部142により状態が認識された周辺車両のうち、自車両Mの直前を走行する前走車両および自車両Mの直後を走行する後続車両の一方または双方と、自車両Mとの車間距離に基づいて、現在偏差に対して設定する第1の不感帯DZ1の領域サイズを変更してよい。
また、比例ゲイン調整部181は、自車両Mの直前を走行する前走車両および自車両Mの直後を走行する後続車両の一方または双方と、自車両Mとの車間距離に基づいて、将来偏差に対して設定する第2の不感帯DZ2の領域サイズを変更してよい。
また、上述した比例積分ゲイン調整部180は、外界認識部142により状態が認識された周辺車両のうち、自車両Mの直前を走行する前走車両および自車両Mの直後を走行する後続車両の一方または双方と、自車両Mとの車間距離に基づいて、現在偏差に対して設定する第1の不感帯DZ1の領域サイズを変更してよい。
また、比例ゲイン調整部181は、自車両Mの直前を走行する前走車両および自車両Mの直後を走行する後続車両の一方または双方と、自車両Mとの車間距離に基づいて、将来偏差に対して設定する第2の不感帯DZ2の領域サイズを変更してよい。
図24および図25は、不感帯DZの領域サイズの変更方法を説明するための図である。
図24に示すように、比例積分ゲイン調整部180または比例ゲイン調整部181は、自車位置Pact(i)に比して軌道点K(i)が前方である場合、それぞれが設定する不感帯DZの正側の閾値Th1を、後続車両との車間距離が広くなるのに応じて正側において大きくし、後続車両との車間距離が狭くなるのに応じて正側において小さくする。これによって、加減速制御部164は、後続車両との車間距離が詰まった場合には、安全を考慮して不感帯DZを狭くすることで、加速を頻繁に行わせることができる。また、加減速制御部164は、後続車両との車間距離が開いた場合には、不感帯DZを広くすることで、加速の頻度を低下させることができる。
図24に示すように、比例積分ゲイン調整部180または比例ゲイン調整部181は、自車位置Pact(i)に比して軌道点K(i)が前方である場合、それぞれが設定する不感帯DZの正側の閾値Th1を、後続車両との車間距離が広くなるのに応じて正側において大きくし、後続車両との車間距離が狭くなるのに応じて正側において小さくする。これによって、加減速制御部164は、後続車両との車間距離が詰まった場合には、安全を考慮して不感帯DZを狭くすることで、加速を頻繁に行わせることができる。また、加減速制御部164は、後続車両との車間距離が開いた場合には、不感帯DZを広くすることで、加速の頻度を低下させることができる。
また、図25に示すように、比例積分ゲイン調整部180または比例ゲイン調整部181は、自車位置Pact(i)に比して軌道点K(i)が後方である場合、それぞれが設定する不感帯DZの負側の閾値Th3を、前走車両との車間距離が広くなるのに応じて負側において大きし、前走車両との車間距離が狭くなるのに応じて負側において小さくする。これによって、加減速制御部164は、前走車両との車間距離が詰まった場合には、安全を考慮して不感帯DZを狭くすることで、減速を頻繁に行わせることができる。また、加減速制御部164は、前走車両との車間距離が開いた場合には、不感帯DZを広くすることで、減速の頻度を低下させることができる。
図26は、第2の実施形態における加減速制御部164Aの処理の流れの一例を示すフローチャートである。まず、第1演算部165は、軌道に含まれる複数の軌道点Kの中から、現在の時刻tiからn秒分の時間が経過するまで間に自車両Mが到達すべき軌道点K(i)からK(i+n)を抽出して、これらの軌道点K(i)からK(i+n)を含む軌道の長さを、n秒分の時間で除算して平均速度を導出する(ステップS200)。
次に、第4演算部168は、自車位置認識部140により認識された自車位置Pact(i)と、車両センサ60により検出された自車両Mの速度vおよび加速度αに基づいて、現在の時刻tiから1秒経過した時刻ti+1において自車両Mが到達することが予測される予測位置Ppre(i+1)を導出する(ステップS202)。
次に、減算器169は、第2演算部166により抽出された軌道点K(i)から、自車位置Pact(i)を差し引いた現在偏差を導出する(ステップS204)。次に、減算器170は、第3演算部167により抽出された軌道点K(i+1)から、第4演算部168により導出された予測位置Ppre(i+1)を差し引いた将来偏差を導出する(ステップS206)。
次に、比例積分ゲイン調整部180は、現在偏差が第1の不感帯DZ1内であるか否かを判定し(ステップS208)、現在偏差が第1の不感帯DZ1内である場合、比例積分制御部171における比例ゲインおよび積分ゲインの一方または双方を低下させる(ステップS210)。一方、現在偏差が第1の不感帯DZ1内でない場合、比例積分ゲイン調整部180は、S212に処理を移す。
次に、比例積分制御部171は、減算器169により出力された現在偏差に所定の比例ゲインを乗算すると共に、現在偏差の時間積分値に所定の積分ゲインを乗算し、これらを加算することで、第1補正量を導出する(ステップS212)。次に、第1出力調整部173は、第1補正量にフィルタリングを行う(ステップS214)。
次に、比例ゲイン調整部181は、将来偏差が第2の不感帯DZ2内であるか否かを判定し(ステップS216)、将来偏差が第2の不感帯DZ2内である場合、比例制御部172における比例ゲインを低下させる(ステップS218)。一方、将来偏差が第2の不感帯DZ2内でない場合、比例ゲイン調整部181は、S220に処理を移す。
次に、比例制御部172は、減算器170により出力された将来偏差に所定の比例ゲインを乗算することで、第2補正量を導出する(ステップS220)。次に、第2出力調整部174は、第2補正量にフィルタリングを行う(ステップS222)。
次に、第3出力調整部175は、第1補正量と第2補正量とを加算した第3補正量にフィルタリングを行う(ステップS224)。次に、加算器177は、第1演算部165により導出された平均速度に、第3出力調整部175により調整された第3補正量を加算して、現在の時刻tiからn秒間における自車両Mの目標速度として出力する(ステップS226)。これによって、本フローチャートの処理が終了する。
以上説明した第2の実施形態によれば、将来偏差および現在偏差のいずれか一方または双方に対して不感帯DZを設定するため、更に頻繁な加減速の発生を抑制できる。この結果、車両の安全を考慮しつつ乗員の不快感を低減させることができる。
また、第2の実施形態によれば、前走車両または後続車両との車間距離に基づいて、不感帯DZの領域を変更するため、頻繁な加減速の発生を効率よく抑制できる。
<第3の実施形態>
以下、第3の実施形態について説明する。第3の実施形態では、自車両Mの速度が小さい場合に第3補正量の出力ゲインを調整する点で第1および第3の実施形態と相違する。
以下、係る相違点を中心に説明する。
以下、第3の実施形態について説明する。第3の実施形態では、自車両Mの速度が小さい場合に第3補正量の出力ゲインを調整する点で第1および第3の実施形態と相違する。
以下、係る相違点を中心に説明する。
図27は、第3の実施形態における加減速制御部164Bの構成の一例を示す図である。加減速制御部164Bは、例えば、第1演算部165と、第2演算部166と、第3演算部167と、第4演算部168と、減算器169および170と、比例積分制御部171と、比例制御部172と、第1出力調整部173と、第2出力調整部174と、加算器176および177と、第3ゲイン調整部183と、乗算器184とを備える。
第3ゲイン調整部183は、自車両Mの速度vが低下するほど、第1補正量と第2補正量とを加算した第3補正量を調整するための出力ゲインを低下させる。
乗算器184は、第3ゲイン調整部183により調整された出力ゲインと、加算器176により出力された第3補正量とを乗算し、加算器177に出力する。
図28は、自車両Mの速度vに対する出力ゲインの変化の一例を示す図である。図28に示すように、自車両Mの速度vが速度閾値Vth以下では、速度vの低下に応じて出力ゲインが1以下に低下する。このため、自車両Mが徐々に減速して停車するような場合、第3補正量が減少していくため、加減速の発生がより抑制される。
以上説明した第3の実施形態によれば、自車両Mの速度が低下するのに応じて第3補正量を低下させるため、例えば自車両Mが停車する際に頻繁な加減速の発生を抑制できる。
これにより、スムーズな停車を行うことができる。また、第3の実施形態によれば、自車両Mの速度が増加するのに応じて第3補正量を増加させるため、自車両Mを停止状態からスムーズに加速させることできる。この結果、乗員の不快感を低減させることができる。
これにより、スムーズな停車を行うことができる。また、第3の実施形態によれば、自車両Mの速度が増加するのに応じて第3補正量を増加させるため、自車両Mを停止状態からスムーズに加速させることできる。この結果、乗員の不快感を低減させることができる。
以上、本発明を実施するための形態について実施形態を用いて説明したが、本発明はこうした実施形態に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。
20…ファインダ、30…レーダ、40…カメラ、DD…検知デバイス、50…ナビゲーション装置、55…通信装置、60…車両センサ、62…表示装置、64…スピーカ、70…操作デバイス、72…操作検出センサ、80…切替スイッチ、100…車両制御システム、110…目標車線決定部、120…自動運転制御部、130…自動運転モード制御部、140…自車位置認識部、142…外界認識部、144…行動計画生成部、146…軌道生成部、146A…走行態様決定部、146B…軌道候補生成部、146C…評価・選択部、150…切替制御部、160…走行制御部、162…操舵制御部、164…加減速制御部、165…第1演算部、166…第2演算部、167…第3演算部、168…第4演算部、169、170…減算器、171…比例積分制御部、172…比例制御部、173…第1出力調整部、174…第2出力調整部、175…第3出力調整部、176、177…加算器、190…記憶部、200…駆動力出力装置、210…ステアリング装置、220…ブレーキ装置、M…自車両
Claims (11)
- 車両の位置を認識する位置認識部と、
前記車両が到達すべき将来の目標位置が、時系列に連続して複数含まれる軌道を生成する軌道生成部と、
前記軌道に含まれる前記複数の目標位置間の距離に基づいて、前記軌道に沿って前記車両を走行させる際の目標速度を導出すると共に、前記位置認識部により認識された前記車両の位置と、前記複数の目標位置のうち前記車両の位置認識がおこなわれた認識時刻に対応した第1の目標位置との第1の偏差に基づいて、前記目標速度を補正する走行制御部と、
を備える車両制御システム。 - 前記走行制御部は、
前記複数の目標位置の中から、前記認識時刻から第1の所定時間が経過した将来の時刻に対応する第2の目標位置を抽出し、
前記第1の目標位置から、前記第2の目標位置までの前記軌道の長さを、前記第1の所定時間で除算した速度を、前記目標速度として導出する、
請求項1に記載の車両制御システム。 - 前記走行制御部は、更に、前記認識時刻から、前記第1の所定時間に比して短い第2の所定時間が経過した将来の時刻に対応した第3の目標位置と、前記将来の時刻において前記車両が到達することが予測される予測位置との第2の偏差に基づいて、前記目標速度を補正する、
請求項2に記載の車両制御システム。 - 前記第1の偏差に基づく前記目標速度の補正量と、前記第2の偏差に基づく前記目標速度の補正量との一方または双方には制限が設けられ、
前記走行制御部は、前記制限の範囲内の補正量で前記目標速度を補正する、
請求項3に記載の車両制御システム。 - 前記第1の偏差および前記第2の偏差の少なくとも一方に対して、それぞれの偏差に応じて前記目標速度の補正量を減少させる領域が設けられ、
前記走行制御部は、求められた偏差が前記第1の偏差および前記第2の偏差の少なくとも一方の前記領域内にある場合、求められた偏差が前記領域外にある場合の前記目標速度の補正量に比して少ない補正量で前記目標速度を補正する、
請求項3または4に記載の車両制御システム。 - 前記車両の周辺を走行する他車両を認識する外界認識部を更に備え、
前記走行制御部は、前記外界認識部により認識された他車両のうち、前記車両の前方を走行する前走車両および前記車両の後方を走行する後続車両の一方または双方と、前記車両との車間距離が大きくなるほど、前記領域の領域範囲を広く設定する、
請求項5に記載の車両制御システム。 - 前記走行制御部は、前記第1の偏差および前記第2の偏差の少なくとも一方が閾値以下である場合、求められた偏差が前記閾値を超える場合の前記目標速度の補正量に比して少ない補正量で前記導出した目標速度を補正する、
請求項3または4に記載の車両制御システム。 - 前記車両の周辺を走行する他車両を認識する外界認識部を更に備え、
前記走行制御部は、前記外界認識部により認識された他車両のうち、前記車両の前方を走行する前走車両および前記車両の後方を走行する後続車両の一方または双方と、前記車両との車間距離が大きくなるほど、前記閾値を大きくする、
請求項7に記載の車両制御システム。 - 前記車両の速度を検出する検出部を更に備え、
前記走行制御部は、前記検出部により検出された速度が低下するほど、前記第1の偏差に基づく前記目標速度の補正量、または前記第2の偏差に基づく前記目標速度の補正量を少なくする、
請求項3から8のうちいずれか1項に記載の車両制御システム。 - 車載コンピュータが、
車両の位置を認識し、
前記車両が到達すべき将来の目標位置が、時系列に連続して複数含まれる軌道を生成し、
前記軌道に含まれる前記複数の目標位置間の距離に基づいて、前記軌道に沿って前記車両を走行させる際の目標速度を導出し、
前記認識した前記車両の位置と、前記複数の目標位置のうち前記車両の位置認識がおこなわれた認識時刻に対応した第1の目標位置との第1の偏差に基づいて、前記目標速度を補正する、
車両制御方法。 - 車載コンピュータに、
車両の位置を認識させ、
前記車両が到達すべき将来の目標位置が、時系列に連続して複数含まれる軌道を生成させ、
前記軌道に含まれる前記複数の目標位置間の距離に基づいて、前記軌道に沿って前記車両を走行させる際の目標速度を導出させ、
前記認識させた前記車両の位置と、前記複数の目標位置のうち前記車両の位置認識がおこなわれた認識時刻に対応した第1の目標位置との第1の偏差に基づいて、前記目標速度を補正させる、
車両制御プログラム。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201780028551.0A CN109070887B (zh) | 2016-05-16 | 2017-05-01 | 车辆控制***、车辆控制方法及存储介质 |
US16/300,065 US11231719B2 (en) | 2016-05-16 | 2017-05-01 | Vehicle control system, vehicle control method and vehicle control program |
JP2018518210A JP6590270B2 (ja) | 2016-05-16 | 2017-05-01 | 車両制御システム、車両制御方法、および車両制御プログラム |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016-098048 | 2016-05-16 | ||
JP2016098048 | 2016-05-16 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2017199750A1 true WO2017199750A1 (ja) | 2017-11-23 |
Family
ID=60325956
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2017/017143 WO2017199750A1 (ja) | 2016-05-16 | 2017-05-01 | 車両制御システム、車両制御方法、および車両制御プログラム |
Country Status (4)
Country | Link |
---|---|
US (1) | US11231719B2 (ja) |
JP (1) | JP6590270B2 (ja) |
CN (1) | CN109070887B (ja) |
WO (1) | WO2017199750A1 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111830958A (zh) * | 2019-03-26 | 2020-10-27 | 百度(美国)有限责任公司 | 用于操作自动驾驶车辆的方法、***和机器可读介质 |
JP7036284B1 (ja) * | 2021-02-09 | 2022-03-15 | 三菱電機株式会社 | 制御演算装置および制御演算方法 |
US11840227B2 (en) | 2020-09-03 | 2023-12-12 | Honda Motor Co., Ltd. | Vehicle control device, vehicle control method, and storage medium |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10745009B2 (en) * | 2016-12-21 | 2020-08-18 | Samsung Electronics Co., Ltd. | Electronic apparatus for determining a dangerous situation of a vehicle and method of operating the same |
US11481017B2 (en) * | 2017-09-26 | 2022-10-25 | Sony Corporation | Power reduction in an autonomous mobile by stopping data processing in an upstream node when there is no downstream node using the output data |
US11392127B2 (en) * | 2018-10-15 | 2022-07-19 | Zoox, Inc. | Trajectory initialization |
US11097579B2 (en) * | 2018-11-08 | 2021-08-24 | Ford Global Technologies, Llc | Compensation for trailer coupler height in automatic hitch operation |
EP3915850A4 (en) * | 2019-01-21 | 2022-06-08 | Hitachi Astemo, Ltd. | VEHICLE CONTROL DEVICE, VEHICLE CONTROL METHOD AND VEHICLE CONTROL SYSTEM |
DE102019201800A1 (de) * | 2019-02-12 | 2020-08-13 | Continental Automotive Gmbh | Verfahren zur Trajektorienplanung eines Assistenzsystems |
JP7189060B2 (ja) * | 2019-03-27 | 2022-12-13 | トヨタ自動車株式会社 | 車両走行制御システム |
CN110375745A (zh) * | 2019-07-26 | 2019-10-25 | 上海知洋信息科技有限公司 | 一种基于角度修正的自动导航导航方法 |
US11608059B2 (en) * | 2019-08-26 | 2023-03-21 | GM Global Technology Operations LLC | Method and apparatus for method for real time lateral control and steering actuation assessment |
CA3157512A1 (en) * | 2019-10-16 | 2021-04-22 | Locomation, Inc. | Vision-based follow the leader lateral controller |
US11851078B2 (en) * | 2020-04-20 | 2023-12-26 | Honda Motor Co., Ltd. | Driving assistance device, driving assistance method, and storage medium |
CN112308976A (zh) * | 2020-10-28 | 2021-02-02 | 上海恒润数字科技集团股份有限公司 | 一种轨道车及其执行控制机构的误差控制方法和装置 |
CN114506343B (zh) * | 2022-03-02 | 2024-07-16 | 阿波罗智能技术(北京)有限公司 | 轨迹规划方法、装置、设备、存储介质及自动驾驶车辆 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5042291A (ja) * | 1973-08-17 | 1975-04-17 | ||
JP2002331853A (ja) * | 2001-05-11 | 2002-11-19 | Nissan Motor Co Ltd | 車両用走行制御装置 |
JP2007203860A (ja) * | 2006-02-01 | 2007-08-16 | Xanavi Informatics Corp | 車両速度制御装置および同装置における目標速度設定方法ならびにプログラム |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3770975B2 (ja) | 1995-10-31 | 2006-04-26 | 本田技研工業株式会社 | 自動走行車 |
JP4222398B2 (ja) * | 2006-09-21 | 2009-02-12 | 株式会社デンソー | 車両用衝突判定装置 |
US8983765B2 (en) * | 2006-10-11 | 2015-03-17 | GM Global Technology Operations LLC | Method and system for lane centering control |
US9008890B1 (en) * | 2013-03-15 | 2015-04-14 | Google Inc. | Augmented trajectories for autonomous vehicles |
JP5994755B2 (ja) * | 2013-09-06 | 2016-09-21 | トヨタ自動車株式会社 | 車両走行制御装置 |
JP5821917B2 (ja) * | 2013-09-20 | 2015-11-24 | トヨタ自動車株式会社 | 運転支援装置 |
JP6340824B2 (ja) * | 2014-02-25 | 2018-06-13 | 村田機械株式会社 | 自律走行台車 |
EP3202631B1 (en) * | 2014-09-29 | 2018-12-05 | Nissan Motor Co., Ltd | Travel control device and travel contrl method |
EP3018026B1 (en) * | 2014-11-06 | 2019-05-15 | Veoneer Sweden AB | Method for vehicle path prediction |
GB201420988D0 (en) * | 2014-11-26 | 2015-01-07 | Tomtom Telematics Bv | Apparatus and method for vehicle economy improvement |
EP3578431B1 (en) * | 2015-01-05 | 2024-03-20 | Nissan Motor Co., Ltd. | Drive control device with detection range adjustment |
JP6298772B2 (ja) * | 2015-01-14 | 2018-03-20 | 日立オートモティブシステムズ株式会社 | 車載用制御装置、自車位置姿勢特定装置、車載用表示装置 |
CN111380545A (zh) * | 2015-02-10 | 2020-07-07 | 御眼视觉技术有限公司 | 用于自主车辆导航的方法、服务器、自主车辆以及介质 |
DE102015215929A1 (de) * | 2015-08-20 | 2017-02-23 | Volkswagen Aktiengesellschaft | Vorrichtungen, Verfahren und Computerprogramm zum Bereitstellen von Information über eine voraussichtliche Fahrintention |
JP6558239B2 (ja) * | 2015-12-22 | 2019-08-14 | アイシン・エィ・ダブリュ株式会社 | 自動運転支援システム、自動運転支援方法及びコンピュータプログラム |
-
2017
- 2017-05-01 US US16/300,065 patent/US11231719B2/en active Active
- 2017-05-01 JP JP2018518210A patent/JP6590270B2/ja active Active
- 2017-05-01 WO PCT/JP2017/017143 patent/WO2017199750A1/ja active Application Filing
- 2017-05-01 CN CN201780028551.0A patent/CN109070887B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5042291A (ja) * | 1973-08-17 | 1975-04-17 | ||
JP2002331853A (ja) * | 2001-05-11 | 2002-11-19 | Nissan Motor Co Ltd | 車両用走行制御装置 |
JP2007203860A (ja) * | 2006-02-01 | 2007-08-16 | Xanavi Informatics Corp | 車両速度制御装置および同装置における目標速度設定方法ならびにプログラム |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111830958A (zh) * | 2019-03-26 | 2020-10-27 | 百度(美国)有限责任公司 | 用于操作自动驾驶车辆的方法、***和机器可读介质 |
US11840227B2 (en) | 2020-09-03 | 2023-12-12 | Honda Motor Co., Ltd. | Vehicle control device, vehicle control method, and storage medium |
JP7429172B2 (ja) | 2020-09-03 | 2024-02-07 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、およびプログラム |
JP7036284B1 (ja) * | 2021-02-09 | 2022-03-15 | 三菱電機株式会社 | 制御演算装置および制御演算方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109070887A (zh) | 2018-12-21 |
CN109070887B (zh) | 2021-08-24 |
JP6590270B2 (ja) | 2019-10-16 |
US20190179330A1 (en) | 2019-06-13 |
JPWO2017199750A1 (ja) | 2018-12-20 |
US11231719B2 (en) | 2022-01-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6590270B2 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP6544878B2 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP6582319B2 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP6598127B2 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP6569186B2 (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
JP6246844B2 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP6768787B2 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP6432116B2 (ja) | 車両位置特定装置、車両制御システム、車両位置特定方法、および車両位置特定プログラム | |
JP6303217B2 (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
JP6304894B2 (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
WO2017159539A1 (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
WO2017141396A1 (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
WO2017138513A1 (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
JP2017165156A (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JPWO2017154152A1 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP2017081426A (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
JP2017146794A (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
JPWO2017159493A1 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
WO2017159489A1 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP6270888B2 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP2017144886A (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
JP6442771B2 (ja) | 車両制御装置、車両制御方法、および車両制御プログラム | |
JP2018037100A (ja) | 車両制御システム、車両制御方法、および車両制御プログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
WWE | Wipo information: entry into national phase |
Ref document number: 2018518210 Country of ref document: JP |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 17799180 Country of ref document: EP Kind code of ref document: A1 |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 17799180 Country of ref document: EP Kind code of ref document: A1 |