Driving Support Devices

The driving support device addresses the challenge of accurately identifying curve inflection points to enhance the driving experience by smoothly transitioning vehicle speed and acceleration, replicating the skills of an experienced driver.

JP7579132B2Active Publication Date: 2024-11-07SUBARU CORP
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
JP2020212703
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2020-12-22
Publication Date
2024-11-07
Estimated Expiration
2040-12-22

AI Technical Summary

Technical Problem

Existing driving support devices struggle to accurately identify the curve inflection point near the target turning speed, leading to difficulties in smoothly connecting lateral acceleration, which affects the ability to replicate the driving feeling of a skilled driver during curve navigation.

Method used

A driving support device that utilizes a vehicle position estimation system to detect curve inflection points by analyzing road map information, calculating curvature changes, and setting deceleration start points to achieve a smooth transition from straight to curved sections, mimicking the driving skills of an experienced driver.

Benefits of technology

The device effectively identifies curve inflection points and adjusts vehicle speed to replicate the driving experience of a skilled driver by smoothly connecting longitudinal and lateral accelerations, enhancing the driving feeling during curve navigation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007579132000001
    Figure 0007579132000001
  • Figure 0007579132000002
    Figure 0007579132000002
  • Figure 0007579132000003
    Figure 0007579132000003
Patent Text Reader

Abstract

To enable deceleration control at the time when an own vehicle enters a curve section, with a driving feeling equivalent to a driving feeling of a skilled driver.SOLUTION: A driving support control unit 31 detects a curve section C, on the basis of road information written on a front watching-point distance P obtained by a front watching-point distance information obtaining part 12b of an own vehicle position estimating unit 11; sets a target steering speed at which an own vehicle M can be steered, on the basis of a curve radius R in a constant radius section C1 in the curve section C and preset lateral acceleration; when a current speed of the own vehicle is over the target steering speed, determines a change rate of a flection point by differentiating a curvature of the curve section C twice; and when the change rate is over a preset threshold value, determines that the deflection point is a curve deflection point Ci leading from a relaxation curve section to the constant radius section, and determines a deceleration starting point Ds that is necessary for the speed of the own vehicle to be equal to the target steering speed in the vicinity of the curve deflection point.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a driving support device that enables deceleration control when entering a curved section to be performed with a feeling equivalent to that of a skilled driver. [Background technology]

[0002] Generally, in curved sections of expressways and general roads, a constant radius (circular arc) section is provided between the entrance from a straight road or the exit to a straight road, and this constant radius section and the straight road are connected by a transition curve section. As shown in Figure 9, in a constant radius (circular arc) section, the change in curve curvature [1 / m] is zero with respect to the curve length [m], and in a transition curve, the curve curvature [1 / m] changes at a constant slope with respect to the curve length [m]. Needless to say, the curve curvature [1 / m] of a straight line is 0.

[0003] By connecting the straight line and the constant radius section with a transition curve section, the driver can reach the constant radius section by turning the steering wheel at a constant angular velocity from the straight line to the constant radius section, thereby obtaining a stable ride.

[0004] Also, there is known a driving support device that automatically controls the vehicle speed in order to reduce the driver's burden of accelerator work when driving through this curved section.For example, Patent Document 1 (Patent Publication No. 5224918) discloses a technology that executes throttle quick-close control (deceleration feeling control) when steering is predicted when entering a curved section, thereby executing gradual deceleration even if there is a margin of error in the speed at which the vehicle enters the curved section, making the driver feel a deceleration feeling and shifting the load to the front wheels, thereby giving the driver a natural feeling.

[0005] This document also discloses a technique for turning with an appropriate lateral acceleration by executing braking control when the actual deceleration is smaller than the target deceleration so that the actual deceleration becomes the target deceleration. [Prior art documents] [Patent documents]

[0006] [Patent Document 1] Patent No. 5224918 Summary of the Invention [Problem to be solved by the invention]

[0007] Incidentally, a driving assistance device is known that acquires curvature information of a curve section ahead of the vehicle position from map data, sets a target turning speed based on the curve curvature of the curve section, gradually decelerates the vehicle speed (own vehicle speed) to the target turning speed before entering the curve, and causes the vehicle to turn at a constant speed in a constant radius section.

