[go: up one dir, main page]

KR20120067762A - The collision avoidance apparatus using low-speed and close-range collision avoidance algorithm for active safety - Google Patents

The collision avoidance apparatus using low-speed and close-range collision avoidance algorithm for active safety Download PDF

Info

Publication number
KR20120067762A
KR20120067762A KR1020100129329A KR20100129329A KR20120067762A KR 20120067762 A KR20120067762 A KR 20120067762A KR 1020100129329 A KR1020100129329 A KR 1020100129329A KR 20100129329 A KR20100129329 A KR 20100129329A KR 20120067762 A KR20120067762 A KR 20120067762A
Authority
KR
South Korea
Prior art keywords
collision
speed
vehicle
sensor
unit
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.)
Ceased
Application number
KR1020100129329A
Other languages
Korean (ko)
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 KR1020100129329A priority Critical patent/KR20120067762A/en
Publication of KR20120067762A publication Critical patent/KR20120067762A/en
Ceased legal-status Critical Current

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
    • 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
    • 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
    • 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
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/54Audio sensitive means, e.g. ultrasound
    • 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/10Longitudinal speed
    • 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/12Brake pedal position
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/50Barriers
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/802Longitudinal distance
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2400/00Special features of vehicle units
    • B60Y2400/30Sensors
    • B60Y2400/303Speed sensors

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)

Abstract

본 발명은 레이저 센서 기반 저속 근거리 충돌방지시스템에 관한 것으로, 선행차량에서 반사되어 수신될 때까지의 시간을 이용하여 선행차량과의 상대거리를 계산하는 속도 감지부;와 측면으로 접근하는 차량을 검출하기 위한 초음파와 운행자의 위험인식여부를 판단하는 핸들센서와 브레이크 페달센서를 포함하는 센서부;와 상기 속도 감지부와 상기 센서부로부터 수신한 선행차량과의 상대거리와 자차의 속도 및 가속도를 이용하여 선행차량의 속도 및 가속도를 연산한 후, 선행차량과의 상대거리, 선행차량의 속도, 가속도, 자차의 속도, 가속도 정보를 데이터베이스로 유지 관리하는 차량모델부; 상기 차량모델부의 데이터베이스 정보를 이용하여 충돌위험도를 판단하는 충돌진단부; 상기 충돌진단부로부터 수신한 충돌위험도에 따라 충돌경보를 발생시키는 충돌경고부; 및 상기 충돌진단부로부터 수신한 충돌위험도에 따라 차량을 감속시키기 위한 액츄에이터를 제어하는 차량제어부; 를 포함하는 것을 특징으로 하는 레이저 센서 기반 저속 근거리 충돌방지시스템을 제공한다.
본 발명에 따르면, 산업용 정밀 측정에 주로 사용되고 있는 레이저 센서를 사용함으로써 근거리에서 측정정밀도를 높일 수 있으며, 초음파 센서를 통하여 전면 사각지대 및 측면으로부터의 충돌에 예방하여 충돌위험도 판단 기준에 따라서 4단계의 상황을 단계적으로 적용하여 자동차의 급격한 정지나 감속을 막음으로써 능동형 안전성을 향상시킬 수 있다.
The present invention relates to a laser sensor-based low-speed short-range collision avoidance system, comprising: a speed sensor for calculating a relative distance with a preceding vehicle by using a time from the preceding vehicle to being received after being reflected from the preceding vehicle; A sensor unit including a steering wheel sensor and a brake pedal sensor to determine whether the driver recognizes the danger of the driver and the speed of the vehicle and the relative distance between the speed sensor and the preceding vehicle received from the sensor unit; After calculating the speed and acceleration of the preceding vehicle, the vehicle model unit for maintaining the relative distance to the preceding vehicle, the speed of the preceding vehicle, the acceleration, the speed of the own vehicle, the acceleration information in a database; A collision diagnosis unit for determining a collision risk using the database information of the vehicle model unit; A collision warning unit for generating a collision alarm according to the collision risk received from the collision diagnosis unit; And a vehicle control unit controlling an actuator for decelerating the vehicle according to the collision risk received from the collision diagnosis unit. It provides a laser sensor-based low-speed short-range collision avoidance system comprising a.
According to the present invention, by using a laser sensor that is mainly used for industrial precision measurement can increase the measurement accuracy at a short distance, and through the ultrasonic sensor to prevent collision from the front blind spot and the side to prevent the collision from the four stages according to the criteria of the collision risk By applying the situation step by step, the active safety can be improved by preventing sudden stop or deceleration of the car.

Description

능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치{The Collision Avoidance Apparatus Using Low-Speed And Close-range Collision Avoidance Algorithm For Active Safety}The Collision Avoidance Apparatus Using Low-Speed And Close-range Collision Avoidance Algorithm For Active Safety}

본 발명은 초음파센서를 이용한 능동 안전을 위한 저속에서의 근거리 충돌방지장치에 관한 것으로서, 보다 상세하게는 혼잡한 도시내에서 자동차가 저속으로 운행시 근거리에서 발생할 수 있는 충돌을 회피하고 나아가 능동적으로 안전성을 확보할 수 있도록 차량 전면의 레이저 센서와 차량의 전면 양쪽 가장자리에 장착된 초음파 센서를 이용하여 전면차량과의 거리, 상대속도, 상대가속도 및 측면 차량의 유무를 검출함으로써 충돌위험도를 보다 정확하게 판단하여 능동적으로 차량을 제동시킬 수 있도록 하는 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치에 관한 것이다.The present invention relates to an apparatus for preventing short-range collisions at low speed for active safety using ultrasonic sensors, and more particularly, to avoid collisions that may occur at short distances when the vehicle is operated at low speeds in a crowded city, and further actively to safety. By using the laser sensor on the front of the vehicle and the ultrasonic sensors mounted on both edges of the front of the vehicle, the collision risk can be judged more accurately by detecting the distance, relative speed, relative acceleration and the presence of the side vehicle. The present invention relates to a collision avoidance device using a low-speed short-range collision avoidance algorithm for active safety that actively brakes a vehicle.

최근의 자동차는 운송수단으로서 연비 및 성능의 향상뿐만아니라 발전된 정보통신기술을 이용하여 보다 향상된 안전성과 편의성을 제공할 수 있는 지능형 자동차로 발전하였다. 하지만 지능형 자동차는 운전자에게 부가적으로 엔터테인먼트시스템이나 공기정화장치, 편의장치 등 많은 기능으로 인해 운전자는 운전을 위한 조작기구 이외의 증가된 조작 기구를 조작하게 되어 운전자의 부주의로 인한 운행상의 위험 또한 증가하였다. 이에 순간적인 방심으로 인한 혼잡한 도심도로에서의 차량충돌을 예방 또는 회피할 수 있기 위한 안전장치에 대한 연구가 다양하게 이루어지고 있다. Recently, the automobile has been developed as an intelligent vehicle that can provide improved safety and convenience by using advanced information and communication technology as well as improving fuel economy and performance as a means of transportation. However, intelligent cars have many functions such as entertainment systems, air purifiers, and convenience devices, so that the driver can operate an increased control device in addition to the control device for driving, thereby increasing the risk of driving due to the carelessness of the driver. It was. Accordingly, various studies have been made on safety devices for preventing or avoiding a vehicle crash on a busy city road due to momentary carelessness.

