[go: up one dir, main page]

KR102303648B1 - Apparatus for controlling safety driving of vehicle and method thereof - Google Patents

Apparatus for controlling safety driving of vehicle and method thereof Download PDF

Info

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
Application number
KR1020190165514A
Other languages
Korean (ko)
Other versions
KR20210075253A (en
Inventor
김재석
김해준
Original Assignee
주식회사 만도
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 주식회사 만도 filed Critical 주식회사 만도
Priority to KR1020190165514A priority Critical patent/KR102303648B1/en
Publication of KR20210075253A publication Critical patent/KR20210075253A/en
Application granted granted Critical
Publication of KR102303648B1 publication Critical patent/KR102303648B1/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/20Conjoint control of vehicle sub-units of different type or different function including control of steering systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/18154Approaching an intersection
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/02Estimation 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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/105Speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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/114Yaw movement
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • B60W2050/143Alarm means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • B60W2050/146Display means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/408Radar; Laser, e.g. lidar
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to overall vehicle dynamics
    • B60W2520/14Yaw
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to occupants
    • B60W2540/18Steering angle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Output or target parameters relating to overall vehicle dynamics
    • B60W2720/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2300/00Purposes or special features of road vehicle drive control systems
    • B60Y2300/08Predicting or avoiding probable or impending collision
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2300/00Purposes or special features of road vehicle drive control systems
    • B60Y2300/18Propelling the vehicle
    • B60Y2300/18008Propelling the vehicle related to particular drive situations
    • B60Y2300/18158Approaching 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

차량 안전주행 제어장치 및 그 방법{Apparatus for controlling safety driving of vehicle and method thereof} Apparatus for controlling safety driving of vehicle and method thereof

본 발명은 차량 안전주행 제어장치 및 그 방법에 관한 것이다. 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.

KRUS 2007-01015612007-0101561 AA

상기와 같은 종래 기술의 문제점을 해결하기 위해, 본 발명의 일 실시예는 합류 도로에서 본선 도로 진입시 후측방 경고 기능은 유지하면서 전측방에 대한 충돌 판단 및 제어 기능을 부가하여 안전운전을 지원할 수 있는 차량 안전주행 제어장치 및 그 방법을 제공하는 데 그 목적이 있다. 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 own vehicle 10 enters the main road 1 from the merging road 2 , the driving speed is determined in consideration of whether or not it collides with the target car 11 traveling on the main road 1 . have to slow down Here, the main road 1 is mainly a straight road and means a main road. The merging road 2 means a connecting road for entering the main road 1 . In addition, the merging road 2 may include a straight road as well as a curved road.

이때, 자차(10)은 먼저, 합류 도로(2)에서 본선 도로(1)로의 진입 상황을 판단하고, 본선 도로(1)에서 주행중인 타겟차(11)가 합류 도로(2) 부근에서 자차(10)와의 충돌 가능성을 예측해야 한다. At this time, the own vehicle 10 first determines the state of entry into the main road 1 from the merging road 2, and the target car 11 driving on the main road 1 is located near the merging road 2 ( 10) to predict the possibility of collision with

이를 위해, 본 발명은 합류 도로(2)에서 본선 도로(1)로 진입하는 상황을 판단하고, 이 경우 한시적으로 후측방 경고 기능은 유지하면서 전측방 충돌 판단 및 제어 기능을 부가함으로 할 수 있다. To this end, the present invention determines the situation of entering the main road 1 from the merging road 2, and in this case, it is possible to temporarily add a front-side collision determination and control function while maintaining the rear-side warning function.

이에 의해, 본 발명은 운전자의 부주의나 합류 도로 주행이 미숙한 경우에도 충돌 경고 또는 충돌 회피 제어에 의해 안전운전을 지원할 수 있음으로 운전자의 편의성을 향상시킬 수 있다. 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 driving control device 100 includes a sensing unit 110 , a GPS receiving unit 120 , a control unit 130 , a storage unit 140 , a mirror indicator 150 , a cluster 160 , and a safety device. It may include a driving module 170 .

감지부(110)는 자차(10)의 주위 정보를 감지할 수 있다. 감지부(110)는 레이더 센서(112) 및 이미지 센서(114)를 포함할 수 있다.The sensing unit 110 may sense surrounding information of the own vehicle 10 . The detector 110 may include a radar sensor 112 and an image sensor 114 .

레이더 센서(112)는 자차(10)의 전방, 측방 또는 후방에 복수로 구비될 수 있다. 여기서, 레이더 센서(112)는 타겟차(11)의 위치 및 속도를 감지할 수 있다. 이때, 레이더 센서(112)는 종방향과 횡방향을 구분하여 위치 및 속도를 감지할 수 있다.A plurality of radar sensors 112 may be provided at the front, side, or rear of the own vehicle 10 . Here, the radar sensor 112 may detect the position and speed of the target car 11 . In this case, the radar sensor 112 may detect the position and speed by dividing the longitudinal direction and the lateral direction.

이미지 센서(114)는 자차(10) 주변의 이미지를 획득한다. 이미지 센서(114)는 카메라 센서 또는 라이다(Lidar) 센서 중 적어도 하나를 포함할 수 있다. 또한, 이미지 센서(114)는 자차(10)의 전방, 측방 또는 후방에 복수로 구비될 수 있다. 여기서, 이미지 센서(114)는 본선 도로(1)에서 주행하는 타겟차(11) 또는 합류 도로(2) 상의 차선(2')의 이미지를 획득할 수 있다. The image sensor 114 acquires an image around the own vehicle 10 . The image sensor 114 may include at least one of a camera sensor and a lidar sensor. In addition, a plurality of image sensors 114 may be provided at the front, side, or rear of the host vehicle 10 . Here, the image sensor 114 may acquire an image of the target car 11 traveling on the main road 1 or the lane 2 ′ on the merging road 2 .

GPS 수신부(120)는 GPS 위성으로부터 GPS 정보를 수신할 수 있다. 여기서, GPS 정보는 자차(10)의 현재 위치에 따른 지형 및 도로 정보를 포함할 수 있다. 또한, GPS 수신부(120)는 수신된 GPS 정보를 저장부(140)에 저장할 수 있다. The GPS receiver 120 may receive GPS information from a GPS satellite. Here, the GPS information may include terrain and road information according to the current location of the host vehicle 10 . Also, the GPS receiver 120 may store the received GPS information in the storage 140 .

저장부(140)는 내비게이션의 맵 정보가 저장될 수 있다. 또한, 저장부(140)는 GPS 수신부(120)로부터 수신된 GPS 정보가 저장될 수 있다.The storage unit 140 may store navigation map information. Also, the storage unit 140 may store GPS information received from the GPS receiver 120 .

미러 인디케이터(150)는 제어부(130)의 제어에 따라 충돌 경고를 시각적으로 나타낼 수 있다. 또한, 미러 인디케이터(150)는 자차(10) 외부의 사이드 밀러에 구비될 수 있다. 이때, 미러 인디케이터(150)는 LED 등과 같은 점멸 수단에 의해 깜박임으로 사용자가 인지할 수 있도록 충돌 경고를 시각적으로 나타낼 수 있다. The mirror indicator 150 may visually indicate a collision warning under the control of the controller 130 . Also, the mirror indicator 150 may be provided on a side mirror outside the host vehicle 10 . In this case, the mirror indicator 150 may visually indicate a collision warning so that the user can recognize it by blinking by a flashing means such as an LED.

클러스터(160)는 제어부(130)의 제어에 따라 충돌 경고를 시각적으로 또는 청각적으로 나타낼 수 있다. 또한, 클러스터(160)는 자차(10) 내부에서 사용자가 인지할 수 있도록 충돌 경고를 수행하도록 구성될 수 있다. 이때, 시각적 충돌 경고는 LED 등과 같은 점멸 수단에 의해 깜박임으로 수행될 수 있다. 또한, 청각적 충돌 경고는 오디오 기기의 스피커에 의해 음성 또는 음향으로 수행될 수 있다.The cluster 160 may visually or audibly display a collision warning under the control of the controller 130 . In addition, the cluster 160 may be configured to perform a collision warning so that the user can recognize it inside the own vehicle 10 . In this case, the visual collision warning may be performed by blinking by a blinking means such as an LED. In addition, the auditory collision warning may be performed by voice or sound by a speaker of the audio device.

안전주행 모듈(170)은 자차(10)의 안전주행을 제어하기 위한 모듈일 수 있다. 안전주행 모듈(170)은 자차(10)의 엔진 및 조향장치를 제어할 수 있다. 이때, 안전주행 모듈(170)은 자차(10)의 속도와 조향 각도 및 타겟차(11)의 속도를 기반으로 자차(10)을 감속 제어하도록 구성될 수 있다.The safe driving module 170 may be a module for controlling safe driving of the own vehicle 10 . The safe driving module 170 may control an engine and a steering device of the own vehicle 10 . In this case, the safe driving module 170 may be configured to control the deceleration of the own vehicle 10 based on the speed and the steering angle of the own vehicle 10 and the speed of the target vehicle 11 .

제어부(130)는 감지부(110), GPS 수신부(120), 저장부(140), 미러 인디케이터(150), 클러스터(160) 및 안전주행 모듈(170)에 통신적으로 연결될 수 있다. 여기서, 제어부(130)는 자차(10)의 ECU일 수 있다. 선택적으로, 제어부(130)는 자차(10)의 안전주행 제어를 위해 별도로 구비된 컨트롤러일 수도 있다. The control unit 130 may be communicatively connected to the sensing unit 110 , the GPS receiving unit 120 , the storage unit 140 , the mirror indicator 150 , the cluster 160 , and the safe driving module 170 . Here, the controller 130 may be the ECU of the own vehicle 10 . Optionally, the controller 130 may be a controller separately provided for safe driving control of the host vehicle 10 .

또한, 제어부(130)는 GPS 수신부(120)로부터 수신된 GPS 정보, 저장부(140)에 저장된 내비게이션의 맵 정보, 자차 정보 및 감지부(110)의 감지 결과를 이용하여 자차가 합류 도로(2)로 진입하는지의 여부를 결정하도록 구성될 수 있다. 이때, 감지부(110)의 감지결과는 전방 이미지 센서(114)를 통한 차량 주변의 영상 정보로서, 합류 도로(2)의 주변 차선(2') 정보일 수 있다. 즉, 제어부(130)는 차선(2')의 형상을 인식하여 곡선의 합류 도로(2)임을 인식하도록 구성될 수 있다.In addition, the control unit 130 uses the GPS information received from the GPS receiver 120 , the map information of the navigation stored in the storage unit 140 , the own vehicle information, and the detection result of the sensing unit 110 , ) can be configured to determine whether to enter. In this case, the detection result of the sensing unit 110 is image information around the vehicle through the front image sensor 114 , and may be information on the surrounding lane 2 ′ of the merging road 2 . That is, the controller 130 may be configured to recognize the shape of the lane 2 ′ and recognize that it is the merging road 2 of the curve.

또한, 제어부(130)는 합류 도로(2)로 판단한 경우, 합류 도로(2)로 진입하는 자차(10)의 회전 반경(R)을 기반으로 본선 도로(1)를 주행하는 타겟차(11)와 자차(10)의 교차 지점(CP)을 연산하도록 구성될 수 있다. In addition, when it is determined that the controller 130 is the merging road 2 , the target car 11 driving the main road 1 based on the turning radius R of the own vehicle 10 entering the merging road 2 ) and may be configured to calculate the intersection point CP of the host vehicle 10 .