[0008] In such a vehicle speed control in a curve section, the lateral acceleration applied to the vehicle gradually increases when traveling through a transition curve section, and reaches a maximum at the curve inflection point, which is the entrance to a constant radius section. Therefore, in the vehicle speed control, the acceleration acting on the front and rear of the vehicle body (longitudinal acceleration) and the lateral acceleration are smoothly connected by decelerating the vehicle speed to a target turning speed near the curve inflection point, and a driving feeling equivalent to that of a driver with high driving skills (skill driver) can be obtained. Therefore, the driving assistance device needs to recognize the position of the curve inflection point, which is near the target point where the vehicle speed is decelerated to the target turning speed, at the start of deceleration.

[0009] In a system (so-called "map locator") that acquires road information ahead of the vehicle from the relationship between map data and the vehicle's position, road information is set at predetermined intervals for curve sections shown in the map data. The curve radius is stored in this road information, and when starting deceleration control of the vehicle's speed before entering a curve, the curve radius information stored in each piece of road information is acquired, the section with the smallest curve radius is set as the constant radius section, and the target turning speed is set based on this curve radius.

[0010] However, the road information in which the minimum curve radius is stored is not always set near the curve inflection point. As a result, when the road information in which the minimum curve radius is stored is set at a position away from the curve inflection point, if the vehicle speed is controlled to decelerate to the target turning speed, it becomes difficult to smoothly connect the lateral acceleration applied to the vehicle when moving from the transition curve section to the constant radius section. Therefore, there is an inconvenience that a good driving feeling like the accelerator operation performed by an ideal skilled driver cannot be obtained.

[0011] In view of the above circumstances, the present invention aims to provide a driving assistance device that can obtain a driving feeling equivalent to that of a skilled driver when acquiring curve information from road information written in road map information and performing deceleration control when entering a curve section. [Means for solving the problem]

[0012] The present invention relates to a driving assistance device having a vehicle position estimation unit including a storage unit in which road map information is stored, a vehicle position estimation calculation unit which estimates the vehicle position on the road map information stored in the storage unit, and a road information acquisition unit which acquires road information written at predetermined intervals for a road ahead of the vehicle position on the road map information estimated by the vehicle position estimation calculation unit, a vehicle speed detection unit which detects the vehicle speed of the vehicle, and a driving assistance control unit which controls the vehicle speed of the vehicle. The driving assistance control unit includes a curve section detection unit which detects a curve section having a transition curve section following a straight section and a constant radius section following the transition curve section based on the road information acquired by the road information acquisition unit, a target turning speed setting unit which sets a target turning speed at which the vehicle can turn through the constant radius section based on a curve radius written in the road information of the constant radius section and a preset lateral acceleration; a curvature calculation unit which compares the vehicle speed detected by the vehicle speed detection unit with the target turning speed set by the target turning speed setting unit, and if the vehicle speed exceeds the target turning speed, calculates a curvature of the curve section based on the curve radius written in the road information of the curve section; a curvature change value calculation unit which differentiates the curvature calculated by the curvature calculation unit to calculate a curvature change value; an inflection point detection unit which checks whether or not there is an inflection point in the curvature change value calculated by the curvature change value calculation unit; In front a curve inflection point determination unit which, when the inflection point is detected, differentiates the curvature change value determined by the curvature change value calculation unit to determine a rate of change at the inflection point, and, when the rate of change exceeds a preset threshold value, determines that the inflection point is a curve inflection point continuing from the transition curve section to the constant radius section; and a deceleration start point setting unit which sets a deceleration start point required for decelerating the vehicle speed to the target turning speed near the curve inflection point, based on a difference between the vehicle speed detected by the vehicle speed detection unit and the target turning speed set by the target turning speed setting unit. and a deceleration control processing unit, the deceleration control processing unit ending deceleration when the vehicle position on the road map estimated by the vehicle position estimation calculation unit passes the curve inflection point for a predetermined time or a predetermined distance, and causes the vehicle to travel at a constant speed in the constant radius section at the vehicle speed at the time of ending deceleration. . Effect of the Invention

[0013] According to the present invention, a curve section having a transition curve section following a straight section and a constant radius section following this transition curve section is detected based on road information acquired by a road information acquisition unit, a target turning speed at which the vehicle can turn through the constant radius section is set based on the curve radius written in the road information for the constant radius section and a preset lateral acceleration, this target turning speed is compared with the vehicle speed of the vehicle, and if the vehicle speed of the vehicle exceeds the target turning speed, a curvature of the curve section is calculated based on the curve radius written in the road information for the curve section, the curvature of the curve section is differentiated to calculate a curvature change value, and it is checked whether there is an inflection point where this curvature change value hits zero, and if an inflection point that hits zero is detected, the curvature change value is differentiated to calculate a rate of change of the inflection point, and if this rate of change exceeds a preset threshold value, it is determined that the inflection point is a curve inflection point continuing from the transition curve section to the constant radius section. Then, based on the difference between the vehicle speed of the vehicle itself and the target turning speed, the deceleration start point required for the vehicle speed to be decelerated to the target turning speed near the curve inflection point is set. Therefore, when curve information is obtained from the road information acquired by the road information acquisition unit and deceleration control is performed when entering a curve section, a driving feeling equivalent to that of a skilled driver can be obtained. [Brief description of the drawings]

