KR20200133442A - Autonomous driving apparatus and method - Google Patents

Abstract

The present invention relates to an autonomous driving device and method. The autonomous driving device comprises: a sensor unit detecting a nearby object including a nearby vehicle of a vehicle in autonomous driving; a memory storing map information; and a processor controlling the autonomous driving of the vehicle according to an expected driving trajectory generated based on the map information stored in the memory. The processor determines whether it is necessary to correct the expected driving trajectory of the vehicle based on a result of the sensor unit detecting the nearby vehicle of the vehicle, performs trajectory-based control to control autonomous driving of the vehicle by correcting the expected driving trajectory according to the determination result, and performs cluster tracking control for controlling the autonomous driving of the vehicle to follow the driving of the driving cluster when a first driving path to a destination of the vehicle overlaps with a second travel path of the travel cluster formed by a plurality of cluster vehicles. The processor changes a detection area of the nearby object of the sensor unit according to a relative position of the vehicle with respect to the cluster vehicle belonging to the driving cluster when performing cluster following control.

Description

Autonomous driving device and method {AUTONOMOUS DRIVING APPARATUS AND METHOD}

The present invention relates to an autonomous driving apparatus and method applied to an autonomous driving vehicle.

Today's automotive industry is moving toward implementing autonomous driving that minimizes driver intervention in vehicle driving. An autonomous vehicle refers to a vehicle that independently determines a driving route by recognizing the surrounding environment through a function of sensing and processing external information during driving, and independently driving by using its own power.

Autonomous vehicles can drive themselves to their destination by preventing collisions with obstacles on the driving path and adjusting the vehicle speed and driving direction according to the shape of the road, even if the driver does not operate the steering wheel, accelerator pedal, or brake. have. For example, acceleration may be performed on a straight road and deceleration may be performed while changing a driving direction in response to a curvature of the road on a curved road.

In order to ensure stable driving of an autonomous vehicle, it is necessary to accurately measure the driving environment through each sensor mounted on the vehicle, and control the driving according to the measured driving environment by continuously monitoring the driving state of the vehicle. To this end, various sensors, such as a lidar sensor, a radar sensor, an ultrasonic sensor, and a camera sensor, are applied to the autonomous vehicle as a sensor for detecting surrounding objects such as surrounding vehicles, pedestrians, and fixed facilities. Data output from these sensors is used to determine information about the driving environment, such as the location, shape, movement direction, and movement speed of surrounding objects.

Furthermore, autonomous vehicles use pre-stored map data to determine and correct the location of the vehicle to optimally determine the driving route and driving lane, control the driving of the vehicle so as not to deviate from the determined path and lane, and abruptly It also provides the function of performing defense and avoidance driving against dangers existing on the vehicle entering or the driving path.

Background art of the present invention is disclosed in Korean Patent Application Publication No. 10-1998-0068399 (published on October 15, 1998).

An object according to an aspect of the present invention is to selectively apply a method of controlling autonomous driving of a vehicle according to a driving trajectory to a destination and a method of following the driving of a driving cluster formed of a plurality of clustered vehicles, thereby It is to provide an autonomous driving apparatus and method that enables reaching a destination in the shortest time while minimizing a driving control computational load.

According to another aspect of the present invention, in the process of performing cluster driving by joining a driving cluster by an autonomous vehicle, an angle belonging to the driving cluster is changed by varying the sensing area of surrounding objects according to the relative position with the other cluster vehicles. It is to provide an autonomous driving apparatus and method capable of reducing the total resources of a system required for a cluster vehicle to sense surrounding objects.

An autonomous driving device according to an aspect of the present invention includes a sensor unit that detects surrounding objects including nearby vehicles of an own vehicle that is autonomously driving, a memory that stores map information, and a prediction generated based on map information stored in the memory. And a processor for controlling autonomous driving of the own vehicle according to a driving trajectory, wherein the processor needs to correct the predicted driving trajectory of the own vehicle based on a result of the sensor unit detecting the surrounding vehicles of the host vehicle. It determines whether there is a presence, and performs a trajectory-based control for controlling autonomous driving of the own vehicle by correcting the predicted driving trajectory according to the determination result, and the first driving route to the destination of the host vehicle is a plurality of cluster vehicles. When overlapping with the second driving path of the driving cluster formed as, cluster following control for controlling autonomous driving of the host vehicle to follow the driving of the driving cluster, and the processor, when performing the cluster following control And varying an object detection area around the sensor unit according to a relative position of the host vehicle with respect to the cluster vehicle belonging to the driving cluster.

In the present invention, when performing the trajectory-based control, the processor generates an actual driving trajectory of the surrounding vehicle based on the driving information of the surrounding vehicle detected by the sensor unit, and the map information stored in the memory is It is determined that it is necessary to correct the predicted driving trajectory of the own vehicle when the predicted driving trajectory of the surrounding vehicle is generated based on and the trajectory error between the actual driving trajectory and the predicted driving trajectory of the surrounding vehicle is greater than or equal to a preset threshold value. Characterized in that.

In the present invention, in the case of performing the cluster following control, the processor includes, based on a direction in which the host vehicle travels to a destination, from a confluence point at which an overlap between the first and second travel routes is started, the first And performing the cluster following control up to the withdrawal point at which the overlap between the second travel paths ends.

In the present invention, the processor performs by mutually switching the trajectory-based control and the cluster tracking control according to whether a predefined control switching condition is satisfied, and the control switching condition is the cluster following control from the trajectory-based control. And a cluster following control switching condition for switching to and a trajectory-based control switching condition for switching from the cluster following control to the trajectory-based control.

In the present invention, when the host vehicle reaches the confluence point in the process of performing the trajectory-based control from the current position of the host vehicle, the processor determines that the cluster following control switching condition is satisfied, and the cluster It is characterized in that it performs tracking control.

In the present invention, the processor performs the trajectory-based control by determining that the trajectory-based control switching condition is satisfied when the host vehicle reaches the withdrawal point in the process of performing cluster tracking control from the confluence point. Characterized in that.

In the present invention, the processor determines the confluence point and the withdrawal point for performing the cluster tracking control from a plurality of candidate confluence points and a plurality of candidate withdrawal points, and the own vehicle is based on the trajectory-based control. The time required to reach the candidate confluence point from the current position, the time required for the host vehicle to reach the candidate withdrawal point from the candidate confluence point based on the cluster tracking control, and the candidate withdrawal point based on the trajectory-based control A candidate confluence point and a candidate withdrawal point at which the total required time, which is a sum of time required to reach the destination from, are determined as the confluence point and the withdrawal point, respectively.

In the present invention, in the case of performing the cluster following control, the processor classifies the driving cluster into a preceding driving group, a middle driving group, and a following driving group using a predefined group classification algorithm, and among the driving groups The driving group to which the own vehicle belongs is determined, and an object detection area around the sensor unit is varied according to the determination result.

In the present invention, the processor, when the host vehicle belongs to the preceding driving group, detects an object in front of the host vehicle through the sensor unit, and when the host vehicle belongs to the middle driving group, through the sensor unit A peripheral object at the side of the host vehicle is detected, and when the host vehicle belongs to the following driving group, the surrounding object at the rear of the host vehicle is detected through the sensor unit.

An autonomous driving method according to an aspect of the present invention includes a sensor unit that detects a surrounding object including a nearby vehicle of an autonomous vehicle, a memory that stores map information, and a prediction generated based on map information stored in the memory. A method for controlling autonomous driving in an autonomous driving system including a processor for controlling autonomous driving of the own vehicle according to a driving trajectory, wherein the processor includes the sensor unit based on a result of detecting a vehicle surrounding the host vehicle. It is determined whether it is necessary to correct the expected driving trajectory of the own vehicle, and performing a trajectory-based control for controlling the autonomous driving of the own vehicle by correcting the predicted driving trajectory according to the determination result, and the processor , When the first driving path to the destination of the host vehicle overlaps with the second driving path of the driving cluster formed of a plurality of cluster vehicles, cluster following for controlling the autonomous driving of the host vehicle to follow the driving of the driving cluster Including the step of performing a control, and in the step of performing the cluster following control, the processor, in accordance with the relative position of the host vehicle with respect to the cluster vehicle belonging to the driving cluster, variable the detection area of the surrounding object of the sensor unit It is characterized by letting.