도 3을 참조하면, 자차(10)와 타겟차(11)의 교차 지점은 본선 도로(1)를 직선으로 주행중인 타겟차(11)의 직선 방향과 곡선의 합류 도로(2)로 진입한 자차(10)의 회전 방향의 교차점으로 나타낼 수 있다. 따라서 제어부(130)는 자차(10)의 회전 반경(R)에 따른 원(C)의 방정식과 타겟차(11)의 경로에 따른 직선(L)의 방정식의 교차점을 교차 지점(CP)으로 연산하도록 구성될 수 있다. Referring to FIG. 3 , the intersection point of the own vehicle 10 and the target vehicle 11 is the own vehicle entering into the merging road 2 of the straight direction and the curved line of the target vehicle 11 driving the main road 1 in a straight line. (10) can be expressed as the intersection of the rotation directions. Therefore, the control unit 130 calculates the intersection point of the equation of the circle C according to the turning radius R of the host vehicle 10 and the equation of the straight line L according to the path of the target vehicle 11 as the intersection point CP. can be configured to

이때, 제어부(130)는 자차(10)의 조향 각도 또는 요-레이트(yaw-rate)를 기반으로 자차(10)의 회전 반경(R)을 연산하도록 구성될 수 있다.In this case, the controller 130 may be configured to calculate the turning radius R of the host vehicle 10 based on the steering angle or yaw-rate of the host vehicle 10 .