[0014] [Figure 1] Schematic diagram of a driving support device [Diagram 2] Flowchart showing a curve deceleration control routine [Diagram 3] Flowchart showing a subroutine for calculating a deceleration start point before a curve [Figure 4] Flowchart showing a curve inflection point estimation processing subroutine [Diagram 5] Schematic diagram showing curved sections on a road map [Figure 6]The process of detecting a curve inflection point is shown in FIG. 1. (a) is a time chart showing the curve radius for each forward gaze point distance. (b) is a time chart in which the curve curvature line is developed based on the curve radius in (a). The middle chart is a time chart in which the curve curvature is differentiated once. The bottom chart is a time chart in which the curve curvature is differentiated twice. (c) is a time chart showing the state in which the curve inflection point is estimated based on the second derivative value shown in the bottom chart of (b). [Figure 7] A time chart showing the changes in vehicle speed and deceleration before entering a curve section [Figure 8] Distance chart showing changes in deceleration, vehicle speed and lateral acceleration at the curve inflection point due to curve deceleration control [Figure 9] A characteristic diagram showing the change in curve curvature with respect to the curve length for transition curve sections and constant radius sections set in straight sections and curve sections. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0015] An embodiment of the present invention will be described below with reference to the drawings. Reference numeral 1 in FIG. 1 denotes a driving assistance device mounted on a vehicle M (see FIG. 5). The driving assistance device 1 includes a vehicle position estimation unit 11 as a vehicle position estimation unit, a camera unit 21, and a driving assistance control unit 31 as a driving assistance control unit. The vehicle position estimation unit 11 includes a map locator calculation unit 12 and a road map database 15 as a storage unit. The map locator calculation unit 12, a forward driving environment recognition unit 21d (described later), and the driving assistance control unit 31 are configured with a well-known microcomputer including a CPU, RAM, ROM, a non-volatile storage unit, and the like, and peripheral devices thereof, and the ROM stores programs to be executed by the CPU, tables, fixed data such as maps, and the like in advance.

[0016] A GNSS (Global Navigation Satellite System) receiver 13 and an autonomous sensor 14 are connected to the input side of the map locator calculation unit 12. The GNSS receiver 13 receives positioning signals transmitted from a plurality of positioning satellites. The autonomous sensor 14 is a collective term for sensors that detect the driving state of the host vehicle M, and is composed of a vehicle speed sensor, a steering angle sensor, a longitudinal G (acceleration) sensor, a lateral G sensor, and the like.

[0017] The road map database 15 is a large-capacity storage medium such as a HDD, and stores well-known road map information. In this road map information, road nodes are set at intervals of several centimeters to several tens of centimeters for roads on the map, and position information (latitude, longitude, altitude, road direction) and road information such as the curve radius at the center of the lane width at each position are written in advance as static map information to the road nodes.

[0018] On the other hand, the map locator calculation unit 12 includes a vehicle position estimation calculation unit 12a and a forward gaze point distance information acquisition unit 12b as a road information acquisition unit. The vehicle position estimation calculation unit 12a estimates position information (latitude, longitude, altitude) of the current position of the vehicle M.

[0019] That is, when the GNSS receiver 13 can receive a positioning signal, the vehicle position estimation calculation unit 12a estimates the vehicle position based on the positioning signal. In addition, in an environment where the reception sensitivity from the GNSS satellite is low and the positioning signal cannot be effectively received, such as when driving inside a tunnel, the vehicle position estimation calculation unit 12a performs localization based on information detected by the autonomous sensor 14. Then, the vehicle position estimation calculation unit 12a performs map matching of the estimated position information (latitude, longitude, altitude) on a road map stored in the road map database 15, and estimates the vehicle position (current position) on the road map.

[0020] Further, the forward gaze point distance information acquisition unit 12b reads the road node located closest to the forward gaze point distance P set at a predetermined interval ahead of the host vehicle M, based on the host vehicle position on the road map estimated by the host vehicle position estimation calculation unit 12a, and then acquires the road information stored in the read road node.

