KR102303648B1 - Apparatus for controlling safety driving of vehicle and method thereof - Google Patents
Apparatus for controlling safety driving of vehicle and method thereof Download PDFInfo
- Publication number
- KR102303648B1 KR102303648B1 KR1020190165514A KR20190165514A KR102303648B1 KR 102303648 B1 KR102303648 B1 KR 102303648B1 KR 1020190165514 A KR1020190165514 A KR 1020190165514A KR 20190165514 A KR20190165514 A KR 20190165514A KR 102303648 B1 KR102303648 B1 KR 102303648B1
- Authority
- KR
- South Korea
- Prior art keywords
- vehicle
- intersection point
- host vehicle
- target
- reach
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18154—Approaching an intersection
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/105—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/114—Yaw movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
- B60W2050/143—Alarm means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
- B60W2050/146—Display means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/14—Yaw
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2300/00—Purposes or special features of road vehicle drive control systems
- B60Y2300/08—Predicting or avoiding probable or impending collision
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2300/00—Purposes or special features of road vehicle drive control systems
- B60Y2300/18—Propelling the vehicle
- B60Y2300/18008—Propelling the vehicle related to particular drive situations
- B60Y2300/18158—Approaching intersection
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
차량 안전주행 제어장치 및 그 방법이 제공된다. 본 발명의 실시예에 따른 차량 안전주행 제어장치는 자차의 주위 정보를 감지하는 감지부, GPS 위성으로부터 GPS 정보를 수신하는 GPS 수신부, 내비게이션의 맵 정보가 저장된 저장부, 및 감지부, GPS 수신부 및 저장부와 통신적으로 연결되는 제어부를 포함한다. 여기서, 제어부는 GPS 정보, 내비게이션의 맵 정보, 자차 정보 및 감지부의 감지 결과를 이용하여 자차가 합류 도로로 진입하는지의 여부를 결정하고, 합류 도로로 진입하는 자차의 회전 반경을 기반으로 본선 도로를 주행하는 타겟차와 자차의 교차 지점을 연산하며, 자차 및 타겟차가 교차 지점에 도달하는데 소요되는 시간을 연산하고, 자차와 타겟차가 교차 지점에 도달하는데 소요되는 시간에 따라 충돌 경고 또는 충돌 회피 감속 제어를 수행하기 위해 제어하도록 구성된다. Provided are an apparatus and method for controlling safe driving of a vehicle. A vehicle safe driving control device according to an embodiment of the present invention includes a sensing unit detecting surrounding information of the own vehicle, a GPS receiving unit receiving GPS information from a GPS satellite, a storage unit storing map information of navigation, and a sensing unit, a GPS receiving unit, and and a control unit communicatively connected to the storage unit. Here, the control unit determines whether or not the own vehicle enters the merging road using GPS information, the map information of the navigation, the own vehicle information, and the detection result of the sensing unit, and drives the main road based on the turning radius of the own vehicle entering the merging road. Calculates the intersection point of the target car and the host vehicle, calculates the time required for the host vehicle and the target vehicle to reach the intersection point, and performs collision warning or collision avoidance deceleration control according to the time required for the host vehicle and target vehicle to reach the intersection point configured to control.
Description
본 발명은 차량 안전주행 제어장치 및 그 방법에 관한 것이다. The present invention relates to an apparatus for controlling safe driving of a vehicle and a method therefor.
최근 차량의 성능뿐만 아니라 차량의 안전 및 편의에 대한 요구가 증가함에 따라 센서 등을 통해 획득된 정보를 기반으로 차량의 제어를 보조하는 ADAS(Advanced Driver Assist System)이 차량에 적용되어 운전중 운전자를 지원한다. ADAS는 차량 시스템을 적응, 자동화 및 개선함으로써 부드럽고 안전한 주행 경험을 가능하게 한다. As the demand for vehicle safety and convenience as well as vehicle performance increases in recent years, ADAS (Advanced Driver Assist System) that assists vehicle control based on information obtained through sensors has been applied to the vehicle to help the driver while driving. Support. ADAS enables a smooth and safe driving experience by adapting, automating and improving vehicle systems.
한편, 현재의 BSD(Blind Spot Detection) 시스템은 후측방 레이더 센서만을 이용하여 사각지대 영역 또는 원거리에서 빠르게 접근하는 차량에 대한 충돌 위험 경고 및 제어 기능을 통해 상대 차량과의 충돌을 경고/회피해 주는 기술이다.On the other hand, the current BSD (Blind Spot Detection) system warns/avoids a collision with an opposing vehicle through a collision hazard warning and control function for a vehicle rapidly approaching from a blind spot area or from a distance using only the rear-side radar sensor. it's technology
그러나 곡선 도로, 특히 합류 도로를 주행하다 직선 도로인 본선 도로에 합류하는 상황에서는 현재 후측방 레이더만으로는 합류 도로에 대한 정확한 식별이 불가능하여 위험 상황에 대해 회피가 어렵다.However, in a situation where driving on a curved road, especially a merging road and merging with a straight road, a main road, it is difficult to avoid dangerous situations because accurate identification of the merging road is impossible only with the current rear-side radar.
상기와 같은 종래 기술의 문제점을 해결하기 위해, 본 발명의 일 실시예는 합류 도로에서 본선 도로 진입시 후측방 경고 기능은 유지하면서 전측방에 대한 충돌 판단 및 제어 기능을 부가하여 안전운전을 지원할 수 있는 차량 안전주행 제어장치 및 그 방법을 제공하는 데 그 목적이 있다. In order to solve the problems of the prior art as described above, an embodiment of the present invention can support safe driving by adding a collision determination and control function for the front side while maintaining the rear side warning function when entering the main road from the merging road. An object of the present invention is to provide a vehicle safe driving control device and method therefor.
다만, 본 발명이 해결하고자 하는 과제는 이상에서 언급한 과제에 제한되지 않으며, 언급되지 않은 또 다른 과제들은 아래의 기재로부터 당업자에게 명확하게 이해될 수 있을 것이다.However, the problems to be solved by the present invention are not limited to the problems mentioned above, and other problems not mentioned will be clearly understood by those skilled in the art from the following description.
위와 같은 과제를 해결하기 위한 본 발명의 일 측면에 따르면, 자차의 주위 정보를 감지하는 감지부; GPS 위성으로부터 GPS 정보를 수신하는 GPS 수신부; 내비게이션의 맵 정보가 저장된 저장부; 및 상기 감지부, 상기 GPS 수신부 및 상기 저장부와 통신적으로 연결되는 제어부를 포함하고, 상기 제어부는 상기 GPS 정보, 상기 내비게이션의 맵 정보, 자차 정보 및 상기 감지부의 감지 결과를 이용하여 자차가 합류 도로로 진입하는지의 여부를 결정하고, 상기 합류 도로로 진입하는 상기 자차의 회전 반경을 기반으로 본선 도로를 주행하는 타겟차와 상기 자차의 교차 지점을 연산하며, 상기 자차 및 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하고, 상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간에 따라 충돌 경고 또는 충돌 회피 감속 제어를 수행하기 위해 제어하도록 구성되는 차량 안전주행 제어장치가 제공된다. According to one aspect of the present invention for solving the above problems, a sensing unit for sensing information around the own vehicle; GPS receiver for receiving GPS information from GPS satellites; a storage unit storing map information of navigation; and a control unit communicatively connected to the sensing unit, the GPS receiving unit, and the storage unit, wherein the control unit joins the own vehicle using the GPS information, the navigation map information, the own vehicle information, and the detection result of the sensing unit It is determined whether or not to enter the road, and an intersection point of the target car traveling on the main road and the host vehicle is calculated based on the turning radius of the own vehicle entering the merging road, and the own vehicle and the target vehicle reach the intersection point A vehicle safe driving control device is provided, configured to calculate a time required to perform a collision and control to perform a collision warning or collision avoidance deceleration control according to a time required for the host vehicle and the target vehicle to reach the intersection point.
일 실시예에서, 상기 제어부는 상기 자차의 회전 반경에 따른 원의 방정식과 상기 타겟차의 경로에 따른 직선의 방정식의 교차점을 상기 교차 지점으로 연산하도록 구성될 수 있다.In one embodiment, the control unit may be configured to calculate the intersection point of the equation of the circle according to the turning radius of the host vehicle and the equation of the straight line according to the path of the target vehicle as the intersection point.
일 실시예에서, 상기 제어부는 상기 자차의 조향 각도 또는 요-레이트(yaw-rate)를 기반으로 상기 자차의 회전 반경을 연산하고, 상기 타겟차의 위치 및 속도 벡터를 상기 자차의 좌표계로 변환하며, 상기 자차의 좌표계에서 상기 원의 방정식과 상기 직선의 방정식의 교차점을 연산하도록 구성될 수 있다.In one embodiment, the control unit calculates the turning radius of the own vehicle based on the steering angle or yaw-rate of the own vehicle, and converts the position and velocity vectors of the target vehicle into the coordinate system of the own vehicle, , may be configured to calculate an intersection point of the equation of the circle and the equation of the straight line in the coordinate system of the host vehicle.
일 실시예에서, 상기 제어부는 상기 타겟차의 종방향 및 횡방향 속도를 이용하여 상기 속도 벡터를 연산하도록 구성될 수 있다.In an embodiment, the control unit may be configured to calculate the velocity vector using longitudinal and lateral velocities of the target difference.
일 실시예에서, 상기 제어부는 상기 타겟차의 위치에서 상기 교차 지점까지의 거리를 연산한 후 상기 타겟차의 속도 벡터로 나누어 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하고, 상기 자차의 전방 코너에서부터 상기 교차 지점까지의 거리를 연산한 후 상기 자차의 속도로 나누어 상기 자차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하도록 구성될 수 있다.In one embodiment, the control unit calculates a distance from the position of the target car to the intersection point and divides it by the speed vector of the target car to calculate the time it takes for the target car to reach the intersection point, and the own vehicle After calculating the distance from the front corner of the junction to the intersection point, dividing by the speed of the host vehicle may be configured to calculate the time required for the host vehicle to reach the intersection point.
일 실시예에서, 상기 제어부는 상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 충돌 가능 범위 여부를 판단하기 위한 제1임계값과, 충돌 회피 감속 제어 여부를 판단하기 위한 제2임계값보다 작은지의 여부를 결정하고, 상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 상기 제1임계값보다 작고 어느 하나가 상기 제2임계값이상이면, 상기 충돌 경고를 수행하며, 상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 상기 제1임계값보다 작고 상기 제2임계값보다 작으면, 상기 충돌 회피 감속 제어를 수행하도록 구성될 수 있다.In an embodiment, the control unit includes a first threshold value for determining whether all of the time required for the host vehicle and the target vehicle to reach the intersection point is within a possible collision range, and a second threshold value for determining whether collision avoidance deceleration control is performed. It is determined whether or not it is smaller than a threshold value, and if both the time required for the host vehicle and the target vehicle to reach the intersection point is less than the first threshold value and any one is greater than or equal to the second threshold value, the collision warning is executed and when both the time taken for the host vehicle and the target vehicle to reach the intersection point is less than the first threshold value and less than the second threshold value, the collision avoidance deceleration control may be performed.
일 실시예에서, 상기 제어부는 상기 충돌 경고를 시각적으로 또는 청각적으로 수행하기 위해 제어하도록 구성될 수 있다.In one embodiment, the control unit may be configured to control to perform the collision warning visually or audibly.
일 실시예에서, 상기 제어부는 상기 자차의 속도와 조향 각도 및 상기 타겟차의 속도를 기반으로 충돌 회피 감속 제어를 수행하기 위해 안전주행 모듈을 활성화하도록 구성될 수 있다.In an embodiment, the control unit may be configured to activate the safe driving module to perform collision avoidance deceleration control based on the speed and steering angle of the host vehicle and the speed of the target vehicle.
일 실시예에서, 상기 차량 안전주행 제어장치는 상기 충돌 경고를 시각적으로 나타내는 미러 인디케이터; 또는 상기 충돌 경고를 시각적으로 또는 청각적으로 나타내는 클러스터 중 적어도 하나를 더 포함할 수 있다.In one embodiment, the vehicle safe driving control device includes a mirror indicator visually indicating the collision warning; Alternatively, it may further include at least one of a cluster visually or audibly indicating the collision warning.
일 실시예에서, 상기 감지부는 자차의 주변의 이미지를 촬영하는 이미지 센서; 및 상기 타겟차의 위치 및 속도를 감지하는 적어도 하나의 레이더(RADAR) 센서를 포함할 수 있다.In an embodiment, the sensing unit includes an image sensor for capturing an image of the surroundings of the own vehicle; and at least one radar (RADAR) sensor for detecting the position and speed of the target vehicle.
본 발명의 다른 측면에 따르면, 자차가 합류 도로로 진입하는지의 여부를 결정하는 제1결정 단계; 상기 합류 도로로 진입하는 상기 자차의 회전 반경을 기반으로 본선 도로를 주행하는 타겟차와 상기 자차의 교차 지점을 연산하는 제1연산 단계; 상기 자차 및 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하는 제2연산 단계; 및 상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간에 따라 충돌 경고 또는 충돌 회피 감속 제어를 수행하는 단계;를 포함하는 차량 안전주행 제어방법이 제공된다. According to another aspect of the present invention, a first determining step of determining whether the own vehicle enters the merging road; a first calculation step of calculating an intersection point of a target car traveling on a main road and the host vehicle based on a turning radius of the own vehicle entering the merging road; a second calculation step of calculating a time required for the host vehicle and the target vehicle to reach the intersection point; and performing a collision warning or collision avoidance deceleration control according to a time required for the host vehicle and the target vehicle to reach the intersection point.
일 실시예에서, 상기 제1결정 단계는 GPS 위성으로부터 수신된 GPS 정보, 내비게이션의 맵 정보, 자차 정보 및 자차의 주위에 대한 감지 결과를 이용하여 합류 도로의 진입여부를 결정할 수 있다.In an embodiment, the first determining step may determine whether to enter the merging road using GPS information received from a GPS satellite, map information of navigation, own vehicle information, and a detection result of the surroundings of the own vehicle.
일 실시예에서, 상기 제1연산 단계는 상기 자차의 회전 반경에 따른 원의 방정식과 상기 타겟차의 경로에 따른 직선의 방정식의 교차점을 상기 교차 지점으로 연산할 수 있다.In an embodiment, in the first calculation step, an intersection point of an equation of a circle according to a rotation radius of the host vehicle and an equation of a straight line according to a path of the target vehicle may be calculated as the intersection point.
일 실시예에서, 상기 제1연산 단계는 상기 자차의 조향 각도 또는 요-레이트(yaw-rate)를 기반으로 상기 자차의 회전 반경을 연산하고, 상기 타겟차의 위치 및 속도 벡터를 상기 자차의 좌표계로 변환하며, 상기 자차의 좌표계에서 상기 원의 방정식과 상기 직선의 방정식의 교차점을 연산할 수 있다.In an embodiment, the first calculating step calculates a turning radius of the own vehicle based on a steering angle or yaw-rate of the own vehicle, and sets the position and velocity vectors of the target vehicle in a coordinate system of the own vehicle. , and an intersection point of the equation of the circle and the equation of the straight line can be calculated in the coordinate system of the host vehicle.
일 실시예에서, 상기 제1연산 단계는 상기 타겟차의 종방향 및 횡방향 속도를 이용하여 상기 속도 벡터를 연산할 수 있다.In an embodiment, the first calculating step may calculate the velocity vector using longitudinal and lateral velocities of the target difference.
일 실시예에서, 상기 제2연산 단계는 상기 타겟차의 위치에서 상기 교차 지점까지의 거리를 연산한 후 상기 타겟차의 속도 벡터로 나누어 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하고, 상기 자차의 전방 코너에서부터 상기 교차 지점까지의 거리를 연산한 후 상기 자차의 속도로 나누어 상기 자차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산할 수 있다.In one embodiment, the second calculating step calculates the distance from the position of the target car to the crossing point and divides it by the velocity vector of the target difference to calculate the time it takes for the target car to reach the crossing point, , the distance from the front corner of the host vehicle to the intersection point may be calculated and divided by the speed of the host vehicle to calculate the time required for the host vehicle to reach the intersection point.
일 실시예에서, 상기 수행하는 단계는 상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 충돌 가능 범위 여부를 판단하기 위한 제1임계값과, 충돌 회피 감속 제어 여부를 판단하기 위한 제2임계값보다 작은지의 여부를 결정하는 제2결정 단계; 상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 상기 제1임계값보다 작고 어느 하나가 상기 제2임계값이상이면, 상기 충돌 경고를 수행하는 경고 단계; 및 상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 상기 제1임계값보다 작고 상기 제2임계값보다 작으면, 상기 충돌 회피 감속 제어를 수행하는 회피 제어 단계를 포함할 수 있다.In an embodiment, the performing includes: a first threshold for determining whether both the host vehicle and the target vehicle reach the intersection point in a collision possible range, and determining whether to control collision avoidance deceleration a second determining step of determining whether it is smaller than a second threshold; a warning step of performing the collision warning when both the time taken for the host vehicle and the target vehicle to reach the intersection point is less than the first threshold value and any one is greater than or equal to the second threshold value; and an avoidance control step of performing the collision avoidance deceleration control when both the time taken for the host vehicle and the target vehicle to reach the intersection point is less than the first threshold value and less than the second threshold value. .
일 실시예에서, 상기 경고 단계는 시각적으로 또는 청각적으로 경고를 수행할 수 있다.In one embodiment, the warning step may perform a warning visually or audibly.
일 실시예에서, 상기 회피 제어 단계는 상기 자차의 속도와 조향 각도 및 상기 타겟차의 속도를 기반으로 충돌 회피 감속 제어를 수행하도록 안전주행 모듈을 활성화할 수 있다.In an embodiment, the avoidance control step may activate the safe driving module to perform collision avoidance deceleration control based on the speed and steering angle of the host vehicle and the speed of the target vehicle.
본 발명의 일 실시예에 따른 차량 안전주행 제어장치 및 그 방법은 합류 도로에서 본선 도로 진입시 후측방 경고 기능은 유지하면서 전측방에 대한 충돌 판단 및 제어 기능을 부가함으로써 운전자의 부주의나 합류 도로 주행이 미숙한 경우에도 안전운전을 지원할 수 있음으로 운전자의 편의성을 향상시킬 수 있다. A vehicle safety driving control apparatus and method according to an embodiment of the present invention add a collision determination and control function for the front side while maintaining the rear side warning function when entering the main road from the merging road, thereby preventing the driver's carelessness or driving on the merging road It is possible to support safe driving even in inexperienced cases, thereby improving the driver's convenience.
또한, 본 발명의 일 실시예에 따른 차량 안전주행 제어장치 및 방법은 충돌 예상 시간이 운전자가 예상되는 충돌에 대처하는데 소요되는 시간보다 작으면, 감속 제어함으로써, 본선 도로에 주행중인 타겟차와의 충돌을 회피할 수 있으므로 안전운전을 더 효과적으로 지원할 수 있다. In addition, the apparatus and method for controlling safe driving of a vehicle according to an embodiment of the present invention perform deceleration control when the expected collision time is less than the time required for the driver to cope with the expected collision, thereby reducing the vehicle speed with the target vehicle driving on the main road. Since collisions can be avoided, safe driving can be supported more effectively.
또한, 본 발명의 일 실시예에 따른 차량 안전주행 제어장치 및 방법은 충돌 예상 시간이 운전자가 예상되는 충돌에 대처하는데 소요되는 시간보다 크면, 운전자에게 시각적으로 또는 청각적으로 경고함으로써, 운전자가 본선 도로의 진입시 예상되는 충돌을 인식하게 할 수 있으므로 운전자의 편의성을 향상시키고 주행 안전성을 도모할 수 있다. In addition, the apparatus and method for controlling safe vehicle driving according to an embodiment of the present invention provides a visual or auditory warning to the driver when the expected collision time is greater than the time required for the driver to cope with the expected collision, so that the driver can be on the main road. Since it is possible to recognize an expected collision when entering the road, it is possible to improve the driver's convenience and promote driving safety.
도 1은 본 발명의 일 실시예에 따른 차량 안전주행 제어장치를 구비한 차량이 합류 도로에서 본선 도로로 진입하는 과정을 나타낸 예시도이고,
도 2는 본 발명의 일 실시예에 따른 차량 안전주행 제어장치의 블록도이며,
도 3은 본 발명의 일 실시예에 따른 차량 안전주행 제어장치에서 교차 지점의 연산을 설명하기 위한 도면이고,
도 4는 본 발명의 일 실시예에 따른 차량 안전주행 제어장치에서 합류 도로가 직선인 경우 교차 지점의 연산을 설명하기 위한 도면이며,
도 5는 본 발명의 일 실시예에 따른 차량 안전주행 제어방법의 순서도이다. 1 is an exemplary view showing a process in which a vehicle equipped with a vehicle safe driving control device according to an embodiment of the present invention enters a main road from a merging road;
2 is a block diagram of a vehicle safe driving control device according to an embodiment of the present invention;
3 is a view for explaining the calculation of an intersection point in the vehicle safe driving control apparatus according to an embodiment of the present invention;
4 is a view for explaining the calculation of the intersection point when the merging road is a straight line in the vehicle safe driving control apparatus according to an embodiment of the present invention;
5 is a flowchart of a vehicle safe driving control method according to an embodiment of the present invention.
이하, 첨부한 도면을 참고로 하여 본 발명의 실시예에 대하여 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자가 용이하게 실시할 수 있도록 상세히 설명한다. 본 발명은 여러 가지 상이한 형태로 구현될 수 있으며 여기에서 설명하는 실시예에 한정되지 않는다. 도면에서 본 발명을 명확하게 설명하기 위해서 설명과 관계없는 부분은 생략하였으며, 명세서 전체를 통하여 동일 또는 유사한 구성요소에 대해서는 동일한 참조부호를 붙였다.Hereinafter, with reference to the accompanying drawings, the embodiments of the present invention will be described in detail so that those of ordinary skill in the art to which the present invention pertains can easily implement them. The present invention may be embodied in many different forms and is not limited to the embodiments described herein. In order to clearly explain the present invention in the drawings, parts irrelevant to the description are omitted, and the same reference numerals are assigned to the same or similar components throughout the specification.
본 발명의 실시예들은 당해 기술 분야에서 통상의 지식을 가진 자에게 본 발명을 더욱 완전하게 설명하기 위해 제공되는 것이며, 아래에 설명되는 실시예들은 여러 가지 다른 형태로 변형될 수 있으며, 본 발명의 범위가 아래의 실시예들로 한정되는 것은 아니다. 오히려, 이들 실시예는 본 발명을 더욱 충실하고 완전하게 하며 당업자에게 본 발명의 사상을 완전하게 전달하기 위하여 제공되는 것이다.The embodiments of the present invention are provided to more completely explain the present invention to those of ordinary skill in the art, and the embodiments described below may be modified in various other forms, The scope is not limited to the following examples. Rather, these examples are provided so as to more fully and complete the present invention, and to fully convey the spirit of the present invention to those skilled in the art.
도 1은 본 발명의 일 실시예에 따른 차량 안전주행 제어장치를 구비한 차량이 합류 도로에서 본선 도로로 진입하는 과정을 나타낸 예시도이다. 1 is an exemplary diagram illustrating a process in which a vehicle equipped with a vehicle safe driving control device enters a main road from a merging road according to an embodiment of the present invention.
도 1을 참조하면, 자차(10)는 합류 도로(2)에서 본선 도로(1)로 진입하는 경우, 본선 도로(1) 상에 주행하는 타겟차(11)와의 충돌 여부를 고려하여 주행 속도를 감속해야 한다. 여기서, 본선 도로(1)는 주로 직선 형태의 도로로서 주 도로를 의미한다. 합류 도로(2)는 본선 도로(1)에 진입하기 위한 연결 도로를 의미한다. 또한, 합류 도로(2)는 곡선 형태의 도로뿐만 아니라 직선 형태의 도로를 포함할 수 있다.Referring to FIG. 1 , when the
이때, 자차(10)은 먼저, 합류 도로(2)에서 본선 도로(1)로의 진입 상황을 판단하고, 본선 도로(1)에서 주행중인 타겟차(11)가 합류 도로(2) 부근에서 자차(10)와의 충돌 가능성을 예측해야 한다. At this time, the
이를 위해, 본 발명은 합류 도로(2)에서 본선 도로(1)로 진입하는 상황을 판단하고, 이 경우 한시적으로 후측방 경고 기능은 유지하면서 전측방 충돌 판단 및 제어 기능을 부가함으로 할 수 있다. To this end, the present invention determines the situation of entering the
이에 의해, 본 발명은 운전자의 부주의나 합류 도로 주행이 미숙한 경우에도 충돌 경고 또는 충돌 회피 제어에 의해 안전운전을 지원할 수 있음으로 운전자의 편의성을 향상시킬 수 있다. Accordingly, the present invention can improve the driver's convenience by supporting safe driving through collision warning or collision avoidance control even when the driver is negligent or inexperienced in driving on a merging road.
도 2는 본 발명의 일 실시예에 따른 차량 안전주행 제어장치의 블록도이이고, 도 3은 본 발명의 일 실시예에 따른 차량 안전주행 제어장치에서 교차 지점의 연산을 설명하기 위한 도면이며, 도 4는 본 발명의 일 실시예에 따른 차량 안전주행 제어장치에서 합류 도로가 직선인 경우 교차 지점의 연산을 설명하기 위한 도면이다.2 is a block diagram of an apparatus for controlling safe driving of a vehicle according to an embodiment of the present invention, and FIG. 3 is a view for explaining the calculation of an intersection point in the apparatus for controlling safe driving of a vehicle according to an embodiment of the present invention, FIG. 4 is a view for explaining the calculation of the intersection point when the merging road is a straight line in the apparatus for controlling safe driving of a vehicle according to an embodiment of the present invention.
도 2를 참조하면, 차량 안전주행 제어장치(100)는 감지부(110), GPS 수신부(120), 제어부(130), 저장부(140), 미러 인디케이터(150), 클러스터(160) 및 안전주행 모듈(170)을 포함할 수 있다.Referring to FIG. 2 , the vehicle safety
감지부(110)는 자차(10)의 주위 정보를 감지할 수 있다. 감지부(110)는 레이더 센서(112) 및 이미지 센서(114)를 포함할 수 있다.The
레이더 센서(112)는 자차(10)의 전방, 측방 또는 후방에 복수로 구비될 수 있다. 여기서, 레이더 센서(112)는 타겟차(11)의 위치 및 속도를 감지할 수 있다. 이때, 레이더 센서(112)는 종방향과 횡방향을 구분하여 위치 및 속도를 감지할 수 있다.A plurality of
이미지 센서(114)는 자차(10) 주변의 이미지를 획득한다. 이미지 센서(114)는 카메라 센서 또는 라이다(Lidar) 센서 중 적어도 하나를 포함할 수 있다. 또한, 이미지 센서(114)는 자차(10)의 전방, 측방 또는 후방에 복수로 구비될 수 있다. 여기서, 이미지 센서(114)는 본선 도로(1)에서 주행하는 타겟차(11) 또는 합류 도로(2) 상의 차선(2')의 이미지를 획득할 수 있다. The
GPS 수신부(120)는 GPS 위성으로부터 GPS 정보를 수신할 수 있다. 여기서, GPS 정보는 자차(10)의 현재 위치에 따른 지형 및 도로 정보를 포함할 수 있다. 또한, GPS 수신부(120)는 수신된 GPS 정보를 저장부(140)에 저장할 수 있다. The
저장부(140)는 내비게이션의 맵 정보가 저장될 수 있다. 또한, 저장부(140)는 GPS 수신부(120)로부터 수신된 GPS 정보가 저장될 수 있다.The
미러 인디케이터(150)는 제어부(130)의 제어에 따라 충돌 경고를 시각적으로 나타낼 수 있다. 또한, 미러 인디케이터(150)는 자차(10) 외부의 사이드 밀러에 구비될 수 있다. 이때, 미러 인디케이터(150)는 LED 등과 같은 점멸 수단에 의해 깜박임으로 사용자가 인지할 수 있도록 충돌 경고를 시각적으로 나타낼 수 있다. The
클러스터(160)는 제어부(130)의 제어에 따라 충돌 경고를 시각적으로 또는 청각적으로 나타낼 수 있다. 또한, 클러스터(160)는 자차(10) 내부에서 사용자가 인지할 수 있도록 충돌 경고를 수행하도록 구성될 수 있다. 이때, 시각적 충돌 경고는 LED 등과 같은 점멸 수단에 의해 깜박임으로 수행될 수 있다. 또한, 청각적 충돌 경고는 오디오 기기의 스피커에 의해 음성 또는 음향으로 수행될 수 있다.The
안전주행 모듈(170)은 자차(10)의 안전주행을 제어하기 위한 모듈일 수 있다. 안전주행 모듈(170)은 자차(10)의 엔진 및 조향장치를 제어할 수 있다. 이때, 안전주행 모듈(170)은 자차(10)의 속도와 조향 각도 및 타겟차(11)의 속도를 기반으로 자차(10)을 감속 제어하도록 구성될 수 있다.The
제어부(130)는 감지부(110), GPS 수신부(120), 저장부(140), 미러 인디케이터(150), 클러스터(160) 및 안전주행 모듈(170)에 통신적으로 연결될 수 있다. 여기서, 제어부(130)는 자차(10)의 ECU일 수 있다. 선택적으로, 제어부(130)는 자차(10)의 안전주행 제어를 위해 별도로 구비된 컨트롤러일 수도 있다. The
또한, 제어부(130)는 GPS 수신부(120)로부터 수신된 GPS 정보, 저장부(140)에 저장된 내비게이션의 맵 정보, 자차 정보 및 감지부(110)의 감지 결과를 이용하여 자차가 합류 도로(2)로 진입하는지의 여부를 결정하도록 구성될 수 있다. 이때, 감지부(110)의 감지결과는 전방 이미지 센서(114)를 통한 차량 주변의 영상 정보로서, 합류 도로(2)의 주변 차선(2') 정보일 수 있다. 즉, 제어부(130)는 차선(2')의 형상을 인식하여 곡선의 합류 도로(2)임을 인식하도록 구성될 수 있다.In addition, the
또한, 제어부(130)는 합류 도로(2)로 판단한 경우, 합류 도로(2)로 진입하는 자차(10)의 회전 반경(R)을 기반으로 본선 도로(1)를 주행하는 타겟차(11)와 자차(10)의 교차 지점(CP)을 연산하도록 구성될 수 있다. In addition, when it is determined that the
도 3을 참조하면, 자차(10)와 타겟차(11)의 교차 지점은 본선 도로(1)를 직선으로 주행중인 타겟차(11)의 직선 방향과 곡선의 합류 도로(2)로 진입한 자차(10)의 회전 방향의 교차점으로 나타낼 수 있다. 따라서 제어부(130)는 자차(10)의 회전 반경(R)에 따른 원(C)의 방정식과 타겟차(11)의 경로에 따른 직선(L)의 방정식의 교차점을 교차 지점(CP)으로 연산하도록 구성될 수 있다. Referring to FIG. 3 , the intersection point of the
이때, 제어부(130)는 자차(10)의 조향 각도 또는 요-레이트(yaw-rate)를 기반으로 자차(10)의 회전 반경(R)을 연산하도록 구성될 수 있다.In this case, the
또한, 제어부(130)는 레이더 센서(112)를 통하여 수신된 타겟차(11)의 종방향 속도(Vx) 및 횡방향 속도(Vy)를 이용하여 속도 벡터(V)를 연산하도록 구성될 수 있다. 도 1을 참조하면, 속도 벡터(V)는 종방향 속도(Vx)와 횡방향 속도(Vy)의 합성 값일 수 있다.In addition, the
이때, 제어부(130)는 타겟차(11)의 위치 및 속도 벡터(V)를 자차(10)의 좌표계로 변환하도록 구성될 수 있다. 따라서 제어부(130)는 자차 좌표계에서 원(C)의 방정식과 직선(L)의 방정식의 교차점을 연산하도록 구성될 수 있다. 여기서, 원(C)의 방정식은 타겟차(11)와 가까운 방향의 자차(10)의 전방 코너를 기준으로 반지름 R인 원으로 고려될 수 있다. 일례로, LHD(Left Hand Drive) 시스템인 경우, 자차(10)의 좌측 전방 코너가 기준이며, RHD(Right Hand Drive) 시스템인 경우, 자차(10)의 우측 전방 코너가 기준일 수 있다. 또한, 직선(L)의 방정식과 원(C)의 방정식을 연립하여 이차방정식의 근이 연산되면, 교차 지점(CP)이 연산될 수 있다.In this case, the
도 4를 참조하면, 합류 도로(2)가 직선인 경우, 회전 반경(R)은 무한대로 수렴한다. 따라서 원(C)의 방정식은 직선(C1)의 방정식으로 간주될 수 있다. 이 경우, 두 직선(L, C1)의 방정식을 연립하여 1차 방정식의 근이 연산됨으로써 교차 지점(CP)이 연산될 수 있다.Referring to FIG. 4 , when the merging
또한, 제어부(130)는 자차(10) 및 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간을 연산하도록 구성될 수 있다. 여기서, 교차 지점(CP)에 도달하는데 소요되는 시간은 충돌 예상 시간(TTC; Time To Collision)으로 나타낼 수 있다. In addition, the
이때, 제어부(130)는 전방/후측방 레이더 센서(112) 또는 측방 이미지 센서(114)로부터 감지된 타겟차(11)의 위치에서 교차 지점(CP)까지의 거리를 연산하도록 구성될 수 있다. 다음, 제어부(130)는 교차 지점(CP)까지의 거리를 타겟차(11)의 속도 벡터(V)로 나누어 타겟차(11)의 충돌 예상 시간(TTC1)을 연산하도록 구성될 수 있다.In this case, the
또한, 제어부(130)는 자차(10)의 전방 코너에서부터 교차 지점(CP)까지의 거리를 연산하도록 구성될 수 있다. 일례로, 자차(10)의 좌측 전방 코너에서부터 교차 지점(CP)까지의 거리가 연산될 수 있다. 다음, 제어부(130)는 교차 지점(CP)까지의 거리를 자차(10)의 속도로 나누어 자차(10)의 충돌 예상 시간(TTC2)을 연산하도록 구성될 수 있다.Also, the
또한, 제어부(130)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2)에 따라 충돌 경고 또는 충돌 회피 감속 제어를 수행하기 위해 제어하도록 구성될 수 있다. 즉, 자차(10)와 타겟차(11)의 위치에 따른 교차 지점(CP)에 도달하는 시간에 따라 충돌 경고 또는 충돌 회피 감속 제어가 구분되어 수행될 수 있다.In addition, the
일례로, 제어부(130)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제1임계값(Th1)보다 작은지의 여부를 결정하도록 구성될 수 있다. 여기서, 제1임계값(Th1)은 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간에 따른 충돌 가능 범위 여부를 판단하기 위한 기준 시간이다. For example, the
또한, 제어부(130)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제2임계값(Th2)보다 작은지의 여부를 결정하도록 구성될 수 있다. 여기서, 제2임계값(Th2)은 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간에 따른 충돌 회피 감속 제어 여부를 판단하기 위한 기준 시간으로서, 운전자가 예상되는 충돌에 대처하는데 소요되는 시간을 기반으로 설정될 수 있다. In addition, the
이때, 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제1임계값보다 작고, 어느 하나가 제2임계값(Th2)이상이면, 제어부(130)는 충돌 경고를 수행하도록 구성될 수 있다. 즉, 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간 중 어느 하나가 운전자에 의해 예상되는 충돌에 대처하기에 충분한 시간인 경우, 운전자가 주의를 갖도록 충돌 경고가 수행될 수 있다.At this time, if both the expected collision time TTC1 of the
일례로, 제어부(130)는 충돌 경고를 시각적으로 또는 청각적으로 수행하기 위해 제어하도록 구성될 수 있다. 여기서, 충돌 경고는 미러 인디케이터(150) 또는 클러스터(160)를 통하여 수행될 수 있다.As an example, the
이에 의해, 차량 안전주행 제어장치(100)는 운전자가 본선 도로의 진입시 예상되는 충돌을 인식하게 할 수 있으므로 운전자의 편의성을 향상시키고 주행 안전성을 도모할 수 있다. Accordingly, the vehicle safe
반면, 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제1임계값(Th1)보다 작고 제2임계값(Th2)보다 작으면, 제어부(130)는 충돌 회피 감속 제어를 수행하도록 구성될 수 있다. 즉, 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간 모두가 운전자에 의해 예상되는 충돌에 대처하기에 충분하지 않은 시간인 경우, 충돌을 회피하도록 감속 제어가 수행될 수 있다.On the other hand, when both the expected collision time TTC1 of the
이때, 제어부(130)는 자차(10)의 속도와 조향 각도 및 타겟차(11)의 속도를 기반으로 충돌 회피 감속 제어를 수행하도록 구성될 수 있다. 여기서, 제어부(130)는 안전주행 모듈(170)을 활성화하도록 구성될 수 있다.In this case, the
이에 의해, 차량 안전주행 제어장치(100)는 본선 도로에 주행중인 타겟차와의 충돌을 자동으로 신속하게 회피할 수 있으므로 안전운전을 더 효과적으로 지원할 수 있다. Accordingly, the vehicle safe
이하, 도 5를 참조하여 본 발명의 일 실시예에 따른 차량 안전주행 제어방법을 설명한다.Hereinafter, a vehicle safe driving control method according to an embodiment of the present invention will be described with reference to FIG. 5 .
도 5는 본 발명의 일 실시예에 따른 차량 안전주행 제어방법의 순서도이다.5 is a flowchart of a vehicle safe driving control method according to an embodiment of the present invention.
차량 안전주행 제어방법(200)은 합류 도로의 진입 여부를 결정하는 단계(S210), 타겟차와 자차의 교차 지점을 연산하는 단계(S220), 교차 지점에 도달하는데 소요되는 시간을 연산하는 단계(S230 및 S240), 교차 지점에 도달하는데 소요되는 시간에 따라 충돌 경고 또는 충돌 회피 감속 제어를 수행하는 단계(SS250 내지 S280)을 포함한다. The vehicle safe
보다 상세히 설명하면, 도 5에 도시된 바와 같이, 먼저, 차량 안전주행 제어장치(100)는 자차(10)가 합류 도로(2)에 진입하는지의 여부를 결정한다(단계 S210). 이때, 차량 안전주행 제어장치(100)는 GPS 위성으로부터 수신된 GPS 정보, 내비게이션의 맵 정보, 자차 정보 및 자차(10)의 주위에 대한 감지 결과를 이용하여 자차(10)가 합류 도로(2)로 진입하는지의 여부를 결정할 수 있다. More specifically, as shown in FIG. 5 , first, the apparatus for controlling safe vehicle driving 100 determines whether the
여기서, 상기 감지 결과는 전방 이미지 센서(114)를 통한 차량 주변의 영상 정보로서, 합류 도로(2)의 주변 차선(2') 정보일 수 있다. 즉, 차량 안전주행 제어장치(100)는 차선(2')의 형상을 인식하여 곡선의 합류 도로(2)임을 인식할 수 있다.Here, the detection result is image information around the vehicle through the
단계 S210의 결정결과, 합류 도로(2)에 진입하지 않은 경우, 차량 안전주행 제어장치(100)는 합류 도로(2)에 진입하는지의 여부를 지속적으로 감시한다. 또한, 합류 도로(2)에 진입한 경우, 차량 안전주행 제어장치(100)는 자차(10)와 타겟차(11)의 교차 지점(CP)을 연산한다(단계 S220). 이때, 차량 안전주행 제어장치(100)는 자차(10)의 회전 반경(R)을 기반으로 본선 도로(1)를 주행하는 타겟차(11)와 자차(10)의 교차 지점(CP)을 연산할 수 있다.As a result of the determination in step S210 , if the vehicle does not enter the merging
보다 구체적으로, 차량 안전주행 제어장치(100)는 자차(10)의 회전 반경(R)에 따른 원(C)의 방정식과 타겟차(11)의 경로에 따른 직선(L)의 방정식의 교차점을 교차 지점(CP)으로 연산할 수 있다.More specifically, the vehicle safe
이때, 차량 안전주행 제어장치(100)는 자차(10)의 조향 각도 또는 요-레이트(yaw-rate)를 기반으로 자차(10)의 회전 반경(R)을 연산할 수 있다.In this case, the
또한, 차량 안전주행 제어장치(100)는 레이더 센서(112)를 통하여 수신된 타겟차(11)의 종방향 속도(Vx) 및 횡방향 속도(Vy)를 이용하여 속도 벡터(V)를 연산할 수 있다. 여기서, 속도 벡터(V)는 종방향 속도(Vx)와 횡방향 속도(Vy)의 합성 값일 수 있다.In addition, the vehicle safe
또한, 차량 안전주행 제어장치(100)는 타겟차(11)의 위치 및 속도 벡터(V)를 자차(10)의 좌표계로 변환할 수 있다. 이에 의해, 차량 안전주행 제어장치(100)는 자차(10)의 좌표계에서 원(C)의 방정식과 직선(L)의 방정식의 교차점을 연산할 수 있다. 여기서, 원(C)의 방정식은 타겟차(11)와 가까운 방향의 자차(10)의 전방 코너를 기준으로 반지름 R인 원으로 고려될 수 있다. LHD 시스템인지 RHD 시스템인지에 따라 자차(10)의 좌측 전방 코너 또는 우측 전방 코너가 기준이 될 수 있다. 또한, 차량 안전주행 제어장치(100)는 직선(L)의 방정식과 원(C)의 방정식을 연립하여 이차방정식의 근을 연산함으로써, 교차 지점(CP)을 연산할 수 있다.Also, the
한편, 합류 도로(2)가 직선인 경우, 차량 안전주행 제어장치(100)는 두 직선(L, C1)의 방정식을 연립하여 1차 방정식의 근을 연산함으로써 교차 지점(CP)을 연산할 수 있다.On the other hand, when the merging
다음으로, 차량 안전주행 제어장치(100)는 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간을 연산한다(단계 S230). 여기서, 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간은 충돌 예상 시간(TTC1)으로 나타낼 수 있다. Next, the vehicle safe
이때, 차량 안전주행 제어장치(100)는 전방/후측방 레이더 센서(112) 또는 측방 이미지 센서(114)로부터 감지된 타겟차(11)의 위치에서 교차 지점(CP)까지의 거리를 연산한 후, 교차 지점(CP)까지의 거리를 타겟차(11)의 속도 벡터(V)로 나눔으로써 타겟차(11)의 충돌 예상 시간(TTC1)을 연산할 수 있다.At this time, the vehicle safe
다음으로, 차량 안전주행 제어장치(100)는 자차(10)가 교차 지점(CP)에 도달하는데 소요되는 시간을 연산한다(단계 S240). 여기서, 자차(10)가 교차 지점(CP)에 도달하는데 소요되는 시간은 충돌 예상 시간(TTC2)으로 나타낼 수 있다. Next, the device for controlling safe vehicle driving 100 calculates the time required for the
이때, 차량 안전주행 제어장치(100)는 자차(10)의 전방 코너(일례로, 좌측 전방 코너)에서부터 교차 지점(CP)까지의 거리를 연산한 후, 교차 지점(CP)까지의 거리를 자차(10)의 속도로 나눔으로써 자차(10)의 충돌 예상 시간(TTC2)을 연산할 수 있다.At this time, the vehicle safe
다음으로, 차량 안전주행 제어장치(100)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제1임계값(Th1)보다 작은지의 여부를 결정한다(단계 S250). 여기서, 제1임계값(Th1)은 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간에 따른 충돌 가능 범위 여부를 판단하기 위한 기준 시간이다. Next, the vehicle safe
단계 S250의 결정결과, 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 중 어느 하나가 제1임계값(Th1)이상이면, 차량 안전주행 제어장치(100)는 단계 S210으로 진행하여 다른 합류 도로의 진입여부를 결정할 수 있다.As a result of the determination in step S250, if either one of the expected collision time TTC1 of the
단계 S250의 결정결과, 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제1임계값(Th1)보다 작으면, 차량 안전주행 제어장치(100)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제2임계값(Th2)보다 작은지의 여부를 결정한다(단계 S260). 여기서, 제2임계값(Th2)은 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간에 따른 충돌 경고 여부를 판단하기 위한 기준 시간으로서, 운전자가 예상되는 충돌에 대처하는데 소요되는 시간을 기반으로 설정될 수 있다.As a result of the determination in step S250 , if both the expected collision time TTC1 of the
또한, 단계 S260의 결정결과, 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제2임계값(Th2)보다 작으면, 차량 안전주행 제어장치(100)는 충돌 회피 감속 제어를 수행한다(단계 S270). 이때, 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간 모두가 운전자에 의해 예상되는 충돌에 대처하기에 충분하지 않기 때문에, 차량 안전주행 제어장치(100)는 충돌을 회피하도록 감속 제어를 수행할 수 있다.In addition, as a result of the determination in step S260 , if both the expected collision time TTC1 of the
일례로, 차량 안전주행 제어장치(100)는 자차(10)의 속도와 조향 각도 및 타겟차(11)의 속도를 기반으로 충돌 회피 감속 제어를 수행할 수 있다.For example, the
단계 S260의 결정결과, 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 중 어느 하나가 제2임계값(Th2)이상이면, 차량 안전주행 제어장치(100)는 충돌 경고를 수행한다(단계 S280). 이때, 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간 중 어느 하나가 운전자에 의해 예상되는 충돌에 대처하기에 충분한 시간이기 때문에, 차량 안전주행 제어장치(100)는 운전자가 주의를 갖도록 충돌 경고를 수행할 수 있다.As a result of the determination in step S260, if either one of the expected collision time TTC1 of the
일례로, 차량 안전주행 제어장치(100)는 충돌 경고를 시각적으로 또는 청각적으로 수행할 수 있다. 여기서, 차량 안전주행 제어장치(100)는 미러 인디케이터(150) 또는 클러스터(160)를 통하여 충돌 경고를 수행할 수 있다.For example, the vehicle safe
이에 의해, 차량 안전주행 제어방법(200)은 운전자의 부주의나 합류 도로 주행이 미숙한 경우에도 안전운전을 지원할 수 있음으로 운전자의 편의성을 향상시킬 수 있고, 본선 도로에 주행중인 타겟차와의 충돌을 회피할 수 있으므로 안전운전을 더 효과적으로 지원할 수 있으며, 운전자가 본선 도로의 진입시 예상되는 충돌을 인식하게 할 수 있으므로 운전자의 편의성을 향상시키고 주행 안전성을 도모할 수 있다. Accordingly, the vehicle safe
상기와 같은 방법들은 도 1에 도시된 바와 같은 차량 안전주행 제어장치(100)에 의해 구현될 수 있고, 특히, 이러한 단계들을 수행하는 소프트웨어 프로그램으로 구현될 수 있으며, 이 경우, 이러한 프로그램들은 컴퓨터 판독가능한 기록 매체에 저장되거나 전송 매체 또는 통신망에서 반송파와 결합된 컴퓨터 데이터 신호에 의하여 전송될 수 있다. 이때, 컴퓨터 판독가능한 기록 매체는 컴퓨터 시스템에 의해 판독가능한 데이터가 저장되는 모든 종류의 기록 장치를 포함할 수 있다.The above methods may be implemented by the vehicle safe
이상에서 본 발명의 일 실시예에 대하여 설명하였으나, 본 발명의 사상은 본 명세서에 제시되는 실시예에 제한되지 아니하며, 본 발명의 사상을 이해하는 당업자는 동일한 사상의 범위 내에서, 구성요소의 부가, 변경, 삭제, 추가 등에 의해서 다른 실시예를 용이하게 제안할 수 있을 것이나, 이 또한 본 발명의 사상범위 내에 든다고 할 것이다.Although one embodiment of the present invention has been described above, the spirit of the present invention is not limited to the embodiments presented herein, and those skilled in the art who understand the spirit of the present invention can add components within the scope of the same spirit. , changes, deletions, additions, etc. may easily suggest other embodiments, but this will also fall within the scope of the present invention.
100 : 차량 안전주행 제어장치 110 : 감지부
112 : 레이더 센서 114 : 이미지 센서
120 : GPS 수신부 130 : 제어부
140 : 저장부 150 : 미러 인디케이터
160 : 클러스터 170 : 안전주행 모듈100: vehicle safe driving control device 110: sensing unit
112: radar sensor 114: image sensor
120: GPS receiver 130: control unit
140: storage unit 150: mirror indicator
160: cluster 170: safe driving module
Claims (19)
GPS 위성으로부터 GPS 정보를 수신하는 GPS 수신부;
내비게이션의 맵 정보가 저장된 저장부; 및
상기 감지부, 상기 GPS 수신부 및 상기 저장부와 통신적으로 연결되는 제어부를 포함하고,
상기 제어부는,
상기 GPS 정보, 상기 내비게이션의 맵 정보, 자차 정보 및 상기 감지부의 감지 결과를 이용하여 자차가 합류 도로로 진입하는지의 여부를 결정하고,
상기 합류 도로로 진입하는 상기 자차의 회전 반경을 기반으로 본선 도로를 주행하는 타겟차와 상기 자차의 교차 지점을 연산하며,
상기 자차 및 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하고,
상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간에 따라 충돌 경고 또는 충돌 회피 감속 제어를 수행하기 위해 제어하도록 구성되며,
상기 제어부는,
상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 충돌 가능 범위 여부를 판단하기 위한 제1임계값과, 충돌 회피 감속 제어 여부를 판단하기 위한 제2임계값보다 작은지의 여부를 결정하고,
상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 상기 제1임계값보다 작고 어느 하나가 상기 제2임계값 이상이면, 상기 충돌 경고를 수행하며,
상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 상기 제1임계값보다 작고 상기 제2임계값보다 작으면, 상기 충돌 회피 감속 제어를 수행하도록 구성되는 차량 안전주행 제어장치.a sensing unit for detecting surrounding information of the own vehicle;
GPS receiver for receiving GPS information from GPS satellites;
a storage unit storing map information of navigation; and
a control unit communicatively connected to the sensing unit, the GPS receiving unit, and the storage unit;
The control unit is
determining whether or not the own vehicle enters the merging road using the GPS information, the map information of the navigation, the own vehicle information, and the detection result of the sensing unit;
calculating the intersection point of the target car traveling on the main road and the own vehicle based on the turning radius of the own vehicle entering the merging road,
calculating the time it takes for the host vehicle and the target vehicle to reach the intersection point;
and control to perform collision warning or collision avoidance deceleration control according to a time required for the host vehicle and the target vehicle to reach the intersection point,
The control unit is
It is determined whether both the time required for the host vehicle and the target vehicle to reach the intersection point is less than a first threshold value for determining whether a collision is possible within a range and a second threshold value for determining whether to control collision avoidance deceleration do,
If both the time required for the host vehicle and the target vehicle to reach the intersection point is less than the first threshold value and any one is greater than or equal to the second threshold value, the collision warning is performed,
and perform the collision avoidance deceleration control when both the time taken for the host vehicle and the target vehicle to reach the intersection point is less than the first threshold value and less than the second threshold value.
상기 제어부는 상기 자차의 회전 반경에 따른 원의 방정식과 상기 타겟차의 경로에 따른 직선의 방정식의 교차점을 상기 교차 지점으로 연산하도록 구성되는 차량 안전주행 제어장치.According to claim 1,
The control unit is configured to calculate the intersection point of the equation of the circle according to the turning radius of the host vehicle and the equation of the straight line according to the path of the target vehicle as the intersection point.
상기 제어부는,
상기 자차의 조향 각도 또는 요-레이트(yaw-rate)를 기반으로 상기 자차의 회전 반경을 연산하고,
상기 타겟차의 위치 및 속도 벡터를 상기 자차의 좌표계로 변환하며,
상기 자차의 좌표계에서 상기 원의 방정식과 상기 직선의 방정식의 교차점을 연산하도록 구성되는 차량 안전주행 제어장치. 3. The method of claim 2,
The control unit is
Calculate the turning radius of the own vehicle based on the steering angle or yaw-rate of the host vehicle,
Converting the position and velocity vectors of the target car into the coordinate system of the host vehicle,
The apparatus for controlling safe vehicle driving is configured to calculate an intersection point of the equation of the circle and the equation of the straight line in the coordinate system of the host vehicle.
상기 제어부는 상기 타겟차의 종방향 및 횡방향 속도를 이용하여 상기 속도 벡터를 연산하도록 구성되는 차량 안전주행 제어장치.4. The method of claim 3,
The control unit is configured to calculate the speed vector by using the longitudinal and lateral velocities of the target car.
상기 제어부는,
상기 타겟차의 위치에서 상기 교차 지점까지의 거리를 연산한 후 상기 타겟차의 속도 벡터로 나누어 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하고,
상기 자차의 전방 코너에서부터 상기 교차 지점까지의 거리를 연산한 후 상기 자차의 속도로 나누어 상기 자차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하도록 구성되는 차량 안전주행 제어장치.According to claim 1,
The control unit is
After calculating the distance from the position of the target car to the crossing point, dividing by the velocity vector of the target car calculates the time it takes for the target car to reach the crossing point,
The apparatus for controlling safe vehicle driving is configured to calculate a distance from the front corner of the host vehicle to the intersection point and divide by the speed of the host vehicle to calculate a time required for the host vehicle to reach the intersection point.
상기 제어부는 상기 충돌 경고를 시각적으로 또는 청각적으로 수행하기 위해 제어하도록 구성되는 차량 안전주행 제어장치.According to claim 1,
The control unit is configured to control to visually or audibly perform the collision warning.
상기 제어부는 상기 자차의 속도와 조향 각도 및 상기 타겟차의 속도를 기반으로 충돌 회피 감속 제어를 수행하기 위해 안전주행 모듈을 활성화하도록 구성되는 차량 안전주행 제어장치.According to claim 1,
The control unit is configured to activate the safe driving module to perform collision avoidance deceleration control based on the speed and steering angle of the host vehicle and the speed of the target vehicle.
상기 충돌 경고를 시각적으로 나타내는 미러 인디케이터; 또는
상기 충돌 경고를 시각적으로 또는 청각적으로 나타내는 클러스터 중 적어도 하나를 더 포함하는 차량 안전주행 제어장치.According to claim 1,
a mirror indicator visually indicating the collision warning; or
The vehicle safety driving control device further comprising at least one of a cluster visually or audibly indicating the collision warning.
상기 감지부는,
차량 주변의 이미지를 촬영하는 이미지 센서; 및
상기 타겟차의 위치 및 속도를 감지하는 적어도 하나의 레이더(RADAR) 센서를 포함하는 차량 안전주행 제어장치.According to claim 1,
The sensing unit,
an image sensor that captures images around the vehicle; and
A vehicle safe driving control apparatus including at least one radar (RADAR) sensor for detecting the position and speed of the target vehicle.
상기 합류 도로로 진입하는 상기 자차의 회전 반경을 기반으로 본선 도로를 주행하는 타겟차와 상기 자차의 교차 지점을 연산하는 제1연산 단계;
상기 자차 및 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하는 제2연산 단계; 및
상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간에 따라 충돌 경고 또는 충돌 회피 감속 제어를 수행하는 단계를 포함하고,
상기 수행하는 단계는,
상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 충돌 가능 범위 여부를 판단하기 위한 제1임계값과, 충돌 회피 감속 제어 여부를 판단하기 위한 제2임계값보다 작은지의 여부를 결정하는 제2결정 단계;
상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 상기 제1임계값보다 작고, 어느 하나가 상기 제2임계값이상이면, 상기 충돌 경고를 수행하는 경고 단계; 및
상기 자차와 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간 모두가 상기 제1임계값보다 작고 상기 제2임계값보다 작으면, 상기 충돌 회피 감속 제어를 수행하는 회피 제어 단계를 포함하는 차량 안전주행 제어방법.a first determining step of determining whether the own vehicle enters the merging road;
a first calculation step of calculating an intersection point of a target car traveling on a main road and the host vehicle based on a turning radius of the own vehicle entering the merging road;
a second calculation step of calculating a time required for the host vehicle and the target vehicle to reach the intersection point; and
performing a collision warning or collision avoidance deceleration control according to the time required for the host vehicle and the target vehicle to reach the intersection point,
The performing step is,
It is determined whether both the time required for the host vehicle and the target vehicle to reach the intersection point is less than a first threshold value for determining whether a collision is possible within a range and a second threshold value for determining whether to control collision avoidance deceleration a second determining step;
a warning step of performing the collision warning when both the time taken for the host vehicle and the target vehicle to reach the intersection point is less than the first threshold value, and any one is greater than or equal to the second threshold value; and
and an avoidance control step of performing the collision avoidance deceleration control when both the time taken for the host vehicle and the target vehicle to reach the intersection point is less than the first threshold value and less than the second threshold value; control method.
상기 제1결정 단계는 GPS 위성으로부터 수신된 GPS 정보, 내비게이션의 맵 정보, 자차 정보 및 상기 자차의 주위에 대한 감지 결과를 이용하여 합류 도로의 진입여부를 결정하는 차량 안전주행 제어방법.12. The method of claim 11,
The first determining step is a vehicle safe driving control method of determining whether to enter a merging road using GPS information received from a GPS satellite, map information of navigation, own vehicle information, and a detection result of the surroundings of the own vehicle.
상기 제1연산 단계는 상기 자차의 회전 반경에 따른 원의 방정식과 상기 타겟차의 경로에 따른 직선의 방정식의 교차점을 상기 교차 지점으로 연산하는 차량 안전주행 제어방법.12. The method of claim 11,
In the first calculation step, the intersection point of the equation of a circle according to the turning radius of the host vehicle and the equation of a straight line according to the path of the target vehicle is calculated as the intersection point.
상기 제1연산 단계는,
상기 자차의 조향 각도 또는 요-레이트(yaw-rate)를 기반으로 상기 자차의 회전 반경을 연산하고,
상기 타겟차의 위치 및 속도 벡터를 상기 자차의 좌표계로 변환하며,
상기 자차의 좌표계에서 상기 원의 방정식과 상기 직선의 방정식의 교차점을 연산하는 차량 안전주행 제어방법.14. The method of claim 13,
The first operation step is
Calculate the turning radius of the own vehicle based on the steering angle or yaw-rate of the host vehicle,
Converting the position and velocity vectors of the target car into the coordinate system of the host vehicle,
A vehicle safe driving control method for calculating an intersection point of the equation of the circle and the equation of the straight line in the coordinate system of the host vehicle.
상기 제1연산 단계는 상기 타겟차의 종방향 및 횡방향 속도를 이용하여 상기 속도 벡터를 연산하는 차량 안전주행 제어방법.15. The method of claim 14,
The first calculation step is a vehicle safe driving control method of calculating the speed vector by using the longitudinal and lateral speeds of the target car.
상기 제2연산 단계는,
상기 타겟차의 위치에서 상기 교차 지점까지의 거리를 연산한 후 상기 타겟차의 속도 벡터로 나누어 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하고,
상기 자차의 전방 코너에서부터 상기 교차 지점까지의 거리를 연산한 후 상기 자차의 속도로 나누어 상기 자차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하는 차량 안전주행 제어방법.12. The method of claim 11,
The second operation step is
After calculating the distance from the position of the target car to the crossing point, dividing by the velocity vector of the target car calculates the time it takes for the target car to reach the crossing point,
A vehicle safe driving control method for calculating a time required for the host vehicle to reach the intersection by calculating the distance from the front corner of the own vehicle to the intersection point and dividing by the speed of the host vehicle.
상기 경고 단계는 시각적으로 또는 청각적으로 경고를 수행하는 차량 안전주행 제어방법.12. The method of claim 11,
The warning step is a vehicle safe driving control method for performing a warning visually or audibly.
상기 회피 제어 단계는 상기 자차의 속도와 조향 각도 및 상기 타겟차의 속도를 기반으로 충돌 회피 감속 제어를 수행하도록 안전주행 모듈을 활성화하는 차량 안전주행 제어방법.12. The method of claim 11,
The avoidance control step includes activating a safe driving module to perform collision avoidance deceleration control based on the speed and steering angle of the host vehicle and the speed of the target vehicle.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020190165514A KR102303648B1 (en) | 2019-12-12 | 2019-12-12 | Apparatus for controlling safety driving of vehicle and method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020190165514A KR102303648B1 (en) | 2019-12-12 | 2019-12-12 | Apparatus for controlling safety driving of vehicle and method thereof |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20210075253A KR20210075253A (en) | 2021-06-23 |
KR102303648B1 true KR102303648B1 (en) | 2021-09-24 |
Family
ID=76599188
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020190165514A Active KR102303648B1 (en) | 2019-12-12 | 2019-12-12 | Apparatus for controlling safety driving of vehicle and method thereof |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102303648B1 (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2023150247A (en) | 2022-03-31 | 2023-10-16 | 東洋鋼鈑株式会社 | alloy electrolytic foil |
CN115179945A (en) * | 2022-06-23 | 2022-10-14 | 北京主线科技有限公司 | A vehicle control method and device |
KR102735697B1 (en) * | 2022-12-20 | 2024-11-28 | 주식회사 현대케피코 | Vehicle control apparatus and method |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004508627A (en) | 2000-09-08 | 2004-03-18 | レイセオン・カンパニー | Route prediction system and method |
JP2015138528A (en) | 2014-01-24 | 2015-07-30 | トヨタ自動車株式会社 | Drive support device |
JP2017091502A (en) * | 2015-11-11 | 2017-05-25 | 株式会社デンソー | Drive support device |
WO2017159493A1 (en) * | 2016-03-15 | 2017-09-21 | 本田技研工業株式会社 | Vehicle control system, vehicle control method, and vehicle control program |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20070101561A (en) | 2006-04-11 | 2007-10-17 | 주식회사 현대오토넷 | How to detect road junctions in navigation |
KR102715505B1 (en) * | 2017-01-19 | 2024-10-10 | 주식회사 에이치엘클레무브 | A camera system for ADAS and driving Assistance System by using the same |
-
2019
- 2019-12-12 KR KR1020190165514A patent/KR102303648B1/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004508627A (en) | 2000-09-08 | 2004-03-18 | レイセオン・カンパニー | Route prediction system and method |
JP2015138528A (en) | 2014-01-24 | 2015-07-30 | トヨタ自動車株式会社 | Drive support device |
JP2017091502A (en) * | 2015-11-11 | 2017-05-25 | 株式会社デンソー | Drive support device |
WO2017159493A1 (en) * | 2016-03-15 | 2017-09-21 | 本田技研工業株式会社 | Vehicle control system, vehicle control method, and vehicle control program |
Also Published As
Publication number | Publication date |
---|---|
KR20210075253A (en) | 2021-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9963149B2 (en) | Vehicle control device | |
US9809223B2 (en) | Driving assistant for vehicles | |
US9902399B2 (en) | Vehicle travelling control device for controlling a vehicle in traffic | |
US9902398B2 (en) | Driving control device | |
US9714034B2 (en) | Vehicle control device | |
US9896129B2 (en) | Driving assistant system of vehicle and method for controlling the same | |
JP5952862B2 (en) | Vehicle driving support device | |
KR102005253B1 (en) | Lane assistance system responsive to extremely fast approaching vehicles | |
JP6323385B2 (en) | Vehicle travel control device | |
JP6369390B2 (en) | Lane junction determination device | |
US20190073540A1 (en) | Vehicle control device, vehicle control method, and storage medium | |
JP6269606B2 (en) | Vehicle control device | |
JP7087623B2 (en) | Vehicle control unit | |
KR101511858B1 (en) | Advanced Driver Assistance System(ADAS) and controlling method for the same | |
EP3715204A1 (en) | Vehicle control device | |
US9896098B2 (en) | Vehicle travel control device | |
JP6348785B2 (en) | Vehicle driving support device | |
US20140288816A1 (en) | Driving support apparatus and driving support method | |
US20170080941A1 (en) | Vehicle speed control device | |
JP2016132374A (en) | Collision avoidance control device | |
KR101984520B1 (en) | Apparatus and method for preventing vehicle collision | |
KR102303648B1 (en) | Apparatus for controlling safety driving of vehicle and method thereof | |
KR101545054B1 (en) | Driver assistance systems and controlling method for the same | |
US20200384992A1 (en) | Vehicle control apparatus, vehicle, operation method of vehicle control apparatus, and non-transitory computer-readable storage medium | |
JP2019156297A (en) | Travel support system and control method of vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PA0109 | Patent application |
Patent event code: PA01091R01D Comment text: Patent Application Patent event date: 20191212 |
|
PA0201 | Request for examination | ||
PE0902 | Notice of grounds for rejection |
Comment text: Notification of reason for refusal Patent event date: 20210223 Patent event code: PE09021S01D |
|
PG1501 | Laying open of application | ||
E701 | Decision to grant or registration of patent right | ||
PE0701 | Decision of registration |
Patent event code: PE07011S01D Comment text: Decision to Grant Registration Patent event date: 20210813 |
|
GRNT | Written decision to grant | ||
PR0701 | Registration of establishment |
Comment text: Registration of Establishment Patent event date: 20210913 Patent event code: PR07011E01D |
|
PR1002 | Payment of registration fee |
Payment date: 20210914 End annual number: 3 Start annual number: 1 |
|
PG1601 | Publication of registration | ||
PR1001 | Payment of annual fee |
Payment date: 20240624 Start annual number: 4 End annual number: 4 |
|
PR1001 | Payment of annual fee |
Payment date: 20250623 Start annual number: 5 End annual number: 5 |