대표적으로 감응 순항제어장치(Adaptive Cruise Control System), 전방 차량추돌경고장치(Forward Vehicle Collision Warning System), 차선 유지 경고 시스템(Lane Departure Warning System) 등이 있으며, 특히 순항제어장치는 운전자에게 핸들의 조작을 맡기고 페달로 제어되는 부분들을 마이크로프로세서를 이용해 제어한다. 이러한 정속 주행 시스템은 현재 ON/OFF 방식에 의해 제어가 결정되고 있고 24GHz의 FMC방식의 레이더의 특성에 의해 주로 40km/h 이상의 고속주행에서 주로 사용되어 비교적 큰 사고를 예방하기 위하여 고속상황에서 원거리에 있는 장애물을 감지하는 기술이 대부분이다.Representative examples include the Adaptive Cruise Control System, the Forward Vehicle Collision Warning System, and the Lane Departure Warning System. The pedals are controlled by a microprocessor. This constant speed driving system is currently controlled by ON / OFF method and is mainly used in high-speed driving of 40km / h or more due to the characteristic of 24GHz FMC radar. Most of the technology to detect obstacles.

하지만 실제 교통사고의 대부분은 도심내에서 혼잡 교통 특성상 교통사고의 70% 이상이 30km/h 이하의 저속에서 많이 발생 되고 있어 기존의 순항제어장치에 적용된 레이더는 근거리에 대한 오차가 크기 때문에 저속 근거리 충돌방지 시스템을 구성하기에 적합하지 않으며 또한 저속상황에서 발생하는 근거리 충돌의 경우는 제동을 위해 필요한 제동거리 보다 운전자 인지를 위해 필요한 공주거리에 영향을 더 많이 받고 있다.However, most of the actual traffic accidents occur in urban areas because more than 70% of traffic accidents occur at low speeds below 30km / h. Radar applied to the existing cruise control devices has a large error in near distance, so it has a low near-field collision. It is not suitable for constructing a prevention system, and in case of a close collision occurring in a low speed situation, it is more affected by the princess distance required for driver recognition than the braking distance required for braking.

이에 최근 Volvo에서 선보인 City Safety기능은 기존에 장애물 감지용으로 많이 사용되던 레이더에서 근거리 정밀도가 뛰어난 레이저센서를 사용하였으나 이런 근거리 충돌 회피 기술은 실제로 해외보다 훨씬 교통사항이 혼잡한 국내 도로에서의 밀집된 차간 간격이나 잦은 차선 변경으로 인한 측면 충돌 등에 있어서 적용하는데 어려움 점이 있으며, 또한 환경적 변화에 민감한 레이저 센서의 사용으로 인한 검출에러 및 레이저 센스가 미치지 못하는 전면 가장자리에서 발생하는 사각지대를 검출하지 못하는 문제점이 있었다.Recently, the City Safety function introduced by Volvo used a laser sensor with excellent short-range accuracy in radar, which was used for obstacle detection in the past, but such near-collision avoidance technology is actually a dense vehicle on domestic roads with much more traffic than overseas. It is difficult to apply in side collisions due to spacing or frequent lane changes. Also, there is a problem in that detection errors due to the use of a laser sensor sensitive to environmental changes and blind spots occurring at the front edge that the laser sense cannot reach are detected. there was.

본 발명은 전술한 문제점을 해결하기 위하여 안출된 것으로, 자동차에 있어 차량 전면의 레이저 센서로부터 측정된 전면 차량과의 거리와 환경에 민감한 레이저 센서의 부정확한 정보의 발생 및 전면 사각지대를 보완할 수 있는 차량의 전면 가장자리에 장착된 초음파센서를 이용하여 측면으로부터 접근하는 차량 충돌을 회피하도록 상기 센서와 운전자의 제동의지를 감지하는 센서로부터 측정된 값을 이용하여 연산한 충돌위험도에 따른 충돌 회피 알고리즘에 따른 제어를 수행하는 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치를 제공하는 것을 목적으로 한다.SUMMARY OF THE INVENTION The present invention has been made to solve the above problems, and can compensate for the occurrence of inaccurate information and front blind spots of the laser sensor sensitive to the environment and distance from the front vehicle measured from the laser sensor on the front of the vehicle. The collision avoidance algorithm according to the collision risk calculated using the values measured from the sensor and the sensor detecting the driver's braking intention to avoid the vehicle collision approaching from the side by using the ultrasonic sensor mounted on the front edge of the vehicle. It is an object of the present invention to provide a collision avoidance apparatus using a low-speed short-range collision avoidance algorithm for active safety to perform the control according to.

상기 목적을 달성하기 위한 본 발명의 초음파센서를 이용한 능동 안전을 위한 저속에서의 근거리 충돌방지장치는, 레이저 센서를 이용하여 선행차량과의 상대거리를 계산하는 레이저 센서와 운행차량의 속도를 측정하는 블루투스 OBD를 포함하는 속도 감지부;와 측면으로 접근하는 차량을 검출하기 위한 초음파와 운행자의 위험인식여부를 판단하는 핸들센서와 브레이크 페달센서를 포함하는 센서부;와 상기 속도 감지부와 상기 센서부로부터 수신한 선행차량과의 상대거리, 측면의 차량 의 유무와 자차의 속도 및 가속도를 이용하여 선행차량의 속도 및 가속도를 연산한 후, 선행차량과의 상대거리, 선행차량의 속도, 가속도, 자차의 속도, 가속도 정보, 측면 장애물 유무를 데이터베이스로 유지 관리하는 차량모델부; 상기 차량모델부의 데이터베이스 정보를 이용하여 충돌위험도를 판단하는 충돌진단부; 상기 충돌진단부로부터 수신한 충돌위험도에 따라 충돌경보를 발생시키는 충돌경고부; 및 상기 충돌진단부로부터 수신한 충돌위험도에 따라 차량을 감속시키기 위하여 액츄에이터를 제어하는 차량제어부;를 포함하는 것을 특징으로 한다.The short-range collision prevention device at low speed for active safety using the ultrasonic sensor of the present invention for achieving the above object, the laser sensor for calculating the relative distance with the preceding vehicle using a laser sensor to measure the speed of the driving vehicle A speed sensing unit including a Bluetooth OBD; and a sensor unit including a handle sensor and a brake pedal sensor for determining whether the driver recognizes a dangerous vehicle and an ultrasonic wave for detecting a vehicle approaching to the side; and the speed detecting unit and the sensor unit Calculate the speed and acceleration of the preceding vehicle using the relative distance from the preceding vehicle, the presence or absence of the vehicle on the side, and the speed and acceleration of the own vehicle, and then compare the relative distance with the preceding vehicle, the speed, acceleration, and own vehicle of the preceding vehicle. Vehicle model unit for maintaining the speed, acceleration information, the presence of side obstacles in the database; A collision diagnosis unit for determining a collision risk using the database information of the vehicle model unit; A collision warning unit for generating a collision alarm according to the collision risk received from the collision diagnosis unit; And a vehicle control unit for controlling the actuator to decelerate the vehicle according to the collision risk received from the collision diagnosis unit.

