Driving support method and driving support device
The driving support device calculates a turning route at intersections using non-high-precision maps by defining a route area based on vehicle and other vehicle positions, enabling smooth navigation and collision avoidance.
Patent Information
- Application Number
- JP2020194350
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-11-24
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2040-11-24
AI Technical Summary
Conventional methods require a high-precision map generated from past driving to set a turning route at intersections, making it impossible to set routes at newly constructed intersections where such maps are unavailable.
A driving support method that uses a driving support device to calculate a turning route at intersections without a high-precision map by determining the own vehicle's position, detecting other vehicles, and setting a route within a defined area bounded by extension lines and arcs based on the vehicle's minimum turning radius and the direction of other vehicles.
Enables setting a turning route at intersections without a high-precision map, allowing smooth navigation and collision avoidance by controlling the vehicle's steering, accelerator, and brakes.
Smart Images

Figure 0007579683000002 
Figure 0007579683000003 
Figure 0007579683000004
Abstract
Description
[Technical field]
[0001] The present invention relates to a driving assistance method and a driving assistance device. [Background technology]
[0002] Conventionally, a method for setting a turning path within an intersection when a vehicle turns right or left at the intersection has been known (see Patent Document 1). The invention described in Patent Document 1 combines map data with road data acquired by LiDAR at least once in the past to generate accurate road and lane information (high-precision map), and sets a turning path within the intersection based on the high-precision map. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2016-75905 A Summary of the Invention [Problem to be solved by the invention]
[0004] However, in the invention disclosed in Patent Document 1, in order to set a turning path within an intersection when a vehicle turns right or left at the intersection, the driver must have driven through the intersection at least once in the past and generated a high-precision map including lane information in advance. Therefore, the conventional technology had a problem in that a turning path cannot be set when turning right or left at an intersection where high-precision map data has not been generated, such as a newly constructed intersection.
[0005] The present invention has been made in consideration of the above-mentioned problems, and an object of the present invention is to provide a driving assistance method and a driving assistance device that are capable of setting a turning path within an intersection when a vehicle turns right or left at an intersection without using a high-precision map. [Means for solving the problem]
[0006] A driving support method according to one aspect of the present invention extracts an intersection where a lane on which a vehicle is traveling intersects with another lane, and where a driving route for turning from the vehicle's lane to the other lane is set. A first extension line that passes through the position of the other vehicle moving in the other lane from the opposite direction to the direction in which the vehicle is turning toward the turning direction at the extracted intersection or in the opposite direction to the moving direction of the other vehicle, and a second extension line that passes through the position of the vehicle and extends in the direction of the turning direction of the other vehicle. Straight ahead A first straight-line direction line extending in the direction of the vehicle is calculated. An outermost boundary line, which is an arc-shaped curve having a radius equal to the minimum turning radius of the vehicle and which is tangent to the first extension line and the first straight-line direction line, and an innermost boundary line, which is an arc-shaped curve having a radius larger than the minimum turning radius, are set. A turning path is set in a path setting area, which is an area surrounded by the first extension line, the first straight-line direction line, the outermost boundary line, and the innermost boundary line, and each control unit that controls the steering, accelerator, and brake of the vehicle is controlled so that the vehicle travels along the turning path. Effect of the Invention
[0007] According to the present invention, when a vehicle turns right or left at an intersection, a driving route can be set without using a high-precision map. [Brief description of the drawings]
[0008] [Figure 1] FIG. 1 is a block diagram showing the configuration of a driving assistance device according to the first embodiment. [Diagram 2] FIG. 2 is a diagram illustrating a process in which the driving assistance device according to the first embodiment sets a route setting area. [Diagram 3] FIG. 3 is a flowchart showing a process of controlling the vehicle in accordance with a turning route set by the driving assistance device according to the first embodiment. [Figure 4] FIG. 4 is a block diagram showing the configuration of a driving assistance device according to the second embodiment. [Diagram 5] FIG. 5 is a diagram illustrating a process in which a driving support device according to the second embodiment estimates the center position of an intersection. [Figure 6]FIG. 6 is a diagram illustrating a process in which a driving assistance device according to the second embodiment corrects the outermost boundary line. [Figure 7] FIG. 7 is a flowchart showing a process for controlling a vehicle in accordance with a turning route set by a driving assistance device according to the second embodiment. [Figure 8] FIG. 8 is a block diagram showing the configuration of a driving assistance device according to the third embodiment. [Figure 9] FIG. 9 is a diagram illustrating a process in which a driving support device according to the third embodiment estimates the center position of an intersection. [Figure 10] FIG. 10 is a diagram illustrating a process in which a driving support device according to the third embodiment estimates the center position of an intersection. [Figure 11] FIG. 11 is a diagram illustrating a process of setting a detection range for another vehicle by a driving assistance device according to the third embodiment. [Figure 12] FIG. 12 is a flowchart showing a process of controlling a vehicle according to a turning route set by a driving assistance device according to the third embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0009] The embodiments will be described with reference to the drawings. In the description of the drawings, the same parts are given the same reference numerals and the description will be omitted.
[0010] (First embodiment) [Configuration of driving support device] The overall configuration of a driving support device according to this embodiment will be described with reference to Fig. 1. The driving support device is a device that sets a turning route for the host vehicle at an intersection and supports the host vehicle in traveling along the set turning route.
[0011] The driving support device 100 is configured by a controller. The driving support device 100 detects another vehicle ahead of the vehicle using a camera 200 and a radar 300 mounted on the vehicle, and sets a turning route at an intersection where the vehicle turns right or left based on the position and moving direction of the other vehicle. In FIG. 1, the camera 200 and the radar 300 are illustrated as an example of a device for acquiring external information, but a LiDAR may also be used. The driving support device 100 sets a driving route from the current position of the vehicle to the destination using map data that is not a high-precision map. The map data may be stored in the storage unit 400, or may be appropriately received via Internet communication from an external server including a cloud server.
[0012] The controller is a general-purpose microcomputer equipped with a CPU (Central Processing Unit), a memory, and an input / output unit. A computer program for functioning as the driving support device 100 is installed in the microcomputer. By executing the computer program, the microcomputer functions as a plurality of information processing circuits equipped in the driving support device 100. Note that in this embodiment, an example is shown in which the plurality of information processing circuits equipped in the driving support device 100 are realized by software, but it is of course possible to configure the information processing circuits by preparing dedicated hardware for executing each of the information processes described below. Also, the plurality of information processing circuits may be configured by individual hardware.
[0013] The driving support device 100 includes a driving route setting unit 110, an intersection extraction unit 120, a vehicle position detection unit 130, a moving object measurement unit 140, a turning route setting unit 150, and a driving support unit 160 as a plurality of information processing circuits.
[0014] The travel route setting unit 110 reads out the map data stored in the storage unit 400 and sets a travel route from the current position of the vehicle to the input destination. The travel route setting unit 110 may search for a plurality of travel routes to the destination. The travel route may be a travel route with a short travel distance, a travel route that avoids traffic jams and takes a short travel time to the destination, or a travel route that mainly travels on main roads. Based on the input user's preferences, the travel route setting unit 110 sets an optimal travel route from among the plurality of travel routes searched. The travel route setting unit 110 can search for a travel route by using a car navigation function. Note that the map data stored in the storage unit 400 is map data that includes information on a road basis, and does not need to include information on a lane basis (lane information) as in a high-precision map. In other words, the map data stored in the storage unit 400 may be a map that includes information for setting a route on a road basis from the current position to the destination, as in a map for car navigation, and is hereinafter also referred to as simple map data.
[0015] The travel route setting unit 110 determines the travel lane of the host vehicle on the travel route excluding the set intersection. For example, if the travel route of the host vehicle includes an intersection where the host vehicle turns right, and the travel route to the intersection where the host vehicle turns right has two or more lanes on one side, the travel route is set so that the host vehicle travels in the rightmost lane before the distance from the intersection to the host vehicle becomes less than a predetermined distance. If the travel route connected to the intersection where the host vehicle turns right has two or more lanes of right-turn lanes, the travel route is set to one of the right-turn lanes. The same applies to the intersection where the host vehicle turns left, and the travel route is set so that the host vehicle travels in the leftmost lane before the distance from the intersection to the host vehicle becomes less than a predetermined distance. Alternatively, if the travel route connected to the intersection where the host vehicle turns left has two or more lanes of left-turn lanes, the travel route is set to one of the left-turn lanes.
[0016] The intersection extraction unit 120 extracts intersections at which the host vehicle turns right or left on the travel route, and acquires the positions of the intersections at which the host vehicle turns right or left. Specifically, the intersection extraction unit 120 extracts information on intersections registered in map data, and identifies the positions of the intersections at which the host vehicle turns right or left.
[0017] The vehicle position detection unit 130 detects the position of the vehicle. Specifically, the vehicle position detection unit 130 detects the position of the vehicle using a GPS function. The vehicle position detection unit 130 can more accurately specify the position of the vehicle by correcting the error of the GPS using a map matching function. The vehicle position detection unit 130 calculates the distance from the specified position of the vehicle to the next intersection where the vehicle will turn right or left from the travel route. This allows the vehicle position detection unit 130 to determine whether the vehicle is approaching an intersection where the vehicle will turn right or left. As a specific method for determining whether the vehicle is approaching an intersection where the vehicle will turn right or left, the determination can be made based on the travel time until the vehicle enters the intersection. For example, when the travel time to the intersection is less than 15 seconds, it is determined that the vehicle is approaching the intersection. The determination whether the vehicle is approaching an intersection where the vehicle will turn right or left may be made based on the distance from the vehicle to the intersection.
[0018] The moving object measurement unit 140 acquires information ahead of the host vehicle from the camera 200 and the radar 300, and detects other vehicles ahead of the host vehicle by analyzing the acquired information, and measures the position and moving direction of the other vehicles. The moving object measurement unit 140 includes an object detection unit 141, an object position measurement unit 142, an object moving direction measurement unit 143, and a host vehicle behavior measurement unit 144. Note that, in this embodiment, a method of detecting other vehicles using the camera 200 and the radar 300 will be described, but the method of detecting other vehicles is not limited thereto. For example, other vehicles may be detected using a stereo camera or a LiDAR.
[0019] The object detection unit 141 detects other vehicles from the captured image of the area in front of the vehicle captured by the camera 200. Specifically, the object detection unit 141 detects other vehicles included in the captured image by using an image recognition function. The image recognition function is a function that extracts the feature amount of each object included in the captured image and identifies what the object is based on the extracted feature amount of each object. The object detection unit 141 determines whether each object included in the captured image has the feature of a vehicle, and determines whether each object is another vehicle.
[0020] The object position measuring unit 142 measures the relative positions of other vehicles with respect to the host vehicle in real space at each time. Specifically, the object position measuring unit 142 acquires the three-dimensional relative positions of each object measured by the radar 300 with respect to the host vehicle, and extracts the three-dimensional relative positions of other vehicles detected by the object detection unit 141 from the acquired three-dimensional relative positions of each object. This allows the object position measuring unit 142 to measure the three-dimensional relative positions of other vehicles with respect to the host vehicle in real space.
[0021] As described above, the sensor fusion of the camera 200 and the radar 300 makes it possible to detect other vehicles and measure the relative positions of the other vehicles in real space with respect to the host vehicle. In this embodiment, the radar 300 is used to measure the three-dimensional relative positions of the other vehicles, but the method of measuring the three-dimensional relative positions of the other vehicles is not limited to this. For example, by using a stereo camera as the camera 200, it is possible to measure the three-dimensional relative positions of the other vehicles with respect to the host vehicle without using the radar 300.
[0022] The object movement direction measurement unit 143 detects the movement direction of the other vehicle based on the relative position in real space of the other vehicle with respect to the host vehicle measured by the object position measurement unit 142 at each time and the amount of movement of the host vehicle measured by the host vehicle behavior measurement unit 144.
[0023] The host vehicle behavior measurement unit 144 identifies the position of the host vehicle in real space at each time and measures the movement amount of the host vehicle from the change in the position of the host vehicle in real space. Specifically, the host vehicle behavior measurement unit 144 identifies the position of the host vehicle in real space at each time by acquiring the coordinates of the host vehicle using a GPS function. Note that the host vehicle behavior measurement unit 144 may calculate the position of the host vehicle using a vehicle speed pulse and a yaw rate sensor of the host vehicle in addition to the coordinates of the host vehicle acquired using the GPS function. The host vehicle behavior measurement unit 144 can measure the movement direction and movement amount of the host vehicle from the change in the acquired position of the host vehicle in real space at each time.
[0024] The process in which the object movement direction measuring unit 143 detects the movement direction of another vehicle from the relative position in real space of the other vehicle with respect to the host vehicle at each time and the movement amount of the host vehicle will be specifically described below.
[0025] The object movement direction measuring unit 143 detects the movement direction of the other vehicle by correcting the three-dimensional relative position of the other vehicle in real space with respect to the host vehicle measured by the object position measuring unit 142 to a position (absolute position) in real space based on the movement amount of the host vehicle, and tracking the three-dimensional absolute position of the other vehicle. More specifically, it is assumed that the three-dimensional relative position of the other vehicle measured at time T1 is (X1, Y1, Z1), and the three-dimensional relative position of the other vehicle measured at time T2 is (X2, Y2, Z2). Then, if the distance traveled by the host vehicle between time T1 and time T2 is (Xc, Yc, Zc), the position of the other vehicle in real space corrected by the distance traveled by the host vehicle can be calculated as (X2-(X1-Xc), Y2-(Y1-Yc), Z2-(Z1-Zc). This allows the object movement direction measuring unit 143 to detect the movement direction of the other vehicle. Here, X, Y, and Z are coordinates with the position of the camera 200 as the reference position (origin), X indicates the left-right direction and is positive to the right of the reference position, Y indicates the up-down direction and is positive above the reference position, and Z is the front-rear direction and is positive forward of the reference position. Note that the above-mentioned method of calculating the movement direction of the other vehicle can detect the movement vector of the other vehicle in addition to the movement direction of the other vehicle.
[0026] The turning path setting unit 150 sets a turning path for the host vehicle at an intersection. Specifically, when the host vehicle position detection unit 130 determines that the host vehicle is approaching an intersection at which the host vehicle makes a right or left turn, the turning path setting unit 150 sets a route setting area that is an area at the intersection where the host vehicle can travel, and sets a turning path for the host vehicle in the set route setting area.
[0027] Here, the process of setting the route setting area 8 by the turning route setting unit 150 will be specifically described with reference to FIG. 2. The route setting area 8 is an area (hatched portion) surrounded by the first extension line 3, the first straight driving direction line 4, the outermost boundary line 6, and the innermost boundary line. When the vehicle approaches an intersection where the vehicle turns right or left, the turning route setting unit 150 first calculates the first extension line 3 and the first straight driving direction line 4. Next, the turning route setting unit 150 sets the outermost boundary line 6 and the innermost boundary line 7 that are tangent to the first extension line 3 and the first straight driving direction line 4. The turning route setting unit 150 sets the area (hatched portion) surrounded by the first extension line 3, the first straight driving direction line 4, the outermost boundary line 6, and the innermost boundary line 7 as the route setting area 8.
[0028] First, a process of calculating the first extension line 3 and the first straight direction line 4 by the turning path setting unit 150 will be described. The first extension line 3 is an extension line that passes through the position of the other vehicle 2A moving in the other lane at the intersection from the opposite direction of the turning direction of the host vehicle 1 toward the turning direction of the host vehicle 1 or the opposite direction to the moving direction of the other vehicle 2A. The first straight direction line 4 is an extension line that passes through the position of the other vehicle 2A moving in the other lane at the intersection from the opposite direction of the turning direction of the host vehicle 1 toward the turning direction of the host vehicle 1 or the opposite direction to the moving direction of the other vehicle 2A. Straight ahead 2, the direction in which the host vehicle 1 turns is the lower right direction, and the other vehicle 2A moves from the upper left direction, which is the opposite direction to the turning direction of the host vehicle, toward the lower right direction, which is the turning direction of the host vehicle.
[0029] When the host vehicle position detection unit 130 determines that the host vehicle 1 is approaching an intersection at which to turn right or left, the turning path setting unit 150 obtains the turning direction of the host vehicle from the driving path setting unit 110, and obtains the moving direction of the other vehicle 2A from the object moving direction measurement unit 143. When multiple other vehicles (not shown) are detected, the turning path setting unit 150 extracts the moving direction of the other vehicle 2A, which moves from the opposite direction to the turning direction of the host vehicle 1 toward the turning direction, from the moving directions of the multiple other vehicles that have been obtained. The turning path setting unit 150 calculates a first extension line 3 that passes through the position of the other vehicle 2A and extends to the lower right, which is the moving direction of the other vehicle 2A. The turning path setting unit 150 obtains the moving direction of the host vehicle 1 from the host vehicle position detection unit 130, and obtains the moving direction of the other vehicle 2A from the object moving direction measurement unit 143. Straight ahead A first straight line 4 extending in the direction of the arrow is calculated.
[0030] Next, a process of setting the outermost boundary line 6 and the innermost boundary line 7 by the turning path setting unit 150 will be described. The outermost boundary line 6 is an arc-shaped curve having a radius equal to the minimum turning radius Rmin of the host vehicle tangent to the first extension line 3 and the first straight driving direction line 4, and the innermost boundary line 7 is an arc-shaped curve having a radius Rmax larger than the minimum turning radius of the host vehicle tangent to the first extension line 3 and the first straight driving direction line 4.
[0031] The turning path setting unit 150 generates an arc-shaped curve having a radius equal to the minimum turning radius Rmin of the host vehicle, and sets an outermost boundary line 6 where the generated curve is tangent to the first extension line 3 and the first straight driving direction line 4. The turning path setting unit 150 sets an innermost boundary line 7 which is an arc-shaped curve having a radius Rmax larger than the minimum turning radius Rmin of the host vehicle and tangent to the host vehicle, the first extension line 3, and the first straight driving direction line 4.
[0032] The turning path setting unit 150 sets, as the innermost boundary line 7, a curved line whose curvature change rate is equal to or less than a predetermined value, and whose direction when connecting to the first extension line 3 coincides with the direction of the first extension line 3. Specifically, the turning path setting unit 150 sets a curved line whose curvature change rate when a circular arc having a radius Rmax larger than the minimum turning radius Rmin of the vehicle connects to the vehicle 1 and the first extension line 3 is equal to or less than a predetermined value. The predetermined value is a curvature that allows the occupants of the vehicle to tolerate the lateral acceleration generated in the vehicle when the vehicle travels on the set curved line. The turning path setting unit 150 sets the curvature so that the direction of the curved line when connecting to the first extension line 3 coincides with the direction of the first extension line 3. The difference between the turning radius Rmin and the radius Rmax can be set arbitrarily in advance, and may be constant or variable depending on the road shape.
[0033] As described above, the turning path setting unit 150 can set a route setting area 8 that is an area surrounded by the first extension line 3, the first straight direction line 4, the outermost boundary line 6, and the innermost boundary line 7, and set a turning path for the vehicle in the set route setting area 8. When the turning path setting unit 150 determines that an object detected by the object detection unit 141 is on the turning path, it searches for a turning path that avoids the object within the route setting area 8, and sets the turning path that avoids the object. Alternatively, it sets a turning path that stops the vehicle before the position where the object is present.
[0034] Returning to Fig. 1, the driving support unit 160 controls the host vehicle to travel along the turning path set in the route setting area 8. Furthermore, when the turning path setting unit 150 is unable to set a turning path that avoids an object within the range of the route setting area, the driving support unit 160 controls the host vehicle to stop. Specifically, the driving support unit 160 controls each control unit that controls the steering, accelerator, and brake, such as an electric power steering unit, an engine control unit, and an ABS unit, to control the host vehicle.
[0035] [Driving support method] Next, a method in which the driving support device shown in Fig. 1 sets a turning route in an intersection without using a high-precision map and controls the vehicle to travel along the set turning route will be described with reference to Fig. 3. The operation of the driving support device shown in the flowchart of Fig. 3 starts when the destination of the vehicle is set and the driving support function of the vehicle is enabled, and ends when the vehicle arrives at the destination or the driving support function of the vehicle is disabled.
[0036] In step S10, the driving route setting unit 110 acquires the input destination, reads out simple map data on a road-by-road basis stored in the memory unit 400, and sets a driving route on a road-by-road basis from the current position of the vehicle to the input destination.
[0037] Proceeding to step S20, the vehicle position detection unit 130 detects the position of the vehicle and acquires the position of the intersection where the vehicle will turn right or left on the driving route acquired from the intersection extraction unit 120. The vehicle position detection unit 130 calculates the distance from the identified vehicle position to the next intersection where the vehicle will turn right or left from the driving route, and determines whether the vehicle is approaching an intersection where the vehicle will turn right or left. If it is determined that the vehicle is not approaching an intersection where the vehicle will turn right or left (NO in step S20), the process remains in step S20 and continues. If it is determined that the vehicle is approaching an intersection where the vehicle will turn right or left (YES in step S20), the process proceeds to step S30.
[0038] In step S30, the object detection unit 141 detects other vehicles from the captured image of the area ahead of the host vehicle captured by the camera 200.
[0039] Proceeding to step S40, the object position measuring unit 142 acquires the relative position of each object measured by the radar 300 with respect to the host vehicle, and measures the relative positions of other vehicles with respect to the host vehicle in real space at each time.
[0040] Proceeding to step S50, the object movement direction measurement unit 143 detects the movement direction of the other vehicle based on the relative position in real space of the other vehicle with respect to the host vehicle measured by the object position measurement unit 142 at each time and the movement amount of the host vehicle measured by the host vehicle behavior measurement unit 144.
[0041] Proceeding to step S60, the turning path setting unit 150 acquires the turning direction of the host vehicle from the travel path setting unit 110, and acquires the moving direction of the other vehicle from the object moving direction measuring unit 143. The turning path setting unit 150 determines whether or not another vehicle moving in the opposite direction to the turning direction of the host vehicle in another lane has been detected from the acquired moving directions of the other vehicles.
[0042] If no vehicle is detected moving in the other lane from the opposite direction to the turning direction of the host vehicle toward the turning direction (NO in step S60), the process returns to step S30 and continues to detect other vehicles around the host vehicle. If a vehicle is detected moving in the other lane from the opposite direction to the turning direction of the host vehicle toward the turning direction (YES in step S60), the process proceeds to step S70.
[0043] In step S70, the turning path setting unit 150 calculates a first extension line that passes through the position of another vehicle moving in the other lane from the opposite direction to the turning direction of the host vehicle toward the turning direction, and extends in the moving direction of the other vehicle.
[0044] Proceeding to step S80, the turning path setting unit 150 acquires the moving direction of the host vehicle from the host vehicle position detection unit 130 and calculates the Straight ahead A first straight line extending in the direction of the arrow is calculated.
[0045] Proceeding to step S90, the turning path setting unit 150 generates an arc-shaped curve having a radius equal to the minimum turning radius Rmin of the host vehicle, and sets the outermost boundary line where the generated curve is tangent to the first extension line and the first straight direction line.
[0046] Proceeding to step S100, the turning path setting unit 150 sets an innermost boundary line which is an arc-shaped curve tangent to the host vehicle, the first extension line, and the first straight direction line and has a radius Rmax larger than the minimum turning radius Rmin of the host vehicle.
[0047] Proceeding to step S110, the turning path setting unit 150 sets a route setting area that is an area surrounded by the first extension line, the first straight line, the outermost boundary line, and the innermost boundary line, and sets a turning path for the vehicle in the set route setting area. If the turning path setting unit 150 determines that an object is on the turning path, it searches for a turning path that avoids the object within the range of the route setting area, and sets the turning path that avoids the object. Alternatively, it sets a turning path that stops the vehicle before the position where the object is present.
[0048] Proceeding to step S120, the driving support unit 160 controls each control unit that controls the steering, accelerator, and brake, such as an electric power steering unit, an engine control unit, and an ABS unit, and controls the host vehicle to travel along a turning path. Furthermore, when the turning path setting unit 150 cannot set a turning path that avoids an object within the route setting area, the driving support unit 160 controls the host vehicle to stop.
[0049] By executing the above-described processing, the driving assistance device can set a turning route within an intersection without using a high-precision map, and control the vehicle to travel along the set turning route.
[0050] As described above, according to the first embodiment, the following advantageous effects can be obtained.
[0051] The driving support device 100 calculates a first extension line and a first straight line, and calculates a minimum turning radius of the host vehicle that connects the first extension line and the first straight line. Radius An outermost boundary line that is an arc-shaped curve and an innermost boundary line that is an arc-shaped curve with a radius larger than the minimum turning radius are set. This allows the driving assistance device 100 to set a route setting area that is an area in which the host vehicle can travel and is surrounded by the first extension line, the first straight direction line, the outermost boundary line, and the innermost boundary line, and to set a turning path for the host vehicle to turn in the route setting area.
[0052] The driving support device 100 sets, as the innermost boundary line, a curve whose rate of change of curvature is equal to or less than a predetermined value and whose direction when connecting to the first extension line coincides with the direction of the first extension line. This allows the driving support device 100 to set a turning path for the host vehicle as a curve whose curvature changes gradually, allowing the host vehicle to turn smoothly.
[0053] The driving support device 100 detects the moving direction of the other vehicle based on the relative position of the other vehicle with respect to the host vehicle in real space at each time and the movement amount of the host vehicle. This makes it possible to correct the relative position of the other vehicle with respect to the host vehicle in real space to a position in real space (absolute position) based on the movement amount of the host vehicle, and to detect the moving direction of the other vehicle by tracking the position of the other vehicle in real space.
[0054] When an object is detected on the set turning route, the driving support device 100 searches for a turning route that avoids the object within the route setting area. This makes it possible to set a turning route that avoids the object. Furthermore, when it is not possible to set a turning route that avoids the object, a turning route that stops the vehicle before the location of the object is set. This makes it possible to avoid a collision with the object.
[0055] Second embodiment [Configuration of driving support device] The configuration of the driving support device according to the second embodiment will be described with reference to Fig. 4. The differences from the first embodiment are that an intersection center estimation unit 170 is further provided, and the processing of the turning path setting unit 150. Therefore, only the intersection center estimation unit 170 and the turning path setting unit 150 will be described, and descriptions of other common configurations will be omitted.
[0056] The intersection center estimation unit 170 detects the center position of the intersection where the host vehicle turns right or left. Here, the process of detecting the center position 5 of the intersection by the intersection center estimation unit 170 will be specifically described with reference to Fig. 5. In Fig. 5, the turning direction of the host vehicle 1 is the right direction.
[0057] First, the intersection center estimation unit 170 calculates the first extension line 3, the second extension line 9, and the second straight direction line. Next, the intersection center estimation unit 170 detects the intersection of the center line 10 of the first extension line 3 and the second extension line 9 and the second straight direction line 11 as the center position 5 of the intersection.
[0058] The following describes specific processing contents in which the intersection center estimation unit 170 calculates the first extension line 3, the second extension line 9, and the second straight direction line.
[0059] The intersection center estimation unit 170 acquires the turning direction of the host vehicle 1 from the travel route setting unit 110, and acquires the moving direction of the other vehicles (2A, 2B) from the object moving direction measuring unit 143. The intersection center estimation unit 170 extracts the moving direction of the other vehicle 2A moving in the other lane from the opposite direction to the turning direction of the host vehicle 1 toward the turning direction from the acquired moving directions of the other vehicles (2A, 2B), and calculates a first extension line 3 that passes through the position of the other vehicle 2A and extends in the moving direction of the other vehicle 2A.
[0060] The intersection center estimation unit 170 extracts the direction of movement of the other vehicle 2B, which is moving in the other lane from the direction in which the host vehicle 1 turns to the opposite direction from the obtained directions of movement of the other vehicles 2 (2A, 2B), and calculates a second extension line 9 that passes through the position of the other vehicle 2B and extends in the direction of movement of the other vehicle 2B. The intersection center estimation unit 170 obtains the direction of movement of the host vehicle 1 from the host vehicle position detection unit 130, and calculates a second extension line 9 that passes through the position of the host vehicle 2B and extends in the direction of movement of the other vehicle 2B from the side of the host vehicle 1 on the oncoming lane side. Straight ahead A second straight line 11 extending in the direction of the arrow A is calculated.
[0061] As described above, the intersection center estimation unit 170 calculates the first extension line 3, the second extension line 9, and the second straight direction line. Then, the intersection center estimation unit 170 calculates the center line 10 between the first extension line 3 and the second extension line 9, and can detect the intersection of the center line 10 and the second straight direction line 11 as the center position 5 of the intersection.
[0062] Returning to Figure 4, the turning path setting unit 150 obtains the center position of the intersection detected by the intersection center estimation unit 170, and if the outermost boundary line is located outside the center position of the intersection in the turning radius direction, sets the outermost boundary line closer to the innermost boundary line than the center position of the intersection.
[0063] Here, a process in which the turning path setting unit 150 sets the outermost boundary line 6 closer to the innermost boundary line than the center position 5 of the intersection will be described with reference to Fig. 6. The outermost boundary line 6 shown in Fig. 6 is set outside the center position 5 of the intersection in the turning radius direction.
[0064] The turning path setting unit 150 determines that the set outermost boundary line 6 is outside the center position 5 of the intersection in the turning radius direction, and changes the outermost boundary line 6 to the outermost boundary line 6A. Specifically, the turning path setting unit 150 generates a straight line 6B that passes through the center position 5 of the intersection and intersects with the first extension line 3 and the first straight direction line 4, and sets the outermost boundary line 6A by changing the outermost boundary line 6 that is set outside the straight line 6B in the turning radius direction to the straight line 6B. The slope of the straight line 6B is calculated by the following formula (1).
[0065]
number
[0066] This allows the turning path setting unit 150 to set the outermost boundary line 6 closer to the innermost boundary line than the center position of the intersection. Note that the method of setting the outermost boundary line 6 closer to the innermost boundary line than the center position 5 of the intersection is not limited to the above-mentioned method, and for example, the outermost boundary line 6 may be offset until it contacts the center position 5 of the intersection.
[0067] [Driving support method] Next, a driving support method according to the second embodiment will be described with reference to Fig. 7. The difference from the first embodiment is that the second embodiment further includes steps S101 and S102. Therefore, only the processes in steps S101 and S102 will be described, and descriptions of other common processes will be omitted.
[0068] In step S101, the turning path planning unit 150 acquires the center position of the intersection detected by the intersection center estimation unit 170, and determines whether or not the outermost boundary line is located outside the center position of the intersection in the turning radius direction.
[0069] If it is determined that the outermost boundary line is not outside the center position of the intersection in the turning radius direction (NO in step S101), proceed to step S110. If it is determined that the outermost boundary line is outside the center position of the intersection in the turning radius direction (YES in step S101), proceed to step S102.
[0070] In step S102, the turning path planning unit 150 sets the outermost boundary line closer to the innermost boundary line than the center position of the intersection.
[0071] As described above, according to the second embodiment, in addition to the effects of the first embodiment, the following effects can be obtained.
[0072] The driving support device 100 calculates the first extension line, the second extension line, and the second straight direction line, and detects the intersection of the center line 10 of the first extension line and the second extension line and the second straight direction line 11 as the center position 5 of the intersection. This allows the driving support device 100 to estimate the center position of the intersection.
[0073] The driving support device 100 acquires the center position of the intersection, and when the outermost boundary line is located outside the center position of the intersection in the turning radius direction, sets the outermost boundary line closer to the innermost boundary line than the center position of the intersection. This enables the driving support device 100 to correct the route setting area and set a turning route that prevents a collision with another vehicle traveling in the oncoming lane.
[0074] Third embodiment The configuration of the driving support device according to the third embodiment will be described with reference to Fig. 8. The differences from the second embodiment are that an object trajectory generation unit 180 is further provided, and the processing of the turning path setting unit 150 and the intersection center estimation unit 170. Therefore, only the object trajectory generation unit 180, the intersection center estimation unit 170, and the turning path setting unit 150 will be described, and descriptions of other common configurations will be omitted.
[0075] The object trajectory generation unit 180 acquires tracking data of the positions (absolute positions) of other vehicles in real space at each time from the object movement direction measurement unit 143, and generates a movement trajectory of other vehicles in real space by connecting the positions of other vehicles in real space at each time.
[0076] The intersection center estimation unit 170 estimates the center position of the intersection by using the movement trajectory of the other vehicle generated by the object trajectory generation unit 180. Here, a method in which the intersection center estimation unit 170 estimates the center position of the intersection by using the movement trajectory of the other vehicle will be specifically described with reference to Figs. 9 and 10.
[0077] First, a method in which the intersection center estimation unit 170 estimates the center position 5 of the intersection using the movement trajectories of the other vehicles (2C, 2D) will be specifically described with reference to Fig. 9. The intersection center estimation unit 170 acquires the movement trajectory 12 of the other vehicle 2C entering the own vehicle lane from another lane intersecting with the own vehicle lane, and the movement trajectory 13 of the other vehicle 2D entering the oncoming lane of the own vehicle lane from another lane intersecting with the own vehicle lane, from the object trajectory generation unit 180. Then, the intersection center estimation unit 170 sets the center position of the straight line that forms the shortest distance between the movement trajectory 12 and the movement trajectory 13 as the center position 5 of the intersection.
[0078] Next, with reference to Fig. 10, a method in which the intersection center estimation unit 170 estimates the center position 5 of the intersection using the movement trajectories of the other vehicles (2A, 2B, 2E, 2F) will be specifically described. The intersection center estimation unit 170 acquires movement trajectories (16, 17) in the own lane direction of each of the other vehicles (2E, 2F) traveling straight in the own lane and the oncoming lane of the own lane, and movement trajectories (14, 15) in the intersecting lane direction of each of the other vehicles (2A, 2B) traveling straight in the other lane intersecting the own lane and the oncoming lane of the other lane intersecting the own lane. Then, the intersection center estimation unit 170 sets the intersection point of the center lines (18, 19) between the closest lanes facing each other in each lane direction as the center position 5 of the intersection.
[0079] In addition, the intersection center estimation unit 170 calculates the movement trajectory in the crossing lane direction ( 14、15 ) the center line between the nearest opposing lanes 18 and Second straight line (not shown) can be set as the center position 5 of the intersection.
[0080] 8, the turning path setting unit 150 sets a range for detecting other vehicles. Specifically, when the position of the host vehicle is within a predetermined distance from an intersection, the turning path setting unit 150 sets the detection range from the first straight line to the exit of the intersection in the turning direction of the host vehicle.
[0081] Here, the process in which the turning path setting unit 150 sets the detection range 21 will be specifically described with reference to Fig. 11. In Fig. 11, the turning direction of the host vehicle 1 is the right direction.
[0082] First, the turning path setting unit 150 measures a distance 20 to the other vehicle 2A that is closest to the host vehicle among other vehicles moving in the other lane from the opposite direction to the turning direction of the host vehicle 1 toward the turning direction. Specifically, the turning path setting unit 150 measures the distance from the host vehicle to the movement trajectory of the other vehicle 2A. Alternatively, the turning path setting unit 150 may measure the distance from the host vehicle to the first extension line.
[0083] Next, the turning path setting unit 150 sets a detection range 21 in which the distance from the first straight line 4 in the direction in which the host vehicle turns and in the direction parallel to another lane intersecting the host vehicle lane is set as the measured distance 20. The turning path setting unit 150 sets a route setting area based on the position and moving direction (not shown) of the other vehicle traveling at the farthest position from the host vehicle within the detection range 21.
[0084] Returning to FIG. 8, when the vehicle travels along the driving route and another vehicle moving outside the route setting area is newly detected within the set detection range, the turning route setting unit 150 updates the turning route based on the position and moving direction of the other detected vehicle.
[0085] When the direction in which the host vehicle turns is a direction in which the host vehicle turns across other lanes and a plurality of movement trajectories of other vehicles moving in the other lanes from the opposite direction to the turning direction of the host vehicle toward the turning direction are detected, the turning path setting unit 150 measures the intervals between the movement trajectories of the plurality of other vehicles. When the intervals between the movement trajectories of the plurality of other vehicles are equal to or greater than a predetermined threshold, the turning path setting unit 150 extracts the other vehicle farthest from the host vehicle and sets the innermost boundary line based on the movement trajectory of the other vehicle farthest from the host vehicle.
[0086] [Driving support method] Next, a driving support method according to the third embodiment will be described with reference to Fig. 12. The difference from the second embodiment is that the driving support method further includes steps S51, S52, and S61. Therefore, only the processes in steps S51, S52, and S61 will be described, and descriptions of other common processes will be omitted.
[0087] In step S51, the object trajectory generation unit 180 acquires tracking data of the position of the other vehicle from the object movement direction measurement unit 143, and generates a movement trajectory of the other vehicle in real space by connecting the positions of the other vehicles in real space at each time.
[0088] Proceeding to step S52, the turning path setting unit 150 measures a distance 20 to the other vehicle that is closest to the host vehicle among other vehicles moving in the other lane from the opposite direction to the turning direction of the host vehicle 1 toward the turning direction. The turning path setting unit 150 sets a detection range in which the measured distance is the distance from the first straight line in the turning direction of the host vehicle and in the direction parallel to the other lane that intersects with the host lane.
[0089] In step S62, when the direction in which the host vehicle turns is a direction in which the host vehicle turns across other lanes and a plurality of movement trajectories of other vehicles moving in the other lanes from the opposite direction to the turning direction of the host vehicle toward the turning direction are detected, the turning path setting unit 150 measures the intervals between the movement trajectories of the plurality of other vehicles. When the intervals between the movement trajectories of the plurality of other vehicles are equal to or greater than a predetermined threshold, the turning path setting unit 150 extracts the other vehicle that is farthest from the host vehicle.
[0090] As described above, according to the third embodiment, in addition to the effects of the second embodiment, the following effects can be obtained.
[0091] The driving support device 100 corrects the relative positions of the other vehicles in real space with respect to the vehicle at each time based on the amount of movement of the vehicle at each time, and generates a movement trajectory of the other vehicles in real space by connecting the corrected positions of the other vehicles in real space at each time. This allows the driving support device 100 to correct the relative positions of the other vehicles in real space with respect to the vehicle to positions (absolute positions) in real space based on the amount of movement of the vehicle, and to generate a movement trajectory of the other vehicles by connecting the positions of the other vehicles in real space.
[0092] The driving support device 100 estimates the center position of the intersection using the movement trajectory of the other vehicle. This makes it possible to estimate the center position of the intersection using the movement trajectory of the other vehicle in addition to the extension line of the direction in which the other vehicle is moving.
[0093] The driving support device 100 sets the center position of the intersection as the center position of a straight line that forms the shortest distance between the movement trajectory of another vehicle entering the own lane from another lane intersecting the own lane and the movement trajectory of another vehicle entering the oncoming lane from another lane intersecting the own lane. This makes it possible to set the center position of the intersection based on the movement trajectory of the other vehicle when it actually turns around the intersection.
[0094] The driving support device 100 acquires the movement trajectories in the own lane direction of each of the other vehicles traveling straight in the own lane and the oncoming lane of the own lane, and the movement trajectories in the cross lane direction of each of the other vehicles traveling straight in the other lane intersecting the own lane and the oncoming lane of the other lane intersecting the own lane. The driving support device 100 then sets the intersection of the center lines between the closest lanes that are opposed to each other in each lane direction as the center position of the intersection. This allows the driving support device 100 to set the center position of the intersection based on the movement trajectories in the own lane direction and the movement trajectories in the cross lane direction when the other vehicle actually travels straight through the intersection.
[0095] The driving support device 100 detects the center line between the closest opposing lanes in the movement trajectory in the cross lane direction. Second straight line As a result, the driving support device 100 can set the center position of the intersection even when only the movement trajectory in the intersecting lane direction is detected as the movement trajectory of the other vehicle.
[0096] The driving support device 100 can exclude other vehicles that are not relevant when setting a turning path for the host vehicle by setting a detection range for detecting other vehicles.
[0097] When the position of the host vehicle is within a predetermined distance from the intersection, the driving support device 100 sets the detection range from the first straight line to the exit of the intersection in the direction in which the host vehicle turns, as the detection range. As a result, the driving support device 100 can set the detection range at an appropriate timing by setting the detection range when the position of the host vehicle is within a predetermined distance from the intersection. Furthermore, by setting the detection range from the first straight line to the exit of the intersection in the direction in which the host vehicle turns, the driving support device 100 can set the turning path of the host vehicle based on the position and moving direction of another vehicle traveling near the intersection exit, and can set the turning path taking into account the road shape after passing through the intersection.
[0098] The driving support device 100 can estimate the approximate size of the intersection by measuring the distance to the closest vehicle to the vehicle among other vehicles moving in the other lanes in the intersection from the opposite direction to the turning direction of the vehicle. The driving support device 100 can set the detection range to include the intersection on the turning direction side of the vehicle by setting the detection range in which the distance from the first straight line to the other lane in the turning direction of the vehicle and intersecting the vehicle's lane is the measured distance. This makes it possible to set the turning route of the vehicle based on the position and moving direction of the other vehicle traveling near the intersection exit, and to set the turning route taking into account the road shape after passing through the intersection.
[0099] The driving support device 100 updates the detection range as the vehicle moves, and when another vehicle moving outside the route setting area is newly detected in the detection range, the driving support device 100 updates the turning route based on the position and moving direction of the detected other vehicle. This allows the driving support device 100 to obtain information on other vehicles that could not be detected due to blind spots, etc., and to set a turning route based on the newer position and moving direction of the other vehicle.
[0100] When the direction of turning of the host vehicle is a direction of turning across other lanes and a plurality of movement trajectories of other vehicles moving in the other lanes from the opposite direction to the turning direction of the host vehicle toward the turning direction are detected, the driving support device 100 measures the intervals between the movement trajectories of the plurality of other vehicles. In this way, the driving support device 100 can estimate the number of other lanes into which the host vehicle will turn and enter from the intervals between the movement trajectories of the other vehicles. Then, when the intervals between the movement trajectories are equal to or greater than a predetermined threshold, the driving support device 100 can cause the host vehicle to enter the first lane of the entering lane.
[0101] As described above, the embodiment of the present invention has been described, but the description and drawings forming a part of this disclosure should not be understood as limiting this invention. From this disclosure, various alternative embodiments, examples and operating techniques will become apparent to those skilled in the art. [Explanation of symbols]
[0102] 100 Driving support device 120 Intersection Extraction Unit 150 Turning path setting section
Claims
1. A driving assistance method for assisting a vehicle in traveling along a driving route, comprising: extracting an intersection at which a lane on which the host vehicle is traveling intersects with another lane, the intersection being set so that the traveling route makes a turn from the host vehicle lane to the other lane; calculating a first extension line passing through a position of another vehicle moving in the other lane at the intersection from a direction opposite to a direction in which the host vehicle turns toward the turning direction of the other vehicle or in the opposite direction to the moving direction of the other vehicle, and a first straight-ahead direction line passing through the position of the host vehicle and extending in the straight-ahead direction of the host vehicle; an outermost boundary line which is an arc-shaped curve having a radius equal to a minimum turning radius of the host vehicle and which is tangent to the first extension line and the first straight-line direction line, and an innermost boundary line which is an arc-shaped curve having a radius larger than the minimum turning radius; a route setting area that is an area surrounded by the first extension line, the first straight direction line, the outermost boundary line, and the innermost boundary line, and a turning route of the host vehicle at the intersection is set; Controlling each control unit for controlling the steering, accelerator and brake of the host vehicle so that the host vehicle travels along the turning path A driving support method comprising:
2. calculating a second extension line that passes through a position of another vehicle moving in the other lane at the intersection from a direction in which the host vehicle turns toward a direction opposite to the turning direction of the other vehicle and that extends in the moving direction of the other vehicle or in the opposite direction to the turning direction, and a second straight direction line that extends in the straight direction from a side surface of the host vehicle on an oncoming lane side; an intersection point between a center line of the first extension line and the second extension line and the second straight direction line is detected as a center position of the intersection; The outermost boundary line is set closer to the innermost boundary line than the center position of the intersection. The driving support method according to claim 1 .
3. As the innermost boundary line, a curve is set in which the rate of change of curvature is equal to or less than a predetermined value, and the direction of the curve when connected to the first extension line coincides with the direction of the first extension line. The driving support method according to claim 1 .
4. measuring a relative position in real space of the other vehicle with respect to the host vehicle at each time and a movement amount of the host vehicle; The method for assisting a vehicle according to claim 1 , wherein a moving direction of the other vehicle is detected from a relative position of the other vehicle in real space at each time and an amount of movement of the host vehicle.
5. correcting a relative position of the other vehicle with respect to the host vehicle in real space at each time based on an amount of movement of the host vehicle at each time; The corrected positions of the other vehicles in real space at each time are connected to generate a movement trajectory of the other vehicles in real space. The driving support method according to claim 4 .
6. setting a center position of the intersection as a center position of a straight line that forms a shortest distance between a movement trajectory of the other vehicle entering the own lane from the other lane that intersects with the own lane and a movement trajectory of the other vehicle entering an oncoming lane from the other lane that intersects with the own lane, The outermost boundary line is set closer to the innermost boundary line than the center position of the intersection. The driving support method according to claim 1 .
7. set, as a center position of the intersection, an intersection point between center lines of the nearest lanes opposed to each other in each lane direction, a movement trajectory in the own lane direction of each of the other vehicles traveling straight in the own lane and the oncoming lane of the own lane, and a movement trajectory in the intersecting lane direction of each of the other vehicles traveling straight in the other lane intersecting with the own lane and the oncoming lane of the other lane intersecting with the own lane, The outermost boundary line is set closer to the innermost boundary line than the center position of the intersection. The driving support method according to claim 1 .
8. When the position of the host vehicle is within a predetermined distance from the intersection, a detection range for detecting the other vehicle is set from the first straight line to an exit of the intersection in the turning direction of the host vehicle. The driving support method according to claim 1 .
9. measuring a first distance to the other vehicle that is closest to the host vehicle among the other vehicles that are moving in the other lane at the intersection from a direction opposite to a direction in which the host vehicle turns toward the turning direction; The detection range is set so that the first distance is a distance from the first straight line in a direction in which the host vehicle turns and which is parallel to the other lane that intersects with the host lane; The route setting area is set based on the position and the moving direction of the other vehicle that is traveling at the farthest position from the host vehicle within the detection range. The driving support method according to claim 8 .
10. Detecting an object on the turning path; searching for a turning path that avoids the object within the range of the route setting area; If a turning path to avoid the object cannot be set, the host vehicle is controlled to stop. The driving support method according to claim 1 .
11. When the vehicle travels along the travel route and the other vehicle is newly detected in the detection range moving outside the route setting area, the turning route is updated based on the position and moving direction of the other vehicle detected. Characterized by The driving support method according to claim 8 .
12. When the turning direction of the host vehicle is a direction in which the host vehicle turns across the other lane, and a plurality of movement trajectories of the other vehicle moving on the other lane from a direction opposite to the turning direction of the host vehicle toward the turning direction are detected, measuring an interval between the movement trajectories of the plurality of the other vehicles; If the distance is equal to or greater than a predetermined threshold, the innermost boundary line is set based on the movement trajectory of the other vehicle that is farthest from the host vehicle. The driving support method according to claim 5 .
13. A driving assistance device that assists a vehicle in traveling along a driving route, an intersection extraction unit that extracts an intersection at which a lane on which the host vehicle is traveling intersects with another lane, and in which the travel route is set to turn from the host lane to the other lane; a turning path setting unit that calculates a first extension line that passes through a position of another vehicle moving in the other lane at the intersection from a direction opposite to a direction in which the host vehicle turns toward the turning direction of the other vehicle or in the opposite direction to the direction of movement of the other vehicle and a first straight driving direction line that passes through the position of the host vehicle and extends in a straight driving direction of the host vehicle, sets an outermost boundary line that is an arc-shaped curve having a radius equal to a minimum turning radius of the host vehicle and an innermost boundary line that is an arc-shaped curve having a radius larger than the minimum turning radius and is tangent to the first extension line and the first straight driving direction line, and sets a turning path of the host vehicle at the intersection in a route setting area that is an area surrounded by the first extension line, the first straight driving direction line, the outermost boundary line, and the innermost boundary line; A driving assistance device comprising:
Citation Information
Patent Citations
Joint probabilistic modeling and inference of intersection structure
JP2016075905A
Travel support device and travel support method
JP2019018827A
Travel support method and travel support device
JP2020032994A
Traveling control device for vehicle
WO2014006759A1