또한, 제어부(130)는 레이더 센서(112)를 통하여 수신된 타겟차(11)의 종방향 속도(Vx) 및 횡방향 속도(Vy)를 이용하여 속도 벡터(V)를 연산하도록 구성될 수 있다. 도 1을 참조하면, 속도 벡터(V)는 종방향 속도(Vx)와 횡방향 속도(Vy)의 합성 값일 수 있다.In addition, the controller 130 may be configured to calculate the velocity vector V using the longitudinal velocity Vx and the lateral velocity Vy of the target vehicle 11 received through the radar sensor 112 . . Referring to FIG. 1 , the velocity vector V may be a composite value of a longitudinal velocity Vx and a lateral velocity Vy.

이때, 제어부(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 controller 130 may be configured to convert the position and velocity vectors V of the target car 11 into the coordinate system of the host vehicle 10 . Therefore, the control unit 130 may be configured to calculate the intersection point of the equation of the circle (C) and the equation of the straight line (L) in the own vehicle coordinate system. Here, the equation of the circle C may be considered as a circle having a radius R based on the front corner of the host vehicle 10 in a direction close to the target car 11 . For example, in the case of a Left Hand Drive (LHD) system, the left front corner of the own vehicle 10 may be the reference, and in the case of the Right Hand Drive (RHD) system, the right front corner of the own vehicle 10 may be the reference. In addition, when the root of the quadratic equation is calculated by synthesizing the equation of the straight line L and the equation of the circle C, the intersection point CP may be calculated.

도 4를 참조하면, 합류 도로(2)가 직선인 경우, 회전 반경(R)은 무한대로 수렴한다. 따라서 원(C)의 방정식은 직선(C1)의 방정식으로 간주될 수 있다. 이 경우, 두 직선(L, C1)의 방정식을 연립하여 1차 방정식의 근이 연산됨으로써 교차 지점(CP)이 연산될 수 있다.Referring to FIG. 4 , when the merging road 2 is a straight line, the turning radius R converges to infinity. Therefore, the equation of the circle C can be regarded as the equation of the straight line C1. In this case, the intersection point CP may be calculated by calculating the root of the linear equation by synthesizing the equations of the two straight lines L and C1.

또한, 제어부(130)는 자차(10) 및 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간을 연산하도록 구성될 수 있다. 여기서, 교차 지점(CP)에 도달하는데 소요되는 시간은 충돌 예상 시간(TTC; Time To Collision)으로 나타낼 수 있다. In addition, the control unit 130 may be configured to calculate a time required for the host vehicle 10 and the target vehicle 11 to reach the intersection point CP. Here, the time required to reach the intersection point CP may be expressed as a time to collision (TTC).

이때, 제어부(130)는 전방/후측방 레이더 센서(112) 또는 측방 이미지 센서(114)로부터 감지된 타겟차(11)의 위치에서 교차 지점(CP)까지의 거리를 연산하도록 구성될 수 있다. 다음, 제어부(130)는 교차 지점(CP)까지의 거리를 타겟차(11)의 속도 벡터(V)로 나누어 타겟차(11)의 충돌 예상 시간(TTC1)을 연산하도록 구성될 수 있다.In this case, the control unit 130 may be configured to calculate a distance from the position of the target car 11 detected by the front/rear side radar sensor 112 or the side image sensor 114 to the intersection point CP. Next, the controller 130 may be configured to calculate the expected collision time TTC1 of the target car 11 by dividing the distance to the intersection point CP by the velocity vector V of the target car 11 .

또한, 제어부(130)는 자차(10)의 전방 코너에서부터 교차 지점(CP)까지의 거리를 연산하도록 구성될 수 있다. 일례로, 자차(10)의 좌측 전방 코너에서부터 교차 지점(CP)까지의 거리가 연산될 수 있다. 다음, 제어부(130)는 교차 지점(CP)까지의 거리를 자차(10)의 속도로 나누어 자차(10)의 충돌 예상 시간(TTC2)을 연산하도록 구성될 수 있다.Also, the controller 130 may be configured to calculate a distance from the front corner of the host vehicle 10 to the intersection point CP. For example, the distance from the left front corner of the host vehicle 10 to the intersection point CP may be calculated. Next, the controller 130 may be configured to calculate the expected collision time TTC2 of the host vehicle 10 by dividing the distance to the intersection point CP by the speed of the host vehicle 10 .

또한, 제어부(130)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2)에 따라 충돌 경고 또는 충돌 회피 감속 제어를 수행하기 위해 제어하도록 구성될 수 있다. 즉, 자차(10)와 타겟차(11)의 위치에 따른 교차 지점(CP)에 도달하는 시간에 따라 충돌 경고 또는 충돌 회피 감속 제어가 구분되어 수행될 수 있다.In addition, the controller 130 may be configured to control to perform a collision warning or collision avoidance deceleration control according to the expected collision time TTC1 of the target car 11 and the expected collision time TTC2 of the host vehicle 10 . . That is, the collision warning or collision avoidance deceleration control may be separately performed according to the time to reach the intersection point CP according to the positions of the host vehicle 10 and the target vehicle 11 .