또한, 상기 데이터베이스는 마이크로컨트롤러에서 허용가능한 메모리의 크기로 제한되며, 메모리의 용량을 초과하게 되는 경우에는 과거의 데이터를 삭제하고 최신의 데이터로 계속 업데이트를 하면서 데이터베이스를 최신의 상태로 유지하는 것을 특징으로 한다.In addition, the database is limited to the size of the memory allowable by the microcontroller, and if the memory capacity is exceeded, the database is kept up to date while deleting the old data and continuously updating with the latest data. It is done.

또한, 상기 데이터베이스는 선행차량과의 상대거리, 선행차량의 속도, 가속도, 자차의 속도, 가속도 정보를 이용하여 선행차량 및 자차의 가속도선도 및 감속도선도에 대한 정보를 저장하고 있는 것을 특징으로 한다.In addition, the database stores information on the acceleration diagram and the deceleration diagram of the preceding vehicle and the own vehicle using the relative distance with the preceding vehicle, the speed of the preceding vehicle, the acceleration, the speed of the own vehicle, and the acceleration information. .

또한, 상기 데이터베이스는 선행차량과의 상대거리, 선행차량의 속도, 가속도, 자차의 속도, 가속도 정보를 이용하여 특정속도 및 특정거리에서 발생할 수 있는 운전자의 평균 감속도를 테이블 형태로 저장하는 것을 특징으로 한다.In addition, the database stores the average deceleration of the driver that can occur at a specific speed and a specific distance in a table form using the relative distance to the preceding vehicle, the speed of the preceding vehicle, the acceleration, the speed of the own vehicle, the acceleration information. It is done.

또한, 상기 충돌위험도를 판단하는 기준이 되는 거리값은 2.5m를 기준으로 하는 것을 특징으로 한다.In addition, the distance value which is a criterion for determining the collision risk is characterized in that it is based on 2.5m.

또한, 상기 충돌위험도는 안전단계, 경고단계, 감속단계, 위험단계의 4가지 단계로 구성되며, 가장 안전한 상황인 안전단계를 기준으로 상대속도나 상대가속도 또는 차간거리의 상황이 나빠질 때마다 위험상황이 한 단계씩 높아지는 것을 특징으로 한다.In addition, the collision risk is composed of four stages of safety stage, warning stage, deceleration stage, and dangerous stage. It is characterized by a step-by-step increase.

본 발명에 따른 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치에 의하면, 도심내에서의 저속 근거리간 차량운행에 있어 자동차의 전면 중앙의 레이저센서와 자동차 전면 양쪽 가장자리의 초음파 센서와 운행차량의 속도 및 가속도 측정을 위한 블루투스 OBD와 운전자의 제어의지를 판단하는 핸들센서와 브레이크 페달센서를 통하여 얻어진 정보를 이용함으로써 전면 레이저 센서와 전면 사각지대를 보완할 수 있는 차량의 전면 가장자리에 장착된 초음파센서를 이용하여 측정정밀도의 신뢰성을 향상시키고, 전면 가장자리의 사각지대 및 측면의 충돌을 예방하며, 충돌위험도 판단 기준에 따라서 4단계의 상황을 단계적으로 적용하여 차량을 효과적이고 능동적으로 제동할 수 있는 충돌 회피 알고리즘을 통한 자동차의 급격한 정지나 감속을 막음으로써 능동형 안전성을 향상시킬 수 있다.According to the collision avoidance device using the low-speed short-range collision avoidance algorithm for active safety according to the present invention, the laser sensor of the center of the front of the vehicle and the ultrasonic sensor and the driving vehicle of both edges of the front of the vehicle in the low-speed near-vehicle operation in the city Ultrasonics mounted on the front edge of the vehicle that can supplement the front laser sensor and front blind spot by using the information obtained through the Bluetooth OBD for measuring the speed and acceleration of the driver and the steering wheel sensor and brake pedal sensor to determine the driver's control will It can improve the reliability of measurement accuracy by using sensors, prevent the collision of blind spots and sides at the front edge, and apply the four stages step by step according to the collision risk judgment criteria to effectively and actively brake the vehicle. Sudden car collision with collision avoidance algorithm By Gina preventing the deceleration can improve active safety.

도 1은 본 발명에 따른 능동 안전을 위한 저속 근거리 충돌방지 장치의 차량에서의 구성도,
도 2는 본 발명에 따른 능동 안전을 위한 저속 근거리 충돌방지 장치충돌 방지 장치도,
도 3은 본 발명에 따른 두 차량의 속도와 거리를 나타내는 예시도,
도 4는 본 발명에 따른 충돌위험도 판단 기준에 따른 4단계의 순서도,
도 5는 본 발명에 따른 초음파 센서를 이용한 저속 근거리 충돌방지장치의 알고리즘.
1 is a block diagram of a vehicle of a low-speed short-range collision prevention device for active safety according to the present invention,
Figure 2 is a low-speed short-range collision avoidance device collision prevention device for active safety according to the present invention,
3 is an exemplary view showing the speed and distance of two vehicles according to the present invention;
4 is a flow chart of four steps according to the criteria for determining the risk of collision according to the present invention;
5 is an algorithm of a low-speed short-range collision avoidance apparatus using an ultrasonic sensor according to the present invention.

이하, 예시도면을 참조하여 본 발명에 따른 초음파 센서를 이용한 능동 안전을 위한 저속 근거리 충돌방지장치의 일실시예에 대한 구성 및 작용을 상세하게 설명한다.Hereinafter, the configuration and operation of an embodiment of a low-speed short-range collision avoidance device for active safety using the ultrasonic sensor according to the present invention with reference to the exemplary drawings in detail.

도 1을 참조하면, 본 발명의 실시예에 따른 도심 내 혼잡한 도로에서의 저속 운행하는 자동차간의 근거리 충돌을 예방하기 위하여 레이저 센서와 초음파 센서, 블루투스 OBD, 핸들 센서, 브레이크 페달센서를 장착한 능동 안전을 위한 저속 근거리 충돌방지장치의 차량에서의 구성은 전방의 차량과의 거리 등을 측정하기 위하여 차량의 전면에 부착된 레이저 센서(10)와 레이저 센서의 단점을 보완하도록 차량의 전면 양쪽 가장자리에 각각 부착된 초음파 센서(20)와 운행차량의 속도를 검출하기 위해 핸들과 브레이크 중간에 위치한 블루투스 OBD(40)와 운전자의 충돌 인식을 감지하도록 브레이크 페달에 설치된 브레이크 페달센서(50)와 핸들에 장착된 핸들센서(60)와 상기의 센서의 정보로부터 충돌 상황의 판단 및 위험도를 분석하여 적절한 신호를 발생시키는 전자제어장치(30)와 상기 전자제어장치에 의해 발생된 신호에 의해 감속을 수행하는 브레이크 컨트롤러(70)와 경고음을 발생하는 경고장치(80)로 구성된다.Referring to FIG. 1, in order to prevent a short-range collision between a vehicle driving at a low speed on a busy road in a city center according to an exemplary embodiment of the present invention, an active device equipped with a laser sensor, an ultrasonic sensor, a Bluetooth OBD, a steering wheel sensor, and a brake pedal sensor is installed. The construction of the low speed short-range collision avoidance device for safety is provided on both front edges of the vehicle so as to compensate for the shortcomings of the laser sensor 10 and the laser sensor attached to the front of the vehicle in order to measure the distance from the vehicle ahead. It is mounted on the steering wheel and the brake pedal sensor 50 installed on the brake pedal so as to detect the collision detection of the driver and the Bluetooth OBD 40 located in the middle of the steering wheel and the brake to detect the speed of the vehicle and the attached ultrasonic sensor 20, respectively. From the handle sensor 60 and the information of the sensor, the determination of the collision situation and the risk may be performed to generate an appropriate signal. The electronic control device 30 is composed of a brake controller 70 for performing the deceleration by the signal generated by the electronic control device and a warning device 80 for generating a warning sound.