[0021] The road information includes the position coordinates (latitude, longitude, altitude) of the extracted point, the direction of the road, the linear type (straight line, circular arc, transition curve), etc. The transition curve is, for example, a well-known clothoid curve.

[0022] This forward gaze point distance P is set, for example, at a point 100 [m], 200 [m], or 300 [m] ahead of the vehicle M. The forward gaze point distance information acquisition unit 12b acquires, at each predetermined calculation cycle, road information of a map node that is located closest to the forward gaze point distance P of the set point.

[0023] For example, assuming that the vehicle M is traveling on a highway at a speed of 100 [Km / h], the time to pass 100 [m] is 3.6 [sec]. If the calculation cycle of the forward gaze point distance information acquisition unit 12b is, for example, 1.8 [sec], the map node is sampled every 50 [m]. Therefore, as shown in FIG. 5, when the vehicle M is traveling at a speed of 100 [Km / h] and the calculation cycle of the forward gaze point distance information acquisition unit 12b is, for example, 1.8 [sec], the road information stored in the map node at the position closest to the forward gaze point distance P1'-P3' up to 100 [m], 200 [m], and 300 [m] ahead is read at the position of the vehicle M' at the time of the previous calculation shown by the dashed line. Then, at the time of the current calculation, the road information stored in the map node at the position closest to the forward fixation point distance P1-P3 up to 300 [m] ahead at 100 [m] intervals at the position of the vehicle M which has progressed 50 [m] since the previous calculation is read. Note that, since the actual calculation cycle is shorter than 1.8 [sec], the sequence of points of the forward fixation point distance P becomes finer as the vehicle M approaches the curve section C.

[0024] As described below, the number and intervals of the forward gaze point distances P are for estimating the curve inflection points Ci in the curve section C. Therefore, as long as the curve inflection points Ci can be estimated before the host vehicle M enters the curve section C, the number and intervals of the forward gaze point distances P are not limited to these.

[0025] The camera unit 21 is fixed to the upper center of the front interior of the vehicle M, and has an in-vehicle camera (stereo camera) consisting of a main camera 21a and a sub-camera 21b arranged at symmetrical positions on either side of the center in the vehicle width direction (vehicle width center), an image processing unit (IPU) 21c, and a forward driving environment recognition unit 21d. The camera unit 21 captures reference image data with the main camera 21a, and captures comparison image data with the sub-camera 21b.

[0026] The IPU 21c processes both sets of image data in a predetermined manner. The forward driving environment recognition unit 21d reads the reference image data and the comparison image data that have been image-processed by the IPU 21c, and calculates distance information data (distance from the host vehicle M to the object) of the same object in both images based on the parallax, using the principle of triangulation.

[0027] Next, by pattern matching the distance information with pre-stored three-dimensional road shape data and three-dimensional object data, etc., information on the driving environment ahead of the vehicle, such as the dividing lines that separate the left and right sides of the driving lane, fixed objects, and moving objects, is extracted and transmitted to the driving assistance control unit 31.

[0028] Further, in addition to the host vehicle position estimation calculation unit 12a and the forward driving environment recognition unit 21d of the camera unit 21, a vehicle speed sensor 32 as a vehicle speed detection unit that detects the vehicle speed (host vehicle speed), a longitudinal G sensor 33 that detects longitudinal acceleration (longitudinal G) occurring in the host vehicle M, a lateral G sensor 34 that detects lateral acceleration (lateral G) occurring in the host vehicle M, etc. are connected to the input side of the driving assistance control unit 31. The vehicle speed sensor 32 and both acceleration sensors 33, 34 may be those incorporated in the autonomous sensor 14. Alternatively, the autonomous sensor 14 may also use the vehicle speed sensor 32 and both acceleration sensors 33, 34.

[0029] On the other hand, the input side of the driving assistance control unit 31 is connected to a brake control unit 36 ​​that applies the brakes to forcibly decelerate the host vehicle M, and a drive source control unit 37 that controls the output of a drive source (engine or electric motor).

[0030] The driving assistance control unit 31 reads the vehicle position estimated by the vehicle position estimation calculation unit 12a of the map locator calculation unit 12 and the road information (latitude, longitude, altitude, road direction, curve radius at the center of the lane width at the position, etc.) written in the map node at each forward gaze point distance P extracted by the forward gaze point distance information acquisition unit 12b.

[0031] 5, the driving assistance control unit 31 estimates the curve section C from the road information written in each forward gaze point distance P. As shown in the figure, the curve section C is composed of a constant radius (circular arc) section C1 and transition curve sections C2, C3 connecting the constant radius section C1 and straight line sections Si, So.