일례로, 제어부(130)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제1임계값(Th1)보다 작은지의 여부를 결정하도록 구성될 수 있다. 여기서, 제1임계값(Th1)은 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간에 따른 충돌 가능 범위 여부를 판단하기 위한 기준 시간이다. For example, the controller 130 may be configured to determine whether both the expected collision time TTC1 of the target car 11 and the expected collision time TTC2 of the host vehicle 10 are less than the first threshold value Th1. can Here, the first threshold value Th1 is a reference time for determining whether a collision is possible according to a time required for the host vehicle 10 and the target vehicle 11 to reach the intersection point CP.

또한, 제어부(130)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제2임계값(Th2)보다 작은지의 여부를 결정하도록 구성될 수 있다. 여기서, 제2임계값(Th2)은 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간에 따른 충돌 회피 감속 제어 여부를 판단하기 위한 기준 시간으로서, 운전자가 예상되는 충돌에 대처하는데 소요되는 시간을 기반으로 설정될 수 있다. In addition, the control unit 130 may be configured to determine whether both the expected collision time TTC1 of the target car 11 and the expected collision time TTC2 of the host vehicle 10 are less than the second threshold value Th2. have. Here, the second threshold value Th2 is a reference time for determining whether to control the collision avoidance deceleration according to the time required for the host vehicle 10 and the target vehicle 11 to arrive at the intersection point CP. It can be set based on the time it takes to deal with a conflict.

이때, 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제1임계값보다 작고, 어느 하나가 제2임계값(Th2)이상이면, 제어부(130)는 충돌 경고를 수행하도록 구성될 수 있다. 즉, 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간 중 어느 하나가 운전자에 의해 예상되는 충돌에 대처하기에 충분한 시간인 경우, 운전자가 주의를 갖도록 충돌 경고가 수행될 수 있다.At this time, if both the expected collision time TTC1 of the target car 11 and the expected collision time TTC2 of the host vehicle 10 are smaller than the first threshold value, and any one is greater than or equal to the second threshold value Th2, the control unit ( 130) may be configured to perform a collision warning. That is, when any one of the time required for the host vehicle 10 and the target vehicle 11 to reach the intersection point CP is sufficient time to cope with a collision expected by the driver, a collision warning so that the driver pays attention can be performed.