본 발명의 실시예에 따른 초음파 센서를 장착한 능동 안전을 위한 저속 근거리 충돌방지장치는 도 2에 도시된 바와 같이, 속도 감지부(100), 센서부(110), 차량모델부(120), 충돌진단부(130), 충돌경고부(140), 차량제어부(150)로 이루어진다.As shown in FIG. 2, a low-speed short-range collision preventing device for active safety equipped with an ultrasonic sensor according to an exemplary embodiment of the present invention includes a speed detecting unit 100, a sensor unit 110, a vehicle model unit 120, The collision diagnosis unit 130, the collision warning unit 140, and the vehicle control unit 150.

상기 속도 감지부(100)는 자동차의 전면 중앙부에 설치된 레이저 센서를 통한 선행차량의 상대 속도 및 상대 가속도를 검출하는 레이저 모듈부(101)와 운행차량의 속도 및 가속도를 측정하는 핸들과 페달의 중간에 설치된 블루투스 OBD(107)로부터 측정된 값을 차량모델부(121)에 전송한다.The speed detecting unit 100 is a laser module unit 101 that detects the relative speed and the relative acceleration of the preceding vehicle through a laser sensor installed at the front center of the vehicle, and a handle and a pedal for measuring the speed and acceleration of the driving vehicle. The measured value is transmitted from the Bluetooth OBD 107 installed in the vehicle model unit 121.

상기 레이저 모듈부(101)는 현행차량과 선행차량의 상대거리를 계산하기 위하여 레이저 다이오드 및 레이저 발진부(103), 레이저 송ㆍ수신을 담당하는 광학렌즈(Tx, Rx)(102), 수신된 신호를 디지털값으로 변경하는 신호처리부(104), TOF 알고리즘 계산부(105)와 레이저측 네트워크 모듈(106)로 구성되어 있다. The laser module 101 includes a laser diode and a laser oscillator 103, optical lenses (Tx, Rx) 102, which are responsible for laser transmission and reception, in order to calculate the relative distance between the current vehicle and the preceding vehicle. Is composed of a signal processing unit 104, a TOF algorithm calculation unit 105, and a laser side network module 106 for changing the digital value into a digital value.

상기 레이저 다이오드 및 레이저 발진부(103)에서 발진된 레이저 빛은 전방의 선행차량에 반사되어 수신렌즈(102)를 거쳐 레이저 모듈부로 다시 돌아오게 된다. 이때, 수신된 레이저 광은 신호처리부(104)를 거쳐 디지털값으로 변환되고, 이 디지털 값은 레이저 발진부터 반사되어 수신될 때까지의 시간을 이용해 상대거리를 연산하는 TOF 알고리즘 계산부(105)을 거쳐 디지털 거리값으로 출력되게 된다. 레이저측 네트워크 모듈(106)에서는 레이저 모듈부(101)에서 측정된 선행차량과의 상대거리를 전송한다.The laser light oscillated by the laser diode and the laser oscillator 103 is reflected by the preceding vehicle in front and returns to the laser module through the receiving lens 102. At this time, the received laser light is converted into a digital value through the signal processing unit 104, and the digital value is calculated using the TOF algorithm calculation unit 105 that calculates the relative distance using the time from the laser oscillation to the reflection and reception. It will be output as a digital distance value. The laser side network module 106 transmits a relative distance to the preceding vehicle measured by the laser module unit 101.

상기 레이저 모듈부(101)에서 선행차량과의 상대거리의 계산은 도 3에 도시된 바와 같이, 두 차간의 거리는 d, 선행차량의 속도를 V2, 후행차량의 속도를 V1으로 두었으며 선행차량의 가속도를 A2, 후행차량의 가속도를 A1 이라 하였고 두 차량간의 상대속도를 △V, 상대가속도를 △A 라 정의한다.As shown in FIG. 3, the distance between the two cars is d, the speed of the preceding vehicle is V 2 , the speed of the following vehicle is set to V 1 , and the speed of the following vehicle is set to V 1 in the laser module unit 101. The acceleration of the vehicle is A 2 , the acceleration of the following vehicle is A 1 , and the relative speed between the two vehicles is defined as ΔV and the relative acceleration as ΔA.

△V 는 V2 에서 V1을 뺀값과 같으며, △A 는 A2 에서 A1을 뺀값과 같다.ΔV Is equal to V 2 minus V 1, and ΔA Is equal to A 2 minus A 1 .

상기 센서부(110))는 자동차의 전면 가장자리 양쪽에 초음파센서와 운전자의 위험인식에 따른 속도의 제어의지를 판단할 수 있는 핸들에 장착된 핸들센서와 브레이크 페달에 장착된 브레이크 페달 센서를 포함한다.The sensor unit 110 includes an ultrasonic sensor on both sides of the front edge of the vehicle and a handle sensor mounted on a handle capable of determining the control intention of speed according to a driver's risk recognition, and a brake pedal sensor mounted on a brake pedal. .

초음파 센서(111)는 레이저 센서의 사각지대인 전면 2.5m이내의 장애물과 3m이내의 측면 장애물을 감지할 수 있도록 자동차의 전면 가장자리 양쪽에 각각 2개씩 장착하고 장애물의 감지시에 이에 대한 정보를 차량모델부(121)에 송신한다.The ultrasonic sensors 111 are mounted on each side of the front edge of the vehicle so as to detect obstacles within 2.5m and side obstacles within 3m, which are blind spots of the laser sensor, and provide information on the detection of obstacles. It transmits to the model part 121.

핸들센서(112)와 브레이크 페달센서(113)는 차량의 충돌의 위험이 발생한 경우 이에 대한 운전자의 인지여부를 판단할 수 있도록 핸들과 브레이크 페달의 순간적인 큰 변화를 감지할 수 있도록 하여 운전자의 감속의지를 판단하여 위험도 판단단계에 따른 운전자의 대처를 결정할수 있도록 차량모델부(121)에 송신한다.The steering wheel sensor 112 and the brake pedal sensor 113 detect a momentary large change in the steering wheel and the brake pedal so as to determine whether the driver is aware of the danger of collision of the vehicle. The determination is sent to the vehicle model unit 121 to determine the driver's response to the risk determination step.

