KR20180069505A - 차량의 주행 경로 생성장치 및 그 방법 - Google Patents

차량의 주행 경로 생성장치 및 그 방법 Download PDF

Info

Publication number
KR20180069505A
KR20180069505A KR1020160171746A KR20160171746A KR20180069505A KR 20180069505 A KR20180069505 A KR 20180069505A KR 1020160171746 A KR1020160171746 A KR 1020160171746A KR 20160171746 A KR20160171746 A KR 20160171746A KR 20180069505 A KR20180069505 A KR 20180069505A
Authority
KR
South Korea
Prior art keywords
vehicle
lane
average value
curvature
traveling path
Prior art date
Application number
KR1020160171746A
Other languages
English (en)
Other versions
KR102452546B1 (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 KR1020160171746A priority Critical patent/KR102452546B1/ko
Priority to US15/435,935 priority patent/US10049575B2/en
Priority to CN201710151758.9A priority patent/CN108216256B/zh
Publication of KR20180069505A publication Critical patent/KR20180069505A/ko
Application granted granted Critical
Publication of KR102452546B1 publication Critical patent/KR102452546B1/ko

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/36—Input/output arrangements for on-board computers
    • G01C21/3626—Details of the output of route guidance instructions
    • G01C21/3658—Lane guidance
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/10—Path keeping
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/10—Path keeping
    • B60W30/12—Lane keeping
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06—Road conditions
    • B60W40/072—Curvature of the road
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D21/00—Measuring or testing not otherwise provided for
    • G01D21/02—Measuring two or more variables by means not covered by a single other subclass
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P1/00—Details of instruments
    • G01P1/02—Housings
    • G01P1/026—Housings for speed measuring devices, e.g. pulse generator
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/16—Anti-collision systems
    • G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/10—Longitudinal speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/14—Yaw
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00—Input parameters relating to infrastructure
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00—Input parameters relating to infrastructure
    • B60W2552/30—Road curve radius
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/40—Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404—Characteristics
    • B60W2554/4041—Position
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/80—Spatial relation or speed relative to objects
    • B60W2554/801—Lateral distance
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/114—Yaw movement

Abstract

본 발명은 차량의 주행 경로 생성장치 및 그 방법에 관한 것으로, 차량의 주행 경로 생성장치에 있어서, 차선정보를 검출하는 제1 센서; 자차의 주행속도를 검출하는 제2 센서; 자차의 요 레이트(yaw rate)를 검출하는 제3 센서; 자차에 대한 선행차량의 상대위치를 검출하는 제4 센서; 및 상기 자차의 주행속도와 요 레이트 및 상기 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 상기 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성하는 제어기를 포함한다.

Description

차량의 주행 경로 생성장치 및 그 방법{APPARATUS FOR PATH PLANNING OF VEHICLE AND METHOD THEREOF}
본 발명은 차량의 주행 경로 생성장치 및 그 방법에 관한 것으로, 더욱 상세하게는 카메라의 한계상황(역광, 밝기변화 등)과 도로환경(닳아서 흐려진 차선, 차선에 의한 빛 반사 등) 및 주행환경(선행차량에 의한 차선의 가림 현상, 저속주행 등)으로 인해 차선정보의 신뢰도가 떨어지는 경우에도 안정적으로 주행 경로를 생성할 수 있는 기술에 관한 것이다.
운전자의 조향을 보조하는 기술은 LKAS(Lane Keeping Assist System)을 시작으로 최근에는 운전자 개입 없이 한정된 상황에서 차량 스스로 조향할 수 있는 HDAS(Highway Driving Assist System)으로 확대되고 있다.
차량을 보다 안정적으로 제어하기 위해서는 주행 경로의 생성이 필수적인데, 일반적으로 차로 내에서 안정적인 주행에 필요한 경로를 생성하기 위해 차선정보를 이용하는 것이 보통이다.
종래의 차량의 주행 경로 생성 기술은 카메라를 이용하여 차선정보를 검출한다. 하지만, 카메라의 한계상황(역광, 밝기변화 등)과 도로환경(닳아서 흐려진 차선, 차선에 의한 빛 반사 등) 및 주행환경(선행차량에 의한 차선의 가림 현상, 저속주행 등)에 의해서 차선정보에 대한 신뢰도가 떨어지거나 검출 자체가 불가능한 경우 주행 경로를 생성할 수 없기 때문에 LKAS, HDAS 등의 동작이 해제될 수 있다.
결국, 종래의 기술은 신뢰도가 낮은 차선정보를 검출하거나 아예 차선정보를 검출하지 못하는 경우가 발생하여 LKAS, HDAS 등의 동작 해제를 유발하고, 이러한 LKAS, HDAS 등의 빈번한 동작 해제는 소비자의 차량에 대한 선호도를 떨어뜨리며, 이는 소비자의 신뢰도 하락으로 이어지는 문제점을 유발한다.
대한민국등록특허 제1215219호
상기와 같은 종래 기술의 문제점을 해결하기 위하여, 본 발명은 자차의 주행정보와 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성함으로써, 카메라의 한계상황(역광, 밝기변화 등)과 도로환경(닳아서 흐려진 차선, 차선에 의한 빛 반사 등) 및 주행환경(선행차량에 의한 차선의 가림 현상, 저속주행 등)으로 인해 차선정보의 신뢰도가 떨어지는 경우에도 안정적으로 주행 경로를 생성할 수 있는 차량의 주행 경로 생성장치 및 그 방법을 제공하는데 그 목적이 있다.
본 발명의 목적들은 이상에서 언급한 목적으로 제한되지 않으며, 언급되지 않은 본 발명의 다른 목적 및 장점들은 하기의 설명에 의해서 이해될 수 있으며, 본 발명의 실시예에 의해 보다 분명하게 알게 될 것이다. 또한, 본 발명의 목적 및 장점들은 특허 청구 범위에 나타낸 수단 및 그 조합에 의해 실현될 수 있음을 쉽게 알 수 있을 것이다.
상기 목적을 달성하기 위한 본 발명의 장치는, 차량의 주행 경로 생성장치에 있어서, 차선정보를 검출하는 제1 센서; 자차의 주행속도를 검출하는 제2 센서; 자차의 요 레이트(yaw rate)를 검출하는 제3 센서; 자차에 대한 선행차량의 상대위치를 검출하는 제4 센서; 및 상기 자차의 주행속도와 요 레이트 및 상기 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 상기 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성하는 제어기를 포함한다.
여기서, 상기 차선정보는 좌측 차선의 곡률 변화율과 우측 차선의 곡률 변화율의 평균값(a), 좌측 차선의 곡률과 우측 차선의 곡률의 평균값(b), 좌측 차선에 대한 자차의 헤딩 각도와 우측 차선에 대한 자차의 헤딩 각도의 평균값(c), 좌측 차선에 대한 자차의 위치와 우측 차선에 대한 자차의 위치의 평균값(d)을 포함한다.
또한, 상기 주행궤적은 곡률(f), 헤딩 각도(g), 위치(h)를 포함한다.
또한, 상기 제어기는 자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 미만이면, 상기 주행궤적의 곡률(f)과 상기 차선정보의 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성할 수 있다.
또한, 상기 제어기는 자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 이상이면 상기 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성할 수 있다.
또한, 상기 제어기는 자차의 속도가 제1 임계치 이하이고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성할 수 있다.
또한, 상기 제어기는 자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출된 경우 상기 곡률 변화율의 평균값(a), 곡률의 평균값(b), 헤딩 각도의 평균값(c), 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성할 수 있다.
또한, 상기 제어기는 자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성할 수 있다.
상기 목적을 달성하기 위한 본 발명의 방법은, 차량의 주행 경로 생성방법에 있어서, 제1 센서가 차선정보를 검출하는 단계; 제2 센서가 자차의 주행속도를 검출하는 단계; 제3 센서가 자차의 요 레이트(yaw rate)를 검출하는 단계; 제4 센서가 자차에 대한 선행차량의 상대위치를 검출하는 단계; 및 제어기가 상기 자차의 주행속도와 요 레이트 및 상기 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 상기 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성하는 단계를 포함한다.
여기서, 상기 차선정보는 좌측 차선의 곡률 변화율과 우측 차선의 곡률 변화율의 평균값(a), 좌측 차선의 곡률과 우측 차선의 곡률의 평균값(b), 좌측 차선에 대한 자차의 헤딩 각도와 우측 차선에 대한 자차의 헤딩 각도의 평균값(c), 좌측 차선에 대한 자차의 위치와 우측 차선에 대한 자차의 위치의 평균값(d)을 포함한다.
또한, 상기 주행궤적은 곡률, 헤딩 각도, 위치를 포함한다.
또한, 상기 자차의 주행 경로 생성단계는 자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 미만이면, 상기 주행궤적의 곡률(f)과 상기 차선정보의 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성할 수 있다.
또한, 상기 자차의 주행 경로 생성단계는 상기 자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 이상이면 상기 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성할 수 있다.
또한, 상기 자차의 주행 경로 생성단계는 상기 자차의 속도가 제1 임계치 이하이고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성할 수 있다.
또한, 상기 자차의 주행 경로 생성단계는 상기 자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출된 경우 상기 곡률 변화율의 평균값(a), 곡률의 평균값(b), 헤딩 각도의 평균값(c), 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성할 수 있다.
또한, 상기 자차의 주행 경로 생성단계는 상기 자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성할 수 있다.
상기와 같은 본 발명은, 자차의 주행정보와 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성함으로써, 카메라의 한계상황(역광, 밝기변화 등)과 도로환경(닳아서 흐려진 차선, 차선에 의한 빛 반사 등) 및 주행환경(선행차량에 의한 차선의 가림 현상, 저속주행 등)으로 인해 차선정보의 신뢰도가 떨어지는 경우에도 안정적으로 주행 경로를 생성할 수 있는 효과가 있다.
또한, 본 발명은 자차의 주행정보와 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성함으로써, 선행차량이 이상 거동을 하거나 차선을 변경해도 선행차량을 추종하지 않고 안정적으로 주행 경로를 생성할 수 있는 효과가 있다.
도 1 은 본 발명에 따른 차량의 주행 경로 생성장치에 대한 일실시예 구성도,
도 2 는 본 발명에 따른 차량의 주행 경로 생성장치가 생성한 주행 경로에 대한 일예시도,
도 3 은 본 발명에 따른 차량의 주행 경로 생성장치가 생성한 주행 경로에 대한 다른 일예시도,
도 4 는 본 발명에 따른 차량의 주행 경로 생성방법에 대한 일실시예 흐름도이다.
상술한 목적, 특징 및 장점은 첨부된 도면을 참조하여 상세하게 후술되어 있는 상세한 설명을 통하여 보다 명확해 질 것이며, 그에 따라 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자가 본 발명의 기술적 사상을 용이하게 실시할 수 있을 것이다. 또한, 본 발명을 설명함에 있어서 본 발명과 관련된 공지 기술에 대한 구체적인 설명이 본 발명의 요지를 불필요하게 흐릴 수 있다고 판단되는 경우에 그 상세한 설명을 생략하기로 한다. 이하, 첨부된 도면을 참조하여 본 발명에 따른 바람직한 실시예를 상세히 설명하기로 한다.
도 1 은 본 발명에 따른 차량의 주행 경로 생성장치에 대한 일실시예 구성도이다.
도 1에 도시된 바와 같이, 본 발명에 따른 차량의 주행 경로 생성장치는, 차선인식센서(Lane Recognition Sensor)(10), 차량센서(Vehicle Sensor)(20), 위치검출센서(Location Detection Sensor)(30), 및 제어기(40)를 포함한다.
상기 각 구성요소들에 대해 살펴보면, 먼저 차선인식센서(10)는 제1 센서로서, 카메라에 의해 촬영된 차량의 전방 영상으로부터 차선정보를 인식한다. 이렇게 인식된 차선정보는 일례로 하기의 [수학식 1]과 같이 3차원 방정식의 형태로 표현된다.
[수학식 1]
Figure pat00001
여기서, a는 곡률 변화율(curvature derivative), b는 곡률, c는 헤딩 각도(heading angle), d는 위치(차선과 차량 간의 옵셋)을 각각 의미한다.
참고로, a, b, c, d 값은 각각 평균값일 수 있다. 일반적으로 차선인식센서(10)는 차량을 중심으로 좌측 차선과 우측 차선을 각각 상술한 3차 방정식의 형태로 인식하는데, 본 발명에서는 차량이 좌측 차선과 우측 차선의 사이로 주행하도록 주행 경로를 생성하는 것이 바람직한바, 좌측 차선의 곡률 변화율과 우측 차선의 곡률 변화율의 평균값(a), 좌측 차선의 곡률과 우측 차선의 곡률의 평균값(b), 좌측 차선에 대한 차량의 헤딩 각도와 우측 차선에 대한 차량의 헤딩 각도의 평균값(c), 좌측 차선에 대한 차량의 위치와 우측 차선에 대한 차량의 위치의 평균값(d)을 이용할 수 있다.
아울러, 차선인식센서(10)는 카메라 모듈에 의해 촬영된 영상으로부터 차선 특징점들을 검출하고, 상기 검출된 차선 특징점들을 차선 방정식에 대입하여 검출된 차선들과 상기 차선 특징점들을 비교하여, 거리 오차가 미리 설정된 임계값 이하가 되는 후보 차선들을 검출하고, 상기 검출된 후보 차선들 중에서 차량에 인접한 차선(차량의 좌측 차선 및 우측 차선)들을 차량의 현재 주행 차선으로 인식할 수 있다.
다음으로, 차량센서(20)는 차량에 구비된 각종 센서로서 속도센서(제2 센서), 요 레이트(yaw rate) 센서(제3 센서)를 포함하며, 이때 속도센서는 차량의 주행속도를 검출하고, 요 레이트 센서는 차량의 요 레이트를 검출한다.
다음으로, 위치검출센서(30)는 제4 센서로서, 자차에 대한 선행차량의 상대위치를 검출한다. 여기서, 상대위치는 자차를 기준으로 검출한 선행차량의 위치를 의미한다.
다음으로, 제어기(40)는 상기 각 구성요소들이 제 기능을 정상적으로 수행할 수 있도록 전반적인 제어를 수행한다.
특히, 제어기(40)는 속도센서에 의해 측정된 자차의 주행속도와 요 레이트 센서에 의해 측정된 요 레이트 및 위치검출센서(30)에 의해 검출된 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출한다. 이때, 선행차량의 주행궤적은 과거부터 현재까지 선행차량이 이동한 위치(Point)들을 대표하는 하나의 방정식이다. 일례로 선행차량의 주행궤적은 하기의 [수학식 2]와 같이 표현될 수 있다.
[수학식 2]
y = fx2 + gx + h
여기서, f는 곡률, g는 헤딩 각도, h는 위치(선행차량의 주행궤적과 자차 간의 옵셋)를 각각 의미한다.
또한, 제어기(40)는 상기 산출된 선행차량의 주행궤적과 상기 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성한다.
일례로, 자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 미만이면, 상기 주행궤적의 곡률(f)과 차선정보의 헤딩 각도의 평균값(c)과 위치의 평균값(d)를 이용하여 자차의 주행 경로를 생성한다. 이는 차선정보가 검출된 경우에 해당한다.
또한, 자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 이상이면 상기 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성한다. 이는 차선정보가 검출된 경우에 해당한다.
또한, 자차의 속도가 제1 임계치 이하이고 상기 차선정보가 검출되지 않은 경우, 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성한다. 이는 선행차량의 주행궤적이 산출된 경우로서, 선행차량의 주행궤적이 산출되지 않은 경우에는 자차의 주행 경로를 생성하지 않는다.
이상은 자차의 속도가 저속인 경우에 대해 살펴봤고, 이하는 자차의 속도가 고속인 경우에 대해 살펴본다.
먼저, 자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출된 경우 상기 곡률 변화율의 평균값(a), 곡률의 평균값(b), 헤딩 각도의 평균값(c), 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성한다.
또한, 자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성한다. 이는 선행차량의 주행궤적이 산출된 경우로서, 선행차량의 주행궤적이 산출되지 않은 경우에는 자차의 주행 경로를 생성하지 않는다.
도 2 는 본 발명에 따른 차량의 주행 경로 생성장치가 생성한 주행 경로에 대한 일예시도이다.
도 2는 자차(210)의 속도가 저속이고, 자차(210)의 좌측 차선(250)과 우측 차선(270)이 존재하며, 선행차량(220)과의 이격거리가 유효거리인 경우에 생성된 자차의 주행 경로(211)를 나타낸다. 여기서, '221'은 선행차량(220)의 주행궤적을 나타낸다.
이 경우, 제어기(40)는 선행차량(220)의 주행궤적에 포함된 곡률과 차선정보에 포함된 헤딩 각도의 평균값(c), 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성한다.
이때, 선행차량(220)과의 이격거리가 유효거리를 초과하면 선행차량(220)의 주행궤적에 포함된 곡률의 신뢰도가 떨어지므로, 선행차량(220)의 주행궤적에 포함된 곡률을 배제한 채, 차선정보에 포함된 헤딩 각도의 평균값(c), 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성한다.
이렇게 자차의 주행 경로를 생성함으로써, 선행차량이 이상 거동을 하거나 차선을 변경해도 선행차량을 추종하지 않고 안정적으로 주행 경로를 생성할 수 있다.
도 3 은 본 발명에 따른 차량의 주행 경로 생성장치가 생성한 주행 경로에 대한 다른 예시도이다.
도 3은 자차(210)의 속도에 관계없이, 자차(210)의 좌측 차선(250)과 우측 차선(270)이 존재하지 않는 경우에 생성된 자차의 주행 경로(211)를 나타낸다. 여기서, '221'은 선행차량(220)의 주행궤적을 나타낸다.
도 3에서, 자차(210)의 좌측 차선(250)과 우측 차선(270)이 존재하지 않으면, 차선정보를 검출할 수 없기 때문에 선행차량의 주행궤적에 기초하여 자차(210)의 주행 경로(211)를 생성한다. 여기서, 자차(210)의 좌측 차선(250)과 우측 차선(270)이 존재하지 않는다는 것은 실제로 차선이 없을 수도 있지만, 카메라의 한계상황(역광, 밝기변화 등)과 도로환경(닳아서 흐려진 차선, 차선에 의한 빛 반사 등) 및 주행환경(선행차량에 의한 차선의 가림 현상 등)으로 인해 차선을 검출하지 못한 경우도 포함된다.
도 4 는 본 발명에 따른 차량의 주행 경로 생성방법에 대한 일실시예 흐름도이다.
먼저, 차선인식센서(10)가 차선정보를 검출한다(401).
그리고 속도센서가 자차의 주행속도를 검출한다(402).
그리고 요레이트 센서가 자차의 요 레이트(yaw rate)를 검출한다(403).
그리고 위치검출센서(30)가 자차에 대한 선행차량의 상대위치를 검출한다(404).
이후, 제어기(40)가 상기 자차의 주행속도와 요 레이트 및 상기 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 상기 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성한다(405).
한편, 전술한 바와 같은 본 발명의 방법은 컴퓨터 프로그램으로 작성이 가능하다. 그리고 상기 프로그램을 구성하는 코드 및 코드 세그먼트는 당해 분야의 컴퓨터 프로그래머에 의하여 용이하게 추론될 수 있다.　또한, 상기 작성된 프로그램은 컴퓨터가 읽을 수 있는 기록매체(정보저장매체)에 저장되고, 컴퓨터에 의하여 판독되고 실행됨으로써 본 발명의 방법을 구현한다. 그리고 상기 기록매체는 컴퓨터가 판독할 수 있는 모든 형태의 기록매체를 포함한다.
이상에서 설명한 본 발명은, 본 발명이 속하는 기술 분야에서 통상의 지식을 가진 자에게 있어 본 발명의 기술적 사상을 벗어나지 않는 범위 내에서 여러 가지 치환, 변형 및 변경이 가능하므로 전술한 실시예 및 첨부된 도면에 의해 한정되는 것이 아니다.
10 : 차선인식센서
20 : 차량센서
30 : 위치검출센서
40 : 제어기

Claims (16)

  1. 차선정보를 검출하는 제1 센서;
    자차의 주행속도를 검출하는 제2 센서;
    자차의 요 레이트(yaw rate)를 검출하는 제3 센서;
    자차에 대한 선행차량의 상대위치를 검출하는 제4 센서; 및
    상기 자차의 주행속도와 요 레이트 및 상기 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 상기 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성하는 제어기
    를 포함하는 차량의 주행 경로 생성장치.
  2. 제 1 항에 있어서,
    상기 차선정보는,
    좌측 차선의 곡률 변화율과 우측 차선의 곡률 변화율의 평균값(a), 좌측 차선의 곡률과 우측 차선의 곡률의 평균값(b), 좌측 차선에 대한 자차의 헤딩 각도와 우측 차선에 대한 자차의 헤딩 각도의 평균값(c), 좌측 차선에 대한 자차의 위치와 우측 차선에 대한 자차의 위치의 평균값(d)을 포함하는 차량의 주행 경로 생성장치.
  3. 제 2 항에 있어서,
    상기 주행궤적은,
    곡률(f), 헤딩 각도(g), 위치(h)를 포함하는 차량의 주행 경로 생성장치.
  4. 제 3 항에 있어서,
    상기 제어기는,
    자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 미만이면, 상기 주행궤적의 곡률(f)과 상기 차선정보의 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성장치.
  5. 제 3 항에 있어서,
    상기 제어기는,
    자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 이상이면 상기 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성장치.
  6. 제 3 항에 있어서,
    상기 제어기는,
    자차의 속도가 제1 임계치 이하이고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성장치.
  7. 제 3 항에 있어서,
    상기 제어기는,
    자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출된 경우 상기 곡률 변화율의 평균값(a), 곡률의 평균값(b), 헤딩 각도의 평균값(c), 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성장치.
  8. 제 3 항에 있어서,
    상기 제어기는,
    자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성장치.
  9. 제1 센서가 차선정보를 검출하는 단계;
    제2 센서가 자차의 주행속도를 검출하는 단계;
    제3 센서가 자차의 요 레이트(yaw rate)를 검출하는 단계;
    제4 센서가 자차에 대한 선행차량의 상대위치를 검출하는 단계; 및
    제어기가 상기 자차의 주행속도와 요 레이트 및 상기 자차에 대한 선행차량의 상대위치에 기초하여 선행차량의 주행궤적을 산출하고, 상기 산출된 선행차량의 주행궤적과 상기 차선정보를 상호 보완적으로 이용하여 자차의 주행 경로를 생성하는 단계
    를 포함하는 차량의 주행 경로 생성방법.
  10. 제 9 항에 있어서,
    상기 차선정보는,
    좌측 차선의 곡률 변화율과 우측 차선의 곡률 변화율의 평균값(a), 좌측 차선의 곡률과 우측 차선의 곡률의 평균값(b), 좌측 차선에 대한 자차의 헤딩 각도와 우측 차선에 대한 자차의 헤딩 각도의 평균값(c), 좌측 차선에 대한 자차의 위치와 우측 차선에 대한 자차의 위치의 평균값(d)을 포함하는 차량의 주행 경로 생성방법.
  11. 제 10 항에 있어서,
    상기 주행궤적은,
    곡률, 헤딩 각도, 위치를 포함하는 차량의 주행 경로 생성방법.
  12. 제 11 항에 있어서,
    상기 자차의 주행 경로 생성단계는,
    자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 미만이면, 상기 주행궤적의 곡률(f)과 상기 차선정보의 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성방법.
  13. 제 11 항에 있어서,
    상기 상기 자차의 주행 경로 생성단계는,
    상기 자차의 속도가 제1 임계치 이하이고 상기 선행차량과의 이격거리가 제2 임계치 이상이면 상기 헤딩 각도의 평균값(c)과 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성방법.
  14. 제 11 항에 있어서,
    상기 자차의 주행 경로 생성단계는,
    상기 자차의 속도가 제1 임계치 이하이고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성방법.
  15. 제 11 항에 있어서,
    상기 자차의 주행 경로 생성단계는,
    상기 자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출된 경우 상기 곡률 변화율의 평균값(a), 곡률의 평균값(b), 헤딩 각도의 평균값(c), 위치의 평균값(d)을 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성방법.
  16. 제 11 항에 있어서,
    상기 자차의 주행 경로 생성단계는,
    상기 자차의 속도가 제1 임계치를 초과하고 상기 차선정보가 검출되지 않은 경우 상기 주행궤적의 곡률, 헤딩 각도, 위치를 이용하여 자차의 주행 경로를 생성하는 것을 특징으로 하는 차량의 주행 경로 생성방법.
KR1020160171746A 2016-12-15 2016-12-15 차량의 주행 경로 생성장치 및 그 방법 KR102452546B1 (ko)

Priority Applications (3)

Application Number Priority Date Filing Date Title
KR1020160171746A KR102452546B1 (ko) 2016-12-15 2016-12-15 차량의 주행 경로 생성장치 및 그 방법
US15/435,935 US10049575B2 (en) 2016-12-15 2017-02-17 Apparatus and method for generating path of vehicle
CN201710151758.9A CN108216256B (zh) 2016-12-15 2017-03-14 用于生成车辆的路径的装置和方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020160171746A KR102452546B1 (ko) 2016-12-15 2016-12-15 차량의 주행 경로 생성장치 및 그 방법

Publications (2)

Publication Number Publication Date
KR20180069505A true KR20180069505A (ko) 2018-06-25
KR102452546B1 KR102452546B1 (ko) 2022-10-07

Family

ID=62561912

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020160171746A KR102452546B1 (ko) 2016-12-15 2016-12-15 차량의 주행 경로 생성장치 및 그 방법

Country Status (3)

Country Link
US (1) US10049575B2 (ko)
KR (1) KR102452546B1 (ko)
CN (1) CN108216256B (ko)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6407447B1 (ja) * 2017-01-10 2018-10-17 三菱電機株式会社 走行路認識装置及び走行路認識方法
KR102553247B1 (ko) * 2018-04-27 2023-07-07 주식회사 에이치엘클레무브 전방 차량 추종 제어 시 안전성을 향상할 수 있는 차선 유지 보조 시스템 및 방법
CN108919802B (zh) * 2018-07-04 2021-05-14 百度在线网络技术（北京）有限公司 无人驾驶的车辆行驶方法和装置
JP7087896B2 (ja) * 2018-10-01 2022-06-21 株式会社Soken 走行車線推定装置、走行車線推定方法、及び制御プログラム
US11400926B2 (en) * 2019-12-12 2022-08-02 Aptiv Technologies Limited Adaptive object in-path detection model for automated or semi-automated vehicle operation
US20220348257A1 (en) * 2021-04-28 2022-11-03 Aptiv Technologies Limited System and method of providing evasive steering assist
CN114459487B (zh) * 2022-02-25 2024-02-09 上海联适导航技术股份有限公司 一种对角耙地的路径规划方法、装置、设备及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1120504A (ja) * 1997-07-07 1999-01-26 Honda Motor Co Ltd 車両用走行制御装置
KR101215219B1 (ko) 2010-12-14 2012-12-24 주식회사 만도 차선유지가 가능한 차량제어시스템
JP2014135016A (ja) * 2013-01-11 2014-07-24 Nippon Soken Inc 車両走行支援装置
JP2014151906A (ja) * 2013-02-07 2014-08-25 Mando Corp 車線維持制御システム、方法及びコンピュータ読取可能な記録媒体
JP2015210720A (ja) * 2014-04-28 2015-11-24 トヨタ自動車株式会社 運転支援装置

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3320894B2 (ja) * 1994-04-26 2002-09-03 マツダ株式会社 自動車の走行路推定装置
JP2003296899A (ja) 2002-03-29 2003-10-17 Toyota Central Res & Dev Lab Inc 先行車両判定装置
DE102004028404A1 (de) 2004-06-14 2006-01-19 Daimlerchrysler Ag Verfahren zur Schätzung des Verlaufs einer Fahrspur eines Kraftfahrzeuges
JP5286214B2 (ja) * 2009-09-30 2013-09-11 日立オートモティブシステムズ株式会社 車両制御装置
KR101249366B1 (ko) 2011-10-17 2013-04-01 주식회사 만도 차선 인식 장치 및 차선 인식 방법
EP2806413B1 (en) * 2012-01-20 2016-12-28 Toyota Jidosha Kabushiki Kaisha Vehicle behavior prediction device and vehicle behavior prediction method, and driving assistance device
JP5981332B2 (ja) 2012-12-21 2016-08-31 株式会社日本自動車部品総合研究所 走行経路生成装置
JP6207952B2 (ja) 2013-09-26 2017-10-04 日立オートモティブシステムズ株式会社 先行車認識装置
CN104181923A (zh) * 2014-08-29 2014-12-03 武汉大学 一种基于直线控制器的智能车辆曲线跟踪方法
JP6046190B2 (ja) 2015-03-31 2016-12-14 本田技研工業株式会社 運転支援装置
CN104960522B (zh) * 2015-06-18 2018-09-21 奇瑞汽车股份有限公司 自动跟车系统及其控制方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1120504A (ja) * 1997-07-07 1999-01-26 Honda Motor Co Ltd 車両用走行制御装置
KR101215219B1 (ko) 2010-12-14 2012-12-24 주식회사 만도 차선유지가 가능한 차량제어시스템
JP2014135016A (ja) * 2013-01-11 2014-07-24 Nippon Soken Inc 車両走行支援装置
JP2014151906A (ja) * 2013-02-07 2014-08-25 Mando Corp 車線維持制御システム、方法及びコンピュータ読取可能な記録媒体
JP2015210720A (ja) * 2014-04-28 2015-11-24 トヨタ自動車株式会社 運転支援装置

Also Published As

Publication number Publication date
CN108216256B (zh) 2021-06-01
US10049575B2 (en) 2018-08-14
US20180174459A1 (en) 2018-06-21
CN108216256A (zh) 2018-06-29
KR102452546B1 (ko) 2022-10-07

Similar Documents

Publication Publication Date Title
KR20180069505A (ko) 차량의 주행 경로 생성장치 및 그 방법
JP6506625B2 (ja) 運転支援装置及び運転支援方法
US8830044B2 (en) Driving support device
US10127460B2 (en) Lane boundary line information acquiring device
KR101102144B1 (ko) 차선 유지 제어 방법 및 시스템
US9014917B2 (en) Method and device for adjusting an intervention torque of a steering assistance system
US9108664B2 (en) Control apparatus of vehicle for changing lane and control method of the same
US20140188360A1 (en) Lateral control apparatus of vehicle and control method of the same
KR101850669B1 (ko) 목표 주행 정보 생성 장치 및 주행 제어 장치
JP2009040107A (ja) 画像表示制御装置及び画像表示制御システム
JP2007309757A (ja) 対象物認識装置
US20120206708A1 (en) Method and control unit for robustly detecting a lane change of a vehicle
JP6363518B2 (ja) 区画線認識装置
CN109478065A (zh) 用于车辆的自主驾驶方法
CN110908379A (zh) 基于历史信息的车辆轨迹预测方法、装置及存储介质
KR20220001498A (ko) 자동차의 환경에서 타겟 자동차의 궤적을 예측하기 위한 방법 및 시스템
CN112639906B (zh) 车载器以及判定方法
JP6908439B2 (ja) 区画線認識装置
JP2015221636A (ja) 車線維持支援装置
KR101491315B1 (ko) 차량의 주행제어 장치 및 방법
KR20130005176A (ko) 후측방 차량 감지 장치
KR101826628B1 (ko) 선행 차량 인식 방법과 장치
JP2019202642A (ja) 車両用走行制御装置
JP2015174478A (ja) 車両制御装置
JP6306429B2 (ja) 操舵制御システム

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right
GRNT Written decision to grant