According to an aspect of the present invention, the present invention provides a trajectory-based control for controlling autonomous driving according to a driving trajectory correction for each predetermined section on a route from a current position of an autonomous vehicle to a destination, and a cluster tracking control for following the driving of a driving cluster. By switching to each other, it is possible to reduce the autonomous driving control calculation load of the autonomous vehicle and minimize the occupant's intervention in the driving control of the vehicle in the process of reaching the destination, thereby improving the occupant's convenience and reaching the destination in the shortest time. You can make it possible to reach.

In addition, according to an aspect of the present invention, since the present invention operates to change the detection area of surrounding objects of the sensor unit according to the relative position of the host vehicle with respect to other cluster vehicles belonging to the driving cluster when performing cluster following control, When viewed from the level of the entire cluster vehicle being driven, it is possible to reduce the total resources of the system required for each cluster vehicle belonging to the driving cluster to sense surrounding objects.

1 is an overall block diagram of an autonomous driving control system to which an autonomous driving device according to an embodiment of the present invention can be applied.
2 is a block diagram showing a detailed configuration of an integrated autonomous driving control unit in an autonomous driving device according to an embodiment of the present invention.
3 is an exemplary view showing an example in which an autonomous driving device according to an embodiment of the present invention is applied to a vehicle.
4 is an exemplary view showing an example of an internal structure of a vehicle to which an autonomous driving device according to an embodiment of the present invention is applied.
5 is an exemplary view showing an example of a set distance and a horizontal angle of view at which a lidar sensor, a radar sensor, and a camera sensor can detect surrounding objects in an autonomous driving apparatus according to an embodiment of the present invention.
6 is an exemplary view showing an example in which a sensor unit detects a nearby vehicle in an autonomous driving device according to an embodiment of the present invention.
7 is an exemplary view showing an example in which an object detection area around a sensor unit is changed according to a position of an own vehicle in a driving cluster in an autonomous driving apparatus according to an embodiment of the present invention.
8 and 9 are flowcharts illustrating an autonomous driving method according to an embodiment of the present invention.

Hereinafter, embodiments of an autonomous driving apparatus and method according to the present invention will be described with reference to the accompanying drawings. In this process, the thickness of the lines or the size of components shown in the drawings may be exaggerated for clarity and convenience of description. In addition, terms to be described later are terms defined in consideration of functions in the present invention and may vary according to the intention or custom of users or operators. Therefore, definitions of these terms should be made based on the contents throughout the present specification.

1 is an overall block diagram of an autonomous driving control system to which an autonomous driving device according to an embodiment of the present invention can be applied, and FIG. 2 is a detailed diagram of an autonomous driving integrated control unit in an autonomous driving device according to an embodiment of the present invention. A block diagram showing the configuration, FIG. 3 is an exemplary view showing an example in which an autonomous driving device according to an embodiment of the present invention is applied to a vehicle, and FIG. 4 is an autonomous driving device according to an embodiment of the present invention applied. It is an exemplary view showing an example of the internal structure of the vehicle, and FIG. 5 is a set distance and a horizontal angle of view at which a lidar sensor, a radar sensor, and a camera sensor can detect surrounding objects in an autonomous driving device according to an embodiment of the present invention. 6 is an exemplary view showing an example in which a sensor unit detects a nearby vehicle in an autonomous driving apparatus according to an embodiment of the present invention, and FIG. 7 is an autonomous driving according to an embodiment of the present invention. It is an exemplary view showing an example in which the detection area of the surrounding object of the sensor unit varies according to the position of the own vehicle in the driving cluster in the apparatus.

First, the structure and function of the autonomous driving control system to which the autonomous driving apparatus according to the present embodiment can be applied will be described with reference to FIGS. 1 and 3. As shown in FIG. 1, the autonomous driving control system is used to control autonomous driving of a vehicle through a driving information input interface 101, a driving information input interface 201, a passenger output interface 301, and a vehicle control output interface 401. It may be implemented around the autonomous driving integrated control unit 600 that transmits and receives necessary data.

The integrated autonomous driving control unit 600 may obtain driving information according to a user's manipulation of the user input unit 100 in the autonomous driving mode or the manual driving mode of the vehicle through the driving information input interface 101. The user input unit 100 includes a driving mode switch 110 and a user terminal 120 (e.g., a navigation terminal mounted on a vehicle, a smartphone or a tablet PC, etc.) possessed by a passenger, as shown as an example in FIG. 1 Accordingly, the driving information may include driving mode information and navigation information of the vehicle. For example, the driving mode of the vehicle determined according to the operation of the occupant on the driving mode switch 110 (i.e., autonomous driving mode/manual driving mode, or sports mode/eco mode/safety A mode (Safe Mode)/Normal Mode) may be transmitted to the autonomous driving integrated control unit 600 through the driving information input interface 101 as the driving information described above. In addition, navigation information such as the passenger's destination input through the user terminal 120 by the occupant and the route to the destination (the shortest route selected by the occupant among candidate routes to the destination, or a preferred route, etc.) is driving information as described above. It may be transmitted to the integrated autonomous driving controller 600 through the input interface 101. Meanwhile, the user terminal 120 may be implemented as a control panel (eg, a touch screen panel) that provides a user interface (UI) for the driver to input or modify information for autonomous driving control of the vehicle. In this case, the driving mode switch 110 described above may be implemented as a touch button on the user terminal 120.

In addition, the autonomous driving integrated control unit 600 may obtain driving information indicating the driving state of the vehicle through the driving information input interface 201. The driving information includes the steering angle formed as the passenger manipulates the steering wheel, the accelerator pedal stroke or the brake pedal stroke formed by depressing the accelerator pedal or the brake pedal, and the vehicle speed, acceleration, yaw, and pitch as the behavior formed in the vehicle. And various information indicating the driving state and behavior of the vehicle such as a roll, and each of the driving information includes a steering angle sensor 210, an APS (Accel Position Sensor)/PTS (Pedal Travel Sensor) as shown in FIG. 220, the vehicle speed sensor 230, the acceleration sensor 240, it may be detected by the driving information detection unit 200 including the yaw / pitch / roll sensor 250. Furthermore, the driving information of the vehicle may include location information of the vehicle, and the location information of the vehicle may be obtained through the GPS (Global Positioning Sysetm) receiver 260 applied to the vehicle. The driving information may be transmitted to the integrated autonomous driving controller 600 through the driving information input interface 201 and used to control the driving of the vehicle in the autonomous driving mode or the manual driving mode.

In addition, the integrated autonomous driving controller 600 may transmit driving state information provided to the occupant in the autonomous driving mode or the manual driving mode of the vehicle to the output unit 300 through the occupant output interface 301. That is, the integrated autonomous driving control unit 600 transmits the driving state information of the vehicle to the output unit 300, so that the occupant can drive the vehicle autonomously or manually based on the driving state information output through the output unit 300. The state may be checked, and the driving state information may include various information indicating the driving state of the vehicle, such as a current driving mode, a shift range, and a vehicle speed. In addition, the autonomous driving integrated control unit 600 outputs warning information through the occupant output interface 301 when it is determined that the driver needs a warning in the autonomous driving mode or the manual driving mode of the vehicle together with the driving status information. By passing it to 300, the output unit 300 may output a warning to the driver. In order to audibly and visually output such driving state information and warning information, the output unit 300 may include a speaker 310 and a display device 320 as shown in FIG. 1. In this case, the display device 320 may be implemented as the same device as the user terminal 120 described above, or may be implemented as a separate and independent device.

In addition, the autonomous driving integrated control unit 600 may transmit control information for driving control of the vehicle in the autonomous driving mode or the manual driving mode of the vehicle to the lower control system 400 applied to the vehicle through the vehicle control output interface 401. have. The lower control system 400 for driving control of a vehicle may include an engine control system 410, a braking control system 420, and a steering control system 430 as shown in FIG. 1, and an integrated autonomous driving control unit 600 may transmit engine control information, braking control information, and steering control information as the control information to each of the sub-control systems 410, 420, and 430 through the vehicle control output interface 401. Accordingly, the engine control system 410 may increase or decrease the fuel supplied to the engine to control the vehicle speed and acceleration, and the braking control system 420 may control the braking of the vehicle by adjusting the braking force of the vehicle. In addition, the steering control system 430 may control the steering of the vehicle through a steering device applied to the vehicle (eg, a Motor Driven Power Steering (MDPS) system).