상기 차량모델부(120)는 상기 속도 감지부(100)와 센서부(110)로부터 전송된 데이터를 이용하여 충돌 상황의 판단 및 위험도를 분석하기 위해서 차량의 가속도선도 및 감속도선도에 대한 정보를 데이터베이스의 형태로 포함한다.The vehicle model unit 120 uses information transmitted from the speed detecting unit 100 and the sensor unit 110 to determine information on the acceleration diagram and the deceleration diagram of the vehicle in order to analyze the risk and determine the collision situation. Included in the form of a database.

충돌 상황의 판단 및 위험도를 분석하기 위해서 먼저 선행차량을 추종하기 위한 적정거리 선정을 위해 이상적인 자동차의 제동거리를 측정해볼 필요가 있다.In order to determine the collision situation and analyze the risk, it is necessary to first measure the braking distance of the ideal vehicle to select the appropriate distance to follow the preceding vehicle.

제동거리를 나타내는 식

Figure pat00001
을 이용하고 이 식에서 사용된 마찰계수 μ= 0.8을 이용하여 도심 혼잡교통 내의 평균 주행속도인 20km/h일 때의 요구되는 제동거리를 계산하면 D = 1.96m 와 같은 값을 구할 수 있다.Expression for braking distance
Figure pat00001
By calculating the required braking distance at 20km / h, the average driving speed in urban congested traffic, using the coefficient of friction μ = 0.8 used in this equation, we can obtain a value equal to D = 1.96m.

여기서 구해진 제동거리에서 실제 주행에서 충돌 방지를 위해 safety factor를 곱하여 충돌의 위험도를 판단하기 위한 거리를 2.5m 로 선정하였다.In order to prevent collision in actual driving at the braking distance obtained here, the distance to determine the risk of collision was selected as 2.5m.

본 발명에서 제안하는 충돌 위험도 기술은 상대속도, 상대가속도와 차간 거리에 따라 단계별로 적용된다. The collision risk technique proposed in the present invention is applied step by step according to the relative speed, relative acceleration and the distance between the vehicles.

먼저 상대 속도(△V)와 상대 가속도(△A)는 0보다 큰 경우, 0과 같은 경우, 0보다 작은 경우로 나뉘어지고 이는 앞으로 차간 거리의 변화량을 예측할 수 있는 factor로써 차간거리가 멀어지거나 가까워지는 정도를 판단하여 각각의 위험도를 판단한다. First, relative velocity (△ V) and relative acceleration (△ A) are divided into greater than zero, equal to zero, and less than zero, which is a factor for predicting the amount of change in the distance between vehicles. Judging how much you lose, determine your risk.

다음은 현재 두 차간의 거리요소로 위험요소를 판단하게 되는데 앞에서 지정한 안전제동거리 2.5m을 기준으로 위험단계를 설정한다. 즉 세 가지의 충돌위험도 판단 factor 속도, 가속도, 차간거리를 이용하여 충돌 위험도를 판단하게 된다.Next, the risk factor is determined by the distance factor between the two vehicles. The risk level is set based on the safety braking distance 2.5m specified above. That is, three collision risk judgment factors are used to determine the collision risk using speed, acceleration, and distance between vehicles.

각각의 상황은 다음의 기준으로 설정되었다.Each situation was set based on the following criteria.

1. △V>0, △A>0 상황에서는 차간거리에 관계없이 안전단계로 지정한다.1. In ΔV> 0 and ΔA> 0 situations, designate the safety level regardless of the distance between vehicles.

2. △V<0, △A<0 상황에서는 차간 거리에 관계없이 위험단계로 지정한다.2. In case of ΔV <0, ΔA <0, it is designated as a dangerous step regardless of the distance between vehicles.

3. 가장 안전한 상황인 안전단계를 기준으로 상대속도나 상대가속도, 차간거리의 상황이 나빠질 때마다 위험상황을 한 단계씩 격상시킨다.3. Whenever the relative speed, relative acceleration, or distance between vehicles becomes worse, the safety situation is upgraded by one level based on the safety stage, the safest situation.

위의 세 조건을 통해 [표1]을 완성할 수 있다. [표1]은 상대속도, 상대가속도, 차간거리값에 따라서 충돌위험도를 4가지로 구분하여 나타낸 것이다.
[Table 1] can be completed through the above three conditions. [Table 1] shows the collision risks according to the relative speed, relative acceleration, and distance value.

△V > 0ΔV> 0 △V = 0ΔV = 0 △V < 0ΔV <0 Dmax = 2.5mDmax = 2.5 m 2.5m이하2.5m or less Dmax = 2.5mDmax = 2.5 m 2.5m이하2.5m or less Dmax = 2.5mDmax = 2.5 m 2.5m이하2.5m or less △A > 0 ΔA> 0 안전단계Safety level 안전단계Safety level 안전단계Safety level 안전단계Safety level 경고단계Warning step 위험단계Risk level △A = 0 ΔA = 0 안전단계Safety level 안전단계Safety level 안전단계Safety level 경고단계Warning step 위험단계Risk level 충돌단계Crash phase △A < 0 ΔA <0 안전단계Safety level 안전단계Safety level 경고단계Warning step 위험단계Risk level 충돌단계Crash phase 충돌단계Crash phase

가장 안전한 상태로써 충돌방지 시스템이 작동하지 하는 안전단계, 충돌방지시스템의 개입이 준비되는 준비단계, 액츄에이터를 제어하지 않고 운전자에서 위험을 알려 주는 경고단계, 브레이크의 압력을 조절하여 감속을 진행하는 감속단계, 마지막으로 가장 위험한 상황으로 정지가 요구되는 위험단계로 구분된다.The safest state, the safety phase in which the collision avoidance system does not work, the preparation phase in preparation for the intervention of the collision avoidance system, the warning phase informing the driver of the danger without controlling the actuator, and the deceleration in which the brake pressure is adjusted to adjust the pressure. Stages, and finally the most dangerous situation, divided into dangerous stages that require stopping.

도 4를 참조하면, 각각의 상황에서 충돌방지시스템은 현재 상황에 적합한 제어방법을 선택한다.Referring to FIG. 4, in each situation, the collision avoidance system selects a control method suitable for the current situation.

안전단계에서는 현재 상태는 안전하지만 시간이 지남에 따라 안전거리를 보장할 수 없는 시점이 발생 될 요지가 있기에 상황을 대비할 수 있도록 충돌방지장치을 작동시켜 센서를 통해 계속 측정한다.In the safety phase, the current state is safe, but there is a point where it is impossible to guarantee a safe distance over time, so the anti-collision device is operated to measure the situation.

경고단계는 실질적으로 충돌방지장치에 의해 충돌을 회피할 수 있는지에 대하여 판단하는 단계로 먼저 핸들센서와 브레이크 페달센서로부터 운전자의 제어의지가 있는지를 판단하여 있다면 다시 안전단계로 전환하여 측정하나, 운전자의 제어의지가 없다면 핸들진동이나 경고음을 통해 운전자에게 위험 요소를 알리고 제어를 요구하는 단계이다.The warning step is to judge whether the collision can be substantially avoided by the collision avoidance device. If the driver's control intention is first determined from the steering wheel sensor and the brake pedal sensor, the warning step is converted to safety level again. If there is no willingness to control, it is a step that informs the driver of the hazard through steering wheel vibration or warning sound and requires control.