[0032] Therefore, the sections where the curve radius R of the road information stored in each map node is the same can be estimated as constant radius sections C1, the sections where the curve radius R is infinite can be estimated as straight line sections Si, So, and the sections where the curve radius R changes continuously between the constant radius section C1 and the straight line sections Si, So can be estimated as transition curve sections C2, C3.

[0033] The driving assistance control unit 31 calculates a target turning speed when traveling through the constant radius section C1 based on the curve radius R of the constant radius section C1, calculates a start point (deceleration start point) for decelerating the vehicle speed to the target turning speed near the curve inflection point Ci based on the current vehicle position and vehicle speed, and performs a predetermined deceleration control process.

[0034] That is, when the vehicle M is caused to enter a curve section C from a straight section Si and the vehicle speed is controlled when passing through this curve section C to obtain a driving feeling equivalent to that of a skilled driver, as shown in FIG. 7, deceleration of the vehicle speed is started in the straight section Si before entering the curve, and a point a predetermined distance from the curve entrance (curve inflection point) Ci of the constant radius section C1 (for example, a point 20 [sec] from the curve inflection point Ci) is set as the deceleration end point, and the vehicle is decelerated at a constant deceleration so as to reach the target turning speed at this point. By setting the deceleration end point to a point a predetermined distance from Ci, a feeling closer to the actual accelerator operation by the driver can be obtained. Note that the target turning speed is set from Ci to the deceleration end point. of The distance may be a fixed value, or may be a variable value that is set according to the target turning speed.

[0035] Then, the vehicle M is driven at a constant speed in the constant radius section C1 at the speed at which the vehicle M reaches the deceleration end point. This allows the acceleration acting on the front and rear of the vehicle M (longitudinal acceleration) and the lateral acceleration to be smoothly connected, providing a driving feeling equivalent to that of a skilled driver.

[0036] However, as described above, the forward fixation point distance information acquisition unit 12b samples road information of map nodes at a preset forward fixation point distance P (for example, up to 500 [m] ahead at 100 [m] intervals) for each calculation cycle, so that the map node at the curve inflection point Ci is not necessarily read at this forward fixation point distance P. Furthermore, this map node is not necessarily set at the curve inflection point Ci.

[0037] The driving assistance control unit 31 described above must first estimate the curve inflection point Ci, and perform deceleration control processing so that the turning speed reaches the target turning speed at a point slightly past the curve inflection point (curve entrance) Ci.

[0038] Specifically, the deceleration control process when entering a curve, which is executed by the driving assistance control unit 31 described above, is executed according to a curve deceleration control routine shown in Fig. 2. This routine is executed at every predetermined calculation period, and first, in step S1, the host vehicle position information estimated by the host vehicle position estimation calculation unit 12a of the host vehicle position estimation unit 11 is read. In step S2, road information stored in a map node at a front fixation point distance P (P1 to P3 set at 100 [m] intervals in Fig. 5) set ahead of the host vehicle position extracted by the front fixation point distance information acquisition unit 12b is read.

[0039] The road information read in each calculation cycle is stored in the RAM or the non-volatile storage unit in sequence until the host vehicle M passes the point of the map node. Therefore, the sequence of points of the curve information ahead of the host vehicle M becomes finer as the host vehicle M approaches the curve section C.

[0040] Then, the process proceeds to step S3, where it is checked whether or not the road information stored in the map node that the vehicle M read at the forward gaze point distance P contains curve information indicating the curve section C. This curve information refers to information in which the curve radius R is equal to or smaller than the radius that is regarded as a straight line. The lower limit of the radius that is regarded as a straight line is preset. The processes in steps S2 and S3 correspond to the curve section detection unit of the present invention.

[0041] If it is determined that the curve information is included, the process proceeds to step S4, whereas if it is determined that the curve information is not included, the process exits the routine.

[0042] For example, at a point where the host vehicle M' is traveling on the straight section Si shown by the dashed line in Fig. 5, the road map information of the map node set at a position closest to the forward gaze point distance P1'-P3' is read in. After that, when the host vehicle M reaches the position shown by the solid line, the road map information of the map node set at a position closest to the forward gaze point distance P1-P3 at that point is read in. The travel distance between the host vehicles M' and M corresponds to the calculation cycle of the forward gaze point distance information acquisition unit 12b.