일례로, 제어부(130)는 충돌 경고를 시각적으로 또는 청각적으로 수행하기 위해 제어하도록 구성될 수 있다. 여기서, 충돌 경고는 미러 인디케이터(150) 또는 클러스터(160)를 통하여 수행될 수 있다.As an example, the control unit 130 may be configured to control the collision warning to be performed visually or audibly. Here, the collision warning may be performed through the mirror indicator 150 or the cluster 160 .

이에 의해, 차량 안전주행 제어장치(100)는 운전자가 본선 도로의 진입시 예상되는 충돌을 인식하게 할 수 있으므로 운전자의 편의성을 향상시키고 주행 안전성을 도모할 수 있다. Accordingly, the vehicle safe driving control apparatus 100 may allow the driver to recognize an expected collision when entering the main road, thereby improving the driver's convenience and promoting driving safety.

반면, 타겟차(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 target car 11 and the expected collision time TTC2 of the host vehicle 10 are less than the first threshold value Th1 and less than the second threshold value Th2, the control unit ( 130) may be configured to perform collision avoidance deceleration control. That is, when both the time required for the host vehicle 10 and the target vehicle 11 to reach the intersection point CP is not sufficient time to cope with the collision expected by the driver, the deceleration control is performed to avoid the collision. can be performed.

이때, 제어부(130)는 자차(10)의 속도와 조향 각도 및 타겟차(11)의 속도를 기반으로 충돌 회피 감속 제어를 수행하도록 구성될 수 있다. 여기서, 제어부(130)는 안전주행 모듈(170)을 활성화하도록 구성될 수 있다.In this case, the controller 130 may be configured to perform collision avoidance deceleration control based on the speed and steering angle of the host vehicle 10 and the speed of the target vehicle 11 . Here, the control unit 130 may be configured to activate the safe driving module 170 .

이에 의해, 차량 안전주행 제어장치(100)는 본선 도로에 주행중인 타겟차와의 충돌을 자동으로 신속하게 회피할 수 있으므로 안전운전을 더 효과적으로 지원할 수 있다. Accordingly, the vehicle safe driving control apparatus 100 can automatically and quickly avoid a collision with a target car driving on the main road, and thus can more effectively support safe driving.

이하, 도 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 driving control method 200 includes the steps of determining whether to enter the merging road (S210), calculating the intersection of the target car and the host vehicle (S220), calculating the time required to reach the intersection (S210) S230 and S240), and performing collision warning or collision avoidance deceleration control according to the time required to reach the intersection (SS250 to S280).

보다 상세히 설명하면, 도 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 host vehicle 10 enters the merging road 2 (step S210 ). At this time, the vehicle safe driving control device 100 uses the GPS information received from the GPS satellite, the map information of the navigation, the own vehicle information, and the detection result of the own vehicle 10 around the own vehicle 10 merging road (2) You can decide whether to enter or not.

여기서, 상기 감지 결과는 전방 이미지 센서(114)를 통한 차량 주변의 영상 정보로서, 합류 도로(2)의 주변 차선(2') 정보일 수 있다. 즉, 차량 안전주행 제어장치(100)는 차선(2')의 형상을 인식하여 곡선의 합류 도로(2)임을 인식할 수 있다.Here, the detection result is image information around the vehicle through the front image sensor 114 , and may be information on the surrounding lane 2 ′ of the merging road 2 . That is, the apparatus 100 for controlling safe vehicle driving may recognize the shape of the lane 2 ′ to recognize that it is the merging road 2 of the curve.

단계 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 road 2 , the vehicle safe driving control apparatus 100 continuously monitors whether or not the merging road 2 is entered. In addition, when entering the merging road 2 , the vehicle safe driving control apparatus 100 calculates the intersection point CP of the host vehicle 10 and the target vehicle 11 (step S220 ). At this time, the vehicle safe driving control device 100 calculates the intersection point CP of the target car 11 and the own vehicle 10 traveling on the main road 1 based on the turning radius R of the own vehicle 10 . can do.

보다 구체적으로, 차량 안전주행 제어장치(100)는 자차(10)의 회전 반경(R)에 따른 원(C)의 방정식과 타겟차(11)의 경로에 따른 직선(L)의 방정식의 교차점을 교차 지점(CP)으로 연산할 수 있다.More specifically, the vehicle safe driving control device 100 determines the intersection of the equation of the circle C according to the turning radius R of the host vehicle 10 and the equation of the straight line L according to the path of the target vehicle 11 . It can be calculated as the intersection point (CP).