위험단계에서는 운전자의 제어의지를 판단하면서 액츄에이터를 제어하여 브레이크 압력을 50%로 조정하여 운전자의 승차감을 저해하지 않는 범위에서 감속을 진행하면서 안전제동거리를 줄이고 운전자의 제어를 기다리거나 선행차량과의 거리 변화에 따라 감속을 진행한다.At the risk level, the driver controls the actuator while adjusting the brake pressure to 50%, reducing the safety braking distance while decelerating in the range that does not impair the driver's riding comfort, and waiting for the driver's control or with the preceding vehicle. Decelerate according to the distance change.

마지막으로 충돌단계는 이미 운전자에 의해서는 충돌을 피할 수 없는 단계로 정지가 요구되는 단계로서 액츄에이터를 제어하여 브레이크 압력을 100%로 조정하여 최대한 빠른 시간에 차량이 정지할 수 있도록 한다.Finally, the collision stage is a stage in which collision is inevitable by the driver, and a stop is required. The actuator is controlled to adjust the brake pressure to 100% so that the vehicle can be stopped as soon as possible.

이렇게 각 4단계의 상황을 단계적으로 적용함으로써 자동차의 급격한 정지나 감속을 막고 운전자에게 제어를 요구함으로써 운전자의 운전을 방해하지 않고 혼잡한 교통 속에서 급격한 상황변화를 발생시키지 않는다.By applying each of the four stages step by step, it prevents a sudden stop or deceleration of the car and requires the driver to control, so that it does not interfere with the driver's driving and does not cause a sudden change in the crowded traffic.

차량모델부(121)에서는 자차의 속도정보(V1), 가속도정보(A1)를 통해 상기 레이저모듈부(101)로부터 수신된 전방 차량의 상대거리(△D)를 이용하여 충돌판단에 사용되는 전방차량의 속도(V2), 가속도(A2)를 연산한다. 그리고 자차의 속도정보, 가속도정보 및 전방차량의 상대거리는 운행시간 동안 일정한 주기로 차량모델부(121)의 데이터베이스에 업데이트 된다. 이 데이터베이스의 데이터량은 마이트로컨트롤러에서 허용할 수 있는 메모리크기로 제한되며, 메모리 용량을 초과하게 과거의 데이터를 삭제하고 최신의 데이터로 계속 업데이트하면서 데이터베이스를 최신상태로 유지한다. The vehicle model unit 121 is used for collision determination using the relative distance ΔD of the front vehicle received from the laser module unit 101 through the speed information V 1 and the acceleration information A 1 of the own vehicle. The speed V 2 and the acceleration A 2 of the front vehicle to be calculated are calculated. The speed information, acceleration information, and relative distance of the vehicle ahead are updated in the database of the vehicle model unit 121 at regular intervals during the driving time. The amount of data in this database is limited by the amount of memory that the microcontroller can accept, keeping the database up-to-date while deleting past data beyond the memory capacity and continuing to update with the latest data.

데이터베이스는 △D, V1, V2, A2, A1 정보를 이용하여 특정속도 및 특정거리에서 발생할 수 있는 운전자의 평균 감속도(-1g~0g의 범위: g=-9.81m/s2)를 매치하여 테이블의 형태로 저장한다. 운전자마다 전방의 차량과 유지하는 상대거리 및 감속도가 다르기 때문에, 이 테이블은 운전자가 운전을 할 때 점차 시스템을 운전자의 운전성향에 적합하도록 튜닝한다. The database includes ΔD, V 1 , V 2 , A 2 , Using the A 1 information, match the driver's average deceleration (range from -1g to 0g: g = -9.81m / s 2 ) that can occur at a specific speed and a specific distance and store it in the form of a table. Because each driver has different relative distances and decelerations to keep ahead of the vehicle, the table gradually tunes the system to suit the driver's driving preferences as he drives.

이러한 데이터베이스를 이용한 차량모델부(121)는 속도와 가속도의 변화추이를 이용하여 다음 주기에서의 차량속도와 가속도를 미리 예측할 수 있기 때문에, 빠른 충돌판단을 할 수 있도록 도와준다. Since the vehicle model unit 121 using the database can predict the vehicle speed and the acceleration in the next cycle in advance by using the change trend of the speed and the acceleration, it helps to make a quick collision determination.

상기 충돌진단부(120)는 상기 차량모델부(121)의 데이터베이스에 저장된 자차의 속도, 가속도와 선행차량과의 속도, 가속도 정보 및 상대거리, 측면 차량 및 장애물의 유무정보, 운전자의 충돌인식정도를 이용하여 본 발명의 충돌 위험도 판단표 [표1]에 의해 충돌가능성을 판단하여 충돌위험도 정보를 송신한다. 충돌위험도 정보는 충돌위험의 가능성에 따라 충돌경고부(130)와 차량제어부(140)에서 사용하게 된다. The collision diagnosis unit 120 is the speed of the own vehicle stored in the database of the vehicle model unit 121, the acceleration and the speed of the preceding vehicle, the acceleration information and relative distance, the presence or absence of side vehicles and obstacles, the degree of collision recognition of the driver By using the collision risk determination table [Table 1] of the present invention to determine the possibility of collision and transmits the collision risk information. The collision risk information is used by the collision warning unit 130 and the vehicle control unit 140 according to the possibility of collision risk.

상기 충돌경고부(130)에서는 충돌경고부측 네트워크모듈(131)를 통해 수신한 충돌 위험단계가 경고단계나 감속단계이면 핸들센서와 브레이크 페달 센서로부터의 정보로 운전자의 감속의지의 유무를 판단하여 감속의지가 없다면 경고단계의 경우에는 운전자에게 경고음이나 핸들 진동을 통해 운전자에게 위험상황을 알리고, 감속단계이면 차량제어부(140)를 통해 브레이크 압력 페달을 50%작동시키며, 충돌단계이면 차량제어부(140)를 통해 브레이크 압력 페달을 100%작동시켜 최대한 짧은 시간을 차량을 정지시킨다. The collision warning unit 130 decelerates the driver's deceleration will by deciding whether the collision risk level received through the collision warning unit network module 131 is a warning stage or a deceleration stage based on information from the steering wheel sensor and the brake pedal sensor. If there is no willingness to warn the driver through a warning sound or handle vibration in the case of the driver, the decelerating phase to operate the brake pressure pedal 50% through the vehicle control unit 140, if the collision phase vehicle control unit 140 The brake pressure pedal is operated 100% to stop the vehicle in the shortest possible time.

상기 차량제어부(140)에서는 충돌위험도에 따라 차량을 감속시키기 위해서 브레이킹 컨트롤러(142)와 서보드라이버(143)를 이용하여 액츄에이터(150)를 제어하는 역할을 담당한다. The vehicle controller 140 controls the actuator 150 using the braking controller 142 and the servo driver 143 to decelerate the vehicle according to the collision risk.

