Vehicle control device, vehicle control method, and program
The vehicle control device improves autonomous driving accuracy by integrating road dividing line and vehicle trajectory analysis to select the most reliable lane for control, reducing errors and maintaining stable driving.
Patent Information
- Application Number
- JP2024056047
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2024-03-29
- Publication Date
- 2025-12-26
- Estimated Expiration
- 2044-03-29
AI Technical Summary
Conventional autonomous driving technologies struggle to accurately combine multiple roadway judgments for maintaining vehicle control, leading to potential errors in determining reliable road dividing lines.
A vehicle control device that recognizes road dividing lines and other vehicles, determines deviations between map and camera-based lines, and performs driving control based on the line closest to the vehicle's movement trajectory or with the smallest lane width change, depending on the presence of a preceding vehicle and lane width discrepancies.
Enhances vehicle control accuracy by combining multiple judgments, reducing erroneous determinations and maintaining stable driving even with lane width changes or lack of preceding vehicles.
Smart Images

Figure 0007792985000001 
Figure 0007792985000002 
Figure 0007792985000003
Abstract
Description
[Technical Field]
[0001] The present invention relates to a vehicle control device, a vehicle control method, and a program. [Background technology]
[0002] In recent years, efforts to provide access to sustainable transportation systems that take into consideration vulnerable transport participants have become more active. To achieve this, we are focusing on research and development into autonomous driving technology to further improve traffic safety and convenience.
[0003] In autonomous driving technology, road dividing lines recognized from a camera image (hereinafter sometimes referred to as camera road dividing lines) are confirmed to match road dividing lines recognized from map information (hereinafter sometimes referred to as map road dividing lines), and driving control of the vehicle is performed based on the matched camera road dividing lines and map road dividing lines on either side. At this time, it is estimated which of the camera road dividing lines or the map road dividing lines has a higher reliability. For example, Patent Document 1 describes a technology that compares the map road dividing lines with the driving trajectory of a preceding vehicle and determines that the map road dividing lines are unreliable if they are not similar. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] Japanese Patent Application Publication No. 2017-146724 Summary of the Invention [Problem to be solved by the invention]
[0005] As described above, conventional technology compares the reliability of road dividing lines on a map by comparing them with the driving trajectory of a preceding vehicle, but it has not been possible to combine multiple roadway judgments to accurately maintain vehicle driving control.
[0006] The present invention has been made in consideration of the above circumstances, and an object of the present invention is to provide a vehicle control device, a vehicle control method, and a program that can continue to accurately control vehicle travel by combining multiple path judgments, thereby contributing to the development of sustainable transportation systems. [Means for solving the problem]
[0007] The vehicle control device according to the present invention employs the following configuration. (1) A vehicle control device according to one aspect of the present invention includes a recognition unit that recognizes road dividing lines and other vehicles that exist in the traveling direction of a vehicle, a determination unit that determines whether the recognized road dividing lines match map road dividing lines based on map information stored in a storage unit, and determines a deviation between the matched recognized road dividing lines and the map road dividing lines, a calculation unit that calculates the distance between the road dividing lines on both sides of each of the recognized road dividing lines and the map road dividing lines as a lane width, and a calculation unit that calculates the lane width of the vehicle based on at least one of the recognized road dividing lines and the map road dividing lines. and a control unit that performs both driving controls, and when the determination unit determines that there is a discrepancy between the recognized road dividing line and the map road dividing line, if the other vehicle is recognized by the recognition unit, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle, while when the other vehicle is not recognized by the recognition unit, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever has the smaller change in lane width.
[0008] (2): In the above aspect (1), the control unit performs the driving control based on the map road dividing line when the change in the lane width of the recognized road dividing line is equal to or greater than a threshold value, while performing the driving control based on the recognized road dividing line when the change in the lane width of the map road dividing line is equal to or greater than the threshold value.
[0009] (3): In the above aspect (1), when it is determined that both the recognized road dividing line and the map road dividing line are along the movement trajectory of the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle.
[0010] (4): In the above aspect (1), when the determination unit determines that the recognized road dividing line and the map road dividing line match on only one side and that a deviation has occurred on that side, if the recognition unit recognizes the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle, while if the recognition unit does not recognize the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever has the smaller change in lane width.
[0011] (5): In the aspect (1) above, when the vehicle is not changing lanes and the judgment unit determines that there is a discrepancy between the recognized road dividing line and the map road dividing line, if the recognition unit recognizes the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle, while if the recognition unit does not recognize the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever has the smaller change in lane width.
[0012] (6): In the aspect (1) above, when the index value representing the degree of curvature of the vehicle's driving lane is equal to or less than a predetermined value and the judgment unit determines that there is a deviation between the recognized road dividing line and the map road dividing line, if the other vehicle is recognized by the recognition unit, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle, while if the other vehicle is not recognized by the recognition unit, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever has the smaller change in lane width.
[0013] (7): In the aspect (1) above, when the vehicle is not traveling near a branch road and the judgment unit determines that there is a discrepancy between the recognized road dividing line and the map road dividing line, if the recognition unit recognizes the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle, while if the recognition unit does not recognize the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever has the smaller change in lane width.
[0014] (8): In another aspect of the present invention, a vehicle control method is provided in which a computer mounted on a vehicle recognizes road dividing lines and other vehicles existing in the direction of travel of the vehicle, determines whether the recognized road dividing lines match map road dividing lines based on map information stored in a memory unit, determines the deviation between the matched recognized road dividing lines and the map road dividing lines, calculates the distance between the road dividing lines on both sides of each of the recognized road dividing lines and the map road dividing lines as the lane width, and performs driving control of the vehicle based on at least one of the recognized road dividing lines and the map road dividing lines.If it is determined that there is a deviation between the recognized road dividing lines and the map road dividing lines, when the other vehicle is recognized, the driving control is performed based on the recognized road dividing line or the map road dividing line that is closer to the movement trajectory of the other vehicle, while when the other vehicle is not recognized, the driving control is performed based on the recognized road dividing line or the map road dividing line that has the smaller change in lane width.
[0015] (9): Another aspect of the present invention provides a program that causes a computer mounted on a vehicle to recognize road dividing lines and other vehicles in the direction of travel of the vehicle, determine whether the recognized road dividing lines match map road dividing lines based on map information stored in a memory unit, and determine the deviation between the matched recognized road dividing lines and the map road dividing lines, calculate the distance between the road dividing lines on both sides of each of the recognized road dividing lines and the map road dividing lines as the lane width, and perform driving control of the vehicle based on at least one of the recognized road dividing lines and the map road dividing lines.If it is determined that there is a deviation between the recognized road dividing line and the map road dividing line, when the other vehicle is recognized, the driving control is performed based on the recognized road dividing line or the map road dividing line that is closer to the movement trajectory of the other vehicle, while when the other vehicle is not recognized, the driving control is performed based on the recognized road dividing line or the map road dividing line that has the smaller change in lane width. [Effects of the Invention]
[0016] According to the above aspects (1) to (9), by combining a plurality of roadway judgments, it is possible to continue controlling the vehicle's running with high accuracy.
[0017] According to the above aspect (1), if there is no preceding vehicle ahead of the vehicle, the recognized road dividing line or the map road dividing line, whichever results in the smaller change in lane width, is selected and driving control is continued, and if there is no preceding vehicle, the line closest to the preceding vehicle is selected and driving control is continued, thereby making it possible to continue driving control with greater accuracy than when determining based on lane width alone.
[0018] According to the above aspect (2), if there is an extremely large change in lane width between the recognized road dividing line and the map road dividing line, it is determined to be a false detection, and driving control can be continued based on the lane with the smaller change in width, regardless of the presence of a preceding vehicle.
[0019] According to the above aspect (3), even if both the recognized road dividing line and the map road dividing line are aligned with the movement trajectory of the preceding vehicle, driving control can be continued based on the line with the smaller change in lane width.
[0020] According to the above aspect (4), when the recognized road dividing line and the map road dividing line coincide on only one side, driving control can be continued based on either the recognized road dividing line or the map road dividing line.
[0021] According to the above aspects (5) to (7), it is possible to suppress erroneous determinations in this determination process. [Brief explanation of the drawings]
[0022] [Figure 1] 1 is a configuration diagram of a vehicle system using a vehicle control device according to an embodiment. [Figure 2] FIG. 2 is a functional configuration diagram of a first control unit and a second control unit. [Figure 3] FIG. 2 is a diagram illustrating an example of a correspondence relationship between a driving mode, a control state of a host vehicle, and a task. [Figure 4]FIG. 1 is a diagram for explaining an erroneous selection of a running path in the prior art. [Figure 5] 1 is a diagram for explaining an outline of basic processing according to an embodiment and invention processings 1 and 2.
[0023] FIG. [Figure 6] FIG. 10 is a diagram for explaining details of basic processing according to the embodiment. [Figure 7] FIG. 2 is a diagram for explaining details of the present invention process 1 according to the embodiment. [Figure 8] 10 is a graph for explaining a method for determining road dividing lines to be output in the processing 1 of the present invention. [Figure 9] 10 is a flowchart showing an example of the flow of a second inventive process according to the embodiment. DETAILED DESCRIPTION OF THE INVENTION
[0023] Hereinafter, embodiments of a vehicle control device, a vehicle control method, and a program according to the present invention will be described with reference to the drawings.
[0024] [Overall configuration] 1 is a configuration diagram of a vehicle system 1 that uses a vehicle control device according to an embodiment. The vehicle on which the vehicle system 1 is mounted may be, for example, a two-wheeled, three-wheeled, or four-wheeled vehicle, and its drive source may be an internal combustion engine such as a diesel engine or a gasoline engine, an electric motor, or a combination of these. The electric motor operates using power generated by a generator connected to the internal combustion engine, or discharged power from a secondary battery or a fuel cell.
[0025] The vehicle system 1 includes, for example, a camera 10, a radar device 12, a LIDAR (Light Detection and Ranging) 14, an object recognition device 16, a communication device 20, an HMI (Human Machine Interface) 30, vehicle sensors 40, a navigation device 50, an MPU (Map Positioning Unit) 60, a driver monitor camera 70, a driving operator 80, an automatic driving control device 100, a driving force output device 200, a braking device 210, and a steering device 220. These devices and equipment are connected to each other via multiplexed communication lines such as a CAN (Controller Area Network) communication line, serial communication lines, a wireless communication network, etc. Note that the configuration shown in FIG. 1 is merely an example, and some of the configuration may be omitted, or other configurations may be added.
[0026] The camera 10 is, for example, a digital camera using a solid-state imaging element such as a CCD (Charge Coupled Device) or a CMOS (Complementary Metal Oxide Semiconductor). The camera 10 is attached to any location of a vehicle (hereinafter referred to as the host vehicle M) in which the vehicle system 1 is installed. When capturing an image of the front, the camera 10 is attached to the top of the front windshield, the back of the rearview mirror, or the like. The camera 10, for example, periodically and repeatedly captures images of the surroundings of the host vehicle M. The camera 10 may be a stereo camera.
[0027] The radar device 12 emits radio waves such as millimeter waves around the vehicle M and detects radio waves reflected by an object (reflected waves) to detect at least the position (distance and direction) of the object. The radar device 12 is attached to any location on the vehicle M. The radar device 12 may detect the position and speed of an object using an FM-CW (Frequency Modulated Continuous Wave) method.
[0028] The LIDAR 14 irradiates the surroundings of the vehicle M with light (or electromagnetic waves with wavelengths similar to light) and measures the scattered light. The LIDAR 14 detects the distance to the target based on the time between light emission and light reception. The irradiated light is, for example, pulsed laser light. The LIDAR 14 is attached to any location on the vehicle M.
[0029] The object recognition device 16 performs sensor fusion processing on the detection results from some or all of the camera 10, the radar device 12, and the LIDAR 14 to recognize the position, type, speed, etc. of the object. The object recognition device 16 outputs the recognition results to the automatic driving control device 100. The object recognition device 16 may output the detection results from the camera 10, the radar device 12, and the LIDAR 14 directly to the automatic driving control device 100. The object recognition device 16 may be omitted from the vehicle system 1.
[0030] The communication device 20 communicates with other vehicles in the vicinity of the vehicle M, for example, using a cellular network, a Wi-Fi network, Bluetooth (registered trademark), DSRC (Dedicated Short Range Communication), etc., or communicates with various server devices via a wireless base station.
[0031] The HMI 30 presents various information to the occupants of the vehicle M and accepts input operations by the occupants. The HMI 30 includes various display devices, a speaker, a buzzer, a touch panel, switches, keys, and the like.
[0032] The vehicle sensor 40 includes a vehicle speed sensor that detects the speed of the host vehicle M, an acceleration sensor that detects acceleration, a yaw rate sensor that detects angular velocity around a vertical axis, a direction sensor that detects the direction of the host vehicle M, and the like.
[0033] The navigation device 50 includes, for example, a GNSS (Global Navigation Satellite System) receiver 51, a navigation HMI 52, and a route determination unit 53. The navigation device 50 stores first map information 54 in a storage device such as a hard disk drive (HDD) or flash memory. The GNSS receiver 51 identifies the position of the vehicle M based on signals received from GNSS satellites. The position of the vehicle M may be identified or supplemented by an inertial navigation system (INS) that uses the output of the vehicle sensors 40. The navigation HMI 52 includes a display device, a speaker, a touch panel, keys, etc. The navigation HMI 52 may share some or all of the components with the HMI 30 described above. The route determination unit 53 determines, for example, a route (hereinafter, a map route) from the position of the vehicle M identified by the GNSS receiver 51 (or any input position) to a destination input by the occupant using the navigation HMI 52, with reference to the first map information 54. The first map information 54 is information that represents road shapes using, for example, links indicating roads and nodes connected by the links. The first map information 54 may also include information such as road curvature and POI (Point of Interest) information. The route on the map is output to the MPU 60. The navigation device 50 may provide route guidance using the navigation HMI 52 based on the route on the map. The navigation device 50 may be realized, for example, by the functions of a terminal device such as a smartphone or tablet device owned by the occupant. The navigation device 50 may transmit the current position and destination to a navigation server via the communication device 20 and obtain a route equivalent to the route on the map from the navigation server.
[0034] The MPU 60 includes, for example, a recommended lane determination unit 61, and stores second map information 62 in a storage device such as an HDD or flash memory. The recommended lane determination unit 61 divides the route on the map provided by the navigation device 50 into a plurality of blocks (for example, by dividing it into 100 m intervals in the vehicle travel direction), and determines a recommended lane for each block by referring to the second map information 62. The recommended lane determination unit 61 determines, for example, which lane from the left the vehicle should travel in. When there is a branch point on the route on the map, the recommended lane determination unit 61 determines a recommended lane so that the vehicle M can travel on a reasonable route to the branch point.
[0035] The second map information 62 is map information with higher accuracy than the first map information 54. The second map information 62 includes, for example, information on the centers of lanes or information on lane boundaries. The second map information 62 may also include road information, traffic regulation information, address information (address and postal code), facility information, telephone number information, information on prohibited sections where mode A or mode B, described below, is prohibited, and the like. The second map information 62 may be updated as needed by the communication device 20 communicating with another device.
[0036] The driver monitor camera 70 is, for example, a digital camera that uses a solid-state imaging element such as a CCD or CMOS. The driver monitor camera 70 is attached to any location on the vehicle M in a position and orientation that allows it to capture an image of the head of an occupant (hereinafter, driver) seated in the driver's seat of the vehicle M from the front (in an orientation that captures an image of the face). For example, the driver monitor camera 70 is attached to the top of a display device provided in the center of the instrument panel of the vehicle M.
[0037] The driving operators 80 include, for example, a steering wheel 82, an accelerator pedal, a brake pedal, a shift lever, and other operators. The driving operators 80 are equipped with sensors that detect the amount of operation or the presence or absence of operation, and the detection results are output to the automatic driving control device 100 or some or all of the driving force output device 200, the brake device 210, and the steering device 220. The steering wheel 82 is an example of an "operator that accepts steering operation by the driver." The operator does not necessarily have to be annular and may be in the form of an irregular steering wheel, a joystick, a button, or the like. A steering grip sensor 84 is attached to the steering wheel 82. The steering grip sensor 84 is realized by a capacitance sensor or the like, and outputs a signal to the automatic driving control device 100 that can detect whether the driver is gripping the steering wheel 82 (meaning that the driver is in contact with the steering wheel in a state where force can be applied).
[0038] The automatic driving control device 100 includes, for example, a first control unit 120 and a second control unit 160. The first control unit 120 and the second control unit 160 are each realized by, for example, a hardware processor such as a CPU (Central Processing Unit) executing a program (software). Some or all of these components may be realized by hardware (including circuitry) such as an LSI (Large Scale Integration), an ASIC (Application Specific Integrated Circuit), an FPGA (Field-Programmable Gate Array), a GPU (Graphics Processing Unit), or an SOC (System On Chip), or may be realized by a combination of software and hardware. The program may be stored in advance in a storage device (a storage device having a non-transitory storage medium) such as a HDD or flash memory of the automatic driving control device 100, or may be stored in a removable storage medium such as a DVD or CD-ROM, and installed in the HDD or flash memory of the automatic driving control device 100 by inserting the storage medium (non-transitory storage medium) into a drive device. The automatic driving control device 100 is an example of a "vehicle control device."
[0039] FIG. 2 is a functional configuration diagram of the first control unit 120 and the second control unit 160. The first control unit 120 includes, for example, a recognition unit 130, a determination unit 132, an action plan generation unit 140, and a mode determination unit 150. The first control unit 120, for example, implements functions based on AI (Artificial Intelligence) and functions based on a predefined model in parallel. For example, the function of "recognizing intersections" may be implemented by executing intersection recognition using deep learning or the like and recognition based on predefined conditions (such as traffic lights and road markings that can be pattern-matched) in parallel, and then scoring and comprehensively evaluating both. This ensures the reliability of autonomous driving.
[0040] The recognition unit 130 recognizes the position, speed, acceleration, and other states of objects around the vehicle M based on information input from the camera 10, the radar device 12, and the LIDAR 14 via the object recognition device 16. The position of an object is recognized as a position on an absolute coordinate system with a representative point of the vehicle M (such as the center of gravity or the center of the drive shaft) as the origin, and is used for control. The position of an object may be represented by a representative point such as the center of gravity or a corner of the object, or may be represented by an area. The "state" of an object may include the acceleration or jerk of the object, or the "behavioral state" (for example, whether the object is changing lanes or is about to change lanes).
[0041] The recognition unit 130 also recognizes, for example, the lane in which the host vehicle M is traveling (driving lane). For example, the recognition unit 130 recognizes the driving lane by comparing the pattern of road dividing lines obtained from the second map information 62 (hereinafter, sometimes referred to as "map road dividing lines") with the pattern of road dividing lines around the host vehicle M recognized from an image captured by the camera 10 (hereinafter, sometimes referred to as "camera road dividing lines"). More specifically, the determination unit 132 of the recognition unit 130 calculates, for example, the deviation between the map road dividing lines and the camera road dividing lines, and if it determines that the calculated deviation is equal to or less than a predetermined value (i.e., if it determines that they match), it recognizes at least one of the map road dividing lines and the camera road dividing lines (or their midline, etc.) as the driving lane. Here, the deviation may be, for example, the angle between the map road dividing line and the camera road dividing line or the distance between the map road dividing line and the camera road dividing line. When calculating the distance between the map road-dividing line and the camera road-dividing line, for example, one or more representative points may be extracted from each of the map road-dividing line and the camera road-dividing line within a predetermined range in the traveling direction of the vehicle M, and the distance between these representative points may be used as the deviation. The recognition unit 130 may recognize road boundaries (road boundaries) including not only road-dividing lines but also road-dividing lines, road shoulders, curbs, medians, guardrails, etc. to recognize the driving lane. This recognition may take into account the position of the vehicle M obtained from the navigation device 50 and the processing results of the INS. The recognition unit 130 may also recognize stop lines, obstacles, red lights, toll booths, and other road phenomena. The camera road-dividing line is an example of a "recognized road-dividing line" in the claims.
[0042] When recognizing the driving lane, the recognition unit 130 recognizes the position and attitude of the host vehicle M with respect to the driving lane. For example, the recognition unit 130 may recognize the deviation of the reference point of the host vehicle M from the center of the lane and the angle it forms with a line connecting the centers of the lanes in the traveling direction of the host vehicle M as the relative position and attitude of the host vehicle M with respect to the driving lane. Alternatively, the recognition unit 130 may recognize the position of the reference point of the host vehicle M with respect to either side edge of the driving lane (a road dividing line or a road boundary) as the relative position of the host vehicle M with respect to the driving lane.
[0043] The behavior plan generation unit 140 automatically (without driver input) generates a target trajectory for the host vehicle M to travel in the recommended lane determined by the recommended lane determination unit 61, and to avoid approaching any objects recognized by the recognition unit 130 (excluding objects that can be overcome, such as road dividing lines, road markings, and manholes). For example, the recognition unit 130 sets a risk area centered on the object whose status has been output, and within the risk area, the recognition unit 130 sets a risk as an index value indicating the degree to which the host vehicle M should not approach. The behavior plan generation unit 140 generates a target trajectory for the host vehicle M to avoid passing through points where the risk is equal to or greater than a predetermined value and to travel within the recognized travel lane. Because some objects are moving, the risk distribution is not one per control cycle, but is set for multiple future time points, taking into account the future position of the object predicted based on the object's speed. For example, the target trajectory is expressed as a sequential list of points (trajectory points) to be reached by the host vehicle M. The trajectory points are points that the host vehicle M should reach at every predetermined travel distance (for example, about several meters) along the road, and separately, the target speed and target acceleration are generated as part of the target trajectory at every predetermined sampling time (for example, about a few tenths of a second). The trajectory points may also be positions that the host vehicle M should reach at every predetermined sampling time. In this case, the information on the target speed and target acceleration is expressed as the interval between the trajectory points.
[0044] Furthermore, in this embodiment, when the determination unit 132 determines that the map road dividing line and the camera road dividing line match on only one side, the behavior plan generation unit 140 generates a target trajectory for the host vehicle M to travel along (at least taking into consideration) the matched map road dividing line and camera road dividing line. As an example, the behavior plan generation unit 140 generates a target trajectory for the host vehicle M to travel at a point shifted a predetermined distance from the matched map road dividing line and camera road dividing line.
[0045] The behavior plan generation unit 140 may set an autonomous driving event when generating the target trajectory. The autonomous driving events include a constant speed driving event, a low-speed following driving event, a lane change event, a branching event, a merging event, a takeover event, etc. The behavior plan generation unit 140 generates a target trajectory according to the activated event.
[0046] The mode determination unit 150 determines the driving mode of the host vehicle M to be one of a plurality of driving modes that assign different tasks to the driver. FIG. 3 is a diagram showing an example of the correspondence between the driving modes, the control state of the host vehicle M, and the tasks. The driving modes of the host vehicle M include, for example, five modes, Mode A to Mode E. The control state, i.e., the degree of automation of the driving control of the host vehicle M, is Mode A, which is the highest, followed by Mode B, Mode C, and Mode D, with Mode E being the lowest. Conversely, the tasks assigned to the driver are Mode A, which is the lightest, followed by Mode B, Mode C, and Mode D, with Mode E being the most severe. Note that Modes D and E are non-autonomous driving control states, and therefore the autonomous driving control device 100 is responsible for terminating control related to autonomous driving and transitioning to driving assistance or manual driving. The contents of each driving mode are exemplified below.
[0047] In Mode A, the vehicle is in an autonomous driving state, and the driver is not required to monitor the road ahead or grip the steering wheel 82 (in the figure, gripping the steering wheel). However, even in Mode A, the driver is required to be in a position where he or she can quickly switch to manual driving in response to a request from a system centered on the automatic driving control device 100. Note that, as used herein, "automatic driving" refers to control of both steering and acceleration / deceleration without driver input. "Ahead" refers to the space in the direction of travel of the host vehicle M, as viewed through the front windshield. Mode A is a driving mode that can be implemented, for example, on a motorway such as an expressway, when certain conditions are met, such as the host vehicle M traveling at a predetermined speed (e.g., approximately 50 km / h) or less and there is a vehicle ahead to be followed, and is sometimes referred to as TJP (Traffic Jam Pilot). If these conditions are no longer met, the mode determination unit 150 changes the driving mode of the host vehicle M to Mode B.
[0048] In mode B, the vehicle is in a driving assistance state, and the driver is tasked with monitoring the area ahead of the vehicle M (hereinafter referred to as forward monitoring), but is not tasked with holding the steering wheel 82. In mode C, the vehicle is in a driving assistance state, and the driver is tasked with monitoring the area ahead and holding the steering wheel 82. Mode D is a driving mode that requires some degree of driver operation for at least one of steering and acceleration / deceleration of the vehicle M. For example, in mode D, driving assistance such as ACC (Adaptive Cruise Control) and LKAS (Lane Keeping Assist System) is provided. Mode E is a manual driving state in which the driver must perform both steering and acceleration / deceleration operations. In both mode D and mode E, the driver is naturally tasked with monitoring the area ahead of the vehicle M.
[0049] The driving modes are not limited to those illustrated in FIG. 3 and may be defined by other definitions. For example, among driving modes that require both forward monitoring and gripping the steering wheel, there may be driving modes with lenient thresholds for determining that the steering wheel is being gripped and driving modes with stricter thresholds. More specifically, driving modes may be defined such that in one driving mode, it is sufficient for the driver to have either the left or right hand touching the steering wheel 82, while in another driving mode that imposes a heavier task on the driver, the driver must grip the steering wheel 82 with both hands with a strength equal to or greater than a threshold. Driving modes that differ in the severity of the tasks imposed on the driver may be defined in any other way.
[0050] The automatic driving control device 100 (and the driving assistance device (not shown)) executes an automated lane change according to the driving mode. There are two types of automated lane changes: a system-requested automated lane change (1) and a driver-requested automated lane change (2). The automated lane change (1) is an automated lane change for overtaking, which is performed when the speed of the vehicle ahead is slower than the speed of the vehicle itself by a standard or more, and an automated lane change for proceeding toward the destination (an automated lane change due to a change in the recommended lane). The automated lane change (2) is a lane change in which, when conditions related to the speed and the positional relationship with surrounding vehicles are met and the driver operates the turn signal, the vehicle M changes lanes in the direction of the operation.
[0051] In mode A, the automatic driving control device 100 does not perform either automated lane change (1) or (2). In modes B and C, the automatic driving control device 100 performs either automated lane change (1) or (2). In mode D, the driving assistance device (not shown) does not perform automated lane change (1), but performs automated lane change (2). In mode E, neither automated lane change (1) nor (2) is performed.
[0052] When the driver does not perform a task related to the determined driving mode (hereinafter, the current driving mode), the mode determination unit 150 changes the driving mode of the vehicle M to a driving mode with a more severe task.
[0053] For example, in mode A, if the driver is in a position where he or she cannot switch to manual driving in response to a request from the system (for example, if the driver continues to look away from the road outside the allowable area or if a sign of driving difficulty is detected), the mode determination unit 150 uses the HMI 30 to prompt the driver to switch to manual driving, and if the driver does not comply, the mode determination unit 150 performs control such as pulling the host vehicle M to the shoulder of the road and gradually stopping it, and stopping the automatic driving. After the automatic driving is stopped, the host vehicle enters a state of mode D or E, and the host vehicle M can be started by manual operation by the driver. The same applies below to "stopping automatic driving." In mode B, if the driver is not monitoring the road ahead, the mode determination unit 150 performs control such as prompting the driver to monitor the road ahead using the HMI 30, and if the driver does not comply, pulling the host vehicle M to the shoulder of the road and gradually stopping it, and stopping the automatic driving. In mode C, if the driver is not monitoring the road ahead or is not gripping the steering wheel 82, the mode determination unit 150 uses the HMI 30 to prompt the driver to monitor the road ahead and / or grip the steering wheel 82, and if the driver does not comply, the mode determination unit 150 controls the vehicle M to move to the shoulder of the road and gradually stop, thereby terminating automatic driving.
[0054] The mode determination unit 150 further monitors the driver's state for the above-mentioned mode change and determines whether the driver's state is appropriate for the task. For example, the mode determination unit 150 analyzes the image captured by the driver monitor camera 70 and performs posture estimation processing to determine whether the driver is in a position that prevents them from switching to manual driving in response to a request from the system. In addition, the driver state determination unit 152 analyzes the image captured by the driver monitor camera 70 and performs line-of-sight estimation processing to determine whether the driver is monitoring the road ahead.
[0055] Furthermore, in this embodiment, if the determination unit 132 determines that the map road dividing lines and the camera road dividing lines do not match on both sides, the mode determination unit 150 changes the driving mode of the host vehicle M to a driving mode with a more difficult task. For example, if the mode determination unit 150 determines that the map road dividing lines and the camera road dividing lines do not match on both sides while the host vehicle M is traveling in a driving mode (mode A or mode B) that does not require gripping the steering wheel, the mode determination unit 150 changes the driving mode to mode C or a lower mode.
[0056] Furthermore, in this embodiment, when the determination unit 132 determines that the map road dividing line and the camera road dividing line match only on one side while the host vehicle M is traveling in a driving mode (mode A or mode B) that does not require gripping the steering wheel, the mode determination unit 150 continues the driving mode of mode A or mode B. In this case, as described above, the action plan generation unit 140 generates a target trajectory that follows the matched map road dividing line or camera road dividing line.
[0057] The mode determination unit 150 further performs various processes for changing the mode. For example, the mode determination unit 150 instructs the action plan generation unit 140 to generate a target trajectory for stopping on the shoulder of the road, instructs a driving assistance device (not shown) to operate, and controls the HMI 30 to prompt the driver to take action.
[0058] The second control unit 160 controls the traveling driving force output device 200, the braking device 210, and the steering device 220 so that the host vehicle M passes through the target trajectory generated by the action plan generation unit 140 at the scheduled time.
[0059] Returning to FIG. 2, the second control unit 160 includes, for example, an acquisition unit 162, a speed control unit 164, and a steering control unit 166. The acquisition unit 162 acquires information on the target trajectory (trajectory points) generated by the action plan generation unit 140 and stores it in a memory (not shown). The speed control unit 164 controls the driving force output device 200 or the brake device 210 based on a speed element associated with the target trajectory stored in the memory. The steering control unit 166 controls the steering device 220 according to the curvature of the target trajectory stored in the memory. The processing of the speed control unit 164 and the steering control unit 166 is realized by, for example, a combination of feedforward control and feedback control. As an example, the steering control unit 166 executes a combination of feedforward control according to the curvature of the road ahead of the host vehicle M and feedback control based on the deviation from the target trajectory.
[0060] The driving force output device 200 outputs a driving force (torque) for the vehicle to travel to the drive wheels. The driving force output device 200 includes, for example, a combination of an internal combustion engine, an electric motor, a transmission, etc., and an ECU (Electronic Control Unit) that controls these. The ECU controls the above components according to information input from the second control unit 160 or information input from the driving operator 80.
[0061] Braking device 210 may include, for example, a brake caliper, a cylinder that transmits hydraulic pressure to the brake caliper, an electric motor that generates hydraulic pressure in the cylinder, and a brake ECU. The brake ECU controls the electric motor according to information input from second control unit 160 or information input from driving operation device 80, so that a brake torque corresponding to the braking operation is output to each wheel. Braking device 210 may include a backup mechanism that transmits hydraulic pressure generated by operation of a brake pedal included in driving operation device 80 to the cylinder via a master cylinder. Note that braking device 210 is not limited to the configuration described above, and may also be an electronically controlled hydraulic brake device that controls an actuator according to information input from second control unit 160 to transmit hydraulic pressure from a master cylinder to the cylinder.
[0062] The steering device 220 includes, for example, a steering ECU and an electric motor. The electric motor applies a force to a rack and pinion mechanism to change the direction of the steered wheels. The steering ECU drives the electric motor in accordance with information input from the second control unit 160 or information input from the driving operator 80 to change the direction of the steered wheels.
[0063] [Processing when one-sided match occurs] As described above, the determination unit 132 compares the map road dividing lines and the camera road dividing lines on both sides, and if it determines that the map road dividing lines and the camera road dividing lines match on at least one side, the action plan generation unit 140 generates a target trajectory for the host vehicle M to travel along the matched map road dividing lines and camera road dividing lines. However, for example, if the camera road dividing lines and the map road dividing lines do not match on one side, while the camera road dividing lines and the map road dividing lines match only on the other side, and then a deviation occurs between the camera road dividing lines and the map road dividing lines on the matched side, conventional technology could erroneously select the camera road dividing line or the map road dividing line that shows the smaller change in lane width for driving control.
[0064] FIG. 4 is a diagram illustrating erroneous lane selection in the prior art. In FIG. 4, the symbol L represents the lane in which the host vehicle M is traveling, the symbol M1 represents a preceding vehicle of the host vehicle M, the symbol AL represents an actual road dividing line, the symbol CL represents a camera road dividing line for the traveling lane L, and the symbol ML represents a map road dividing line for the traveling lane L. FIG. 4 illustrates, as an example, a situation in which a mismatch between the camera road dividing line CL and the map road dividing line ML is determined for the left side, and a match between the camera road dividing line CL and the map road dividing line ML is determined for the right side. For example, the camera road dividing line CL and the map road dividing line ML shown on the left side were determined to be inconsistent in a previous determination, and this determination has been continued for a predetermined period, and the previous mismatch determination is also held for this determination.
[0065] As shown in Figure 4, even on the right side where the camera-captured road dividing line CL and the map-captured road dividing line ML were determined to match, a deviation occurs in the deviation region DR. This situation can occur, for example, when the actual road dividing line AL is redrawn from a straight road due to construction or other reasons, and the camera-captured road dividing line CL properly captures the road dividing line AL, but the map-captured road dividing line ML has not been updated. In such cases, prior art has calculated the distance between both sides of the camera-captured road dividing line CL and the map-captured road dividing line ML over time as the lane width, and used the lane dividing line with the least change in lane width as the more reliable road dividing line for automated driving or driver assistance. 4, for example, the change ΔWcam = |d(t2)_C - d(t1)_C| between the lane width d(t1)_C of the camera road dividing line ML at time t1 and the lane width d(t2)_C of the camera road dividing line ML at time t2 is a positive value, whereas the change ΔWmap = |d(t2)_M - d(t1)_M| between the lane width d(t1)_M of the map road dividing line ML at time t1 and the lane width d(t2)_M of the map road dividing line ML at time t2 is zero. Therefore, in conventional technology, the map road dividing line ML, which has a smaller change in lane width, may be mistakenly used as a more reliable road dividing line for automated driving or driver assistance.
[0066] In light of the above circumstances, in this embodiment, the behavior plan generation unit 140 combines a process for selecting road-dividing lines based on the amount of change in lane width (basic process) with a process for selecting road-dividing lines based on the movement trajectory of the preceding vehicle (process 1 of the present invention), and then arbitrates the results of these processes (process 2 of the present invention) to ultimately determine the road-dividing lines to be used for cruise control. When there is no preceding vehicle ahead of the host vehicle M, the behavior plan generation unit 140 executes only the basic process described below to determine the road-dividing lines to be used for cruise control.
[0067] 5 is a diagram illustrating an overview of basic processing according to an embodiment and invention processes 1 and 2. As shown in FIG. 5, the processing according to this embodiment includes basic processing that selects one of the camera road lane lines CL and the map road lane lines ML as a selected road lane line in accordance with inputs of the camera road lane lines CL, the map road lane lines ML, and the camera lateral position / angle change amount, invention process 1 that selects one of the camera road lane lines CL and the map road lane lines ML as a selected road lane line in accordance with inputs of the camera road lane lines CL, the map road lane lines ML, and the movement trajectory of the preceding vehicle M1, and invention process 2 that selects one of the camera road lane lines CL and the map road lane lines ML as a selected road lane line to be ultimately used for cruise control, in accordance with inputs of the selected road lane lines output by the basic processing, the selected road lane lines output by invention process 1, and the camera lateral position / angle change amount. In the situation shown in Figure 4 above, while the map road-dividing line ML is output by the basic processing, in combination with inventive processes 1 and 2, the camera road-dividing line CL is ultimately determined to be the road-dividing line to be used for cruise control. Therefore, by combining multiple lane determinations, it is possible to continue cruise control of the vehicle with high accuracy. The basic processing and inventive processes 1 and 2 are explained in detail below. Note that the following processing is executed in a situation similar to that shown in Figure 4, where the determination unit 132 determines that the camera road-dividing line CL and the map road-dividing line ML coincide on only one side and that a deviation has occurred between the camera road-dividing line CL and the map road-dividing line ML on that side.
[0068] [Basic processing] Fig. 6 is a diagram for explaining the details of the basic processing according to the embodiment. The table shown in Fig. 6 specifies that, in principle, the road-dividing line with the smaller lane width change (ΔWcam or ΔWmap) is evaluated as more reliable and selected as the road-dividing line to be used for cruise control. When lane width changes are about the same, the camera-based road-dividing line CL, which generally tends to be more reliable, is used preferentially.
[0069] First, as shown in patterns (a), (b), and (c) in Figure 6, if the lane width change ΔWcam of the camera-captured road-dividing line is less than the first threshold value Th1, the behavior plan generation unit 140 uses the camera-captured road-dividing line CL from the side where the camera-captured road-dividing line CL and the map-captured road-dividing line ML coincide. On the other hand, from the side where the camera-captured road-dividing line CL and the map-captured road-dividing line ML do not coincide, the behavior plan generation unit 140 uses the narrower road-dividing line between the camera-captured road-dividing line CL and the map-captured road-dividing line ML. The behavior plan generation unit 140 calculates the centerline of the lane by offsetting the camera-captured road-dividing line CL on the side where the two coincident road-dividing lines coincide by a distance Wm / 2, which is half the width Wm between the two adopted road-dividing lines.
[0070] Next, as shown in pattern (d) of Figure 6, if the lane width change ΔWcam of the camera road-dividing line is equal to or greater than the first threshold Th1 and less than the second threshold Th2 (Th2 > Th1), and the lane width change ΔWmap of the map road-dividing line ML is less than the first threshold Th1, the behavior plan generation unit 140 uses the map road-dividing line ML from the side where the camera road-dividing line CL and the map road-dividing line ML coincide. On the other hand, from the side where the camera road-dividing line CL and the map road-dividing line ML do not coincide, the behavior plan generation unit 140 uses the narrower road-dividing line between the camera road-dividing line CL and the map road-dividing line ML. The behavior plan generation unit 140 calculates the centerline of the lane by offsetting the map road-dividing line ML on the side where the two road-dividing lines coincide by a distance Wm / 2, which is half the width Wm between the two road-dividing lines used.
[0071] Next, as shown in patterns (e) and (f) of Figure 6, if the lane width change ΔWcam of the camera-recorded road-dividing line is equal to or greater than the first threshold value Th1 and less than the second threshold value Th2, and the lane width change ΔWmap of the map-recorded road-dividing line ML is equal to or greater than the first threshold value Th1, the behavior plan generation unit 140 uses the camera-recorded road-dividing line CL from the side where the camera-recorded road-dividing line CL and the map-recorded road-dividing line ML coincide. On the other hand, the behavior plan generation unit 140 uses the narrower road-dividing line between the camera-recorded road-dividing line CL and the map-recorded road-dividing line ML from the side where the camera-recorded road-dividing line CL and the map-recorded road-dividing line ML do not coincide. The behavior plan generation unit 140 calculates the centerline of the lane by offsetting the camera-recorded road-dividing line CL on the side where the two coincident road-dividing lines coincide by a distance Wm / 2, which is half the width Wm between the two road-dividing lines.
[0072] Next, as shown in patterns (g) and (h) in Figure 6, if the lane width change ΔWcam of the camera road-dividing line is equal to or greater than the second threshold Th2 and the lane width change ΔWmap of the map road-dividing line ML is less than the second threshold Th2, the behavior plan generation unit 140 uses the map road-dividing lines ML from both the side where the camera road-dividing line CL and the map road-dividing line ML coincide and the side where they do not coincide. In other words, the behavior plan generation unit 140 calculates the centerline of the lane by offsetting a distance Wm / 2, which is half the width Wm of the map road-dividing lines ML on both sides, from the side where they coincide.
[0073] Next, as shown in pattern (i) of Figure 6, if the lane width change ΔWcam of the camera road-dividing line and the lane width change ΔWmap of the map road-dividing line ML are equal to or greater than the second threshold value Th2, the behavior plan generation unit 140 uses the camera road-dividing line CL from the side where the camera road-dividing line CL and the map road-dividing line ML coincide. On the other hand, the behavior plan generation unit 140 uses the narrower road-dividing line between the camera road-dividing line CL and the map road-dividing line ML from the side where the camera road-dividing line CL and the map road-dividing line ML do not coincide. The behavior plan generation unit 140 calculates the centerline of the lane by offsetting the camera road-dividing line CL on the side where the two road-dividing lines coincide by a distance Wm / 2, which is half the width Wm between the two road-dividing lines used.
[0074] In this way, in basic processing, the behavior plan generation unit 140 refers to the table shown in Figure 6 in response to the input of the camera road dividing line CL and the map road dividing line ML, selects one of them, and outputs it as the selected road dividing line.
[0075] In the above process, the behavior plan generation unit 140 determines whether the camera lateral position / angle change amounts (i.e., the lateral position change amount of the camera road-dividing line CL and the angle change amount of the camera road-dividing line CL) calculated by the calculation unit 134 are equal to or greater than predetermined values. If either the lateral position change amount or the angle change amount is equal to or greater than the predetermined value (i.e., if the reliability of the camera road-dividing line CL is low), the map road-dividing line ML may be adopted regardless of the change amount of the lane width. Here, the camera lateral position change amount is calculated by subtracting the average value of the lateral coordinates of the points constituting the camera road-dividing line CL over a predetermined number of past samples (for example, supplemented by the momentum of the vehicle M or stored) from the average value of the lateral coordinates of the points constituting the camera road-dividing line CL within a predetermined range ahead of the vehicle M. Similarly, the camera angle change amount is the average value of the angle from the vehicle M of the points constituting the camera road dividing line CL in a specified range ahead of the vehicle M minus the average value of past specified samples of the angle from the vehicle M of the points constituting the camera road dividing line CL in the past (for example, supplemented by the momentum of the vehicle M or stored).
[0076] [Inventive Process 1] 7 is a diagram for explaining the details of the present invention process 1 according to the embodiment. The present invention process 1 is a process for determining whether the camera road-dividing line CL or the map road-dividing line ML is closer to the movement trajectory of the preceding vehicle. In FIG. 7, the host vehicle M is traveling on lane L1, and three other vehicles M1, M2, and M3 are traveling ahead of the host vehicle M.
[0077] If the determination unit 132 determines that there is a deviation between the camera road dividing line CL and the map road dividing line ML, the calculation unit 134 determines whether there are other vehicles whose number is equal to or greater than a third threshold within a predetermined distance from the host vehicle M. If it is determined that there are other vehicles whose number is equal to or greater than the third threshold within the predetermined distance from the host vehicle M, the calculation unit 134 calculates the parallelism between the trajectories of these other vehicles and the camera road dividing line CL using the method described below.
[0078] 7, the calculation unit 134 first calculates the travel trajectories T1, T2, and T3 for each of the other vehicles M1, M2, and M3. The calculation unit 134 can calculate the travel trajectories T1, T2, and T3 by measuring the displacement of the positions of the other vehicles M1, M2, and M3 over a predetermined period of time based on, for example, camera images.
[0079] Next, the calculation unit 134 calculates the deviation angles between the calculated traveling trajectories T1, T2, and T3 and the camera road dividing line CL and the map road dividing line ML. For example, in the case of Fig. 7, the calculation unit 134 calculates, for another vehicle M1, a deviation angle θc1 between the traveling trajectory T1 and the camera road dividing line CL1 (the camera road dividing line CL1 is illustrated by translating the camera road dividing line CL for the sake of convenience in explaining the calculation method. The same applies to CL2 and CL3 below) and a deviation angle θm1 between the traveling trajectory T1 and the map road dividing line ML1 (the map road dividing line ML1 is illustrated by translating the map road dividing line ML for the sake of convenience in explaining the calculation method. The same applies to ML2 and ML3 below). Similarly, the calculation unit 134 calculates, for the other vehicle M2, the deviation angle θc2 between the travel trajectory T2 and the camera road dividing line CL2, and the deviation angle θm2 between the travel trajectory T2 and the map road dividing line ML2. Similarly, for the other vehicle M3, the calculation unit 134 calculates the deviation angle θc3 between the travel trajectory T3 and the camera road dividing line CL3, and the deviation angle θm2 between the travel trajectory T3 and the map road dividing line ML3. Note that at this time, the calculation unit 134, for example, calculates the deviation angle as a positive deviation angle in the clockwise direction and a negative deviation angle in the counterclockwise direction based on the travel trajectory of the other vehicle (this setting may be reversed).
[0080] Next, the calculation unit 134 calculates, for each detected vehicle, the average value of the deviation angle between the calculated travel trajectory T1 and the camera road dividing line CL1 and the average value of the deviation angle between the travel trajectory T1 and the map road dividing line ML1. More specifically, in the case of Figure 7, the calculation unit 134 calculates the average value of the deviation angle between the travel trajectory T1 and the camera road dividing line CL1 using θc_av = (|θc1| + |θc2| + |θc3|) / 3, and calculates the average value of the deviation angle between the travel trajectory T1 and the map road dividing line ML1 using θm_av = (|θm1| + |θm2| + |θm3|) / 3.
[0081] Next, the calculation unit 134 calculates the parallelism between the detected travel trajectory T of the other vehicle and the camera road dividing line CL (map road dividing line ML) using θm_av-θc_av (θc_av-θm_av). That is, the parallelism θm_av-θc_av (θc_av-θm_av) can be considered an index value that indicates whether the other vehicle is traveling more parallel to the camera road dividing line CL or the map road dividing line ML. The larger the value of the parallelism θm_av-θc_av (θc_av-θm_av), the more parallel the other vehicle is traveling to the camera road dividing line CL (map road dividing line ML). The smaller the value of the parallelism θm_av-θc_av (θc_av-θm_av), the more parallel the other vehicle is traveling to the map road dividing line ML (camera road dividing line CL).
[0082] Figure 8 is a graph illustrating a method for determining the road-dividing line to be output in present invention process 1. As shown in Figure 8, if the calculated parallelism θm_av-θc_av (θc_av-θm_av) is equal to or greater than the fourth threshold (the area indicated by diagonal lines R), the action plan generator 140 determines that the reliability of the camera road-dividing line CL (map road-dividing line ML) is higher than the reliability of the map road-dividing line ML (camera road-dividing line CL), and outputs the camera road-dividing line CL (map road-dividing line ML) as the selected road-dividing line. The fourth threshold here is set to a value greater than zero, taking into account a safety margin.
[0083] If the behavior plan generation unit 140 determines that both the calculated parallelism θm_av-θc_av and the calculated parallelism θc_av-θm_av are equal to or greater than the fourth threshold, this means that both the camera road dividing line CL and the map road dividing line ML are aligned with the trajectory of the other vehicle, and it is impossible to determine which is more reliable. Therefore, the behavior plan generation unit 140 terminates the present invention process 1 (and the subsequent present invention process 2) and selects the line with the smaller change in lane width based only on the basic process. Similarly, if the behavior plan generation unit 140 determines that both the calculated parallelism θm_av-θc_av and the calculated parallelism θc_av-θm_av are less than the fourth threshold, this means that both the camera road dividing line CL and the map road dividing line ML are not aligned with the trajectory of the other vehicle, and the reliability of both is low. Therefore, the behavior plan generation unit 140 terminates the present invention process 1 (and the subsequent present invention process 2) and selects the line with the smaller change in lane width based only on the basic process. On the other hand, if it is determined that only one of the parallelism θm_av-θc_av and the parallelism θc_av-θm_av is equal to or greater than the fourth threshold, the behavior plan generation unit 140 outputs the road-dividing line corresponding to that parallelism as the selected road-dividing line. For example, if θm_av-θc_av is equal to or greater than the fourth threshold, the behavior plan generation unit 140 outputs the camera road-dividing line CL as the selected road-dividing line, whereas if θc_av-θm_av is equal to or greater than the fourth threshold, the behavior plan generation unit 140 outputs the map road-dividing line ML as the selected road-dividing line. This makes it possible to select the road-dividing line that is closer to the movement trajectory of the leading vehicle from among the camera road-dividing line CL and the map road-dividing line ML.
[0084] In addition to the above conditions, the behavior plan generation unit 140 may determine whether the deviation angle is equal to or less than a fifth threshold for the majority of other vehicles for which the average deviation value was calculated, and output either the parallelism θm_av-θc_av or the parallelism θc_av-θm_av as the selected road-dividing line only if it is determined that the deviation angle is equal to or less than the fifth threshold for the majority of other vehicles for which the average deviation value was calculated. This makes it possible to more accurately select, from the camera road-dividing line CL and the map road-dividing line ML, the road-dividing line that is closer to the movement trajectory of the leading vehicle.
[0085] Furthermore, in the present invention process 1, the action plan generation unit 140 may determine whether an additional condition is satisfied, and output the selected road-dividing line only if the additional condition is satisfied in addition to the above condition. However, if the additional condition is not satisfied, the present invention process 1 (and the subsequent present invention process 2) may be terminated, and the lane width change may be selected based on only the basic process. For example, the additional condition may include the determination by the determination unit 132 that the camera road-dividing line CL and the map road-dividing line ML coincide on only one side and that a deviation has occurred between the camera road-dividing line CL and the map road-dividing line ML on that side. Furthermore, for example, the additional condition may include the other vehicle that is the target of the present invention process 1 being at a distance of a predetermined distance or more from the host vehicle M. Furthermore, for example, the additional condition may include the deviation between the camera road-dividing line CL and the map road-dividing line ML on the coincident side being at a predetermined angle or more within a predetermined range ahead of the host vehicle M.
[0086] The additional condition may further be a condition for excluding a situation in which the accuracy of the present invention processes 1 and 2 is expected to decrease. For example, the additional condition may include the host vehicle M not being in the middle of changing lanes. The behavior plan generation unit 140 may determine whether the host vehicle M is in the middle of changing lanes, for example, based on whether the host vehicle M crosses a camera road dividing line CL or a map road dividing line ML while operating a turn signal. For example, the additional condition may include an index value representing the degree of curvature of the driving lane in which the host vehicle M is traveling being equal to or less than a predetermined value. The behavior plan generation unit 140 may calculate the curvature of the camera road dividing line CL or the map road dividing line ML as an index value representing the degree of curvature of the driving lane, and determine whether the calculated curvature is equal to or less than a predetermined value. For example, the additional condition may include the host vehicle M not being in the vicinity of a branching road. The behavior plan generation unit 140 may determine whether the host vehicle M is in the vicinity of a branching road by, for example, referring to the second map information 62 and comparing it with the current position of the host vehicle M.
[0087] [Inventive Process 2] Inventive process 2 is a process for arbitrating the road dividing line output by the basic process and the road dividing line output by inventive process 1, and ultimately determining the dividing line to be used for cruise control. Inventive process 2 prioritizes the output result of inventive process 1 (interrupts the output result of the basic process) when a preceding vehicle is present around vehicle M, and adopts the output result of the basic process as is if the reliability of the output result of inventive process 1 is low. Details of inventive process 2 are described below.
[0088] 9 is a flowchart showing an example of the flow of Process 2 of the present invention according to an embodiment. The process of the flowchart shown in FIG. 9 is executed when, for example, the camera-captured road-dividing line and the map-captured road-dividing line mismatch on one side, while the camera-captured road-dividing line and the map-captured road-dividing line match only on the other side, and then a deviation occurs between the camera-captured road-dividing line and the map-captured road-dividing line on the matching side, and the basic process and Process 1 of the present invention are executed, and the results of these basic process and Process 1 of the present invention are obtained. As described above, if Process 1 of the present invention determines that the other vehicle is following both the camera-captured road-dividing line and the map-captured road-dividing line, or is following neither, the camera-captured road-dividing line or the map-captured road-dividing line that results in the least change in lane width is selected based solely on the basic process.
[0089] First, the behavior plan generation unit 140 determines whether the road dividing line output by the present invention process 1 is a camera-captured road dividing line CL or a map-captured road dividing line ML (step S100). If the road dividing line output by the present invention process 1 is determined to be a camera-captured road dividing line CL, the behavior plan generation unit 140 determines whether the output by the basic process is not pattern (g), i.e., whether the lane width change of the camera-captured road dividing line CL is not significantly large and the camera lateral position / angle change amounts are each equal to or less than predetermined values (step S102). This step verifies the reliability of the camera-captured road dividing line CL before determining whether to cut in by the present invention process 1. If the output by the basic process is not pattern (g) and the camera lateral position / angle change amounts are equal to or less than predetermined values, this means that the camera-captured road dividing line CL is highly reliable. Therefore, the behavior plan generation unit 140 determines that the camera-captured road dividing line CL should be used for driving control (step S104).
[0090] On the other hand, if it is determined that the output from the basic processing is pattern (g) or that the change in camera lateral position / angle is greater than a predetermined value, this means that the reliability of the camera road-dividing line CL is low, and the behavior plan generation unit 140 determines that the road-dividing line output from the basic processing, i.e., in this case, the map road-dividing line ML, will be used for driving control (step S106).If it is determined in step S100 that the road-dividing line output by present invention processing 1 is the map road-dividing line ML, the behavior plan generation unit 140 determines that the output from the basic processing is pattern (c), that is, whether the change in lane width of the map road-dividing line ML is significantly large (step S108).
[0091] If the output from the basic processing is determined to be pattern (c), this means that the reliability of the map road dividing lines ML is low, so the behavior plan generation unit 140 decides to use the road dividing lines output by the basic processing, that is, in this case, the camera road dividing lines CL, for driving control (step S106). On the other hand, if the output from the basic processing is determined not to be pattern (c), this means that the reliability of the map road dividing lines ML is high, so the behavior plan generation unit 140 decides to use the map road dividing lines ML for driving control (step S110). This ends the processing of this flowchart.
[0092] [Drive control] When the behavior plan generation unit 140 determines the final lane marking to be used for cruise control from among the camera road lane marks CL and the map road lane marks ML, it holds the lane marking for a predetermined period and generates a target trajectory along the lane marking. At this time, the mode determination unit 150 may continue the driving mode of the host vehicle M as is, or may change to a driving mode with a more complex task after continuing the driving mode for a certain period. In the situation shown in FIG. 4 , the behavior plan generation unit 140 uses the camera road lane marks CL output by the present invention process 1 for cruise control by interrupting the map road lane marks ML output by the basic process. Therefore, even in a situation where the map road lane marks ML have not been updated to the latest information, the behavior plan generation unit 140 can appropriately generate a target trajectory, and the mode determination unit 150 can continue the current driving mode for at least a certain period.
[0093] According to the present embodiment described above, if it is determined that there is a discrepancy between the camera road-delimiting lines and the map road-delimiting lines, and another vehicle is recognized, driving control is performed based on either the camera road-delimiting lines or the map road-delimiting lines, whichever is closer to the other vehicle's movement trajectory. On the other hand, if another vehicle is not recognized, driving control is performed based on either the camera road-delimiting lines or the map road-delimiting lines, whichever has the smaller lane width change. This allows for accurate and continuous vehicle driving control by combining multiple roadway judgments.
[0094] The above-described embodiment can be expressed as follows. a storage medium for storing computer-readable instructions; a processor connected to the storage medium; The processor executes the computer-readable instructions to: Recognizes road markings and other vehicles in the direction of travel of the vehicle, determining whether the recognized road dividing line matches a map road dividing line based on map information stored in a storage unit, and determining a deviation between the matched recognized road dividing line and the map road dividing line; Calculating a lane width as a distance between the recognized road dividing line and the map road dividing line; performing driving control of the vehicle based on at least one of the recognized road dividing lines and the map road dividing lines; When it is determined that there is a discrepancy between the recognized road dividing line and the map road dividing line, if the other vehicle is recognized, the driving control is performed based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle, whereas when the other vehicle is not recognized, the driving control is performed based on either the recognized road dividing line or the map road dividing line, whichever has a smaller change in lane width. Vehicle control device.
[0095] The above describes the form for carrying out the present invention using an embodiment, but the present invention is not limited to such an embodiment, and various modifications and substitutions can be made within the scope that does not deviate from the gist of the present invention. [Explanation of symbols]
[0096] 10 Camera 12 Radar equipment 14 LIDAR 16 Object recognition device 100 Automatic driving control device 120 First Control Section 130 Recognition part 132 Judgment section 134 Calculation Unit 140 Action Plan Generation Unit 150 Mode determination unit 160 Second Control Section
Claims
1. a recognition unit that recognizes road dividing lines and other vehicles present in the traveling direction of the vehicle; a determination unit that determines whether the recognized road-dividing line matches a map road-dividing line based on map information stored in a storage unit, and determines a deviation between the matched recognized road-dividing line and the map road-dividing line; a calculation unit that calculates a distance between the recognized road-dividing line and the map road-dividing line as a lane width; a control unit that controls driving of the vehicle based on at least one of the recognized road-dividing lines and the map road-dividing lines, When the determination unit determines that there is a discrepancy between the recognized road-delimiting line and the map road-delimiting line, if the other vehicle is recognized by the recognition unit, the control unit performs the driving control based on either the recognized road-delimiting line or the map road-delimiting line, whichever is closer to a movement trajectory of the other vehicle, and when the other vehicle is not recognized by the recognition unit, the control unit performs the driving control based on either the recognized road-delimiting line or the map road-delimiting line, whichever has a smaller change in lane width. Vehicle control device.
2. the control unit performs the driving control based on the map road dividing line when the recognized road dividing line is closer to the movement trajectory of the other vehicle and the change in the lane width of the recognized road dividing line is equal to or greater than a threshold, and performs the driving control based on the recognized road dividing line when the map road dividing line is closer to the movement trajectory of the other vehicle and the change in the lane width of the map road dividing line is equal to or greater than the threshold. The vehicle control device according to claim 1 .
3. when it is determined that both the recognized road dividing line and the map road dividing line are along the movement trajectory of the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle. The vehicle control device according to claim 1 .
4. When the determination unit determines that the recognized road-delimiting line and the map road-delimiting line match only on one side and that a deviation has occurred on the one side, if the recognition unit recognizes the other vehicle, the control unit performs the driving control based on either the recognized road-delimiting line or the map road-delimiting line, whichever is closer to a movement trajectory of the other vehicle, and when the recognition unit does not recognize the other vehicle, the control unit performs the driving control based on either the recognized road-delimiting line or the map road-delimiting line, whichever has a smaller change in lane width. The vehicle control device according to claim 1 .
5. When the vehicle is not changing lanes and the determination unit determines that there is a discrepancy between the recognized road dividing line and the map road dividing line, if the recognition unit recognizes the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to a movement trajectory of the other vehicle, and when the recognition unit does not recognize the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever has a smaller change in lane width. The vehicle control device according to claim 1 .
6. When an index value indicating the degree of curvature of the vehicle's driving lane is equal to or less than a predetermined value and the determination unit determines that there is a deviation between the recognized road-dividing line and the map road-dividing line, if the other vehicle is recognized by the recognition unit, the control unit performs the driving control based on either the recognized road-dividing line or the map road-dividing line, whichever is closer to a movement trajectory of the other vehicle, and when the other vehicle is not recognized by the recognition unit, the control unit performs the driving control based on either the recognized road-dividing line or the map road-dividing line, whichever has a smaller change in lane width. The vehicle control device according to claim 1 .
7. When the vehicle is not traveling near a branch road and the determination unit determines that there is a discrepancy between the recognized road dividing line and the map road dividing line, if the recognition unit recognizes the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever is closer to a movement trajectory of the other vehicle, and when the recognition unit does not recognize the other vehicle, the control unit performs the driving control based on either the recognized road dividing line or the map road dividing line, whichever has a smaller change in lane width. The vehicle control device according to claim 1 .
8. The vehicle's on-board computer Recognizes road markings and other vehicles in the direction of travel of the vehicle, determining whether the recognized road dividing line matches a map road dividing line based on map information stored in a storage unit, and determining a deviation between the matched recognized road dividing line and the map road dividing line; Calculating a lane width as a distance between the recognized road dividing line and the map road dividing line; performing driving control of the vehicle based on at least one of the recognized road dividing lines and the map road dividing lines; When it is determined that there is a discrepancy between the recognized road dividing line and the map road dividing line, if the other vehicle is recognized, the driving control is performed based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle, whereas when the other vehicle is not recognized, the driving control is performed based on either the recognized road dividing line or the map road dividing line, whichever has a smaller change in lane width. Vehicle control method.
9. The vehicle's on-board computer The system recognizes road dividing lines and other vehicles in the vehicle's direction of travel, determining whether or not the recognized road dividing line matches a map road dividing line based on map information stored in a storage unit, and determining a deviation between the matched recognized road dividing line and the map road dividing line; calculating a distance between the recognized road dividing lines and the map road dividing lines as a lane width; performing driving control of the vehicle based on at least one of the recognized road-dividing lines and the map road-dividing lines; When it is determined that there is a discrepancy between the recognized road dividing line and the map road dividing line, if the other vehicle is recognized, the driving control is performed based on either the recognized road dividing line or the map road dividing line, whichever is closer to the movement trajectory of the other vehicle, whereas when the other vehicle is not recognized, the driving control is performed based on either the recognized road dividing line or the map road dividing line, whichever has a smaller change in lane width. program.
Citation Information
Patent Citations
Map information output device
JP2017146724A
Vehicle control device, vehicle control method and program
JP2023150506A
Vehicle control device, vehicle control method, and program
JP2024025482A