KR101401932B1 - 차선 인식 장치 및 차선 인식 방법 - Google Patents
차선 인식 장치 및 차선 인식 방법 Download PDFInfo
- Publication number
- KR101401932B1 KR101401932B1 KR1020120060708A KR20120060708A KR101401932B1 KR 101401932 B1 KR101401932 B1 KR 101401932B1 KR 1020120060708 A KR1020120060708 A KR 1020120060708A KR 20120060708 A KR20120060708 A KR 20120060708A KR 101401932 B1 KR101401932 B1 KR 101401932B1
- Authority
- KR
- South Korea
- Prior art keywords
- lane
- slope
- offset
- vehicle
- information
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- 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
-
- 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/076—Slope angle of the road
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/105—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/114—Yaw movement
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
- B60W2050/005—Sampling
-
- 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
- B60W2552/15—Road slope
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mathematical Physics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- General Physics & Mathematics (AREA)
- Multimedia (AREA)
- Theoretical Computer Science (AREA)
- Traffic Control Systems (AREA)
- Image Analysis (AREA)
Abstract
본 발명의 일 측면은 차선 정보 추정시 차선 기울기 또는/ 및 차선 오프셋을 연산이 간단하고 연산 부담이 적은 선형 모델을 이용하여 추정함으로써 연산 능력이 낮은 저가의 제어기에서도 실시간 동작이 가능하여 제조비용을 낮출 수 있고, 차선 기울기 또는/ 및 차선 오프셋 추정을 위한 차선 추적을 선형화함으로써 기존에 폭 넓게 사용되고 있는 칼만 필터링 기법 등 선형 제어 기법들을 사용할 수 있어 차선 인식 작업을 보다 간단하고 신뢰성 있게 수행할 수 있는 차선 인식 장치 및 차선 인식 방법을 개시한다.
Description
본 발명은 차선 인식 장치 및 차선 인식 방법에 관한 것으로, 더욱 상세하게는 도로 영상과 차량의 각종 상태정보를 종합하여 차선을 인식하는 차선 인식 장치 및 차선 인식 방법에 관한 것이다.
차선유지보조시스템(Lane Keeping Assistance System), 차선이탈경고시스템(Lane Departure Warning System) 등의 차선 유지 시스템은 차선정보를 이용하여 차선을 인식한다.. 이때, 차선 유지 시스템이 차선을 정확히 인식하기 위해서는 검출된 차선정보가 정확해야만 한다. 이 차선 정보는 차선 오프셋(Offset), 차선 기울기(Heading Angle slope), 도로 곡률(Curvature), 도로 곡률 변화율(Curvature Rate)등을 포함한다. 차선 오프셋은 차량 중심으로부터 차선이 얼마나 떨어져 있는지를 나타낸다. 예를 들면, 차선 오프셋은 차선 중심으로부터 차량 중심까지 거리일 수 있다. 차선의 기울기는 차선과 차량 진행 방향과의 기울기이다.
영상에서 검출한 차선이 일정 시간 이후 어떻게 천이(Transformation)될 수 있는지를 자차의 운동식(Kinetic-Dynamics Ego Motion)에 의해 계산하여 추정할 수 있다. 차량의 이동에 의한 좌표 변환을 역산해 보는 것이다.
일반적으로 자차의 운동식은 비선형식이다. 따라서 이를 이용한 차선 추적 역시 많은 비선형 항(term)을 포함한다. 이는 계산상 복잡함으로 인해 제어 시스템 구현상 어려움을 야기한다.
또한 이를 구현하여 제품으로 만들기 위해서는 고가의 프로세서를 필요로 하므로 제품의 단가를 높이는 원인이 된다.
본 발명의 일 측면은 차선 정보 추정시 차선의 기울기 또는/ 및 차선의 오프셋을, 연산이 간단하고 연산 부담이 적은 선형 모델을 이용하여 추정할 수 있는 차선 인식 장치 및 차선 인식 방법을 제공한다.
이를 위해 본 발명의 일 측면에 따른 차선 인식 장치는 차량 전방의 도로를 촬영하는 촬영부; 상기 촬영부를 통해 촬영된 도로 영상을 영상 처리 및 영상 분석하여 차선을 검출하는 차선 검출부; 상기 차량의 요레이트를 검출하는 요레이트센서; 상기 차량의 속도를 검출하는 차속센서; 차선과 차량 진행 방향과의 기울기를 나타내는 차선 기울기를, 상기 요레이트센서를 통해 검출된 요레이트 정보, 이전 주기의 차선 기울기 정보 및 이전 주기와 현재 주기 간의 시간차에 의해 결정되는 각도값을 가진 tan 함수값을 이용하여 추정하는 차선 기울기 추정부; 차량 중심으로부터 차선이 얼마나 떨어져 있는지를 나타내는 차선 오프셋을, 상기 차속센서를 통해 검출된 차속 정보, 상기 이전 주기의 차선 기울기, 이전 주기의 오프셋 정보 및 이전 주기와 현재 주기 간의 시간차를 근거로 하여 추정하는 차선 오프셋 추정부; 및 상기 추정된 차선 기울기 정보 및 상기 추정된 차선 오프셋 정보에 기초하여 차선을 추정하고, 상기 추정된 차선과 상기 차선 검출부를 통해 검출된 차선을 비교하며, 상기 비교결과 상기 두 개의 차선간의 차이가 미리 설정된 범위 이내인 경우 추정된 차선을 현재의 차선으로 인식하는 차선 인식부;를 포함한다.
여기서, 상기 차선기울기 추정부는 상기 차선 기울기(C1t+1)를 다음의 식 [1]에 의해 산출하는 것을 포함한다.
이때, C1t 이전 주기의 차선 기울기, ω는 요레이트, Δt는 이전 주기와 현재 주기간의 샘플링 시간 차이이다.
여기서, 상기 차선오프셋 추정부는 상기 차선 오프셋(Cot+1)은 다음의 식 [2]에 의해 산출되는 것을 포함한다.
이때, Cot는 이전 주기의 차선 오프셋, C1t 이전 주기의 차선 기울기, v는 차속, Δt는 이전 주기와 현재 주기간의 샘플링 시간 차이이다.
본 발명의 다른 측면에 따른 차선 인식 방법은 차량 전방의 도로를 촬영하고, 상기 촬영된 도로 영상을 영상 처리 및 영상 분석하여 차선을 검출하고; 요레이트센서를 통해 상기 차량의 요레이트를 검출하고; 차속센서를 통해 상기 차량의 속도를 검출하고, 차선과 차량 진행 방향과의 기울기를 나타내는 차선 기울기를, 상기 검출된 요레이트 정보, 이전 주기의 차선 기울기 정보 및 이전 주기와 현재 주기 간의 시간차에 의해 결정되는 각도값을 가진 tan 함수값을 이용하여 추정하고, 차량 중심으로부터 차선이 얼마나 떨어져 있는지를 나타내는 차선 오프셋을, 상기 검출된 차속 정보, 상기 이전 주기의 차선 기울기, 이전 주기의 오프셋 정보 및 이전 주기와 현재 주기 간의 시간차를 근거로 하여 추정하고, 상기 추정된 차선 기울기 정보 및 상기 추정된 차선 오프셋 정보에 기초하여 차선을 추정하고, 상기 추정된 차선과 상기 차선 검출부를 통해 검출된 차선을 비교하고, 상기 비교결과 상기 두 개의 차선간의 차이가 미리 설정된 범위 이내인 경우 추정된 차선을 현재의 차선으로 인식하는 것을 포함한다.
여기서, 상기 차선기울기 추정은, 상기 차선 기울기(C1t+1)를 다음의 식 [1]에 의해 산출하는 것을 포함한다.
이때, C1t 이전 주기의 차선 기울기, ω는 요레이트, Δt는 이전 주기와 현재 주기간의 샘플링 시간 차이이다.
여기서, 상기 차선오프셋 추정은, 상기 차선 오프셋(Cot+1)을 다음의 식 [2]에 의해 산출하는 것을 포함한다.
이때, Cot는 이전 주기의 차선 오프셋, C1t 이전 주기의 차선 기울기, v는 차속, Δt는 이전 주기와 현재 주기간의 샘플링 시간 차이이다.
이상에서 설명한 본 발명의 일 측면에 따르면, 차선 기울기 또는/ 및 차선 오프셋 추정을 위해 연산 부담이 적은 선형 차선 추적 모델을 구현함으로써 연산 능력이 낮은 저가의 제어기에서도 실시간 동작이 가능하여 제조비용을 낮출 수 있다.
또한, 본 발명의 다른 측면에 따르면, 차선 기울기 또는/ 및 차선 오프셋 추정을 위해 차선 추적 방식을 선형화함으로써 기존에 폭 넓게 사용되고 있는 칼만 필터링 기법 등 선형 제어 기법들을 사용할 수 있어 차선 인식 작업을 보다 간단하고 신뢰성 있게 수행할 수 있다.
도 1은 본 발명의 일실시예에 따른 차선 인식 장치의 제어블록도이다.
도 2는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 기울기 추정부의 작동을 설명하기 위한 도면이다.
도 3은 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 오프셋 추정부의 작동을 설명하기 위한 도면이다.
도 4는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 기울기와 차선 오프셋 추정에 사용되는 차량의 운동식을 설명하기 위한 도면이다.
도 5a 및 도 5b는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 오프셋 추정을 설명하기 위한 도면이다.
도 6은 본 발명의 일실시예에 따른 차선 인식 장치에서 차선을 인식하는 것을 설명하기 위한 제어흐름도이다.
도 2는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 기울기 추정부의 작동을 설명하기 위한 도면이다.
도 3은 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 오프셋 추정부의 작동을 설명하기 위한 도면이다.
도 4는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 기울기와 차선 오프셋 추정에 사용되는 차량의 운동식을 설명하기 위한 도면이다.
도 5a 및 도 5b는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 오프셋 추정을 설명하기 위한 도면이다.
도 6은 본 발명의 일실시예에 따른 차선 인식 장치에서 차선을 인식하는 것을 설명하기 위한 제어흐름도이다.
일반적으로, 차선 정보는 차선 오프셋(Offset), 차선 기울기(Heading Angle Slope), 도로 곡률(Curvature), 도로 곡률 변화율(Curvature Rate)등을 포함해야 한다. 차선이 3차 곡선 모델을 사용한다고 가정하면 차선(yt)을 다음의 식 [1]을 통해 표현할 수 있다.
여기서, 1/(6*C3t)은 도로의 곡률 변화율, 1/(2*C2t)는 도로의 곡률, C1t은 차선의 기울기, C0t는 차선의 오프셋을 나타낸다.
다시 말해, 만약 영상에 보이는 차선 위의 점들의 집합을 위 식 [1]과 같이 표현할 수 있다면, 위 식 [1]을 통해 차선의 정보를 알아낼 수 있는 것이다.
정리하자면, 차속, 요레이트(Yaw Rate)센서 등 다른 센서들부터 들어온 데이터와 CMOS 촬상 소자 등의 촬영장치로부터 획득한 차선 영상을 분석하여 검출한 차선 위의 점들을 식 [1]의 형태로 피팅(fitting)하여 차선 인식을 위한 제어기로 전달한다.
차선 추적은 예측(Prediction) - 입력 - 보정(correction)의 순서로 이루어진다.
최종적으로 제어기로 전달되는 식 [1] 형태의 차선 검출 결과는 두 가지 경로를 통해 생성된 정보들이 융합된 것이다. 촬영장치를 통해 획득한 영상을 분석하여 나온 차선 검출 정보와 추적을 통해 예측된 정보가 정보의 신뢰도를 바탕으로 융합된다. 따라서 차선 추적은 필터링과 미싱(Missing) 대비 이 두 가지 목적을 위해 이루어진다.
첫째, 필터링은 추적하여 예측한 차선과 현재 영상에서 검출한 차선이 크게 다를 경우 이를 걸러 내기 위함이다. 둘째, 미싱 대비는 현재 영상에서 영상 검출에 실패하였지만(예측된 정보가 나오지 않을 경우) 결과를 내어주어야 하는 경우, 추적하고 있던 차선으로 출력하기 위함이다.
이때, 추적은 다양한 방법을 통해 이루어 질 수 있지만 일반적으로 가장 많이 사용되는 방식은 차량의 운동식 모델링(Kinetic - Dynamic Modeling)을 이용하는 것이다. 차량의 이동에 의한 좌표 변환을 역산해 보는 것이다.
그러나 운동식 모델은 비선형적 요소들을 포함하고 있기 때문에 제한적인 연산 능력을 갖고 있으면서 실시간성을 요하는 임베디드(Embedded) 환경에서 사용이 어렵다.
본 발명의 실시예는 차선 추적 중 예측 과정을 다룬다. 본 발명의 실시예는 비선형 운동식을 몇 가지 가정에 의해 간단한 선형으로 근사하는 모델로 표현하는 방법을 다룬다. 즉, 본 발명의 실시예는 자차의 운동식에 의한 좌표계 변환을 몇 가지 가정에 의해 선형화함으로써 간단한 구현을 가능하게 하며 높은 성능을 기대할 수 있다. 또한 칼만 필터링(kalman filtering)과 같은 기존의 선형 모델 기반 필터링 및 추적(tracking) 시스템에 쉽게 적용이 가능하다는 장점을 갖는다.
특히 본 발명의 실시예에는 차선의 4가지 주요 정보 중 차선 기울기와 차선 오프셋을 예측하는 방법을 다루고 있다. 앞선 시간(time = t)에 추정한 차선 기울기와 차선 오프셋은 차량의 각종 다이나믹 센서(Dynamics Sensor)로부터 들어온 센싱 데이터를 통해 현재 시간(time = t+1)의 차선 기울기와 차선 오프셋을 예측한다.
이하, 첨부된 도면을 참조하여 본 발명의 실시예에 대해 설명한다.
도 1은 본 발명의 일실시예에 따른 차선 인식 장치의 제어블록도이다. 도 2는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 기울기 추정부의 작동을 설명하기 위한 도면이다. 도 3은 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 오프셋 추정부의 작동을 설명하기 위한 도면이다.
도 1에 도시된 바와 같이, 차선 인식 장치는 촬영부(10), 차량센서부(20), 차선 검출부(30), 차선기울기추정부(40), 차선오프셋추정부(50) 및 차선인식부(60)를 포함한다.
촬영부(10)는 도로 예를 들면, 차량 전방의 도로를 촬영하여 도로 영상을 생성한다. 촬영부(10)는 CCD 또는 CMOS 소자를 이용하여 차량 전방의 도로 영상을 촬영할 수 있다. 한편, 본 실시예에서는 촬영부(10)에 마련된 CCD 또는 CMOS 소자를 이용하여 도로 영상을 촬영하는 것에 대해서만 설명하였지만, 외부 카메라로부터 영상을 입력받는 형태로도 구현되는 것도 가능하다.
차량센서부(20)는 요레이트센서(21)와 차속센서(22)를 포함한다. 요레이트센서(21)는 차량이 수직축을 기준으로 회전할 때, 즉 Z축 방향을 기준으로 회전할 때 내부의 프레이트 포크가 진동 변화를 일으키면서 전자적으로 차량의 요 모멘트를 검출한다. 여기서 요 모멘트는 차체의 앞뒤가 좌우측 또는 선회할 때 안쪽 바깥쪽 차륜 쪽으로 이동하려는 힘이다. 차속센서(22)는 차량에 마련된 휠(FL, FR, RL, RR)의 속도에 따른 차량의 종방향 속도를 검출한다.
또한, 차량센서부(20)는 요레이트센서(21)와 차속센서(22)를 이외에도 조향각센서, 횡가속도센서 등 각종 센서를 포함한다.
차선 검출부(30)는 촬영부(10)에 의해 촬영된 도로 영상을 영상 처리 및 영상 분석함으로써 차선을 검출한다. 이때, 검출된 차선은 차선 기울기, 차선 오프셋, 도로 곡률 및 도로 곡률 변화율 등을 포함하는 차선 정보를 포함한다.
차선기울기 추정부(40)는 차선정보 중 차선 기울기를 선형 차량 모델을 이용하여 추정한다.
도 2에 도시된 바와 같이, 차선기울기 추정부(40)는 차선의 기울기를 이전 주기의 차선 기울기 정보와, 요레이트센서(21)를 통해 감지된 요레이트 정보 및 타이머로부터 들어온 샘플링 시간 정보(이전 주기와 현재 주기 간의 시간차)를 근거로 하여 추정한다. 차선 기울기(C1t+1)는 다음의 식 [2]에 의해 산출된다.
여기서, C1t 이전 주기의 차선 기울기, ω는 요레이트이다. 이때, 이전 주기의 차선 기울기는 이전 주기에 상기한 식 [2]에 의해 산출된 값이다.
다시 도 1을 참조하면, 차선오프셋 추정부(50)는 차선정보 중 차선 오프셋을 선형 차량 모델을 이용하여 추정한다.
도 3에 도시된 바와 같이, 차선오프셋 추정부(50)는 차선 오프셋을 이전 주기의 오프셋 정보와, 차선 기울기 정보, 요레이트센서(21)를 통해 감지된 요레이트 정보, 차속센서(22)를 통해 감지된 차속 정보 및 타이머로부터 들어온 샘플링 시간 정보를 근거로 하여 추정한다. 차선 오프셋(Cot+1)은 다음의 식 [3]에 의해 산출된다.
여기서, Cot는 이전 주기의 차선 오프셋, C1t 이전 주기의 차선 기울기, v는 차속이다. 이때, 이전 주기의 차선 오프셋은 이전 주기에 상기한 식 [3]에 의해 산출된 값이다.
차선인식부(60)는 추정된 차선 기울기 정보와 차선 오프셋 정보, 차량센서부(20)로부터 입력된 차량의 각종 상태정보를 종합하여 차선을 추정하고, 추정된 차선과, 차선 검출부(30)를 통해 검출된 차선을 비교하고, 이 두 개의 차선간의 차이가 미리 설정된 범위 이내인 경우 추정된 차선을 현재의 차선으로 인식한다.
이하에서는 차선 기울기와 차선 오프셋이 상기한 식 [2]와 [3]에 의해 산출될 수 있음을 설명한다.
도 4는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 기울기와 차선 오프셋 추정에 사용되는 차량의 운동식을 설명하기 위한 도면이다.
도 4에 도시된 바와 같이, 만약, 샘플링 시간 Δt(Δt = t1 - t0)가 매우 작다면, 단위 시간 동안 차속 v와 단위시간 동안 평균 ω의 요레이트를 갖는 차량은 다음과 같이 원을 따라 이동했다고 가정할 수 있다.
이때, 차량이 미끄러지지 않았다면, t0 에서의 Y방향 속도는 0이다. 이때, 비 구동륜의 Y방향 속도는 0으로 가정할 수 있다.
따라서 y의 변위 Δy 는 원을 따라 움직인 것에만 기인한다.
차량이 이동한 궤적은 원호의 공식에 따라, 다음과 같이 표현되고,
여기서, l는 차량이 이동한 궤적이고, r는 원의 반지름이고, φ는 차량의 헤딩각도를 나타낸다.
이때, 샘플링 시간 Δt가 매우 작다고 가정하면, 차량이 헤딩각도를 바꾸고 직진한 것과 큰 차이가 없으므로, 차량이 이동한 궤적은 다음과 같이 표현할 수 있다.
따라서, 위의 식을 통해 회전 반경 r을 추정할 수 있다.
또한, x와 y의 변위는 다음과 같이 유도할 수 있다.
만약, v = au + b를 만족하는 a와 b를 알고 있고,
y = cx + d를 만족하는 c와 d를 다음과 같이 유도 할 수 있다.
이하에서는 차량의 운동식을 이용하여 차선 기울기와 차선 오프셋을 추정하는 것을 설명한다.
도 5a 및 도 5b는 본 발명의 일실시예에 따른 차선 인식 장치에서 차선 오프셋 추정을 설명하기 위한 도면이다.
도 5a 및 도 5b에 도시된 바와 같이, 샘플링 시간 t = tk에서 찾은 차선 기울기(C1t = Ak)과 오프셋(C0t =bk)을 알고 있을 때, 샘플링 시간 tk+1에의 차선 기울기(C1t+1 = Ak+1)과 오프셋(C0t+1 =bk+1)을 예측할 수 있다.
아주 짧은 Δt(Δt=tk+1- tk ) 동안 도로의 곡률은 변화가 없다고 가정하고 차량의 모션에 의해 시점 변환이 생겨, 차량 좌표계 기준의 차선 기울기와 차선 오프셋이 변한한다고 가정한다면, 이때, 두 시점 간에 좌표계는 다음과 같은 관계를 갖는다.
따라서,
이하 차선 모델 선형화를 설명한다.
차선이 다음과 같은 3차 곡선 모델을 사용한다고 가정했을 때, 상기한 식 [1]과 같이 나타낼 수 있다.
도로의 곡률변화는 극히 미미하다고 가정할 수 있으므로 3차 항은 0으로 가정할 수 있다.
예측 주기 Δt(Δt= tk+1- tk ) = 0.0667sec로, 스펙 상 속도를 최대 180KPH = 50 m/s로 가정하면, x 축 방향 최대 이동거리는 (50 m/s)*(0.0667 sec ) = 3.35m이고, 스펙 상 인식 가능한 최소 반경은 125 이하이다(125>R).
이때, r = 1/2C2 < 125 이고, C2 < 1/250이므로, 예측 시간 동안 x2 텀은 최대 0.0449의 영향을 미칠 수 있다. 즉, 예측 주기 Δt 동안 상기한 식 [1]을 다음과 같이 나타낼 수 있다.
따라서 Δt 동안 차량이 추적해야 하는 차선은 다음 식과 같은 직선 모델로 나타낼 수 있다.
<운동학에 의한 차선의 헤딩각도 추정>
차선 추적에서 상정한 모델은 직선 모델이므로, 즉, 프레임을 고정하면 각도 변화가 없으므로, Δt 후 관측 프레임에서의 차선의 각도 변화는 차량의 모션에 의한 시점 변화에만 기인한다고 볼 수 있다.
샘플링 시간 t에서의 차선 기울기 at의 헤딩각도를 θ 라 하면, 샘플링 시간 t+1에서의 헤딩각도(θt+1)는 다음과 같이 표현할 수 있다.
따라서, 차선 기울기는 다음과 같이 표현할 수 있다.
<운동학에 의한 차선의 오프셋 추정>
샘플링 시간 t+1에서 차선 오프셋은 제1 오프셋(offset1)이다.
만약, 요 모션(Yaw Motion)에 의한 헤딩각도의 변화 없이 전이(Translation)에 의한 변화만 있었다면 샘플링 시간 t+1에서의 차선 오프셋은 제2 오프셋(offset2)와 같다.
제1 오프셋(Offset 1)과 제2 오프셋(offset 2)는 다음과 같은 관계가 성립한다.
Offset1 = Offset2 ×cosφ
이때, offset 2 + Δy = AtΔx + bt = C1tΔx+ C0t 이므로, offset 2는 다음과 같이 정리할 수 있다.
따라서, offset 1은 다음과 같이 나타낼 수 있다.
offset1 = term1+term2+term3
여기서, offset1을 다음과 같이 정리할 수 있다.
따라서, offset1은 다음과 같이 나타낼 수 있다.
따라서, term 1은 다음과 같이 나타낼 수 있다.
정리하면, 차선 기울기 Cot +1은 다음과 같이 나타낼 수 있다.
요약하면, 샘플링 시간 t 에서 찾은 차선의 모델은 다음과 같고,
Δt(=tk+1- tk ) 동안 도로의 곡률은 변화가 없다고 가정하고 차량의 모션에 의해 시점 변환이 생겨, 차량 좌표계 기준의 차선 기울기와 차선 오프셋이 변한다고 가정할 때, 시점 변환 후의 차선은 다음과 같이 예측할 수 있다.
<칼만 모델(Kalman Mode)l 적용>
차선 기울기와 차선 오프셋은 각각 사용하는 좌표계가 다르므로, 두 상기한 두 식은 동일한 시스템 모델을 공유할 수 없다. 따라서, 차선 기울기(C1t+1)를 먼저 추정한 후 차선 오프셋(Cot+1)을 추정하는 방법을 사용할 수 있다.
도 6은 본 발명의 일실시예에 따른 차선 인식 장치에서 차선을 인식하는 것을 설명하기 위한 제어흐름도이다.
도 6을 살펴보면, 먼저 차선 인식 장치는 촬영부(10)를 통해 전방 도로의 영상을 촬영한다(100).
전방 도로의 영상을 촬영한 후 차선 인식장치는 도로 영상을 분석하여 차선을 검출한다(110).
그리고 차선 인식 장치는 요레이트센서(21)를 통해 요레이트를 검출하고(120), 차속센서(22)를 통해 차속을 검출한다(130).
그런 후 차선 인식 장치는 차선기울기를 추정한다(140). 차선기울기(C1t+1)는 상술한 다음의 식[2]에 의해 산출된다.
여기서, C1t 이전 주기의 차선 기울기, ω는 요레이트이다. Δt는 이전 주기와 현재 주기간의 샘플링 시간 차이이다. 차선기울기를 추정할 수 있음으로써 차선과 차량 진행 방향과의 각도인 차선 헤딩각도(θt+1)를 추정할 수 있다.
차선기울기를 추정한 후 차선 인식 장치는 차선오프셋을 추정한다(150). 차선 오프셋(Cot+1)은 상술한 다음의 식 [3]에 의해 산출된다.
여기서, Cot는 이전 주기의 차선 오프셋, Ct 이전 주기의 차선 기울기, v는 차속, Δt는 이전 주기와 현재 주기간의 샘플링 시간 차이이다.
차선기울기와 차선오프셋을 추정한 후 차선 인식 장치는 추정된 차선기울기와 차선오프셋을 근거로 차선을 추정한다(160).
그런 후 차선 인식 장치는 작동모드 160에서 추정된 차선과 작동모드 110에서 검출된 차선을 비교한다(170).
작동모드 170의 비교결과 추정된 차선과 검출된 차선의 차이가 미리 설정된 범위 이내인 경우, 추정된 차선을 현재의 차선으로 인식한다(180).
이 후 인식된 차선을 근거로 하여 차량이 현재의 차선을 유지하도록 제어한다.
10 : 촬영부 20 : 차량센서부
21 : 요레이트센서 22 : 차속센서
30 : 차선 검출부 40 : 차선기울기 추정부
50 : 차선오프셋 추정부 60 : 차선인식부
21 : 요레이트센서 22 : 차속센서
30 : 차선 검출부 40 : 차선기울기 추정부
50 : 차선오프셋 추정부 60 : 차선인식부
Claims (6)
- 차량 전방의 도로를 촬영하는 촬영부;
상기 촬영부를 통해 촬영된 도로 영상을 영상 처리 및 영상 분석하여 차선을 검출하는 차선 검출부;
상기 차량의 요레이트를 검출하는 요레이트센서;
상기 차량의 속도를 검출하는 차속센서;
차선과 차량 진행 방향과의 기울기를 나타내는 차선 기울기를, 상기 요레이트센서를 통해 검출된 요레이트 정보, 이전 주기의 차선 기울기 정보 및 이전 주기와 현재 주기 간의 시간차에 의해 결정되는 각도값을 가진 tan 함수값을 이용하여 추정하는 차선 기울기 추정부;
차량 중심으로부터 차선이 얼마나 떨어져 있는지를 나타내는 차선 오프셋을, 상기 차속센서를 통해 검출된 차속 정보, 상기 이전 주기의 차선 기울기, 이전 주기의 오프셋 정보 및 이전 주기와 현재 주기 간의 시간차를 근거로 하여 추정하는 차선 오프셋 추정부; 및
상기 추정된 차선 기울기 정보 및 상기 추정된 차선 오프셋 정보에 기초하여 차선을 추정하고, 상기 추정된 차선과 상기 차선 검출부를 통해 검출된 차선을 비교하며, 상기 비교결과 상기 두 개의 차선간의 차이가 미리 설정된 범위 이내인 경우 추정된 차선을 현재의 차선으로 인식하는 차선 인식부;를 포함하는 차선 인식 장치. - 차량 전방의 도로를 촬영하고;
상기 촬영된 도로 영상을 영상 처리 및 영상 분석하여 차선을 검출하고,
요레이트센서를 통해 상기 차량의 요레이트를 검출하고,
차속센서를 통해 상기 차량의 속도를 검출하고;
차선과 차량 진행 방향과의 기울기를 나타내는 차선 기울기를, 상기 검출된 요레이트 정보, 이전 주기의 차선 기울기 정보 및 이전 주기와 현재 주기 간의 시간차에 의해 결정되는 각도값을 가진 tan 함수값을 이용하여 추정하고,
차량 중심으로부터 차선이 얼마나 떨어져 있는지를 나타내는 차선 오프셋을, 상기 검출된 차속 정보, 상기 이전 주기의 차선 기울기, 이전 주기의 오프셋 정보 및 이전 주기와 현재 주기 간의 시간차를 근거로 하여 추정하고;
상기 추정된 차선 기울기 정보 및 상기 추정된 차선 오프셋 정보에 기초하여 차선을 추정하고;
상기 추정된 차선과 상기 차선 검출부를 통해 검출된 차선을 비교하고;
상기 비교결과 상기 두 개의 차선간의 차이가 미리 설정된 범위 이내인 경우 추정된 차선을 현재의 차선으로 인식하는 것을 포함하는 차선 인식 방법.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020120060708A KR101401932B1 (ko) | 2012-06-07 | 2012-06-07 | 차선 인식 장치 및 차선 인식 방법 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020120060708A KR101401932B1 (ko) | 2012-06-07 | 2012-06-07 | 차선 인식 장치 및 차선 인식 방법 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20130137270A KR20130137270A (ko) | 2013-12-17 |
KR101401932B1 true KR101401932B1 (ko) | 2014-06-03 |
Family
ID=49983527
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020120060708A KR101401932B1 (ko) | 2012-06-07 | 2012-06-07 | 차선 인식 장치 및 차선 인식 방법 |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR101401932B1 (ko) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9896127B2 (en) | 2014-12-05 | 2018-02-20 | Hyundai Mobis Co., Ltd. | Vehicle steering control apparatus and method for lane keeping |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102203947B1 (ko) | 2014-04-29 | 2021-01-18 | 주식회사 만도 | 차선 유지 보조 시스템 및 그의 차선 유지 제어 방법 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002352226A (ja) * | 2001-05-25 | 2002-12-06 | Nissan Motor Co Ltd | 走行路検出装置 |
JP2009202673A (ja) * | 2008-02-26 | 2009-09-10 | Toyota Motor Corp | 運転支援装置 |
-
2012
- 2012-06-07 KR KR1020120060708A patent/KR101401932B1/ko active IP Right Grant
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002352226A (ja) * | 2001-05-25 | 2002-12-06 | Nissan Motor Co Ltd | 走行路検出装置 |
JP2009202673A (ja) * | 2008-02-26 | 2009-09-10 | Toyota Motor Corp | 運転支援装置 |
Non-Patent Citations (1)
Title |
---|
이준희 외 4인, Cubic 形 차선의 실용적인 추적 방법의 연구. 2012년도 대한전자공학회 하계종합학술대회, 2012.6, 1695-1697 pages * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9896127B2 (en) | 2014-12-05 | 2018-02-20 | Hyundai Mobis Co., Ltd. | Vehicle steering control apparatus and method for lane keeping |
Also Published As
Publication number | Publication date |
---|---|
KR20130137270A (ko) | 2013-12-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102508843B1 (ko) | 서라운드 뷰 영상에서 차량의 자차 동작을 산정하는 방법 및 장치 | |
EP3009789A1 (en) | Monocular-motion-stereo distance estimation method, and monocular-motion-stereo distance estimation apparatus | |
JP2020064046A (ja) | 車両位置決定方法及び車両位置決定装置 | |
JP6222353B2 (ja) | 物標検出装置及び物標検出方法 | |
JP4319928B2 (ja) | 車両状態検知システムおよび車両状態検知方法 | |
US9187051B2 (en) | Method for detecting an imminent rollover of a vehicle | |
US20190347808A1 (en) | Monocular Visual Odometry: Speed And Yaw Rate Of Vehicle From Rear-View Camera | |
US20150235093A1 (en) | Moving Object Recognition Apparatus | |
CN111645679B (zh) | 用于车辆的侧面碰撞风险估计系统 | |
JP2018092483A (ja) | 物体認識装置 | |
EP3596427A1 (en) | Integrated vision-based and inertial sensor systems for use in vehicle navigation | |
JP6011625B2 (ja) | 速度算出装置及び速度算出方法並びに衝突判定装置 | |
JP2009012521A (ja) | 車両の走行支援システム及び走行支援方法 | |
JP2009139324A (ja) | 車両用走行路面検出装置 | |
KR101401932B1 (ko) | 차선 인식 장치 및 차선 인식 방법 | |
JP3660308B2 (ja) | 車両の走行区分線認識装置 | |
JP2018032253A (ja) | キャリブレーション装置、キャリブレーション方法、キャリブレーションプログラム | |
JP2010003253A (ja) | 運動推定装置 | |
US20110304734A1 (en) | Method and apparatus for operating a video-based driver assistance system in a vehicle | |
Park et al. | A novel line of sight control system for a robot vision tracking system, using vision feedback and motion-disturbance feedforward compensation | |
JP2019007739A (ja) | 自己位置推定方法及び自己位置推定装置 | |
JP2010173511A (ja) | 車両用運転支援装置および車両用運転支援方法 | |
JP5425500B2 (ja) | キャリブレーション装置およびキャリブレーション方法 | |
JP3985610B2 (ja) | 車両用走行路認識装置 | |
KR20180137904A (ko) | 차량 주행 정보의 보정 장치 및 방법 |
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 | ||
FPAY | Annual fee payment |
Payment date: 20170320 Year of fee payment: 4 |
|
FPAY | Annual fee payment |
Payment date: 20190403 Year of fee payment: 6 |