본 발명에 따르면, 레이저 센서를 사용함으로써 근거리에서 측정정밀도를 높일 수 있으며, 초음파 센서를 통하여 전면 사각지대 및 측면으로부터의 차량의 충돌을 감지하여 충돌위험도 판단 기준에 따라서 4단계의 상황을 단계적으로 적용하여 자동차의 급격한 정지나 감속을 막음으로써 능동형 안전성을 향상시킬 수 있다.According to the present invention, it is possible to increase the measurement accuracy at a short distance by using a laser sensor, and detect the collision of the vehicle from the front blind spot and the side through the ultrasonic sensor and apply the situation in four stages according to the collision risk judgment criteria. Therefore, active safety can be improved by preventing a sudden stop or deceleration of the vehicle.

본 명세서에는 본 발명에 따른 초음파센서를 이용한 능동 안전을 위한 저속 근거리 충돌방지장치의 바람직한 실시예를 설명하였으나, 본 발명이 이에 한정되는 것은 아니다. 본 발명은 특허청구범위 및 첨부도면의 범위 내에서 다양하게 변형되어 실시될 수 있으며, 이것 또한 본 발명의 권리범위에 속한다.In the present specification, a preferred embodiment of the low-speed short-range collision preventing device for active safety using the ultrasonic sensor according to the present invention has been described, but the present invention is not limited thereto. The invention may be practiced in various ways within the scope of the claims and the accompanying drawings, which also belong to the scope of the invention.

100 속도 감지부101 레이저 모듈부
102 수신렌즈 103 레이저 다이오드 및 레이저 발진부
104 신호처리부 105 TOF 알고리즘 계산부
106 레이저측 네트워크 모듈 107 블루투스 OBD
110 센서부 111 초음파 센서
` 112 핸들센서 113 브레이크 페달센서
120 충돌진단부 121 차량모델부
122 네트워크 모듈 130 충돌경고부
131 충돌경고부측 네트워크 모듈 140 차량제어부
141 차량제어부측 네트워크 모듈 142 브레이크 컨트롤러
143 서보드라이브 150 액츄에이터
100 Speed Sensor 101 Laser Module
102 Receiver lens 103 Laser diode and laser oscillator
104 Signal Processing Unit 105 TOF Algorithm Computing Unit
106 Laser side network module 107 Bluetooth OBD
110 sensor section 111 ultrasonic sensor
`112 Handle sensor 113 Brake pedal sensor
120 Collision diagnosis unit 121 Vehicle model unit
122 Network module 130 collision warning part
131 Network module of collision warning unit 140 Vehicle control unit
141 Network module at vehicle control unit 142 Brake controller
143 Servo Drive 150 Actuator

Claims (6)

능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치는,
선행차량과의 상대거리를 계산하는 레이저 센서와 운행차량의 속도를 측정하는 블루투스 OBD를 포함하는 속도 감지부;
레이저 센서의 전면 사각지대와 측면으로 접근하는 차량을 검출하고 효과적인 능동제어를 위한 초음파 센서와 운행자의 제어의지여부를 판단하는 핸들센서와 브레이크 페달센서를 포함하는 센서부;
상기 속도 감지부와 상기 센서부로부터 수신한 선행차량과의 상대거리, 측면의 차량 의 유무와 자차의 속도 및 가속도를 이용하여 선행차량의 속도 및 가속도를 연산한 후, 선행차량과의 상대거리, 선행차량의 속도, 가속도, 자차의 속도, 가속도 정보, 측면 장애물 유무를 데이터베이스로 유지 관리하는 차량모델부;
상기 차량모델부의 데이터베이스 정보를 이용하여 충돌위험도를 판단하는 충돌진단부;
상기 충돌진단부로부터 수신한 충돌위험도에 따라 충돌경보를 발생시키는 충돌경고부;
상기 충돌진단부로부터 수신한 충돌위험도에 따라 차량을 감속시키기 위하여 액츄에이터를 제어하는 차량제어부;를 포함하는 것을 특징으로 하는 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치.
Collision avoidance device using low speed near collision avoidance algorithm for active safety,
A speed sensor including a laser sensor for calculating a relative distance to the preceding vehicle and a Bluetooth OBD for measuring the speed of the driving vehicle;
A sensor unit including a steering wheel sensor and a brake pedal sensor for detecting a vehicle approaching the front blind spot and the side of the laser sensor and determining whether the driver is willing to control the ultrasonic sensor for effective active control;
After calculating the speed and acceleration of the preceding vehicle using the relative distance between the speed detecting unit and the preceding vehicle received from the sensor unit, the presence or absence of the vehicle on the side and the speed and acceleration of the own vehicle, the relative distance with the preceding vehicle, A vehicle model unit for maintaining the speed, acceleration, speed of the own vehicle, acceleration information, and the presence of side obstacles of the preceding vehicle in a database;
A collision diagnosis unit for determining a collision risk using the database information of the vehicle model unit;
A collision warning unit for generating a collision alarm according to the collision risk received from the collision diagnosis unit;
Vehicle control unit for controlling the actuator to decelerate the vehicle in accordance with the collision risk received from the collision diagnosis unit; collision prevention apparatus using a low-speed short-range collision avoidance algorithm for active safety.
제 1 항에 있어서,
상기 데이터베이스는 마이크로컨트롤러에서 허용가능한 메모리의 크기로 제한되며, 메모리의 용량을 초과하게 되는 경우에는 과거의 데이터를 삭제하고 최신의 데이터로 계속 업데이트를 하면서 데이터베이스를 최신의 상태로 유지하는 것을 특징으로 하는 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치.
The method of claim 1,
The database is limited to the size of the memory allowable by the microcontroller, and if the capacity of the memory is exceeded, the database is kept up to date while deleting the old data and continuously updating the latest data. Collision avoidance device using low speed near collision avoidance algorithm for active safety.
제 1 항에 있어서,
상기 데이터베이스는 선행차량과의 거리, 선행차량의 속도, 가속도, 운행차량의 속도, 가속도를 이용하여 선행차량 및 자차의 가속도선도 및 감속도선도에 대한 정보를 저장하고 있는 것을 특징으로 하는 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치.
The method of claim 1,
The database stores active safety and acceleration information of the preceding vehicle and the own vehicle using the distance from the preceding vehicle, the speed of the preceding vehicle, the acceleration, the speed of the driving vehicle, and the acceleration. Anti-collision device using low speed near field collision avoidance algorithm.
제 1 항에 있어서,
상기 데이터베이스는 선행차량과의 상대거리, 선행차량의 속도, 가속도, 자차의 속도, 가속도 정보를 이용하여 특정속도 및 특정거리에서 발생할 수 있는 운전자의 평균 감속도를 테이블 형태로 저장하는 것을 특징으로 하는 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치.
The method of claim 1,
The database may store the average deceleration of the driver that may occur at a specific speed and a specific distance in a table form by using a relative distance from the preceding vehicle, the speed of the preceding vehicle, the acceleration, the speed of the own vehicle, and the acceleration information. Collision avoidance device using low speed near collision avoidance algorithm for active safety.
제 1 항에 있어서,
상기 충돌위험도를 판단하는 기준이 되는 거리값은 2.5m를 기준으로 하는 것을 특징으로 하는 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치.
The method of claim 1,
The collision prevention apparatus using a low-speed short-range collision avoidance algorithm for active safety, characterized in that the distance value which is a criterion for determining the collision risk is based on 2.5m.
제 1 항에 있어서,
상기 충돌위험도는 안전단계, 경고단계, 감속단계, 위험단계의 4가지 단계로 구성되며, 가장 안전한 상황인 안전단계를 기준으로 상대속도나 상대가속도 또는 차간거리의 상황이 나빠질 때마다 위험상황이 한단계씩 높아지는 것을 특징으로 하는 능동 안전을 위한 저속 근거리 충돌회피알고리즘을 이용한 충돌방지장치.
The method of claim 1,
The collision risk is composed of four stages: safety stage, warning stage, deceleration stage, and dangerous stage, and the risk situation is one stage whenever the situation of relative speed, relative acceleration, or inter-vehicle deteriorates based on the safety stage, which is the safest situation. An anti-collision device using a low-speed short-range collision avoidance algorithm for active safety characterized in that it increases.
KR1020100129329A 2010-12-16 2010-12-16 The collision avoidance apparatus using low-speed and close-range collision avoidance algorithm for active safety Ceased KR20120067762A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020100129329A KR20120067762A (en) 2010-12-16 2010-12-16 The collision avoidance apparatus using low-speed and close-range collision avoidance algorithm for active safety

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020100129329A KR20120067762A (en) 2010-12-16 2010-12-16 The collision avoidance apparatus using low-speed and close-range collision avoidance algorithm for active safety