As described above, the autonomous driving integrated control unit 600 according to the present embodiment provides driving information according to the driver's manipulation and driving information indicating the driving state of the vehicle through the driving information input interface 101 and the driving information input interface 201, respectively. The driving state information and warning information generated according to the autonomous driving algorithm acquired and processed by the internal processor 610 may be transmitted to the output unit 300 through the occupant output interface 301, and the internal processor ( Control information generated according to the autonomous driving algorithm processed by 610 may be transmitted to the lower control system 400 through the vehicle control output interface 401 to perform driving control of the vehicle.

Meanwhile, in order to ensure stable autonomous driving of the vehicle, it is necessary to continuously monitor the driving state by accurately measuring the driving environment of the vehicle and control the driving according to the measured driving environment. To this end, the autonomous driving apparatus of this embodiment As shown in FIG. 1, it may include a sensor unit 500 for detecting objects around the vehicle, such as surrounding vehicles, pedestrians, roads, or fixed facilities (eg, traffic lights, milestones, traffic signs, construction fences, etc.). The sensor unit 500 may include one or more of a lidar sensor 510, a radar sensor 520, and a camera sensor 530 to detect surrounding objects outside the vehicle as shown in FIG. 1.

The lidar sensor 510 can detect surrounding objects outside the vehicle by transmitting a laser signal around the vehicle and receiving a signal that is reflected and returned to the object. It is possible to detect surrounding objects located within a vertical field of view and a set horizontal field of view. The lidar sensor 510 may include a front lidar sensor 511, an upper lidar sensor 512, and a rear lidar sensor 513 respectively installed at the front, upper and rear of the vehicle, but the installation position thereof And the number of installations is not limited to a specific embodiment. The threshold value for determining the validity of the laser signal reflected and returned from the object may be stored in advance in the memory 620 of the integrated autonomous driving controller 600, and the processor 610 of the integrated autonomous driving controller 600 Is to determine the position (including the distance to the object), speed, and movement direction of the object through a method of measuring the time when the laser signal transmitted through the lidar sensor 510 is reflected on the object and returns. I can.

The radar sensor 520 can detect surrounding objects outside the vehicle by emitting electromagnetic waves around the vehicle and receiving a signal reflected back from the object, and a preset distance, a set vertical angle of view, and Nearby objects located within the set horizontal angle of view can be detected. The radar sensor 520 includes a front radar sensor 521, a left radar sensor 521, a right radar sensor 522, and a rear radar sensor 523 respectively installed on the front, left, right and rear of the vehicle. However, the installation location and the number of installations are not limited to specific embodiments. The processor 610 of the autonomous driving integrated control unit 600 analyzes the power of the electromagnetic waves transmitted and received through the radar sensor 520 to determine the location of the object (including the distance to the object) and speed. And the moving direction can be determined.

The camera sensor 530 may detect surrounding objects outside the vehicle by photographing the surroundings of the vehicle, and may detect surrounding objects located within a preset distance, a set vertical angle of view, and a set horizontal angle of view according to the specifications. . The camera sensor 530 includes a front camera sensor 531, a left camera sensor 532, a right camera sensor 533, and a rear camera sensor 534 respectively installed on the front, left, right and rear of the vehicle. However, the installation location and the number of installations are not limited to specific embodiments. The processor 610 of the autonomous driving integrated control unit 600 applies a predefined image processing processing to the image captured through the camera sensor 530, so that the location of the object (including the distance to the object) and speed And the moving direction can be determined. In addition, an internal camera sensor 535 for capturing the inside of the vehicle may be mounted at a predetermined position (eg, a rear view mirror) inside the vehicle, and the processor 610 of the autonomous driving integrated control unit 600 is an internal camera A guide or warning may be output to the occupant through the above-described output unit 300 by monitoring the occupant's behavior and condition based on the image acquired through the sensor 535.

In addition to the lidar sensor 510, the radar sensor 520, and the camera sensor 530, the sensor unit 500 may further include an ultrasonic sensor 540 as shown in FIG. Various types of sensors for detecting surrounding objects may be further employed in the sensor unit 500. 3 is a front lidar sensor 511 or a front radar sensor 521 installed on the front of the vehicle, and a rear lidar sensor 513 or a rear radar sensor 524 is installed at the rear of the vehicle to aid understanding of this embodiment. The front camera sensor 531, the left camera sensor 532, the right camera sensor 533, and the rear camera sensor 534 are respectively installed on the front, left, right and rear sides of the vehicle. , As described above, the installation position and number of each sensor are not limited to a specific embodiment. FIG. 5 shows an example of a set distance and a horizontal angle of view at which the lidar sensor 510, the radar sensor 520, and the camera sensor 530 can detect surrounding objects in front, and FIG. 6 is An example of detecting an object is shown. 6 is only an example of detecting surrounding objects, and a method of detecting surrounding objects is determined depending on the installation location and number of sensors. According to the configuration of the sensor unit 500 described above, surrounding vehicles and surrounding objects in an omnidirectional region of the host vehicle may be detected.

Furthermore, the sensor unit 500 detects voice and bio signals of the occupant (eg, heart rate, electrocardiogram, respiration, blood pressure, body temperature, brain waves, blood flow (pulse wave), blood sugar, etc.) to determine the state of the occupant in the vehicle. It may further include a microphone and a biometric sensor, and the biometric sensor includes a heart rate sensor, an electrocardiogram sensor, a breathing sensor, a blood pressure sensor, a body temperature sensor, an electroencephalogram sensor, a photoplethysmography sensor, and a blood sugar sensor. This can be.

4 shows an example of the internal structure of the vehicle, and the state of the vehicle is controlled by the operation of the occupant, such as the driver or passenger of the vehicle, to facilitate the driver's driving or convenience (e.g., rest, entertainment activities, etc.) Internal devices may be installed to support. Such an internal device may include a vehicle seat (S) on which the occupant is seated, a lighting device such as an interior light and mood lamp (L), the aforementioned user terminal 120 and a display device 320, an interior table, and the like. The state of the internal device may be controlled by the processor 610.

In the case of the vehicle seat S, the angle can be adjusted by the processor 610 (or by manual operation of the occupant), and the vehicle seat S is the front row seat S1 and the rear row seat S2 If it is composed of, only the angle of the front row seat (S1) can be adjusted. If the rear row seat (S2) is not provided and the front row seat (S1) is divided into a seat structure and a footrest structure, the seat structure of the front row seat (S1) is physically separated from the footrest structure. It can be implemented so that the angle is adjusted. In addition, an actuator (eg, a motor) for adjusting the angle of the vehicle seat S may be provided. In the case of the lighting device L, the on/off may be controlled by the processor 610 (or by manual operation of the occupant), and the lighting device L may operate a plurality of lighting units such as internal lights and mood lights. When included, each lighting unit can be independently controlled on and off. The user terminal 120 or the display device 320 may adjust the angle according to the occupant's viewing angle by the processor 610 (or by the occupant's manual operation), for example, the screen in the direction of the occupant's gaze. The angle can be adjusted so that there is. In this case, an actuator (eg, a motor) for adjusting the angles of the user terminal 120 and the display device 320 may be provided.

The integrated autonomous driving controller 600 may communicate with the server 700 through a network as shown in FIG. 1. As a network method between the autonomous driving integrated control unit 600 and the server 700, various communication methods such as a wide area network (WAN), a local area network (LAN), or a personal area network (PAN) may be employed. In addition, in order to secure wide network coverage, LPWAN (Low Power Wide Area Network, a network with very wide coverage among Internet of Things, including commercialized technologies such as LoRa, Sigfox, Ingenu, LTE-M, NB-IOT, etc.) communication The scheme can be employed. For example, LoRa (low-power communication is possible, but has a wide coverage of up to 20Km), or Sigfox (which has a coverage of 10Km (city) to 30Km (outskirts outside the city) depending on the environment) is adopted. In addition, 3GPP (3rd Generation) such as LTE-MTC (Machine-type Communications) (or LTE-M), NB (Narrowband) LTE-M, and NB IoT having a power saving mode (PSM) Partnership Project) Release 12, 13-based LTE network technology may be employed. The server 700 may provide map information that is kept up to date (various map information such as two-dimensional navigation map data, three-dimensional remote map data, or three-dimensional high-precision electronic map data may correspond), and further It can also provide various information such as accident information, road control information, traffic volume information and weather information. The autonomous driving integrated control unit 600 may receive the latest map information from the server 700 and update the map information stored in the memory 620, and receive accident information, road control information, traffic volume information, and weather information to It can also be used for autonomous driving control.

