WO2021002239A1 - Vehicle speed control device - Google Patents
Vehicle speed control device Download PDFInfo
- Publication number
- WO2021002239A1 WO2021002239A1 PCT/JP2020/024508 JP2020024508W WO2021002239A1 WO 2021002239 A1 WO2021002239 A1 WO 2021002239A1 JP 2020024508 W JP2020024508 W JP 2020024508W WO 2021002239 A1 WO2021002239 A1 WO 2021002239A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- speed
- vehicle
- upper limit
- driver
- limit speed
- Prior art date
Links
- 230000003111 delayed effect Effects 0.000 claims abstract description 9
- 230000008859 change Effects 0.000 claims description 163
- 238000012508 change request Methods 0.000 claims 2
- 238000000034 method Methods 0.000 description 281
- 230000008569 process Effects 0.000 description 266
- 238000012545 processing Methods 0.000 description 78
- 230000001133 acceleration Effects 0.000 description 53
- 230000006870 function Effects 0.000 description 34
- 238000001514 detection method Methods 0.000 description 16
- 230000005540 biological transmission Effects 0.000 description 14
- 230000004048 modification Effects 0.000 description 12
- 238000012986 modification Methods 0.000 description 12
- 238000004891 communication Methods 0.000 description 9
- 240000004050 Pentaglottis sempervirens Species 0.000 description 6
- 235000004522 Pentaglottis sempervirens Nutrition 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 239000003550 marker Substances 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 210000005252 bulbus oculi Anatomy 0.000 description 2
- 230000000873 masking effect Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000011084 recovery Methods 0.000 description 2
- OHVLMTFVQDZYHP-UHFFFAOYSA-N 1-(2,4,6,7-tetrahydrotriazolo[4,5-c]pyridin-5-yl)-2-[4-[2-[[3-(trifluoromethoxy)phenyl]methylamino]pyrimidin-5-yl]piperazin-1-yl]ethanone Chemical compound N1N=NC=2CN(CCC=21)C(CN1CCN(CC1)C=1C=NC(=NC=1)NCC1=CC(=CC=C1)OC(F)(F)F)=O OHVLMTFVQDZYHP-UHFFFAOYSA-N 0.000 description 1
- 230000005856 abnormality Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 125000004122 cyclic group Chemical group 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 238000002372 labelling Methods 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K31/00—Vehicle fittings, acting on a single sub-unit only, for automatically controlling vehicle speed, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator
-
- 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
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F02—COMBUSTION ENGINES; HOT-GAS OR COMBUSTION-PRODUCT ENGINE PLANTS
- F02D—CONTROLLING COMBUSTION ENGINES
- F02D29/00—Controlling engines, such controlling being peculiar to the devices driven thereby, the devices being other than parts or accessories essential to engine operation, e.g. controlling of engines by signals external thereto
- F02D29/02—Controlling engines, such controlling being peculiar to the devices driven thereby, the devices being other than parts or accessories essential to engine operation, e.g. controlling of engines by signals external thereto peculiar to engines driving vehicles; peculiar to engines driving variable pitch propellers
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
Definitions
- the present invention relates to a vehicle speed control device, and relates to a vehicle speed control device that automatically acquires a speed limit specified on a road and controls the vehicle speed so as not to exceed the speed limit.
- the speed limit specified for the road on which the vehicle is traveling is acquired by a camera, a car navigation system, or communication, and the driver depresses the accelerator pedal so that the speed limit is exceeded.
- a technique for suppressing the deviation of the speed limit by limiting the driving force of the vehicle even if the above is performed see, for example, Patent Document 2 below.
- Patent Documents 2 and 3 above do not propose any method for notifying such a speed limit driver.
- the timing of notifying the driver of the current speed limit and the timing of the speed change of the own vehicle are matched, for example, the timing of recognizing the speed sign during the lane change operation (that is, the timing of acquiring the speed limit)
- the timing of notifying the driver of the current speed limit does not match, and the driver misses the speed indicator or the like.
- the present invention has been made in view of the above circumstances, and an object of the present invention is to provide a speed control device for a vehicle that can surely reduce discomfort to a driver.
- the vehicle speed control device of the present invention responds to a speed limit acquisition unit that acquires a speed limit specified for the road on which the own vehicle travels, and a speed limit acquisition unit that acquires the speed limit from the speed limit acquisition unit.
- An upper limit speed setting unit that sets the upper limit speed of the own vehicle
- a speed control unit that controls the traveling speed of the own vehicle so as to be equal to or lower than the upper limit speed obtained from the upper limit speed setting unit, and the upper limit speed.
- the speed control unit includes an upper limit speed notification unit for notifying the driver of the upper limit speed set by the setting unit, and the speed control unit notifies the driver of the upper limit speed by the upper limit speed notification unit. It is characterized in that the upper limit speed is applied to the control of the traveling speed of the own vehicle at a timing delayed from the above.
- the vehicle speed control device of the present invention acquires the speed limit defined on the road on which the own vehicle travels by a camera, a car navigation system, or the like, and switches the driver according to the speed limit (or the speed limit).
- the speed limit or the speed limit.
- the driving force of the vehicle is limited even if the driver depresses the accelerator pedal so as to exceed the speed limit.
- It has a function (speed limiter function), and while matching the timing when the speed limit of the road changes (that is, the timing when the speed limit is acquired) and the timing when the current speed limit (specifically, the upper limit speed) is notified to the driver.
- the change of the upper limit speed is applied to the speed control at the timing delayed from the notification of the speed limit (specifically, the upper limit speed) not only when the lane change operation is performed. Further, for example, the upper limit speed change during the lane change operation is suppressed, and the upper limit speed change is applied to the speed control after the lane change operation is completed.
- the speed limit is automatically set as the upper limit speed of the own vehicle, so that the occurrence of traveling exceeding the speed limit due to oversight or misunderstanding is suppressed without troublesome operation by the driver.
- the speed limit is automatically set as the upper limit speed of the own vehicle, so that the occurrence of traveling exceeding the speed limit due to oversight or misunderstanding is suppressed without troublesome operation by the driver.
- there is a time (delay time) from the change of the upper limit speed to the change of the own vehicle speed regardless of the presence or absence of the lane change so that the change of the own vehicle speed from the change of the upper limit speed when the lane is changed etc. Even if there is a time lag before, the discomfort to the driver is reduced.
- FIG. 3 is a block diagram showing a system configuration of a vehicle including the vehicle speed control device of the first embodiment.
- Configuration diagram of a stereo camera A bird's-eye view showing the positions of your vehicle and traffic signs. The figure which shows the image which image
- FIG. The flowchart of the control process of the speed control device for a vehicle of Example 1. Flow chart of sign information acquisition process. Flow chart of control state determination process. The figure which shows the switch attached to the steering wheel. Flowchart of set vehicle speed update process. Flowchart of operation state estimation processing. Flowchart of lane change start judgment processing. Flowchart of lane change end judgment processing. Flowchart of lane stability judgment processing.
- a bird's-eye view showing the own vehicle and the vehicle lane markings.
- the vehicle speed control device of this embodiment is mounted on a vehicle (hereinafter, may be referred to as a own vehicle or a own vehicle), and the vehicle is constructed according to a block diagram as shown in FIG.
- the vehicle speed control device 100 of the illustrated embodiment is connected to a stereo camera 200 that images the surroundings of the vehicle, and the content of a traffic sign (hereinafter, may be referred to as a road sign or simply a sign) measured by the stereo camera 200. And the position is transmitted by communication to the vehicle speed control device 100. Further, the vehicle speed control device 100 is connected to the wheel speed sensor 300 attached to the wheel, the rotation speed of the tire 900 is measured by the wheel speed sensor 300, and the speed of the own vehicle converted from the measured rotation speed is calculated. It is transmitted to the vehicle speed control device 100.
- a traffic sign hereinafter, may be referred to as a road sign or simply a sign
- the speed control device 100 for vehicles is connected to a speed limiter control switch (hereinafter, may be simply referred to as a switch) 700, and the switch operation information of the driver is transmitted to the speed control device 100 for vehicles, so that the vehicle is used.
- the speed control device 100 determines the speed limiter control start / release of the driver and the set speed instructed by the driver (see also FIG. 9). With this configuration, the vehicle speed control device 100 calculates the control amount by obtaining the status of the traffic sign applied to the road currently traveling, the own vehicle speed, and the speed control intention of the driver.
- the vehicle speed control device 100 calculates the control amount of the engine 510 based on the calculated control amount, and determines the notification method to the driver.
- the control amount of the engine 510 is transmitted by communication to the engine control unit 500 connected to the vehicle speed control device 100, and the engine control unit 500 uses the information obtained from the accelerator pedal opening sensor 550 and the vehicle speed control device 100.
- the engine 510 is operated based on the control amount of the engine 510 obtained from.
- the acceleration force generated by the engine 510 is boosted through the torque converter 520, transmission 530, and final gear 540 and transmitted to the tire 900 to control the acceleration of the vehicle.
- the notification method to the driver determined by the vehicle speed control device 100 is transmitted by communication to the meter control unit 600 connected to the vehicle speed control device 100, so that the buzzer 620 by the meter control unit 600 is used. It gives a warning by voice and a control status notification to the driver by display using the display device 610.
- the configuration of the stereo camera 200 is shown in FIG.
- the stereo camera 200 has a CCD camera (right) 210 and a CCD camera (left) 220, and any or all of the images obtained by the CCD camera (right) 210 and the CCD camera (left) 220 are sent to the image processing unit 230. Entered.
- the image processing unit 230 detects a traffic sign from the input image.
- the image processing unit 230 estimates the relative position of the own vehicle and the traffic sign by determining where the detected traffic sign is in the image and what the size of the traffic sign is. To do.
- the image processing unit 230 determines what kind of traffic sign the detected traffic sign is.
- the information on the relative position of the own vehicle and the traffic sign and the type of the traffic sign (in other words, the content of the traffic sign) is used as the traffic sign information for the vehicle through the communication processing unit 250 via the CAN bus of the vehicle. It is transmitted to the speed control device 100.
- FIG. 3 is a bird's-eye view of the own vehicle V1 traveling under the condition that there are two traffic signs in the vicinity and two in the distance.
- FIG. 4 shows an image taken by using the CCD camera (right) 210 under the same situation as shown in FIG. 3 and an image taken by continuing running as it is.
- the image shows a nearby traffic sign 1110 and a distant traffic sign 1120, but as the traffic sign approaches, the size in the image increases and the position moves closer to the outside of the screen. ..
- the distance to the traffic sign can be obtained by obtaining the parallax for the traffic sign from the two images captured by the CCD camera (right) 210 and the CCD camera (left) 220. it can.
- the engine control unit 500 was calculated from the control amount transmitted from the vehicle speed control device 100, specifically, the allowable acceleration (described later), and the accelerator pedal opening by the driver obtained from the accelerator pedal opening sensor 550.
- the acceleration of the own vehicle is controlled by comparing the accelerations of the vehicle requested by the driver, selecting the smaller acceleration as the acceleration for engine control, and controlling the output of the engine 510.
- the acceleration of the vehicle is controlled as desired by generating a driving force for the tire 900 through the torque converter 520, the transmission 530, and the final gear 540.
- the engine control unit 500 has a function of adjusting the engine torque generated with respect to the acceleration for engine control in consideration of the weight of the own vehicle, the tire dynamic radius, the torque converter 520, and the state of the transmission 530, and the engine 510. Controls the engine throttle opening and injection amount. Further, the engine control unit 500 also controls the gear ratio of the transmission 530 as needed so that the desired acceleration can be obtained.
- the vehicle speed control device 100 is configured as a microcomputer (also called a microcomputer) having a CPU, ROM, RAM, etc. inside, and the CPU executes various programs stored in the ROM, and the CPU is executed. The information generated by this is temporarily stored in the RAM.
- the speed control device 100 for a vehicle realizes speed limiter control that automatically acquires a speed limit specified on the road on which the vehicle travels and controls the speed of the vehicle so as not to exceed the speed limit. It performs each calculation related to the traveling control of the vehicle.
- the vehicle speed control device 100 of this embodiment has a speed limit acquisition unit 101, a driver operation acquisition unit 102, an upper limit speed setting unit 103, a lane change estimation unit 104, a speed control unit 105, and an upper limit speed. It is composed of a notification unit 106.
- the speed limit acquisition unit 101 is realized by the sign information acquisition process P110 described later, and is defined on the road on which the own vehicle travels based on the traffic sign information obtained from the stereo camera 200, and is applied to the own vehicle. It has a function to acquire the speed.
- the driver operation acquisition unit 102 is realized by the switch operation information acquisition process P115 described later, acquires switch operation information from the speed limiter control switch 700, and is based on the switch operation information obtained from the speed limiter control switch 700. It has a function of acquiring a request for enabling or disabling the speed limiter function and a request for changing the speed limit applied to the own vehicle by a switch operation (driver operation) of the driver.
- the upper limit speed setting unit 103 is realized by the control state determination process P120 and the set vehicle speed update process P130, which will be described later, and obtains the speed limit obtained from the speed limit acquisition unit 101 and the driver request obtained from the driver operation acquisition unit 102. It has a function of determining the speed limit applied to the own vehicle as the upper limit speed (hereinafter, may be referred to as a set vehicle speed).
- the lane change estimation unit 104 is realized by the driving state estimation process P140 described later, and has a function of estimating and determining the start and end of the lane change operation of the own vehicle as the lane change state.
- the speed control unit 105 is realized by the allowable acceleration calculation process P150 and the allowable acceleration transmission process P160 described later, and is based on the upper limit speed obtained by the upper limit speed setting unit 103 and the lane change state obtained from the lane change estimation unit 104. It has a function of setting an allowable acceleration and controlling the speed of the own vehicle (specifically, controlling the speed to be equal to or lower than the upper limit speed obtained from the upper limit speed setting unit 103). Among the functions of the speed control unit 105, there is a function to prevent the change of the speed limit from being immediately reflected in the allowable acceleration and a function to control the speed of the own vehicle by transmitting the allowable acceleration to the engine control unit 500. Included (detailed later).
- the upper limit speed notification unit 106 is realized by the set vehicle speed transmission process P170 described later, has a function of notifying the driver of the upper limit speed (set vehicle speed) obtained by the upper limit speed setting unit 103, and notifies the upper limit speed to the meter control unit 600. Send. Further, the upper limit speed notification unit 106 immediately obtains the upper limit speed obtained by the upper limit speed setting unit 103 regardless of the control status of the speed control unit 105 (that is, the timing at which the speed limit acquisition unit 101 acquires the speed limit, or By notifying (at the timing when the upper limit speed is set by the upper limit speed setting unit 103), the speed control unit 105 notifies the driver of the upper limit speed before the timing when the speed of the vehicle fluctuates.
- the vehicle speed control device 100 In controlling the engine control unit 500 and the meter control unit 600, the vehicle speed control device 100 first acquires traffic sign information by processing P110.
- this process (sign information acquisition process) P110 information on the speed limit is extracted from the traffic sign information identified by the stereo camera 200.
- the traffic sign information there are traffic signs such as pause and overtaking prohibition in addition to the traffic sign related to the speed limit, but the traffic sign information to be referred to in the subsequent processing by masking the information other than the information related to the speed limit on process P110.
- This process (sign information acquisition process) P110 is performed by the speed limit acquisition unit 101 of FIG.
- switch operation information acquisition process P115 information regarding the driver's request for speed limiter control is acquired from the switch operation information obtained from the speed limiter control switch 700.
- This process (switch operation information acquisition process) P115 is performed by the driver operation acquisition unit 102 of FIG.
- control state is determined according to the information such as the driver switch operation and the occurrence of a failure, and the state for determining whether the allowable acceleration calculated value of the vehicle acceleration by the speed limiting function is invalid. To determine.
- This process (control state determination process) P120 is performed by the upper limit speed setting unit 103 of FIG.
- the driver's operating state is estimated by processing P140.
- P140 driving state estimation process
- the driver's driving operation and the detection of the direction and positional relationship between the outside line of the road and the own vehicle, the position and relative speed with the surrounding vehicles by the outside world recognition sensor such as the stereo camera 200 Estimate what kind of driving the driver is doing according to the result.
- This process (driving state estimation process) P140 is performed by the lane change estimation unit 104 of FIG.
- the allowable acceleration is calculated in process P150.
- the control state determined by the process P120, the speed limit updated by the process P130, the driving state estimation result determined by the process P140, and the own vehicle speed obtained from the wheel speed sensor 300 are used.
- This process (allowable acceleration calculation process) P150 is realized by the speed control unit 105 of FIG.
- processing P160 and processing P170 the allowable acceleration obtained in processing P150 and the set vehicle speed obtained in processing P130 are transmitted using communication.
- the permissible acceleration obtained in processing P150 is processed into information that can be communicated in processing P160, and transmitted to the engine control unit 500 through the CAN bus, which is the communication path.
- the vehicle is controlled by processing the set vehicle speed obtained in the process P130 into information that can be communicated by the process P170 and transmitting it to the meter control unit 600.
- the process (allowable acceleration transmission process) P160 is realized by the speed control unit 105 of FIG. 5, and the process (set vehicle speed transmission process) P170 is realized by the upper limit speed notification unit 106 of FIG.
- the traffic sign information identified by the stereo camera 200 is received by processing P111.
- the traffic sign information is composed of the number of detected signs and a plurality of arranged single sign information.
- the single sign information is composed of information on the type of the detected sign, the positional relationship with respect to the own vehicle, and the detection accuracy of the sign.
- the sequence number M for controlling the sequence is set to 0, the labeling speed limit is set to an invalid value, and the selection marker effectiveness score is initialized to an invalid value.
- processing P113 it is determined by using SEQ ID NO: M whether or not the number of detected signs obtained as traffic sign information has been processed, and if SEQ ID NO: M is not less than the number of detected signs (P113: false), End process P110. If the number of detected markers is 0, the determination of process P113 is determined to be false in the first execution, and process P110 ends. If the sequence number M is less than the number of detected signs in the judgment of the process P113 (P113: true), the process proceeds to the process P114, and the sign information [M], which is the Mth traffic sign information of the sequence number, is the speed limit sign. Determine if there is.
- the type of the sign information [M] is a sign relating to the speed limit effective for the own vehicle" and "the positional relationship of the sign information [M] is valid for the own vehicle". Or, for example, the vehicle is passing 50 m before the road sign, and "is the detection accuracy of the sign information [M] sufficient to be used as a speed limit sign, for example, the detection accuracy is 80%. This is the case.
- the type of speed limit indicator is acquired from the sign information [M] by using the function ftype that acquires the type of speed limit indicator, and is stored in the speed limit indicator.
- the information stored in the speed limit information is not necessary to consider the positional relationship and the detection accuracy in the subsequent processing, and the system can be simplified.
- the process proceeds to P116, and the tag effectiveness score is obtained by using the function fscore that calculates the marker effectiveness score for the indicator information [M] stored in the process P115, and the selected indicator effectiveness score is used. Store.
- the sequence number M is incremented, the process returns to the process P113, the above-mentioned process is repeated, and all the single labels stored in the indicator information are displayed.
- the function fscore used in process P116 and process P114 is calculated from the type of indicator.
- a score is determined in advance for each type of sign, and a score for a matching sign is set. For example, a high value is set for a high speed sign score, and 100 km / h is adopted when 100 km / h and 80 km / h signs are acquired at the same time. If 100km / h and 80km / h signs can be obtained at the same time, 100km / h may be applied to vehicles excluding large vehicles and towing vehicles, and 80km / h may be applied to large vehicles and towing vehicles.
- the vehicle to which this score setting is applied is different from a large vehicle or a towing vehicle such as a passenger car, it is possible to select an appropriate speed limit for the own vehicle by preferentially adopting a high speed sign. If your vehicle is a large vehicle, you want to use 80km / h, so you can select an appropriate speed limit for your vehicle by setting a higher score for lower speeds. Further, if an auxiliary sign indicating that the vehicle is intended for a large vehicle or a towing vehicle can be detected, the score may be changed in consideration of the information of the auxiliary sign and the type of the own vehicle. A method may be adopted in which the traveling lane of the own vehicle is detected and the score is added or subtracted in consideration of the type and order of the speed signs.
- the switch operation information is acquired from the speed limiter control switch 700, the request for enabling or disabling the speed limiter function based on the acquired switch operation information, and the own vehicle. Gets information about the driver's requirements for speed limiter control, including requests to change the speed limit applied to.
- process P121 determines a device failure. This condition takes precedence over all conditions, and when a failure is detected (P121: true), the process proceeds to process P122, and the control state is set as a failure. If no failure is detected in process P121 (P121: false), the process proceeds to process P123.
- the process P123 it is determined whether the failure has recovered, and if the recovery of the failure is detected (P123: true), the process proceeds to the process P124 and the control state is prohibited. If it is not a failure recovery (P123: false), the process proceeds to P125, and the switch operation of the speed limit function (speed limiter control switch 700 in this example) by the driver is detected.
- switch operation there are an alternate switch method and a toggle switch method. The method described in the example of FIG. 8 is an example of the method of the alternate switch, and the driver presses the switch SW1 of the speed limiter control switch 700 attached to the steering wheel as shown in FIG. The moment when the vehicle is separated from the speed limit function switch operation is detected (P125: true), and the process proceeds to P126.
- the switch operation is not limited to this method, such as when the timing at which the switch SW1 is pressed is used as the speed limit function switch operation detection, or when the toggle switch method is used. If the switch operation is not detected (P125: false), the process P120 is terminated while maintaining the control state.
- process P126 it is determined whether the control state before the update was prohibited, and if the control state is prohibited (P126: true), the process proceeds to process P127, the control state is switched to allow, and the control state is not prohibited. In that case, that is, when the control state is the permitted state (P126: false), the process proceeds to the process P128, and the control state is switched to the prohibited state.
- first process P131 confirms the control status determined by process P120. If the control state is permitted (P131: true), the process proceeds to P132 as established. If the control state is not permitted (P131: false), the set vehicle speed is not updated and the process proceeds to P139a.
- the notification time is a time for notifying the driver that the set vehicle speed has changed. For example, if the speed limit is read from the sign and the set vehicle speed changes to 50km / h just before the driver tries to update the set vehicle speed from 40km / h to 50km / h by operating a switch, it is + 10km compared to 50km / h. The operation of / h is performed. In this way, after the set vehicle speed is updated once so that the driver does not unintentionally update the set vehicle speed, the driver should not update the set vehicle speed for the time to check the current set vehicle speed. To.
- the notification time is less than 0.5 s (P132: false)
- the condition is not satisfied, that is, the notification time is insufficient, and the set vehicle speed is not updated and the process proceeds to P139a.
- the notification time is 0.5s or more (P132: true)
- the threshold value of the notification time at this time is set to 0.1 s when the vehicle speed is changed by switch operation by the process P134, and 1 s when the set vehicle speed is updated using the sign speed limit in the process P136.
- the process P133 it is determined from the information obtained by the process P115 whether the driver is trying to update the set vehicle speed by operating the switch.
- the set vehicle speed is updated by operating the switch SW2, switch SW3, and switch SW4 of the speed limiter control switch 700 attached to the steering wheel, for example, as shown in FIG.
- the switch SW2 is pressed and then released, or when the switch SW3 is pressed and then released, or when the switch SW4 is pressed and then released, or when the switch SW2 is pressed and held for 1s or more, or the switch SW3 is pressed. While pressing and holding for 1s or more, it is determined that there is a switch operation of the driver (P133: true), and the process proceeds to P134. If it is not determined that the driver has a switch operation (P133: false), the condition is not satisfied and the process proceeds to P135.
- the set vehicle speed is updated according to the operation content of the switch used under the conditions determined in process P133. Specifically, when the switch SW2, that is, the addition request switch for the set vehicle speed is pressed and released, the set vehicle speed is set to an upper limit of 120 km / h and updated to a value + 10 km / h from the previously set vehicle speed. When the switch SW3, that is, the subtraction request switch for the set vehicle speed is pressed and released, the set vehicle speed is set to the lower limit of 30 km / h and updated to the value -10 km / h from the previously set vehicle speed.
- the switch SW4 that is, the switch for returning the set vehicle speed to the original value (returning to the set vehicle speed before the change) is pressed and released
- the set vehicle speed is updated to the previously set vehicle speed. If the addition request switch for the set vehicle speed is continuously pressed for 1 s or more, the set vehicle speed is set to 120 km / h as the upper limit, and is updated to a value + 1 km / h from the previously set vehicle speed every 1 s. If the subtraction request switch for the set vehicle speed is continuously pressed for 1s or more, the lower limit is 30km / h, and the set vehicle speed is updated to a value -1km / h from the previously set vehicle speed every 1s.
- the upper limit of 120km / h and the lower limit of 30km / h are set to 180km / h according to the traffic regulations and manners of the country where the vehicle is used, and the lower limit is 10km. Reset to / h. Also, if the country uses the mile / h unit system as the vehicle speed unit system instead of the km / h unit system, 1km / h is 1mile / h, 10km / h is 10mile / h, and the upper limit is The speed of 120km / h can be treated as 80mile / h. By doing so, this function can be used in multiple countries with different unit systems and traffic rules.
- process P135 it is determined whether to use the sign speed limit obtained by the process P110 as the set vehicle speed.
- process P135 if the sign speed limit is not updated in process P110 with the indicator speed limit set to an invalid value (P135: false), the set vehicle speed is not updated and the process proceeds to process P139a. If the indicator speed limit is not an invalid value (P135: true), the process proceeds to P136.
- process P136 set the sign speed limit to the set vehicle speed and proceed to process P139a.
- the upper limit speed setting unit 103 changes the driver switch operation (driver operation of switch SW2 for increasing the upper limit speed, driver operation of switch SW3 for lowering the upper limit speed, and upper limit speed) obtained from the driver operation acquisition unit 102.
- the set vehicle speed (upper limit speed) setting can be updated according to the result of (including the driver operation of the switch SW4 that returns to the previous upper limit speed).
- the upper limit speed setting unit 103 requests the change of the upper limit speed by the driver operation acquired from the driver operation acquisition unit 102, and the speed limit (marking speed limit) acquired from the speed limit acquisition unit 101.
- priority is given to the update by the driver operation acquired from the driver operation acquisition unit 102, and the upper limit speed is changed by the driver operation acquired from the driver operation acquisition unit 102.
- the set vehicle speed is compared with the set vehicle speed before change detection, and it is determined that the set vehicle speed has been updated. At this time, if the set vehicle speed is the same value as the sign speed limit in processing P136, the set vehicle speed and the value of the set vehicle speed before change detection match even if the set vehicle speed is updated (P139a: false).
- the notification time is not reset, and if there is a driver switch operation at the next moment, the set vehicle speed can be updated according to the driver switch operation on process P134.
- process P139a determines whether the set vehicle speed has been updated (P139a: true). If it is determined in process P139a that the set vehicle speed has been updated (P139a: true), the process proceeds to process P139b and the notification time used for determination in process P132 is reset to 0. Subsequently, the process proceeds to process P139d, and the set vehicle speed before change detection is set to the previously set vehicle speed used in process P134, and then the set vehicle speed is set to the set vehicle speed before change detection used in process P139a. By separately holding the set vehicle speed before change detection and the previously set vehicle speed, it is possible to realize a function of detecting a change in the set vehicle speed and returning to the previously set vehicle speed. If it is determined in process P139a that the set vehicle speed has not been updated (P139a: false), the process proceeds to process P139c, and the notification time is measured by setting the notification time for the operation cycle, for example, +10 ms.
- the first is no lane change
- the second is during lane change
- the third is after lane movement.
- the driving state is defined in process P141, and no lane change is specified as the initial value.
- process P142 it is determined whether the control state obtained in the above-mentioned control state determination process P120 is permitted, and if it is not permitted (P142: false), the process proceeds to process P149b and the driving state is changed without changing lanes. Update and end process P140. If the control state is permitted in the determination of process P142 (P142: true), the process proceeds to process P143.
- process P143 if the driving state is changing lanes or the duration of the state after moving lanes is within the specified time (within the lane change time range) (P143: true), the process proceeds to process P144. If the specified time has passed (P143: false), the process proceeds to P149a. Processing P143 cannot detect the case where the blinker is mistakenly operated and the blinker is operated while running when the lane change is performed for too long, or the outside line of the lane is affected by dirt or snow. This is done for the purpose of preventing the speed control function from stopping by forcibly ending the lane change. Therefore, when proceeding to the process P149a, the driving state is updated without changing the lane, and the process P140 is terminated.
- process P144 when proceeding to process P144, the judgment process is switched according to the current operating state. If it is determined in process P144 that the driving state is no lane change (P144: true), the process proceeds to process P145, and the result of the lane change start determination is set to the driving state. If the driving status is not changed in lane in process P144 (P144: false), the process proceeds to process P146. If it is determined in process P146 that the driving state is changing lanes (P146: true), the process proceeds to process P147, and the result of determining the end of lane change is set to the driving state.
- process P146 If the driving state is not changing lanes in process P146 (P146: false), that is, if the driving state is after moving to a lane, the process proceeds to process P148 and the result of making a stability judgment in the lane is set to the driving state. ..
- processing P145a it is determined whether the lane change has started to the right of the own vehicle, and if it is determined that the lane change has started (P145a: true), the process proceeds to P145b and the lane change direction is set as the right.
- the process P145c the lane change is set as the driving state return value.
- P145d determine whether the lane change has started to the left of the own vehicle, and determine that the lane change has started. (P145d: true), proceed to processing P145e and set the lane change direction as left.
- the process proceeds to P145f, and the lane change is set as the operating state return value.
- process P145d If it is determined in process P145d that the left lane change has not started (P145d: false), the process proceeds to process P145g and the lane change direction is set as invalid. Next, the process proceeds to P145h, and no lane change is set as the driving state return value. The operation state return value set in this way is returned as the return value of the process P145, and the operation state is set.
- the stereo camera 200 is used to recognize the outside world, and it is determined whether or not there is an adjacent lane on the right side of the own vehicle. Further, it is determined that the driver has operated the blinker lever to the right. It is determined that there is an adjacent lane on the right side of the own vehicle and that the lane change is started to the right of the own vehicle when the blinker lever is operated to the right.
- the presence or absence of a lane as a condition, it is possible to separate the scene of making a right turn instead of changing the lane to the right and extract only the lane change to the right.
- the stereo camera 200 is used to recognize the outside world, and it is determined whether or not there is an adjacent lane on the left side of the own vehicle. Furthermore, it was determined that the driver operated the blinker lever to the left, and there was an adjacent lane on the left side of the own vehicle, and when the blinker lever was operated to the left, the lane change to the left of the own vehicle was started. Judge.
- the lane change direction determined in the process P145 is determined, and the process is switched by determining whether the lane change direction is right or other, that is, left.
- the process P145g is operating and the process P145h is inevitably executed. Therefore, the judgment when the lane change direction is invalid is the process P147. There is no need to consider in.
- process P147a If the lane change direction is determined to be right in process P147a (P147a: true), proceed to process P147b, monitor the vehicle lane markings that are straddled when changing lanes, and target the right lane markings (target right lane markings). ) Has been switched. If it is determined that the right lane has been changed (P147b: true), the process proceeds to P147c, and the driving state return value is set after moving to the lane. If it is not determined that the right lane has been changed (P147b: false), proceed to process P147d and set the driving status return value to lane changing.
- process P147a If it is determined in process P147a that the lane change direction is not right (P147a: false), proceed to process P147e, monitor the vehicle lane markings that are straddled when changing lanes, and target the left lane marking (target left lane marking). ) Has been switched. If it is determined that the left lane has been changed (P147e: true), proceed to process 147f and set the driving state return value after moving to the lane. If it is not determined that the left lane has been changed (P147e: false), proceed to processing P147g and set the driving status return value to lane changing. The operating state return value determined in this way is returned as the return value of the process P147 and set to the operating state.
- the right lane marking with respect to the own vehicle V1 refers to the lane marking at the center of the tip of the vehicle, to the right of the position indicated by Pc in the figure, and the closest distance.
- the left lane marking with respect to the own vehicle V1 refers to the lane marking that is to the left of the position indicated by Pc in the figure and is the closest distance.
- process P148a confirm that the lane change direction set in process P145 is either left or right, and if the lane change direction is right (P148a: true), proceed to process P148b.
- processing P148b it is determined whether the horizontal position with the left lane (horizontal position in the left lane) is more than 0.2 m, and if it is not (P148b: false), proceed to processing P148f and set the stable waiting time to zero. Reset. If the lateral position with the left lane (horizontal position of the left lane) is more than 0.2 m (P148b: true), proceed to processing P148c and determine whether the absolute yaw angle to the lane is less than 5 [deg].
- processing P148g it is judged whether the horizontal position with the right lane (horizontal position in the right lane) is more than 0.2m, and if it is not (P148g: false), proceed to processing P148k and set the stable waiting time to zero. Reset. If the lateral position with the right lane (horizontal position of the right lane) is more than 0.2 m (P148g: true), proceed to processing P148h and determine whether the absolute yaw angle to the right lane is less than 5 [deg].
- processing P148n it is determined whether the stable waiting time has passed by 1 [s] or more. If the stable waiting time elapses more than 1 [s] (P148n: true), proceed to processing P148m, set no lane change as the return value of the driving state, and judge that the lane change has been completed. If the stable waiting time has not passed 1 [s] or more (P148n: false), proceed to processing P148p, set the driving state return value after moving to the lane (or changing lanes), and judge the stability in the lane. Continue to do. The operating state return value determined in this way is returned as the return value of the process P148 and set to the operating state.
- the lateral positions of the left and right lanes used in the processing P148b and the processing P148g will be described with reference to FIG.
- the right lane lateral position indicates a position from the position at the right end of the tip of the own vehicle V1 toward the right lane, and is indicated by Xr in the figure.
- the left lane lateral position indicates a position from the position at the left end of the tip of the own vehicle V1 toward the left lane, and is indicated by Xl in the figure.
- the anti-lane yaw angle is the yaw angle of the line Lc extending in the front-rear direction of the own vehicle V1 and the lane (lane boundary line) Rc.
- the value of the angle ⁇ at which the right line Lr and the right lane Rc of the left and right lines Ll and Lr obtained by horizontally moving the line Lc extending in the front-rear direction of the own vehicle V1 is the yaw angle with respect to the lane.
- the right direction is represented as plus
- the left direction is represented as minus.
- the absolute value of the anti-lane yaw angle is just the absolute value of the anti-lane yaw angle, and we wanted to determine whether the processing P148c and the processing P148h were traveling horizontally with respect to the lane. Take the absolute value without being aware of the right and left directions, and judge whether the own vehicle V1 can run horizontally.
- the period from when the driver starts changing lanes to when the driver returns to the state of continuing to drive horizontally with respect to the lane can be indicated as during lane change in the driving state or after lane movement. it can.
- process P151a the control status obtained from process P120 is confirmed. If it is determined that the control state is not permitted (P151a: false), the process proceeds to P151b, and the own vehicle speed obtained by the wheel speed sensor 300 is set as the past set vehicle speed. After that, the process proceeds to P151c, an invalid value (in other words, the maximum value) is set for the allowable acceleration, and the allowable acceleration calculation process P150 is terminated so that the allowable acceleration is not reflected in the control when the control state is not permitted. To do. At this time, if the vehicle speed is set to the past set vehicle speed in the process P151b and the lane is changed immediately after the control state is permitted, the past set vehicle speed is set as the own vehicle speed in the process P155. It is possible to suppress fluctuations in vehicle speed.
- process P152a determines the change in the set vehicle speed obtained from the process P130. When a change in the set vehicle speed is detected (P152a: true), the process proceeds to P152b and the waiting time (corresponding to the delay time described later) is reset with 1 [s]. If there is no change in the set vehicle speed (P152a: false), the process proceeds to P152c, and the waiting time is reduced by the operating cycle by setting the value of waiting time-operation cycle (for example, 10ms) in the waiting time. At this time, in order to set the lower limit to zero, in the process P152c, the larger value of 0 and the waiting time-operation cycle value is set as the waiting time. Processing P152b or processing P152c is followed by processing P152d.
- the set vehicle speed is set as the set vehicle speed for change detection for detecting that the set vehicle speed has changed in the judgment of the process P152a.
- the process proceeds to process P154, and it is determined that the driving state obtained in process P140 does not match "no lane change", that is, the lane is being changed. If it is determined that the driving state is changing lanes (P154: true), the process proceeds to P155, and the previously set vehicle speed is set as the control set vehicle speed.
- the speed control unit 105 determines that the lane change operation is in progress (period)
- the traveling speed of the own vehicle becomes equal to or less than the set vehicle speed (upper limit speed) before the determination that the lane change operation is started.
- the waiting time updated by the process P152b and the process P152c is determined, and it is determined that the waiting time is zero, that is, there is no waiting time. If there is no waiting time (P156: true), the process proceeds to P157, the set vehicle speed is set to the past set vehicle speed, the process proceeds to P158a, and the set vehicle speed is set as the control set vehicle speed. If the waiting time remains (P156: false), the process proceeds to the process P158b without performing the process P157 and the process P158a, the set vehicle speed for control is not updated, and the change in the set vehicle speed is not applied.
- the control is performed. Since the set vehicle speed is not updated, in this case, the timing of the vehicle speed fluctuation due to the set vehicle speed update (the application timing of the set vehicle speed update) is the timing of notification of the set vehicle speed (upper limit speed) to the driver described later (in other words, the limit). There is a possibility that it will be delayed by 1 [s] or more, which is set as the waiting time, from the acquisition timing of the vehicle speed or the setting timing of the upper limit speed (set vehicle speed).
- the speed control unit 105 determines the timing at which the own vehicle travels a certain distance (corresponding to the waiting time) or a certain time after the set vehicle speed (upper limit speed) is changed. Alternatively, the traveling speed of the own vehicle is controlled to be equal to or less than the set vehicle speed (upper limit speed) before the set vehicle speed (upper limit speed) is changed until the timing set according to both of them.
- process P158a, and process P158b After setting the control set vehicle speed in process P155, process P158a, and process P158b, proceed to process P159 and input the set control set vehicle speed and the own vehicle speed obtained from the wheel speed sensor 300 into the map function. Get acceleration.
- the map value used in the map function is set in advance as a constant map by calculating the allowable acceleration on the desk or in an experiment by combining the set vehicle speed for control and the own vehicle speed.
- the previously set vehicle speed is not updated during the lane change, and the allowable acceleration can be calculated based on the set vehicle speed 1 [s] before the lane change. Therefore, the vehicle speed does not fluctuate due to a change in the set vehicle speed, which is the basis for calculating the allowable acceleration, during the lane change operation, and the driver can smoothly change lanes.
- the driver is fully notified of the change in the set vehicle speed. Since the vehicle speed fluctuates, there is no sense of discomfort for the driver. Also, if the driver feels that the change in vehicle speed during lane change is troublesome even if he / she is aware of the change in the set vehicle speed, he / she has enough time to release the speed limit by operating a switch before changing lanes. Can be taken.
- a waiting time of 1 [s] or more (in other words, a delay time) always occurs from the change of the set vehicle speed to the reflection of the allowable acceleration. Therefore, the driver can update the set vehicle speed by operating the switch while the waiting time has elapsed. Since there is a time margin before the change in the set vehicle speed is applied to the allowable acceleration, it is possible to suppress the occurrence of acceleration / deceleration based on the set vehicle speed not intended by the driver.
- the engine control unit 500 controls the output of the engine 510 by comparing the allowable acceleration with the driver-required vehicle acceleration calculated from the accelerator pedal opening by the driver obtained from the accelerator pedal opening sensor 550. , Control the acceleration (that is, running speed) of the own vehicle.
- the set vehicle speed (upper limit speed) obtained in the process P130 is transmitted to the meter control unit 600.
- the meter control unit 600 warns the driver by voice using the buzzer 620 and the driver by displaying using the display device 610. The driver is immediately notified of the set vehicle speed.
- the timing of the vehicle speed fluctuation due to the set vehicle speed update (the application timing of the set vehicle speed update) is set as the waiting time rather than the timing of notifying the driver of the set vehicle speed (upper limit speed) 1 [s. ]
- the upper limit speed notification unit 106 is based on the upper limit speed (set vehicle speed) different from the upper limit speed (set vehicle speed) obtained by the speed control unit 105 from the upper limit speed setting unit 103. Even under the condition that the running speed of the vehicle is controlled, the upper limit speed (set vehicle speed) set by the upper limit speed setting unit 103 is notified, and the upper limit speed (set vehicle speed) used for controlling the running speed of the own vehicle is notified.
- the upper limit speed (set vehicle speed) used for may not match.
- the allowable acceleration and set vehicle speed are given a cyclic redundancy check (CRC) and resolution conversion so that communication can be performed for transmission, and a data transmission request is made to the CAN bus.
- the data transmitted to the meter control unit 600 is the set vehicle speed obtained in the processing P130, and is different from the control set vehicle speed directly used in the allowable acceleration calculation in the processing P150.
- the set vehicle speed for control used for controlling the engine control unit 500 can be suppressed from the driver's discomfort when changing lanes by shifting the set vehicle speed and the timing of change without notifying the driver. ..
- an erroneous detection occurs in the recognition of the speed limit detected by the stereo camera 200
- the driver is quickly notified of the set vehicle speed
- the driver is notified of the erroneous detection result
- the driver switches SW4.
- Operate (Fig. 9) to return to the set speed before false detection, or operate switches SW1 and SW2 (Fig. 9) to change to the desired set speed.
- the set vehicle speed for control becomes the set vehicle speed updated by the driver, and the vehicle speed can be controlled based on the correct speed limit. Therefore, it is possible to suppress the occurrence of acceleration / deceleration based on the speed limit as a result of erroneous detection. ..
- FIG. 17 shows an example of a driving scene in which the vehicle changes lanes as a bird's-eye view.
- the scene changes from the timing of S1 to the timing of S2 and S3.
- Pos1 the driver of the vehicle V1 operates the right turn signal lever to operate the right turn signal.
- Pos1 the own vehicle V1 recognizes the speed sign TS1.
- S2 scene he steers at the Pos2 position and straddles the lane markings.
- the direction of the own vehicle V1 is parallel to the lane marking at the position of Pos3.
- the preceding vehicle V25 which is slower than the own vehicle V1
- the rear side vehicle V20 which is about the same speed as the own vehicle V1
- the front side which is about the same speed as the own vehicle V1.
- a speed indicator TS1 at the position of Pos2.
- the speed sign TS1 indicates 80 [km / h], and 100km / h is applied as the speed limit until Pos2 is reached, and 80 [km / h] is specified for roads after Pos2. There is.
- both the timing of notifying the speed limit and the timing of speed change are set when passing Pos3. May be done.
- the own vehicle V1 has passed Pos2 at the timing when the driver is notified of the change in the speed limit by Pos3, and there is no timing for the driver to recognize the speed indicator TS1 again.
- the driver should pay attention to the preceding vehicle V25 and the front side vehicle V21 so that the distance between the preceding vehicle V25 and the front side vehicle V21 and the own vehicle V1 does not become too close.
- the driver is notified of the set vehicle speed at the timing of passing Pos1, and the driver recognizes the correctness of the speed limit change of the own vehicle V1 by comparing it with the speed sign TS1. Can be done. Furthermore, since we are accustomed to the behavior that the speed limit changes normally and the speed change of the own vehicle V1 occurs by running for a certain period of time or running a certain distance, after the notification is given at the timing of Pos1 , Even if the speed change occurs at the timing of Pos3 (the timing when it is judged that the lane change operation is completed), the discomfort given to the driver will be reduced and suppressed.
- the upper limit speed notification unit 106 acquires the speed limit specified for the road on which the own vehicle travels by the speed limit acquisition unit 101, or the upper limit.
- the driver is notified of the upper limit speed (set vehicle speed) set in the upper limit speed setting unit 103.
- the speed control unit 105 applies the upper limit speed (update) to the control of the running speed of the own vehicle at a timing delayed from the timing when the upper limit speed notification unit 106 notifies the driver of the upper limit speed (set vehicle speed). To do.
- the upper limit speed notification unit 106 controls the traveling speed of the own vehicle based on the upper limit speed (set vehicle speed) different from the upper limit speed (set vehicle speed) obtained from the upper limit speed setting unit 103 by the speed control unit 105. Even under such circumstances, the upper limit speed (set vehicle speed) set by the upper limit speed setting unit 103 is notified, and the upper limit speed (set vehicle speed) used for controlling the running speed of the own vehicle and the upper limit speed used for notification (set vehicle speed). The set vehicle speed) does not match.
- the speed control unit 105 has a timing (waiting) in which the own vehicle travels at least one of a certain distance or a certain time after the upper limit speed (set vehicle speed) obtained from the upper limit speed setting unit 103 is changed. Until the timing corresponding to the time), the traveling speed of the own vehicle is controlled so as to be equal to or less than the upper limit speed (set vehicle speed) before the upper limit speed (set vehicle speed) is changed.
- the vehicle speed control device 100 of the present embodiment acquires the speed limit defined on the road on which the own vehicle travels by the stereo camera 200, and operates the driver's switch according to the speed limit (or the speed limit).
- the speed limit or the speed limit.
- the driving force of the vehicle is limited. It has a (speed limiter function), and while matching the timing when the speed limit of the road changes (that is, the timing when the speed limit is acquired) and the timing when the driver is notified of the current speed limit (specifically, the upper limit speed).
- the change of the upper limit speed is applied to the speed control at the timing delayed from the notification of the speed limit (specifically, the upper limit speed) not only when the lane change operation is performed. Further, for example, the upper limit speed change during the lane change operation is suppressed, and the upper limit speed change is applied to the speed control after the lane change operation is completed.
- the speed limit is automatically set as the upper limit speed of the own vehicle, so that the occurrence of traveling exceeding the speed limit due to oversight or misunderstanding is suppressed without troublesome operation by the driver.
- the speed limit is automatically set as the upper limit speed of the own vehicle, so that the occurrence of traveling exceeding the speed limit due to oversight or misunderstanding is suppressed without troublesome operation by the driver.
- there is a time (delay time) from the change of the upper limit speed to the change of the own vehicle speed regardless of the presence or absence of the lane change so that the change of the own vehicle speed from the change of the upper limit speed when the lane is changed etc. Even if there is a time lag before, the discomfort to the driver is reduced.
- Example 1 a modified example of the above-mentioned Example 1 will be described.
- the speed limit is obtained by reading the road sign with the stereo camera 200, but the own vehicle travels by linking GPS and map information or by using road-to-vehicle communication. It is also possible to replace the speed limit acquisition unit 101 that acquires the speed limit specified for the road, such as by obtaining the speed limit of the road.
- ⁇ Modification 2> when operating by voice recognition instead of operating the switch (speed limiter control switch 700) set for the steering shown in FIG. 9, or when arranging the switch in a place other than the steering.
- voice recognition instead of operating the switch (speed limiter control switch 700) set for the steering shown in FIG. 9, or when arranging the switch in a place other than the steering.
- a switch set on the steering wheel for vehicle control applications such as ACC and LKS and a switch for use in the vehicle speed control function
- the driver's operation is accepted, and in some cases, a request for changing the speed limit applied to the own vehicle is obtained by such driver operation.
- ⁇ Modification 3> In the first embodiment, as an example of the condition of the process P114 (FIG. 7), "whether the positional relationship of the sign information [M] is valid for the own vehicle, for example, the own vehicle is on the road. "You have passed 50m before the sign.” However, if the speed limit of the sign information [M] is lower than the currently set speed limit, from a long distance according to the difference in speed. It is valid for the own vehicle, and if the speed limit of the sign information [M] is higher than the currently set speed limit, it can be valid when the own vehicle has passed the side of the sign.
- the speed limit currently set is lower or higher than the speed limit indicated by the sign, if it is valid only when passing by the sign, it is right before the vehicle reaches the position of the sign. There is an advantage that there is no case where you make a left turn and you do not need to change the speed limit.
- the speed of the own vehicle is increased to the speed limit before entering the road with the lower speed limit. There is a merit that it can be lowered.
- the driving plan information of the own vehicle entered in the navigation and the result of matching the map information with the camera or GPS to detect whether the road is likely to turn left or right are detected, and the road turns left or right like an urban road.
- the sign information On roads where there is a high possibility of turning, the sign information will be valid when passing by the sign, and on roads where there is a low possibility of turning left or right, such as highways, the sign information may be valid even before passing by the sign. It is possible.
- the deceleration force from the front of the sign is set to a large value by setting the allowable acceleration calculated in the process P159 (FIG. 16) according to the distance from the sign. It can also weaken and improve the ride comfort.
- the judgment condition is "There is an adjacent lane on the right side of the own vehicle, and when the winker lever is operated to the right, the lane is changed to the right of the own vehicle. "It is judged that the vehicle has started.” However, this judgment condition is set to "there is an adjacent lane on the right side of the own vehicle, the blinker lever is operated to the right, and the vehicle is on the adjacent lane on the right side of the own vehicle.” When the vehicle is detected, it is determined that the lane change has started to the right of the own vehicle. " At this time, the traveling vehicle on the adjacent lane on the right side of the own vehicle is acquired from a camera, radar, sonar, etc.
- the judgment condition is that "there is an adjacent lane on the left side of the own vehicle and the lane change is started to the left of the own vehicle when the blinker lever is operated to the left". "Judgment is made.” However, this judgment condition is that "there is an adjacent lane on the left side of the own vehicle, the blinker lever is operated to the left, and the vehicle is detected on the adjacent lane on the left side of the own vehicle.” It is judged that the lane change has started to the left of the own vehicle when it is being done. ”The vehicle on the adjacent lane on the left side of the own vehicle monitors the front, side, and rear side of the own vehicle. Obtained from cameras, radars, sonars, etc.
- the judgment condition is "the lane is changed to the right of the own vehicle when the adjacent lane exists on the right side of the own vehicle and the blinker lever is operated to the right. "It is judged that the vehicle has started.” However, this judgment condition is that "there is an adjacent lane on the right side of the own vehicle, the blinker lever is operated to the right, and the driver is gazing to the right.” Sometimes it is determined that the lane change has started to the right of the own vehicle. " At this time, whether or not the driver is gazing to the right is detected by using a camera that monitors the driver's line of sight.
- This camera monitors the driver's face orientation, eyeball orientation, or both the driver's face orientation and eyeball orientation, and the driver is looking at the right side mirror, etc., in front of the vehicle, and in the speed control state. Detects that you are not looking at the display device for notifying.
- the determination condition is "it is determined that there is an adjacent lane on the left side of the own vehicle and the lane change is started to the left of the own vehicle when the blinker lever is operated to the left". However, this condition is changed to "when there is an adjacent lane on the left side of the own vehicle, the blinker lever is operated to the left, and the driver is gazing to the left, the lane is changed to the left of the own vehicle. It is judged that it has started. ”, And whether or not the driver is gazing to the left is detected by using a camera that monitors the driver's line of sight.
- ⁇ Modification 5> In the first embodiment, only the waiting time is used as the condition of the process P156 (FIG. 16), but there is also a method of determining this condition according to the distance traveled by the own vehicle. For example, the set vehicle speed is updated 50 [m] before the road sign, it is detected that the vehicle has traveled 40 [m] from that point, and the set vehicle speed is set as the control set vehicle speed. With this configuration, when traveling on a route that involves turning left or right, the speed limit applied to roads that are not planned to be entered can be ignored. In addition, this distance may be changed according to the speed of the own vehicle. Further, it is possible to apply a combination of conditions such as detecting that the waiting time has become 0 or traveling 40 [m] and proceeding to the process P157.
- the waiting time set in the process P152b (FIG. 16) is set to 1 [s], but this parameter is set by the driver's switch operation grace and the deceleration start grace of the own vehicle. ..
- the driver switch operation grace is the time required from when the display device 610 presents the change in the speed limit by the speed indicator to the driver until the error is corrected, and the longer the waiting time, the more margin there is.
- the deceleration start grace of the own vehicle is the time during which the deceleration can be controlled until the own vehicle reaches the road whose speed limit has changed according to the speed sign. The shorter the waiting time, the more the deceleration occurs before the speed limit changes. This reduces the risk of overspeeding.
- There is a trade-off between the driver's switch operation grace period and the deceleration start grace period of the own vehicle and the driver needs at least 1 [s] to change the speed limit by the speed sign by the switch operation, and the own vehicle decelerates. Since the start grace period is set as long as possible, 1 [s] is set in the first embodiment.
- This parameter has a waiting time of 1.5 to ensure a longer switch operation grace period for drivers, such as elderly people, who take a long time from recognition by presenting information to response by switch operation. It may be deformed to be longer than [s]. That is, the waiting time (corresponding to the delay time described above) can be changed according to the operation ability such as the switch operation of the driver.
- the waiting time is set as long as 1.5 [s] when driving at low speed, and the waiting time is set as short as 1.0 [s] when driving at high speed.
- the waiting time can be changed according to the traveling speed.
- the driver can be used at low speeds where there is a time grace to reach the position where the speed limit changes, and at high speeds where there is little time grace to reach the position where the speed limit changes.
- it is possible to make a modification such that the deceleration start grace period of the own vehicle is set as long as possible while ensuring a long switch operation grace period.
- the difference in waiting time set between high-speed driving and low-speed driving becomes too large, the driver will feel uncomfortable with the timing until the vehicle behavior occurs, so the difference is 1 [s at the longest. ] It is desirable to set it within.
- the present invention is not limited to the above-described embodiment.
- the same method can be applied to control the speed and acceleration of the vehicle.
- the engine torque, driving force, and throttle opening may be calculated by the vehicle speed control device 100 and communicated with the power unit without communicating using the allowable acceleration.
- the present invention is not limited to the above-described embodiment, and includes various modified forms.
- the above-described embodiment has been described in detail in order to explain the present invention in an easy-to-understand manner, and is not necessarily limited to the one including all the described configurations.
- it is possible to replace a part of the configuration of one embodiment with the configuration of another embodiment and it is also possible to add the configuration of another embodiment to the configuration of one embodiment.
- each of the above configurations, functions, processing units, processing means, etc. may be realized by hardware by designing a part or all of them by, for example, an integrated circuit. Further, each of the above configurations, functions, and the like may be realized by software by the processor interpreting and executing a program that realizes each function. Information such as programs, tables, and files that realize each function can be stored in a memory, a hard disk, a storage device such as an SSD (Solid State Drive), or a recording medium such as an IC card, an SD card, or a DVD.
- SSD Solid State Drive
- control lines and information lines indicate what is considered necessary for explanation, and not all control lines and information lines are necessarily shown on the product. In practice, it can be considered that almost all configurations are interconnected.
- 100 Vehicle speed control device, 101 ... Speed limit acquisition unit, 102 ... Driver operation acquisition unit, 103 ... Upper limit speed setting unit, 104 ... Lane change estimation unit, 105 ... Speed control unit, 106 ... Upper limit speed notification unit, 200 ... Stereo camera, 300 ... Wheel speed sensor, 500 ... Engine control unit, 510 ... Engine, 550 ... Accelerator pedal opening sensor, 600 ... Meter control unit, 610 ... Display device, 620 ... Buzzer, 700 ... Speed limiter control switch, 1110 and 1120 ... Traffic signs
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- General Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Controls For Constant Speed Travelling (AREA)
- Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
Abstract
The present invention addresses the problem of providing a vehicle speed control device that can reliably reduce a driver's feeling of discomfort. In the present invention, an upper limit speed notifying unit 106 notifies a driver of an upper limit speed (set vehicle speed) set by an upper limit speed setting unit 103 at a timing (immediately) when a speed limit acquiring unit 101 acquires a speed limit established for a road on which a host vehicle is traveling or a timing when the upper limit speed setting unit 103 sets the upper limit speed to be applied to the host vehicle in accordance with the speed limit. Further, a speed control unit 105 applies the upper limit speed (as an update) to the control of a traveling speed of the host vehicle at a timing delayed from the timing at which the upper limit speed notifying unit 106 notified the driver of the upper limit speed (set vehicle speed).
Description
本発明は、車両用速度制御装置に係り、道路に規定された制限速度を自動的に取得し、車両の速度が制限速度を超過しないように制御する車両用速度制御装置に関する。
The present invention relates to a vehicle speed control device, and relates to a vehicle speed control device that automatically acquires a speed limit specified on a road and controls the vehicle speed so as not to exceed the speed limit.
車両の運転操作において、自車の走行速度が道路に規定された制限速度を超過することを防止するため、ドライバが制限速度をステアリングに取り付けられたスイッチなどの装置で入力し、車両の駆動力を制御する車両用速度制御装置に関する技術が知られている(例えば、下記特許文献1を参照)。
In order to prevent the running speed of the own vehicle from exceeding the speed limit specified on the road during the driving operation of the vehicle, the driver inputs the speed limit with a device such as a switch attached to the steering wheel to drive the vehicle. A technique relating to a speed control device for a vehicle for controlling a vehicle is known (see, for example, Patent Document 1 below).
また、前述の車両用速度制御装置に対して、自車両の走行する道路に規定されている制限速度をカメラやカーナビゲーションシステム、通信により取得し、ドライバが制限速度を超えるようなアクセルペダルの踏み込みを行ったとしても車両の駆動力を制限することで制限速度の逸脱を抑止する技術が知られている(例えば、下記特許文献2を参照)。
In addition, for the speed control device for vehicles mentioned above, the speed limit specified for the road on which the vehicle is traveling is acquired by a camera, a car navigation system, or communication, and the driver depresses the accelerator pedal so that the speed limit is exceeded. There is known a technique for suppressing the deviation of the speed limit by limiting the driving force of the vehicle even if the above is performed (see, for example, Patent Document 2 below).
また、道路に規定されている制限速度の低下と、ドライバの車線変更のタイミングが一致した際、ドライバの意図に反して自車両が減速してしまうことを防ぐため、車線変更中は車線変更開始前の制限速度を基に車両の駆動力を制限することで、ドライバに対して与えられる違和感の軽減を行う技術が知られている(例えば、下記特許文献3を参照)。
In addition, when the speed limit specified on the road decreases and the driver's lane change timing matches, the lane change starts during the lane change in order to prevent the vehicle from decelerating against the driver's intention. There is known a technique for reducing the discomfort given to the driver by limiting the driving force of the vehicle based on the previous speed limit (see, for example, Patent Document 3 below).
ところで、例えば上記特許文献2、3に所載のように、道路に規定されている制限速度の取得と、取得した制限速度に基づく車両の走行速度の制御を自動的に行う場合においても、取得した制限速度をドライバに対して音声や表示等で通知し、制限速度の変化に起因した車両の走行速度の変化(車速変動)によるドライバの違和感を軽減することが望まれる。
By the way, even when the speed limit specified for the road is acquired and the traveling speed of the vehicle is automatically controlled based on the acquired speed limit, as described in Patent Documents 2 and 3 above, the acquisition is also obtained. It is desired to notify the driver of the speed limit by voice, display, etc., and reduce the driver's discomfort due to the change in the running speed of the vehicle (variation in vehicle speed) caused by the change in the speed limit.
しかしながら、上記特許文献2、3には、そのような制限速度のドライバに対する通知方法は一切提案されていない。
However, Patent Documents 2 and 3 above do not propose any method for notifying such a speed limit driver.
前述のような技術を適用するにあたり、速度標識を認識したタイミング(つまり、制限速度を取得したタイミング)とドライバに対して現在の制限速度を通知するタイミングを合わせるだけでは、通常走行中は制限速度を通知した結果が自車両の速度変化に反映されるタイミングが制限速度を通知するタイミングと略一致する一方で、例えば車線変更操作中は制限速度を通知した結果が自車両の速度変化に反映されるタイミングが制限速度を通知するタイミングからずれてしまい、ドライバに違和感を与えてしまう。また、ドライバに対して現在の制限速度を通知するタイミングと自車両の速度変化のタイミングを一致させると、例えば車線変更操作中は速度標識を認識したタイミング(つまり、制限速度を取得したタイミング)とドライバに対して現在の制限速度を通知するタイミングが合わなくなり、ドライバは速度標識等を見逃してしまうという問題があった。
When applying the above-mentioned technology, simply matching the timing of recognizing the speed indicator (that is, the timing of acquiring the speed limit) and the timing of notifying the driver of the current speed limit is sufficient to speed limit during normal driving. The timing at which the result of notifying the speed limit is reflected in the speed change of the own vehicle is almost the same as the timing at which the speed limit is notified, while the result of notifying the speed limit is reflected in the speed change of the own vehicle during the lane change operation, for example. The timing shifts from the timing of notifying the speed limit, giving the driver a sense of discomfort. Also, if the timing of notifying the driver of the current speed limit and the timing of the speed change of the own vehicle are matched, for example, the timing of recognizing the speed sign during the lane change operation (that is, the timing of acquiring the speed limit) There is a problem that the timing of notifying the driver of the current speed limit does not match, and the driver misses the speed indicator or the like.
本発明は、上記事情に鑑みてなされたもので、その目的とするところは、ドライバに対する違和感を確実に軽減することのできる車両用速度制御装置を提供することにある。
The present invention has been made in view of the above circumstances, and an object of the present invention is to provide a speed control device for a vehicle that can surely reduce discomfort to a driver.
上記課題を解決するため、本発明の車両用速度制御装置は、自車両が走行する道路に規定された制限速度を取得する制限速度取得部と、前記制限速度取得部から取得した制限速度に応じて、前記自車両の上限速度を設定する上限速度設定部と、前記自車両の走行速度を前記上限速度設定部から得た前記上限速度以下となるように制御する速度制御部と、前記上限速度設定部で設定している前記上限速度をドライバに対して通知する上限速度通知部と、を備え、前記速度制御部は、前記上限速度通知部で前記上限速度を前記ドライバに対して通知するタイミングから遅れたタイミングで、前記上限速度を前記自車両の走行速度の制御に適用することを特徴としている。
In order to solve the above problems, the vehicle speed control device of the present invention responds to a speed limit acquisition unit that acquires a speed limit specified for the road on which the own vehicle travels, and a speed limit acquisition unit that acquires the speed limit from the speed limit acquisition unit. An upper limit speed setting unit that sets the upper limit speed of the own vehicle, a speed control unit that controls the traveling speed of the own vehicle so as to be equal to or lower than the upper limit speed obtained from the upper limit speed setting unit, and the upper limit speed. The speed control unit includes an upper limit speed notification unit for notifying the driver of the upper limit speed set by the setting unit, and the speed control unit notifies the driver of the upper limit speed by the upper limit speed notification unit. It is characterized in that the upper limit speed is applied to the control of the traveling speed of the own vehicle at a timing delayed from the above.
すなわち、本発明の車両用速度制御装置は、自車両の走行する道路に規定されている制限速度をカメラやカーナビゲーションシステム等により取得し、制限速度(または、その制限速度に応じてドライバのスイッチ操作等を介して設定される上限速度)を自車両の上限速度として自動的に設定することで、ドライバが制限速度を超えるようなアクセルペダルの踏み込みを行ったとしても車両の駆動力を制限する機能(スピードリミッタ機能)を持ち、道路の制限速度が変化するタイミング(つまり、制限速度を取得したタイミング)とドライバに対して現在の制限速度(詳しくは、上限速度)を通知するタイミングを合わせつつ、車線変更操作時等に限らず制限速度(詳しくは、上限速度)の通知から遅れたタイミングで上限速度の変更を速度制御に適用する。また、例えば、車線変更操作中の上限速度変更を抑止し、車線変更操作終了後に上限速度変更を速度制御に適用する。
That is, the vehicle speed control device of the present invention acquires the speed limit defined on the road on which the own vehicle travels by a camera, a car navigation system, or the like, and switches the driver according to the speed limit (or the speed limit). By automatically setting the upper limit speed of the own vehicle as the upper limit speed set through operations, etc., the driving force of the vehicle is limited even if the driver depresses the accelerator pedal so as to exceed the speed limit. It has a function (speed limiter function), and while matching the timing when the speed limit of the road changes (that is, the timing when the speed limit is acquired) and the timing when the current speed limit (specifically, the upper limit speed) is notified to the driver. , The change of the upper limit speed is applied to the speed control at the timing delayed from the notification of the speed limit (specifically, the upper limit speed) not only when the lane change operation is performed. Further, for example, the upper limit speed change during the lane change operation is suppressed, and the upper limit speed change is applied to the speed control after the lane change operation is completed.
これにより、本発明によれば、自動的に制限速度が自車両の上限速度として設定されることによって、見落としや誤解で制限速度を超過した走行の発生をドライバの煩わしい操作を行わずに抑止しつつ、例えば車線変更時にドライバの意図しない速度変動を抑止できる。この時、車線変更の有無等にかかわらず上限速度の変更から自車速度の変化につながるまでの時間(遅延時間)があることで、車線変更時等に上限速度の変更から自車速度の変化までに時間的差があったとしても、ドライバに対する違和感が軽減される。
As a result, according to the present invention, the speed limit is automatically set as the upper limit speed of the own vehicle, so that the occurrence of traveling exceeding the speed limit due to oversight or misunderstanding is suppressed without troublesome operation by the driver. At the same time, for example, when changing lanes, it is possible to suppress unintended speed fluctuations by the driver. At this time, there is a time (delay time) from the change of the upper limit speed to the change of the own vehicle speed regardless of the presence or absence of the lane change, so that the change of the own vehicle speed from the change of the upper limit speed when the lane is changed etc. Even if there is a time lag before, the discomfort to the driver is reduced.
上記した以外の課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
Issues, configurations and effects other than those described above will be clarified by the explanation of the following embodiments.
<実施例1> 以下、図面を参照しながら本発明の一実施形態である車両用速度制御装置を説明する。
<Example 1> Hereinafter, a vehicle speed control device according to an embodiment of the present invention will be described with reference to the drawings.
本実施例の車両用速度制御装置は、車両(以下、自車や自車両ということがある)に搭載され、図1のようなブロック図に従って車両を構築する。
The vehicle speed control device of this embodiment is mounted on a vehicle (hereinafter, may be referred to as a own vehicle or a own vehicle), and the vehicle is constructed according to a block diagram as shown in FIG.
図示実施例の車両用速度制御装置100は、車両周囲を撮像するステレオカメラ200と接続され、ステレオカメラ200で計測した交通標識(以下、道路標識、または、単に標識ということがある)の内容、および位置は、車両用速度制御装置100へ通信によって送信される。また、車両用速度制御装置100は、車輪に取り付けられた車輪速センサ300と接続され、車輪速センサ300でタイヤ900の回転数を計測し、計測した回転数から換算した自車両の速度は、車両用速度制御装置100へ送信される。また、車両用速度制御装置100は、スピードリミッタコントロールスイッチ(以下、単にスイッチということがある)700と接続され、ドライバのスイッチ操作情報が車両用速度制御装置100へ送信されることで、車両用速度制御装置100は、ドライバのスピードリミッタ制御開始、制御解除、ドライバの指示する設定速度を判断する(図9を併せて参照)。この構成により、車両用速度制御装置100は、現在走行している道路に適用されている交通標識の状況、自車速度、ドライバの速度制御意図を得ることで、制御量の計算を行う。
The vehicle speed control device 100 of the illustrated embodiment is connected to a stereo camera 200 that images the surroundings of the vehicle, and the content of a traffic sign (hereinafter, may be referred to as a road sign or simply a sign) measured by the stereo camera 200. And the position is transmitted by communication to the vehicle speed control device 100. Further, the vehicle speed control device 100 is connected to the wheel speed sensor 300 attached to the wheel, the rotation speed of the tire 900 is measured by the wheel speed sensor 300, and the speed of the own vehicle converted from the measured rotation speed is calculated. It is transmitted to the vehicle speed control device 100. In addition, the speed control device 100 for vehicles is connected to a speed limiter control switch (hereinafter, may be simply referred to as a switch) 700, and the switch operation information of the driver is transmitted to the speed control device 100 for vehicles, so that the vehicle is used. The speed control device 100 determines the speed limiter control start / release of the driver and the set speed instructed by the driver (see also FIG. 9). With this configuration, the vehicle speed control device 100 calculates the control amount by obtaining the status of the traffic sign applied to the road currently traveling, the own vehicle speed, and the speed control intention of the driver.
車両用速度制御装置100は、算出した制御量に基づいて、エンジン510での制御量を算出するとともに、ドライバへの報知方法を決定する。
The vehicle speed control device 100 calculates the control amount of the engine 510 based on the calculated control amount, and determines the notification method to the driver.
エンジン510での制御量は、車両用速度制御装置100に接続したエンジンコントロールユニット500に通信で送信され、エンジンコントロールユニット500は、アクセルペダル開度センサ550から得た情報と車両用速度制御装置100から得たエンジン510の制御量を基に、エンジン510を動作させる。エンジン510で発生した加速力は、トルクコンバータ520、トランスミッション530、ファイナルギア540を通して倍力され、タイヤ900に伝えられることで、車両の加速度を制御する。
The control amount of the engine 510 is transmitted by communication to the engine control unit 500 connected to the vehicle speed control device 100, and the engine control unit 500 uses the information obtained from the accelerator pedal opening sensor 550 and the vehicle speed control device 100. The engine 510 is operated based on the control amount of the engine 510 obtained from. The acceleration force generated by the engine 510 is boosted through the torque converter 520, transmission 530, and final gear 540 and transmitted to the tire 900 to control the acceleration of the vehicle.
更に、車両用速度制御装置100で決定したドライバへの報知方法は、車両用速度制御装置100に接続されたメータコントロールユニット600に通信で送信されることで、メータコントロールユニット600によるブザー620を用いた音声による警告や、表示装置610を用いた表示によるドライバへの制御状態通知などを行う。
Further, the notification method to the driver determined by the vehicle speed control device 100 is transmitted by communication to the meter control unit 600 connected to the vehicle speed control device 100, so that the buzzer 620 by the meter control unit 600 is used. It gives a warning by voice and a control status notification to the driver by display using the display device 610.
そして、上述する接続は、例えばCAN(Car Area Network)を用いて行われる。
Then, the above-mentioned connection is performed using, for example, CAN (Car Area Network).
次に、図1に記載した各ブロックがどのような機能を持つのかを、詳細を説明する。
Next, the function of each block shown in FIG. 1 will be described in detail.
ステレオカメラ200の構成を図2に示す。ステレオカメラ200は、CCDカメラ(右)210とCCDカメラ(左)220を持ち、CCDカメラ(右)210とCCDカメラ(左)220で得た画像のいずれか、またはすべては画像処理部230に入力される。画像処理部230は、入力された画像の中から交通標識を検出する。画像処理部230は、検出した交通標識が、画像の中のどの位置にあるか、また、その大きさがどうなっているかを判断することで、自車両と交通標識の相対的な位置を推定する。また、画像処理部230は、検出した交通標識が、どの種類の交通標識であるかを判断する。その後、自車両と交通標識の相対的な位置と交通標識の種類(換言すれば、交通標識の内容)の情報は、交通標識情報として、通信処理部250を通して車両のCANバスを介して車両用速度制御装置100へ送信される。
The configuration of the stereo camera 200 is shown in FIG. The stereo camera 200 has a CCD camera (right) 210 and a CCD camera (left) 220, and any or all of the images obtained by the CCD camera (right) 210 and the CCD camera (left) 220 are sent to the image processing unit 230. Entered. The image processing unit 230 detects a traffic sign from the input image. The image processing unit 230 estimates the relative position of the own vehicle and the traffic sign by determining where the detected traffic sign is in the image and what the size of the traffic sign is. To do. In addition, the image processing unit 230 determines what kind of traffic sign the detected traffic sign is. After that, the information on the relative position of the own vehicle and the traffic sign and the type of the traffic sign (in other words, the content of the traffic sign) is used as the traffic sign information for the vehicle through the communication processing unit 250 via the CAN bus of the vehicle. It is transmitted to the speed control device 100.
自車両と交通標識の相対的な位置を計測する原理を、図3および図4を用いて説明する。図3は、近傍と遠方にそれぞれ2つの交通標識がある状況下を走行している自車両V1の俯瞰図である。図3で示した状況と同じ状況下でCCDカメラ(右)210を用いて撮像した画像、および、そのまま走行を継続して撮像した画像を図4に示している。
The principle of measuring the relative position of the own vehicle and the traffic sign will be described with reference to FIGS. 3 and 4. FIG. 3 is a bird's-eye view of the own vehicle V1 traveling under the condition that there are two traffic signs in the vicinity and two in the distance. FIG. 4 shows an image taken by using the CCD camera (right) 210 under the same situation as shown in FIG. 3 and an image taken by continuing running as it is.
画像の中には近傍の交通標識1110と遠方の交通標識1120が写っているが、走行を続けるにつれて、交通標識が近づくと、画像内のサイズが大きくなり、位置が画面の外側に近づいていく。この仕組みを利用して、走行している時に交通標識の画像が大きくなった比率と、画像内の交通標識の位置の変化から、自車両と交通標識の相対的な位置を推定することができる。また、CCDカメラ(右)210とCCDカメラ(左)220を用いて撮像した2枚の画像から、交通標識に対しての視差を得ることで、該交通標識に対しての距離を求めることができる。
The image shows a nearby traffic sign 1110 and a distant traffic sign 1120, but as the traffic sign approaches, the size in the image increases and the position moves closer to the outside of the screen. .. Using this mechanism, it is possible to estimate the relative position of the own vehicle and the traffic sign from the ratio of the image of the traffic sign becoming larger while driving and the change in the position of the traffic sign in the image. .. In addition, the distance to the traffic sign can be obtained by obtaining the parallax for the traffic sign from the two images captured by the CCD camera (right) 210 and the CCD camera (left) 220. it can.
エンジンコントロールユニット500は、車両用速度制御装置100から送信された制御量、具体的には許容加速度(後で説明)と、アクセルペダル開度センサ550より得たドライバによるアクセルペダル開度から計算したドライバ要求車両加速度を比較し、小さい方の加速度をエンジン制御用加速度として選択してエンジン510の出力を制御することで、自車両の加速度を制御する。エンジン510の制御により、トルクコンバータ520、トランスミッション530、ファイナルギア540を通してタイヤ900に対して駆動力を発生させることで、車両の加速度を所望に制御する。この時、エンジンコントロールユニット500は、自車両の重量やタイヤ動半径、トルクコンバータ520、トランスミッション530の状態を考慮してエンジン制御用加速度に対して発生させるエンジントルクを調整する機能を持ち、エンジン510のエンジンスロットル開度や噴射量を制御する。更に、エンジンコントロールユニット500は、必要に応じてトランスミッション530の変速比も制御することで、目的の加速度を得られるようにする。
The engine control unit 500 was calculated from the control amount transmitted from the vehicle speed control device 100, specifically, the allowable acceleration (described later), and the accelerator pedal opening by the driver obtained from the accelerator pedal opening sensor 550. The acceleration of the own vehicle is controlled by comparing the accelerations of the vehicle requested by the driver, selecting the smaller acceleration as the acceleration for engine control, and controlling the output of the engine 510. By controlling the engine 510, the acceleration of the vehicle is controlled as desired by generating a driving force for the tire 900 through the torque converter 520, the transmission 530, and the final gear 540. At this time, the engine control unit 500 has a function of adjusting the engine torque generated with respect to the acceleration for engine control in consideration of the weight of the own vehicle, the tire dynamic radius, the torque converter 520, and the state of the transmission 530, and the engine 510. Controls the engine throttle opening and injection amount. Further, the engine control unit 500 also controls the gear ratio of the transmission 530 as needed so that the desired acceleration can be obtained.
[車両用速度制御装置100の機能ブロック構成] 次に、車両用速度制御装置100を構成する機能ブロックについて、図5を用いて説明する。車両用速度制御装置100は、内部にCPU、ROM、RAM等を備えたマイクロコンピュータ(マイコンともいう)として構成されており、CPUは、ROMに格納された各種プログラムを実行し、CPUが実行されることで生成される情報はRAMに一時的に格納される。車両用速度制御装置100は、ここでは、車両の走行する道路に規定されている制限速度を自動的に取得し、車両の速度が制限速度を超過しないように制御するスピードリミッタ制御を実現するものであり、車両の走行制御に関連する各演算を行う。
[Functional block configuration of the vehicle speed control device 100] Next, the functional blocks constituting the vehicle speed control device 100 will be described with reference to FIG. The vehicle speed control device 100 is configured as a microcomputer (also called a microcomputer) having a CPU, ROM, RAM, etc. inside, and the CPU executes various programs stored in the ROM, and the CPU is executed. The information generated by this is temporarily stored in the RAM. Here, the speed control device 100 for a vehicle realizes speed limiter control that automatically acquires a speed limit specified on the road on which the vehicle travels and controls the speed of the vehicle so as not to exceed the speed limit. It performs each calculation related to the traveling control of the vehicle.
図5に示すように、本実施例の車両用速度制御装置100は、制限速度取得部101、ドライバ操作取得部102、上限速度設定部103、車線変更推定部104、速度制御部105、上限速度通知部106により構成される。
As shown in FIG. 5, the vehicle speed control device 100 of this embodiment has a speed limit acquisition unit 101, a driver operation acquisition unit 102, an upper limit speed setting unit 103, a lane change estimation unit 104, a speed control unit 105, and an upper limit speed. It is composed of a notification unit 106.
制限速度取得部101は、ここでは、後述する標識情報取得処理P110によって実現され、ステレオカメラ200より得た交通標識情報を基に、自車両が走行する道路に規定され、自車両に適用する制限速度を取得する機能を有する。
Here, the speed limit acquisition unit 101 is realized by the sign information acquisition process P110 described later, and is defined on the road on which the own vehicle travels based on the traffic sign information obtained from the stereo camera 200, and is applied to the own vehicle. It has a function to acquire the speed.
ドライバ操作取得部102は、ここでは、後述するスイッチ操作情報取得処理P115によって実現され、スピードリミッタコントロールスイッチ700からスイッチ操作情報を取得するとともに、スピードリミッタコントロールスイッチ700から得たスイッチ操作情報を基に、ドライバのスイッチ操作(ドライバ操作)によって、スピードリミッタ機能を有効化、または無効化する要求、及び、自車両に適用する制限速度を変更する要求を取得する機能を有する。
Here, the driver operation acquisition unit 102 is realized by the switch operation information acquisition process P115 described later, acquires switch operation information from the speed limiter control switch 700, and is based on the switch operation information obtained from the speed limiter control switch 700. It has a function of acquiring a request for enabling or disabling the speed limiter function and a request for changing the speed limit applied to the own vehicle by a switch operation (driver operation) of the driver.
上限速度設定部103は、後述する制御状態決定処理P120、及び、設定車速更新処理P130によって実現され、制限速度取得部101から得た制限速度と、ドライバ操作取得部102から得たドライバの要求を用いて、自車両に適用する制限速度を上限速度(以下、設定車速ということがある)として決定する機能を有する。
The upper limit speed setting unit 103 is realized by the control state determination process P120 and the set vehicle speed update process P130, which will be described later, and obtains the speed limit obtained from the speed limit acquisition unit 101 and the driver request obtained from the driver operation acquisition unit 102. It has a function of determining the speed limit applied to the own vehicle as the upper limit speed (hereinafter, may be referred to as a set vehicle speed).
車線変更推定部104は、後述する運転状態推定処理P140によって実現され、自車両の車線変更操作の開始と終了を車線変更状態として推定・判断する機能を有する。
The lane change estimation unit 104 is realized by the driving state estimation process P140 described later, and has a function of estimating and determining the start and end of the lane change operation of the own vehicle as the lane change state.
速度制御部105は、後述する許容加速度計算処理P150と許容加速度送信処理P160によって実現され、上限速度設定部103で得た上限速度と、車線変更推定部104から得た車線変更状態を基に、許容加速度を設定して、自車両の速度を制御(詳しくは、上限速度設定部103から得た上限速度以下となるように制御)する機能を有する。その速度制御部105の機能の中には、制限速度の変更が許容加速度に即座に反映されないようにする機能とエンジンコントロールユニット500へ許容加速度を送信することで自車両の速度を制御する機能を含む(後で詳述)。
The speed control unit 105 is realized by the allowable acceleration calculation process P150 and the allowable acceleration transmission process P160 described later, and is based on the upper limit speed obtained by the upper limit speed setting unit 103 and the lane change state obtained from the lane change estimation unit 104. It has a function of setting an allowable acceleration and controlling the speed of the own vehicle (specifically, controlling the speed to be equal to or lower than the upper limit speed obtained from the upper limit speed setting unit 103). Among the functions of the speed control unit 105, there is a function to prevent the change of the speed limit from being immediately reflected in the allowable acceleration and a function to control the speed of the own vehicle by transmitting the allowable acceleration to the engine control unit 500. Included (detailed later).
上限速度通知部106は、後述する設定車速送信処理P170によって実現され、上限速度設定部103で得た上限速度(設定車速)をドライバへ通知する機能を有し、上限速度をメータコントロールユニット600へ送信する。更に、上限速度通知部106は、速度制御部105の制御状況によらず上限速度設定部103で得た上限速度を即座に(すなわち、制限速度取得部101で制限速度を取得するタイミング、もしくは、上限速度設定部103で上限速度を設定するタイミングで)通知することで、速度制御部105によって車両の速度が変動するタイミングより以前にドライバに上限速度を通知する。
The upper limit speed notification unit 106 is realized by the set vehicle speed transmission process P170 described later, has a function of notifying the driver of the upper limit speed (set vehicle speed) obtained by the upper limit speed setting unit 103, and notifies the upper limit speed to the meter control unit 600. Send. Further, the upper limit speed notification unit 106 immediately obtains the upper limit speed obtained by the upper limit speed setting unit 103 regardless of the control status of the speed control unit 105 (that is, the timing at which the speed limit acquisition unit 101 acquires the speed limit, or By notifying (at the timing when the upper limit speed is set by the upper limit speed setting unit 103), the speed control unit 105 notifies the driver of the upper limit speed before the timing when the speed of the vehicle fluctuates.
[車両用速度制御装置100の制御処理] 次に、車両用速度制御装置100によって、ステレオカメラ200やスピードリミッタコントロールスイッチ700から得た情報を基に、エンジンコントロールユニット500、及び、メータコントロールユニット600を制御する処理の流れを、図6のフローチャートを用いて説明する。車両用速度制御装置100では、図6に記載の処理を定期的、例えば、10[ms]周期毎に繰り返し実行することで、エンジンコントロールユニット500、及び、メータコントロールユニット600を制御する。
[Control processing of vehicle speed control device 100] Next, based on the information obtained from the stereo camera 200 and the speed limiter control switch 700 by the vehicle speed control device 100, the engine control unit 500 and the meter control unit 600 The flow of the process for controlling the above will be described with reference to the flowchart of FIG. The vehicle speed control device 100 controls the engine control unit 500 and the meter control unit 600 by periodically or repeatedly executing the process shown in FIG. 6, for example, every 10 [ms] cycle.
エンジンコントロールユニット500、及び、メータコントロールユニット600を制御するにあたり、車両用速度制御装置100は、まず、処理P110によって、交通標識情報の取得を行う。この処理(標識情報取得処理)P110では、ステレオカメラ200で識別した交通標識情報の中から、制限速度に関する情報を抽出する。交通標識情報の中には制限速度に関する交通標識以外に一時停止や追い越し禁止などの交通標識が存在するが、処理P110にて制限速度に関する情報以外をマスクし、以降の処理で参照する交通標識情報の種類を減らすことで、処理負荷を軽減し、誤判断のリスクを低減することができる。この処理(標識情報取得処理)P110は、図5の制限速度取得部101によって実施される。
In controlling the engine control unit 500 and the meter control unit 600, the vehicle speed control device 100 first acquires traffic sign information by processing P110. In this process (sign information acquisition process) P110, information on the speed limit is extracted from the traffic sign information identified by the stereo camera 200. In the traffic sign information, there are traffic signs such as pause and overtaking prohibition in addition to the traffic sign related to the speed limit, but the traffic sign information to be referred to in the subsequent processing by masking the information other than the information related to the speed limit on process P110. By reducing the types of, the processing load can be reduced and the risk of misjudgment can be reduced. This process (sign information acquisition process) P110 is performed by the speed limit acquisition unit 101 of FIG.
次に、処理P115によって、スイッチ操作情報の取得を行う。この処理(スイッチ操作情報取得処理)P115では、スピードリミッタコントロールスイッチ700から得たスイッチ操作情報から、スピードリミッタ制御に対するドライバの要求に関する情報を取得する。この処理(スイッチ操作情報取得処理)P115は、図5のドライバ操作取得部102によって実施される。
Next, the switch operation information is acquired by the process P115. In this process (switch operation information acquisition process) P115, information regarding the driver's request for speed limiter control is acquired from the switch operation information obtained from the speed limiter control switch 700. This process (switch operation information acquisition process) P115 is performed by the driver operation acquisition unit 102 of FIG.
次に、処理P120で、ドライバのスイッチ操作や故障発生等の情報に応じて制御状態の決定を行い、速度制限機能による車両加速度の許容加速度計算値を無効値とするかを判断するための状態を決定する。この処理(制御状態決定処理)P120は、図5の上限速度設定部103によって実施される。
Next, in the process P120, the control state is determined according to the information such as the driver switch operation and the occurrence of a failure, and the state for determining whether the allowable acceleration calculated value of the vehicle acceleration by the speed limiting function is invalid. To determine. This process (control state determination process) P120 is performed by the upper limit speed setting unit 103 of FIG.
次に、処理P130で、設定車速の更新を行う。この処理(設定車速更新処理)P130では、処理P110で検出した制限速度に関する交通標識情報と、自車の速度、位置情報、及び処理P115で取得したドライバのスイッチ操作情報を基に、設定車速を更新する。この処理(設定車速更新処理)P130は、図5の上限速度設定部103によって実施される。
Next, update the set vehicle speed on processing P130. In this process (set vehicle speed update process) P130, the set vehicle speed is set based on the traffic sign information regarding the speed limit detected in the process P110, the speed and position information of the own vehicle, and the switch operation information of the driver acquired in the process P115. Update. This process (set vehicle speed update process) P130 is performed by the upper limit speed setting unit 103 of FIG.
次に、処理P140で、ドライバの運転状態推定を行う。この処理(運転状態推定処理)P140では、ドライバの運転操作、及び、ステレオカメラ200等の外界認識センサによる、車道外側線と自車の向きや位置関係、周辺車両との位置や相対速度の検出結果に応じて、ドライバがどういった運転を行っているかを推定する。この処理(運転状態推定処理)P140は、図5の車線変更推定部104によって実施される。
Next, the driver's operating state is estimated by processing P140. In this process (driving state estimation process) P140, the driver's driving operation and the detection of the direction and positional relationship between the outside line of the road and the own vehicle, the position and relative speed with the surrounding vehicles by the outside world recognition sensor such as the stereo camera 200 Estimate what kind of driving the driver is doing according to the result. This process (driving state estimation process) P140 is performed by the lane change estimation unit 104 of FIG.
次に、処理P150で、許容加速度計算を行う。この処理(許容加速度計算処理)P150では、処理P120で決定した制御状態、処理P130で更新した制限速度、処理P140で判断した運転状態推定結果、車輪速センサ300から得た自車速に応じて、自車両の、発生させて良い最大の加速度である、許容加速度を計算する。この処理(許容加速度計算処理)P150は、図5の速度制御部105によって実現される。
Next, the allowable acceleration is calculated in process P150. In this process (allowable acceleration calculation process) P150, the control state determined by the process P120, the speed limit updated by the process P130, the driving state estimation result determined by the process P140, and the own vehicle speed obtained from the wheel speed sensor 300 are used. Calculate the allowable acceleration of your vehicle, which is the maximum acceleration that can be generated. This process (allowable acceleration calculation process) P150 is realized by the speed control unit 105 of FIG.
最後に、処理P160及び処理P170で、処理P150で得た許容加速度と処理P130で得た設定車速を、通信を用いて送信する。
Finally, in processing P160 and processing P170, the allowable acceleration obtained in processing P150 and the set vehicle speed obtained in processing P130 are transmitted using communication.
処理P150で得た許容加速度を処理P160で通信できる情報に加工し、通信路であるCANバスを通して、エンジンコントロールユニット500へ送信する。処理P130で得た設定車速を処理P170によって通信できる情報に加工し、メータコントロールユニット600へ送信することで、車両の制御を行う。処理(許容加速度送信処理)P160は、図5の速度制御部105によって実現され、処理(設定車速送信処理)P170は、図5の上限速度通知部106によって実現される。
The permissible acceleration obtained in processing P150 is processed into information that can be communicated in processing P160, and transmitted to the engine control unit 500 through the CAN bus, which is the communication path. The vehicle is controlled by processing the set vehicle speed obtained in the process P130 into information that can be communicated by the process P170 and transmitting it to the meter control unit 600. The process (allowable acceleration transmission process) P160 is realized by the speed control unit 105 of FIG. 5, and the process (set vehicle speed transmission process) P170 is realized by the upper limit speed notification unit 106 of FIG.
以降、上記の各処理を更に詳細にわたって説明する。
Hereinafter, each of the above processes will be described in more detail.
[標識情報取得処理P110(制限速度取得部101)] 前述した処理(標識情報取得処理)P110に関して、具体的な処理を図7を用いて説明する。
[Sign information acquisition process P110 (speed limit acquisition unit 101)] Regarding the above-mentioned process (sign information acquisition process) P110, a specific process will be described with reference to FIG. 7.
処理P110では、ステレオカメラ200で識別した交通標識情報を処理P111で受信する。交通標識情報は、標識検出数と、配列化された複数の単独標識情報で構成される。さらに、単独標識情報は、検出した標識の種類、自車に対しての位置関係、標識の検出精度の情報で構成される。
In processing P110, the traffic sign information identified by the stereo camera 200 is received by processing P111. The traffic sign information is composed of the number of detected signs and a plurality of arranged single sign information. Further, the single sign information is composed of information on the type of the detected sign, the positional relationship with respect to the own vehicle, and the detection accuracy of the sign.
次に、処理P112で、以降で配列を制御するための配列番号Mを0で、標識制限速度を無効値で、選択標識有効性スコアを無効値で初期化する。
Next, in process P112, the sequence number M for controlling the sequence is set to 0, the labeling speed limit is set to an invalid value, and the selection marker effectiveness score is initialized to an invalid value.
次に、処理P113で、交通標識情報として得た標識の検出数分だけ処理したかを、配列番号Mを用いて判断し、配列番号Mが標識検出数未満でなければ(P113:false)、処理P110を終了する。もし標識検出数が0の場合は、処理P113の判定は1回目の実行でfalseと判断し、処理P110が終了する。処理P113の判定で配列番号Mが標識検出数未満であれば(P113:true)、処理P114に進み、配列番号M番目の交通標識情報である、標識情報[M]が、制限速度の標識であるかを判断する。この時、処理P114では「標識情報[M]の種類が自車両に対して有効な制限速度に関する標識である。」且つ、「標識情報[M]の位置関係が自車両に対して有効であるか、例えば、自車両が道路標識の50m手前を通り過ぎている。」且つ、「標識情報[M]の検出精度が制限速度の標識として使用するために十分であるか、例えば、検出精度80%以上である場合である。」且つ、「標識情報[M]から標識有効性スコアを計算する関数fscoreを用いて計算した値が、選択標識有効性スコアより高い」場合に制限速度判定として(P114:true)、処理P115に進む。いずれかの条件が非成立である場合は、制限速度判定とせず(P114:false)、処理P115、処理P116をスキップして処理P117へ進む。
Next, in processing P113, it is determined by using SEQ ID NO: M whether or not the number of detected signs obtained as traffic sign information has been processed, and if SEQ ID NO: M is not less than the number of detected signs (P113: false), End process P110. If the number of detected markers is 0, the determination of process P113 is determined to be false in the first execution, and process P110 ends. If the sequence number M is less than the number of detected signs in the judgment of the process P113 (P113: true), the process proceeds to the process P114, and the sign information [M], which is the Mth traffic sign information of the sequence number, is the speed limit sign. Determine if there is. At this time, in the process P114, "the type of the sign information [M] is a sign relating to the speed limit effective for the own vehicle" and "the positional relationship of the sign information [M] is valid for the own vehicle". Or, for example, the vehicle is passing 50 m before the road sign, and "is the detection accuracy of the sign information [M] sufficient to be used as a speed limit sign, for example, the detection accuracy is 80%. This is the case. ”And when“ the value calculated using the function fscore for calculating the marker effectiveness score from the indicator information [M] is higher than the selected indicator effectiveness score ”as the speed limit determination (P114). : true), proceed to process P115. If any of the conditions is not satisfied, the speed limit is not determined (P114: false), the process P115 and the process P116 are skipped, and the process proceeds to the process P117.
処理P115では、標識情報[M]から、制限速度標識の種類を取得する関数ftypeを用いて、制限速度標識の種類を取得し、標識制限速度へ格納する。この時、制限速度情報に格納する情報は標識の種類のみに限定することで、以降の処理で位置関係や検出精度を考慮する必要がなくなり、システムを単純化することが可能となる。
In processing P115, the type of speed limit indicator is acquired from the sign information [M] by using the function ftype that acquires the type of speed limit indicator, and is stored in the speed limit indicator. At this time, by limiting the information stored in the speed limit information to only the type of the sign, it is not necessary to consider the positional relationship and the detection accuracy in the subsequent processing, and the system can be simplified.
次に、処理P116へと進み、処理P115で格納された標識情報[M]に対しての標識有効性スコアを計算する関数fscoreを用いて標識有効性スコアを取得し、選択標識有効性スコアに格納する。
Next, the process proceeds to P116, and the tag effectiveness score is obtained by using the function fscore that calculates the marker effectiveness score for the indicator information [M] stored in the process P115, and the selected indicator effectiveness score is used. Store.
次に、処理P117へと進み、確認する標識情報の配列番号を切り替えるため、配列番号Mをインクリメントし、処理P113へ戻って前述の処理を繰り返し行い、標識情報に格納されている全ての単独標識情報の中から、必要な制限速度情報を取得する。こうすることで、制限速度に関する情報以外をマスクし、以降の処理で参照する標識情報の種類を減らすことで、処理負荷を軽減し、誤判断のリスクを低減することができる。
Next, in order to proceed to the process P117 and switch the sequence number of the indicator information to be confirmed, the sequence number M is incremented, the process returns to the process P113, the above-mentioned process is repeated, and all the single labels stored in the indicator information are displayed. Obtain the required speed limit information from the information. By doing so, it is possible to reduce the processing load and the risk of erroneous judgment by masking information other than the information related to the speed limit and reducing the types of indicator information referred to in the subsequent processing.
また、処理P116及び処理P114で使用する関数fscoreは、標識の種類から計算する。あらかじめ、標識の種類毎にスコアを決めておき、一致した標識のスコアを設定する。例えば、高い速度標識スコアに高い値を設定し、100km/hと80km/hの標識が同時に取得された場合に、100km/hを採用する。100km/hと80km/hの標識が同時に取得できるような場合、100km/hは大型車や牽引車を除く車種として適用され、80km/hは大型車や牽引車に適用されるケースがある。本スコア設定を適用する車両が乗用車のように、大型車や牽引車と異なる場合は、高い速度標識を優先して採用することで自車に適切な制限速度を選ぶことが出来る。自車が大型車の場合であれば、80km/hを採用したいため、低い速度の方が高いスコアを設定することで、自車に適切な制限速度を選ぶことが出来る。また、大型車や牽引車向けであることを示すような補助標識が検知可能であれば、補助標識の情報と自車両の種類を鑑みて、スコアを変更すると良い。自車の走行レーンを検知し、速度標識の種類や並び順を鑑みてスコアに加算、減算を行う方式を採用しても良い。
Also, the function fscore used in process P116 and process P114 is calculated from the type of indicator. A score is determined in advance for each type of sign, and a score for a matching sign is set. For example, a high value is set for a high speed sign score, and 100 km / h is adopted when 100 km / h and 80 km / h signs are acquired at the same time. If 100km / h and 80km / h signs can be obtained at the same time, 100km / h may be applied to vehicles excluding large vehicles and towing vehicles, and 80km / h may be applied to large vehicles and towing vehicles. When the vehicle to which this score setting is applied is different from a large vehicle or a towing vehicle such as a passenger car, it is possible to select an appropriate speed limit for the own vehicle by preferentially adopting a high speed sign. If your vehicle is a large vehicle, you want to use 80km / h, so you can select an appropriate speed limit for your vehicle by setting a higher score for lower speeds. Further, if an auxiliary sign indicating that the vehicle is intended for a large vehicle or a towing vehicle can be detected, the score may be changed in consideration of the information of the auxiliary sign and the type of the own vehicle. A method may be adopted in which the traveling lane of the own vehicle is detected and the score is added or subtracted in consideration of the type and order of the speed signs.
[スイッチ操作情報取得処理P115(ドライバ操作取得部102)] 次に、処理(スイッチ操作情報取得処理)P115に関して説明する。
[Switch operation information acquisition process P115 (driver operation acquisition unit 102)] Next, the process (switch operation information acquisition process) P115 will be described.
この処理P115では、前述したように、スピードリミッタコントロールスイッチ700からスイッチ操作情報を取得するとともに、取得したスイッチ操作情報を基に、スピードリミッタ機能を有効化、または無効化する要求、及び、自車両に適用する制限速度を変更する要求を含むスピードリミッタ制御に対するドライバの要求に関する情報を取得する。
In this process P115, as described above, the switch operation information is acquired from the speed limiter control switch 700, the request for enabling or disabling the speed limiter function based on the acquired switch operation information, and the own vehicle. Gets information about the driver's requirements for speed limiter control, including requests to change the speed limit applied to.
[制御状態決定処理P120(上限速度設定部103)] 次に、処理(制御状態決定処理)P120について、図8を用いて詳細を説明する。
[Control state determination process P120 (upper limit speed setting unit 103)] Next, the process (control state determination process) P120 will be described in detail with reference to FIG.
車両用速度制御装置100で扱う制御状態として、“故障”、“禁止”、“許可”の3状態を持つ。まず処理P121で、機器の故障を判定する。この条件は全ての条件に優先され、故障検出時は(P121:true)、処理P122へと進み、制御状態を故障とする。処理P121で故障が検出されない場合は(P121:false)、処理P123へ進む。
The vehicle speed control device 100 has three control states, "failure", "prohibition", and "permission". First, process P121 determines a device failure. This condition takes precedence over all conditions, and when a failure is detected (P121: true), the process proceeds to process P122, and the control state is set as a failure. If no failure is detected in process P121 (P121: false), the process proceeds to process P123.
処理P123では、故障が復帰したかを判断し、故障の復帰を検出した場合は(P123:true)、処理P124に進み、制御状態を禁止とする。故障復帰で無い時は(P123:false)、処理P125に進み、ドライバによる速度制限機能(本例では、スピードリミッタコントロールスイッチ700)のスイッチ操作を検出する。スイッチ操作に関しては、オルタネートスイッチの方式と、トグルスイッチの方式がある。図8の例で記載している方式は、オルタネートスイッチの方式を例としており、ドライバが、図9に記載のように、ステアリングホイールに取り付けられたスピードリミッタコントロールスイッチ700のスイッチSW1を押下してから離した瞬間を速度制限機能スイッチ操作検出とし(P125:true)、処理P126へ進む。スイッチ操作については、スイッチSW1を押下したタイミングを速度制限機能スイッチ操作検出とする場合や、トグルスイッチの方式を使用する等、この方式に限るものではない。また、スイッチ操作検出が行われなかった場合は(P125:false)、制御状態を維持したまま処理P120を終了する。
In the process P123, it is determined whether the failure has recovered, and if the recovery of the failure is detected (P123: true), the process proceeds to the process P124 and the control state is prohibited. If it is not a failure recovery (P123: false), the process proceeds to P125, and the switch operation of the speed limit function (speed limiter control switch 700 in this example) by the driver is detected. Regarding switch operation, there are an alternate switch method and a toggle switch method. The method described in the example of FIG. 8 is an example of the method of the alternate switch, and the driver presses the switch SW1 of the speed limiter control switch 700 attached to the steering wheel as shown in FIG. The moment when the vehicle is separated from the speed limit function switch operation is detected (P125: true), and the process proceeds to P126. The switch operation is not limited to this method, such as when the timing at which the switch SW1 is pressed is used as the speed limit function switch operation detection, or when the toggle switch method is used. If the switch operation is not detected (P125: false), the process P120 is terminated while maintaining the control state.
処理P126では、更新前の制御状態が禁止であったかを判定し、制御状態が禁止であった場合は(P126:true)、処理P127へ進み、制御状態を許可へと切り替え、制御状態が禁止でない場合、つまり制御状態が許可状態であった場合は(P126:false)、処理P128へ進み、制御状態を禁止に切り替える。
In process P126, it is determined whether the control state before the update was prohibited, and if the control state is prohibited (P126: true), the process proceeds to process P127, the control state is switched to allow, and the control state is not prohibited. In that case, that is, when the control state is the permitted state (P126: false), the process proceeds to the process P128, and the control state is switched to the prohibited state.
[設定車速更新処理P130(上限速度設定部103)] 次に、処理(設定車速更新処理)P130で行う処理について、図10を用いて詳細を説明する。
[Set vehicle speed update process P130 (upper limit speed setting unit 103)] Next, the process performed in the process (set vehicle speed update process) P130 will be described in detail with reference to FIG.
処理P130では、最初に処理P131で、処理P120で判定した制御状態の確認を行う。制御状態が許可であれば(P131:true)、成立として処理P132へ進む。制御状態が許可でなければ(P131:false)、設定車速の更新を行わず、処理P139aへ進む。
In process P130, first process P131 confirms the control status determined by process P120. If the control state is permitted (P131: true), the process proceeds to P132 as established. If the control state is not permitted (P131: false), the set vehicle speed is not updated and the process proceeds to P139a.
次に、処理P132で通知時間の判定を行う。通知時間とは、設定車速が変化したことをドライバに伝えるための時間である。例えば、ドライバがスイッチ操作で設定車速を40km/hから50km/hに更新しようと操作する寸前に標識から制限速度を読み込んで設定車速が50km/hに変化すると、50km/hに対して+10km/hの操作を行ってしまう。このように、ドライバの意図しない設定車速の更新が発生してしまわないように一度設定車速が更新された後、ドライバが現在の設定車速を確認するための時間、設定車速の更新を行わないようにする。そのため、例えば通知時間が0.5s未満であれば(P132:false)、条件非成立、つまり通知時間が不足しているとして、設定車速の更新を行わず、処理P139aに進む。通知時間が0.5s以上であれば(P132:true)、十分に通知できたとして、処理P133に進む。また、この時の通知時間の閾値である0.5sについては、処理P134によって、スイッチ操作によって車速を変更した場合は0.1sとし、処理P136で標識制限速度を用いて設定車速を更新した場合は1sとするなど、条件によって待ち時間を切り替えることで、ドライバのスイッチ操作のレスポンスに素早く反応できるが、自動的に設定車速が更新された時は誤操作を防ぐようにすることもできる。
Next, the notification time is determined in process P132. The notification time is a time for notifying the driver that the set vehicle speed has changed. For example, if the speed limit is read from the sign and the set vehicle speed changes to 50km / h just before the driver tries to update the set vehicle speed from 40km / h to 50km / h by operating a switch, it is + 10km compared to 50km / h. The operation of / h is performed. In this way, after the set vehicle speed is updated once so that the driver does not unintentionally update the set vehicle speed, the driver should not update the set vehicle speed for the time to check the current set vehicle speed. To. Therefore, for example, if the notification time is less than 0.5 s (P132: false), it is assumed that the condition is not satisfied, that is, the notification time is insufficient, and the set vehicle speed is not updated and the process proceeds to P139a. If the notification time is 0.5s or more (P132: true), it is assumed that sufficient notification has been made, and the process proceeds to P133. In addition, the threshold value of the notification time at this time, 0.5 s, is set to 0.1 s when the vehicle speed is changed by switch operation by the process P134, and 1 s when the set vehicle speed is updated using the sign speed limit in the process P136. By switching the waiting time according to the conditions, it is possible to quickly respond to the response of the driver's switch operation, but it is also possible to prevent erroneous operation when the set vehicle speed is automatically updated.
次に、処理P133では、処理P115によって得られた情報から、ドライバがスイッチ操作で設定車速を更新しようとしているかを判定する。設定車速の更新は、例えば図9のようにステアリングホイールに取り付けられたスピードリミッタコントロールスイッチ700のスイッチSW2、スイッチSW3、スイッチSW4を操作することで行う。スイッチSW2を押してから離した時、または、スイッチSW3を押してから離した時、または、スイッチSW4を押してから離した時、または、スイッチSW2を1s以上押下し続けている時、または、スイッチSW3を1s以上押下し続けている時に、ドライバのスイッチ操作有りと判定し(P133:true)、処理P134へ進む。ドライバのスイッチ操作有りと判定しなかった場合は(P133:false)、条件不成立として処理P135へ進む。
Next, in the process P133, it is determined from the information obtained by the process P115 whether the driver is trying to update the set vehicle speed by operating the switch. The set vehicle speed is updated by operating the switch SW2, switch SW3, and switch SW4 of the speed limiter control switch 700 attached to the steering wheel, for example, as shown in FIG. When the switch SW2 is pressed and then released, or when the switch SW3 is pressed and then released, or when the switch SW4 is pressed and then released, or when the switch SW2 is pressed and held for 1s or more, or the switch SW3 is pressed. While pressing and holding for 1s or more, it is determined that there is a switch operation of the driver (P133: true), and the process proceeds to P134. If it is not determined that the driver has a switch operation (P133: false), the condition is not satisfied and the process proceeds to P135.
処理P134では、処理P133で判定した条件で用いたスイッチの操作内容に応じて設定車速の更新を行う。具体的には、スイッチSW2、つまり設定車速の加算要求スイッチを押して離した場合は、設定車速を120km/hを上限とし、前回設定車速から+10km/hした値に更新する。スイッチSW3、つまり設定車速の減算要求スイッチを押して離した場合は、設定車速を30km/hを下限とし、前回設定車速から-10km/hした値に更新する。スイッチSW4、つまり設定車速を元に戻す(変化前の設定車速に戻す)スイッチを押下して離した場合は、設定車速を前回設定車速に更新する。設定車速の加算要求スイッチを1s以上押下し続けている場合は、設定車速を120km/hを上限とし、1s経過毎に前回設定車速から+1km/hした値に更新する。設定車速の減算要求スイッチを1s以上押下し続けている場合は、30km/hを下限とし、1s経過毎に設定車速を前回設定車速から-1km/hした値に更新する。この時に上限として設定している120km/hや、下限として設定している30km/hは、自車両の使用される国の交通法規やマナーに応じて上限を180km/hにする、下限を10km/hとするように設定しなおす。また、km/hの単位系ではなく、mile/hの単位系を車両速度の単位系として用いている国であれば、1km/hを1mile/h、10km/hを10mile/h、上限の速度120km/hを80mile/hとして扱うこともできる。こうすることで、単位系や交通ルールの異なる複数の国で本機能を活用することができるようになる。
In process P134, the set vehicle speed is updated according to the operation content of the switch used under the conditions determined in process P133. Specifically, when the switch SW2, that is, the addition request switch for the set vehicle speed is pressed and released, the set vehicle speed is set to an upper limit of 120 km / h and updated to a value + 10 km / h from the previously set vehicle speed. When the switch SW3, that is, the subtraction request switch for the set vehicle speed is pressed and released, the set vehicle speed is set to the lower limit of 30 km / h and updated to the value -10 km / h from the previously set vehicle speed. When the switch SW4, that is, the switch for returning the set vehicle speed to the original value (returning to the set vehicle speed before the change) is pressed and released, the set vehicle speed is updated to the previously set vehicle speed. If the addition request switch for the set vehicle speed is continuously pressed for 1 s or more, the set vehicle speed is set to 120 km / h as the upper limit, and is updated to a value + 1 km / h from the previously set vehicle speed every 1 s. If the subtraction request switch for the set vehicle speed is continuously pressed for 1s or more, the lower limit is 30km / h, and the set vehicle speed is updated to a value -1km / h from the previously set vehicle speed every 1s. At this time, the upper limit of 120km / h and the lower limit of 30km / h are set to 180km / h according to the traffic regulations and manners of the country where the vehicle is used, and the lower limit is 10km. Reset to / h. Also, if the country uses the mile / h unit system as the vehicle speed unit system instead of the km / h unit system, 1km / h is 1mile / h, 10km / h is 10mile / h, and the upper limit is The speed of 120km / h can be treated as 80mile / h. By doing so, this function can be used in multiple countries with different unit systems and traffic rules.
一方、処理P135では、処理P110によって得られた標識制限速度を設定車速として用いるかを判定する。処理P135では、処理P110で標識制限速度を無効値としたまま更新されなかった場合(P135:false)、設定車速の更新を行わないとして、処理P139aに進む。標識制限速度が無効値でなかった場合は(P135:true)、処理P136へ進む。
On the other hand, in the process P135, it is determined whether to use the sign speed limit obtained by the process P110 as the set vehicle speed. In process P135, if the sign speed limit is not updated in process P110 with the indicator speed limit set to an invalid value (P135: false), the set vehicle speed is not updated and the process proceeds to process P139a. If the indicator speed limit is not an invalid value (P135: true), the process proceeds to P136.
処理P136では、設定車速に標識制限速度を設定し、処理P139aへ進む。
In process P136, set the sign speed limit to the set vehicle speed and proceed to process P139a.
前述の処理P134により、上限速度設定部103は、ドライバ操作取得部102より得たドライバのスイッチ操作(上限速度を上げるスイッチSW2のドライバ操作、上限速度を下げるスイッチSW3のドライバ操作、上限速度を変化前の上限速度に戻すスイッチSW4のドライバ操作を含む)の結果に応じて、設定車速(上限速度)の設定を更新することができる。
By the above-mentioned process P134, the upper limit speed setting unit 103 changes the driver switch operation (driver operation of switch SW2 for increasing the upper limit speed, driver operation of switch SW3 for lowering the upper limit speed, and upper limit speed) obtained from the driver operation acquisition unit 102. The set vehicle speed (upper limit speed) setting can be updated according to the result of (including the driver operation of the switch SW4 that returns to the previous upper limit speed).
また、前述の処理P133~P136により、上限速度設定部103は、ドライバ操作取得部102から取得したドライバ操作による上限速度の変更要求と、制限速度取得部101から取得した制限速度(標識制限速度)の変化による上限速度の変更要求の発生タイミングが重複した際、ドライバ操作取得部102から取得したドライバ操作による更新を優先し、ドライバ操作取得部102から取得したドライバ操作による上限速度の変更を行った後に一定時間もしくは一定距離は制限速度取得部101から取得した制限速度(標識制限速度)の変化による上限速度の変更を行わないようにできる。
Further, by the above-mentioned processes P133 to P136, the upper limit speed setting unit 103 requests the change of the upper limit speed by the driver operation acquired from the driver operation acquisition unit 102, and the speed limit (marking speed limit) acquired from the speed limit acquisition unit 101. When the timing of the request to change the upper limit speed overlaps due to the change in, priority is given to the update by the driver operation acquired from the driver operation acquisition unit 102, and the upper limit speed is changed by the driver operation acquired from the driver operation acquisition unit 102. Later, for a certain period of time or a certain distance, it is possible to prevent the upper limit speed from being changed due to a change in the speed limit (marking speed limit) acquired from the speed limit acquisition unit 101.
処理P139aでは、設定車速と変化検出前設定車速との比較を行い、設定車速が更新されたことを判定する。この時、処理P136で設定車速が標識制限速度と同じ値であった場合は、設定車速の更新が行われていても、設定車速と変化検出前設定車速の値が一致し(P139a:false)、設定車速の更新無しとして扱うことで、通知時間がリセットされず、次の瞬間にドライバのスイッチ操作があれば、処理P134でドライバのスイッチ操作に応じた設定車速の更新が可能になる。
In processing P139a, the set vehicle speed is compared with the set vehicle speed before change detection, and it is determined that the set vehicle speed has been updated. At this time, if the set vehicle speed is the same value as the sign speed limit in processing P136, the set vehicle speed and the value of the set vehicle speed before change detection match even if the set vehicle speed is updated (P139a: false). By treating as no update of the set vehicle speed, the notification time is not reset, and if there is a driver switch operation at the next moment, the set vehicle speed can be updated according to the driver switch operation on process P134.
処理P139aで設定車速の更新有りと判定された場合は(P139a:true)、処理P139bへ進み、処理P132で判定に用いる通知時間を0でリセットする。続いて処理P139dに進んで、処理P134で用いる前回設定車速に変化検出前設定車速をセットし、その次に、処理P139aで用いる変化検出前設定車速に設定車速をセットする。変化検出前設定車速と、前回設定車速を分けて保持することで、設定車速の変化検出と、前回の設定車速へ戻る機能を実現することができる。処理P139aで設定車速の更新が無いと判断された場合は(P139a:false)、処理P139cへ進み、通知時間を動作周期分、例えば+10msすることで、通知時間の計測を行う。
If it is determined in process P139a that the set vehicle speed has been updated (P139a: true), the process proceeds to process P139b and the notification time used for determination in process P132 is reset to 0. Subsequently, the process proceeds to process P139d, and the set vehicle speed before change detection is set to the previously set vehicle speed used in process P134, and then the set vehicle speed is set to the set vehicle speed before change detection used in process P139a. By separately holding the set vehicle speed before change detection and the previously set vehicle speed, it is possible to realize a function of detecting a change in the set vehicle speed and returning to the previously set vehicle speed. If it is determined in process P139a that the set vehicle speed has not been updated (P139a: false), the process proceeds to process P139c, and the notification time is measured by setting the notification time for the operation cycle, for example, +10 ms.
[運転状態推定処理P140(車線変更推定部104)] 次に、処理(運転状態推定処理)P140で行う処理について、図11を用いて詳細を説明する。この運転状態推定処理P140では、運転状態を3つの状態に分割して判断する。
[Driving state estimation process P140 (lane change estimation unit 104)] Next, the process performed by the process (driving state estimation process) P140 will be described in detail with reference to FIG. In this operating state estimation process P140, the operating state is divided into three states for determination.
1つ目は車線変更無し、2つ目は車線変更中、3つ目は車線移動後とする。運転状態は処理P141で定義され、初期値として車線変更無しを指定する。次に、処理P142で、前述した制御状態決定処理P120で得た制御状態が許可であるかを判定し、許可でなければ(P142:false)、処理P149bに進み、運転状態を車線変更無しに更新して、処理P140を終了する。処理P142の判定で、制御状態が許可であれば(P142:true)、処理P143に進む。
The first is no lane change, the second is during lane change, and the third is after lane movement. The driving state is defined in process P141, and no lane change is specified as the initial value. Next, in process P142, it is determined whether the control state obtained in the above-mentioned control state determination process P120 is permitted, and if it is not permitted (P142: false), the process proceeds to process P149b and the driving state is changed without changing lanes. Update and end process P140. If the control state is permitted in the determination of process P142 (P142: true), the process proceeds to process P143.
処理P143では、運転状態が、車線変更中、または、車線移動後の状態の継続時間が規定時間以内(車線変更時間範囲内)であれば(P143:true)、成立として、処理P144に進み、規定時間を超えて経過していれば(P143:false)、処理P149aへ進む。処理P143は、車線変更を行っている時間が長すぎる場合、ウィンカーを誤って操作してウィンカーを操作しながら走ってしまっているケースや、車道外側線が汚れや積雪等の影響で検出不可能になってしまう場合等、強制的に車線変更を終了することで、速度制御機能が動作しなくなってしまうことを防ぐ目的で行われる。そのため、処理P149aに進んだ場合、運転状態を車線変更無しに更新して、処理P140を終了する。
In process P143, if the driving state is changing lanes or the duration of the state after moving lanes is within the specified time (within the lane change time range) (P143: true), the process proceeds to process P144. If the specified time has passed (P143: false), the process proceeds to P149a. Processing P143 cannot detect the case where the blinker is mistakenly operated and the blinker is operated while running when the lane change is performed for too long, or the outside line of the lane is affected by dirt or snow. This is done for the purpose of preventing the speed control function from stopping by forcibly ending the lane change. Therefore, when proceeding to the process P149a, the driving state is updated without changing the lane, and the process P140 is terminated.
次に、処理P144に進んだ場合、現在の運転状態に合わせて、判定処理の切り替えを行う。処理P144で運転状態が車線変更無しと判断された場合(P144:true)、処理P145に進んで、車線変更開始判断を行った結果を運転状態にする。処理P144で運転状態が車線変更無しでなかった場合(P144:false)、処理P146に進む。処理P146で運転状態が車線変更中と判断された場合(P146:true)、処理P147へ進み、車線変更終了判断を行った結果を運転状態にする。処理P146で運転状態が車線変更中でなかった場合(P146:false)、つまり、運転状態が車線移動後であった場合、処理P148へ進み、車線内安定判断を行った結果を運転状態にする。
Next, when proceeding to process P144, the judgment process is switched according to the current operating state. If it is determined in process P144 that the driving state is no lane change (P144: true), the process proceeds to process P145, and the result of the lane change start determination is set to the driving state. If the driving status is not changed in lane in process P144 (P144: false), the process proceeds to process P146. If it is determined in process P146 that the driving state is changing lanes (P146: true), the process proceeds to process P147, and the result of determining the end of lane change is set to the driving state. If the driving state is not changing lanes in process P146 (P146: false), that is, if the driving state is after moving to a lane, the process proceeds to process P148 and the result of making a stability judgment in the lane is set to the driving state. ..
(車線変更開始判断処理P145) また、処理P145の詳細を、図12を用いて説明する。処理P145の車線変更開始判断処理では、ドライバが車線変更を開始したことを推定する。
(Lane change start determination process P145) Further, the details of the process P145 will be described with reference to FIG. In the lane change start determination process of process P145, it is estimated that the driver has started the lane change.
処理P145aでは、自車の右方向に車線変更を開始したかを判断し、車線変更を開始したと判断した場合は(P145a:true)、処理P145bに進み、車線変更方向を右として設定する。次に、処理P145cで、運転状態戻り値として、車線変更中を設定する。処理P145aで、右車線変更開始でないと判断された場合(P145a:false)、処理P145dに進み、自車の左方向に車線変更を開始したかを判断し、車線変更を開始したと判断した場合は(P145d:true)、処理P145eに進み、車線変更方向を左として設定する。次に、処理P145fへ進み、運転状態戻り値として、車線変更中を設定する。処理P145dで、左車線変更開始でないと判断された場合(P145d:false)、処理P145gへ進み、車線変更方向を無効として設定する。次に、処理P145hへと進み、運転状態戻り値として、車線変更無しを設定する。こうして設定された運転状態戻り値を処理P145の戻り値として返し、運転状態へと設定する。
In processing P145a, it is determined whether the lane change has started to the right of the own vehicle, and if it is determined that the lane change has started (P145a: true), the process proceeds to P145b and the lane change direction is set as the right. Next, in the process P145c, the lane change is set as the driving state return value. When it is determined in process P145a that the right lane change has not started (P145a: false), proceed to process P145d, determine whether the lane change has started to the left of the own vehicle, and determine that the lane change has started. (P145d: true), proceed to processing P145e and set the lane change direction as left. Next, the process proceeds to P145f, and the lane change is set as the operating state return value. If it is determined in process P145d that the left lane change has not started (P145d: false), the process proceeds to process P145g and the lane change direction is set as invalid. Next, the process proceeds to P145h, and no lane change is set as the driving state return value. The operation state return value set in this way is returned as the return value of the process P145, and the operation state is set.
また、処理P145aの条件判定について、ステレオカメラ200を用いて外界認識を行い、自車両の右側に隣接車線が存在するか否かを判定する。更に、ドライバが右方向にウィンカーレバーを操作したことを判定する。自車両の右側に隣接車線が存在し、且つ、ウィンカーレバーを右方向に操作した時に自車の右方向に車線変更を開始したと判断する。車線の有無を条件に用いることにより、右方向への車線変更ではなく、右折を行うシーンであることを分離し、右方向への車線変更のみを抽出することができるようになる。また、ステアリング操作角やヨーレートセンサ値、横加速度センサを条件に用いる場合、車両の挙動が変化してからの判定となるため、ドライバのウィンカーレバー操作より車線変更の操作に対して判定が遅くなる。そのため、ドライバのウィンカーレバー操作を条件に用いることにより、最もドライバの車線変更意図に沿う判断を行うことができるようになる。また、処理P145dの条件判定は、処理P145aの条件判定と同様に、ステレオカメラ200を用いて外界認識を行い、自車両の左側に隣接車線が存在するか否かを判定する。更に、ドライバが左方向にウィンカーレバーを操作したことを判定し、自車両の左側に隣接車線が存在し、且つ、ウィンカーレバーを左方向に操作した時に自車の左方向に車線変更を開始したと判断する。
Also, regarding the condition determination of processing P145a, the stereo camera 200 is used to recognize the outside world, and it is determined whether or not there is an adjacent lane on the right side of the own vehicle. Further, it is determined that the driver has operated the blinker lever to the right. It is determined that there is an adjacent lane on the right side of the own vehicle and that the lane change is started to the right of the own vehicle when the blinker lever is operated to the right. By using the presence or absence of a lane as a condition, it is possible to separate the scene of making a right turn instead of changing the lane to the right and extract only the lane change to the right. In addition, when the steering operation angle, yaw rate sensor value, and lateral acceleration sensor are used as conditions, the judgment is made after the behavior of the vehicle has changed, so the judgment is slower for the lane change operation than the driver's blinker lever operation. .. Therefore, by using the driver's blinker lever operation as a condition, it becomes possible to make a judgment most in line with the driver's lane change intention. Further, in the condition determination of the processing P145d, similarly to the condition determination of the processing P145a, the stereo camera 200 is used to recognize the outside world, and it is determined whether or not there is an adjacent lane on the left side of the own vehicle. Furthermore, it was determined that the driver operated the blinker lever to the left, and there was an adjacent lane on the left side of the own vehicle, and when the blinker lever was operated to the left, the lane change to the left of the own vehicle was started. Judge.
(車線変更終了判断処理P147) また、処理P147の詳細を、図13を用いて説明する。処理P147では、車線の変更が行われたのかを判断する。
(Lane change end determination process P147) Further, the details of the process P147 will be described with reference to FIG. In process P147, it is determined whether the lane has been changed.
処理P147aでは、処理P145で判定した車線変更方向を判定し、車線変更方向が右であったか、それ以外、つまり左であったかを判別して処理を切り替える。この時、処理P145で車線変更方向が無効となるケースは、処理P145gが動作しており、必然的に処理P145hが実行されてしまうため、車線変更方向が無効である場合の判定は、処理P147で考慮する必要はない。
In the process P147a, the lane change direction determined in the process P145 is determined, and the process is switched by determining whether the lane change direction is right or other, that is, left. At this time, in the case where the lane change direction is invalid in the process P145, the process P145g is operating and the process P145h is inevitably executed. Therefore, the judgment when the lane change direction is invalid is the process P147. There is no need to consider in.
処理P147aで車線変更方向が右と判断された場合は(P147a:true)、処理P147bへ進み、車線変更を行う際に跨ぐ車両区画線を監視し、対象となる右区画線(対象右区画線)が切り替わったことを判定する。右区画線の変更があったと判定された場合は(P147b:true)、処理P147cへ進み、運転状態戻り値に車線移動後を設定する。右区画線の変更があったと判定されなかった場合は(P147b:false)、処理P147dへ進み、運転状態戻り値に車線変更中を設定する。
If the lane change direction is determined to be right in process P147a (P147a: true), proceed to process P147b, monitor the vehicle lane markings that are straddled when changing lanes, and target the right lane markings (target right lane markings). ) Has been switched. If it is determined that the right lane has been changed (P147b: true), the process proceeds to P147c, and the driving state return value is set after moving to the lane. If it is not determined that the right lane has been changed (P147b: false), proceed to process P147d and set the driving status return value to lane changing.
処理P147aで車線変更方向が右でないと判断された場合(P147a:false)、処理P147eへ進み、車線変更を行う際に跨ぐ車両区画線を監視し、対象となる左区画線(対象左区画線)が切り替わったことを判定する。左区画線の変更があったと判定された場合は(P147e:true)、処理147fへ進み、運転状態戻り値に車線移動後を設定する。左区画線の変更があったと判定されなかった場合は(P147e:false)、処理P147gへ進み、運転状態戻り値に車線変更中を設定する。こうして決定された運転状態戻り値を処理P147の戻り値として返し、運転状態へ設定する。
If it is determined in process P147a that the lane change direction is not right (P147a: false), proceed to process P147e, monitor the vehicle lane markings that are straddled when changing lanes, and target the left lane marking (target left lane marking). ) Has been switched. If it is determined that the left lane has been changed (P147e: true), proceed to process 147f and set the driving state return value after moving to the lane. If it is not determined that the left lane has been changed (P147e: false), proceed to processing P147g and set the driving status return value to lane changing. The operating state return value determined in this way is returned as the return value of the process P147 and set to the operating state.
この時、処理P147b、及び、処理P147eで判定に用いる対象としている自車両の左右区画線について、図15の自車両及び道路の俯瞰図を用いて説明する。自車両V1に対して右区画線とは、車両先端中央、図中Pcで示す位置より右方向にあって、最も近い距離にある区画線を指す。逆に、自車両V1に対して左区画線とは、図中Pcで示す位置より左方向にあって、最も近い距離にある区画線を指す。そのため、車線変更を行う際は、車線境界線Rcの左側から図中Pcが移動し、車線境界線Rcの右側に移動した際に、自車両V1に対する右区画線は車線境界線Rcから車道外側線Rrへと変更される。また、この時、自車両V1に対する左区画線は車道外側線Rlから車線境界線Rcへと変更される。
At this time, the left and right lane markings of the own vehicle used for the determination in the processing P147b and the processing P147e will be described with reference to the bird's-eye view of the own vehicle and the road in FIG. The right lane marking with respect to the own vehicle V1 refers to the lane marking at the center of the tip of the vehicle, to the right of the position indicated by Pc in the figure, and the closest distance. On the contrary, the left lane marking with respect to the own vehicle V1 refers to the lane marking that is to the left of the position indicated by Pc in the figure and is the closest distance. Therefore, when changing lanes, Pc in the figure moves from the left side of the lane boundary line Rc, and when moving to the right side of the lane boundary line Rc, the right lane marking for the own vehicle V1 is outside the lane boundary line Rc. Changed to line Rr. At this time, the left lane marking for the own vehicle V1 is changed from the lane outer line Rl to the lane boundary line Rc.
(車線内安定判断処理P148) また、処理P148の詳細を、図14を用いて説明する。処理P148では、車線内安定判断を行い、車線変更後に、車両姿勢が安定し、車道外側線に対して、略水平に走行できているかを判断する。
(In-lane stability determination process P148) Further, the details of the process P148 will be described with reference to FIG. In the process P148, the stability in the lane is determined, and after the lane is changed, it is determined whether the vehicle posture is stable and the vehicle can travel substantially horizontally with respect to the outside lane.
処理P148aでは、処理P145で設定した車線変更方向が左右いずれかであることを確認し、車線変更方向が右であれば(P148a:true)、処理P148bへ進む。処理P148bでは、左車線との横位置(左車線横位置)が0.2mより離れているかを判断し、離れていない場合は(P148b:false)、処理P148fへ進んで、安定待ち時間をゼロでリセットする。左車線との横位置(左車線横位置)が0.2mより離れている場合は(P148b:true)、処理P148cへ進み、対車線ヨー角絶対値が5[deg]未満であるかを判断し、5[deg]以上であれば(P148c:false)、処理P148eへ進み、安定待ち時間をゼロでリセットする。対車線ヨー角絶対値が5[deg]未満であれば(P148c:true)、処理P148dへ進み、安定待ち時間に安定待ち時間+動作周期(例えば10ms)を設定し、安定待ち時間の更新を行う。
In process P148a, confirm that the lane change direction set in process P145 is either left or right, and if the lane change direction is right (P148a: true), proceed to process P148b. In processing P148b, it is determined whether the horizontal position with the left lane (horizontal position in the left lane) is more than 0.2 m, and if it is not (P148b: false), proceed to processing P148f and set the stable waiting time to zero. Reset. If the lateral position with the left lane (horizontal position of the left lane) is more than 0.2 m (P148b: true), proceed to processing P148c and determine whether the absolute yaw angle to the lane is less than 5 [deg]. , 5 [deg] or more (P148c: false), proceed to processing P148e and reset the stable waiting time to zero. If the absolute value of the yaw angle to the lane is less than 5 [deg] (P148c: true), proceed to processing P148d, set the stable waiting time + operation cycle (for example, 10ms), and update the stable waiting time. Do.
また、処理P148aで車線変更方向が右でない、つまり、左だった場合(P148a:false)、処理148gへ進む。処理P148gでは、右車線との横位置(右車線横位置)が0.2mより離れているかを判断し、離れていない場合は(P148g:false)、処理P148kへ進んで、安定待ち時間をゼロでリセットする。右車線との横位置(右車線横位置)が0.2mより離れている場合は(P148g:true)、処理P148hへ進み、対車線ヨー角絶対値が5[deg]未満であるかを判断し、5[deg]以上であれば(P148h:false)、処理P148jへ進み、安定待ち時間をゼロでリセットする。対車線ヨー角絶対値が5[deg]未満であれば(P148h:true)、処理P148iへ進み、安定待ち時間に安定待ち時間+動作周期(例えば10ms)を設定し、安定待ち時間の更新を行う。
Also, if the lane change direction is not right, that is, left (P148a: false) in processing P148a, proceed to processing 148g. In processing P148g, it is judged whether the horizontal position with the right lane (horizontal position in the right lane) is more than 0.2m, and if it is not (P148g: false), proceed to processing P148k and set the stable waiting time to zero. Reset. If the lateral position with the right lane (horizontal position of the right lane) is more than 0.2 m (P148g: true), proceed to processing P148h and determine whether the absolute yaw angle to the right lane is less than 5 [deg]. If it is 5 [deg] or more (P148h: false), proceed to processing P148j and reset the stable waiting time to zero. If the absolute value of the yaw angle to the lane is less than 5 [deg] (P148h: true), proceed to processing P148i, set the stable waiting time + operation cycle (for example, 10ms), and update the stable waiting time. Do.
以上の処理で、安定待ち時間をゼロにするか、動作周期分進めるかして更新した後、処理P148nへ進む。
With the above processing, after updating by setting the stable waiting time to zero or advancing by the operation cycle, proceed to processing P148n.
処理P148nでは、安定待ち時間が1[s]以上経過したかを判断する。安定待ち時間が1[s]以上経過した場合は(P148n:true)、処理P148mへ進み、運転状態戻り値として車線変更無しを設定し、車線変更が終了したと判断する。安定待ち時間が1[s]以上経過していない場合は(P148n:false)、処理P148pへ進み、運転状態戻り値に車線移動後(または、車線変更中)を設定し、車線内安定判断を継続して行う。こうして決定された運転状態戻り値を処理P148の戻り値として返し、運転状態へ設定する。
In processing P148n, it is determined whether the stable waiting time has passed by 1 [s] or more. If the stable waiting time elapses more than 1 [s] (P148n: true), proceed to processing P148m, set no lane change as the return value of the driving state, and judge that the lane change has been completed. If the stable waiting time has not passed 1 [s] or more (P148n: false), proceed to processing P148p, set the driving state return value after moving to the lane (or changing lanes), and judge the stability in the lane. Continue to do. The operating state return value determined in this way is returned as the return value of the process P148 and set to the operating state.
処理P148b、及び、処理P148gで用いた左右車線横位置について、図15を用いて説明する。右車線横位置とは、自車両V1の先端右端の位置から、右車線に向かう位置を示しており、図中Xrで示される。同様に、左車線横位置とは、自車両V1の先端左端の位置から、左車線に向かう位置を示しており、図中Xlで示される。
The lateral positions of the left and right lanes used in the processing P148b and the processing P148g will be described with reference to FIG. The right lane lateral position indicates a position from the position at the right end of the tip of the own vehicle V1 toward the right lane, and is indicated by Xr in the figure. Similarly, the left lane lateral position indicates a position from the position at the left end of the tip of the own vehicle V1 toward the left lane, and is indicated by Xl in the figure.
また、処理P148c、及び、処理P148hで用いる対車線ヨー角絶対値について、図15を用いて説明する。対車線ヨー角は、自車両V1の前後方向に延ばした線Lcと車線(車線境界線)Rcのヨー角である。図15では、自車両V1の前後方向に延ばした線Lcを水平に移動させた左右の線Ll、Lrのうち右側の線Lrと右車線Rcの交差する角θの値が対車線ヨー角となり、右方向をプラス、左方向をマイナスとして表す。対車線ヨー角がゼロに近づくとそれだけ自車両V1が車線に対して水平に走行していることを示す。また、対車線ヨー角絶対値は、対車線ヨー角の絶対値をとっただけの値であり、処理P148c、及び、処理P148hで車線に対して水平に走行しているかを判断したかったため、右方向、左方向を意識せず絶対値をとって、自車両V1が水平に走行できているのかを判断する。
Further, the absolute value of the yaw angle to the lane used in the processing P148c and the processing P148h will be described with reference to FIG. The anti-lane yaw angle is the yaw angle of the line Lc extending in the front-rear direction of the own vehicle V1 and the lane (lane boundary line) Rc. In FIG. 15, the value of the angle θ at which the right line Lr and the right lane Rc of the left and right lines Ll and Lr obtained by horizontally moving the line Lc extending in the front-rear direction of the own vehicle V1 is the yaw angle with respect to the lane. , The right direction is represented as plus, and the left direction is represented as minus. When the yaw angle to the lane approaches zero, it indicates that the own vehicle V1 is traveling horizontally with respect to the lane. In addition, the absolute value of the anti-lane yaw angle is just the absolute value of the anti-lane yaw angle, and we wanted to determine whether the processing P148c and the processing P148h were traveling horizontally with respect to the lane. Take the absolute value without being aware of the right and left directions, and judge whether the own vehicle V1 can run horizontally.
こうした処理により、ドライバが車線変更を開始して、車線変更後、車道に対して水平に走行し続ける状態に戻るまでの間を、運転状態の車線変更中、または、車線移動後として示すことができる。
By such processing, the period from when the driver starts changing lanes to when the driver returns to the state of continuing to drive horizontally with respect to the lane can be indicated as during lane change in the driving state or after lane movement. it can.
[許容加速度計算処理P150(速度制御部105)] 次に、処理(許容加速度計算処理)P150について、図16を用いて説明する。
[Allowable acceleration calculation process P150 (speed control unit 105)] Next, the process (allowable acceleration calculation process) P150 will be described with reference to FIG.
処理P151aでは、処理P120から得た制御状態の確認を行う。制御状態が許可でないと判定した場合(P151a:false)、処理P151bへ進み、過去設定車速として車輪速センサ300で得た自車速度を設定する。その後、処理P151cへ進み、許容加速度へ無効値(換言すれば最大値)を設定して許容加速度計算処理P150を終了することで、制御状態が許可でない場合は許容加速度が制御へ反映されないようにする。この時、処理P151bで過去設定車速に自車速度を設定することで、制御状態が許可になってすぐに車線変更を行った場合、処理P155で過去設定車速をその際の自車速度とすることができ、車速変動を抑えることができる。
In process P151a, the control status obtained from process P120 is confirmed. If it is determined that the control state is not permitted (P151a: false), the process proceeds to P151b, and the own vehicle speed obtained by the wheel speed sensor 300 is set as the past set vehicle speed. After that, the process proceeds to P151c, an invalid value (in other words, the maximum value) is set for the allowable acceleration, and the allowable acceleration calculation process P150 is terminated so that the allowable acceleration is not reflected in the control when the control state is not permitted. To do. At this time, if the vehicle speed is set to the past set vehicle speed in the process P151b and the lane is changed immediately after the control state is permitted, the past set vehicle speed is set as the own vehicle speed in the process P155. It is possible to suppress fluctuations in vehicle speed.
処理P151aで制御状態が許可であると判断した場合(P151a:true)、処理P152aへ進む。
処理P152aでは、処理P130から得た設定車速の変化を判定する。設定車速の変化を検出した場合は(P152a:true)、処理P152bへ進み、待ち時間(後述する遅延時間に対応)を1[s]でリセットする。設定車速の変化が無かった場合は(P152a:false)、処理P152cへ進み、待ち時間に待ち時間-動作周期(例えば10ms)の値を設定することで、待ち時間を動作周期分減らしていく。この時、下限をゼロとするため、処理P152cでは、0と待ち時間-動作周期の値のうち、大きい方の値を待ち時間として設定する。処理P152b、または、処理P152cの次に、処理P152dを行う。 If it is determined in process P151a that the control state is permitted (P151a: true), the process proceeds to process P152a.
The process P152a determines the change in the set vehicle speed obtained from the process P130. When a change in the set vehicle speed is detected (P152a: true), the process proceeds to P152b and the waiting time (corresponding to the delay time described later) is reset with 1 [s]. If there is no change in the set vehicle speed (P152a: false), the process proceeds to P152c, and the waiting time is reduced by the operating cycle by setting the value of waiting time-operation cycle (for example, 10ms) in the waiting time. At this time, in order to set the lower limit to zero, in the process P152c, the larger value of 0 and the waiting time-operation cycle value is set as the waiting time. Processing P152b or processing P152c is followed by processing P152d.
処理P152aでは、処理P130から得た設定車速の変化を判定する。設定車速の変化を検出した場合は(P152a:true)、処理P152bへ進み、待ち時間(後述する遅延時間に対応)を1[s]でリセットする。設定車速の変化が無かった場合は(P152a:false)、処理P152cへ進み、待ち時間に待ち時間-動作周期(例えば10ms)の値を設定することで、待ち時間を動作周期分減らしていく。この時、下限をゼロとするため、処理P152cでは、0と待ち時間-動作周期の値のうち、大きい方の値を待ち時間として設定する。処理P152b、または、処理P152cの次に、処理P152dを行う。 If it is determined in process P151a that the control state is permitted (P151a: true), the process proceeds to process P152a.
The process P152a determines the change in the set vehicle speed obtained from the process P130. When a change in the set vehicle speed is detected (P152a: true), the process proceeds to P152b and the waiting time (corresponding to the delay time described later) is reset with 1 [s]. If there is no change in the set vehicle speed (P152a: false), the process proceeds to P152c, and the waiting time is reduced by the operating cycle by setting the value of waiting time-operation cycle (for example, 10ms) in the waiting time. At this time, in order to set the lower limit to zero, in the process P152c, the larger value of 0 and the waiting time-operation cycle value is set as the waiting time. Processing P152b or processing P152c is followed by processing P152d.
処理P152dでは、処理P152aの判定で設定車速が変化したことを検出するための変化検出用設定車速に設定車速を設定する。次に、処理P154へ進み、処理P140で得た運転状態が「車線変更無し」と不一致であること、つまり、車線変更中であることを判定する。運転状態が車線変更中であると判断した場合は(P154:true)、処理P155へ進み、制御用設定車速に過去設定車速を設定する。これにより、速度制御部105は、車線変更操作中と判定している場合(期間)は、自車両の走行速度を、車線変更操作開始と判断される前の設定車速(上限速度)以下となるように制御することで、車線変更操作中にドライバの意図しない車速変動(走行速度の変化)を抑止する。一方、運転状態が車線変更無しであると判断した場合は(P154:false)、処理P156へ進む。
In the process P152d, the set vehicle speed is set as the set vehicle speed for change detection for detecting that the set vehicle speed has changed in the judgment of the process P152a. Next, the process proceeds to process P154, and it is determined that the driving state obtained in process P140 does not match "no lane change", that is, the lane is being changed. If it is determined that the driving state is changing lanes (P154: true), the process proceeds to P155, and the previously set vehicle speed is set as the control set vehicle speed. As a result, when the speed control unit 105 determines that the lane change operation is in progress (period), the traveling speed of the own vehicle becomes equal to or less than the set vehicle speed (upper limit speed) before the determination that the lane change operation is started. By controlling the vehicle in this way, unintended vehicle speed fluctuations (changes in traveling speed) of the driver are suppressed during the lane change operation. On the other hand, if it is determined that the driving state has not changed lanes (P154: false), the process proceeds to P156.
処理P156では、処理P152b、処理P152cで更新した待ち時間を判定し、待ち時間がゼロであること、つまり、待ち時間が無いことを判定する。待ち時間が無ければ(P156:true)、処理P157へ進んで、過去設定車速に設定車速を設定して処理P158aへ進み、制御用設定車速として設定車速を設定する。待ち時間が残っている場合は(P156:false)、処理P157および処理P158aを行わずに処理P158bへ進み、制御用設定車速を更新せず、設定車速の変化を適用しない。
In the process P156, the waiting time updated by the process P152b and the process P152c is determined, and it is determined that the waiting time is zero, that is, there is no waiting time. If there is no waiting time (P156: true), the process proceeds to P157, the set vehicle speed is set to the past set vehicle speed, the process proceeds to P158a, and the set vehicle speed is set as the control set vehicle speed. If the waiting time remains (P156: false), the process proceeds to the process P158b without performing the process P157 and the process P158a, the set vehicle speed for control is not updated, and the change in the set vehicle speed is not applied.
つまり、前述の処理P156、P158bにより、運転状態が車線変更無しである(車線変更操作中でない)場合で、待ち時間(本例では、最大で1[s])が残っている場合は、制御用設定車速を更新しないため、この場合は、設定車速更新による車速変動のタイミング(設定車速更新の適用タイミング)が後述するドライバへの設定車速(上限速度)の通知のタイミング(換言すれば、制限車速の取得タイミングもしくは上限速度(設定車速)の設定タイミング)よりも、待ち時間として設定される1[s]以上遅れる可能性がある。
That is, according to the above-mentioned processes P156 and P158b, when the driving state is no lane change (the lane change operation is not in progress) and the waiting time (in this example, the maximum is 1 [s]) remains, the control is performed. Since the set vehicle speed is not updated, in this case, the timing of the vehicle speed fluctuation due to the set vehicle speed update (the application timing of the set vehicle speed update) is the timing of notification of the set vehicle speed (upper limit speed) to the driver described later (in other words, the limit). There is a possibility that it will be delayed by 1 [s] or more, which is set as the waiting time, from the acquisition timing of the vehicle speed or the setting timing of the upper limit speed (set vehicle speed).
また、前述の処理P152a~P158bにより、速度制御部105は、設定車速(上限速度)が変更された後、自車両が(待ち時間に相当する)一定の距離または一定の時間を走行するタイミング、あるいはその両方に応じて設定されるタイミングまで、自車両の走行速度を、設定車速(上限速度)が変更される前の設定車速(上限速度)以下となるように制御することになる。
Further, according to the above-mentioned processes P152a to P158b, the speed control unit 105 determines the timing at which the own vehicle travels a certain distance (corresponding to the waiting time) or a certain time after the set vehicle speed (upper limit speed) is changed. Alternatively, the traveling speed of the own vehicle is controlled to be equal to or less than the set vehicle speed (upper limit speed) before the set vehicle speed (upper limit speed) is changed until the timing set according to both of them.
処理P155、処理P158a、処理P158bにおいて制御用設定車速を設定したら、処理P159へ進み、設定された制御用設定車速と車輪速センサ300から得た自車速度をマップ関数へ入力することで、許容加速度を得る。この時にマップ関数で用いるマップ値は、制御用設定車速と自車速度の組み合わせにより、どれくらいの許容加速度とするかを机上、及び実験等で算出し、定数マップとしてあらかじめ設定しておく。
After setting the control set vehicle speed in process P155, process P158a, and process P158b, proceed to process P159 and input the set control set vehicle speed and the own vehicle speed obtained from the wheel speed sensor 300 into the map function. Get acceleration. At this time, the map value used in the map function is set in advance as a constant map by calculating the allowable acceleration on the desk or in an experiment by combining the set vehicle speed for control and the own vehicle speed.
このような構成とすることで、車線変更を行っている最中は過去設定車速が更新されず、車線変更を行う1[s]前の設定車速に基づいて許容加速度の計算を行うことができるようになるため、車線変更操作中に許容加速度の計算の基となる設定車速が変化してしまうことによる車速変動が起こらず、ドライバはスムーズな車線変更を行うことが可能となる。
With such a configuration, the previously set vehicle speed is not updated during the lane change, and the allowable acceleration can be calculated based on the set vehicle speed 1 [s] before the lane change. Therefore, the vehicle speed does not fluctuate due to a change in the set vehicle speed, which is the basis for calculating the allowable acceleration, during the lane change operation, and the driver can smoothly change lanes.
また、車線変更の1[s]以上前のタイミングで設定車速を変更していた場合、過去設定車速が既に設定車速として更新されており、ドライバに設定車速の変更を十分に通知してからの車速変動となるため、ドライバに対して違和感を生むことない。また、設定車速の変化を認知していても車線変更中の車速変動が煩わしいと感じるドライバであれば、車線変更を行う前にスイッチ操作等で速度制限の解除を行うための時間的な余裕をとることができる。
In addition, if the set vehicle speed is changed at a timing 1 [s] or more before the lane change, the previously set vehicle speed has already been updated as the set vehicle speed, and the driver is fully notified of the change in the set vehicle speed. Since the vehicle speed fluctuates, there is no sense of discomfort for the driver. Also, if the driver feels that the change in vehicle speed during lane change is troublesome even if he / she is aware of the change in the set vehicle speed, he / she has enough time to release the speed limit by operating a switch before changing lanes. Can be taken.
また、設定車速が変化してから、許容加速度の反映までに、必ず1[s]以上の待ち時間(換言すれば、遅延時間)が発生する。そのため、ドライバは待ち時間の経過中に設定車速をスイッチ操作で更新することができる。設定車速の変化が許容加速度に適用されるまでに時間的余裕ができるので、ドライバの意図していない設定車速に基づいた加減速の発生を抑止できる。
In addition, a waiting time of 1 [s] or more (in other words, a delay time) always occurs from the change of the set vehicle speed to the reflection of the allowable acceleration. Therefore, the driver can update the set vehicle speed by operating the switch while the waiting time has elapsed. Since there is a time margin before the change in the set vehicle speed is applied to the allowable acceleration, it is possible to suppress the occurrence of acceleration / deceleration based on the set vehicle speed not intended by the driver.
[許容加速度送信処理P160(速度制御部105)、設定車速送信処理P170(上限速度通知部106)] 最後に、処理(許容加速度送信処理)P160で、処理P150の許容加速度計算処理で得た許容加速度をエンジンコントロールユニット500へ送信する。
[Allowable acceleration transmission process P160 (speed control unit 105), set vehicle speed transmission process P170 (upper limit speed notification unit 106)] Finally, in the process (allowable acceleration transmission process) P160, the allowable acceleration obtained by the allowable acceleration calculation process of process P150 The acceleration is transmitted to the engine control unit 500.
エンジンコントロールユニット500は、前述したように、許容加速度と、アクセルペダル開度センサ550より得たドライバによるアクセルペダル開度から計算したドライバ要求車両加速度を比較してエンジン510の出力を制御することで、自車両の加速度(つまり、走行速度)を制御する。
As described above, the engine control unit 500 controls the output of the engine 510 by comparing the allowable acceleration with the driver-required vehicle acceleration calculated from the accelerator pedal opening by the driver obtained from the accelerator pedal opening sensor 550. , Control the acceleration (that is, running speed) of the own vehicle.
また、処理(設定車速送信処理)P170で、処理P130で得た設定車速(上限速度)をメータコントロールユニット600へ送信する。
Also, in the process (set vehicle speed transmission process) P170, the set vehicle speed (upper limit speed) obtained in the process P130 is transmitted to the meter control unit 600.
メータコントロールユニット600は、設定車速が送信されると(換言すれば、設定車速が送信されたタイミングで)、ブザー620を用いた音声によるドライバへの警告や、表示装置610を用いた表示によるドライバへの通知などを行い、その設定車速をドライバへ即座に通知する。
When the set vehicle speed is transmitted (in other words, at the timing when the set vehicle speed is transmitted), the meter control unit 600 warns the driver by voice using the buzzer 620 and the driver by displaying using the display device 610. The driver is immediately notified of the set vehicle speed.
この場合、前述したように、設定車速更新による車速変動のタイミング(設定車速更新の適用タイミング)がドライバへの設定車速(上限速度)の通知のタイミングよりも、待ち時間として設定される1[s]以上遅れる可能性があり、上限速度通知部106は、速度制御部105が、上限速度設定部103から得た上限速度(設定車速)と異なる上限速度(設定車速)を基にして、自車両の走行速度を制御している状況下においても、上限速度設定部103で設定している上限速度(設定車速)を通知し、自車両の走行速度の制御に用いる上限速度(設定車速)と通知に用いる上限速度(設定車速)とが不一致となる場合がある。
In this case, as described above, the timing of the vehicle speed fluctuation due to the set vehicle speed update (the application timing of the set vehicle speed update) is set as the waiting time rather than the timing of notifying the driver of the set vehicle speed (upper limit speed) 1 [s. ] There is a possibility of delay, and the upper limit speed notification unit 106 is based on the upper limit speed (set vehicle speed) different from the upper limit speed (set vehicle speed) obtained by the speed control unit 105 from the upper limit speed setting unit 103. Even under the condition that the running speed of the vehicle is controlled, the upper limit speed (set vehicle speed) set by the upper limit speed setting unit 103 is notified, and the upper limit speed (set vehicle speed) used for controlling the running speed of the own vehicle is notified. The upper limit speed (set vehicle speed) used for may not match.
処理P160及び処理P170では、許容加速度、設定車速は、送信に向けて通信可能なように巡回冗長検査(CRC)の付与や分解能変換を行い、CANバスに対してデータ送信リクエストを行う。この時、メータコントロールユニット600へ送信するデータは処理P130で得た設定車速とし、処理P150で許容加速度計算に直接的に用いた制御用設定車速とは異なるようにしている。こうすることで、ステレオカメラ200での認識状況や、ドライバのスイッチ操作に対する応答の結果を処理P130で処理した設定車速としてドライバに素早く情報通知する。一方、エンジンコントロールユニット500の制御用に用いた制御用設定車速は、ドライバに通知しないながら、設定車速と変化のタイミングをずらすことで、ドライバに対する車線変更時の違和感を抑止することが可能となる。同様に、ステレオカメラ200で検出した制限速度の認識に誤検出が発生していた場合、設定車速をドライバに素早く通知した時点で、ドライバに対して誤検出の結果を通知し、ドライバはスイッチSW4(図9)を操作して、誤検出前の設定速度に戻すことや、スイッチSW1、SW2(図9)を操作して目的の設定速度に変更する。その後、制御用設定車速はドライバの更新した設定車速となり、正しい制限速度に基づいた車速の制御が可能となるため、誤検出した結果の制限速度に基づいた加減速の発生を抑止することができる。
In processing P160 and processing P170, the allowable acceleration and set vehicle speed are given a cyclic redundancy check (CRC) and resolution conversion so that communication can be performed for transmission, and a data transmission request is made to the CAN bus. At this time, the data transmitted to the meter control unit 600 is the set vehicle speed obtained in the processing P130, and is different from the control set vehicle speed directly used in the allowable acceleration calculation in the processing P150. By doing so, the recognition status of the stereo camera 200 and the result of the response to the driver's switch operation are quickly notified to the driver as the set vehicle speed processed by the processing P130. On the other hand, the set vehicle speed for control used for controlling the engine control unit 500 can be suppressed from the driver's discomfort when changing lanes by shifting the set vehicle speed and the timing of change without notifying the driver. .. Similarly, if an erroneous detection occurs in the recognition of the speed limit detected by the stereo camera 200, when the driver is quickly notified of the set vehicle speed, the driver is notified of the erroneous detection result, and the driver switches SW4. Operate (Fig. 9) to return to the set speed before false detection, or operate switches SW1 and SW2 (Fig. 9) to change to the desired set speed. After that, the set vehicle speed for control becomes the set vehicle speed updated by the driver, and the vehicle speed can be controlled based on the correct speed limit. Therefore, it is possible to suppress the occurrence of acceleration / deceleration based on the speed limit as a result of erroneous detection. ..
<実施例1の具体例> 次に、本実施例1の車両用速度制御装置100を適用した場合の具体例について説明する。
<Specific Example of Example 1> Next, a specific example when the vehicle speed control device 100 of the first embodiment is applied will be described.
車両が車線変更を行う走行シーンの例を俯瞰図として図17に示す。図17は、S1のタイミングから、S2、S3のタイミングへとシーンが移り変わっている。S1のシーンは、自車両V1がPos1に到達してから、自車両V1のドライバは右ウィンカーレバーを操作し、右のターンランプを作動させている。同時に、Pos1に到達したタイミングで、自車両V1は速度標識TS1を認識する。その次に、S2のシーンでは、Pos2の位置で操舵を行い、区画線を跨いでいる。次に、S3のシーンでは、Pos3の位置で自車両V1の向きを区画線に対して平行にしている。更に、自車両V1の周辺には、自車両V1より速度の遅い先行車両V25と、自車両V1と同程度の速度である後側方車両V20と、自車両V1と同程度の速度である前側方車両V21が存在している。また、Pos2の位置に速度標識TS1が存在する。速度標識TS1では80[km/h]が示されており、Pos2に到達するまでは、制限速度として100km/hが適用されており、Pos2以降の道路では80[km/h]が指定されている。
FIG. 17 shows an example of a driving scene in which the vehicle changes lanes as a bird's-eye view. In FIG. 17, the scene changes from the timing of S1 to the timing of S2 and S3. In the S1 scene, after the vehicle V1 reaches Pos1, the driver of the vehicle V1 operates the right turn signal lever to operate the right turn signal. At the same time, when Pos1 is reached, the own vehicle V1 recognizes the speed sign TS1. Next, in the S2 scene, he steers at the Pos2 position and straddles the lane markings. Next, in the S3 scene, the direction of the own vehicle V1 is parallel to the lane marking at the position of Pos3. Furthermore, in the vicinity of the own vehicle V1, the preceding vehicle V25, which is slower than the own vehicle V1, the rear side vehicle V20, which is about the same speed as the own vehicle V1, and the front side, which is about the same speed as the own vehicle V1. There is a vehicle V21. In addition, there is a speed indicator TS1 at the position of Pos2. The speed sign TS1 indicates 80 [km / h], and 100km / h is applied as the speed limit until Pos2 is reached, and 80 [km / h] is specified for roads after Pos2. There is.
この時、本実施例を適用していない場合の1の例として、制限速度を通知するタイミングをPos1通過時とし、Pos3通過時に制限速度の変化を自車両V1の制御に適用するケースでは、Pos1のタイミングで制限速度変更を通知されるが、自車両V1の速度変化がPos3に到達するタイミングとなる。また、普段は速度標識TS1を認識した直後に速度変化が起こるため、自車両V1のドライバは、Pos1のタイミングで自車両V1の速度変化がおこらないことに違和を感じることがある。
At this time, as an example of 1 when this embodiment is not applied, in the case where the timing of notifying the speed limit is when passing Pos1 and the change in speed limit is applied to the control of the own vehicle V1 when passing Pos3, Pos1 You will be notified of the speed limit change at the timing of, but it will be the timing when the speed change of your vehicle V1 reaches Pos3. In addition, since the speed change usually occurs immediately after recognizing the speed sign TS1, the driver of the own vehicle V1 may feel uncomfortable that the speed change of the own vehicle V1 does not occur at the timing of Pos1.
また、本実施例を適用していない場合の2の例として、制限速度を通知するタイミングと速度変化のタイミングを合わせるために、制限速度を通知するタイミングと速度変化のタイミングを共にPos3通過時とする場合がある。この場合、Pos3でドライバに制限速度の変化を通知したタイミングでは自車両V1はPos2を通り越しており、速度標識TS1をドライバが改めて認知するタイミングが無い。更に、車線変更を行うPos1からPos3の区間では、先行車両V25や前側方車両V21と、自車両V1の車間間隔が接近しすぎたりしないようにドライバは注意を先行車両V25や前側方車両V21に向けており、速度標識TS1の認知が疎かになる。そのため、自車両V1のドライバは、Pos3のタイミングでは制限速度の変化をシステムの異常や外界認識センサの誤認識と誤って制限速度を100km/hに戻してしまうような懸念がある。
In addition, as a second example when this embodiment is not applied, in order to match the timing of notifying the speed limit and the timing of speed change, both the timing of notifying the speed limit and the timing of speed change are set when passing Pos3. May be done. In this case, the own vehicle V1 has passed Pos2 at the timing when the driver is notified of the change in the speed limit by Pos3, and there is no timing for the driver to recognize the speed indicator TS1 again. Furthermore, in the section from Pos1 to Pos3 where the lane is changed, the driver should pay attention to the preceding vehicle V25 and the front side vehicle V21 so that the distance between the preceding vehicle V25 and the front side vehicle V21 and the own vehicle V1 does not become too close. It is aimed, and the recognition of the speed sign TS1 becomes sparse. Therefore, there is a concern that the driver of the own vehicle V1 may mistakenly return the speed limit to 100km / h at the timing of Pos3 due to a system abnormality or a false recognition of the outside world recognition sensor.
一方、本実施例を適用した場合、Pos1を通過したタイミングでドライバに設定車速の通知が行われ、ドライバは速度標識TS1と照らし合わせることで自車両V1の制限速度変化の正しさを認知することができる。更に、普段から制限速度の変化が発生して、一定期間の走行、または、一定距離の走行によって自車両V1の速度変化が起こる挙動に慣れているため、Pos1のタイミングで通知が行われた後、Pos3のタイミング(車線変更操作終了と判断されるタイミング)で速度変化が発生しても、ドライバに与える違和感は軽減、及び、抑止されることになる。
On the other hand, when this embodiment is applied, the driver is notified of the set vehicle speed at the timing of passing Pos1, and the driver recognizes the correctness of the speed limit change of the own vehicle V1 by comparing it with the speed sign TS1. Can be done. Furthermore, since we are accustomed to the behavior that the speed limit changes normally and the speed change of the own vehicle V1 occurs by running for a certain period of time or running a certain distance, after the notification is given at the timing of Pos1 , Even if the speed change occurs at the timing of Pos3 (the timing when it is judged that the lane change operation is completed), the discomfort given to the driver will be reduced and suppressed.
以上で説明したように、本実施例の車両用速度制御装置100は、上限速度通知部106が、制限速度取得部101で自車両が走行する道路に規定された制限速度を取得するタイミングもしくは上限速度設定部103で制限速度に応じて自車両に適用する上限速度を設定するタイミングで(即座に)、上限速度設定部103で設定している上限速度(設定車速)をドライバに対して通知するとともに、速度制御部105が、上限速度通知部106で上限速度(設定車速)をドライバに対して通知するタイミングから遅れたタイミングで、上限速度(の更新)を自車両の走行速度の制御に適用する。
As described above, in the vehicle speed control device 100 of the present embodiment, the upper limit speed notification unit 106 acquires the speed limit specified for the road on which the own vehicle travels by the speed limit acquisition unit 101, or the upper limit. At the timing (immediately) of setting the upper limit speed to be applied to the own vehicle according to the speed limit in the speed setting unit 103, the driver is notified of the upper limit speed (set vehicle speed) set in the upper limit speed setting unit 103. At the same time, the speed control unit 105 applies the upper limit speed (update) to the control of the running speed of the own vehicle at a timing delayed from the timing when the upper limit speed notification unit 106 notifies the driver of the upper limit speed (set vehicle speed). To do.
この場合、上限速度通知部106は、速度制御部105が、上限速度設定部103から得た上限速度(設定車速)と異なる上限速度(設定車速)を基にして、自車両の走行速度を制御している状況下においても、上限速度設定部103で設定している上限速度(設定車速)を通知し、自車両の走行速度の制御に用いる上限速度(設定車速)と通知に用いる上限速度(設定車速)を不一致とする。
In this case, the upper limit speed notification unit 106 controls the traveling speed of the own vehicle based on the upper limit speed (set vehicle speed) different from the upper limit speed (set vehicle speed) obtained from the upper limit speed setting unit 103 by the speed control unit 105. Even under such circumstances, the upper limit speed (set vehicle speed) set by the upper limit speed setting unit 103 is notified, and the upper limit speed (set vehicle speed) used for controlling the running speed of the own vehicle and the upper limit speed used for notification (set vehicle speed). The set vehicle speed) does not match.
また、この場合、速度制御部105は、上限速度設定部103から得た上限速度(設定車速)が変更された後、自車両が一定の距離または一定の時間の少なくとも一方を走行するタイミング(待ち時間に相当するタイミング)まで、自車両の走行速度を、上限速度(設定車速)が変更される前の上限速度(設定車速)以下となるように制御する。
Further, in this case, the speed control unit 105 has a timing (waiting) in which the own vehicle travels at least one of a certain distance or a certain time after the upper limit speed (set vehicle speed) obtained from the upper limit speed setting unit 103 is changed. Until the timing corresponding to the time), the traveling speed of the own vehicle is controlled so as to be equal to or less than the upper limit speed (set vehicle speed) before the upper limit speed (set vehicle speed) is changed.
すなわち、本実施例の車両用速度制御装置100は、自車両の走行する道路に規定されている制限速度をステレオカメラ200により取得し、制限速度(または、その制限速度に応じてドライバのスイッチ操作等を介して設定される上限速度)を自車両の上限速度として自動的に設定することで、ドライバが制限速度を超えるようなアクセルペダルの踏み込みを行ったとしても車両の駆動力を制限する機能(スピードリミッタ機能)を持ち、道路の制限速度が変化するタイミング(つまり、制限速度を取得したタイミング)とドライバに対して現在の制限速度(詳しくは、上限速度)を通知するタイミングを合わせつつ、車線変更操作時等に限らず制限速度(詳しくは、上限速度)の通知から遅れたタイミングで上限速度の変更を速度制御に適用する。また、例えば、車線変更操作中の上限速度変更を抑止し、車線変更操作終了後に上限速度変更を速度制御に適用する。
That is, the vehicle speed control device 100 of the present embodiment acquires the speed limit defined on the road on which the own vehicle travels by the stereo camera 200, and operates the driver's switch according to the speed limit (or the speed limit). By automatically setting the upper limit speed of the own vehicle as the upper limit speed of the own vehicle, even if the driver depresses the accelerator pedal so as to exceed the speed limit, the driving force of the vehicle is limited. It has a (speed limiter function), and while matching the timing when the speed limit of the road changes (that is, the timing when the speed limit is acquired) and the timing when the driver is notified of the current speed limit (specifically, the upper limit speed). The change of the upper limit speed is applied to the speed control at the timing delayed from the notification of the speed limit (specifically, the upper limit speed) not only when the lane change operation is performed. Further, for example, the upper limit speed change during the lane change operation is suppressed, and the upper limit speed change is applied to the speed control after the lane change operation is completed.
これにより、本実施例によれば、自動的に制限速度が自車両の上限速度として設定されることによって、見落としや誤解で制限速度を超過した走行の発生をドライバの煩わしい操作を行わずに抑止しつつ、例えば車線変更時にドライバの意図しない速度変動を抑止できる。この時、車線変更の有無等にかかわらず上限速度の変更から自車速度の変化につながるまでの時間(遅延時間)があることで、車線変更時等に上限速度の変更から自車速度の変化までに時間的差があったとしても、ドライバに対する違和感が軽減される。
As a result, according to this embodiment, the speed limit is automatically set as the upper limit speed of the own vehicle, so that the occurrence of traveling exceeding the speed limit due to oversight or misunderstanding is suppressed without troublesome operation by the driver. At the same time, for example, when changing lanes, it is possible to suppress unintended speed fluctuations by the driver. At this time, there is a time (delay time) from the change of the upper limit speed to the change of the own vehicle speed regardless of the presence or absence of the lane change, so that the change of the own vehicle speed from the change of the upper limit speed when the lane is changed etc. Even if there is a time lag before, the discomfort to the driver is reduced.
以下、上記実施例1の変形例について説明する。
Hereinafter, a modified example of the above-mentioned Example 1 will be described.
<変形例1> 上記実施例1では、ステレオカメラ200で道路標識を読み取って制限速度を得る構成としたが、GPSと地図情報を連携させる、または、路車間通信を用いて自車両が走行する道路の制限速度を得る等して、道路に規定された制限速度を取得する制限速度取得部101を置き換えることも可能である。
<Modification 1> In the first embodiment, the speed limit is obtained by reading the road sign with the stereo camera 200, but the own vehicle travels by linking GPS and map information or by using road-to-vehicle communication. It is also possible to replace the speed limit acquisition unit 101 that acquires the speed limit specified for the road, such as by obtaining the speed limit of the road.
<変形例2> また、図9で示したステアリングに設定されたスイッチ(スピードリミッタコントロールスイッチ700)を操作する代わりに、音声認識による操作を行う場合や、ステアリング以外の場所にスイッチを配置する場合、ACCやLKSなど車両制御アプリケーション向けにステアリングに設定されたスイッチと車速制御機能に用いるためのスイッチを共有する場合、ステアリングにスイッチを付けず、タッチパネル、圧力センサ、振動センサなどのセンサを用いてドライバの操作を受け付ける場合もあり、このようなドライバ操作によって自車両に適用する制限速度を変更する要求等を取得する場合もある。
<Modification 2> Also, when operating by voice recognition instead of operating the switch (speed limiter control switch 700) set for the steering shown in FIG. 9, or when arranging the switch in a place other than the steering. When sharing a switch set on the steering wheel for vehicle control applications such as ACC and LKS and a switch for use in the vehicle speed control function, do not attach a switch to the steering wheel and use sensors such as a touch panel, pressure sensor, and vibration sensor. In some cases, the driver's operation is accepted, and in some cases, a request for changing the speed limit applied to the own vehicle is obtained by such driver operation.
<変形例3> 上記実施例1においては、処理P114(図7)の条件の例として、「標識情報[M]の位置関係が自車に対して有効であるか、例えば、自車が道路標識の50m手前を通り過ぎている。」としたが、この条件を、現在設定している制限速度より、標識情報[M]の制限速度が低い場合は、その速度の差に応じて遠い距離から自車に対して有効とし、現在設定している制限速度より、標識情報[M]の制限速度が高い場合は、自車が標識の横を通り過ぎていた場合に有効とすることもできる。
<Modification 3> In the first embodiment, as an example of the condition of the process P114 (FIG. 7), "whether the positional relationship of the sign information [M] is valid for the own vehicle, for example, the own vehicle is on the road. "You have passed 50m before the sign." However, if the speed limit of the sign information [M] is lower than the currently set speed limit, from a long distance according to the difference in speed. It is valid for the own vehicle, and if the speed limit of the sign information [M] is higher than the currently set speed limit, it can be valid when the own vehicle has passed the side of the sign.
現在設定している制限速度が標識で示した制限速度より低いか高いかに依らず、標識の横を通り過ぎている場合にのみ有効とする場合は、自車が標識の位置に到達する前に右左折を行ってしまい、制限速度の変更が不要となるケースが無いというメリットがある。一方、現在設定している制限速度が標識で示した制限速度より低いか高いかに依って有効となるタイミングを切り替える場合、低い制限速度の道路に進入する前に、自車両の速度を制限速度まで下げることができるというメリットがある。また、ナビに入力した自車両の走行計画情報や、右左折を行うような可能性のある道路であるかをカメラやGPSと地図情報をマッチングした結果により検知し、市街地路のように右左折を行う可能性が高い道路では標識の横を通り過ぎた時に標識情報を有効とし、高速道路のように右左折の可能性が低い道路では標識の横を通り過ぎる前から標識情報を有効とすることも可能である。
Regardless of whether the speed limit currently set is lower or higher than the speed limit indicated by the sign, if it is valid only when passing by the sign, it is right before the vehicle reaches the position of the sign. There is an advantage that there is no case where you make a left turn and you do not need to change the speed limit. On the other hand, when switching the effective timing depending on whether the speed limit currently set is lower or higher than the speed limit indicated by the sign, the speed of the own vehicle is increased to the speed limit before entering the road with the lower speed limit. There is a merit that it can be lowered. In addition, the driving plan information of the own vehicle entered in the navigation and the result of matching the map information with the camera or GPS to detect whether the road is likely to turn left or right are detected, and the road turns left or right like an urban road. On roads where there is a high possibility of turning, the sign information will be valid when passing by the sign, and on roads where there is a low possibility of turning left or right, such as highways, the sign information may be valid even before passing by the sign. It is possible.
更に、標識の横を通り過ぎる前から標識情報を有効とする場合、標識との距離に応じて処理P159(図16)で算出する許容加速度を大きな値とすることにより、標識の手前からの減速力を弱め、乗り心地を良くすることもできる。
Further, when the sign information is valid before passing by the sign, the deceleration force from the front of the sign is set to a large value by setting the allowable acceleration calculated in the process P159 (FIG. 16) according to the distance from the sign. It can also weaken and improve the ride comfort.
<変形例4> 上記実施例1に示した構成に対して、処理(運転状態推定処理)P140は以下のように変更を行うことができる。
<Modification Example 4> The process (operating state estimation process) P140 can be changed as follows with respect to the configuration shown in the first embodiment.
<変形例4-1> 処理P145a(図12)では、判定条件を「自車両の右側に隣接車線が存在し、且つ、ウィンカーレバーを右方向に操作した時に自車両の右方向に車線変更を開始したと判断する。」としているが、この判定条件を、「自車両の右側に隣接車線が存在し、且つ、ウィンカーレバーを右方向に操作した、且つ、自車両の右側の隣接車線上に車両が検出されている時に自車両の右方向に車線変更を開始したと判断する。」と変更することができる。この時、自車両の右側の隣接車線上の走行車両は、自車両の前方、側方、後側方を監視するカメラ、レーダー、ソナー等から取得する。また、処理P145d(図12)も同様に、判定条件を「自車両の左側に隣接車線が存在し、且つ、ウィンカーレバーを左方向に操作した時に自車両の左方向に車線変更を開始したと判断する。」としているが、この判定条件を、「自車両の左側に隣接車線が存在し、且つ、ウィンカーレバーを左方向に操作した、且つ、自車両の左側の隣接車線上に車両が検出されている時に自車両の左方向に車線変更を開始したと判断する。」と変更し、自車両の左側の隣接車線上の車両は、自車両の前方、側方、後側方を監視するカメラ、レーダー、ソナー等から取得する。
<Modification 4-1> In processing P145a (Fig. 12), the judgment condition is "There is an adjacent lane on the right side of the own vehicle, and when the winker lever is operated to the right, the lane is changed to the right of the own vehicle. "It is judged that the vehicle has started." However, this judgment condition is set to "there is an adjacent lane on the right side of the own vehicle, the blinker lever is operated to the right, and the vehicle is on the adjacent lane on the right side of the own vehicle." When the vehicle is detected, it is determined that the lane change has started to the right of the own vehicle. " At this time, the traveling vehicle on the adjacent lane on the right side of the own vehicle is acquired from a camera, radar, sonar, etc. that monitors the front, side, and rear sides of the own vehicle. Similarly, in the processing P145d (FIG. 12), the judgment condition is that "there is an adjacent lane on the left side of the own vehicle and the lane change is started to the left of the own vehicle when the blinker lever is operated to the left". "Judgment is made." However, this judgment condition is that "there is an adjacent lane on the left side of the own vehicle, the blinker lever is operated to the left, and the vehicle is detected on the adjacent lane on the left side of the own vehicle." It is judged that the lane change has started to the left of the own vehicle when it is being done. ”The vehicle on the adjacent lane on the left side of the own vehicle monitors the front, side, and rear side of the own vehicle. Obtained from cameras, radars, sonars, etc.
この変更を行うことで、道路に適用されている制限速度の変化を自車両に速やかに適用し、加速または減速を行うことができるようになる。一方、この状況下では、ドライバが車線変更を行う際、周辺車両が存在しないため、速度標識を見落とすリスクが低下し、ドライバが自車両に対しての制限速度変化を認識し、車線変更を行う際に速度変化を起こしても違和感の発生は少ない。よって、ドライバが速度標識を見落とすリスクが高い周辺車両との間隔を保ちながらの車線変更シーンでのみ、制限速度の適用を遅延させることができる。更に、本変形例の判定条件をドライバが運転時に有効にするか無効にするかを選択できる機構を設けることで、周辺車両が存在するか否かにかかわらず車線変更操作中の速度変化を行わない条件と切り替えできるようになり、ドライバの違和感の感度に合わせた速度制御が可能となる。
By making this change, it will be possible to quickly apply the change in the speed limit applied to the road to the own vehicle and accelerate or decelerate. On the other hand, in this situation, when the driver changes lanes, the risk of overlooking the speed sign is reduced because there are no surrounding vehicles, and the driver recognizes the speed limit change with respect to the own vehicle and changes lanes. Even if the speed changes at that time, there is little discomfort. Therefore, the application of the speed limit can be delayed only in the lane change scene while maintaining the distance from the surrounding vehicle, which has a high risk of the driver overlooking the speed sign. Furthermore, by providing a mechanism that allows the driver to select whether to enable or disable the judgment condition of this modification during driving, the speed is changed during the lane change operation regardless of the presence or absence of surrounding vehicles. It becomes possible to switch to a condition that does not exist, and it becomes possible to control the speed according to the sensitivity of the driver's discomfort.
<変形例4-2> 処理P145a(図12)では、判定条件を「自車両の右側に隣接車線が存在し、且つ、ウィンカーレバーを右方向に操作した時に自車両の右方向に車線変更を開始したと判断する。」としているが、この判定条件を、「自車両の右側に隣接車線が存在し、且つ、ウィンカーレバーを右方向に操作した、且つ、ドライバが右方向を注視している時に自車両の右方向に車線変更を開始したと判断する。」と変更することができる。この時、ドライバが右方向を注視しているか否かは、ドライバの目線を監視するカメラを用いて検知する。このカメラは、ドライバの顔の向き、または、眼球の向き、もしくはドライバの顔の向きと眼球の向きの両方を監視し、ドライバが右サイドミラー等を見ており、車両前方、及び速度制御状態を通知するための表示装置を見ていないことを検知する。同様に、処理P145d
(図12)では、判定条件を「自車両の左側に隣接車線が存在し、且つ、ウィンカーレバーを左方向に操作した時に自車両の左方向に車線変更を開始したと判断する。」としているが、この条件を、「自車両の左側に隣接車線が存在し、且つ、ウィンカーレバーを左方向に操作した、且つ、ドライバが左方向を注視している時に自車両の左方向に車線変更を開始したと判断する。」と変更し、ドライバが左方向を注視しているか否かは、ドライバの目線を監視するカメラを用いて検知する。 <Modification Example 4-2> In the process P145a (Fig. 12), the judgment condition is "the lane is changed to the right of the own vehicle when the adjacent lane exists on the right side of the own vehicle and the blinker lever is operated to the right. "It is judged that the vehicle has started." However, this judgment condition is that "there is an adjacent lane on the right side of the own vehicle, the blinker lever is operated to the right, and the driver is gazing to the right." Sometimes it is determined that the lane change has started to the right of the own vehicle. " At this time, whether or not the driver is gazing to the right is detected by using a camera that monitors the driver's line of sight. This camera monitors the driver's face orientation, eyeball orientation, or both the driver's face orientation and eyeball orientation, and the driver is looking at the right side mirror, etc., in front of the vehicle, and in the speed control state. Detects that you are not looking at the display device for notifying. Similarly, processing P145d
In (FIG. 12), the determination condition is "it is determined that there is an adjacent lane on the left side of the own vehicle and the lane change is started to the left of the own vehicle when the blinker lever is operated to the left". However, this condition is changed to "when there is an adjacent lane on the left side of the own vehicle, the blinker lever is operated to the left, and the driver is gazing to the left, the lane is changed to the left of the own vehicle. It is judged that it has started. ”, And whether or not the driver is gazing to the left is detected by using a camera that monitors the driver's line of sight.
(図12)では、判定条件を「自車両の左側に隣接車線が存在し、且つ、ウィンカーレバーを左方向に操作した時に自車両の左方向に車線変更を開始したと判断する。」としているが、この条件を、「自車両の左側に隣接車線が存在し、且つ、ウィンカーレバーを左方向に操作した、且つ、ドライバが左方向を注視している時に自車両の左方向に車線変更を開始したと判断する。」と変更し、ドライバが左方向を注視しているか否かは、ドライバの目線を監視するカメラを用いて検知する。 <Modification Example 4-2> In the process P145a (Fig. 12), the judgment condition is "the lane is changed to the right of the own vehicle when the adjacent lane exists on the right side of the own vehicle and the blinker lever is operated to the right. "It is judged that the vehicle has started." However, this judgment condition is that "there is an adjacent lane on the right side of the own vehicle, the blinker lever is operated to the right, and the driver is gazing to the right." Sometimes it is determined that the lane change has started to the right of the own vehicle. " At this time, whether or not the driver is gazing to the right is detected by using a camera that monitors the driver's line of sight. This camera monitors the driver's face orientation, eyeball orientation, or both the driver's face orientation and eyeball orientation, and the driver is looking at the right side mirror, etc., in front of the vehicle, and in the speed control state. Detects that you are not looking at the display device for notifying. Similarly, processing P145d
In (FIG. 12), the determination condition is "it is determined that there is an adjacent lane on the left side of the own vehicle and the lane change is started to the left of the own vehicle when the blinker lever is operated to the left". However, this condition is changed to "when there is an adjacent lane on the left side of the own vehicle, the blinker lever is operated to the left, and the driver is gazing to the left, the lane is changed to the left of the own vehicle. It is judged that it has started. ”, And whether or not the driver is gazing to the left is detected by using a camera that monitors the driver's line of sight.
この変更を行うことで、ドライバが車両前方に設置された速度標識、及び、速度制御状態を通知するための表示装置を見て、自車両に対する制限速度の変化を認識していれば、不意の速度変動が生じず、違和感が少ない。また、道路に適用されている制限速度の変化を自車両に速やかに適用し、加速または減速を行うことができるようになる。
By making this change, if the driver sees the speed sign installed in front of the vehicle and the display device for notifying the speed control status and recognizes the change in the speed limit for the own vehicle, it is unexpected. There is no speed fluctuation and there is little discomfort. In addition, the change in the speed limit applied to the road can be quickly applied to the own vehicle to accelerate or decelerate.
更に、前述した変形例4-1と変形例4-2を組み合わせて、自車両周辺の車両の状況に応じた条件とドライバの注視位置に関する条件を同時に判定し、速度変動のタイミングを変更する構成へ変更することも可能である。
Further, by combining the above-mentioned modification 4-1 and modification 4-2, the conditions according to the situation of the vehicle around the own vehicle and the conditions regarding the driver's gaze position are simultaneously determined, and the timing of the speed fluctuation is changed. It is also possible to change to.
<変形例5> 上記実施例1においては、処理P156(図16)の条件として、待ち時間のみを用いたが、この条件を自車両の走行した距離に応じて判断する方法もある。例えば、道路標識の50[m]前で設定車速を更新し、その地点から40[m]走行したことを検知して、制御用設定車速に設定車速を設定する。この構成とすると、右左折を伴うような経路を走行する際、進入予定の無い道路について適用される制限速度を無視することができるようになる。また、この距離については、自車両の速度に応じて変化させることもある。更に、待ち時間が0となった、または、40[m]走行したことを検知したことを検出して処理P157へ進むようにするなど、条件を組み合わせて適用することもできる。
<Modification 5> In the first embodiment, only the waiting time is used as the condition of the process P156 (FIG. 16), but there is also a method of determining this condition according to the distance traveled by the own vehicle. For example, the set vehicle speed is updated 50 [m] before the road sign, it is detected that the vehicle has traveled 40 [m] from that point, and the set vehicle speed is set as the control set vehicle speed. With this configuration, when traveling on a route that involves turning left or right, the speed limit applied to roads that are not planned to be entered can be ignored. In addition, this distance may be changed according to the speed of the own vehicle. Further, it is possible to apply a combination of conditions such as detecting that the waiting time has become 0 or traveling 40 [m] and proceeding to the process P157.
<変形例6> 上記実施例1においては、処理P152b(図16)で設定する待ち時間を1[s]としたが、本パラメータはドライバのスイッチ操作猶予と自車両の減速開始猶予によって設定する。
<Modification 6> In the first embodiment, the waiting time set in the process P152b (FIG. 16) is set to 1 [s], but this parameter is set by the driver's switch operation grace and the deceleration start grace of the own vehicle. ..
ドライバのスイッチ操作猶予とは、速度標識による制限速度の変更を表示装置610によってドライバに提示してから、誤りの訂正までに必要な時間であり、待ち時間が長ければ長いほど余裕ができる。一方、自車両の減速開始猶予とは、速度標識によって制限速度が変化した道路に自車両が到達するまでに減速制御できる時間であり、待ち時間が短ければ短いほど制限速度が変化する前に減速できるため、速度超過を起こすリスクは低下する。
このドライバのスイッチ操作猶予と自車両の減速開始猶予は、トレードオフの関係にあり、ドライバがスイッチ操作で速度標識による制限速度を変更するためには少なくとも1[s]必要として、自車両の減速開始猶予期間をなるべく長く設定したため、上記実施例1では1[s]を設定している。 The driver switch operation grace is the time required from when thedisplay device 610 presents the change in the speed limit by the speed indicator to the driver until the error is corrected, and the longer the waiting time, the more margin there is. On the other hand, the deceleration start grace of the own vehicle is the time during which the deceleration can be controlled until the own vehicle reaches the road whose speed limit has changed according to the speed sign. The shorter the waiting time, the more the deceleration occurs before the speed limit changes. This reduces the risk of overspeeding.
There is a trade-off between the driver's switch operation grace period and the deceleration start grace period of the own vehicle, and the driver needs at least 1 [s] to change the speed limit by the speed sign by the switch operation, and the own vehicle decelerates. Since the start grace period is set as long as possible, 1 [s] is set in the first embodiment.
このドライバのスイッチ操作猶予と自車両の減速開始猶予は、トレードオフの関係にあり、ドライバがスイッチ操作で速度標識による制限速度を変更するためには少なくとも1[s]必要として、自車両の減速開始猶予期間をなるべく長く設定したため、上記実施例1では1[s]を設定している。 The driver switch operation grace is the time required from when the
There is a trade-off between the driver's switch operation grace period and the deceleration start grace period of the own vehicle, and the driver needs at least 1 [s] to change the speed limit by the speed sign by the switch operation, and the own vehicle decelerates. Since the start grace period is set as long as possible, 1 [s] is set in the first embodiment.
このパラメータは、例えば高齢者のように情報の提示による認知からスイッチ操作による応答までに時間のかかるようなドライバが使用する場合、ドライバのスイッチ操作猶予期間を長めに確保するため、待ち時間を1.5[s]と長めにするような変形を行う場合がある。すなわち、待ち時間(前述した遅延時間に対応)は、ドライバのスイッチ操作等の操作能力に応じて変更することができる。
This parameter has a waiting time of 1.5 to ensure a longer switch operation grace period for drivers, such as elderly people, who take a long time from recognition by presenting information to response by switch operation. It may be deformed to be longer than [s]. That is, the waiting time (corresponding to the delay time described above) can be changed according to the operation ability such as the switch operation of the driver.
また、走行時の自車両速度に応じて、低速走行時は待ち時間を1.5[s]と長めに設定し、高速走行時は待ち時間を1.0[s]と短めに設定する等、自車両の走行速度に応じて待ち時間を変化させることもできる。このような構成とすることで、制限速度が変化する位置に到達するまでに時間的猶予がある低速時と、制限速度が変化する位置に到達するまでに時間的猶予が少ない高速時で、ドライバに対してスイッチ操作猶予期間を長めに確保しつつ、自車両の減速開始猶予期間をなるべく長く設定するような変形を行うこともできる。ただし、この時、高速走行時と低速走行時で設定する待ち時間の差が大きくなりすぎると、ドライバが車両挙動の発生までのタイミングに違和を感じるようになるため、長くとも差が1[s]以内に設定するのが望ましい。
In addition, depending on the speed of the own vehicle during driving, the waiting time is set as long as 1.5 [s] when driving at low speed, and the waiting time is set as short as 1.0 [s] when driving at high speed. The waiting time can be changed according to the traveling speed. With such a configuration, the driver can be used at low speeds where there is a time grace to reach the position where the speed limit changes, and at high speeds where there is little time grace to reach the position where the speed limit changes. On the other hand, it is possible to make a modification such that the deceleration start grace period of the own vehicle is set as long as possible while ensuring a long switch operation grace period. However, at this time, if the difference in waiting time set between high-speed driving and low-speed driving becomes too large, the driver will feel uncomfortable with the timing until the vehicle behavior occurs, so the difference is 1 [s at the longest. ] It is desirable to set it within.
なお、本発明は、上述した実施形態に限られるものではない。
The present invention is not limited to the above-described embodiment.
例えば、エンジンコントロールユニット500は、電気自動車やエンジンとモータを持つハイブリッド自動車のパワートレインの構成に置き換えても、車両の速度、加速度の制御には同様の手法が適用可能となる。
For example, even if the engine control unit 500 is replaced with the power train configuration of an electric vehicle or a hybrid vehicle having an engine and a motor, the same method can be applied to control the speed and acceleration of the vehicle.
また、許容加速度を用いて通信せず、エンジントルクや駆動力、スロットル開度を車両用速度制御装置100で計算し、パワーユニットへ通信しても良い。
Alternatively, the engine torque, driving force, and throttle opening may be calculated by the vehicle speed control device 100 and communicated with the power unit without communicating using the allowable acceleration.
なお、本発明は上記した実施形態に限定されるものではなく、様々な変形形態が含まれる。例えば、上記した実施形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。また、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。
The present invention is not limited to the above-described embodiment, and includes various modified forms. For example, the above-described embodiment has been described in detail in order to explain the present invention in an easy-to-understand manner, and is not necessarily limited to the one including all the described configurations. Further, it is possible to replace a part of the configuration of one embodiment with the configuration of another embodiment, and it is also possible to add the configuration of another embodiment to the configuration of one embodiment. Further, it is possible to add / delete / replace a part of the configuration of each embodiment with another configuration.
また、上記の各構成、機能、処理部、処理手段等は、それらの一部又は全部を、例えば集積回路で設計する等によりハードウェアで実現してもよい。また、上記の各構成、機能等は、プロセッサがそれぞれの機能を実現するプログラムを解釈し、実行することによりソフトウェアで実現してもよい。各機能を実現するプログラム、テーブル、ファイル等の情報は、メモリや、ハードディスク、SSD(Solid State Drive)等の記憶装置、または、ICカード、SDカード、DVD等の記録媒体に置くことができる。
Further, each of the above configurations, functions, processing units, processing means, etc. may be realized by hardware by designing a part or all of them by, for example, an integrated circuit. Further, each of the above configurations, functions, and the like may be realized by software by the processor interpreting and executing a program that realizes each function. Information such as programs, tables, and files that realize each function can be stored in a memory, a hard disk, a storage device such as an SSD (Solid State Drive), or a recording medium such as an IC card, an SD card, or a DVD.
また、制御線や情報線は説明上必要と考えられるものを示しており、製品上必ずしも全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えてもよい。
In addition, the control lines and information lines indicate what is considered necessary for explanation, and not all control lines and information lines are necessarily shown on the product. In practice, it can be considered that almost all configurations are interconnected.
100…車両用速度制御装置、101…制限速度取得部、102…ドライバ操作取得部、103…上限速度設定部、104…車線変更推定部、105…速度制御部、106…上限速度通知部、200…ステレオカメラ、300…車輪速センサ、500…エンジンコントロールユニット、510…エンジン、550…アクセルペダル開度センサ、600…メータコントロールユニット、610…表示装置、620…ブザー、700…スピードリミッタコントロールスイッチ、1110及び1120…交通標識
100 ... Vehicle speed control device, 101 ... Speed limit acquisition unit, 102 ... Driver operation acquisition unit, 103 ... Upper limit speed setting unit, 104 ... Lane change estimation unit, 105 ... Speed control unit, 106 ... Upper limit speed notification unit, 200 ... Stereo camera, 300 ... Wheel speed sensor, 500 ... Engine control unit, 510 ... Engine, 550 ... Accelerator pedal opening sensor, 600 ... Meter control unit, 610 ... Display device, 620 ... Buzzer, 700 ... Speed limiter control switch, 1110 and 1120 ... Traffic signs
Claims (9)
- 自車両が走行する道路に規定された制限速度を取得する制限速度取得部と、
前記制限速度取得部から取得した制限速度に応じて、前記自車両の上限速度を設定する上限速度設定部と、
前記自車両の走行速度を前記上限速度設定部から得た前記上限速度以下となるように制御する速度制御部と、
前記上限速度設定部で設定している前記上限速度をドライバに対して通知する上限速度通知部と、を備え、
前記速度制御部は、前記上限速度通知部で前記上限速度を前記ドライバに対して通知するタイミングから遅れたタイミングで、前記上限速度を前記自車両の走行速度の制御に適用することを特徴とする車両用速度制御装置。 A speed limit acquisition unit that acquires the speed limit specified for the road on which the vehicle travels,
An upper limit speed setting unit that sets the upper limit speed of the own vehicle according to the speed limit acquired from the speed limit acquisition unit, and
A speed control unit that controls the traveling speed of the own vehicle so as to be equal to or less than the upper limit speed obtained from the upper limit speed setting unit.
It is provided with an upper limit speed notification unit for notifying the driver of the upper limit speed set in the upper limit speed setting unit.
The speed control unit is characterized in that the upper limit speed is applied to the control of the traveling speed of the own vehicle at a timing delayed from the timing of notifying the driver of the upper limit speed by the upper limit speed notification unit. Vehicle speed control device. - 請求項1に記載の車両用速度制御装置において、
前記上限速度通知部は、前記制限速度取得部で前記制限速度を取得するタイミングもしくは前記上限速度設定部で前記上限速度を設定するタイミングで、前記上限速度を前記ドライバに対して通知するとともに、
前記速度制御部は、前記上限速度通知部で前記上限速度を前記ドライバに対して通知するタイミングから遅れたタイミングで、前記上限速度を前記自車両の走行速度の制御に適用することを特徴とする車両用速度制御装置。 In the vehicle speed control device according to claim 1,
The upper limit speed notification unit notifies the driver of the upper limit speed at the timing of acquiring the speed limit by the speed limit acquisition unit or at the timing of setting the upper limit speed by the upper limit speed setting unit.
The speed control unit is characterized in that the upper limit speed is applied to the control of the traveling speed of the own vehicle at a timing delayed from the timing of notifying the driver of the upper limit speed by the upper limit speed notification unit. Vehicle speed control device. - 請求項1に記載の車両用速度制御装置において、
前記上限速度通知部は、前記速度制御部が、前記上限速度設定部から得た前記上限速度と異なる上限速度を基にして、前記自車両の走行速度を制御している状況下においても、前記上限速度設定部で設定している前記上限速度を通知し、前記自車両の走行速度の制御に用いる上限速度と前記通知に用いる上限速度を不一致とすることを特徴とする車両用速度制御装置。 In the vehicle speed control device according to claim 1,
The upper limit speed notification unit is also used even under a situation where the speed control unit controls the traveling speed of the own vehicle based on an upper limit speed different from the upper limit speed obtained from the upper limit speed setting unit. A speed control device for a vehicle, characterized in that the upper limit speed set by the upper limit speed setting unit is notified, and the upper limit speed used for controlling the traveling speed of the own vehicle and the upper limit speed used for the notification do not match. - 請求項1に記載の車両用速度制御装置において、
前記上限速度を前記ドライバに対して通知するタイミングから前記上限速度を前記自車両の走行速度の制御に適用するタイミングまでの遅延時間は、前記ドライバの操作能力に応じて変更されることを特徴とする車両用速度制御装置。 In the vehicle speed control device according to claim 1,
The delay time from the timing of notifying the driver of the upper limit speed to the timing of applying the upper limit speed to the control of the traveling speed of the own vehicle is characterized in that the delay time is changed according to the operating ability of the driver. Vehicle speed control device. - 請求項1に記載の車両用速度制御装置において、
前記上限速度を前記ドライバに対して通知するタイミングから前記上限速度を前記自車両の走行速度の制御に適用するタイミングまでの遅延時間は、前記自車両の走行速度に応じて変更されることを特徴とする車両用速度制御装置。 In the vehicle speed control device according to claim 1,
The delay time from the timing of notifying the driver of the upper limit speed to the timing of applying the upper limit speed to the control of the traveling speed of the own vehicle is characterized in that the delay time is changed according to the traveling speed of the own vehicle. Vehicle speed control device. - 請求項1に記載の車両用速度制御装置において、
前記速度制御部は、前記上限速度設定部から得た前記上限速度が変更された後、前記自車両が一定の距離または一定の時間の少なくとも一方を走行するタイミングまで、前記自車両の走行速度を、前記上限速度が変更される前の前記上限速度以下となるように制御することを特徴とする車両用速度制御装置。 In the vehicle speed control device according to claim 1,
After the upper limit speed obtained from the upper limit speed setting unit is changed, the speed control unit determines the traveling speed of the own vehicle until the timing when the own vehicle travels at least one of a certain distance or a certain time. , A speed control device for a vehicle, characterized in that the upper limit speed is controlled to be equal to or lower than the upper limit speed before the change. - 請求項1に記載の車両用速度制御装置において、
前記自車両の車線変更操作を推定する車線変更推定部をさらに備え、
前記速度制御部は、前記車線変更推定部により車線変更操作中と判定している場合は、前記自車両の走行速度を、前記車線変更推定部により車線変更操作開始と判断される前の前記上限速度以下となるように制御することを特徴とする車両用速度制御装置。 In the vehicle speed control device according to claim 1,
Further equipped with a lane change estimation unit that estimates the lane change operation of the own vehicle,
When the speed control unit determines that the lane change operation is in progress by the lane change estimation unit, the upper limit of the traveling speed of the own vehicle before the lane change estimation unit determines that the lane change operation is started. A vehicle speed control device characterized in that the speed is controlled to be equal to or lower than the speed. - 請求項1に記載の車両用速度制御装置において、
前記ドライバによる前記上限速度の変更を行うためのドライバ操作を取得するドライバ操作取得部をさらに備え、
前記ドライバ操作取得部は、上限速度を上げるドライバ操作と、上限速度を下げるドライバ操作と、上限速度を変化前の上限速度に戻すドライバ操作を取得し、
前記上限速度設定部は、前記ドライバ操作取得部より得た前記ドライバ操作の結果に応じて、前記上限速度の設定を更新することを特徴とする車両用速度制御装置。 In the vehicle speed control device according to claim 1,
A driver operation acquisition unit for acquiring a driver operation for changing the upper limit speed by the driver is further provided.
The driver operation acquisition unit acquires a driver operation that raises the upper limit speed, a driver operation that lowers the upper limit speed, and a driver operation that returns the upper limit speed to the upper limit speed before the change.
The vehicle speed control device is characterized in that the upper limit speed setting unit updates the setting of the upper limit speed according to the result of the driver operation obtained from the driver operation acquisition unit. - 請求項8に記載の車両用速度制御装置において、
前記上限速度設定部は、前記ドライバ操作取得部から取得した前記ドライバ操作による前記上限速度の変更要求と、前記制限速度取得部から取得した前記制限速度の変化による前記上限速度の変更要求の発生タイミングが重複した際、前記ドライバ操作取得部から取得した前記ドライバ操作による更新を優先し、前記ドライバ操作取得部から取得した前記ドライバ操作による前記上限速度の変更を行った後に一定時間もしくは一定距離は前記制限速度取得部から取得した前記制限速度の変化による前記上限速度の変更を行わないことを特徴とする車両用速度制御装置。 In the vehicle speed control device according to claim 8.
The upper limit speed setting unit is the timing of occurrence of the upper limit speed change request by the driver operation acquired from the driver operation acquisition unit and the occurrence timing of the upper limit speed change request due to the change of the upper limit speed acquired from the speed limit acquisition unit. When the above overlaps, priority is given to the update by the driver operation acquired from the driver operation acquisition unit, and after the upper limit speed is changed by the driver operation acquired from the driver operation acquisition unit, the fixed time or a certain distance is the same. A speed control device for a vehicle, characterized in that the upper limit speed is not changed due to a change in the speed limit acquired from a speed limit acquisition unit.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021529972A JP7361117B2 (en) | 2019-07-03 | 2020-06-23 | Vehicle speed control device |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019124735 | 2019-07-03 | ||
JP2019-124735 | 2019-07-03 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2021002239A1 true WO2021002239A1 (en) | 2021-01-07 |
Family
ID=74100267
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2020/024508 WO2021002239A1 (en) | 2019-07-03 | 2020-06-23 | Vehicle speed control device |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP7361117B2 (en) |
WO (1) | WO2021002239A1 (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114426023A (en) * | 2022-03-31 | 2022-05-03 | 禾多科技(北京)有限公司 | A method, device, device and storage medium for determining target cruise speed |
US20230347889A1 (en) * | 2022-04-29 | 2023-11-02 | Hyundai Motor Company | Autonomous Driving Control Apparatus and Method for Controlling Setting Speed Thereof |
JP2024046265A (en) * | 2022-09-22 | 2024-04-03 | いすゞ自動車株式会社 | Electronic apparatus, vehicle, notification control method and program |
JP7586130B2 (en) | 2022-05-02 | 2024-11-19 | トヨタ自動車株式会社 | Information processing device, driving diagnosis method and program |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0785400A (en) * | 1993-09-20 | 1995-03-31 | Mitsubishi Motors Corp | Vehicle running control device |
JP2003262530A (en) * | 2002-03-07 | 2003-09-19 | Mitsubishi Electric Corp | Navigation apparatus and method thereof, and program |
JP2007233744A (en) * | 2006-03-01 | 2007-09-13 | Fujitsu Ten Ltd | Driving support apparatus |
JP2008120271A (en) * | 2006-11-13 | 2008-05-29 | Toyota Motor Corp | Self-driving vehicle |
JP2008221973A (en) * | 2007-03-12 | 2008-09-25 | Xanavi Informatics Corp | Vehicle speed controller |
JP2016137819A (en) * | 2015-01-28 | 2016-08-04 | 日立オートモティブシステムズ株式会社 | Automatic operation control device |
JP2017007362A (en) * | 2015-06-16 | 2017-01-12 | トヨタ自動車株式会社 | Vehicle speed limit system |
US20180222478A1 (en) * | 2015-08-07 | 2018-08-09 | Audi Ag | Method for Assisting a Driver in Time-Efficiently Performing a Journey with a Motor Vehicle, and Motor Vehicle |
-
2020
- 2020-06-23 JP JP2021529972A patent/JP7361117B2/en active Active
- 2020-06-23 WO PCT/JP2020/024508 patent/WO2021002239A1/en active Application Filing
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0785400A (en) * | 1993-09-20 | 1995-03-31 | Mitsubishi Motors Corp | Vehicle running control device |
JP2003262530A (en) * | 2002-03-07 | 2003-09-19 | Mitsubishi Electric Corp | Navigation apparatus and method thereof, and program |
JP2007233744A (en) * | 2006-03-01 | 2007-09-13 | Fujitsu Ten Ltd | Driving support apparatus |
JP2008120271A (en) * | 2006-11-13 | 2008-05-29 | Toyota Motor Corp | Self-driving vehicle |
JP2008221973A (en) * | 2007-03-12 | 2008-09-25 | Xanavi Informatics Corp | Vehicle speed controller |
JP2016137819A (en) * | 2015-01-28 | 2016-08-04 | 日立オートモティブシステムズ株式会社 | Automatic operation control device |
JP2017007362A (en) * | 2015-06-16 | 2017-01-12 | トヨタ自動車株式会社 | Vehicle speed limit system |
US20180222478A1 (en) * | 2015-08-07 | 2018-08-09 | Audi Ag | Method for Assisting a Driver in Time-Efficiently Performing a Journey with a Motor Vehicle, and Motor Vehicle |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114426023A (en) * | 2022-03-31 | 2022-05-03 | 禾多科技(北京)有限公司 | A method, device, device and storage medium for determining target cruise speed |
US20230347889A1 (en) * | 2022-04-29 | 2023-11-02 | Hyundai Motor Company | Autonomous Driving Control Apparatus and Method for Controlling Setting Speed Thereof |
JP7586130B2 (en) | 2022-05-02 | 2024-11-19 | トヨタ自動車株式会社 | Information processing device, driving diagnosis method and program |
JP2024046265A (en) * | 2022-09-22 | 2024-04-03 | いすゞ自動車株式会社 | Electronic apparatus, vehicle, notification control method and program |
JP7604430B2 (en) | 2022-09-22 | 2024-12-23 | いすゞ自動車株式会社 | Electronic device, vehicle, notification control method and program |
Also Published As
Publication number | Publication date |
---|---|
JPWO2021002239A1 (en) | 2021-01-07 |
JP7361117B2 (en) | 2023-10-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10435025B2 (en) | Vehicle control device | |
US11433898B2 (en) | Driving control apparatus for vehicle | |
US10688993B2 (en) | Vehicle control system with traffic driving control | |
US10222796B2 (en) | Autonomous driving control apparatus | |
WO2021002239A1 (en) | Vehicle speed control device | |
US9604652B2 (en) | Method for a driver assistance system for autonomous longitudinal and/or lateral control of a vehicle | |
US8538674B2 (en) | Vehicle collision avoidance apparatus and method | |
US11396296B2 (en) | Control system of vehicle, control method of the same, and non-transitory computer-readable storage medium | |
EP3539838A1 (en) | Vehicle control device | |
US20190202472A1 (en) | Apparatus and method for automatically controlling driving assist function of vehicle | |
KR20200017971A (en) | Vehicle and method for controlling thereof | |
EP3549838A1 (en) | Vehicle control device | |
JP6970215B2 (en) | Vehicle control device, vehicle with it, and control method | |
US11688185B2 (en) | Consciousness state determination system and autonomous driving apparatus | |
JPWO2019150525A1 (en) | Vehicle control devices, vehicles, and vehicle control methods | |
JP2017117192A (en) | Driving assistance device | |
US20190243361A1 (en) | Drive switching determination apparatus, drive switching determination method, and program for drive switching determination | |
KR20150051550A (en) | Performance enhanced driver assistance systems and controlling method for the same | |
KR20220119229A (en) | Advanced Driver Assistance System, and Vehicle having the same | |
CN110712655A (en) | Control device and method for controlling a passing process of an autonomous or partially autonomous vehicle | |
CN117062740A (en) | Auxiliary system operation method and auxiliary system | |
GB2572203A (en) | Vehicle controller and control method | |
EP3303089B1 (en) | Coast assist controller with haptic feedback | |
US20230014184A1 (en) | Vehicle control device, vehicle, vehicle control method and storage medium | |
US12097885B2 (en) | Assistance system and method for avoiding false activations of a shoulder function |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 20834265 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2021529972 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 20834265 Country of ref document: EP Kind code of ref document: A1 |