[0043] Therefore, when the host vehicle M is traveling in a straight section Si (300 m or more) before the curve section C, the road map information acquired by the forward gaze point distance information acquisition unit 12b does not include curve information, so the routine is terminated. After that, when the host vehicle M travels further and acquires a map node for the curve section C for the first time with the forward gaze point distance P3, the road information of this map node includes curve information, so the process proceeds to step S4. This map node is accumulated sequentially for each calculation cycle until the host vehicle M passes the point of the map node.

[0044] Then, when the process proceeds to step S4, a curve deceleration start point calculation process is executed, and the process proceeds to step S5. This curve deceleration start point calculation is executed according to a curve deceleration start point calculation subroutine shown in FIG.

[0045] In this subroutine, first, in step S11, the curve radius R stored in the road information of the map node at each forward fixation point distance P (see FIG. 6(a)) is read. Next, the process proceeds to step S12, where each curve radius R is converted into a curve curvature 1 / R. The process in step S12 corresponds to the curvature calculation unit of the present invention. Also, the horizontal axis in FIG. 6 indicates the elapsed time for each calculation cycle.

[0046] Next, the process proceeds to step S13, where the curvature line of the curve section is developed based on the converted curvature 1 / R of each curve. That is, the road information stores position coordinates (latitude, longitude, altitude) and road direction in addition to the curve radius R, and the curvature line of the curve section is developed as shown in the time chart in the upper part of Fig. 6(b) by interpolating the point sequence of each curve curvature 1 / R based on this road information.

[0047] Then, proceed to step S14, where the position (curve inflection point) of the curve entrance Ci (curve exit Co) of the transition curve section C2 (C3) is estimated based on the curvature change of the transition curve section C2, the curve curvature (1 / R=0) of the straight section Si, and the curve curvature of the constant radius section C1, and then proceed to step S15.

[0048] The estimation of the curve inflection point Ci executed in step S14 is performed according to a curve inflection point estimation processing subroutine shown in Fig. 4. In this subroutine, first, in step S21, it is checked whether a constant curve curvature is detected on the curvature line. If a constant curve curvature is detected, the process proceeds to step S22, and if not, the routine is terminated.

[0049] Whether the curve curvature 1 / R is constant or not is determined based on the curve curvature 1 / R of the adjacent forward gaze point distance P, and if this curve curvature 1 / R is the same, it is determined to be constant. For example, when the forward center point distance P of the vehicle M has passed the curve start point of the curve section C, the curve curvature 1 / R gradually increases, so a constant curve curvature is not yet detected.

[0050] Since the constant curve radius section C1 indicates the minimum curve curvature in the curve section C, when the front center point distance P3 enters the constant radius section C1 and the curve radius detected at each calculation cycle remains the same or increases, the minimum curve radius can be estimated to be the constant curve curvature.

[0051] Next, in step S22, a target turning speed is set, which is the upper limit of the vehicle speed at which the vehicle can turn while satisfying a preset allowable lateral G based on a constant curve curvature 1 / R. This target turning speed is obtained by referring to a table set based on the characteristics of the host vehicle M, or by an arithmetic expression that takes into account the characteristics of the host vehicle M. The processing in step S22 corresponds to the target turning speed setting unit of the present invention.

[0052] Then, the process proceeds to step S23, where the target turning speed is compared with the vehicle speed detected by the vehicle speed sensor 32. If the current vehicle speed is equal to or less than the target turning speed, the vehicle can travel through the fixed radius section C1 without decelerating, and the process exits the routine. On the other hand, if the vehicle speed exceeds the target turning speed, the vehicle speed must be decelerated to the target turning speed when entering the fixed radius section C1, and the process proceeds to step S24.

[0053] In step S24, the curve curvature of the curvature line is differentiated once to obtain a curvature change value. That is, as shown in the middle part of Fig. 6(b), the curvature change value changes according to the curve curvature 1 / R from the curve start point (curve end point) of the transition curve section C2 (C3) to the curve entrance Ci (curve exit Co). The process in step S24 corresponds to the curvature change value calculation unit of the present invention.

[0054] Then, the process proceeds to step S25 to check whether the curvature change value has hit 0 (falling). If the curvature change value has hit 0, it is determined that there is an inflection point, and the process proceeds to step S26. If the curvature change value has not hit 0, it is determined that there is no inflection point, and the process exits the routine. The process in step S25 corresponds to the inflection point detection unit of the present invention.

[0055] The position where the curvature change value hits 0 is the position where the curve curvature 1 / R becomes constant, but the first differentiation merely checks the point where the curve curvature 1 / R changes, and it is not possible to accurately identify whether it is the curve inflection point Ci or not.