Next, the structure and function of the integrated autonomous driving controller 600 according to the present embodiment will be described with reference to FIG. 2. As shown in FIG. 2, the integrated autonomous driving controller 600 may include a processor 610 and a memory 620.

The memory 620 may store basic information necessary for the autonomous driving control of the vehicle, or may store information generated in the process of controlling the autonomous driving of the vehicle by the processor 610, and the processor 610 may store the memory 620 ), you can control the autonomous driving of the vehicle by accessing (read, access) the information stored in it. The memory 620 may be implemented as a computer-readable recording medium and may operate to allow the processor 610 to access it. Specifically, the memory 620 is a hard drive, magnetic tape, memory card, read-only memory (ROM), random-access memory (RAM), digital video disc (DVD), or optical disk. It may be implemented as an optical data storage device such as.

Map information required for autonomous driving control by the processor 610 may be stored in the memory 620. The map information stored in the memory 620 may be a navigation map (a numerical topographic map) that provides road-level information, but a precision road map that provides road information in units of lanes to improve the precision of autonomous driving control, That is, it may be desirable to be implemented as 3D high-precision electronic map data. Accordingly, the map information stored in the memory 620 is dynamic and necessary for autonomous driving control of the vehicle, such as lanes, lane center lines, regulatory lines, road boundaries, road center lines, traffic signs, road signs, road shapes and heights, and lane widths. Static information can be provided.

In addition, the memory 620 may store an autonomous driving algorithm for autonomous driving control of a vehicle. The autonomous driving algorithm is an algorithm (recognition, determination and control algorithm) that recognizes the surroundings of an autonomous vehicle, determines its state, and controls the driving of the vehicle according to the determination result, and the processor 610 is an autonomous vehicle stored in the memory 620 By executing the driving algorithm, it is possible to perform active autonomous driving control in the surrounding environment of the vehicle.

The processor 610 includes driving information and driving information respectively input from the driving information input interface 101 and the driving information input interface 201 described above, information on surrounding objects detected through the sensor unit 500, and memory. The autonomous driving of the vehicle may be controlled based on the map information stored in 620 and the autonomous driving algorithm. The processor 610 may be implemented as a dedicated semiconductor circuit such as an embedded processor such as a complex instruction set computer (CISC) or a reduced instruction set computer (RISC), or an application specific integrated circuit (ASIC). .

In this embodiment, the processor 610 may control autonomous driving of the own vehicle by analyzing each driving trajectory of the own vehicle and the surrounding vehicle. To this end, as shown in FIG. 2, the processor 610 includes a sensor processing module ( 611), a driving trajectory generation module 612, a driving trajectory analysis module 613, a driving control module 614, a trajectory learning module 615, and a passenger status determination module 616. Although FIG. 2 shows each module as an independent block according to a function, each module may be integrated into one module to be implemented in a configuration in which each function is integrated.

The sensor processing module 611 includes driving information of the surrounding vehicle (that is, the location of the surrounding vehicle, and includes the location of the surrounding vehicle and the speed of the surrounding vehicle along with the location) based on the result of detecting the surrounding vehicle of the host vehicle through the sensor unit 500. It may further include a moving direction). That is, the position of the surrounding vehicle is determined based on the signal received through the lidar sensor 510, the position of the surrounding vehicle is determined based on the signal received through the radar sensor 520, or the camera sensor 530 The location of the surrounding vehicle may be determined based on the image captured through the device, or the location of the surrounding vehicle may be determined based on a signal received through the ultrasonic sensor 540. To this end, the sensor processing module 611 as shown in FIG. 1 may include a lidar signal processing module 611a, a radar signal processing module 611b, and a camera signal processing module 611c (ultrasonic signal processing A module may be further added to the sensor processing module 611). A method of determining a location of a nearby vehicle using the lidar sensor 510, the radar sensor 520, and the camera sensor 530 is a specific embodiment, and the implementation method is not limited thereto. In addition, the sensor processing module 611 may determine attribute information such as the size and type of the surrounding vehicle as well as the location, speed, and movement direction of the surrounding vehicle, and the position, speed, movement direction, and size of the surrounding vehicle as described above. And an algorithm for determining information such as type may be predefined.

The driving trajectory generation module 612 can generate the actual driving trajectory and the expected driving trajectory of the surrounding vehicle, and the actual driving trajectory of the own vehicle, and for this purpose, as shown in FIG. 2, the surrounding vehicle driving trajectory generation module 612a And a driving trajectory generation module 612b of the own vehicle.

First, the surrounding vehicle driving trajectory generation module 612a may generate an actual driving trajectory of the surrounding vehicle.

Specifically, the surrounding vehicle driving trajectory generation module 612a is based on the driving information of the surrounding vehicle detected by the sensor unit 500 (that is, the position of the surrounding vehicle determined by the sensor processing module 611). You can create an actual driving trajectory. In this case, in order to generate the actual driving trajectory of the surrounding vehicle, the surrounding vehicle driving trajectory generation module 612a may refer to the map information stored in the memory 620, and the position of the surrounding vehicle detected by the sensor unit 500 And a random location on the map information stored in the memory 620 may be cross-referenced to generate an actual driving trajectory of the surrounding vehicle. For example, when a nearby vehicle is detected at a specific point by the sensor unit 500, the surrounding vehicle driving trajectory generation module 612a is a location of the detected surrounding vehicle and an arbitrary location on the map information stored in the memory 620. By cross-referencing, it is possible to specify the location of the currently detected surrounding vehicle on the map information, and by continuously monitoring the location of the surrounding vehicle as described above, the actual driving trajectory of the surrounding vehicle can be generated. That is, the surrounding vehicle driving trajectory generation module 612a maps and accumulates the location of the surrounding vehicle detected by the sensor unit 500 to the location on the map information stored in the memory 620 based on the cross reference. The actual driving trajectory of the vehicle can be created.

Meanwhile, the actual driving trajectory of the surrounding vehicle may be compared with the predicted driving trajectory of the surrounding vehicle to be described later, and used to determine whether the map information stored in the memory 620 is incorrect. In this case, when comparing the actual driving trajectory of a specific surrounding vehicle with the predicted driving trajectory, a problem of erroneously determining that the map information is accurate but inaccurate may arise. For example, when the actual driving trajectory of a plurality of surrounding vehicles and the predicted driving trajectory coincide with each other, and the actual driving trajectory and the predicted driving trajectory of a specific surrounding vehicle are different, only the actual driving trajectory of the specific surrounding vehicle is matched with the expected driving trajectory. In comparison, even though the map information is accurate, it can be misjudged as inaccurate. Therefore, there is a need to determine whether the tendency of the actual driving trajectory of the plurality of surrounding vehicles deviates from the expected driving trajectory, and for this purpose, the driving trajectory generation module 612a of the surrounding vehicles generates the actual driving trajectories of the plurality of surrounding vehicles, respectively. You may. Furthermore, considering that the driver of the surrounding vehicle tends to move the steering wheel to the left and right during the driving process for a straight path driving, the actual driving trajectory of the surrounding vehicle may be generated in a curved shape rather than a straight line. In order to calculate the error between the predicted driving trajectories, the driving trajectory generation module 612a of the surrounding vehicle may generate the actual driving trajectory in the form of a straight line by applying a predetermined smoothing technique to the original actual driving trajectory that is generated in a curved form. Various techniques such as interpolation for each position of the surrounding vehicle can be employed as the smoothing technique.

Also, the surrounding vehicle driving trajectory generation module 612a may generate a predicted driving trajectory of the surrounding vehicle based on map information stored in the memory 620.