이때, 차량 안전주행 제어장치(100)는 자차(10)의 조향 각도 또는 요-레이트(yaw-rate)를 기반으로 자차(10)의 회전 반경(R)을 연산할 수 있다.In this case, the apparatus 100 for controlling safe vehicle driving may calculate the turning radius R of the own vehicle 10 based on the steering angle or yaw-rate of the own vehicle 10 .

또한, 차량 안전주행 제어장치(100)는 레이더 센서(112)를 통하여 수신된 타겟차(11)의 종방향 속도(Vx) 및 횡방향 속도(Vy)를 이용하여 속도 벡터(V)를 연산할 수 있다. 여기서, 속도 벡터(V)는 종방향 속도(Vx)와 횡방향 속도(Vy)의 합성 값일 수 있다.In addition, the vehicle safe driving control apparatus 100 calculates the velocity vector (V) using the longitudinal velocity (Vx) and the lateral velocity (Vy) of the target car 11 received through the radar sensor 112 . can Here, the velocity vector V may be a composite value of the longitudinal velocity Vx and the lateral velocity Vy.

또한, 차량 안전주행 제어장치(100)는 타겟차(11)의 위치 및 속도 벡터(V)를 자차(10)의 좌표계로 변환할 수 있다. 이에 의해, 차량 안전주행 제어장치(100)는 자차(10)의 좌표계에서 원(C)의 방정식과 직선(L)의 방정식의 교차점을 연산할 수 있다. 여기서, 원(C)의 방정식은 타겟차(11)와 가까운 방향의 자차(10)의 전방 코너를 기준으로 반지름 R인 원으로 고려될 수 있다. LHD 시스템인지 RHD 시스템인지에 따라 자차(10)의 좌측 전방 코너 또는 우측 전방 코너가 기준이 될 수 있다. 또한, 차량 안전주행 제어장치(100)는 직선(L)의 방정식과 원(C)의 방정식을 연립하여 이차방정식의 근을 연산함으로써, 교차 지점(CP)을 연산할 수 있다.Also, the apparatus 100 for controlling safe vehicle driving may convert the position and velocity vectors V of the target vehicle 11 into the coordinate system of the host vehicle 10 . Accordingly, the vehicle safe driving control apparatus 100 may calculate the intersection point of the equation of the circle C and the equation of the straight line L in the coordinate system of the host vehicle 10 . Here, the equation of the circle C may be considered as a circle having a radius R based on the front corner of the host vehicle 10 in a direction close to the target car 11 . A left front corner or a right front corner of the host vehicle 10 may be a reference depending on whether the LHD system or the RHD system is used. Also, the apparatus 100 for controlling safe vehicle driving may calculate the intersection point CP by calculating the root of the quadratic equation by synthesizing the equation of the straight line L and the equation of the circle C.

한편, 합류 도로(2)가 직선인 경우, 차량 안전주행 제어장치(100)는 두 직선(L, C1)의 방정식을 연립하여 1차 방정식의 근을 연산함으로써 교차 지점(CP)을 연산할 수 있다.On the other hand, when the merging road 2 is a straight line, the vehicle safe driving control device 100 calculates the intersection point CP by synthesizing the equations of the two straight lines L and C1 and calculating the root of the first equation. have.

다음으로, 차량 안전주행 제어장치(100)는 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간을 연산한다(단계 S230). 여기서, 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간은 충돌 예상 시간(TTC1)으로 나타낼 수 있다. Next, the vehicle safe driving control apparatus 100 calculates a time required for the target car 11 to reach the intersection CP (step S230). Here, the time required for the target car 11 to reach the intersection point CP may be expressed as the expected collision time TTC1.

이때, 차량 안전주행 제어장치(100)는 전방/후측방 레이더 센서(112) 또는 측방 이미지 센서(114)로부터 감지된 타겟차(11)의 위치에서 교차 지점(CP)까지의 거리를 연산한 후, 교차 지점(CP)까지의 거리를 타겟차(11)의 속도 벡터(V)로 나눔으로써 타겟차(11)의 충돌 예상 시간(TTC1)을 연산할 수 있다.At this time, the vehicle safe driving control device 100 calculates the distance from the position of the target car 11 detected by the front/rear side radar sensor 112 or the side image sensor 114 to the intersection point CP. , by dividing the distance to the intersection point CP by the velocity vector V of the target car 11 , it is possible to calculate the expected collision time TTC1 of the target car 11 .

다음으로, 차량 안전주행 제어장치(100)는 자차(10)가 교차 지점(CP)에 도달하는데 소요되는 시간을 연산한다(단계 S240). 여기서, 자차(10)가 교차 지점(CP)에 도달하는데 소요되는 시간은 충돌 예상 시간(TTC2)으로 나타낼 수 있다. Next, the device for controlling safe vehicle driving 100 calculates the time required for the host vehicle 10 to reach the intersection CP (step S240). Here, the time required for the host vehicle 10 to arrive at the intersection point CP may be expressed as the expected collision time TTC2.

