Determination device, determination method, and program
The determination device improves lane marking accuracy in autonomous driving by using recognition units to assess vehicle trajectories and map information, addressing errors caused by changing lanes in conventional systems.
Patent Information
- Application Number
- JP2024035554
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2024-03-08
- Publication Date
- 2025-12-26
- Estimated Expiration
- 2044-03-08
AI Technical Summary
Conventional autonomous driving technologies face challenges in accurately determining lane markings when other vehicles are changing lanes, leading to potential errors in lane marking recognition.
A determination device and method that utilizes a first recognition unit to identify lane markings and surrounding vehicles, a second recognition unit to reference map information, and a determination unit to assess the correctness of these markings based on vehicle trajectories, excluding certain vehicles that are changing lanes or not in the same lateral position.
Enhances the accuracy of lane marking determination by considering the status of surrounding vehicles, ensuring precise lane recognition for improved autonomous driving.
Smart Images

Figure 0007792981000001 
Figure 0007792981000002 
Figure 0007792981000003
Abstract
Description
[Technical Field]
[0001] The present invention relates to a determination device, a determination method, and a program. [Background technology]
[0002] In recent years, efforts to provide access to sustainable transportation systems that take into consideration vulnerable traffic participants have been gaining momentum. To achieve this, efforts are being focused on research and development to further improve traffic safety and convenience through research and development of autonomous driving technology. In this regard, a technology has been known in the past that includes a first sensor unit that captures or measures lane markings in the vehicle's direction of travel, a second sensor unit that detects the movement of a preceding vehicle, and controls a driving actuator based on lane marking position information obtained by the first sensor unit and the reliability of the position information (see, for example, Patent Document 1). [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Japanese Patent Application Publication No. 2022-39469 Summary of the Invention [Problem to be solved by the invention]
[0004] However, in conventional autonomous driving technology, when determining whether a lane marking is correct using recognized lane markings and the driving trajectories of other vehicles, there was a problem in that if some of the multiple other vehicles were changing lanes, it may not be possible to properly determine whether the lane marking was correct.
[0005] In order to solve the above-mentioned problems, one of the objects of the present application is to provide a determination device, a determination method, and a program that can more appropriately determine whether a lane marking is correct or not, depending on the lane markings around the vehicle and the situation of other vehicles, thereby contributing to the development of a sustainable transportation system. [Means for solving the problem]
[0006] The determination device, the determination method, and the program according to the present invention employ the following configuration. (1): A determination device according to one embodiment of the present invention includes a first recognition unit that recognizes the surrounding conditions, including a first dividing line that divides the lane in which the host vehicle is traveling and other vehicles present around the host vehicle, based on the output of a detection device that detects the surrounding conditions of the host vehicle; a second recognition unit that recognizes a second dividing line that divides the lanes around the host vehicle from map information based on the position information of the host vehicle; and a determination unit that determines whether at least one of the first dividing line and the second dividing line is correct based on at least one of the first dividing line and the second dividing line and the traveling trajectory of the other vehicle.The determination unit does not make the determination based on the traveling trajectory of the first other vehicle when, among the multiple other vehicles recognized by the first recognition unit, there is a first other vehicle that is moving laterally ahead of the host vehicle and a second other vehicle that is not moving laterally ahead of the first other vehicle.
[0007] (2): In the above aspect (1), if the second other vehicle is located at the same lateral position as the first other vehicle has moved laterally or was located before the first other vehicle moved laterally, and the judgment unit does not make the judgment of correct or incorrect based on the driving trajectory of the first other vehicle.
[0008] (3): In the aspect (1) above, the determination unit determines that the marking line that follows the driving trajectory of the second other vehicle is the correct marking line, out of the first marking line and the second marking line.
[0009] (4): In the above aspect (1), the judgment unit judges that the first marking line and the second marking line whose deviation angle from the direction of travel of the second other vehicle is less than a threshold value is the correct marking line.
[0010] (5): In the above aspect (2), when there is a third other vehicle behind the second other vehicle, the lateral position of which is different from the lateral position of the second other vehicle after or before the second other vehicle has moved laterally, the judgment unit does not make the judgment of correctness based on the driving trajectory of the first other vehicle and the driving trajectory of the third other vehicle.
[0011] (6): In the above aspect (5), the third other vehicle is a vehicle whose lateral position to which it has moved laterally or which it was in before it moved laterally is the same lateral position as the first other vehicle was in before it moved laterally.
[0012] (7) In the above aspect (5), the third other vehicle is a vehicle moving laterally in the same direction as the first other vehicle.
[0013] (8) In the above aspect (1), the determination unit performs the correct / incorrect determination in an area of a predetermined width in the vehicle width direction based on the position where the second other vehicle is present.
[0014] (9): In the above aspect (1), when the determination unit only acquires a driving trajectory of the second other vehicle that is farther away than the point at which the lateral movement of the first other vehicle, which is moving laterally ahead of the host vehicle, is completed, the determination unit makes the correct or incorrect determination based on the driving trajectory of the first other vehicle and the driving trajectory of the second other vehicle.
[0015] (10): A determination method according to one embodiment of the present invention is a determination method in which a computer recognizes the surrounding conditions, including a first dividing line that divides the lane in which the host vehicle is traveling and other vehicles present around the host vehicle, based on the output of a detection device that detects the surrounding conditions of the host vehicle; recognizes a second dividing line that divides the lane in which the host vehicle is traveling from map information based on the position information of the host vehicle; determines whether at least one of the first dividing line and the second dividing line is correct based on at least one of the first dividing line and the second dividing line and the traveling trajectory of the other vehicle; and if, among the multiple other vehicles recognized, there is a first other vehicle that is moving laterally ahead of the host vehicle and a second other vehicle that is not moving laterally ahead of the first other vehicle, the computer does not make the determination based on the traveling trajectory of the first other vehicle.
[0016] (11): A program according to one embodiment of the present invention causes a computer to recognize the surrounding conditions, including a first dividing line that divides the lane in which the host vehicle is traveling and other vehicles present around the host vehicle, based on the output of a detection device that detects the surrounding conditions of the host vehicle; recognize a second dividing line that divides the lane in which the host vehicle is traveling from map information based on the position information of the host vehicle; determine whether at least one of the first dividing line and the second dividing line is correct based on at least one of the first dividing line and the second dividing line and the traveling trajectory of the other vehicle; and if, among the multiple other vehicles recognized, there is a first other vehicle that is moving laterally ahead of the host vehicle and a second other vehicle that is not moving laterally ahead of the first other vehicle, the program does not cause the computer to determine whether the first other vehicle is correct based on the traveling trajectory of the first other vehicle. [Effects of the Invention]
[0017] According to the above aspects (1) to (11), it is possible to more appropriately determine whether a marking line is correct or not, depending on the status of the marking lines around the vehicle and other vehicles. [Brief explanation of the drawings]
[0018] [Figure 1]1 is a configuration diagram of a vehicle system 1 including a vehicle control device according to an embodiment. [Figure 2] 2 is a functional configuration diagram of a first control unit 120 and a second control unit 160. FIG. [Figure 3] 10A and 10B are diagrams for explaining the determination process of the host vehicle M in a first scene. [Figure 4] 10 is a diagram for explaining the determination process of the host vehicle M in a second scene. FIG. [Figure 5] 10 is a diagram for explaining the determination process of the host vehicle M in a third scene. FIG. [Figure 6] 10 is a diagram for explaining the determination process of the host vehicle M in a fourth scene. FIG. [Figure 7] 3 is a flowchart illustrating an example of processing executed by the automatic driving control device 100 according to the embodiment. DETAILED DESCRIPTION OF THE INVENTION
[0019] Hereinafter, with reference to the drawings, embodiments of a determination device, a determination method, and a program according to the present invention will be described. Hereinafter, as an example, an embodiment will be described in which a vehicle control device including a determination device that determines whether a road dividing line (or lane) that divides a lane on which a vehicle is traveling is a correct dividing line (or lane) is applied to an autonomous vehicle. Autonomous driving refers to, for example, automatically controlling one or both of the steering and speed of a vehicle to perform driving control. The above-mentioned driving control may include, for example, an adaptive cruise control system (ACC), a traffic jam pilot (TJP), a lane keeping assistance system (LKAS), an automated lane change (ALC), a collision mitigation brake system (CMBS), and the like. Furthermore, autonomous vehicles may be manually controlled by a vehicle user (e.g., a passenger) (so-called manual driving). Although the following description will be given for a case where a law stipulates driving on the left side of the road, if a law stipulates driving on the right side of the road, the terms left and right may be reversed.
[0020] [Overall configuration] 1 is a configuration diagram of a vehicle system 1 including a vehicle control device according to an embodiment. The vehicle (hereinafter referred to as host vehicle M) on which the vehicle system 1 is mounted is, for example, a two-wheeled, three-wheeled, or four-wheeled vehicle, and its drive source is 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 battery (storage battery) such as a secondary battery or a fuel cell.
[0021] The vehicle system 1 includes, for example, a camera 10, a radar device 12, a LIDAR (Light Detection and Ranging) device 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 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. The combination of the camera 10, the radar device 12, the LIDAR 14, and the object recognition device 16 is an example of a "detection device DD." The HMI 30 is an example of an "output device." The automatic driving control device 100 is an example of a "vehicle control device."
[0022] The camera 10 is a digital camera that uses 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 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, the front of the vehicle body, etc. When capturing an image of the rear, the camera 10 is attached to the top of the rear windshield, the back door, etc. When capturing an image of the side, the camera 10 is attached to a door mirror, etc. The camera 10 periodically and repeatedly captures images of the surroundings of the host vehicle M, for example. The camera 10 may be a stereo camera.
[0023] The radar device 12 emits radio waves such as millimeter waves around the vehicle M and detects radio waves reflected by surrounding objects (reflected waves) to detect at least the position (distance and direction) of the objects. The radar device 12 is attached to any location on the vehicle M. The radar device 12 may detect the position and speed of the objects using an FM-CW (Frequency Modulated Continuous Wave) method.
[0024] The LIDAR 14 irradiates light around the vehicle M and measures the scattered light. The LIDAR 14 detects the distance to the target based on the time between emitting and receiving the light. The irradiated light is, for example, a pulsed laser light. The LIDAR 14 is attached to any location on the vehicle M.
[0025] 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. Alternatively, 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. In that case, the object recognition device 16 may be omitted from the configuration of the vehicle system 1 (detection device DD).
[0026] The communication device 20 communicates with, for example, other vehicles in the vicinity of the vehicle M, terminal devices of users using the vehicle M, or various server devices, using networks such as a cellular network, a Wi-Fi network, Bluetooth (registered trademark), DSRC (Dedicated Short Range Communication), LAN (Local Area Network), WAN (Wide Area Network), or the Internet.
[0027] The HMI 30 outputs various information to the occupants of the vehicle M and accepts input operations by the occupants. The HMI 30 includes, for example, various display devices, speakers, buzzers, touch panels, switches, keys, microphones, and the like.
[0028] 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 the yaw rate (for example, the rotational angular velocity around a vertical axis passing through the center of gravity of the host vehicle M), and a direction sensor that detects the orientation of the host vehicle M. The vehicle sensor 40 may also be provided with a position sensor that detects the position of the vehicle. The position sensor is an example of a "position measurement unit." The position sensor is, for example, a sensor that acquires position information (longitude and latitude information) from a GPS (Global Positioning System) device. The position sensor may also be a sensor that acquires position information using a GNSS (Global Navigation Satellite System) receiver 51 of the navigation device 50. The vehicle sensor 40 may derive the speed of the host vehicle M from the difference (i.e., distance) of the position information at a predetermined time in the position sensor. The results detected by the vehicle sensor 40 are output to the automatic driving control device 100.
[0029] The navigation device 50 includes, for example, a GNSS 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 a 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 sensor 40. The navigation HMI 52 includes a display device, a speaker, a touch panel, keys, etc. The GNSS receiver 51 may be provided in the vehicle sensor 40. 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 route on a map) from the position of the vehicle M identified by the GNSS receiver 51 (or an arbitrary 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 in which road shapes are expressed by, for example, links indicating roads and nodes connected by the links. The first map information 54 may also include POI (Point Of Interest) information and the like. 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 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. The navigation device 50 outputs the determined route on the map to the MPU 60.
[0030] 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.
[0031] 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, the number of lanes, the type and shape of road dividing lines (hereinafter referred to as dividing lines), information on the center of lanes, and road boundary information. The second map information 62 may also include information on whether the road boundary includes a structure that prevents a vehicle from passing (including crossing or coming into contact with). Examples of such structures include guardrails, curbs, medians, and fences. The term "impassable" may include the presence of a low level step that allows passage if unusual vehicle vibrations are tolerated. The second map information 62 may also include road shape information, traffic regulation information, address information (address and postal code), facility information, parking information, telephone number information, and the like. The road shape information includes, for example, the curvature (which may be interpreted as the radius of curvature; the same applies below), width, and gradient of the road. The second map information 62 may be updated as needed by the communication device 20 communicating with an external device. The first map information 54 and the second map information 62 may be provided as an integrated piece of map information.
[0032] The driving operators 80 include, for example, a steering wheel, an accelerator pedal, and a brake pedal. The driving operators 80 may also include a shift lever, a variable steering wheel, a joystick, or other operators. Each operator of the driving operators 80 is equipped with an operation detection unit that detects, for example, the amount of operation of the operator by the occupant or whether or not the operator is operated. The operation detection unit detects, for example, the steering angle and steering torque of the steering wheel, the amount of depression of the accelerator pedal and the brake pedal, etc. The operation detection unit then outputs the detection results to the automatic driving control device 100 or one or both of the driving force output device 200, the brake device 210, and the steering device 220.
[0033] The automatic driving control device 100 executes various types of driving control associated with automatic driving for the host vehicle M. The automatic driving control device 100 includes, for example, a first control unit 120, a second control unit 160, an HMI control unit 180, and a storage unit 190. The first control unit 120, the second control unit 160, and the HMI control unit 180 are each realized by, for example, a hardware processor such as a CPU (Central Processing Unit) executing a program (software). Furthermore, 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 above-mentioned program may be stored in advance in a storage device (a storage device with a non-transitory storage medium) such as an HDD or flash memory of the automatic driving control device 100, or may be stored in a removable storage medium such as a DVD, CD-ROM, or memory card, and installed in the storage device of the automatic driving control device 100 by inserting the storage medium (non-transitory storage medium) into a drive device, card slot, etc.
[0034] The storage unit 190 may be realized by the various storage devices described above, or an EEPROM (Electrically Erasable Programmable Read Only Memory), a ROM (Read Only Memory), or a RAM (Random Access Memory). The storage unit 190 stores, for example, various types of information, programs, and the like in the embodiments. The storage unit 190 may also store map information (for example, the first map information 54 and the second map information 62).
[0035] 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 and an action plan generation unit 140. 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 concurrently executing intersection recognition using deep learning or the like and recognition based on predefined conditions (such as the presence of traffic lights and road markings that can be pattern matched), and then scoring and comprehensively evaluating both. This ensures the reliability of autonomous driving. The first control unit 120 also executes control related to autonomous driving of the host vehicle M based on instructions from, for example, the MPU 60, the HMI control unit 180, or the like.
[0036] The recognition unit 130 recognizes the surrounding situation of the host vehicle M based on the recognition results of the detection device DD (information input from the camera 10, the radar device 12, and the LIDAR 14 via the object recognition device 16). For example, the recognition unit 130 recognizes the status of objects present around the host vehicle M (within a predetermined distance), such as their position, speed, and acceleration. The objects include, for example, other vehicles (surrounding vehicles), traffic participants (pedestrians, bicycles, etc.) traveling on the road, road structures, and other obstacles present in the vicinity. The road structures include, for example, road signs, traffic signals, railroad crossings, curbs, medians, guardrails, fences, etc. The position of the object is recognized as a position on an absolute coordinate system with a representative point of the host 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 the object may be represented by a representative point such as the center of gravity or a corner of the object, or by a represented area. The "state" of an object may include, for example, if the object is a moving body such as another vehicle, the acceleration or jerk of the moving body, or the "behavioral state" (for example, whether the other vehicle is changing lanes or is about to change lanes).
[0037] The recognition unit 130 includes, for example, a first recognition unit 132 and a second recognition unit 134. The functions of these units will be described in detail later.
[0038] The behavior plan generation unit 140 generates a behavior plan for driving the host vehicle M by autonomous driving based on the recognition results of the recognition unit 130, etc. For example, the behavior plan generation unit 140 generates a target trajectory for the host vehicle M to travel automatically (without driver operation) in the future, so that the host vehicle M can respond to the surrounding conditions of the host vehicle M, while essentially traveling in the recommended lane determined by the recommended lane determination unit 61, based on the recognition results by the recognition unit 130 and the surrounding road shapes based on the current position of the host vehicle M acquired from map information, etc. The target trajectory includes, for example, a speed element. For example, the target trajectory is expressed as a sequential arrangement of points (trajectory points) to be reached by the host vehicle M. The trajectory points are points to be reached by the host vehicle M at predetermined travel distances (e.g., on the order of several meters) along the road, and separately, target speeds and target accelerations for predetermined sampling times (e.g., on the order of a few tenths of a second) are generated as part of the target trajectory. Alternatively, the trajectory points may be positions to be reached by the host vehicle M at the sampling times for each predetermined sampling time. In this case, the target speed and target acceleration information are expressed as the interval between trajectory points.
[0039] The action plan generation unit 140 may set an autonomous driving event when generating the target trajectory. Examples of the event include a constant speed driving event in which the host vehicle M drives in the same lane at a constant speed, a following driving event in which the host vehicle M follows another vehicle that is within a predetermined distance (for example, within 100 m) ahead of the host vehicle M and is closest to the host vehicle M, a lane change event in which the host vehicle M changes lanes from the host vehicle's own lane to an adjacent lane, a branching event in which the host vehicle M branches off into a lane on the destination side at a road branching point, a merging event in which the host vehicle M merges into a main lane at a merging point, a takeover event in which the autonomous driving is terminated and the host vehicle M switches to manual driving, and so on. Examples of the event may also include an overtaking event in which the host vehicle M temporarily changes lanes to an adjacent lane, overtakes a leading vehicle in the adjacent lane, and then changes lanes back to the original lane, and an avoidance event in which the host vehicle M performs at least one of braking and steering to avoid an obstacle ahead of the host vehicle M.
[0040] Furthermore, the behavior plan generation unit 140 may change an event already determined for the current section to another event or set a new event for the current section, depending on the surrounding conditions of the host vehicle M recognized while the host vehicle M is traveling. Furthermore, the behavior plan generation unit 140 may change an event already set for the current section to another event or set a new event for the current section, depending on the operation of the occupant on the HMI 30. The behavior plan generation unit 140 generates a target trajectory according to the set event.
[0041] The behavior plan generation unit 140 also includes, for example, a determination unit 142 and an execution control unit 144. Details of these functions will be described later. For example, the recognition unit 130 and the determination unit 142 are an example of a "determination device." The execution control unit 144 and the second control unit 160 are an example of a "driving control unit."
[0042] 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.
[0043] The second control unit 160 includes, for example, a target trajectory acquisition unit 162, a speed control unit 164, and a steering control unit 166. The target trajectory 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.
[0044] Returning to FIG. 1 , the HMI control unit 180 notifies the occupant of predetermined information via the HMI 30. The predetermined information includes, for example, information related to the traveling of the vehicle M, such as information related to the state of the vehicle M and information related to driving control. The information related to the state of the vehicle M includes, for example, the speed of the vehicle M, engine speed, and shift position. The information related to driving control includes, for example, whether or not driving control is being performed by autonomous driving, information inquiring about whether or not to start autonomous driving, information related to the driving control status by autonomous driving, information related to the automation level, and information prompting the occupant to drive when switching from autonomous driving to manual driving. The predetermined information may also include information unrelated to the traveling of the vehicle M, such as television programs and content (e.g., movies) stored on a storage medium such as a DVD. The predetermined information may also include, for example, information related to the current location and destination during autonomous driving, and the remaining amount of fuel in the vehicle M. The HMI control unit 180 may output the information received by the HMI 30 to the communication device 20, the navigation device 50, the first control unit 120, etc.
[0045] Furthermore, the HMI control unit 180 may cause the HMI 30 to output inquiry information for the occupant, processing results by the first control unit 120 and the second control unit 160, etc. Furthermore, the HMI control unit 180 may transmit various pieces of information to be output by the HMI 30 to a terminal device used by the user of the vehicle M via the communication device 20.
[0046] Traveling drive force output device 200 outputs a traveling drive force (torque) to the drive wheels for the vehicle to travel. Traveling drive 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 second control unit 160 or information input from the accelerator pedal of driving operator 80.
[0047] The braking device 210 includes, 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 the second control unit 160 or information input from the brake pedal of the driving operation device 80, so that a braking torque corresponding to the braking operation is output to each wheel. The braking device 210 may include a backup mechanism that transmits hydraulic pressure generated by operation of the brake pedal to the cylinder via a master cylinder. Note that the braking device 210 is not limited to the configuration described above, and may also be an electronically controlled hydraulic braking device that controls an actuator according to information input from the second control unit 160 to transmit hydraulic pressure from the master cylinder to the cylinder.
[0048] The steering device 220 includes, for example, a steering ECU and an electric motor. The electric motor changes the direction of the steered wheels by, for example, applying a force to a rack and pinion mechanism. The steering ECU drives the electric motor to change the direction of the steered wheels in accordance with information input from the second control unit 160 or information input from the steering wheel of the driving operator 80.
[0049] [Recognition and Action Plan Generation] Next, the functions of the recognition unit 130 (first recognition unit 132, second recognition unit 134) and the action plan generation unit 140 (determination unit 142, execution control unit 144) will be described in detail. Note that the following mainly describes the determination process in the embodiment and the contents of driving control (cruising control) based on the determination result, and the determination process will be explained in several stages.
[0050] [Scene 1] FIG. 3 is a diagram for explaining the determination process of the host vehicle M in the first scene. The example of FIG. 3 shows lane markings CL1 to CL4 recognized by the detection device DD and lane markings ML1 to ML4 obtained from map information (e.g., second map information 62) based on the position information of the host vehicle M. In the map information, lane L1 is defined by lane markings ML1 and ML2, lane L2 is defined by lane markings ML2 and ML3, and lane L3 is defined by lane markings ML3 and ML4. Lanes L1 to L3 are lanes on which vehicles can travel in the same direction (the X-axis direction in the figure). In the example of FIG. 3, lane markings CL1 to CL4 are an example of a "first lane marking," and lane markings ML1 to ML4 are an example of a "second lane marking." 3, the host vehicle M is traveling on lane L2 at a speed VM, another vehicle m1 (vehicle ahead) ahead of the host vehicle M is traveling at a speed Vm1, and another vehicle m2 (vehicle ahead of the vehicle m1) ahead of the other vehicle m1 is traveling on lane L1 at a speed Vm2. Point P1 shown in FIG. 3 is a point where, due to weather or other reasons, the recognition accuracy falls below a threshold or the camera lane markings CL1 to CL4 cannot be recognized (in other words, the recognizable range of the camera lane markings). The other vehicle m1 shown in FIG. 3 is an example of a "first other vehicle," and the other vehicle m2 is an example of a "second other vehicle."
[0051] The first recognition unit 132 recognizes the surrounding conditions of the host vehicle M based on the output of the detection device DD, which detects the surrounding conditions of the host vehicle. For example, the first recognition unit 132 recognizes left and right lane markings CL2 and CL3 that demarcate the driving lane (lane L2) of the host vehicle M based on an image captured by the camera 10 (hereinafter referred to as a camera image). The first recognition unit 132 also recognizes lane markings CL1 and CL2 that demarcate the adjacent lane L1 adjacent to the driving lane, and lane markings CL3 and CL4 that demarcate the adjacent lane L3. Hereinafter, the lane markings CL1 to CL4 may be referred to as "camera lane markings CL1 to CL4." For example, the first recognition unit 132 analyzes the camera image, extracts edge points in the image that have a large difference in brightness from adjacent pixels, and recognizes each of the camera lane markings CL1 to CL4 on the image plane by connecting the edge points. The first recognition unit 132 also converts the positions of the camera lane markings CL1-CL4 into a vehicle coordinate system (e.g., the XY plane coordinates in FIG. 3) based on the position of the representative point of the vehicle M. The first recognition unit 132 may also recognize, for example, the curvature of the camera lane markings CL1-CL4. The first recognition unit 132 may also recognize the curvature or curvature change amount of each of the camera lane markings CL1-CL4. The curvature change amount is, for example, the time rate of change in the curvature of the camera lane markings CL1-CL4 recognized by the camera 10 at a distance x [m] forward as viewed from the vehicle M. The first recognition unit 132 may also recognize the curvature or curvature change amount of the lane markings CL1-CL4 by averaging the curvatures or curvature change amounts of each of the camera lane markings CL1-CL4. The camera lane markings CL1-CL4 may be recognized or corrected based on the output of a detection device other than the camera 10.
[0052] The first recognition unit 132 also recognizes other vehicles present in the vicinity (within a predetermined distance) of the host vehicle M. In the example of FIG. 3, the first recognition unit 132 recognizes another vehicle m1 traveling ahead of the host vehicle M and another vehicle m2 traveling further ahead of the other vehicle m1 as viewed from the host vehicle M, based on the output of the detection device DD that detects the surrounding conditions of the host vehicle M. The first recognition unit 132 also recognizes the positions (relative positions with respect to the host vehicle M) and speeds (relative speeds with respect to the host vehicle M) of the other vehicles m1 and m2, and recognizes the traveling lanes of the other vehicles m1 and m2. The first recognition unit 132 may also recognize traveling position information of the other vehicles m1 and m3. The traveling position information is, for example, traveling trajectories K1 and K2 based on the positions of representative points of the other vehicles m1 and m3 at a predetermined time.
[0053] The second recognition unit 134 recognizes lane markings around (within a predetermined distance from) the host vehicle M from map information based on the position of the host vehicle M detected by, for example, the vehicle sensor 40 or the GNSS receiver 51. In the example of FIG. 3, the second recognition unit 134 refers to map information based on the position information of the host vehicle M, and recognizes lane markings ML1 to ML4 that exist in the direction in which the host vehicle M is traveling or in which the host vehicle M can travel. Hereinafter, the lane markings ML1 to ML4 may be referred to as "map lane markings ML1 to ML4."
[0054] Furthermore, the second recognition unit 134 may recognize map division lines ML2 and ML3, among the recognized map division lines ML1 to ML4, as division lines that divide the lane L2 on which the host vehicle M is traveling. Furthermore, the second recognition unit 134 recognizes the curvature or curvature change amount of each of the map division lines ML1 to ML4 from the second map information 62. Furthermore, the second recognition unit 134 may average the curvature or curvature change amount of each of the map division lines ML1 to ML4 to recognize the curvature or curvature change amount for each of the lanes L1 to L3 divided by the map division lines.
[0055] The determination unit 142 determines whether at least one of the camera lane lines and the map lane lines is correct, for example, based on at least one of the camera lane lines and the map lane lines and the travel trajectories of the other vehicles m1 and m2. The execution control unit 144 generates a target trajectory for performing driving control so that the host vehicle M travels along the lane lines determined to be correct based on the determination result by the determination unit 142, or performs control to terminate (or not start) driving control when both lane lines are determined to be incorrect.
[0056] In the success / failure determination, the determination unit 142 first determines whether the camera lane lines CL1-CL4 recognized by the first recognition unit 132 deviate from the map lane lines ML1-ML4 recognized by the second recognition unit 134. For example, the determination unit 142 derives the degree of deviation between the lane lines CL2 and ML2 located closest to the left of the host vehicle M, the degree of deviation between the lane lines CL3 and ML3 located closest to the right of the host vehicle M, and the degree of deviation between the lane lines CL1 and ML1 and the lane lines CL4 and ML4 on the adjacent lane side. If the derived degree of deviation is equal to or greater than a threshold, the determination unit 142 determines that the camera lane lines and the map lane lines deviate; if the derived degree of deviation is less than the threshold, the determination unit 142 determines that there is no deviation. The above-described deviation determination is repeatedly performed at a predetermined timing or period.
[0057] For example, the determination unit 142 superimposes the camera lane lines CL1-CL4 and the map lane lines ML1-ML4 on the plane of the vehicle coordinate system (XY plane) based on the position of the representative point of the vehicle M. When determining the deviation between the compared lane lines (lane lines CL1 and ML1, lane lines CL2 and ML2, lane lines CL3 and ML3, and lane lines CL4 and ML4), the determination unit 142 determines that the lane lines deviate if the degree of deviation between the respective lane lines is equal to or greater than a threshold, and determines that the lane lines do not deviate if the degree of deviation is less than the threshold. The degree of deviation is, for example, the amount of deviation in the lateral position (for example, the Y-axis direction in the figure). In the example of Figure 3, the deviation determination may be performed using the average value of the lateral position deviation D1 between the marking lines CL1 and ML1, the lateral position deviation D2 between the marking lines CL2 and ML2, the lateral position deviation D3 between the marking lines CL3 and ML3, and the lateral position deviation D4 between the marking lines CL4 and ML4, or the deviation determination may be performed using the maximum or minimum value of the deviations D1 to D4.
[0058] Furthermore, the degree of deviation may be, for example, the degree (magnitude) of the angle formed by the two marking lines being compared, instead of (or in addition to) the above-mentioned lateral position deviation. In the example of Fig. 3, the average value of the angle θ1 formed by marking lines CL1 and ML1, the angle θ2 formed by marking lines CL2 and ML2, the angle θ3 formed by marking lines CL3 and ML3, and the angle θ4 formed by marking lines CL4 and ML4 may be used, or the maximum or minimum value of the angles θ1 to θ4 may be used.
[0059] The degree of deviation may be determined by the degree (magnitude) of the difference in curvature change between the lane lines, instead of (or in addition to) the lateral position deviation or the angle formed by the lane lines. The curvature change is mainly used when the lane is a curved road. The determination unit 142 may use the average value of the difference in curvature change between lane lines CL1 and ML1, the difference in curvature change between lane lines CL2 and ML2, the difference in curvature change between lane lines CL3 and ML3, and the difference in curvature change between lane lines CL4 and ML4, or may use the maximum or minimum of these differences. The determination unit 142 may also use the difference between the average value of the curvature change between lane lines CL1 to CL4 and the average value of the curvature change between lane lines ML1 to ML4. The determination unit 142 may also use the difference between the curvature change of the lane lines (lanes L1 to L3) recognized from the camera image and the curvature change of the lane lines recognized from map information.
[0060] For example, if the recognition accuracy of the camera-based lane markings CL1-CL4 recognized by the first recognition unit 132 falls below a threshold or the camera-based lane markings become unrecognizable, the determination unit 142 may derive the degree of deviation using the angle between the travel trajectories K1, K2 of other vehicles traveling in the vicinity and the map lane markings ML1-ML4. The determination unit 142 may also set a virtual lane marking parallel to the travel trajectory K1 and determine the degree of deviation between the set virtual lane marking and the map lane marking. The determination unit 142 may also determine the deviation from the lane markings using the travel trajectories K1, K2, regardless of the recognition results of the camera-based lane markings CL1-CL4.
[0061] If the deviation determination using the deviation degree described above determines that the camera lane markings and the map lane markings do not deviate from each other, the determination unit 142 determines that the camera lane markings and the map lane markings are correct in the accuracy determination. Furthermore, if the determination unit 142 determines that the camera lane markings and the map lane markings deviate from each other, the determination unit 142 determines that at least one of the camera lane markings and the map lane markings is incorrect. For example, if the camera lane markings and the map lane markings deviate from each other and the host vehicle M is performing driving control to avoid an obstacle ahead, the determination unit 142 determines that the camera lane markings are incorrect (or that the map lane markings are correct). Furthermore, the determination unit 142 may determine that the map lane markings are correct if the degree of deviation between the travel path (or a virtual lane marking using the travel path) of a leading vehicle traveling ahead of the host vehicle M and the map lane markings is less than a threshold value.
[0062] Furthermore, the determination unit 142 determines that the map lane markings are incorrect (or that the camera lane markings are correct) when there is a deviation between the camera lane markings and the map lane markings, and when at least a predetermined number of the recognized travel trajectories of multiple other vehicles are travel trajectories that follow the camera lane markings (within a predetermined tolerance range). Furthermore, if the first recognition unit 132 recognizes information indicating a lane change (e.g., an increase or decrease in lanes), such as a road construction sign or a lane increase / decrease road sign, but the road information acquired from the map information does not contain information indicating a lane change, the determination unit 142 may determine that the map lane markings are incorrect (or that the camera lane markings are correct) because the map information is outdated (or does not match the current road shape). Furthermore, the determination unit 142 may determine that the camera lane markings and the map lane markings are incorrect, for example, when the degree of deviation is equal to or greater than an upper limit value that is greater than a threshold, or when the number of lane markings between the camera lane markings and the map lane markings differs.
[0063] Here, when the first recognition unit 132 recognizes multiple other vehicles in a situation where a determination of the legitimacy of a lane marking (or a deviation determination from a lane marking) is performed using the travel path of another vehicle, if there is a first other vehicle moving laterally ahead of the host vehicle M and a second other vehicle located ahead of the first other vehicle and not moving laterally, the determination unit 142 does not perform a determination of the legitimacy (deviation determination) based on the travel path of the first other vehicle. The lateral movement is, for example, a movement of a predetermined distance or more in the road width direction of the map lane marking (movement in the Y-axis direction in FIG. 3). The lateral movement may also be a movement of a predetermined distance or more in a direction perpendicular to the traveling direction of the host vehicle M (in other words, in the vehicle width direction of the host vehicle M). The predetermined distance here may be, for example, the width of one lane, which corresponds to a lane change, or may be a variable distance depending on the road shape, or a fixed distance.
[0064] In the example of FIG. 3, the determination unit 142 determines that the vehicle m1 located ahead of the host vehicle M is moving laterally, and determines that the vehicle m2 located ahead of the vehicle m1 is not moving laterally, based on the travel trajectories K1 and K2 of the vehicles m1 and m2 recognized by the first recognition unit 132. The determination unit 142 then does not perform the true / false determination based on the travel trajectory K1 of the vehicle m1. In this case, the determination unit 142 may perform the true / false determination using, for example, the travel trajectories of multiple vehicles other than the vehicle m1, and performs the true / false determination based on the travel trajectories of some of the vehicles other than the first vehicle. In the example of FIG. 3, the true / false determination is performed based on the travel trajectory K2 of the vehicle m2 other than the vehicle m1.
[0065] For example, the determination unit 142 determines that a lane marking along the travel trajectory K2 of the other vehicle m2 (at least one of the camera lane marking CL and the map lane marking ML) is the correct lane marking. A lane marking along the travel trajectory K2 is a lane marking that is determined not to deviate from the travel trajectory K2 based on a deviation determination. The determination unit 142 may also determine that a lane marking between the camera lane marking CL and the map lane marking ML has a deviation angle (the angle formed by the travel direction of the other vehicle m2 and the extension direction of the lane marking) with respect to the travel direction of the other vehicle m2 (or the longitudinal direction of the body of the other vehicle m2) that is equal to or less than a threshold value is the correct lane marking. This improves the accuracy of determining whether a lane marking is correct (determining the road shape) using the other vehicle based on the travel trajectory K2 of the other vehicle m2.
[0066] 3, the determination unit 142 performs a deviation determination between the traveling trajectory K2 and the camera lane lines CL and the map lane lines ML and a success / failure determination based on the deviation determination result, for example, from the current position of the vehicle M to a point P1 (a range in which the camera lane lines can be recognized) that is a predetermined distance ahead. Furthermore, the determination unit 142 performs a deviation determination between the traveling trajectory K2 and the map lane lines ML and a success / failure determination based on the deviation determination result, for a section farther away from the point P1 as viewed from the vehicle M (a section in which the traveling trajectory K2 exists).
[0067] The determination unit 142 may also perform deviation determination and accuracy determination for lane markings included in an area of a predetermined width to the left and right of the location of the other vehicle m2 in the vehicle width direction. In the example of FIG. 3, the determination unit 142 sets a line AL1 that is a predetermined distance DL away from the other vehicle m2 in the vehicle width direction on the left side and extends in the vehicle body longitudinal direction, and a line AL2 that is a predetermined distance DR away from the other vehicle m2 in the vehicle width direction on the right side and extends in the vehicle body longitudinal direction. The determination unit 142 then subjects the camera lane markings CL1 and CL2 and the map lane markings ML1 and ML2 included in the area defined by the lines AL1 and AL2 to the deviation determination and accuracy determination. The predetermined distances DL and DR may be fixed distances, such as one lane each (or one lane obtained by adding DL and DR), or may be variable distances depending on the road shape and the distance between the host vehicle M and the other vehicle m2. Since it is believed that correct judgments can be made at least within a predetermined area from the other vehicle m2, limiting the range can improve the accuracy of judgments on the correctness of road shapes (demarcation lines) using other vehicles.
[0068] For example, in a situation where another vehicle m2 is not moving laterally as seen from the host vehicle M, and another vehicle m1 is moving laterally, the lateral movement of the other vehicle m1, which is located in front of the other vehicle m2 as seen from the host vehicle M, is likely to be a lane change. Therefore, by not making a determination of correctness based on the travel trajectory K1 of the other vehicle m1 (or by not determining that the travel trajectory K1 is correct), the accuracy of the determination regarding the road shape can be improved. Furthermore, the road shape can be determined with high accuracy based on the other vehicle m2.
[0069] The determination unit 142 may add further conditions to the relationship between the other vehicle m1 (first other vehicle) and the other vehicle m2 (second other vehicle). For example, when the other vehicle m2 is present at the same lateral position (including a predetermined tolerance) as the other vehicle m1's lateral position after the other vehicle m1 has moved laterally, and the other vehicle m2 is present ahead of the other vehicle m1 without moving laterally, the determination unit 142 does not perform a true / false determination based on the travel path K1 of the other vehicle m1. The determination of whether the other vehicle m2 is present at the same lateral position as the other vehicle m1 that has moved laterally is performed, for example, by comparing a deviation amount W1 in the lateral direction (Y-axis direction in the drawing) between the travel paths K1 and K2 as shown in FIG. 3. If the deviation amount W1 is less than a threshold, it is determined that the other vehicle m2 is present at the same position, and if the deviation amount W1 is equal to or greater than the threshold, it is determined that the other vehicle m2 is not present at the same position.
[0070] [Second Scene] Furthermore, the determination unit 142 may determine that the other vehicle m2 is present at the same lateral position as the other vehicle m2 was at "before the other vehicle m1 moved laterally" instead of "the destination to which the other vehicle m1 moved laterally" as described above. Below, the above content will be described as a second scenario, focusing on the differences from the first scenario.
[0071] FIG. 4 is a diagram for explaining the determination process of the host vehicle M in a second scene. The example of FIG. 4 differs from the first scene shown in FIG. 3 in that another vehicle m2 is traveling on the lane L2. In the second scene, when another vehicle m2 is present at the same lateral position as the other vehicle m1 was before the other vehicle m1 moved laterally and the other vehicle m2 is present ahead of the other vehicle m1 (or the host vehicle M) without moving laterally, the determination unit 142 does not perform a true / false determination based on the travel path K1 of the other vehicle m1. The determination of whether the other vehicle m2 is present at the same lateral position as the other vehicle m1 was before moving laterally is performed, for example, by comparing a deviation amount W2 in the lateral direction (Y-axis direction in the figure) between the travel paths K1 and K2 as shown in FIG. 4. If the deviation amount W2 is less than a threshold, it is determined that the other vehicle m2 is present at the same position, and if the deviation amount W2 is equal to or greater than the threshold, it is determined that the other vehicle m2 is not present at the same position.
[0072] In this way, by not making a judgment on whether or not the driving trajectory of another vehicle m1, which is presumed to be changing lanes to enter or exit the lane in which another vehicle m2 was driving, is used, the accuracy of determining the road shape using other vehicles can be further improved.
[0073] [Scene 3] FIG. 5 is a diagram for explaining the determination process of the host vehicle M in the third scene. The example of FIG. 5 differs from the first scene shown in FIG. 3 in that another vehicle m3 is present in addition to other vehicles m1 and m2. The other vehicle m3 is a leading vehicle traveling ahead of the host vehicle M at a speed Vm3. The other vehicle m3 is an example of a "third other vehicle." The third other vehicle is, for example, a vehicle (a vehicle traveling parallel to the other vehicle m1) that is present behind the other vehicle m2, is present laterally of the other vehicle m1 (laterally of the other vehicle m1 and within a predetermined distance in the front-to-rear direction), and is moving laterally.
[0074] In the third scenario, the first recognition unit 132 recognizes the position (relative position with respect to the vehicle M), speed (relative speed with respect to the vehicle M), traveling lane, and traveling position information (for example, traveling trajectory K3) of the vehicle m3 in addition to the vehicles m1 and m2. Based on the recognition result, for example, as shown in Fig. 5, when a vehicle m3 other than the vehicle m1 is present behind the vehicle m2 and the lateral position of the vehicle m3 after the lateral movement or the lateral position of the vehicle m3 after the lateral movement is different from the lateral position of the second vehicle m2, the determination unit 142 does not perform a success / failure determination based on the traveling trajectories K1 and K3 of the vehicles m1 and m3.
[0075] Furthermore, the determination unit 142 may determine, instead of (or in addition to) "when the lateral position of the other vehicle m3 after the lateral movement is different from the lateral position of the other vehicle m2," "when the lateral position of the other vehicle m3 after the lateral movement is the same as the lateral position of the other vehicle m1." The determination of whether or not the other vehicle m3 is at the same position is performed by, for example, comparing a deviation amount W3 in the lateral direction (Y-axis direction in the drawing) between the travel path K1 before the other vehicle m1 lateral movement and the travel path K3 after the other vehicle m3 lateral movement, as shown in FIG. 5 . If the deviation amount W3 is less than a threshold, it is determined that the other vehicle m3 is at the same position. If the deviation amount W3 is equal to or greater than the threshold, it is determined that the other vehicle m3 is not at the same position. In the example of FIG. 5, the lateral position (coordinate on the Y-axis) of the other vehicle m3 after the lateral movement is determined to be different from the lateral position of the other vehicle m2 and the same as the lateral position of the other vehicle m1 before the other vehicle m1 lateral movement.
[0076] [Scene 4] Furthermore, instead of the above-mentioned case where "the lateral position of the other vehicle m3 after the lateral movement is the same as the lateral position of the other vehicle m1," the determination unit 142 may be the case where "the lateral position of the other vehicle m3 before the lateral movement is the same as the lateral position of the other vehicle m1." Below, the above content will be described as a fourth scenario, focusing on the differences from the third scenario.
[0077] Fig. 6 is a diagram for explaining the determination process of the host vehicle M in a fourth scene. The example of Fig. 6 differs from the third scene shown in Fig. 5 in that the other vehicle m3 does not move laterally to the left (from lane L3 to lane L2) but moves laterally to the right (from lane L2 to lane L3). In addition, in the third scene, the other vehicles m1 and m3 move laterally in the same direction, while in the fourth scene, the other vehicles m1 and m3 move laterally in opposite directions.
[0078] In a fourth scenario, when a vehicle m3 other than the vehicle m1 is present behind the vehicle m2 and the lateral position of the vehicle m3 before the lateral movement is the same as the lateral position of the vehicle m1, the determination unit 142 does not perform a true / false determination based on the travel paths K1 and K3 of the vehicles m1 and m3. The determination of whether the vehicles are at the same position is performed by comparing a lateral deviation W4 (Y-axis direction in the figure) between the travel path K1 of the vehicle m1 before the lateral movement and the travel path K3 of the vehicle m3 before the lateral movement, as shown in FIG. 6, for example. If the deviation W4 is less than a threshold, the vehicle is determined to be at the same position. If the deviation W4 is equal to or greater than the threshold, the vehicle is determined not to be at the same position. In the example of FIG. 6, the lateral position (coordinate on the Y-axis) of the vehicle m3 before the lateral movement is determined to be different from the lateral position of the vehicle m2 and the same as the lateral position of the vehicle m1 before the lateral movement.
[0079] Furthermore, the determination unit 142 may include, for example, a condition that the third other vehicle is a vehicle moving laterally in the same direction as the first other vehicle (other vehicle m1). In this case, in the third scene shown in FIG. 5, the other vehicles m1 and m3 move laterally in the same direction (leftward), so the determination unit 142 does not determine the accuracy of the lane markings based on the travel trajectories K1 and K3. When excluding the travel trajectory K1 of the other vehicle m1 from the determination, the accuracy of the determination can be improved by also excluding the other vehicle m3 that moved laterally in the same direction. Note that in the fourth scene shown in FIG. 6, the determination of the accuracy of the other vehicle m3 is not performed either. However, because the other vehicles m1 and m3 move laterally in opposite directions, neither the destination after the lateral movement nor the lateral position before the lateral movement is the same as that of the other vehicle m2. Therefore, the determination unit 142 may determine the accuracy of the lane markings based at least on the travel trajectory K3 without excluding the other vehicle m2.
[0080] In this way, even when there are multiple other vehicles moving laterally, it is possible to more appropriately select the lane markings to be used for the accuracy determination (or deviation determination) based on the travel trajectories and positional relationship between the vehicle ahead and the vehicle ahead of it. Therefore, it is possible to more appropriately determine the accuracy of the lane markings, thereby improving the accuracy of determining the road shape. Furthermore, it is possible to more appropriately select the lane markings to be used for the accuracy determination (or deviation determination) based on the positional relationship (lateral positional relationship before or after the lateral movement) between the other vehicle m1 (first other vehicle) and the other vehicle m3 (third other vehicle), thereby further improving the accuracy of the determination.
[0081] The determination unit 142 may determine whether at least a portion of the vehicle in front (first other vehicle, third other vehicle) has traveled across a map division line, instead of whether the vehicle in front (first other vehicle, third other vehicle) has moved laterally. In this case, the determination unit 142 determines that the map division line is correct when at least a portion of the vehicle in front has traveled across a map division line and the vehicle ahead of the vehicle (second other vehicle) has traveled along the map division line.
[0082] Furthermore, in the first to fourth scenarios described above, if only a portion of the travel path of the vehicle two vehicles ahead (another vehicle m2) could be acquired for some reason, the determination unit 142 may determine whether the lane marking is correct or incorrect based on the travel path of the other vehicle m2 and the travel path of vehicle m1 (including other vehicle m3 in the third and fourth scenarios). The "some reason" may be, for example, that the vehicle two vehicles ahead (other vehicle m2) could not be recognized (is hidden) from the position of the host vehicle M due to the influence of the vehicle ahead (e.g., other vehicle m1) or other obstacles, but is not limited to this. Furthermore, the portion of the travel path of the vehicle two vehicles ahead may be, for example, a travel path farther away from the point where the other vehicle m1 completed its lateral movement as viewed from the host vehicle M, or a travel path shorter than the processing distance. In this way, if only a portion of the travel path of the vehicle two vehicles ahead could be acquired, determining whether the lane marking is correct or incorrect can be performed based on the travel path of the vehicle ahead, allowing for more appropriate determination processing depending on the situation.
[0083] The execution control unit 144 determines driving control for the host vehicle M based on the determination result by the determination unit 142, and executes the determined driving control. "Determining driving control" may include, for example, determining the content (type) of driving control and determining whether to execute (suppress) driving control. "Executing driving control" may include, for example, switching the content of driving control and executing it, as well as continuing driving control that is already being executed. "Suppressing driving control" may include not only not executing (terminating) driving control, but also lowering the automation level of driving control. Furthermore, the driving control executed by the execution control unit 144 may include ACC, TJP, LKAS, ALC, CMBS, etc., and may also include various other driving controls for avoiding contact with surrounding vehicles. The execution control unit 144 generates a target trajectory for executing driving control and outputs the generated target trajectory to the second control unit 160.
[0084] Here, in the first scenario, the driving control executed by the execution control unit 144 includes at least a first driving control and a second driving control. The first driving control is, for example, driving control that executes at least steering control of the steering or speed of the host vehicle M based on a lane marking recognized by the first recognition unit 132 or the second recognition unit 134 (e.g., a portion of the lane marking that does not deviate from the camera lane marking). For example, the first driving control is driving control that causes the host vehicle M to travel so that a representative point of the host vehicle M passes through the center of a lane marked by lane markings. The second driving control is, for example, driving control that executes at least steering control of the steering or speed of the host vehicle M based on map lane markings and traveling position information of other vehicles. For example, the second driving control is driving control that causes the host vehicle M to travel so that a representative point of the host vehicle M travels on a trajectory that follows the traveling trajectory of the other vehicle m1.
[0085] Furthermore, the driving control may include a third driving control in which at least steering control of the steering or speed of the host vehicle M is performed while giving priority to camera lane lines over map lane lines, and a fourth driving control in which at least steering control of the steering or speed of the host vehicle M is performed while giving priority to map lane lines over camera lane lines. Prioritizing camera lane lines over map lane lines means, for example, that processing is basically performed based on the camera lane lines, but temporarily switches to processing based on the map lane lines when, for example, the recognition accuracy of the camera lane lines falls below a threshold or they become unrecognizable. Prioritizing map lane lines over camera lane lines means, for example, that processing is basically performed based on the map lane lines, but temporarily switches to processing based on the camera lane lines when, for example, the map lane lines cannot be identified. The third driving control and the fourth driving control are driving controls performed, for example, when the camera lane lines and the map lane lines are separated from each other.
[0086] Furthermore, the driving control may include multiple driving control levels based on automation levels (an example of the degree of automation). The automation levels may include, for example, a first level, a second level with a lower degree of automation of driving control than the first level, and a third level with a lower degree of automation of driving control than the second level. The automation levels may also include a fourth level (an example of a fourth control level) with a lower degree of automation of driving control than the third level. Here, the automation level may be a level determined by standardized information, laws and regulations, or an index value set independently of such. Therefore, the types, contents, and number of automation levels are not limited to the following examples. A low degree of automation of driving control means, for example, a low automation rate in driving control and a large (heavy) task imposed on the driver. A low degree of automation of driving control means a low degree of control of the steering or acceleration / deceleration of the host vehicle M by the automatic driving control device 100 (a high degree of need for the driver to intervene in steering or acceleration / deceleration operations). Tasks assigned to the driver include, for example, monitoring the surroundings of the vehicle M and operating driving controls. Operating driving controls includes, for example, the driver gripping the steering wheel (hereinafter referred to as a hands-on state). Tasks assigned to the driver include, for example, tasks for the occupant (driver tasks) required to maintain the autonomous driving of the vehicle M. Therefore, if the occupant is unable to perform the assigned tasks, the automation level will be reduced. For example, the first level of driving control may include driving controls such as ACC, ALC, LKAS, and TJP. Furthermore, the second or third level of driving control may include driving controls such as ACC, ALC, and LKAS. The fourth level of driving control may include manual driving. Furthermore, the fourth level of driving control may include, for example, driving controls such as ACC. Of the first to fourth levels, the first level has the highest degree of automation of driving control, and the fourth level has the lowest degree of automation of driving control.
[0087] Furthermore, at the first level, no tasks are assigned to the occupant (the driver has the lightest tasks). At the second level, the task assigned to the occupant is, for example, monitoring the surroundings (particularly ahead) of the vehicle M. At the third level, the task assigned to the occupant includes, for example, monitoring the surroundings of the vehicle M as well as being in a hands-on state. At the fourth level, the task assigned to the occupant (e.g., the driver) is, for example, monitoring the surroundings of the vehicle M and being in a hands-on state, as well as operating the driving operator 80 to control the steering and speed of the vehicle M. In other words, at the fourth level, the occupant is ready to immediately take over driving, and the driver has the most severe tasks. The content of driving control and the tasks assigned to the occupant at each automation level are not limited to the examples described above. The automatic driving control device 100 executes driving control at one of the first to fourth levels based on the surrounding conditions of the vehicle M and the tasks being performed by the occupant. At least some of the first to fourth levels may be associated with the above-mentioned first to fourth operational controls, for example.
[0088] For example, if the determination unit 142 determines that both the camera lane markings CL and the map lane markings ML are correct (for example, the camera lane markings CL and the map lane markings ML do not deviate from each other), the execution control unit 144 generates a target trajectory for executing a first driving control. Furthermore, if the determination unit 142 determines that one of the camera lane markings CL and the map lane markings ML is correct, the execution control unit 144 generates a target trajectory for executing one of the second to fourth driving controls based on the correct lane marking. Furthermore, based on the determination result, the execution control unit 144 may perform control such as terminating driving control of the host vehicle M and switching to manual driving by the occupant. Furthermore, based on the determination result, the execution control unit 144 may switch the automation level corresponding to the driving control. In this case, for example, if the camera lane markings CL and the map lane markings ML are determined to be correct, a first level driving control is executed, and if they are determined to be incorrect, a second level driving control is executed, depending on the situation.
[0089] [Processing flow] The following describes the processing executed by the automatic driving control device 100 of the embodiment. FIG. 7 is a flowchart showing an example of the processing executed by the automatic driving control device 100 of the embodiment. The following mainly describes the processing executed by the automatic driving control device 100, focusing on the process of determining whether at least one of the camera lane markings CL and the map lane markings ML is correct. The automatic driving control device 100 controls the driving of the host vehicle M in accordance with the result of the determination process shown in FIG. 7. The processing described below may be repeatedly executed at a predetermined timing or at a predetermined interval, and may be repeatedly executed while automatic driving by the automatic driving control device 100 is being performed.
[0090] In the example of FIG. 7, the first recognition unit 132 recognizes lane markings (camera lane markings CL) present around the host vehicle M based on the output of the detection device DD that detects the surrounding conditions of the host vehicle M (step S100). Next, the first recognition unit 132 recognizes other vehicles present around the host vehicle M (step S110). In the processing of step S110, for example, the position, speed, traveling lane, traveling position information (traveling trajectory), etc. of the other vehicles are recognized. Next, the second recognition unit 134 refers to map information based on the position information of the host vehicle M, and recognizes lane markings (map lane markings ML) present around the host vehicle M from the map information (step S120).
[0091] Next, the determination unit 142 determines whether or not a first other vehicle that is moving laterally ahead of the host vehicle M exists (step S130). If it is determined that a first other vehicle exists, the determination unit 142 determines whether or not a second other vehicle that is present ahead of the first other vehicle and is not moving laterally exists (step S140). If it is determined that a second other vehicle exists, the determination unit 142 does not determine whether or not at least one of the camera lane markings and the map lane markings is correct based on the travel path of the first other vehicle (step S150). In this case, the determination unit 142 determines whether or not the camera lane markings and the map lane markings are correct based on the travel path of other vehicles other than the first other vehicle that are recognized by the first recognition unit 132 (step S160).
[0092] Furthermore, if it is determined in the process of step S130 that there is no first other vehicle moving laterally ahead of the host vehicle M, or if it is determined in the process of step S140 that there is no second other vehicle not moving laterally ahead of the first other vehicle, the determination unit 142 performs a success / failure determination based on at least one of the camera lane lines and the map lane lines and the travel trajectory of the other vehicle (step S170). This ends the process of this flowchart.
[0093] According to the above-described embodiment, the determination device (recognition unit 130, determination unit 142) includes a first recognition unit 132 that recognizes the surrounding situation including the camera demarcation lines (first demarcation lines) that demarcate the lane of the host vehicle M and other vehicles present around the host vehicle M based on the output of the detection device DD that detects the surrounding situation of the host vehicle M, a second recognition unit 134 that recognizes the camera demarcation lines (second demarcation lines) that demarcate the lanes around the host vehicle M from map information based on the position information of the host vehicle M, and a first recognition unit 132 that recognizes the surrounding situation including the camera demarcation lines (first demarcation lines) that demarcate the lane of the host vehicle M and other vehicles present around the host vehicle M based on the position information of the host vehicle M. and a determination unit 142 that determines whether at least one of the camera lane markings and the map lane markings is correct based on the driving trajectories of both vehicles. When, among the multiple other vehicles recognized by the first recognition unit 132, there is a first other vehicle that is moving laterally ahead of the host vehicle M and a second other vehicle that is not moving laterally ahead of the first other vehicle, the determination unit 142 does not perform a determination of whether the lane markings are correct based on the driving trajectory of the first other vehicle. This allows the determination unit 142 to more appropriately determine whether the lane markings are correct depending on the conditions of the lane markings around the host vehicle and the other vehicles. Furthermore, more appropriate driving control can be executed based on the determination result, thereby further improving the continuity of driving control. This can ultimately contribute to the development of a sustainable transportation system.
[0094] In addition, according to the embodiment, when another vehicle traveling ahead of the vehicle M is moving laterally, it is estimated that the other vehicle is changing lanes based on the traveling trajectory of the other vehicle, and this is not used to determine whether the dividing line is correct, thereby improving the accuracy of the determination.
[0095] 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: Based on an output from a detection device that detects a surrounding situation of the host vehicle, the surrounding situation including a first dividing line that divides the lane in which the host vehicle is traveling and other vehicles that exist around the host vehicle is recognized; Recognizing second lane markings that demarcate lanes around the vehicle from map information based on the position information of the vehicle; determining whether or not at least one of the first demarcation line and the second demarcation line is correct based on at least one of the first demarcation line and the second demarcation line and the travel path of the other vehicle; When there are a first other vehicle that moves laterally ahead of the host vehicle and a second other vehicle that does not move laterally ahead of the first other vehicle among the recognized multiple other vehicles, the correct / incorrect determination based on the travel trajectory of the first other vehicle is not performed. Judgment device.
[0096] 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]
[0097] 1...vehicle system, 10...camera, 12...radar device, 14...LIDAR, 16...object recognition device, 20...communication device, 30...HMI, 40...vehicle sensor, 50...navigation device, 60...MPU, 80...driving operator, 100...automatic driving control device, 120...first control unit, 130...recognition unit, 132...first recognition unit, 134...second recognition unit, 140...action plan generation unit, 142...determination unit, 144...execution control unit, 160...second control unit, 162...target trajectory acquisition unit, 164...speed control unit, 166...steering control unit, 180...HMI control unit, 190...memory unit, 200...driving force output device, 210...brake device, 220...steering device, M...host vehicle
Claims
1. a first recognition unit that recognizes a surrounding situation including a first dividing line that divides the lane in which the host vehicle is traveling and other vehicles that exist around the host vehicle based on an output of a detection device that detects a surrounding situation of the host vehicle; a second recognition unit that recognizes second lane markings that demarcate lanes around the host vehicle from map information based on the position information of the host vehicle; a determination unit that determines whether at least one of the first demarcation line and the second demarcation line is correct based on at least one of the first demarcation line and the second demarcation line and the travel path of the other vehicle, the determination unit does not perform the success / failure determination based on the travel trajectory of the first other vehicle when there are a first other vehicle that moves laterally ahead of the host vehicle and a second other vehicle that does not move laterally ahead of the first other vehicle among the multiple other vehicles recognized by the first recognition unit; Judgment device.
2. the determination unit does not perform the success / failure determination based on the travel path of the first other vehicle when the second other vehicle is present at the same lateral position as the first other vehicle has moved laterally to or before the first other vehicle moved laterally and is ahead of the first other vehicle. The determination device according to claim 1 .
3. the determination unit determines that the lane marking along the travel path of the second other vehicle is a correct lane marking, out of the first lane marking and the second lane marking. The determination device according to claim 1 .
4. the determination unit determines that one of the first and second lane markings, whose deviation angle with respect to the traveling direction of the second other vehicle is equal to or smaller than a threshold, is a correct lane marking. The determination device according to claim 1 .
5. the determination unit does not perform the success / failure determination based on the travel path of the first other vehicle and the travel path of the third other vehicle when a third other vehicle is present behind the second other vehicle and the lateral position of the third other vehicle after or before the third other vehicle has moved laterally is different from the lateral position of the second other vehicle. The determination device according to claim 2 .
6. The third other vehicle is a vehicle whose lateral position after or before the third other vehicle has moved laterally is the same as the lateral position of the first other vehicle before the first other vehicle moved laterally. The determination device according to claim 5 .
7. the third other vehicle is a vehicle moving laterally in the same direction as the first other vehicle; The determination device according to claim 5 .
8. the determination unit performs the true / false determination in an area of a predetermined width in a vehicle width direction based on the position of the second other vehicle. The determination device according to claim 1 .
9. the determination unit performs the correct / incorrect determination based on the travel locus of the first other vehicle and the travel locus of the second other vehicle when only the travel locus of the second other vehicle that is farther away than a point at which the lateral movement of the first other vehicle that is moving laterally ahead of the host vehicle has been completed is acquired. The determination device according to claim 1 .
10. The computer Based on an output from a detection device that detects a surrounding situation of the host vehicle, the surrounding situation including a first dividing line that divides the travel lane of the host vehicle and other vehicles present around the host vehicle is recognized; recognizes second lane markings that demarcate lanes around the vehicle from map information based on the position information of the vehicle; determining whether or not at least one of the first demarcation line and the second demarcation line is correct based on at least one of the first demarcation line and the second demarcation line and the travel path of the other vehicle; When there are a first other vehicle that moves laterally ahead of the host vehicle and a second other vehicle that does not move laterally ahead of the first other vehicle among the recognized multiple other vehicles, the correct / incorrect determination based on the travel trajectory of the first other vehicle is not performed. Judgment method.
11. On the computer, Based on an output from a detection device that detects a surrounding situation of the host vehicle, a surrounding situation including a first dividing line that divides the travel lane of the host vehicle and other vehicles present around the host vehicle is recognized; a second dividing line that divides a lane around the vehicle from map information based on the position information of the vehicle; determining whether at least one of the first demarcation line and the second demarcation line is correct based on at least one of the first demarcation line and the second demarcation line and the travel path of the other vehicle; When there are a first other vehicle that moves laterally ahead of the host vehicle and a second other vehicle that does not move laterally ahead of the first other vehicle among the recognized multiple other vehicles, the correct / incorrect determination based on the travel trajectory of the first other vehicle is not performed. program.
Citation Information
Patent Citations
Driving support system
JP2004322916A
Travel control device for vehicle
JP2016101889A
Vehicle control device, vehicle control method, and program
JP2020050086A
Vehicle travel control device
JP2022039469A
Vehicle control device, vehicle control method, and program
JP2024025478A