[0056] Therefore, in the next step S26, the curvature change value found in step S25 is further differentiated (differentiated twice). Then, as shown in the lower part of FIG. 6(b), an inflection point is extracted at the zero hit position. Then, the process proceeds to step S27, where the rate of change of this inflection point is compared with a preset threshold value. This threshold value is a value for accurately determining whether the zero hit position of the curvature change value determined in the above-mentioned step S25 is an inflection point or not, and is a fixed value determined in advance by experiments or the like. The processes in steps S26 and S27 correspond to the curve inflection point determination unit of the present invention.

[0057] If the rate of change of the inflection point exceeds the threshold value, it is determined that the inflection point is a curve inflection point Ci, and the process proceeds to step S28. If the rate of change of the inflection point does not exceed the threshold value, it is determined that the inflection point is not a curve inflection point Ci, and the routine ends.

[0058] In step S28, the position coordinates of the curve inflection point are calculated, and the process proceeds to step S15 in FIG.

[0059] When the process proceeds to step S28, a curve inflection point estimation process is executed, and the process proceeds to step S15 in FIG. 3. In this curve inflection point estimation process, first, the forward gaze point distances P1 to P3 at the time when the curve inflection point Ci is detected are plotted in a gaze point distance array. Then, first, the travel distance from the forward gaze point distance P(x) (x=1, 2, 3) immediately after passing the curve inflection point Ci to the curve inflection point Ci is calculated based on the elapsed time from the curve inflection point Ci and the vehicle speed for the forward gaze point distance P(x) (X=1, 2, 3) immediately after passing the curve inflection point Ci. Next, the travel distance is subtracted from this forward gaze point distance to estimate the position coordinate of the curve inflection point Ci, and the process proceeds to step S15 in FIG. 3.

[0060] In step S15 in Fig. 3, an inflection point distance, which is the distance from the vehicle position to the deceleration end position De (see Fig. 8), is calculated. That is, first, a point a predetermined distance from the position coordinates of the curve inflection point Ci (for example, a point 20 [sec] from the curve inflection point Ci) is set as the deceleration end point (position coordinates) De. Next, the inflection point distance is calculated based on the coordinate positions of the current vehicle position and the deceleration end point De, and the curvature line between them, and the process proceeds to step S16.

[0061] In step S16, the deceleration start point (position coordinate) is calculated. That is, in this step S16, first, a deceleration travel distance for decelerating to the target turning speed at a constant deceleration is calculated from the difference between the vehicle speed and the target turning speed. Then, the deceleration travel distance is subtracted from the inflection point distance to calculate the deceleration start point (position coordinate) Ds (see FIG. 8).

[0062] Next, the process proceeds to step S17, where the deceleration start point Ds is plotted on a road map, and the process proceeds to step S5 in Fig. 2. Since the deceleration start point Ds varies depending on the vehicle speed, the latest value is obtained at each calculation cycle until the vehicle M reaches the deceleration start point Ds, and the plot point on the road map is updated successively. The processes from step S14 to S17 correspond to the deceleration start point setting unit of the present invention.

[0063] 2, it is checked whether the vehicle position estimated by the vehicle position estimation calculation part 12a of the map locator calculation part 12 provided in the vehicle position estimation unit 11 has reached the deceleration start point Ds plotted on the road map, and the process in step S4 is repeated until the vehicle position has reached the deceleration start point Ds. If the vehicle position has reached the deceleration start point Ds, the process proceeds to step S6. In step S6, the deceleration control process is executed and the routine is exited. The process in step S6 corresponds to the deceleration control processing part of the present invention.

[0064] That is, immediately after the host vehicle position passes the deceleration start point Ds, the driving assistance control unit 31 controls the brake control unit 36 ​​and the drive source control unit 37 to decelerate the host vehicle speed according to a preset deceleration until the host vehicle speed reaches the deceleration end point De. Then, when the host vehicle position reaches the deceleration end point De, the deceleration is ended and the host vehicle travels at a constant speed in the constant radius section C1 at the vehicle speed at the end of deceleration.

[0065] As described above, according to this embodiment, as shown in FIG. 8, the forward gaze point distances P1 to P3 are set, for example, at intervals of 100 m ahead of the current vehicle position, and even if the curve inflection point Ci is located between the forward gaze point distances P1 and P2 in FIG. 5, the accurate curve inflection point Ci can be obtained, and the deceleration end point De can be accurately set based on this curve inflection point Ci.