이때, 차량 안전주행 제어장치(100)는 자차(10)의 전방 코너(일례로, 좌측 전방 코너)에서부터 교차 지점(CP)까지의 거리를 연산한 후, 교차 지점(CP)까지의 거리를 자차(10)의 속도로 나눔으로써 자차(10)의 충돌 예상 시간(TTC2)을 연산할 수 있다.At this time, the vehicle safe driving control device 100 calculates the distance from the front corner (eg, left front corner) of the own vehicle 10 to the intersection point CP, and then calculates the distance to the intersection point CP of the own vehicle. By dividing by the speed of (10), it is possible to calculate the expected collision time TTC2 of the host vehicle 10 .

다음으로, 차량 안전주행 제어장치(100)는 타겟차(11)의 충돌 예상 시간(TTC1)과 자차(10)의 충돌 예상 시간(TTC2) 모두가 제1임계값(Th1)보다 작은지의 여부를 결정한다(단계 S250). 여기서, 제1임계값(Th1)은 자차(10)와 타겟차(11)가 교차 지점(CP)에 도달하는데 소요되는 시간에 따른 충돌 가능 범위 여부를 판단하기 위한 기준 시간이다. Next, the vehicle safe driving control apparatus 100 determines whether both the expected collision time TTC1 of the target car 11 and the expected collision time TTC2 of the host vehicle 10 are less than the first threshold value Th1 A decision is made (step S250). Here, the first threshold value Th1 is a reference time for determining whether a collision is possible according to a time required for the host vehicle 10 and the target vehicle 11 to reach the intersection point CP.

단계 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 target car 11 and the expected collision time TTC2 of the host vehicle 10 is equal to or greater than the first threshold value Th1, the vehicle safe driving control device ( 100) may proceed to step S210 to determine whether to enter another merging road.

단계 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 target car 11 and the expected collision time TTC2 of the host vehicle 10 are less than the first threshold value Th1, the vehicle safe driving control device 100 ) determines whether both the expected collision time TTC1 of the target car 11 and the expected collision time TTC2 of the host vehicle 10 are less than a second threshold value Th2 (step S260). Here, the second threshold value Th2 is a reference time for determining whether a collision warning is generated according to the time required for the host vehicle 10 and the target vehicle 11 to reach the intersection point CP, and the driver expects a collision It can be set based on the time it takes to respond.

또한, 단계 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 target car 11 and the expected collision time TTC2 of the host vehicle 10 are less than the second threshold value Th2, the vehicle safe driving control device (100) performs collision avoidance deceleration control (step S270). At this time, since both the time required for the host vehicle 10 and the target vehicle 11 to reach the intersection point CP are not sufficient to cope with the collision expected by the driver, the vehicle safe driving control device 100 is Deceleration control can be performed to avoid collision.

일례로, 차량 안전주행 제어장치(100)는 자차(10)의 속도와 조향 각도 및 타겟차(11)의 속도를 기반으로 충돌 회피 감속 제어를 수행할 수 있다.For example, the apparatus 100 for controlling safe vehicle driving may perform collision avoidance deceleration control based on the speed and steering angle of the host vehicle 10 and the speed of the target vehicle 11 .

단계 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 target car 11 and the expected collision time TTC2 of the host vehicle 10 is equal to or greater than the second threshold value Th2, the vehicle safe driving control device ( 100) performs a collision warning (step S280). At this time, since any one of the time required for the host vehicle 10 and the target vehicle 11 to reach the intersection point CP is sufficient time to cope with a collision expected by the driver, the vehicle safe driving control device 100 ) can perform a collision warning to get the driver to pay attention.

일례로, 차량 안전주행 제어장치(100)는 충돌 경고를 시각적으로 또는 청각적으로 수행할 수 있다. 여기서, 차량 안전주행 제어장치(100)는 미러 인디케이터(150) 또는 클러스터(160)를 통하여 충돌 경고를 수행할 수 있다.For example, the vehicle safe driving control apparatus 100 may perform a collision warning visually or audibly. Here, the vehicle safe driving control apparatus 100 may perform a collision warning through the mirror indicator 150 or the cluster 160 .

이에 의해, 차량 안전주행 제어방법(200)은 운전자의 부주의나 합류 도로 주행이 미숙한 경우에도 안전운전을 지원할 수 있음으로 운전자의 편의성을 향상시킬 수 있고, 본선 도로에 주행중인 타겟차와의 충돌을 회피할 수 있으므로 안전운전을 더 효과적으로 지원할 수 있으며, 운전자가 본선 도로의 진입시 예상되는 충돌을 인식하게 할 수 있으므로 운전자의 편의성을 향상시키고 주행 안전성을 도모할 수 있다. Accordingly, the vehicle safe driving control method 200 can support safe driving even when the driver's negligence or inexperienced driving on the merging road, thereby improving the driver's convenience, and collision with the target car driving on the main road. Because it can avoid the collision, it can support safe driving more effectively, and it can make the driver recognize an expected collision when entering the main road, thereby improving the driver's convenience and promoting driving safety.

