This application is based on and claims the benefit of priority to Korean Patent Application No. 10-2016-0156515, filed on Nov. 23, 2016, in the Korean Intellectual Property Office, the disclosure of which is incorporated herein in its entirety by reference.
The present disclosure relates to an apparatus and a method for controlling paths of vehicles.
When a driver enters destination information to a vehicle having an autonomous driving system, the autonomous driving system searches for a path from a current location of the vehicle to a destination, sets a global path, and controls autonomous driving of the vehicle along the set global path.
A vehicle which performs autonomous driving may deviate from a path during its driving based on a congestion level of a road and the like. If detecting that the vehicle deviates from the preset global path while the vehicle drives along the global path, the autonomous driving system searches for a path from the corresponding location to the destination again and may set a global path again based on the found path.
It takes time to search for a path until a global path is set again after the vehicle deviates from a path. Since it is difficult to determine whether the vehicle drives along any path while the autonomous driving system searches for a path again, an unexpected situation may occur.
The present disclosure has been made to solve the above-mentioned problems occurring in the prior art while advantages achieved by the prior art are maintained intact.
An aspect of the present disclosure provides an apparatus and a method for controlling path of a vehicle to determine whether there is a path deviation prediction area on a preset path, detect path deviation on the corresponding area in advance, and previously search for an alternative path before the path deviation such that the vehicle drives along the alternative path although the vehicle deviates from a path.
The technical problems to be solved by the present inventive concept are not limited to the aforementioned problems, and any other technical problems not mentioned herein will be clearly understood from the following description by those skilled in the art to which the present disclosure pertains.
According to an exemplary embodiment of the present disclosure, an apparatus may include: a path generating processor configured to generate a first path by searching for a path from a current location of the vehicle to a destination and generate a second path by searching for a path from a path deviation prediction area on the first path to the destination, a path deviation area extracting processor configured to extract the path deviation prediction area based on road attributes on the first path when a driving path of the vehicle is set to the first path, and a path controller configured to determine whether to generate the second path based on a congestion level of a road around the vehicle when the vehicle arrives at a range from the extracted path deviation prediction area on the first path and reset the driving path of the vehicle to the second path when path deviation occurs on the extracted path deviation prediction area.
According to another exemplary embodiment of the present disclosure, a method may include: generating a first path by searching for a path from a current location of the vehicle to a destination; extracting a path deviation prediction area based on road attributes on the first path, when a driving path of the vehicle is set to the first path, generating a second path from the extracted path deviation prediction area to the destination based on a congestion level of a road around the vehicle, when the vehicle arrives at a range from the extracted path deviation prediction area on the first path, resetting the driving path of the vehicle along the second path, when path deviation occurs on the extracted path deviation prediction area.
The above and other objects, features and advantages of the present disclosure will be more apparent from the following detailed description taken in conjunction with the accompanying drawings:
Hereinafter, embodiments of the present disclosure will be described in detail with reference to the accompanying drawings. In adding reference denotations to elements of each drawing, although the same elements are displayed on a different drawing, it should be noted that the same elements have the same denotations. In addition, in describing an embodiment of the present disclosure, if it is determined that a detailed description of related well-known configurations or functions blurs the gist of an embodiment of the present disclosure, it will be omitted.
In describing elements of embodiments of the present disclosure, the terms 1st, 2nd, first, second, A, B, (a), (b), and the like may be used herein. These terms are only used to distinguish one element from another element, but do not limit the corresponding elements irrespective of the nature, turn, or order of the corresponding elements. Unless otherwise defined, all terms used herein, including technical or scientific terms, have the same meanings as those generally understood by those skilled in the art to which the present disclosure pertains. Such terms as those defined in a generally used dictionary are to be interpreted as having meanings equal to the contextual meanings in the relevant field of art, and are not to be interpreted as having ideal or excessively formal meanings unless clearly defined as having such in the present application.
As shown in
This path control apparatus 100 may be implemented in the vehicle 10. In this case, the path control apparatus 100 may be integrated with control units in the vehicle 10. Alternatively, the path control apparatus 100 may be implemented to be independent of the control units in the vehicle and may be connected with the control units of the vehicle 10 by a separate connection means. Herein, the path control apparatus 100 may operate in conjunction with an engine and a motor of the vehicle and may operate in conjunction with a navigation device. Also, the path control apparatus 100 may operate in conjunction with a control unit which controls an operation of the engine or motor.
Thus, a detailed description will be given of detailed components of the path control apparatus 100 with reference to
In the present disclosure, the controller 110 may include a general electronic control unit (ECU) having hardware and software, in which the hardware consists of a printed circuit board (PCB).
The interface 120 may include an input means for receiving a control instruction from a user and an output means for outputting an operation state, an operation result, and the like of the path control apparatus 100.
Herein, the input means may include a key button and may further include a mouse, a joystick, a jog shuttle, a stylus pen, and the like. Also, the input means may include a soft key implemented on a display of the vehicle 10.
The output means may include the display and may further include a voice output means such as a speaker. In this case, if a touch sensor such as a touch film, a touch sheet, or a touch pad is installed in the display, the display may operate as a touch screen and may be implemented in the form of integrating the input means with the output means.
In this case, the display may include at least one of a liquid crystal display (LCD), a thin film transistor-LCD (TFT-LCD), an organic light-emitting diode (OLED), a flexible display, a field emission display (FED), and a three-dimensional (3D) display.
The communicator 130 may include a communication module for supporting a communication interface with electronics and/or control units mounted on the vehicle 10. For example, the communication module may communicatively connect with a navigation device installed in the vehicle 10 and may receive vehicle location information, destination information, information about surrounding circumstances, information about road attributes, information about road conditions, and the like from the navigation device.
Herein, the communication module may include a module for supporting vehicle network communication such as a controller area network (CAN), local interconnect network (LIN) communication, and flex-ray communication.
Further, the communicator 130 may include a global positioning system (GPS) module which receives GPS information relative to a current location of the vehicle 10.
Further, the communicator 130 may include a module for wireless Internet access or a communication module for short range communication. Herein, wireless Internet technologies may include a wireless local area network (WLAN), wireless broadband (Wibro), wireless-fidelity (Wi-Fi), world interoperability for microwave access (Wimax), and the like. Short range communication technologies may include Bluetooth, ZigBee, ultra-wideband (UWB), radio frequency identification (RFID), infrared data association (IrDA), and the like.
The sensor 140 may include one or more sensors for recognizing a driving lane of the vehicle 10. For example, the sensor 140 may include a camera and the like which capture a forward lane image and recognize a lane. The sensor 140 may include any sensor which may recognize a driving lane through lane recognition technology.
The sensor 140 may further include a sensor which measures a distance from a vehicle around the vehicle 10.
The storage 150 may store data and/or an algorithm, and the like necessary for an operation of the path control apparatus 100.
The storage 150 may store information received from a navigation device via the communicator 130. The storage 150 may store destination information and path information generated by the path generating processor 160.
Further, the storage 150 may store a command and/or an algorithm for generating a path, determining a path deviation prediction area, determining path deviation, and controlling autonomous driving and may store the result performed by the algorithm.
Herein, the storage 150 may include storage media such as a random access memory (RAM), a static RAM (SRAM), a read-only memory (ROM), a programmable ROM (PROM), and an electrically erasable PROM (EEPROM).
If information about a destination is entered, the path generating processor 160 may search for a path from a current location of the vehicle 10 to the destination to generate a global path (hereinafter referred to as “first path”). In this case, the path controller 180 may set the first path to a driving path and may control driving of vehicle 10 along the first path. The path controller 180 may provide information about the set driving path to a separate driving control system connected via the communicator 130.
If the vehicle 10 drives along the first path by control of the path controller 180, the path deviation area extracting processor 170 may determine a path deviation prediction area predicted for the vehicle 10 to deviate from the first path.
In this case, the path deviation area extracting processor 170 may extract the path deviation prediction area on the first path using information about road attributes received from the navigation device. For example, the path deviation area extracting processor 170 may extract an area, such as an entrance ramp, an exit ramp, a crossroad, a fork of a road, an underpass, or an overpass, where road attributes on a path during driving are changed, as the path deviation prediction area.
The path deviation area extracting processor 170 may store information about the extracted path deviation prediction area, for example, location information in the storage 150.
If the vehicle 10 arrives at a range from the path deviation prediction area while the vehicle 10 drives along the first path, the path controller 180 may determine whether to generate an alternative path (hereinafter referred to as “second path”) from the path deviation prediction area to the destination.
Herein, the path controller 180 may determine whether to generate the second path, based on a road congestion level, for a target lane on a road where the vehicle 10 is driven or a side lane in the direction of the target lane and a location of a lane where the vehicle 10 is driven.
For example, the path controller 180 may calculate a congestion level of the target lane on the road while the vehicle 10 is driven. If the calculated congestion level of the target lane is greater than a threshold and if a lane where the vehicle 10 is currently driven is not the target lane, the path controller 180 may determine to generate the second path.
If it is determined that the second path is generated by the path controller 180, the path generating processor 160 may search for a path from the path deviation prediction area to the destination before the vehicle 10 arrives at the path deviation prediction area to generate the second path.
The path controller 180 may determine whether the vehicle 10 deviates from the first path on the previously extracted path deviation prediction area. If determining that the vehicle 10 deviates from the first path on the path deviation prediction area, the path controller 180 may set a driving path of the vehicle 10 to the previously generated second path and may control driving of the vehicle 10 along the second path. The path controller 180 may provide information about the set driving path to the separate driving control system connected via the communicator 130.
In this case, if the driving path of the vehicle 10 is set to the second path, the path generating processor 160 may search for a path to the destination again relative to a current location of the vehicle 10 while the vehicle 10 drives along the second path.
The various embodiments disclosed herein, including embodiments of the path control apparatus 100 and/or elements thereof, can be implemented using one or more processors coupled to a memory (or other non-transitory machine readable recording medium) storing computer-executable instructions for causing the processor(s) to perform the functions described above including the functions described in relation to the path generating processor 160, the path deviation area extracting processor 170, and the path controller 180.
Referring to
If the distance dtarget from the current location of the vehicle 10 to the previously extracted path deviation prediction area is less than the second distance threshold Dth2, the path controller 180 may verify whether a current driving lane of the vehicle 10 corresponds to a target lane. If the current driving lane of the vehicle 10 is not the target lane, the path controller 180 may calculate a road congestion level for the target lane or a side road in the direction of the target lane.
The road congestion level may be calculated using Equation 1 below.
In Equation 1, U may denote the road congestion level, and drange may denote an area in front and rear of the vehicle 10 relative to a current location (x=0) of the vehicle 10, for example, a range (−drange ≤x≤drange) of a lane change area. di may represent a longitudinal area of an ith nearby vehicle located on a side road in the lane change area of the vehicle 10. For example, d1 may represent a longitudinal area of an 1st nearby vehicle 21 located on a side road in the lane change area of the vehicle 10, d2 may represent a longitudinal area of an 2nd nearby vehicle 23 located on a side road in the lane change area of the vehicle 10, d3 may represent a longitudinal area of an 3rd nearby vehicle 25 located on a side road in the lane change area of the vehicle 10.
Herein, di may be defined as Equation 2 below.
In Equation 2, xi may denote a location of the ith (ex, i={1, 2, 3}) nearby vehicle located on the side road in the lane change area of the vehicle 10, and v may denote a velocity of the vehicle 10. vi may denote a velocity of the ith nearby vehicle, and α may denote a coefficient. For example, x1 may denote a location of the 1st nearby vehicle 21 located on the side road in the lane change area of the vehicle 10, x2 may denote a location of the 2nd nearby vehicle 23 located on the side road in the lane change area of the vehicle 10, x3 may denote a location of the 3rd nearby vehicle 25 located on the side road in the lane change area of the vehicle 10. Herein, f(x) may be defined as Equation 2.
The path controller 180 may calculate the road congestion level using Equations 1 to 3. In this case, if the calculated road congestion level is greater than or equal to a threshold Uth, the path controller 180 may determine to generate a second path. In this case, the path controller 180 may request a path generating processor 160 of
Therefore, the path generating processor 160 may generate the second path based on the request of the path controller 180.
When a distance dtarget from a current location of the vehicle 10 to an extracted path deviation prediction area is less than a first distance threshold Dth1, the path controller 180 may verify whether a current driving lane of the vehicle 10 corresponds to a target lane. If the current driving lane of the vehicle 10 is not the target lane, the path controller 180 may verify whether the vehicle 10 deviates from a preset first path.
If verifying that the vehicle 10 deviates from the preset first path, the path controller 180 may reset a driving path to the previously generated second path.
Referring to
The path control apparatus 100 may determine a forward fork of a road as a path deviation predication area while the vehicle 10 drives along the first path and may previously set a second path as an alternative path.
In this case, the path control apparatus 100 may set the second path such as “Path_1→Path_2→Path_5→Path_i→Path_j→Path_k→ . . . ”.
If path deviation occurs while the vehicle 10 moves from “Path_1” to “Path_4” on the first path, the path control apparatus 100 may set the previously generated second path to a driving path. Thus, when the vehicle 10 deviates from the first path, it may immediately drive along “Path_2→Path_5→Path_i→Path_j→Path_k→ . . . ” on the second path.
As such, the path control apparatus 100 according to an embodiment of the present disclosure may immediately react to the path deviation by previously setting the second path based on a road congestion level before the path deviation and setting the previously generated second path to a driving path upon the path deviation.
A description will be given in detail of an operation of the path control apparatus 100 according to an embodiment of the present disclosure.
As shown in
The path control apparatus 100 may extract a path deviation prediction area on the first path in advance. In this case, in operation S140, the path control apparatus 100 may determine a forward path deviation prediction area on the first path while the vehicle 10 is driven. The path control apparatus 100 may verify a distance D from a current location of the vehicle 10 to the path deviation prediction area.
In operation S150, the path control apparatus 100 may determine whether the distance D from the current location of the vehicle 10 to the path deviation prediction area is less than or equal to a first distance threshold Dth1. If the distance D is greater than the first distance threshold Dth1 in operation S150, in operation S190, the path control apparatus 100 may determine whether the distance D is less than or equal to a second distance threshold Dth2 which is more distant from the first distance threshold Dth1. If the distance D is greater than the second distance threshold Dth2 in operation S190, the path control apparatus 100 may maintain the driving of the vehicle 10 along the first path. If the distance D is less than or equal to the second distance threshold Dth2, in operation S200, the path control apparatus 100 may determine whether a driving lane of the vehicle 10 is a target lane. If the driving lane of the vehicle 10 is the target lane in operation S200, the path control apparatus 100 may maintain the driving of the vehicle 10 along the first path. If the driving lane of the vehicle 10 is not the target lane, the path control apparatus 100 may calculate a road congestion level of a road around the vehicle 10.
If the calculated road congestion level is greater than a congestion level threshold Uth in operation S210, in operation S220, the path control apparatus 100 may predict path deviation on the path deviation prediction area and may generate a second path. Information of the second path generated in operation S220 may be stored in a storage 150 of
If the distance D from the current location of the vehicle 10 to the path deviation prediction area is less than or equal to the first distance threshold Dth1, in operation S160, the path control apparatus 100 may determine whether the driving lane of the vehicle 10 is the target lane.
If the driving lane of the vehicle 10 is the target lane in operation S160, the path control apparatus 100 may maintain the driving of the vehicle 10 along the first path. If the driving lane of the vehicle 10 is not the target lane in operation S160, in operation S170, the path control apparatus 100 may determine whether the vehicle 10 deviates form a driving path. When the vehicle 10 deviates from the driving path, the path control apparatus 100 may reset the driving path to the second path generated in operation S220.
If it is determined that the vehicle 10 does not deviate from the driving path in operation S170, the path control apparatus 100 may maintain the driving of the vehicle 10 along the first path.
The path control apparatus 100 according to an embodiment may be implemented in the form of an independent hardware device and may be driven in the form of being included in another hardware device such as a micro-processor or a general purpose computer system as at least one or more processors.
Referring to
The processor 1100 may be a central processing unit (CPU) or a semiconductor device for processing instructions stored in the memory 1300 and/or the storage 1600. Each of the memory 1300 and the storage 1600 may include various types of volatile or non-volatile storage media. For example, the memory 1300 may include a read only memory (ROM) 1310 and a random access memory (RAM) 1320.
Thus, the operations of the methods or algorithms described in connection with the embodiments disclosed in the specification may be directly implemented with a hardware module, a software module, or combinations thereof, executed by the processor 1100. The software module may reside on a storage medium (e.g., the memory 1300 and/or the storage 1600) such as a RAM, a flash memory, a ROM, an erasable and programmable ROM (EPROM), an electrically EPROM (EEPROM), a register, a hard disc, a removable disc, or a compact disc-ROM (CD-ROM). An exemplary storage medium may be coupled to the processor 1100. The processor 1100 may read out information from the storage medium and may write information in the storage medium. Alternatively, the storage medium may be integrated with the processor 1100. The processor and the storage medium may reside in an application specific integrated circuit (ASIC). The ASIC may reside in a user terminal. Alternatively, the processor and storage medium may reside as a separate component of the user terminal.
According to various embodiments, the path control apparatus may flexibly respond to an unexpected situation by determining whether there is a path deviation prediction area on a preset path, detecting path deviation on the corresponding area in advance, and previously searching for an alternative path before the path deviation such that the vehicle drives along the alternative path although the vehicle deviates from a path on the path deviation predication area.
While the present disclosure has been described with reference to exemplary embodiments, it will be apparent to those skilled in the art that various changes and modifications may be made without departing from the spirit and scope of the present disclosure.
Therefore, exemplary embodiments of the present disclosure are not limiting, but illustrative, and the spirit and scope of the present disclosure is not limited thereto. The spirit and scope and the present disclosure should be interpreted by the following claims, it should be interpreted that all technical ideas which are equivalent to the present disclosure are included in the spirit and scope of the present disclosure.
Number | Date | Country | Kind |
---|---|---|---|
10-2016-0156515 | Nov 2016 | KR | national |
Number | Name | Date | Kind |
---|---|---|---|
6324452 | Ikegaya | Nov 2001 | B1 |
6405132 | Breed | Jun 2002 | B1 |
6487501 | Jeon | Nov 2002 | B1 |
6950746 | Yano et al. | Sep 2005 | B2 |
7363153 | Nam | Apr 2008 | B2 |
9816826 | Renz | Nov 2017 | B2 |
9846050 | Myers | Dec 2017 | B2 |
9909875 | Holm | Mar 2018 | B2 |
9927248 | Spiro | Mar 2018 | B2 |
20070244635 | Asahara | Oct 2007 | A1 |
20090171562 | Shimada | Jul 2009 | A1 |
20100094551 | Bonanni | Apr 2010 | A1 |
20110196565 | Collins | Aug 2011 | A1 |
20120316725 | Trepagnier | Dec 2012 | A1 |
20120316772 | Han | Dec 2012 | A1 |
20130132426 | Park | May 2013 | A1 |
20150134185 | Lee | May 2015 | A1 |
20150258979 | Matsunaga | Sep 2015 | A1 |
20160117936 | Klinger | Apr 2016 | A1 |
20160274567 | Motohashi | Sep 2016 | A1 |
20170199525 | Albaghajati | Jul 2017 | A1 |
20170201681 | Picalausa | Jul 2017 | A1 |
20170300029 | Oda | Oct 2017 | A1 |
20180051997 | Grochocki, Jr. | Feb 2018 | A1 |
Number | Date | Country |
---|---|---|
2007267340 | Oct 2007 | JP |
4400173 | Jan 2010 | JP |
10-0998321 | Dec 2010 | KR |
WO-2010143935 | Dec 2010 | WO |
Entry |
---|
Guangming et al., “Development and Implementation of Remote Control System for an Unmanned Heavy Tracked Vehicle,” Year: 2007, pp. 663-667. |
Derong et al., “ON Optimal Path Controller Minimizing Longitudinal and Lateral Deviations after Light Collisions,” Year: 2013, pp. 899-904. |
Number | Date | Country | |
---|---|---|---|
20180143028 A1 | May 2018 | US |