KR20140073977A - 차량 요레이트센서의 바이어스 획득방법 - Google Patents
차량 요레이트센서의 바이어스 획득방법 Download PDFInfo
- Publication number
- KR20140073977A KR20140073977A KR1020120142057A KR20120142057A KR20140073977A KR 20140073977 A KR20140073977 A KR 20140073977A KR 1020120142057 A KR1020120142057 A KR 1020120142057A KR 20120142057 A KR20120142057 A KR 20120142057A KR 20140073977 A KR20140073977 A KR 20140073977A
- Authority
- KR
- South Korea
- Prior art keywords
- rate sensor
- yaw rate
- bias
- map
- vehicle
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T8/00—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
- B60T8/17—Using electrical or electronic regulation means to control braking
- B60T8/1755—Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve
- B60T8/17551—Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve determining control parameters related to vehicle stability used in the regulation, e.g. by calculations involving measured or detected parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T8/00—Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
- B60T8/17—Using electrical or electronic regulation means to control braking
- B60T8/1755—Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load
- B60G17/015—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements
- B60G17/018—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by the use of a specific signal treatment or control method
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G17/00—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load
- B60G17/015—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements
- B60G17/019—Resilient suspensions having means for adjusting the spring or vibration-damper characteristics, for regulating the distance between a supporting surface and a sprung part of vehicle or for locking suspension during use to meet varying vehicular or surface conditions, e.g. due to speed or load the regulating means comprising electric or electronic elements characterised by the type of sensor or the arrangement thereof
-
- 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
-
- 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
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/05—Attitude
- B60G2400/052—Angular rate
- B60G2400/0523—Yaw rate
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/20—Speed
- B60G2400/204—Vehicle speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2400/00—Indexing codes relating to detected, measured or calculated conditions or factors
- B60G2400/40—Steering conditions
- B60G2400/41—Steering angle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2401/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60G2401/16—GPS track data
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60G—VEHICLE SUSPENSION ARRANGEMENTS
- B60G2800/00—Indexing codes relating to the type of movement or to the condition of the vehicle and to the end result to be achieved by the control action
- B60G2800/70—Estimating or calculating vehicle parameters or state variables
- B60G2800/702—Improving accuracy of a sensor signal
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T2210/00—Detection or estimation of road or environment conditions; Detection or estimation of road shapes
- B60T2210/30—Environment conditions or position therewithin
- B60T2210/36—Global Positioning System [GPS]
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T2230/00—Monitoring, detecting special vehicle behaviour; Counteracting thereof
- B60T2230/03—Overturn, rollover
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60T—VEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
- B60T2250/00—Monitoring, detecting, estimating vehicle conditions
- B60T2250/06—Sensor zero-point adjustment; Offset compensation
- B60T2250/062—Sensor zero-point adjustment; Offset compensation loosing zero-point calibration of yaw rate sensors when travelling on banked roads or in case of temperature variations
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Transportation (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Manufacturing & Machinery (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
Abstract
GPS정보와 차속정보를 통하여 지도정보와의 매칭을 수행하고 도로의 곡률을 판단하는 판단단계; 도로곡률을 조향각정보 및 차속정보로 보정하여 지도기반방향각을 산출하는 산출단계; 및 요레이트센서의 계측값과 지도기반방향각을 비교하여 요레이트센서의 바이어스를 도출하는 도출단계;를 포함하는 차량 요레이트센서의 바이어스 획득방법이 소개된다.
Description
본 발명은 곡선주행 또는 험로주행시에도 요레이트센서 등의 바이어스를 정확하게 탐지하여 차량 방향각과 거동량 산출의 오차를 줄이기 위한 차량 요레이트센서의 바이어스 획득방법에 관한 것이다.
차량에서의 방향각(yaw degree)은 종래에 GPS를 이용해 계산하였으나 그 수신횟수가 초당 1회로 실시간 계산이 힘들고 음영지역에서 오작동의 우려가 있어 Yaw-rate(요레이트) 센서를 이용해 보완하는 방법이 주로 사용되고 있다.
그러나, 차량용 Yaw-rate 센서의 경우 단가 및 사이즈의 제한으로 인해 대부분 MEMs 센서가 사용된다. 이러한 MEMs gyro rate센서는 열 잡음, 지구의 공전 영향 등으로 인해 특유의 bias를 갖고 이는 방향각을 구할 때 오차로 작용하게 된다.
특히 이러한 Yaw-rate bias(바이어스)의 경우 주변환경에 민감하고 그 예측이 어려워 이를 추정하기 위한 다양한 방법들이 연구되고 있다.
본 발명은 지도 정보 중 도로의 곡률 정보를 이용해 Yaw-rate 센서의 bias를 추정하는 방법 및 이를 프로파일링 하여 차량의 방향각 추정의 정확도를 높이는 방법에 관한 것이다. 또한 이 방법은 지도 정보에 따라 Yaw-rate 뿐만 아니라, Roll, Pitch-rate의 bias를 구하는데도 사용될 수 있다.
현재 출시되는 차량의 경우 GPSDR의 일환으로 Yaw-rate 센서를 이용한 방향각 추정 알고리즘이 사용되고 있으며, 이의 정확도를 높이기 위한 Yaw-rate bias 추정 방법은 차량의 주행 상태를 판별하여 정차 상태이거나 직진 주행 상태일 때 Yaw-rate의 평균값을 취하는 것이다.
그러나, 이러한 방법은 해당 주행 상태에서의 Yaw-rate bias는 추정 가능할 수 있으나 이외의 주행상태, 예를 들면 커브 길에서 변화하는 Yaw-rate bias의 추정은 불가능하다. 이는 방향각을 추정할 때 오차로 작용될 수 있으며, 따라서 Yaw-rate를 누적하여 방향각을 구할 때는 Yaw-rate가 꾸준히 변화하는 상황에서의 bias 추정 기법이 요구된다.
종래의 KR10-2006-0032465 A "자이로스코프 영점 설정 장치 및 방법"은 "회전 각속도를 전압으로 출력하는 자이로스코프와, GPS 신호를 수신하는 GPS 수신기와, 상기 자이로스코프에서 출력하는 전압을 디지털화 하는 아날로그/디지털 변환기와, 상기 GPS 수신 결과로부터 차량의 속도와 방향각을 검출하여 차량 직진 주행 여부를 감지하며, 상기 차량 직진 주행이 감지되면 상기 자이로스코프에서 출력하는 전압을 필터링 하여 자이로스코프 영점 기준값을 구하는 제어부를 포함함을 특징으로 하는 자이로스코프 영점 기준값 설정 장치"를 제시하였다. 그러나 이러한 기술에 의할 경우에도 요레이트센서 자체의 오차를 넘어설 수는 없는바, 좀 더 정확한 오차를 산출하여 방향각의 계산에 산입하는 방안이 필요하였던 것이다.
상기의 배경기술로서 설명된 사항들은 본 발명의 배경에 대한 이해 증진을 위한 것일 뿐, 이 기술분야에서 통상의 지식을 가진자에게 이미 알려진 종래기술에 해당함을 인정하는 것으로 받아들여져서는 안 될 것이다.
본 발명은 이러한 문제점을 해결하기 위하여 제안된 것으로, 곡선주행로 등과 같이 요레이트가 꾸준히 변화되는 환경에서도 요레이트센서의 바이어스를 정확히 추종함으로써 좀 더 정확한 방향각을 산출하는 차량 요레이트센서의 바이어스 획득방법을 제공하는데 그 목적이 있다.
상기의 목적을 달성하기 위한 본 발명에 따른 차량 요레이트센서의 바이어스 획득방법은, GPS정보와 차속정보를 통하여 지도정보와의 매칭을 수행하고 도로의 곡률을 판단하는 판단단계; 도로곡률을 조향각정보 및 차속정보로 보정하여 지도기반방향각을 산출하는 산출단계; 및 요레이트센서의 계측값과 지도기반방향각을 비교하여 요레이트센서의 바이어스를 도출하는 도출단계;를 포함한다.
상기 GPS정보에는 위치, 속도 또는 방향각 중 하나 이상의 정보가 포함될 수 있다.
상기 도출단계는 지도기반방향각을 미분하여 지도기반각속도를 도출하고, 지도기반각속도와 요레이트센서의 계측값의 차이를 통하여 요레이트센서의 바이어스를 도출할 수 있다.
상기 도출단계는 지도기반각속도와 요레이트센서의 계측값의 차이를 평균하여 요레이트센서의 바이어스를 도출할 수 있다.
상기 도출단계는, 요레이트센서의 계측값에서 요레이트센서의 바이어스를 제거하여 요레이트센서의 보정값을 계산하는 보정단계;를 더 포함할 수 있다.
상기 보정단계는, 지도기반방향각을 이용하여 요레이트센서의 보정값을 필터링함으로써 필터링된 요레이트센서의 보정값을 얻는 필터단계;를 더 포함할 수 있다.
상기 도출단계는, 요레이트센서의 바이어스를 구간마다 저장하는 저장단계;를 더 포함할 수 있다.
상기 저장단계는, 동일한 구간을 지날 경우 요레이트센서의 바이어스를 다시 도출하고, 기저장된 요레이트센서의 바이어스 저장값과 비교하는 비교단계;를 더 포함할 수 있다.
상기 비교단계는, 요레이트센서의 바이어스 저장값과의 비교를 통해 현재 차량의 거동이상 또는 노면의 이상 여부를 판단하는 체크단계;를 더 포함할 수 있다.
상술한 바와 같은 구조로 이루어진 차량 요레이트센서의 바이어스 획득방법에 따르면, 곡선주행로 등과 같이 요레이트가 꾸준히 변화되는 환경에서도 요레이트센서의 바이어스를 정확히 추종함으로써 좀 더 정확한 방향각을 산출할 수 있다.
또한, Yaw-rate 센서를 이용한 방향각 판단시 정확도가 향상되고, 곡선도로 주행 시에도 변화하는 바이어스를 능동적으로 추정/보정함으로써 방향각 판단 시 정확도가 향상된다.
그리고, 지도 정보에 도로의 경사도(pitch) 및 기울기(roll)등이 포함되어 있다면 Pitch 및 Roll 방향의 Gyro-rate 센서에 대한 bias 추정에도 적용이 가능하다.
또한, 특정 구간의 Gyro bias를 프로파일링 해 해당 구간을 지날 때 적용함으로써 bias 계산 정확도가 향상될 수 있고, 프로파일링 된 bias 값과 계산된 bias 값의 차이를 분석해 차량의 흔들림 상태 및 노면의 상태 추정이 가능하다.
도 1은 본 발명의 일 실시예에 따른 차량 요레이트센서의 바이어스 획득방법의 블록도.
도 2는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법의 지도기반방향각 산출을 나타낸 블록도.
도 3은 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법의 바이어스 도출을 나타낸 블록도.
고 4는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법을 이용한 방향각도출을 나타낸 블록도.
도 5는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법을 이용한 거동 이상을 판단하는 과정을 설명하기 위한 도면.
도 2는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법의 지도기반방향각 산출을 나타낸 블록도.
도 3은 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법의 바이어스 도출을 나타낸 블록도.
고 4는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법을 이용한 방향각도출을 나타낸 블록도.
도 5는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법을 이용한 거동 이상을 판단하는 과정을 설명하기 위한 도면.
이하에서는 첨부된 도면을 참조하여 본 발명의 바람직한 실시 예에 따른 차량 요레이트센서의 바이어스 획득방법에 대하여 살펴본다.
도 1은 본 발명의 일 실시예에 따른 차량 요레이트센서의 바이어스 획득방법의 블록도이고, 도 2는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법의 지도기반방향각 산출을 나타낸 블록도이며, 도 3은 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법의 바이어스 도출을 나타낸 블록도이고, 고 4는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법을 이용한 방향각도출을 나타낸 블록도이다.
본 발명의 차량 요레이트센서의 바이어스 획득방법은 곡선주행로 등과 같이 요레이트가 꾸준히 변화되는 환경에서도 요레이트센서의 바이어스를 정확히 추종함으로써 좀 더 정확한 방향각을 산출하기 위한 것이다.
이를 위한 본 발명의 차량 요레이트센서의 바이어스 획득방법은, GPS정보와 차속정보를 통하여 지도정보와의 매칭을 수행하고 도로의 곡률을 판단하는 판단단계; 도로곡률을 조향각정보 및 차속정보로 보정하여 지도기반방향각을 산출하는 산출단계; 및 요레이트센서의 계측값과 지도기반방향각을 비교하여 요레이트센서의 바이어스를 도출하는 도출단계;를 포함한다.
즉, 우선 판단단꼐에서 지도정보를 기반으로 한 도로의 곡률을 판단하는 과정을 거친다. 그 후 도로의 곡률을 이용하여 이를 조향각 등으로 보정함으로써 정확한 차량의 계산된 방향각을 산출한다. 그리고 도출단계에서 이를 미분하여 각속도로 고치고 그것과 요레이트센서의 계측값의 차이를 통하여 실시간으로 바이어스를 추정하는 것이다.
구체적으로, 먼저 판단단계를 수행한다. 판단단계에서는 GPS정보와 차속정보를 통하여 지도정보와의 매칭을 수행하고 도로의 곡률을 판단한다. 여기에서의 GPS정보에는 위치, 속도 또는 방향각 중 하나 이상의 정보가 포함될 수 있다.
도 2는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법의 지도기반방향각 산출을 나타낸 블록도로서, 지도정보를 불러오고 이에, 현재 차량을 대입한다. 차량의 경우 GPS를 통하여 획득한 기본적인 위치, 속도, 방향각을 대입하여 지도상에 매칭한다. 그리고 이에는 차속정보가 포함되어 차량의 이동거리를 통해 GPS의 정보를 수정할 수 있다. 이러한 과정을 거쳐 현재 차량이 주행하고 있는 도로의 곡률정보를 산출한다.
한편, 산출된 도로곡률을 조향각정보 및 차속정보로 보정하여 지도기반방향각을 산출하는 산출단계를 수행한다. 즉, 도로곡률이 산출된 경우 차량은 그 곡률을 따라 방향각이 변화될 것으로 추정할 수 있다. 따라서, 차량의 도로곡률에 따라 예상궤적을 산출할 경우, 이를 조향각과 차속을 이용하여 도출한 예상궤적과 비교함으로써 예상되는 방향각을 보정할 수 있는 것이다.
또는 현재의 방향각의 경우에는 현재 차량이 위치한 지점의 도로곡률에 따라 차량의 방향각을 결정하되, 이를 현재의 조향각을 대비하여 그 평균값을 내는 등의 방법으로 적절히 보정함으로써 비교적 정확한 차량의 방향각을 알 수 있는 것이다.
이는 어디까지나 지도의 정보에 근거하고 이를 보정한 값으로써 지도기반방향각으로 볼 수 있다.
그리고, 요레이트센서의 계측값과 지도기반방향각을 비교하여 요레이트센서의 바이어스를 도출하는 도출단계를 수행한다. 도 3은 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법의 바이어스 도출을 나타낸 블록도로서, 요레이트센서의 계측값과 지도기반방향각의 차이로부터 요레이트센서의 바이어스를 도출하는 것이다.
이를 위해, 지도기반방향각을 미분하여 지도기반각속도를 도출하고, 지도기반각속도와 요레이트센서의 계측값의 차이를 통하여 요레이트센서의 바이어스를 도출한다.
그리고, 도출단계에서는 지도기반각속도와 요레이트센서의 계측값의 차이를 평균하여 요레이트센서의 바이어스를 도출할 수도 있을 것이다. 요레이트센서의 계측값과 지도기반각속도의 경우 모두 실시간으로 산출되는 값이기 때문이다.
한편, 도 5는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법을 이용한 거동 이상을 판단하는 과정을 설명하기 위한 도면으로서, 상기 도출단계는, 요레이트센서의 계측값에서 요레이트센서의 바이어스를 제거하여 요레이트센서의 보정값을 계산하는 보정단계;를 더 포함할 수 있다. 이는 실제 주행시 도출된 바이어스를 대입하여 실측된 요레이트센서의 계측값의 보정값을 계산하는 것이다.
그리고, 상기 보정단계는, 지도기반방향각을 이용하여 요레이트센서의 보정값을 필터링함으로써 필터링된 요레이트센서의 보정값을 얻는 필터단계;를 더 포함할 수 있다. 필터의 경우 칼만필터, 알파베타필터 등의 다양한 기법을 적용함으로써 보다 정확한 요레이트센서의 보정값을 얻을 수 있는 것이다. 그리고 최종적으로는 이러한 요레이트센서의 보정값을 이용하여 차량의 방향각 산출에 이용하는 것이다.
한편, 도 5는 도 1에 도시된 차량 요레이트센서의 바이어스 획득방법을 이용한 거동 이상을 판단하는 과정을 설명하기 위한 도면으로서, 상기 도출단계는, 요레이트센서의 바이어스를 구간마다 저장하는 저장단계;를 더 포함할 수 있다. 그리고 상기 저장단계는, 동일한 구간을 지날 경우 요레이트센서의 바이어스를 다시 도출하고, 기저장된 요레이트센서의 바이어스 저장값과 비교하는 비교단계;를 더 포함할 수 있다. 또한, 상기 비교단계는, 요레이트센서의 바이어스 저장값과의 비교를 통해 현재 차량의 거동이상 또는 노면의 이상 여부를 판단하는 체크단계;를 더 포함할 수 있다.
즉, 차량이 특정 도로를 지날 때 해당 속도별/구간별로 요레이트센서의 바이어스를 계산하여 저장하고, 나중에 동일 구간을 재주행할 때 저장된 값을 이용하여 요레이트센서의 바이어스를 다시 계산함으로써 정확도를 향상시킬 수 있는 것이다.
또한, 동일 구간을 재주행할 때 저장된 값과 다시 계산된 값의 요레이트센서 바이어스를 비교하여 노면의 상태 또는 차량의 흔들림 상태를 추정할 수 있는 것이다.
상술한 바와 같은 구조로 이루어진 차량 요레이트센서의 바이어스 획득방법에 따르면, 곡선주행로 등과 같이 요레이트가 꾸준히 변화되는 환경에서도 요레이트센서의 바이어스를 정확히 추종함으로써 좀 더 정확한 방향각을 산출할 수 있다.
또한, Yaw-rate 센서를 이용한 방향각 판단시 정확도가 향상되고, 곡선도로 주행 시에도 변화하는 바이어스를 능동적으로 추정/보정함으로써 방향각 판단 시 정확도가 향상된다.
그리고, 지도 정보에 도로의 경사도(pitch) 및 기울기(roll)등이 포함되어 있다면 Pitch 및 Roll 방향의 Gyro-rate 센서에 대한 bias 추정에도 적용이 가능하다.
또한, 특정 구간의 Gyro bias를 프로파일링 해 해당 구간을 지날 때 적용함으로써 bias 계산 정확도가 향상될 수 있고, 프로파일링 된 bias 값과 계산된 bias 값의 차이를 분석해 차량의 흔들림 상태 및 노면의 상태 추정이 가능하다.
본 발명은 특정한 실시예에 관련하여 도시하고 설명하였지만, 이하의 특허청구범위에 의해 제공되는 본 발명의 기술적 사상을 벗어나지 않는 한도 내에서, 본 발명이 다양하게 개량 및 변화될 수 있다는 것은 당 업계에서 통상의 지식을 가진 자에게 있어서 자명할 것이다.
Claims (9)
- GPS정보와 차속정보를 통하여 지도정보와의 매칭을 수행하고 도로의 곡률을 판단하는 판단단계;
도로곡률을 조향각정보 및 차속정보로 보정하여 지도기반방향각을 산출하는 산출단계; 및
요레이트센서의 계측값과 지도기반방향각을 비교하여 요레이트센서의 바이어스를 도출하는 도출단계;를 포함하는 차량 요레이트센서의 바이어스 획득방법. - 청구항 1에 있어서,
상기 GPS정보에는 위치, 속도 또는 방향각 중 하나 이상의 정보가 포함되는 것을 특징으로 하는 차량 요레이트센서의 바이어스 획득방법. - 청구항 1에 있어서,
상기 도출단계는 지도기반방향각을 미분하여 지도기반각속도를 도출하고, 지도기반각속도와 요레이트센서의 계측값의 차이를 통하여 요레이트센서의 바이어스를 도출하는 것을 특징으로 하는 차량 요레이트센서의 바이어스 획득방법. - 청구항 3에 있어서,
상기 도출단계는 지도기반각속도와 요레이트센서의 계측값의 차이를 평균하여 요레이트센서의 바이어스를 도출하는 것을 특징으로 하는 차량 요레이트센서의 바이어스 획득방법. - 청구항 1에 있어서,
상기 도출단계는, 요레이트센서의 계측값에서 요레이트센서의 바이어스를 제거하여 요레이트센서의 보정값을 계산하는 보정단계;를 더 포함하는 것을 특징으로 하는 차량 요레이트센서의 바이어스 획득방법. - 청구항 5에 있어서,
상기 보정단계는, 지도기반방향각을 이용하여 요레이트센서의 보정값을 필터링함으로써 필터링된 요레이트센서의 보정값을 얻는 필터단계;를 더 포함하는 것을 특징으로 하는 차량 요레이트센서의 바이어스 획득방법. - 청구항 1에 있어서,
상기 도출단계는, 요레이트센서의 바이어스를 구간마다 저장하는 저장단계;를 더 포함하는 것을 특징으로 하는 차량 요레이트센서의 바이어스 획득방법. - 청구항 7에 있어서,
상기 저장단계는, 동일한 구간을 지날 경우 요레이트센서의 바이어스를 다시 도출하고, 기저장된 요레이트센서의 바이어스 저장값과 비교하는 비교단계;를 더 포함하는 것을 특징으로 하는 차량 요레이트센서의 바이어스 획득방법. - 청구항 8에 있어서,
상기 비교단계는, 요레이트센서의 바이어스 저장값과의 비교를 통해 현재 차량의 거동이상 또는 노면의 이상 여부를 판단하는 체크단계;를 더 포함하는 것을 특징으로 하는 차량 요레이트센서의 바이어스 획득방법.
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020120142057A KR101417456B1 (ko) | 2012-12-07 | 2012-12-07 | 차량 요레이트센서의 바이어스 획득방법 |
US13/829,077 US20140163808A1 (en) | 2012-12-07 | 2013-03-14 | System and method of acquiring bias of yaw rate sensor for vehicle |
CN201310154304.9A CN103868523A (zh) | 2012-12-07 | 2013-04-28 | 获取车辆的偏航率传感器的偏差的***和方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020120142057A KR101417456B1 (ko) | 2012-12-07 | 2012-12-07 | 차량 요레이트센서의 바이어스 획득방법 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20140073977A true KR20140073977A (ko) | 2014-06-17 |
KR101417456B1 KR101417456B1 (ko) | 2014-07-08 |
Family
ID=50881842
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020120142057A KR101417456B1 (ko) | 2012-12-07 | 2012-12-07 | 차량 요레이트센서의 바이어스 획득방법 |
Country Status (3)
Country | Link |
---|---|
US (1) | US20140163808A1 (ko) |
KR (1) | KR101417456B1 (ko) |
CN (1) | CN103868523A (ko) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20160036922A (ko) * | 2014-09-26 | 2016-04-05 | 현대모비스 주식회사 | 곡률 추정 장치 및 방법 |
US10180335B2 (en) | 2016-09-09 | 2019-01-15 | Hyundai Motor Company | Apparatus and method for estimating direction of vehicle |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11318950B2 (en) | 2016-03-29 | 2022-05-03 | Pioneer Corporation | Calculation apparatus, control method, program and storage medium |
CN108242145B (zh) * | 2016-12-26 | 2020-10-16 | 阿里巴巴(中国)有限公司 | 异常轨迹点检测方法和装置 |
CN108280243B (zh) * | 2017-01-05 | 2021-12-21 | 北京四维图新科技股份有限公司 | 曲率统计可视方法及装置、曲率可视化辅助制图*** |
US10606273B2 (en) * | 2017-04-20 | 2020-03-31 | Baidu Usa Llc | System and method for trajectory re-planning of autonomous driving vehicles |
US20180347993A1 (en) * | 2017-05-31 | 2018-12-06 | GM Global Technology Operations LLC | Systems and methods for verifying road curvature map data |
CN107702727B (zh) * | 2017-09-04 | 2020-02-04 | 武汉光庭科技有限公司 | 一种自动驾驶过程中使车辆位置平滑的装置及方法 |
EP3588135B1 (en) * | 2018-06-28 | 2021-05-05 | Aptiv Technologies Limited | Method of determining an alignment error of an antenna and vehicle with an antenna and a detection device |
KR102634443B1 (ko) * | 2019-03-07 | 2024-02-05 | 에스케이텔레콤 주식회사 | 차량용 센서의 보정 정보 획득 장치 및 방법 |
US20200339134A1 (en) * | 2019-04-23 | 2020-10-29 | GM Global Technology Operations LLC | Method and apparatus for dynamic yaw rate bias estimation |
JP2020006951A (ja) * | 2019-10-17 | 2020-01-16 | パイオニア株式会社 | 算出装置、制御方法、プログラム及び記憶媒体 |
US20210179115A1 (en) * | 2019-12-16 | 2021-06-17 | GM Global Technology Operations LLC | Method and apparatus for monitoring a yaw sensor |
CN113561969B (zh) * | 2021-08-31 | 2023-07-28 | 岚图汽车科技有限公司 | 一种倒车辅助方法及装置 |
CN114326568B (zh) * | 2021-12-21 | 2023-08-25 | 中冶南方工程技术有限公司 | 一种转炉地面车辆定位控制方法和*** |
WO2024030484A1 (en) * | 2022-08-05 | 2024-02-08 | Arriver Software Llc | Yaw rate sensor bias estimation |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3342413B2 (ja) | 1998-07-10 | 2002-11-11 | 本田技研工業株式会社 | ヨーレートセンサの補正装置 |
KR100651397B1 (ko) * | 2004-10-12 | 2006-11-29 | 삼성전자주식회사 | 자이로스코프 영점 설정 장치 및 방법 |
JP4367370B2 (ja) * | 2005-04-13 | 2009-11-18 | 株式会社デンソー | 車両用ナビゲーション装置 |
KR101103532B1 (ko) * | 2006-08-03 | 2012-01-06 | 주식회사 만도 | 차량의 동적 거동 상태 판단을 위한 기준 요레이트 계산방법 |
JP4816340B2 (ja) * | 2006-08-31 | 2011-11-16 | ソニー株式会社 | ナビゲーション装置、位置検出方法及び位置検出プログラム |
JP4720770B2 (ja) * | 2007-04-02 | 2011-07-13 | トヨタ自動車株式会社 | 車両用情報記録システム |
US7957897B2 (en) * | 2007-06-29 | 2011-06-07 | GM Global Technology Operations LLC | GPS-based in-vehicle sensor calibration algorithm |
US8195357B2 (en) * | 2008-04-16 | 2012-06-05 | GM Global Technology Operations LLC | In-vehicle sensor-based calibration algorithm for yaw rate sensor calibration |
US9279882B2 (en) * | 2008-09-19 | 2016-03-08 | Caterpillar Inc. | Machine sensor calibration system |
US9285485B2 (en) * | 2009-11-12 | 2016-03-15 | GM Global Technology Operations LLC | GPS-enhanced vehicle velocity estimation |
US8706347B2 (en) * | 2010-01-19 | 2014-04-22 | GM Global Technology Operations LLC | Diagnosis of wheel alignment using GPS |
US8630779B2 (en) * | 2010-04-09 | 2014-01-14 | Navteq B.V. | Method and system for vehicle ESC system using map data |
-
2012
- 2012-12-07 KR KR1020120142057A patent/KR101417456B1/ko active IP Right Grant
-
2013
- 2013-03-14 US US13/829,077 patent/US20140163808A1/en not_active Abandoned
- 2013-04-28 CN CN201310154304.9A patent/CN103868523A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20160036922A (ko) * | 2014-09-26 | 2016-04-05 | 현대모비스 주식회사 | 곡률 추정 장치 및 방법 |
US10180335B2 (en) | 2016-09-09 | 2019-01-15 | Hyundai Motor Company | Apparatus and method for estimating direction of vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN103868523A (zh) | 2014-06-18 |
KR101417456B1 (ko) | 2014-07-08 |
US20140163808A1 (en) | 2014-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101417456B1 (ko) | 차량 요레이트센서의 바이어스 획득방법 | |
US8195357B2 (en) | In-vehicle sensor-based calibration algorithm for yaw rate sensor calibration | |
EP2519803B1 (en) | Technique for calibrating dead reckoning positioning data | |
CN110274589B (zh) | 一种定位方法及装置 | |
CN111309001B (zh) | 具有基于主方向的坐标校正的航位推算引导***和方法 | |
JP2008215917A (ja) | 位置検出装置および位置検出方法 | |
KR20140093961A (ko) | 센서 시스템의 데이터의 정확성을 독립적으로 평가하기 위한 센서 시스템 | |
JP5074950B2 (ja) | 航法装置 | |
US20100082250A1 (en) | Angular velocity sensor correcting apparatus and method | |
JP2019066193A (ja) | 自車位置検出装置 | |
US11085773B2 (en) | Angular velocity sensor correction device and method for correcting output signal from angular velocity sensor, and direction estimation device and method for estimating direction by correcting output signal from angular velocity sensor | |
CN107462242B (zh) | 车辆测速方法及其装置 | |
JP2019060814A (ja) | 自動運転の自車位置検出装置 | |
JP5365606B2 (ja) | 角速度センサ補正装置および角速度センサ補正方法 | |
JP6555033B2 (ja) | 角速度センサ補正装置および角速度センサ補正方法 | |
JP2011191243A (ja) | 車載用ジャイロのオフセット補正装置 | |
JP6503477B2 (ja) | 距離推定装置、距離推定方法及びプログラム | |
KR101428992B1 (ko) | 자동차 주행 궤적의 곡률 계산 장치 및 곡률 보정 방법 | |
JP6495609B2 (ja) | 方位検出装置および方位検出方法 | |
JP2010025618A (ja) | 車両偏向性試験装置、プログラム及び方法 | |
JP6287804B2 (ja) | 方位推定装置および方位推定方法 | |
US20080121055A1 (en) | System and method for reducing attitude errors for exoatmospheric devices | |
JP6372339B2 (ja) | 角速度センサ補正装置および角速度センサ補正方法 | |
JP6369320B2 (ja) | 角速度センサ補正装置および角速度センサ補正方法 | |
JPH08338733A (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 | ||
FPAY | Annual fee payment |
Payment date: 20180628 Year of fee payment: 5 |