As described above, the map information stored in the memory 620 may be 3D high-precision electronic map data. Therefore, the map information includes lanes, lane center lines, regulatory lines, road boundaries, road center lines, traffic signs, road signs, and road shapes. And it is possible to provide dynamic and static information necessary for autonomous driving control of the vehicle, such as height and lane width. In general, considering that the vehicle runs in the center of the lane, it may be expected that the surrounding vehicles running in the vicinity of the own vehicle also travel in the center of the lane. Therefore, the surrounding vehicle driving trajectory generation module 612a The vehicle's predicted driving trajectory can be generated as a lane center line reflected in the map information.

The own vehicle driving trajectory generation module 612b may generate an actual driving trajectory that the own vehicle has traveled to date based on the driving information of the own vehicle acquired through the driving information input interface 201 described above.

Specifically, the host vehicle driving trajectory generation module 612b includes a location of the host vehicle obtained through the driving information input interface 201 (that is, location information of the host vehicle obtained through the GPS receiver 260) and a memory 620 ), it is possible to create an actual driving trajectory of the own vehicle by cross-referencing an arbitrary location on the map information stored in ). For example, by cross-referencing the location of the own vehicle acquired through the driving information input interface 201 and an arbitrary location on the map information stored in the memory 620, the current location of the own vehicle can be specified on the map information, As described above, by continuously monitoring the position of the own vehicle, an actual driving trajectory of the own vehicle can be generated. That is, the host vehicle driving trajectory generation module 612b maps and accumulates the location of the host vehicle acquired through the driving information input interface 201 to the location on the map information stored in the memory 620 based on the cross reference. By doing so, it is possible to generate an actual traveling trajectory of the own vehicle.

In addition, the own vehicle driving trajectory generation module 612b may generate a predicted driving trajectory in which the own vehicle should travel to the destination based on map information stored in the memory.

That is, the own vehicle driving trajectory generation module 612b is stored in the current position of the own vehicle obtained through the driving information input interface 201 (that is, the current position information of the own vehicle obtained through the GPS receiver 260) and the memory. An estimated driving trajectory to the destination can be generated using the stored map information, and the predicted driving trajectory of the own vehicle will be generated as a center line of the lane reflected in the map information stored in the memory 620 like the predicted driving trajectory of nearby vehicles. I can.

The driving trajectory generated by the surrounding vehicle driving trajectory generating module 612a and the own vehicle driving trajectory generating module 612b may be stored in the memory 620, and the autonomous driving of the own vehicle is controlled by the processor 610. It can be used for various purposes in the process.

The driving trajectory analysis module 613 is generated by the driving trajectory generation module 612 and stored in the memory 620 (that is, the actual driving trajectory and the expected driving trajectory of the surrounding vehicle, the actual driving trajectory of the own vehicle). By analyzing, it is possible to diagnose the reliability of autonomous driving control for the current own vehicle. The reliability diagnosis of autonomous driving control may be performed by analyzing a trajectory error between an actual driving trajectory and an expected driving trajectory of nearby vehicles.

The driving control module 614 may perform a function of controlling autonomous driving of the own vehicle, and specifically, driving information and driving information input from the driving information input interface 101 and the driving information input interface 201 described above, respectively. Wow, the autonomous driving algorithm is processed by comprehensively using information on surrounding objects detected through the sensor unit 500 and map information stored in the memory 620, and control information is transmitted through the vehicle control output interface 401. It is possible to allow the lower control system 400 to control the autonomous driving of the own vehicle by transmitting the vehicle, and also transmit the driving state information and warning information of the own vehicle to the output unit 300 through the occupant output interface 301 to the driver Can be made aware of. In addition, when the driving control module 614 integrally controls the autonomous driving as described above, the own vehicle analyzed by the sensor processing module 611, the driving trajectory generation module 612, and the driving trajectory analysis module 613 And by controlling the autonomous driving in consideration of the driving trajectory of the surrounding vehicle, the precision of the autonomous driving control may be improved and the stability of the autonomous driving control may be improved.

The trajectory learning module 615 may learn or correct the actual driving trajectory of the own vehicle generated by the own vehicle driving trajectory generation module 612b. For example, if the trajectory error between the actual driving trajectory of the surrounding vehicle and the expected driving trajectory is greater than or equal to a preset threshold, it is determined that the map information stored in the memory 620 is inaccurate, and it is determined that the actual driving trajectory of the own vehicle needs to be corrected. Accordingly, a lateral shift value for correcting the actual traveling trajectory of the own vehicle may be determined to correct the traveling trajectory of the own vehicle.

The occupant state determination module 616 may determine the occupant's state and behavior based on the occupant's state and bio-signals detected by the aforementioned internal camera sensor 535 and the biometric sensor. The state of the occupant determined by the occupant state determination module 616 may be used in the process of controlling the autonomous driving of the own vehicle or outputting a warning to the occupant.

Based on the above, in the following, the trajectory-based control for controlling autonomous driving according to the driving trajectory correction for each predetermined section on the route from the current position of the host vehicle to the destination and the cluster following control for following the driving of the driving cluster are mutually switched. Hereinafter, an embodiment to be performed will be described.

The processor 610 of the present embodiment may control autonomous driving of the own vehicle according to the driving trajectory generated by the above-described driving trajectory generation module 612 of the own vehicle based on map information stored in the memory 620. Specifically, the processor 610 determines whether it is necessary to correct the driving trajectory of the own vehicle based on the result of the sensor unit 500 detecting the surrounding vehicles of the own vehicle, and calculates the driving trajectory according to the determination result. By calibrating, the autonomous driving of the own vehicle can be controlled. The autonomous driving control according to the correction of the driving trajectory is defined as trajectory-based control in the present embodiment.

When describing the trajectory-based control in detail, as described above, the processor 610 (of the driving trajectory generation module 612) of the present embodiment is based on the driving information of the surrounding vehicle detected by the sensor unit 500. The actual driving trajectory of the vehicle can be created. That is, when a nearby vehicle is detected at a specific point by the sensor unit 500, the processor 610 cross-references the detected location of the surrounding vehicle and the location on the map information stored in the memory 620 to detect the current on the map information. The location of the surrounding vehicle can be specified, and the actual driving trajectory of the surrounding vehicle can be generated by continuously monitoring the location of the surrounding vehicle as described above.

Further, the processor 610 (the driving trajectory generation module 612 of) may generate a predicted driving trajectory of the surrounding vehicle based on the map information stored in the memory 620. In this case, the processor 610 The predicted driving trajectory can be generated as the center line of the lane reflected in the map information.

Further, the processor 610 (of the driving trajectory generation module 612) may generate an expected driving trajectory of the own vehicle based on the map information stored in the memory 620, in this case, the processor 610 The predicted driving trajectory can be generated as the center line of the lane reflected in the map information.

When the actual driving trajectory and the expected driving trajectory of the surrounding vehicle and the predicted driving trajectory of the own vehicle are generated, the processor 610 (of the trajectory learning module 615) performs a comparison between the actual driving trajectory and the expected driving trajectory of the surrounding vehicle. It can be determined whether or not correction of the expected driving trajectory of the vehicle is necessary. Specifically, the processor 610 may determine that correction of the expected driving trajectory of the host vehicle is required when the trajectory error between the actual driving trajectory and the predicted driving trajectory of the surrounding vehicle is equal to or greater than a preset threshold value. That is, as described above, if the trajectory error between the actual driving trajectory of the surrounding vehicle and the expected driving trajectory is greater than or equal to the threshold value, the map information stored in the memory 620 may be determined to be inaccurate, and thus the map information stored in the memory 620 The predicted driving trajectory of the own vehicle generated based on is also required to be corrected. In this case, the processor 610 may correct the predicted driving trajectory of the own vehicle based on the comparison result between the actual driving trajectory of the surrounding vehicle and the expected driving trajectory. For example, between the actual driving trajectory and the expected driving trajectory of the surrounding vehicle By shifting the predicted traveling trajectory of the own vehicle to the left or right by the difference, the predicted traveling trajectory of the own vehicle can be corrected. Accordingly, the processor 610 may perform a trajectory-based control for controlling autonomous driving of the own vehicle according to the corrected predicted driving trajectory.