상기와 같은 방법들은 도 1에 도시된 바와 같은 차량 안전주행 제어장치(100)에 의해 구현될 수 있고, 특히, 이러한 단계들을 수행하는 소프트웨어 프로그램으로 구현될 수 있으며, 이 경우, 이러한 프로그램들은 컴퓨터 판독가능한 기록 매체에 저장되거나 전송 매체 또는 통신망에서 반송파와 결합된 컴퓨터 데이터 신호에 의하여 전송될 수 있다. 이때, 컴퓨터 판독가능한 기록 매체는 컴퓨터 시스템에 의해 판독가능한 데이터가 저장되는 모든 종류의 기록 장치를 포함할 수 있다.The above methods may be implemented by the vehicle safe driving control apparatus 100 as shown in FIG. 1 , and in particular, may be implemented as a software program for performing these steps, in this case, these programs are computer-readable It may be stored in a possible recording medium or transmitted by a computer data signal combined with a carrier wave in a transmission medium or a communication network. In this case, the computer-readable recording medium may include any type of recording device in which data readable by a computer system is stored.

이상에서 본 발명의 일 실시예에 대하여 설명하였으나, 본 발명의 사상은 본 명세서에 제시되는 실시예에 제한되지 아니하며, 본 발명의 사상을 이해하는 당업자는 동일한 사상의 범위 내에서, 구성요소의 부가, 변경, 삭제, 추가 등에 의해서 다른 실시예를 용이하게 제안할 수 있을 것이나, 이 또한 본 발명의 사상범위 내에 든다고 할 것이다.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.
제1항에 있어서,
상기 제어부는 상기 자차의 회전 반경에 따른 원의 방정식과 상기 타겟차의 경로에 따른 직선의 방정식의 교차점을 상기 교차 지점으로 연산하도록 구성되는 차량 안전주행 제어장치.
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.
제2항에 있어서,
상기 제어부는,
상기 자차의 조향 각도 또는 요-레이트(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.
제3항에 있어서,
상기 제어부는 상기 타겟차의 종방향 및 횡방향 속도를 이용하여 상기 속도 벡터를 연산하도록 구성되는 차량 안전주행 제어장치.
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.
제1항에 있어서,
상기 제어부는,
상기 타겟차의 위치에서 상기 교차 지점까지의 거리를 연산한 후 상기 타겟차의 속도 벡터로 나누어 상기 타겟차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하고,
상기 자차의 전방 코너에서부터 상기 교차 지점까지의 거리를 연산한 후 상기 자차의 속도로 나누어 상기 자차가 상기 교차 지점에 도달하는데 소요되는 시간을 연산하도록 구성되는 차량 안전주행 제어장치.
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.
삭제delete 제1항에 있어서,
상기 제어부는 상기 충돌 경고를 시각적으로 또는 청각적으로 수행하기 위해 제어하도록 구성되는 차량 안전주행 제어장치.
According to claim 1,
The control unit is configured to control to visually or audibly perform the collision warning.
제1항에 있어서,
상기 제어부는 상기 자차의 속도와 조향 각도 및 상기 타겟차의 속도를 기반으로 충돌 회피 감속 제어를 수행하기 위해 안전주행 모듈을 활성화하도록 구성되는 차량 안전주행 제어장치.
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.
제1항에 있어서,
상기 충돌 경고를 시각적으로 나타내는 미러 인디케이터; 또는
상기 충돌 경고를 시각적으로 또는 청각적으로 나타내는 클러스터 중 적어도 하나를 더 포함하는 차량 안전주행 제어장치.
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.
제1항에 있어서,
상기 감지부는,
차량 주변의 이미지를 촬영하는 이미지 센서; 및
상기 타겟차의 위치 및 속도를 감지하는 적어도 하나의 레이더(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결정 단계;
상기 합류 도로로 진입하는 상기 자차의 회전 반경을 기반으로 본선 도로를 주행하는 타겟차와 상기 자차의 교차 지점을 연산하는 제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.
제11항에 있어서,
상기 제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.
제11항에 있어서,
상기 제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.
◈청구항 14은(는) 설정등록료 납부시 포기되었습니다.◈◈Claim 14 was abandoned at the time of payment of the registration fee.◈ 제13항에 있어서,
상기 제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.
◈청구항 15은(는) 설정등록료 납부시 포기되었습니다.◈◈Claim 15 was abandoned when paying the registration fee.◈ 제14항에 있어서,
상기 제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.
제11항에 있어서,
상기 제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.
삭제delete 제11항에 있어서,
상기 경고 단계는 시각적으로 또는 청각적으로 경고를 수행하는 차량 안전주행 제어방법.
12. The method of claim 11,
The warning step is a vehicle safe driving control method for performing a warning visually or audibly.
제11항에 있어서,
상기 회피 제어 단계는 상기 자차의 속도와 조향 각도 및 상기 타겟차의 속도를 기반으로 충돌 회피 감속 제어를 수행하도록 안전주행 모듈을 활성화하는 차량 안전주행 제어방법.
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.
KR1020190165514A 2019-12-12 2019-12-12 Apparatus for controlling safety driving of vehicle and method thereof Active KR102303648B1 (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (4)

* Cited by examiner, † Cited by third party
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