[0066] As a result, when performing deceleration control when entering the curve section C from the straight section Si, the accurate curve inflection point Ci is obtained, and the vehicle speed can be decelerated to the target turning speed near the curve inflection point Ci. Therefore, the longitudinal acceleration and lateral acceleration acting on the vehicle M as it passes through the transition curve section C2, reaches the constant radius section C1, and turns through this constant radius section C1 at a constant speed are smoothly connected, resulting in a driving feeling equivalent to that of a skilled driver.

[0067] Incidentally, the present invention is not limited to the above-described embodiment. For example, the steering operation when traveling through the curve section C may be either automatic steering by the active lane keep (ALK) control by the driving assistance control unit 31 or manual steering performed by the driver himself. [Explanation of symbols]

[0068] 1...Driving assistance device, 11...Vehicle position estimation unit, 12...Map locator calculation unit, 12a... vehicle position estimation calculation unit, 12b...Front gaze point distance information acquisition unit, 13...GNSS receiver, 14...Autonomous sensors, 15…Road map database, 21...Camera unit, 21a…Main camera, 21b…Sub camera, 21c…Image processing unit, 21d…Front driving environment recognition unit, 31...Driver assistance control unit, 32...Vehicle speed sensor, 33...Front-rear acceleration sensor, 34...Lateral acceleration sensor, 36...Brake control unit, 37...Drive source control unit, A…Clothoid parameters, C: Curve section, C1: Fixed radius section, C2, C3: Tempo curve section, Ci: curve inflection point, Co…Curve exit, De: Deceleration end point, Ds...Deceleration start point, L...Curve length, M: Vehicle, P,P1~P3,P1'~P3'...forward gaze point distance, R: Curve radius, 1 / R: Curve curvature, Si, So: Straight section

Claims

1. a vehicle position estimating unit including a storage unit in which road map information is stored, a vehicle position estimating calculation unit which estimates the vehicle position on the road map information stored in the storage unit, and a road information acquiring unit which acquires road information written at predetermined intervals for a road ahead of the vehicle position on the road map information estimated by the vehicle position estimating calculation unit; A vehicle speed detection unit that detects the speed of the host vehicle; A driving assistance control unit that controls a vehicle speed of the host vehicle; In a driving assistance device having The driving assistance control unit is a curve section detection unit that detects a curve section having a transition curve section following a straight section and a constant radius section following the transition curve section based on the road information acquired by the road information acquisition unit; a target turning speed setting unit that sets a target turning speed at which the host vehicle can turn in the constant radius section based on a curve radius written in the road information of the constant radius section and a preset lateral acceleration; a curvature calculation unit that compares the vehicle speed detected by the vehicle speed detection unit with the target turning speed set by the target turning speed setting unit, and when the vehicle speed exceeds the target turning speed, calculates a curvature of the curve section based on the curve radius written in the road information of the curve section; a curvature change value calculation unit that calculates a curvature change value by differentiating the curvature calculated by the curvature calculation unit; an inflection point detection unit that checks whether or not there is an inflection point in the curvature change value calculated by the curvature change value calculation unit; a curve inflection point determination unit that, when the inflection point is detected by the inflection point detection unit, determines a rate of change of the inflection point by differentiating the curvature change value determined by the curvature change value calculation unit, and determines that the inflection point is a curve inflection point continuing from the transition curve section to the constant radius section when the rate of change exceeds a preset threshold value; a deceleration start point setting unit that sets a deceleration start point required for decelerating the vehicle speed to the target turning speed near the curve inflection point based on a difference between the vehicle speed detected by the vehicle speed detection unit and the target turning speed set by the target turning speed setting unit; A deceleration control processing unit having The deceleration control processing unit ends deceleration when the vehicle position on the road map estimated by the vehicle position estimation calculation unit passes the curve inflection point for a predetermined time or a predetermined distance, and drives the vehicle at a constant speed in the constant radius section at the vehicle speed at the time of ending deceleration. A driving assistance device comprising:

2. The deceleration control processing unit starts deceleration at a predetermined deceleration when it is determined that the vehicle position on the road map estimated by the vehicle position estimation calculation unit has reached the deceleration start point set by the deceleration start point setting unit.

2. The driving support device according to claim 1.

3. The inflection point detection unit checks whether or not there is an inflection point at which the curvature change value calculated by the curvature change value calculation unit hits zero.

3. A driving support device according to claim 1, wherein the driving support device is a vehicle driving device.

Citation Information

Patent Citations

  • Process for producing copper alloy containing iron

    JP1977024918A

  • Recommended speed setting device and vehicle controller

    JP2006331000A

  • Vehicular travel control apparatus

    JP2015063201A

  • Vehicle acceleration-deceleration control apparatus

    JP2015217848A