Publications (1)

Publication Number Publication Date
KR20120067762A true KR20120067762A (en) 2012-06-26

Family

ID=46686693

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020100129329A Ceased KR20120067762A (en) 2010-12-16 2010-12-16 The collision avoidance apparatus using low-speed and close-range collision avoidance algorithm for active safety

Country Status (1)

Country Link
KR (1) KR20120067762A (en)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101470104B1 (en) * 2012-12-27 2014-12-05 현대자동차주식회사 Apparatus and method for controlling crash prevention of vehicle
US8907839B2 (en) 2012-10-19 2014-12-09 Hyundai Motor Company Method and system for recognizing space of shoulder of road
KR101478063B1 (en) * 2012-11-06 2015-01-02 주식회사 만도 Adaptive cruise control system and control method thereof
KR20160055515A (en) * 2014-11-10 2016-05-18 현대모비스 주식회사 System and method for alarm controlling of dead angle zone
KR20170036525A (en) * 2015-09-24 2017-04-03 현대모비스 주식회사 Apparatus and method for vehicle's automatic drive
US10762798B2 (en) 2016-09-01 2020-09-01 Samsung Electronics Co., Ltd. Autonomous driving method and apparatus
CN117456753A (en) * 2023-12-26 2024-01-26 山东高速信息集团有限公司 Safety early warning method and system between vehicles
WO2025110669A1 (en) * 2023-11-20 2025-05-30 주식회사 경우시스테크 Vehicle approach alarm device and method using single communication module

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8907839B2 (en) 2012-10-19 2014-12-09 Hyundai Motor Company Method and system for recognizing space of shoulder of road
KR101478063B1 (en) * 2012-11-06 2015-01-02 주식회사 만도 Adaptive cruise control system and control method thereof
KR101470104B1 (en) * 2012-12-27 2014-12-05 현대자동차주식회사 Apparatus and method for controlling crash prevention of vehicle
US9037379B2 (en) 2012-12-27 2015-05-19 Hyundai Motor Company Apparatus and method for providing a crash prevention control functionality for a vehicle
KR20160055515A (en) * 2014-11-10 2016-05-18 현대모비스 주식회사 System and method for alarm controlling of dead angle zone
KR20170036525A (en) * 2015-09-24 2017-04-03 현대모비스 주식회사 Apparatus and method for vehicle's automatic drive
US10762798B2 (en) 2016-09-01 2020-09-01 Samsung Electronics Co., Ltd. Autonomous driving method and apparatus
WO2025110669A1 (en) * 2023-11-20 2025-05-30 주식회사 경우시스테크 Vehicle approach alarm device and method using single communication module
CN117456753A (en) * 2023-12-26 2024-01-26 山东高速信息集团有限公司 Safety early warning method and system between vehicles
CN117456753B (en) * 2023-12-26 2024-03-08 山东高速信息集团有限公司 Safety early warning method and system between vehicles

Similar Documents

Publication Publication Date Title
JP6573224B2 (en) Vehicle control device
US11173898B2 (en) Driver assistance system for a motor vehicle
US11217045B2 (en) Information processing system and server
KR20210083220A (en) Advanced Driver Assistance System, Vehicle having the same and method for controlling the vehicle
KR20120067762A (en) The collision avoidance apparatus using low-speed and close-range collision avoidance algorithm for active safety
JP4193425B2 (en) Brake control device for vehicle
US11192549B2 (en) Warning and adjusting the longitudinal speed of a motor vehicle based on the recognized road traffic lights
KR20190055738A (en) Drive assist apparatus
KR101328016B1 (en) Collision avoidance apparatus for car based on laser sensor and ultrasonic sensor and collision avoidance apparatus thereof
JP2019077291A (en) Vehicle control device
CN106985780A (en) Vehicle safety accessory system
JP2003112618A (en) Vehicle braking control device
KR101324746B1 (en) Collision avoidance method considering lane violation car and apparatus thereof
WO2020020525A1 (en) Method for performing an overtaking maneuver including considering a safety distance, analyzing component, driver assistance system, as well as vehicle
JP2019130997A (en) Vehicle controlling apparatus
EP4098501A1 (en) Lateral movement system for collision avoidance
KR101285350B1 (en) Collision avoidance apparatus with adaptive type laser sensor and method using the same
KR102011665B1 (en) Apparatus and method for evalutating adaptive cruise control system for vehicle
JP7409204B2 (en) Vehicle control device
US20250356759A1 (en) Device and method for controlling platooning
KR101328018B1 (en) Collision avoidance method for car at low-speed and short distance and collision avoidance apparatus thereof
JP4204830B2 (en) Vehicle driving support device
JP2019043190A (en) Vehicle control device
KR20120067759A (en) The collision avoiding method according to method collision risk degree at low-speed and short distance in vehicle
KR102526079B1 (en) Vehicle and control method for the same

Legal Events

Date Code Title Description
A201 Request for examination
PA0109 Patent application

Patent event code: PA01091R01D

Comment text: Patent Application

Patent event date: 20101216

PA0201 Request for examination
PE0902 Notice of grounds for rejection

Comment text: Notification of reason for refusal

Patent event date: 20120614

Patent event code: PE09021S01D

PG1501 Laying open of application
E601 Decision to refuse application
PE0601 Decision on rejection of patent

Patent event date: 20120903

Comment text: Decision to Refuse Application

Patent event code: PE06012S01D

Patent event date: 20120614

Comment text: Notification of reason for refusal

Patent event code: PE06011S01I