On the other hand, the processor 610, when the driving path to the destination of the host vehicle (hereinafter, referred to as the first driving path) overlaps the driving path of the driving cluster formed by a plurality of cluster vehicles (hereinafter referred to as the second driving path), the driving of the driving cluster It is also possible to control the autonomous driving of the own vehicle to follow. The control for following the traveling cluster is defined as cluster following control in the present embodiment. The driving cluster refers to a cluster that is formed of a plurality of cluster vehicles including one leader vehicle and one or more follower vehicles, shares driving information between vehicles through a vehicle-to-vehicle communication method, and travels on a road while considering an external environment. When a plurality of driving clusters exist in V2X (Vehicle to Everything) or V2V (Vehicle to Vehicle) communication coverage based on the own vehicle, the processor 610 provides information on each driving cluster from each leader vehicle of each driving cluster (e.g. : The specification information of the leader vehicle or the accumulated travel distance of each driving cluster) can be received and output through the above-described user terminal 120 to be provided to the occupant, and the occupant can check and follow the information on each driving cluster You can select the cluster you want to drive. If the driving cluster does not exist in the V2X or V2V communication coverage based on the own vehicle, the processor 610 may receive information on each driving cluster from an external separate server.

In the case of performing the cluster following control, the processor 610 includes an overlap between the first driving path and the second driving path from the confluence point at which the overlap between the first driving path of the host vehicle and the second driving path of the driving cluster starts. It is possible to perform cluster following control up to the end point of withdrawal. That is, the processor 610 may perform cluster following control instead of trajectory-based control in an overlapping section between the driving path of the host vehicle and the driving path of the driving cluster. At this time, the processor 610 may determine the joining point and the withdrawal point for performing the cluster following control from the plurality of candidate joining points and the plurality of candidate withdrawal points before performing the cluster following control, a description of which will be described later. .

In this embodiment, the processor 610 may perform the trajectory-based control and the cluster following control by mutually switching according to whether the predefined control switching condition is satisfied, and the control switching condition is switched from the trajectory-based control to the cluster following control. It may include a cluster following control switching condition for switching, and a trajectory-based control switching condition for switching from cluster following control to trajectory-based control. That is, the processor 610 performs trajectory-based control and cluster tracking control by mutually switching according to whether the control conversion condition according to the driving environment of the host vehicle is satisfied, thereby reducing the computational load for autonomous driving control of the host vehicle and reaching the destination. In the process, it is possible to minimize the occupant's intervention in the driving control of the vehicle to improve the occupant's convenience and at the same time make it possible to reach the destination in the shortest time.

When describing the configuration in which the trajectory-based control and the cluster following control are mutually switched depending on whether the control switching condition is satisfied, the processor 610 may first perform the trajectory-based control with the current position of the host vehicle as a viewpoint. When the host vehicle reaches the confluence point in the process of performing the trajectory-based control from the current position of the vehicle, it is determined that the cluster tracking control switching condition is satisfied, and cluster tracking control may be performed.

That is, the processor 610 may perform trajectory-based control from the current position of the own vehicle to the confluence point, and when the own vehicle reaches the confluence point, the control of the own vehicle may be switched from the trajectory-based control to the cluster following control. . The processor 610 may output an alarm through the output unit 300 before reaching the confluence point (eg, 1 km) to allow the occupant to recognize the confluence of the driving cluster. When switching from the trajectory-based control to the cluster following control, the processor 610 transmits a request to join the driving cluster to the leader vehicle of the driving cluster, and upon receiving the approval of the leader vehicle, the own vehicle can join the driving cluster. It is possible to allow the own vehicle to merge to a predetermined position in the driving cluster within a range that does not disturb the ranks of.

The processor 610 may perform the trajectory-based control by determining that the trajectory-based control switching condition is satisfied when the own vehicle reaches the withdrawal point in the process of performing the cluster following control from the confluence point.

That is, the processor 610 may perform cluster tracking control from the confluence point to the withdrawal point, and when the host vehicle reaches the withdrawal point, the control of the host vehicle may be switched back from the cluster tracking control to the trajectory-based control. The processor 610 may output an alarm through the output unit 300 before reaching the withdrawal point (for example, 1km before) so that the occupants recognize the withdrawal from the driving cluster.

Meanwhile, as described above, the processor 610 may determine the joining point and the withdrawal point from the plurality of candidate joining points and the plurality of candidate withdrawing points. In this embodiment, the processor 610 is The points of joining and leaving can be determined based on the time it takes to reach them.

Specifically, the processor 610 determines the time it takes for the own vehicle to reach the candidate confluence point from the current position based on the trajectory-based control, and the host vehicle reaches the candidate withdrawal point from the candidate confluence point based on the cluster tracking control. A candidate confluence point and a candidate withdrawal point at which the total required time, which is the sum of the time required to reach the destination from the candidate withdrawal point, are the minimum based on the time required and the trajectory-based control, may be determined as the joining point and the withdrawal point, respectively.

That is, the processor 610 may check a plurality of candidate confluence points at which overlap between the first and second driving routes is started, and a plurality of candidate withdrawal points at which the overlap between the first and second driving routes ends, and Among the plurality of candidate joining points and candidate withdrawal points identified as described above, a candidate joining point and a candidate withdrawing point at which the total required time required to reach the destination is minimum may be determined as the joining point and the withdrawing point. Further, when determining the joining point and the withdrawing point, the processor 610 may further consider the ease of joining and withdrawing, such as the degree of congestion or the risk of an accident of each candidate joining point and the candidate withdrawing point.

In the above, a configuration in which the trajectory-based control and cluster tracking control are switched to each other at the own vehicle level has been described. In addition to the above configuration, this embodiment is required to sense surrounding objects at the driving cluster level performing cluster driving. It proposes a configuration that reduces the total resources of the system being used.

Specifically, when the host vehicle joins the driving cluster and then performs cluster following control, the processor 610 detects the surrounding object of the sensor unit 500 according to the relative position of the host vehicle with respect to the cluster vehicle belonging to the driving cluster. Can be changed.

That is, since a plurality of cluster vehicles belonging to the driving cluster are driven under the same driving environment, rather than detecting all objects around each cluster vehicle through a sensing device installed on each vehicle, it is within the driving cluster of each cluster vehicle. A method of separating the surrounding object detection area according to the location of and detecting the surrounding object only for the surrounding object detection area and then sharing the detection result between cluster vehicles may be more efficient in terms of reducing system resources of each cluster vehicle. In order to implement the separation of the surrounding object detection area at the driving cluster level as described above, the processor 610 of the present embodiment detects the surrounding objects of the sensor unit 500 according to the relative position of the host vehicle with respect to the cluster vehicle belonging to the driving cluster. It can be operated to change the area.

In order to implement the function of varying the detection area of the surrounding object of the sensor unit 500 according to the relative position of the host vehicle in the driving cluster, the processor 610 is a predefined group classification algorithm when performing cluster tracking control. The driving cluster is classified into a preceding driving group, a middle driving group, and a following driving group, and the driving group to which the own vehicle belongs is determined among the driving groups, and the surrounding object detection area of the sensor unit 500 is determined according to the determination result. Can be changed. The group classification algorithm for classifying the driving cluster into a preceding driving group, a middle driving group, and a trailing driving group can be implemented through various design methods, such as the location of the leader vehicle and the position of the trailing vehicle based on V2V communication between cluster vehicles. It may be implemented as an algorithm that identifies and calculates the longitudinal (ie, driving direction) length of the driving cluster by using the identified location, and then divides the driving group into a plurality of driving groups based on the calculated longitudinal length.

When the driving cluster is classified into a plurality of driving groups, the processor 610 may determine a driving group to which the own vehicle belongs among each driving group and change the detection area of the surrounding object of the sensor unit 500 according to the determination result. Specifically, when the host vehicle belongs to the preceding driving group, the processor 610 detects an object in front of the host vehicle (defined as including the front side) through the sensor unit 500 (that is, the sensor unit ( 500), and when the host vehicle belongs to the middle driving group, the surrounding object on the side of the host vehicle is detected through the sensor unit 500 (that is, the sensor unit 500 The surrounding object detection area is changed to a side area), and when the host vehicle belongs to the following driving group, the surrounding objects in the rear of the host vehicle (defined as including the rear side) may be detected through the sensor unit 500. (In other words, the detection area of the surrounding object of the sensor unit 500 may be changed to the rear area).

That the surrounding object detection area of the sensor unit 500 is changed to the front area means a sensor for detecting the front area (ie, the front lidar sensor 511, the front radar sensor 521, and the front camera sensor 531). May mean that is necessarily activated and other sensors are selectively activated according to the driving environment, and that the surrounding object detection area of the sensor unit 500 is changed to the side area is a sensor for detecting the side area (ie, left It may mean that the radar sensor 522, the right radar sensor 522, the left camera sensor 532, and the right camera sensor 533) are always activated, and other sensors are selectively activated according to the driving environment. That the surrounding object detection area of 500 is changed to the rear area means that sensors for detecting the rear area (ie, rear lidar sensor 513, rear radar sensor 524, and rear camera sensor 534) must be activated. It may mean that other sensors are selectively activated according to the driving environment.

Furthermore, when considering a case in which a plurality of cluster vehicles are running in a single lane as shown in FIG. 7, the preceding driving group and the following driving group correspond only to the leader vehicle and the trailing vehicle, and the middle driving group The group may correspond to cluster vehicles located between the leader vehicle and the trailing vehicle, and a group classification algorithm for classifying such a preceding driving group, a middle driving group, and a following driving group may be predefined by the designer. In the example of FIG. 7, when the host vehicle belongs to the preceding driving group (that is, when the host vehicle belongs to the preceding driving group), the surrounding object detection area becomes a front area and a side area, and belongs to the middle driving group. If it is a lateral region, it becomes a rear region and a lateral region if it belongs to the following driving group (that is, if it is the last vehicle).

When the function of the processor 610 as described above is applied to each cluster vehicle belonging to the driving cluster, each cluster vehicle varies the detection area of the surrounding object of the sensor unit 500 mounted on each vehicle according to the position within the driving cluster. It works to make it happen. Accordingly, the cluster vehicle belonging to the preceding driving group detects surrounding objects in front of the driving cluster, and the cluster vehicle belonging to the middle driving group detects surrounding objects on the side of the driving cluster, and the cluster vehicle belonging to the following driving group Detects the surrounding objects behind the driving cluster. Therefore, since each cluster vehicle belonging to the driving cluster divides and performs detection of surrounding objects in the front, left and right sides of the driving cluster, the total resources of the system required to detect the surrounding objects from the driving cluster level are reduced. You can save a lot.

8 and 9 are flowcharts illustrating an autonomous driving method according to an embodiment of the present invention.

Referring to FIG. 8, in the autonomous driving method according to an embodiment of the present invention, the processor 610 corrects the predicted driving trajectory of the own vehicle based on the result of the sensor unit 500 detecting the surrounding vehicles of the own vehicle. It is determined whether there is a need to do so, and in step S100 of performing a trajectory-based control for controlling autonomous driving of the own vehicle by correcting the predicted driving trajectory according to the determination result, and the processor 610 When the first driving path overlaps the second driving path of the driving cluster formed of a plurality of cluster vehicles, the step S200 of performing cluster following control for controlling autonomous driving of the host vehicle to follow the driving of the driving cluster may be included. have. In this case, the processor 610 may perform the switching between steps S100 and S200 according to whether the predefined control switching condition is satisfied.

In step S100, the processor 610 generates an actual driving trajectory of the surrounding vehicle based on the driving information of the surrounding vehicle detected by the sensor unit 500, and based on the map information stored in the memory 620, the processor 610 A predicted driving trajectory is generated, and when a trajectory error between the actual driving trajectory and the predicted driving trajectory of the surrounding vehicle is greater than or equal to a preset threshold, it is determined that the expected driving trajectory of the own vehicle needs to be corrected. Accordingly, the processor 610 performs a trajectory-based control for controlling autonomous driving of the own vehicle according to the corrected predicted driving trajectory.

In step S200, based on the direction in which the host vehicle travels to the destination, cluster following control from the confluence point at which the overlap between the first and second driving routes starts to the withdrawal point at which the overlap between the first and second driving routes ends. Perform.

Referring to FIG. 9 for a configuration in which the trajectory-based control and the cluster following control are mutually switched according to whether the control switching condition is satisfied, the processor 610 is in the process of performing the trajectory-based control from the current position of the host vehicle ( S10) When the host vehicle reaches the confluence point (S20), it is determined that the cluster following control conversion condition is satisfied and the cluster following control is performed (S30), and the host vehicle is also in the process of performing the cluster following control from the confluence point. When this withdrawal point is reached (S40), it is determined that the trajectory-based control switching condition is satisfied, and trajectory-based control is performed (S50).

The processor 610 determines a confluence point and a withdrawal point for performing cluster following control from a plurality of candidate confluence points and a plurality of candidate withdrawal points, and in order to minimize the time required for the own vehicle to reach the destination, step S200 Based on the trajectory-based control, the time it takes for the own vehicle to reach the candidate confluence point from the current position, the time it takes for the own vehicle to reach the candidate withdrawal point from the candidate confluence point based on the cluster tracking control, and the trajectory-based Based on the control, a candidate confluence point and a candidate withdrawal point at which the total required time, which is the sum of the time taken to reach the destination from the candidate withdrawal point, are determined as the confluence point and the withdrawal point, respectively.

Meanwhile, in step S200, the processor 610 classifies the driving cluster into a preceding driving group, a middle driving group, and a following driving group using a predefined group classification algorithm, and determines a driving group to which the own vehicle belongs among each driving group. Accordingly, the detection area of the surrounding object of the sensor unit 500 may be varied according to the determination result. Specifically, the processor 610 detects a surrounding object in front of the own vehicle through the sensor unit 500 when the own vehicle belongs to the preceding driving group, and detects the sensor unit 500 when the own vehicle belongs to the middle driving group. Through the detection of the surrounding objects on the side of the host vehicle, and when the host vehicle belongs to the following driving group, the surrounding objects behind the host vehicle may be detected through the sensor unit 500.

As described above, the present embodiment is performed by mutually switching the trajectory-based control for controlling autonomous driving according to the driving trajectory correction for each predetermined section on the route from the current position of the autonomous vehicle to the destination and the cluster following control for following the driving of the driving cluster. By doing so, it is possible to improve the convenience of the occupants by reducing the computational load of autonomous driving control of the autonomous vehicle and minimizing the occupant's intervention in the driving control of the vehicle in the process of reaching the destination, and making it possible to reach the destination in the shortest time. can do.

In addition, since the present embodiment operates to change the detection area of the surrounding object of the sensor unit according to the relative position of the host vehicle with respect to other cluster vehicles belonging to the driving cluster when performing cluster tracking control, the level of the entire cluster vehicle in cluster driving As seen in, it is possible to reduce the total resources of the system required for each cluster vehicle belonging to the driving cluster to sense surrounding objects.

The present invention has been described with reference to the embodiments shown in the drawings, but these are only exemplary, and those of ordinary skill in the art to which the present technology pertains, various modifications and other equivalent embodiments are possible. I will understand. Therefore, the true technical protection scope of the present invention should be determined by the following claims.

100: user input unit 101: driving information input interface
110: drive mode switch 120: user terminal
200: driving information detection unit 201: driving information input interface
210: steering angle sensor 220: APS/PTS
230: vehicle speed sensor 240: acceleration sensor
250: yaw/pitch/roll sensor 260: GPS receiver
300: output unit 301: occupant output interface
310: speaker 320: display device
400: sub-control system 401: vehicle control output interface
410: engine control system 420: braking control system
430: steering control system 500: sensor unit
510: lidar sensor 511: front lidar sensor
512: upper lid sensor 513: rear lid sensor
520: radar sensor 521: front radar sensor
522: left radar sensor 523: right radar sensor
524: rear radar sensor 530: camera sensor
531: front camera sensor 532: left camera sensor
533: right camera sensor 534: rear camera sensor
535: internal camera sensor 540: ultrasonic sensor
600: autonomous driving integrated control unit 610: processor
611: sensor processing module 611a: lidar signal processing module
611b: radar signal processing module 611c: camera signal processing module
612: driving trajectory generation module 612a: driving trajectory generation module of surrounding vehicles
612b: host vehicle driving trajectory generation module 613: driving trajectory analysis module
614: driving control module 615: trajectory learning module
616: occupant status determination module 620: memory
700: server

Claims (18)

A sensor unit for detecting surrounding objects including surrounding vehicles of the self-driving vehicle;
A memory for storing map information; And
A processor that controls autonomous driving of the own vehicle according to an expected driving trajectory generated based on map information stored in the memory; and
The processor,
The sensor unit determines whether it is necessary to correct the expected driving trajectory of the own vehicle based on a result of detecting the surrounding vehicles of the own vehicle, and correcting the predicted driving trajectory according to the determination result. Performs trajectory-based control to control autonomous driving,
When the first driving path to the destination of the host vehicle overlaps with the second driving path of the driving cluster formed of a plurality of cluster vehicles, cluster following control for controlling the autonomous driving of the host vehicle to follow the driving of the driving cluster And
The processor,
When performing the cluster following control, the autonomous driving apparatus, wherein the detection area of the surrounding object of the sensor unit is varied according to a relative position of the host vehicle with respect to the cluster vehicle belonging to the driving cluster.
The method of claim 1,
The processor, when performing the trajectory-based control,
An actual driving trajectory of the surrounding vehicle is generated based on the driving information of the surrounding vehicle detected by the sensor unit, and an expected driving trajectory of the surrounding vehicle is generated based on the map information stored in the memory. When a trajectory error between an actual driving trajectory and an expected driving trajectory is equal to or greater than a preset threshold value, it is determined that the predicted driving trajectory of the host vehicle needs to be corrected.
The method of claim 1,
When the processor performs the cluster following control,
Based on the direction in which the host vehicle travels to the destination, the cluster following control from a confluence point at which the overlap between the first and second travel routes starts to a withdrawal point at which the overlap between the first and second travel routes ends. Autonomous driving device, characterized in that for performing.
The method of claim 3,
The processor performs by mutually switching the trajectory-based control and the cluster following control according to whether a predefined control switching condition is satisfied,
The control switching condition includes a cluster following control switching condition for switching from the trajectory-based control to the cluster following control, and a trajectory-based control switching condition for switching from the cluster following control to the trajectory-based control. Autonomous driving device.
The method of claim 4,
The processor,
When the host vehicle reaches the confluence point in the process of performing the trajectory-based control from the current position of the host vehicle, it is determined that the cluster tracking control switching condition is satisfied, and the cluster tracking control is performed. Autonomous driving device.
The method of claim 5,
The processor,
When the host vehicle reaches the withdrawal point in the process of performing cluster tracking control from the confluence point, it is determined that the trajectory-based control switching condition is satisfied and the trajectory-based control is performed. .
The method of claim 6,
The processor,
Determine the confluence point and the withdrawal point for performing the cluster following control from a plurality of candidate confluence points and a plurality of candidate withdrawal points,
Based on the trajectory-based control, the time it takes for the own vehicle to reach the candidate confluence point from the current position, and the time it takes for the host vehicle to reach the candidate withdrawal point from the candidate confluence point based on the cluster tracking control, , Based on the trajectory-based control, a candidate confluence point and a candidate withdrawal point at which the total required time, which is the sum of time required to reach the destination from the candidate withdrawal point, are determined as the confluence point and the withdrawal point, respectively. Autonomous driving device.
The method of claim 1,
When the processor performs the cluster following control,
Classifies the driving cluster into a preceding driving group, a middle driving group, and a following driving group using a predefined group classification algorithm, and determining the driving group to which the own vehicle belongs among the driving groups, and the sensor according to the determination result. An autonomous driving device, characterized in that the negative surrounding object detection area is varied.
The method of claim 8,
The processor,
When the host vehicle belongs to the preceding driving group, a peripheral object in front of the host vehicle is detected through the sensor unit, and when the host vehicle belongs to the middle driving group, a peripheral object at the side of the host vehicle through the sensor unit And, when the host vehicle belongs to the following driving group, detecting a surrounding object at the rear of the host vehicle through the sensor unit.
Autonomous driving of the host vehicle according to a sensor unit that detects surrounding objects including surrounding vehicles of the autonomous vehicle, a memory that stores map information, and an expected driving trajectory generated based on the map information stored in the memory. A method for controlling autonomous driving in an autonomous driving system including a controlling processor,
The processor determines whether it is necessary to correct the predicted driving trajectory of the own vehicle based on a result of the sensor unit detecting the surrounding vehicle of the own vehicle, and correcting the predicted driving trajectory according to the determination result. Performing trajectory-based control for controlling autonomous driving of the own vehicle; And
The processor controls the autonomous driving of the host vehicle to follow the driving of the driving cluster when the first driving path to the destination of the host vehicle overlaps with the second driving path of the driving cluster formed of a plurality of cluster vehicles. Including; and performing a cluster following control
In the step of performing the cluster following control, the processor,
The autonomous driving method, characterized in that, according to the relative position of the host vehicle with respect to the cluster vehicle belonging to the driving cluster, the detection area of the surrounding object of the sensor unit is varied.
The method of claim 10,
In the step of performing the trajectory-based control, the processor,
An actual driving trajectory of the surrounding vehicle is generated based on the driving information of the surrounding vehicle detected by the sensor unit, and an expected driving trajectory of the surrounding vehicle is generated based on the map information stored in the memory. An autonomous driving method, characterized in that, when a trajectory error between an actual driving trajectory and an expected driving trajectory is equal to or greater than a preset threshold value, it is determined that the predicted driving trajectory of the host vehicle needs to be corrected.
The method of claim 10,
In the step of performing the cluster following control, the processor,
Based on the direction in which the host vehicle travels to the destination, the cluster following control from a confluence point at which the overlap between the first and second travel routes starts to a withdrawal point at which the overlap between the first and second travel routes ends. Autonomous driving method, characterized in that to perform.
The method of claim 12,
The processor performs by mutually switching the trajectory-based control and the cluster following control according to whether a predefined control switching condition is satisfied,
The control switching condition includes a cluster following control switching condition for switching from the trajectory-based control to the cluster following control, and a trajectory-based control switching condition for switching from the cluster following control to the trajectory-based control. Autonomous driving method.
The method of claim 13,
The processor,
When the host vehicle reaches the confluence point in the process of performing the trajectory-based control from the current position of the host vehicle, it is determined that the cluster tracking control switching condition is satisfied, and the cluster tracking control is performed. Autonomous driving method.
The method of claim 14,
The processor,
When the host vehicle reaches the withdrawal point in the process of performing cluster tracking control from the confluence point, it is determined that the trajectory-based control switching condition is satisfied, and the trajectory-based control is performed. .
The method of claim 15,
In the step of performing the cluster following control, the processor,
Determine the confluence point and the withdrawal point for performing the cluster following control from a plurality of candidate confluence points and a plurality of candidate withdrawal points,
Based on the trajectory-based control, the time it takes for the own vehicle to reach the candidate confluence point from the current position, and the time it takes for the host vehicle to reach the candidate withdrawal point from the candidate confluence point based on the cluster tracking control, , Based on the trajectory-based control, a candidate confluence point and a candidate withdrawal point at which the total required time, which is the sum of time required to reach the destination from the candidate withdrawal point, are determined as the confluence point and the withdrawal point, respectively. Autonomous driving method.
The method of claim 10,
In the step of performing the cluster following control, the processor,
Classifies the driving cluster into a preceding driving group, a middle driving group, and a following driving group using a predefined group classification algorithm, and determining the driving group to which the own vehicle belongs among the driving groups, and the sensor according to the determination result. Autonomous driving method characterized by varying the detection area of negative surrounding objects
The method of claim 17,
In the step of performing the cluster following control, the processor,
When the host vehicle belongs to the preceding driving group, a peripheral object in front of the host vehicle is detected through the sensor unit, and when the host vehicle belongs to the middle driving group, a peripheral object at the side of the host vehicle through the sensor unit And detecting a surrounding object at the rear of the own vehicle through the sensor unit when the host vehicle belongs to the following driving group.

Images