KR20040031871A - Navigation guidance for car and method for car navigation guidance using the same - Google Patents

Navigation guidance for car and method for car navigation guidance using the same Download PDF

Info

Publication number
KR20040031871A
KR20040031871A KR1020020061006A KR20020061006A KR20040031871A KR 20040031871 A KR20040031871 A KR 20040031871A KR 1020020061006 A KR1020020061006 A KR 1020020061006A KR 20020061006 A KR20020061006 A KR 20020061006A KR 20040031871 A KR20040031871 A KR 20040031871A
Authority
KR
South Korea
Prior art keywords
vehicle
gyro
speed
scale factor
information
Prior art date
Application number
KR1020020061006A
Other languages
Korean (ko)
Other versions
KR100541485B1 (en
Inventor
김형진
Original Assignee
엘지전자 주식회사
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 엘지전자 주식회사 filed Critical 엘지전자 주식회사
Priority to KR1020020061006A priority Critical patent/KR100541485B1/en
Publication of KR20040031871A publication Critical patent/KR20040031871A/en
Application granted granted Critical
Publication of KR100541485B1 publication Critical patent/KR100541485B1/en

Links

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/09Arrangements for giving variable traffic instructions
    • G08G1/0962Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
    • G08G1/0968Systems involving transmission of navigation instructions to the vehicle
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)

Abstract

PURPOSE: A car navigation guide system and a car navigation guide method by using the same are provided to improve the accuracy of the car navigation by adding gyro scale factor. CONSTITUTION: A car navigation guide system includes a path search server, a communication server, a global positioning system(GPS) satellite and a path guide/deviation determination unit. The path search server supplies a geometry information and a traffic information. The communication server supplies the information to the car navigation system from the path search server. The global positioning system(GPS) satellite supplies the information of the car position. And, the path guide/deviation determination unit is provided with a search path receiving unit, a car position information receiving unit, a geometry information supplying unit, a car drive information extracting unit and a path guide/deviation determining unit.

Description

차량 항법 유도 시스템 및 이를 이용한 차량 항법 유도방법{NAVIGATION GUIDANCE FOR CAR AND METHOD FOR CAR NAVIGATION GUIDANCE USING THE SAME}Vehicle navigation guidance system and vehicle navigation guidance method using the same {NAVIGATION GUIDANCE FOR CAR AND METHOD FOR CAR NAVIGATION GUIDANCE USING THE SAME}

본 발명은 차량 항법 유도 시스템 및 차량 항법 유도방법에 관한 것으로, 보다 구체적으로는 차량에 별도의 유도 장비를 추가하지 않고, 차량 항법 유도의 정밀도를 높일 수 있는 차량 항법 유도 시스템 및 차량 항법 유도방법에 관한 것이다.The present invention relates to a vehicle navigation guidance system and a vehicle navigation guidance method, and more particularly to a vehicle navigation guidance system and a vehicle navigation guidance method that can increase the accuracy of vehicle navigation guidance without adding a separate guidance equipment to the vehicle. It is about.

일반적으로 전형적인 네비게이션(Navigation) 시스템은 표시화면에 표시되는 지도 상에 위치측정장치(Global Positioning System: 이하 'GPS'라 칭함)로부터 수신된 정보를 이용하여 계산된 이동체의 현재위치를 표시하여 준다.In general, a typical navigation system displays the current position of a moving object calculated using information received from a global positioning system (GPS) on a map displayed on a display screen.

또한 상기 네비게이션 시스템은 이동체의 진행 방향, 가고자 하는 목적지까지의 거리, 이동체의 현재 이동속도, 운전자가 주행 전에 설정한 경로, 목적지까지의 최적 경로 등을 표시하여 주는 등 주행에 필요한 각종의 정보를 운전자에게 제공한다.In addition, the navigation system displays various information necessary for driving, such as displaying the moving direction of the moving object, the distance to the destination to be traveled, the current moving speed of the moving object, the path set before the driver, the optimum path to the destination, and the like. To provide.

이러한 차량 주행을 유도하는 네비게이션 시스템(혹은 GPS 위치 장치)은 현재 선박, 항공기, 자동차 등과 같은 각종의 이동체들에 탑재되어 이동체의 현재위치와 이동속도를 확인하거나 이동경로를 결정하기 위해 널리 이용되고 있다.The navigation system (or GPS positioning device) for inducing vehicle driving is currently widely used in various moving objects such as ships, aircrafts, automobiles, etc. to determine the current position and moving speed of the moving object or to determine the moving path. .

특히, 상기 네비게이션 시스템은 이동체의 현재 위치를 GPS에 속하는 복수개의 인공 위성으로부터 위도, 경도, 고도 등을 나타내는 전파를 수신하여 연산한 후 이 현재 위치가 포함되는 지도 정보를 운전자에게 시각적으로 표시시켜 주거나 청각적으로 알려준다.In particular, the navigation system receives and calculates a radio wave indicating latitude, longitude, altitude, etc. from a plurality of satellites belonging to the GPS to display the map information including the current location to the driver. Hear the sound.

도 1은 일반적으로 사용되는 GPS를 이용한 차량 항법 시스템을 도시한 도면이다.1 is a view showing a vehicle navigation system using a GPS that is commonly used.

도 1에 도시된 바와 같이, 일반적으로 위치 추적을 위한 네비게이션 시스템은 CD ROM 등에 수록된 도로 지도 데이터부(1)를 표시부(5)에 디스플레이하고, GPS 수신부(7)로부터 얻은 신호와 센서부(11)로부터 얻은 신호를 하이브리드 방식(Hybrid Type)으로 계산하여 차량의 현재 위치를 상기 표시부(5) 상에 휘점으로 표시하는 방식이다.As shown in FIG. 1, in general, a navigation system for location tracking displays a road map data portion 1 recorded on a CD ROM or the like on a display portion 5, and a signal and sensor portion 11 obtained from a GPS receiver 7. In this way, the signal obtained from the above is calculated in a hybrid type to display the current position of the vehicle as a bright point on the display unit 5.

상기 GPS 수신부(7)와 CPU(3)는 인공 위성(9)으로부터 발사된 전파의 도달시간을 계측하여 위성으로부터의 거리를 계산함으로써 차량의 위도와 경도를 제공한다.The GPS receiver 7 and the CPU 3 provide the latitude and longitude of the vehicle by measuring the arrival time of the radio wave emitted from the satellite 9 and calculating the distance from the satellite.

그러나, 대도시의 빌딩 숲이나 터널 내부 등에서는 전파의 수신이 불가능하므로,GPS 방식 외에 다른 센서를 추가로 사용하여 차량의 현재위치를 측정하게 된다. 이러한 센서로서, 차량의 진행방향을 측정하기 위한 앵귤러 센서와 주행거리를 측정하기 위한 차륜회전 센서가 사용된다. 상기 앵귤러 센서로 부터 얻어진 차체의 각속도를 적분하면 차량의 진행 방향이 얻어지게 된다.However, since it is impossible to receive radio waves in a building forest or a tunnel in a large city, other sensors other than the GPS method may be used to measure the current position of the vehicle. As such a sensor, an angular sensor for measuring the traveling direction of the vehicle and a wheel rotation sensor for measuring the travel distance are used. By integrating the angular velocity of the vehicle body obtained from the angular sensor, the traveling direction of the vehicle is obtained.

상기 CPU(3)는, 앵귤러 센서로 부터 얻은 각속도를 적분하여 차량의 진행방향(θ)을 얻고 차륜 회전 센서로부터는 차량의 이동거리를 전송받아, 차량의 위치 좌표(X, Y)를 계산하고, 그 결과를 상기 표시부에 디스플레이 한다.The CPU 3 obtains the traveling direction θ of the vehicle by integrating the angular velocity obtained from the angular sensor, receives the moving distance of the vehicle from the wheel rotation sensor, and calculates the position coordinates (X, Y) of the vehicle. The result is displayed on the display unit.

상기 CPU(3)에서는 차량의 시동후 출발 전까지 일정 시간 동안 센서의 특성 오차(ΔG)를 측정하고, 측정된 특성 오차(ΔG)를 이용하여 센서의 각속도를 보정한다.The CPU 3 measures the characteristic error ΔG of the sensor for a predetermined time after the start of the vehicle and starts the vehicle, and corrects the angular velocity of the sensor by using the measured characteristic error ΔG.

일반적으로 차량에 시동이 걸리면 약간의 시간동안 워밍 업을 하게되므로, 차량은 정지한 상태로 있게 된다. 이러한 정지 상태에서 센서가 검출하는 각속도는 0이 되어야 하는데, 이때 검출된 각속도가 0 이 아닌 경우 이 값을 특성오차(ΔG)로 정의하고, 추후 검출되는 센서의 각속도에서 이 값만큼을 빼면 센서의 측정값이 보정된다.In general, when the vehicle is started, the vehicle warms up for some time, so the vehicle remains stationary. In this stop state, the angular velocity detected by the sensor should be 0. If the detected angular velocity is not zero, define this value as the characteristic error (ΔG), and subtract this value from the angular velocity of the sensor to be detected later. The measured value is corrected.

그리고 센서에 의한 차량 항법 보정 방법에는 차량이 주행중인가를 판단한 다음, 주행 중인 차량에 대한 하이브리드(Hybrid) 방식에 의하여 차량의 위치를 계산한다.In the vehicle navigation correction method using the sensor, it is determined whether the vehicle is driving, and then the position of the vehicle is calculated by a hybrid method with respect to the driving vehicle.

통상적으로 차량 주행 시에 적용되는 하이브리드 방식은, 센서의 각속도를 적분하는 진행방향(θ) 및 거리측정 센서의 진행거리에 의한DR(Dead Reckoning ; 비천측 위치측정)방식과 위성과의 거리에 의한 GPS 방식을 혼합하여 차량의 위치를 계산하고, 이를 표시부(5) 상에 디스플레이된 도로 지도에 매칭시켜 좌표 형태로 표시한다.In general, a hybrid method applied when driving a vehicle includes a dead reckoning (DR) method based on a traveling direction (θ) that integrates an angular velocity of a sensor and a traveling distance of a ranging sensor and a distance from a satellite. The GPS system is mixed to calculate the location of the vehicle, and matched with the road map displayed on the display unit 5 to display the coordinates.

상기에서 GPS를 이용한 차량 위치 추적 뿐만 아니라 차량의 자체 내에서 이동하는 위치와 거리를 판단할 수 있는 자립 항법 장치가 사용되었는데, 상기 자립 항법 장치는 차량의 주행 각도, 속력을 이용하여 주행에 따른 기준 점에 대한 차량의 상대적 위치를 계산하기 때문에 입력의 정밀도가 상기 자립 항법 장치의 위치를 파악하는데 중요한 자료가 된다.In addition to the vehicle location tracking using the GPS as well as the independent navigation system that can determine the location and distance to move within the vehicle itself, the independent navigation system is a reference according to the driving using the driving angle and speed of the vehicle Since the relative position of the vehicle is calculated with respect to the point, the accuracy of the input is an important data for determining the position of the self-supporting navigation apparatus.

상기의 자립 항법 장치에 입력되어 차량의 주행 각도와 속력을 판단하는 중요한 장치는 자이로(Gyro)와 스피드 신호(Speed Signal)인데, 이중에서 온도 특성, 기하학적 특성에 영향을 받는 자이로에서 발생하는 신호는 상기 자립 항법 장치의 정밀도에 큰 영향을 미친다.Important devices for inputting the self-supporting navigation device to determine the driving angle and speed of the vehicle are the gyro and the speed signal, among which the signals generated from the gyro affected by the temperature characteristics and geometric characteristics are It greatly affects the precision of the self-supporting navigation apparatus.

상기 자이로에서 사용되는 계수는 자이로 노미널 전압(Gyro Nominal Voltage), 자이로 스케일 펙터(Gyro Scale Factor), 자이로 온도 특성(Gyro Temperature Characteristics)이 있다.Coefficients used in the gyro include a gyro nominal voltage, a gyro scale factor, and a gyro temperature characteristics.

상기에서 나타낸 자이로 계수의 보정을 위해서 종래에는 Gyro 출력을 보정하기 위해 자이로 노미널 전압과 자이로 스케일 펙터를 칼만 필터(Kalman Filter)로 보정하였다. 이때, 상기 보정을 위한 방법은 자이로(Gyro) 출력에 대한 급격한 추정 오류가 없다는 가정 하에서 점진적인 보정을 수행하는 단점을 내재하고 있다.In order to correct the gyro coefficients described above, the gyro nominal voltage and the gyro scale factor are corrected with a Kalman filter to correct the Gyro output. At this time, the method for the correction has a disadvantage of performing a gradual correction under the assumption that there is no sudden estimation error for the gyro (Gyro) output.

이러한 단점을 보완하기 위하여 필터링을 통하여 누적된 오차를 상쇄시키는 방법과 영 속도 보정을 이용하여 차량 정지 시점에서 측정된 자이로 출력의 평균을 이용하여 자이로의 노미널 전압을 보정할 수 있도록 대한민국 특허출원 제 1997-0026015호로 제안하였다.In order to make up for this drawback, the patent application of the Korean Patent Application to correct the nominal voltage of the gyro using the method of offsetting the accumulated error through filtering and the average of the gyro output measured at the time of stopping the vehicle using zero speed correction. Proposed 1997-0026015.

그리고, 이러한 특허출원에서 영 속도 보정을 이용하는 방법에 추가적으로 온도 특성에 따른 자이로 값을 반영하여 차후 보정을 위한 기록을 수행하는 방법을 미국 특허 US 6374190 B2로 제안되었다.In addition, the US patent US 6374190 B2 proposes a method of performing a recording for subsequent correction by reflecting a gyro value according to temperature characteristics in addition to the method using zero speed correction in this patent application.

상기에서 제시한 대한민국 특허와 미국 특허는 누적되는 오차를 정확한 값으로 보정할 수 있는 장점이 있다.The Korean patent and the US patent presented above have the advantage of correcting the accumulated error to an accurate value.

그러나, 상기에서 제안된 특허들은 모두 정지 상태에서의 누적 오차를 보정할 수 있도록 하였기 때문에, 실제 차량이 이동 중인 상태에서는 자이로 동작 특성들이 변동하기 때문에 차량의 항법 유도시 많은 오차를 발생시켰다.However, since all of the patents proposed above can correct the cumulative error in the stationary state, the gyro operation characteristics are changed in the state in which the vehicle is actually moving, causing a lot of errors in the navigation guidance of the vehicle.

즉, 정지 상태에서 자이로 특성을 보정함으로써 자립 항법 장치에 정밀한 입력값을 인가하여 보다 정밀한 위치 추적을 할 수 있도록 하였으나, 이동 중에 자이로의 출력 값이 변동하여 오차를 유발하게 된다.In other words, by correcting the gyro characteristics in the stationary state to apply a precise input value to the self-supporting navigation device to perform a more precise position tracking, the output value of the gyro during the movement fluctuates causing an error.

또한, 정밀한 항법 측정을 위한 자이로 계수 값들 중에서 회전 방향에 대한 자이로 스케일 펙터에 대한 정보에 대하여는 아무런 보정이 없어 보다 정밀한 차량 항법 시스템을 구현하기에는 한계가 있었다.In addition, since there is no correction for the information on the gyro scale factor of the rotation direction among the gyro coefficient values for precise navigation measurement, there is a limit to implement a more accurate vehicle navigation system.

따라서, 자이로를 차량에 탑재하여 사용하는 경우 차량 이동으로 인하여 자이로의 출력값이 크게 영향을 받는 점을 모두 고려할 필요가 있으나, 종래에는 이동중인 자이로의 특성 변화를 고려하지 않았기 때문에 오차 폭이 증대되는 요인이 되었다.Therefore, when the gyro is mounted on a vehicle and used, it is necessary to consider all of the fact that the output value of the gyro is greatly affected by the movement of the vehicle, but in the past, the error width is increased because the characteristic change of the gyro is not considered. It became.

본 발명은, 차량 주행을 유도하는 차량 항법 유도장치에 GPS 위성, 자이로 센서에서 출력되는 값, 스피도미터의 출력 값을 이용하여 자이로 노미널 전압과, 스케일 펙터 값을 보정하도록 함으로써 보다 정밀한 차량 항법을 유도할 수 있는 차량 항법 유도 시스템 및 이를 이용한 차량 항법 유도방법을 제공함에 그 목적이 있다.According to the present invention, a vehicle navigation induction device for driving a vehicle is driven to calibrate a gyro nominal voltage and a scale factor by using a GPS satellite, a value output from a gyro sensor, and an output value of a speedometer to induce more accurate vehicle navigation. An object of the present invention is to provide a vehicle navigation guidance system and a vehicle navigation guidance method using the same.

도 1은 일반적으로 사용되는 GPS를 이용한 차량 항법 시스템을 도시한 도면.1 is a view showing a vehicle navigation system using a GPS generally used.

도 2는 본 발명에 따라 차량 항법 유도 시스템의 구조를 도시한 블록도.Figure 2 is a block diagram showing the structure of a vehicle navigation guidance system in accordance with the present invention.

도 3은 본 발명에 따른 차량 항법 유도 시스템의 자립 항법 장치의 자이로 출력값을 구하기 위한 시스템.3 is a system for obtaining a gyro output value of an autonomous navigation apparatus of a vehicle navigation guidance system according to the present invention.

도 4 및 도 5는 본 발명에 따른 자이로 동적 특성에 따른 자이로 노미널 전압 보정 방법을 설명하기 위한 플로 챠트.4 and 5 is a flow chart for explaining a gyro nominal voltage correction method according to the gyro dynamic characteristics according to the present invention.

도 6은 본 발명에 따른 자이로 스케일 펙터 보정방법을 설명하기 위한 플로챠트.6 is a flowchart illustrating a gyro scale factor correction method according to the present invention.

*도면의 주요 부분에 대한 부호의 설명** Description of the symbols for the main parts of the drawings *

20: 차량 항법 유도장치21: 경로 안내/이탈 판단부20: vehicle navigation guidance device 21: route guidance / departure determination unit

22: 탐색 경로 수신부23: 경로 탐색부22: search path receiving unit 23: path search unit

24: 지리 정보 공급부25: 차량 위치 정보 수신부24: geographic information supply unit 25: vehicle location information receiving unit

26: 차량 주행 정보 추출부31: 경로 탐색 서버26: vehicle driving information extraction unit 31: route search server

33: 통신 서버35: GPS 위성33: communication server 35: GPS satellite

상기한 목적을 달성하기 위한, 본 발명에 따른 차량 항법 유도 시스템은,In order to achieve the above object, the vehicle navigation guidance system according to the present invention,

지리 정보와, 교통 정보를 공급하는 원거리 경로 탐색 서버;A long distance search server for supplying geographic information and traffic information;

상기 원거리 경로 탐색 서버로부터 차량 항법 유도 장치에 정보를 공급하기 위한 통신 서버;A communication server for supplying information to the vehicle navigation guidance apparatus from the remote path search server;

차량의 위치를 정보를 공급하는 GPS 위성; 및GPS satellites that provide information about the location of the vehicle; And

상기 통신 서버로부터 지리 정보와, 교통 정보를 수신하는 탐색 경로 수신부와, 상기 GPS 위성으로부터 차량의 위치 정보를 수신하는 차량 위치 정보 수신부와, 상기 차량의 자체 내장되어 있는 지리 정보 공급부, 차량 경로 탐색부와, 상기 차량 위치 정보 수신부로부터 주기적으로 차량 주행 정보를 추출하는 차량 주행 정보 추출부와, 상기 탐색 경로 수신부, 차량 위치 정보 수신부, 지리 정보 공급부 및 차량 경로 탐색부를 이용하여 차량을 유도하는 경로 안내/이탈 판단부로 구성된 차량 항법 유도장치; 를 포함하는 것을 특징으로 한다.A search path receiving unit for receiving geographic information and traffic information from the communication server, a vehicle location information receiving unit for receiving location information of the vehicle from the GPS satellites, a geographic information supply unit and a vehicle path searching unit which are built in the vehicle; And a vehicle guide information extracting unit periodically extracting vehicle driving information from the vehicle location information receiving unit, and a route guide for guiding a vehicle using the search path receiving unit, the vehicle location information receiving unit, a geographic information supply unit, and a vehicle path searching unit. A vehicle navigation guidance device composed of a deviation determination unit; Characterized in that it comprises a.

또한, GPS 위성으로부터 차량의 위치 정보를 수신하는 GPS 수신부;In addition, the GPS receiver for receiving location information of the vehicle from the GPS satellites;

차량의 주행 각도와 속력에 대한 정보를 출력하는 자이로 센서부;A gyro sensor unit configured to output information about a driving angle and a speed of the vehicle;

이동하고 있는 차량의 속도 정보를 공급하는 스피드 센서부;A speed sensor unit supplying speed information of a moving vehicle;

상기 GPS 수신부, 자이로 센서부 및 스피드 센서부에서 공급되는 데이터를 처리하는 드라이버부;A driver unit for processing data supplied from the GPS receiver, a gyro sensor unit, and a speed sensor unit;

상기 드라이버부에서 처리된 상기 자이로 센서부와 스피드 센서부의 각속도, 속도를 적분한 진행 방향 및 진행 거리를 측정하는 DR;DR for measuring the travel direction and travel distance integrating the angular velocity and speed of the gyro sensor unit and the speed sensor unit processed by the driver unit;

상기 DR에서 처리된 정보에서 스피드 오차를 보정하는 제 1 칼만 필터;A first Kalman filter correcting a speed error in the information processed in the DR;

상기 제 1 칼만 필터에서 공급되는 보정된 오차와 상기 DR에서 공급되는 에러 보상 값의 차를 이용하여 위치 정보를 판단하는 합산기; 및A summer for determining position information by using a difference between a corrected error supplied from the first Kalman filter and an error compensation value supplied from the DR; And

상기 합산기의 정보와 상기 GPS 수신부에서 수신된 정보를 이용하여 위치 보정을 하는 제 2 칼만 필터; 를 포함하는 것을 특징으로 한다.A second Kalman filter for correcting a position using information of the summer and information received from the GPS receiver; Characterized in that it comprises a.

여기서 상기 제 1 칼만 필터와 제 2 칼만 필터에서는 상기 자이로 센서부에서의 자이로 노미널 전압 계수, 자이로 스케일 펙터 계수 정보를 보정하는 것을 특징으로 한다.The first Kalman filter and the second Kalman filter may be configured to correct gyro nominal voltage coefficients and gyro scale factor coefficient information of the gyro sensor unit.

또한, 본 발명의 다른 실시 예에 의한 차량 항법 유도 방법은,In addition, the vehicle navigation guidance method according to another embodiment of the present invention,

차량 항법 유도 장치의 자이로 노미널 전압을 초기화하는 단계;Initializing a gyro nominal voltage of the vehicle navigation guidance device;

차량이 정지 상태인지 이동중인지를 판단하는 단계;Determining whether the vehicle is stationary or moving;

상기 차량이 주행 중인 상태로 판단될 경우에는 GPS 위성으로부터의 수신 상태의 양호도를 확인하는 단계;Checking the goodness of a reception state from a GPS satellite when it is determined that the vehicle is in a driving state;

상기 GPS 수신 상태가 양호한 경우에는 GPS의 방향각 추이가 임계각이하인지를 판단하는 단계;Determining whether the change in the direction angle of the GPS is less than or equal to the critical angle when the GPS reception state is good;

상기 방향각 추이가 임계각 이하인 경우에는 직성 주행으로 판단하고, 주행상태의 시간과 이때의 자이로 노미널 전압을 저장하는 단계;If the direction angle transition is less than or equal to a threshold angle, determining that driving is straight and storing the time of the driving state and the gyro nominal voltage at this time;

상기 주행 상태 시간이 지정 고속 주행 상태 시간보다 큰 경우에는 상기 저장된 자이로 노미널 전압의 평균치를 고속 자이로 노미널 전압으로 수정하는 단계; 및Modifying an average value of the stored gyro nominal voltage to a high speed gyro nominal voltage when the driving state time is greater than a designated high speed driving state time; And

상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링 하는 단계;를 포함하는 것을 특징으로 한다.And modifying the nominal voltage according to the high speed and the low speed based on the modified gyro nominal voltage and filtering the Knman filter of the independent navigation apparatus.

여기서, 상기 차량이 정지상태인 경우에는 정지 상태의 시간과 이때의 자이로 노미널 전압 값을 저장하고, 상기 정지 상태의 시간이 지정 저속 상태 시간 간격보다 큰 경우에는 상기 저장된 노미널 전압의 평균치를 자이로 노미널 전압으로 보정하는 것을 특징으로 한다.Here, when the vehicle is in a stopped state, the stop time and the gyro nominal voltage value at this time are stored. When the stop state is greater than a designated low speed time interval, the average value of the stored nominal voltage is gyro. It is characterized by the correction to the nominal voltage.

그리고, 상기 GPS 위성 수신 상태가 양호하지 않는 경우에는 곧 바로 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링 하는 단계로 넘어 가고, 상기 GPS의 방향각 추이가 임계각보다 큰 경우에는 직선 주행과 곡선 주행을 함께 하고 있는 것으로 판단하여 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링 하는 단계로 넘어 가는 것을 특징으로 한다.If the GPS satellite reception condition is not good, immediately modifying the nominal voltage according to the high speed and the low speed of the vehicle based on the modified gyro nominal voltage and filtering the Kalman filter of the independent navigation apparatus. When the direction angle transition of the GPS is greater than the critical angle, the vehicle is determined to be in a straight line and a curved line, and the vehicle driving speed is based on the modified gyro nominal voltage. It is characterized by going to the step of filtering by the Kalman filter of the autonomous navigation device by modifying.

아울러 상기 주행 상태 시간이 지정 고속 주행 상태 시간보다 작은 경우에는 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링 하는 단계로 넘어 가고, 상기 정지 상태의 시간이 지정 저속 상태 시간 간격보다 작은 경우에는 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링 하는 단계로 넘어 가는 것을 특징으로 한다.In addition, when the driving state time is smaller than the designated high speed driving state time, the vehicle driving speed is modified based on the modified gyro nominal voltage according to the high speed and the low speed, and filtering by the Kalman filter of the independent navigation apparatus. If the stop time is less than the designated low speed time interval, the vehicle driving speed is modified based on the modified gyro nominal voltage according to the high speed and the low speed, and thus the Kalman filter of the independent navigation apparatus Characterized in that it goes to the filtering step.

또한, 본 발명의 또 다른 실시 예에 의한 차량 항법 유도방법은.In addition, the vehicle navigation guidance method according to another embodiment of the present invention.

차량 항법 유도 장치의 자이로 스케일 펙터 값을 초기화하는 단계;Initializing a gyro scale factor value of the vehicle navigation guidance apparatus;

GPS 위성으로부터의 수신 상태와 차량의 속도의 양호도를 확인하는 단계;Confirming a goodness of the reception state from the GPS satellite and the speed of the vehicle;

상기 GPS 수신 상태와 차량의 속도가 양호한 경우에는 GPS의 방향각 추이가 0보다 큰가를 판단하는 단계;Determining whether the direction angle of the GPS is greater than zero when the GPS reception state and the vehicle speed are good;

상기 GPS의 방향각 추이가 0보다 큰 경우에는 우측 방향의 자이로 스케일 펙터 값을 업데이트하는 단계;Updating a gyro scale factor value in a right direction when the direction angle change of the GPS is greater than zero;

상기 업데이트된 자이로 스케일 펙터를 이용하여 자립 항법 장치내의 칼만 필터에서 필터링 하는 단계;Filtering at a Kalman filter in a self-supporting navigation apparatus using the updated gyro scale factor;

상기 보정된 우측 방향의 자이로 스케일 펙터 값(SfN+)을 저장하는 단계;Storing the corrected gyro scale factor value Sf N + in the right direction;

상기 보정된 우측 방향의 자이로 스케일 펙터 값과, 이전에 보정후 저장된 GPS 방향각 추이가 0보다 큰 경우의 좌측 방향의 자이로 스케일 펙터 값(SfN-) 이 같은지를 판단하는 단계; 및Determining whether the corrected gyro scale factor value and the left gyro scale factor value (Sf N− ) when the previously corrected GPS direction angle trend is greater than zero are equal to each other; And

상기 우측과 좌측 방향의 자이로 스케일 펙터 값이 상기 GPS 위성 수신 상태와 차량 속도 상태가 불량한 경우에 구해지는 일측 방향의 자이로 스케일 펙터 값 (SfN+l-)과 비교하여 같은 경우에는 상기 일측 방향의 자이로 스케일 펙터 값을 보정 값으로 하여 저장하는 단계; 를 포함하는 것을 특징으로 한다.When the gyro scale factor values of the right and left directions are the same as those of the one-way gyro scale factor value Sf N + l− , which is obtained when the GPS satellite reception state and the vehicle speed state are poor, Storing the gyro scale factor value as a correction value; Characterized in that it comprises a.

여기서, 상기 GPS 수신 상태와 차량의 속도가 양호하지 않은 경우에는 일측 방향의 스케일 펙터 값의 평균을 업데이트하고, 상기 업데이트된 일측 방향의 자이로 스케일 펙터 값을 자립 항법 장치내의 칼만 필터에서 필터링하며, 상기 GPS 수신 상태와 차량의 속도가 양호하고, GPS의 방향각 추이가 0보다 작은 경우에는 좌측 방향의 자이로 스케일 펙터 값을 업데이트 하는 것을 특징으로 한다.Here, when the GPS reception state and the vehicle speed are not good, the average of the scale factor value in one direction is updated, and the updated gyro scale factor value is filtered by the Kalman filter in the independent navigation apparatus. When the GPS reception state and the speed of the vehicle are good and the direction angle of the GPS is less than 0, the gyro scale factor value of the left direction is updated.

아울러 상기 업데이트된 좌측 방향의 자이로 스케일 펙터 값을 자립 항법 장치내의 칼만 필터에서 필터링하고, 저장하며, 상기 우측과 좌측 방향의 자이로 스케일 펙터 값이 상기 일측 방향의 자이로 스케일 펙터 값(SfN+l-)과 비교하여 다른 경우에는 자이로 스케일 펙터 값을 상기 일측 방향의 자이로 스케일 펙터 값으로 설정하는 것을 특징으로 한다.In addition, the updated gyro scale factor value of the updated left direction is filtered and stored in the Kalman filter in the autonomous navigation apparatus, and the gyro scale factor values of the right and left directions are gyro scale factor values (Sf N + l−). In other cases, the gyro scale factor value is set as the gyro scale factor value in one direction.

본 발명에 의하면, 자이로의 노미널 전압, 스케일 펙터 등의 계수 특성들을 차량의 이동 상태에 따라 독립적으로 각각 보정을 한 다음, 이를 차량의 자립 항법 장치에 적용함으로써 실제 물리적인 자이로 특성과 유사하도록 하여 정밀한 항법을 유도할 수 있는 이점이 있다.According to the present invention, the coefficient characteristics such as the nominal voltage and the scale factor of the gyro are independently corrected according to the moving state of the vehicle, and then applied to the autonomous navigation apparatus of the vehicle so as to be similar to the actual physical gyro characteristics. There is an advantage that can lead to precise navigation.

이하, 첨부한 도면에 의거하여 본 발명의 바람직한 실시 예를 자세히 설명하도록 한다.Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings.

도 2는 본 발명에 따라 차량 항법 유도 시스템의 구조를 도시한 블록도 이다.2 is a block diagram showing the structure of a vehicle navigation guidance system according to the present invention.

도 2에 도시된 바와 같이, GPS 위성과 차량내의 자립 항법 장치를 이용하여 차량 항법을 유도하는 차량 항법 유도 시스템이다. 상기 GPS 위성으로부터는 위치 신호를 수신하여 차량의 위치와 항법에 필요한 부가적인 정보를 구하고, 자이로(Gyro), 스피도미터(Speedometer)의 출력을 이용하여 자립 항법 유도한다.As shown in FIG. 2, a vehicle navigation guidance system that induces vehicle navigation using a GPS satellite and an autonomous navigation device in a vehicle. The GPS satellite receives the position signal to obtain additional information necessary for the position and navigation of the vehicle, and uses the output of a gyro or a speedometer to guide the self-supporting navigation.

차량 항법 유도 시스템은 GPS 위성(35)과 차량 내에 자립 항법을 포함하는 차량 항법 유도 장치(20)에 의하여 이동하는 차량의 위치와 지리적 정보, 주행 정보를 외부로부터 얻을 수 있도록 구성되어 있다.The vehicle navigation guidance system is configured to obtain the position, geographic information, and driving information of a moving vehicle by the GPS satellite 35 and the vehicle navigation guidance device 20 including self-supported navigation in the vehicle.

즉, 이동하는 차량을 중심으로 원거리 경로 탐색을 위하여 지리적 정보와 교통 정보를 원거리 경로 탐색 서버(31)로부터 공급받는다. 상기 원거리 경로 탐색 서버(31)에서는 상기 차량 항법 유도 장치(20)에 지리 정보와 교통 정보를 제공하기 위한 통신 서버(33)에 교통 정보와 지리적 정보를 송신하고, 상기 통신 서버(33)는 인가 받은 교통 정보와 지리적 정보를 상기 차량 항법 유도 장치(20)의 탐색 경로 수신부(22)에 송신한다.That is, the geographical information and the traffic information are supplied from the far path search server 31 for the far path search around the moving vehicle. The long distance search server 31 transmits traffic information and geographical information to a communication server 33 for providing geographic information and traffic information to the vehicle navigation guidance apparatus 20, and the communication server 33 is authorized. The received traffic information and geographic information are transmitted to the search path receiving unit 22 of the vehicle navigation guidance apparatus 20.

또한, 상기 이동중인 차량의 위치 정보를 얻기 위하여 GPS 위성(35)으로부터 현재 위치를 알 수 있는 정보 신호를 상기 차량 항법 유도 장치(20)의 차량 위치 정보 수신부(25)에서 수신한다.In addition, the vehicle position information receiving unit 25 of the vehicle navigation guidance apparatus 20 receives an information signal for knowing the current position from the GPS satellite 35 to obtain the position information of the moving vehicle.

상기 탐색 경로 수신부(22)에서 수신한 차량 이동을 위한 교통 정보, 지리적 정보와 상기 차량 위치 정보 수신부(25)에서 상기 GPS 위성(35)으로부터 수신한 위치 정보를 이용하여 이동 중인 차량의 주행을 유도한다.Induce driving of a moving vehicle by using traffic information, geographic information, and location information received from the GPS satellite 35 in the vehicle location information receiving unit 25 received by the search path receiving unit 22. do.

상기 탐색 경로 수신부(22)와 상기 차량 위치 정보 수신부(25)에서 수신된 정보는 상기 차량 항법 유도 장치(20) 내의 경로 안내/이탈 판단부(21)에 전송되고, 이동중인 차량이 앞으로 진행하게 될 경로를 안내하도록 하면서, 이동하는 경로를 수시로 이탈하였는지를 판단한다.The information received by the search path receiving unit 22 and the vehicle location information receiving unit 25 is transmitted to the path guide / departure determining unit 21 in the vehicle navigation guidance apparatus 20, so that the moving vehicle can move forward. While determining the route to be moved, it is determined whether the moving route is frequently departed.

또한, 상기 경로 안내/이탈 판단부(21)에서는 차량 내에 자체적으로 경로를탐지하는 경로 탐색부(23)로부터 주기적으로 정보를 수신 받는데, 상기 경로 탐색부(23)는 자체적으로 도로망 또는 교통 지도 정보를 저장하고 있는 지리 정보 공급부(24)에서 정보를 얻는다.In addition, the route guidance / departure determination unit 21 periodically receives information from the route search unit 23 that detects a route in the vehicle itself, and the route search unit 23 itself includes road network or traffic map information. The information is obtained from the geographic information supply unit 24 which stores.

상기 지리 정보 공급부(24)에서는 자체 저장된 도로망 정보와 교통 지도 정보를 이용하여 차량이 경로를 이탈하는 것을 방지하기 시키기 위해서 상기 경로 탐색부(23)에 인가하고, 상기 경로 탐색부(23)는 상기 차량 위치 정보 수신부(25)에서 수신한 위치 정보를 함께 상기 경로 안내/이탈 판단부(21)로 전송하여, 상기 탐색 경로 수신부(22)와 차량 위치 정보 수신부(25)로부터 인가되는 정보들과 비교하여 이동 중인 차량을 안내하거나 경로를 이탈하지 않도록 유도한다.The geographic information supplier 24 applies the route search unit 23 to prevent the vehicle from leaving the route using the road network information and the traffic map information stored therein, and the route search unit 23 The location information received by the vehicle location information receiver 25 is also transmitted to the route guide / departure determination unit 21, and compared with the information applied from the search path receiver 22 and the vehicle location information receiver 25. To guide the vehicle in motion or to avoid leaving the route.

상기 차량 위치 정보 수신부(25)에서 상기 경로 탐색부(23)에 전송하는 현재 차량의 위치 정보를 주행 정보 추출부(26)에서 추출하여 이동 중인 차량을 유도하도록 한다.The vehicle information extracting unit 25 extracts the position information of the current vehicle transmitted from the vehicle search unit 25 to the route search unit 23 to guide the moving vehicle.

도 3은 본 발명에 따른 차량 항법 유도 시스템의 자립 항법 장치의 자이로 출력값을 구하기 위한 시스템이다.3 is a system for obtaining a gyro output value of the autonomous navigation apparatus of the vehicle navigation guidance system according to the present invention.

도 3에 도시된 바와 같이, GPS 위성으로부터 차량의 위치 정보 신호를 수신하는 GPS 수신부(41)와, 차량의 각도, 속력에 관한 정보를 얻기 위하여 자이로 노미널 전압, 자이로 스케일 펙터 및 자이로 온도 특성 계수값을 측정하는 자이로 센서부(43)와, 차량의 속도를 측정하는 스피드 센서부(45)와, 상기 GPS 수신부(41), 자이로 센서부(43) 및 스피드 센서부(45)로부터 수신된 정보 신호들의 오차를 보정하기 위한 드라이버(47)와, 상기 드라이버(47)를 통과한 상기 자이로 센서부(43)와스피드 센서부(45)로부터 얻은 정보를 계산하는 DR(Dead Reckoning: 비천측 위치측정 49)와, 상기 DR(49)에서 자이로 각속도를 적분하여 차량의 진행 방향과 거리 측정 값들을 필터링하여 스피드 오차 정보를 보정하는 제 1 칼만 필터(51)와, 상기 제 1 칼만 필터(51)에서 스피드 오차를 보정한 정보와, 상기 DR(49)에서 계산된 값들을 합산하는 합산기(53)와, 상기 합산기(53)에서 합산된 정보와 상기 GPS 수신부(41)로부터 현재 위치 정보를 얻은 정보를 이용하여 위치 오차를 보정하는 제 2 칼만 필터(55)로 구성되어 있다.As shown in FIG. 3, a GPS receiver 41 receiving a vehicle position information signal from a GPS satellite, and a gyro nominal voltage, a gyro scale factor, and a gyro temperature characteristic coefficient for obtaining information about an angle and a speed of the vehicle Information received from the gyro sensor unit 43 for measuring the value, the speed sensor unit 45 for measuring the speed of the vehicle, and the GPS receiver 41, the gyro sensor unit 43 and the speed sensor unit 45 Dead Reckoning (DR) for calculating the information obtained from the driver 47 for correcting the error of the signals and the gyro sensor 43 and the speed sensor 45 passing through the driver 47. 49) and a first Kalman filter 51 for integrating a gyro angular velocity in the DR 49 to filter speed direction information by filtering a traveling direction and distance measurement values of the vehicle, and in the first Kalman filter 51. Positive which corrected speed error And a position error using a summer 53 for summing the values calculated by the DR 49, information obtained by the summer 53, and current position information from the GPS receiver 41. It consists of a second Kalman filter 55 to correct.

상기 DR(49)은 비천측 위치측정 장치로서 상기 자이로 센서부(43)와 스피드 센서부(45)로부터 얻은 각속도, 속도등의 정보에 의하여 적분 처리에 의하여 차량의 진행 방향과 차량의 이동거리에 관한 정보를 얻는다.The DR 49 is an uneven side position measuring device, which is used to determine the traveling direction of the vehicle and the moving distance of the vehicle by integrating processing based on information such as angular velocity and speed obtained from the gyro sensor 43 and the speed sensor 45. Get information about

차량 항법 유도 장치내의 자립 항법 장치에서 상기 제 1 , 제 2 칼만 필터(51, 55)에서 필터링하여 누적 오차를 상쇄하는 방법은 다음과 같은 수식으로 주어진다.A method of canceling the cumulative error by filtering the first and second Kalman filters 51 and 55 in the self-supporting navigation device in the vehicle navigation induction device is given by the following equation.

상기에서 제시한 수식을 이용하면 자이로의 동적 특성에 따른 자이로 노미널 전압(Gyro Nominal Voltage)을 계산할 수 있다.By using the above-described formula, the gyro nominal voltage according to the dynamic characteristics of the gyro can be calculated.

이동중인 차량이 저속으로 운행할 때, 자이로 노미널 전압(ν<VThreshold)은 가장 적절한 값으로 초기화를 하는데, 이전 노미널 전압 값이 저장되어 있는 경우에는 그 값을 사용한다. 그리고 지정 시간 간격(TLow Speed) 이상으로 차량이 정지 상태를 유지하는 경우에는 정지 상태의 영 속도를 보정하여 상기 수식으로 연산한 평균 값으로 보정한다.When the moving vehicle is traveling at low speed, the gyro nominal voltage (ν <V Threshold ) is initialized to the most appropriate value. If the previous nominal voltage value is stored, the value is used. When the vehicle is in the stopped state for more than a predetermined time interval (T Low Speed ), the zero speed of the stopped state is corrected and corrected to the average value calculated by the above formula.

그런 다음, 차량이 저속 상태로 운행을 계속하면 GPS 위성으로부터 수신되는 위치 정보의 신뢰도가 낮으므로 보정을 하지 않는다.Then, if the vehicle continues to run at a low speed, the reliability of the position information received from the GPS satellites is low, and thus no correction is made.

또한, 이동중인 차량이 고속으로 운행할 때, 자이로 노미널 전압(ν<VThreshold)은 저속 주행에 대한 노미널 전압 값을 초기 값으로 하는데, 이전 노미널 전압 값이 저장되어 있는 경우에는 그 값을 사용한다.In addition, when the moving vehicle is traveling at a high speed, the gyro nominal voltage (ν <V Threshold ) is set as an initial value of the nominal voltage for low speed driving, and if the previous nominal voltage value is stored. Use

그런 다음, GPS 위성으로부터 수신되는 신호 상태가 양호한지와 그렇지 않은지를 판단하여, 지정 시간 간격(THigh Speed) 이상 GPS 방향각 추이가 임계 각도 이내를 유지한 경우 상기 영 속도 보정 방식과 동일한 방식으로 노미널 전압을 보정한다.Then, it is determined whether or not the signal state received from the GPS satellite is good or not, and in the same manner as the zero speed correction method when the GPS direction angle trend is maintained within a critical angle for a predetermined time interval (T High Speed ) or more. Correct the nominal voltage.

아울러 고속 주행 상태에서 GPS 위성으로부터 수신된 정보는 저속 주행 때보다 위치 정보의 신뢰도가 높으므로 자이로 노미널 전압 보정을 위하여 GPS 위치 정보를 사용한다.In addition, since the information received from the GPS satellites in the high speed driving state has a higher reliability of the position information than the low speed driving state, the GPS position information is used for the gyro nominal voltage correction.

그리고 상기와 같이 자이로 노미널 전압을 보정할 때에는 동적 특성을 반영하기 위한 GPS의 임계 허용 오차 각도의 범위에 따라 차량이 실제 완만하게 기울어진 방향을 지속적으로 주행할 경우 오차가 발생할 수 있다.When the gyro nominal voltage is corrected as described above, an error may occur when the vehicle continuously runs in a direction that is actually gently inclined according to the range of the critical tolerance angle of GPS for reflecting dynamic characteristics.

또한, 저속과 고속의 노미널 전압 보정 방법이 별도로 적용될 경우에는 스위칭에 대한 오 동작을 억제하기 위해 주기적으로 노미널 전압을 평균하여 완곡하게 하는 방법을 적용한다.In addition, when low-speed and high-speed nominal voltage correction methods are separately applied, a method of periodically averaging the nominal voltage to suppress the malfunction of switching is applied.

그리고, 자이로 계수 값중 종래 기술에서는 고려하지 않았던 자이로 스케일 펙터를 적용하는 방식은 다음과 같다.In addition, a method of applying a gyro scale factor, which has not been considered in the prior art, among the gyro coefficient values is as follows.

상기 자이로 스케일 펙터는 기본적으로 차량의 양방향 회전에 대하여 독립적인 스케일 펙터를 적용할 수 있도록 각 방향에 대한 스케일 펙터를 분리하여 차량 항법을 조절한다.The gyro scale factor basically adjusts the vehicle navigation by separating the scale factor in each direction so that an independent scale factor may be applied to bidirectional rotation of the vehicle.

먼저 양방향 자이로 스케일 펙터(Gyro Scale Factor)를 관리(SfN+, SfN-)하기위하여 기존 자이로 스케일 펙터 보정을 위해 사용되는 스케일 펙터를 분리하고, 좌우 스케일 펙터의 차가 임계 오차를 초과한 경우 양방향 스케일 펙터 값의 평균을 구한다. 그리고 저속 주행과 고속 주행 간의 스케일 펙터 차를 허용 범위 이내로 유지하도록 한다.First, to manage the bidirectional gyro scale factor (Sf N + , Sf N- ), separate the scale factor used to calibrate the existing gyro scale factor. Average the factor values. The scale factor difference between the low speed drive and the high speed drive is kept within the allowable range.

또한 각 방향에 대한 업데이트는 GPS 위성과 차량의 주행 속력에 따라 반영하도록 하고, 저속 주행 상태 일 때는 하나의 자이로 스케일 펙터에 적용하는 기존 방법을 유지하도록 하며, 고속 주행 상태일 때는 GPS 위성 수신 상태가 양호한 경우 GPS 방향각 추이를 이용한다.Also, updates for each direction should be reflected according to the driving speed of the GPS satellites and the vehicle, and maintain the existing method of applying to one gyro scale factor when the driving speed is low. If good, use the GPS direction angle trend.

임계 오차를 초과하는 경우에는 자이로의 동작이 기기 상의 치명적인 문제 등으로 정상 상태를 벗어난 오동작을 수행하거나 GPS에서 비정상 기준치를 출력함으로써 누적된 오차라고 판단하여 해당 기간 동안의 누적 차이를 평균하여 상쇄해 준다. 고속 주행에 대한 기준은 전술한 노미널 전압 연산에 적용한 기준과 동일한 기준으로 사용한다.If the threshold error is exceeded, the gyro is determined to be a cumulative error by performing a malfunction out of the normal state due to a fatal problem on the device or by outputting an abnormal reference value from the GPS, and averaging the accumulated difference over the corresponding period. . The criteria for the high speed driving are used as the same criteria as the criteria applied to the above-mentioned nominal voltage calculation.

그리고 주행 상태 판정은 회전 이전 지정 시간 동안 유지된 속력을 기준으로 고속/저속을 판단하게 된다. 또한, 저속에서 고속으로 이전되는 경우 해당 자이로 스케일 펙터를 양방향에 동일하게 적용하고, 고속에서 저속으로 이전되는 경우 각 방향의 자이로 스케일 펙터를 평균하여 동일한 자이로 스케일 펙터에 의해 보정한다.And the driving state determination is to determine the high speed / low speed based on the speed maintained for the predetermined time before rotation. In addition, when moving from low speed to high speed, the corresponding gyro scale factor is equally applied to both directions, and when moving from high speed to low speed, the gyro scale factors in each direction are averaged and corrected by the same gyro scale factor.

도 4 및 도 5는 본 발명에 따른 자이로 동적 특성에 따른 자이로 노미널 전압 보정 방법을 설명하기 위한 플로 챠트이다.4 and 5 are flowcharts illustrating a gyro nominal voltage correction method according to a gyro dynamic characteristic according to the present invention.

도 4에 도시된 바와 같이, 주행중인 차량의 차량 항법 유도 장치가 작동을 하게 되면, 먼저 자이로 계수 값들 중에서 자이로 노미널 전압 값을 초기화한다(S411). 따라서 이전에 저장되어 있는 자이로 노미널 전압 값을 로딩 시키거나(S411), 외부로부터 저속 주행과 고속 주행에 따라 보정된 자이로 노미널 전압 필터 값을 차량 항법 유도 장치의 초기 자이로 노미널 전압 값으로 사용한다(C).As shown in FIG. 4, when the vehicle navigation guidance apparatus of the driving vehicle is operated, first, the gyro nominal voltage value is initialized among the gyro coefficient values (S411). Therefore, the previously stored gyro nominal voltage value is loaded (S411), or the gyro nominal voltage filter value corrected according to low speed driving and high speed driving from the outside is used as the initial gyro nominal voltage value of the vehicle navigation guidance device. (C).

그런 다음, 차량이 정지 상태인지 주행 상태인지를 판단하고(S412), 차량이 주행 중인 상태인 경우에는 GPS 위성으로부터 현재 위치에 관한 정보의 수신 상태를 점검한다(S413). 그리고 상기 GPS 위성으로부터 수신되는 위치 정보의 상태가 양호하고, 차량의 이동 속도 판단도 양호한지를 확인하는데(S414), 양호하다고 판단되는 경우에는 GPS 방향각 추이가 GPS의 임계 각보다 같거나 작은지를 판단한다(S415).Then, it is determined whether the vehicle is in a stopped state or a driving state (S412), and when the vehicle is in a driving state, the reception state of the information on the current position from the GPS satellite is checked (S413). In addition, it is determined whether the state of the location information received from the GPS satellites is good and the vehicle's moving speed judgment is good (S414). If it is determined that the GPS direction angle is equal to or smaller than the critical angle of the GPS, (S415).

그리고 GPS 위성으로부터 수신되는 위치 정보가 양호하지 않다고 판단되는 경우에는 자이로 노미널 전압을 보정하기 위하여 B 루푸로 진행하도록 한다.If it is determined that the location information received from the GPS satellites is not good, it proceeds to B loop to correct the gyro nominal voltage.

상기 GPS 위성으로부터 수신되는 정보가 양호하고, GPS의 방향각이 GPS 임계 각보다 크다고 판단되는 경우에는(S416), 이것은 차량이 경로를 따라 옆으로 이탈하지 않고, 직진하고 있음을 나타낸다.If the information received from the GPS satellites is good and it is determined that the direction angle of the GPS is greater than the GPS threshold angle (S416), this indicates that the vehicle is moving straight along without leaving sideways along the path.

하지만, GPS 방향각 추이가 GPS 임계 각보다 큰 경우에는 일반적으로 차량이 직진과 커브를 교대로하고 있는 것으로 판단하여 자이로 노미널 전압을 보정하기 위하여 B루프에서 보정을 실시한다.However, when the GPS direction angle change is larger than the GPS threshold angle, it is generally determined that the vehicle alternates the straight line and the curve, and the correction is performed in the B loop to correct the gyro nominal voltage.

상기 GPS 위성의 방향각 추이가 임계 각보다 작은 경우에는 차량이 직선으로 진행하고 있음을 나타내는 것이고, 이때 차량 항법 유도 장치에서는 직진하고 있는 시간을 측정하고 아울러 이때의 자이로 노미널 전압 값을 저장한다.When the direction angle change of the GPS satellite is smaller than the critical angle, the vehicle is traveling in a straight line. In this case, the vehicle navigation guidance apparatus measures the time that it is going straight and stores the gyro nominal voltage value at this time.

상기 직진으로 주행하는 차량의 상태가 고속 주행시의 지정 시간 간격(THigh Speed)보다 큰 경우에는 저장된 자이로 노미널 전압의 평균치를 자이로 노미널 전압으로 수정한다(S418).When the state of the vehicle traveling in a straight line is greater than the predetermined time interval T High Speed at high speed , the average value of the stored gyro nominal voltage is corrected to the gyro nominal voltage (S418).

상기 직진으로 주행하는 차량의 상태가 고속 주행시의 지정 시간 간격(THigh Speed)보다 작은 경우에는 저장된 자이로 노미널 전압을 B 루프로 돌려 자이로 노미널 전압을 보정하도록 한다.When the state of the vehicle traveling in a straight line is less than a predetermined time interval (T High Speed ) during high speed driving, the stored gyro nominal voltage is returned to the B loop to correct the gyro nominal voltage.

또한, 상기 차량 정지 상태 확인을 한 결과(S412) 차량이 정지 상태에 있는 경우에는 정지 상태의 시간(T)을 측정하고, 그때의 자이로 노미널 전압 값을 저장한다(S421).In addition, as a result of confirming the vehicle stop state (S412), when the vehicle is in the stationary state, the time T in the stationary state is measured, and the gyro nominal voltage value at that time is stored (S421).

정지 상태의 시간(T)이 지정 시간 간격(TLow Speed)보다 큰 경우에는(S422) 저장된 노미널 전압의 평균치를 구하여 저속 자이로 노미널 전압으로 보정하고(S423), 정지 상태의 시간이 지정 시간 간격(TLow Speed)보다 작은 경우에는 자이로 노미널 전압을 보정하기 위하여 B루프에서 보정하도록 한다.If the time T in the standstill state is greater than the specified time interval (T Low Speed ) (S422), the average value of the stored nominal voltage is obtained and corrected by the low speed gyro nominal voltage (S423). If it is smaller than the interval (T Low Speed ), it should be corrected in B loop to correct the gyro nominal voltage.

그리고, A에서와 같이 차량을 운행하고, 정지하여 차량 항법 유도 장치를 작동하지 않게 되는 경우에는 동작이 정지할 때의 자이로 노미널 전압을 저장한 다음, 차량 항법 유도 장치를 정지시키고, 이후 다시 동작을 시킬 때 초기 자이로 노미널 전압 값으로 사용한다(S401).If the vehicle navigation guidance device is stopped and the vehicle navigation guidance device is not operated as in A, the gyro nominal voltage at the operation stops is stored, and then the vehicle navigation guidance device is stopped and then operated again. When using the initial gyro nominal voltage value is used (S401).

도 5에 도시된 바와 같이, 주행 중인 차량에서의 GPS 위성으로부터 수신되는 위치 정보 상태가 불량한 경우, 양호하더라도 GPS 방향각 추이가 GPS 임계 각보다 작은 경우, 임계 각보다 크더라도 주행 시간이 지정 간격 시간(THigh Speed)보다 작은 경우, 정지 상태에서 정지 지정 간격 시간(TLow Speed)보다 작은 경우에 노미널 전압의 보정을 위하여 B루프로 인가한다.As shown in FIG. 5, when the position information state received from the GPS satellite in the driving vehicle is poor, even if the GPS direction angle transition is good even if it is smaller than the GPS threshold angle, even if it is larger than the threshold angle, the travel time is a specified interval time. If it is less than (T High Speed ), it is applied to B loop to correct the nominal voltage when it is less than the stop designation interval time (T Low Speed ) in the stop state.

상기 자이로 노미널 전압을 보정하기 위하여 차량의 주행 속력을 판단하는데(S501), 차량의 주행 속력이 저속 인 경우(S502)와 고속인 경우(S503)를 분리하여 자이로 노미널 전압을 보정하도록 한다.The driving speed of the vehicle is determined to correct the gyro nominal voltage (S501), and when the driving speed of the vehicle is low (S502) and high speed (S503), the gyro nominal voltage is corrected.

차량 주행 속력이 저속인 경우에는 자이로 출력에 저속 자이로 노미널 전압으로 수정하고, 고속인 경우에는 자이로 출력에 고속 자이로 노미널 전압을 적용한 다음 자립 항법 장치의 칼만 필터에 인가하여 보정을 한다(S504).If the vehicle driving speed is low, the gyro output is corrected to a low speed gyro nominal voltage. If the vehicle is running at high speed, a high speed gyro nominal voltage is applied to the gyro output and then applied to the Kalman filter of the autonomous navigation device to correct it. .

도 6은 본 발명에 따른 자이로 스케일 펙터 보정방법을 설명하기 위한 플로챠트이다.6 is a flowchart illustrating a gyro scale factor correction method according to the present invention.

도 6에 도시된 바와 같이, 차량의 회전 방향에 따른 자이로 스케일 펙터 값을 보정하기 위하여 기존의 자이로 스케일 펙터 값을 로딩 시킨 다음(S601), GPS 위성으로부터 수신되는 현재 위치 정보 신호 상태와 차량의 속도 상태가 양호한 지를 판단한다(S602).As shown in FIG. 6, in order to correct the gyro scale factor value according to the rotation direction of the vehicle, the existing gyro scale factor value is loaded (S601), and the current position information signal state and speed of the vehicle received from the GPS satellites. It is determined whether the state is good (S602).

상기 차량의 속도와 GPS 위성으로부터 수신 상태가 양호한 경우에는 GPS 위성의 방향각 추이가 0°보다 큰가를 판단하고(S603) 0°보다 큰 경우에는 상기 도 3에서 설명한 우측 방향의 자이로 스케일 펙터 SfN+을 업데이트 하고(S607), 자립 항법 장치 보정을 위하여 칼만 필터를 이용하여 필터링을 실시한다(S608). 그런 다음 필터링된 상기 우측 방향의 자이로 스케일 펙터 SfN+값을 저장한다(S609).When the speed of the vehicle and the reception state from the GPS satellites are good, it is determined whether the direction angle of the GPS satellites is greater than 0 ° (S603). If the vehicle is larger than 0 °, the gyro scale factor Sf N + in the right direction described in FIG. To update (S607), the filter is performed using a Kalman filter to calibrate the autonomous navigation apparatus (S608). Then, the filtered gyro scale factor Sf N + value of the right direction is stored (S609).

상기 본 발명에서는 우측 방향의 자이로 스케일 펙터 값을 SfN+으로 표기하고, 좌측 방향의 자이로 스케일 펙터 값을 SfN-으로 표기하고, SfN+l-을 일측 방향의 자이로 스케일 펙터 값으로 표기하였다.In the present invention, the gyro scale factor value in the right direction is denoted by Sf N + , the gyro scale factor value in the left direction is denoted by Sf N- , and Sf N + l- is denoted by the gyro scale factor value in one direction.

그리고, GPS 위성의 방향각 추이가 0°크지 않는 경우에는 좌측 방향의 자이로 스케일 펙터 SfN-로서 업데이트를 하고(S604), 자립 항법 장치 보정을 위하여 칼만 필터를 이용하여 필터링을 실시한다(S605). 그런 다음 필터링된 상기 좌측 방향의 자이로 스케일 펙터 SfN-값을 저장한다(S606).When the direction angle of the GPS satellite is not larger than 0 °, the left side is updated with the gyro scale factor Sf N- in the left direction (S604), and the filter is performed using a Kalman filter to correct the autonomous navigation apparatus (S605). . Then, the filtered gyro scale factor Sf N− value of the left direction is stored (S606).

또한, 상기 GPS 위성으로부터 현재 위치 정보의 수신 상태와 차량의 속도 상태가 양호하지 않는 경우에는 일측 방향의 자이로 스케일 펙터 SfN+l-을 업데이트 하고(S610), 자립 항법 장치의 칼만 필터에서 필터링을 시킨 후(S611)에 상기 일측 방향의 자이로 스케일 펙터 SfN+l-값을 저장한다(S612).In addition, when the reception state of the current position information from the GPS satellite and the vehicle speed state is not good, the one-way gyro scale factor Sf N + l- is updated (S610), and the Kalman filter of the independent navigation device performs filtering. After (S611), the gyro scale factor Sf N + l− value of the one direction is stored (S612).

상기 일측 방향의 자이로 스케일 펙터 SfN+l-값을 기준으로 상기 우측 방향또는 좌측 방향의 자이로 스케일 펙터 값과 같은 값을 갖는지(벨런스) 판단하고, 같은 경우에는 같은 값을 일측 방향의 보정된 스케일 펙터 값으로 저장한다(S620, S622).It is determined whether the gyro scale factor Sf N + l− in the one direction has the same value (balance) as the gyro scale factor value in the right or left direction, and in the same case, the same value is corrected in one direction. Stored as a factor value (S620, S622).

상기 일측 방향의 자이로 스케일 펙터 SfN+l-값을 기준으로 상기 우측 방향 또는 좌측 방향의 자이로 스케일 펙터 값과 같은 값을 갖지 않는 경우에는(unbalance) 스케일 펙터를 상기 일측 스케일 펙터 값의 평균으로 설정하여 저장하여 보정한다(S621, S622).If the gyro scale factor Sf N + l− in the one direction is not equal to the gyro scale factor value in the right or left direction (unbalance), the scale factor is set as an average of the one side scale factor values. To be stored and corrected (S621, S622).

따라서, 본 발명에서는 첫째, 저속 주행 중인 차량의 자이로 노미널 전압과 정지 상태의 영 속도 보정을 함으로써 연산한 평균 값으로 보정할 수 있도록 하였고, 둘째, 고속 주행 상태의 자이로 노미널 전압의 GPS 위성 수신이 양호하고, 방향각 추이가 임계 각도 이내인 경우 동 방법으로 보정하였다.Therefore, in the present invention, first, the gyro nominal voltage of the vehicle driving at low speed and zero speed correction at the stop state can be corrected to the average value calculated. Second, the GPS satellite reception of the gyro nominal voltage at the high speed driving state is performed. Is good, and when the direction angle transition is within the critical angle, it is corrected by the same method.

단, 해당 입력에 대한 신뢰도 기준은 통상적으로 알려진 사실을 이용한다. 즉, 스피드미터의 오차는 상대적으로 영향이 크지 않으며, 일반적으로 위성 상태가 양호한 경우 차량이 고속 주행할 때, GPS 위치 오차가 작다는 가정을 사용한다.However, the reliability criterion for the input uses a known fact. That is, the error of the speed meter is relatively insignificant, and in general, the assumption that the GPS position error is small when the vehicle travels at high speed when the satellite condition is good is used.

또한, 자이로 기구의 물리적인 특성 때문에 회전 방향에 따라 특성이 달라지는 자이로 스케일 펙터의 변동을 다음과 같이 반영한다.In addition, due to the physical characteristics of the gyro mechanism reflects the variation of the gyro scale factor, which varies depending on the rotation direction as follows.

첫째, 양방향 자이로 스케일 펙터를 기존 자이로 스케일 펙터 보정을 위해 사용하는 스케일 펙터 분리하고, 스케일 펙터 통합 적용이 필요한 경우 양방향 스케일 펙터를 평균하여 사용하였다.First, the bidirectional gyro scale factor was separated from the scale factor used to calibrate the existing gyro scale factor, and the bidirectional scale factor was averaged when the scale factor integration application was needed.

둘째, 각 방향의 업데이트는 GPS 위성과 차량의 주행 속력에 따라 저속 주행 상태일 때, 하나의 자이로 스케일 펙터에 적용하는 기존 방법 유지하도록 하였고, 고속 주행 상태일 때, GPS 위성으로부터 수신 상태가 양호한 경우 GPS 방향각 추이와 임계 각을 이용하였다.Secondly, the update of each direction is to maintain the existing method of applying to one gyro scale factor when the vehicle is running at low speed according to the GPS satellite and the driving speed of the vehicle. GPS direction angle trend and critical angle were used.

상기 방법을 이용하여 자이로 스케일 펙터를 정밀하게 추정할 수 있도록 구성한 방법이며, 자이로 스케일 펙터를 보정하기 위해 유효한 판단 기준이라고 생각되는 GPS 위성의 출력과 유효성을 판단하기 위한 GPS 위성 수신 상태와 차량의 속도를 이용한다.It is a method configured to accurately estimate the gyro scale factor by using the above method, and the GPS satellite reception state and the speed of the vehicle to determine the output and validity of the GPS satellite which is considered a valid criterion for calibrating the gyro scale factor. Use

본 발명에서는 기존의 차량 정지 상태에서 적용한 자이로 노미널 전압의 영 속도 보정 방식에 하이브리드 방법으로 주행 중인 특성 변동을 반영하여 실제 자이로 노미널 전압의 드리프트에 가깝도록 모델링하여, 정밀한 차량 항법을 할 수 있도록 하였다.In the present invention, the gyro nominal voltage correction method applied in the existing vehicle stop state is reflected in the characteristic variation while driving in a hybrid method, so as to model close to the drift of the actual gyro nominal voltage, so that accurate vehicle navigation It was.

이상에서 자세히 설명된 바와 같이, 본 발명은 차량 항법 유도를 위하여 종래에는 자이로 계수 중에서 누락시켰던 자이로 스케일 펙터를 추가함으로써 차량 유도를 위한 정밀도를 향상시킨 효과가 있다.As described in detail above, the present invention has an effect of improving the precision for inducing a vehicle by adding a gyro scale factor which is conventionally omitted from the gyro coefficients for vehicle navigation guidance.

또한, 자립 항법을 위하여 GPS와 스피도미터의 입력을 이용하여 추가적인 장비 설치 없이 신뢰성이 우수한 차량 항법 유도 장치를 제조할 수 있다.In addition, by using the input of GPS and speedometer for independent navigation, it is possible to manufacture a reliable vehicle navigation guidance device without additional equipment installation.

아울러, 차량의 이동 중에 사용되는 자이로 노미널 전압 등을 적용함으로써 차량 이동을 위한 오차 범위를 최소화한 효과가 있다.In addition, by applying the gyro nominal voltage used during the movement of the vehicle has the effect of minimizing the error range for the movement of the vehicle.

본 발명은 상기한 실시 예에 한정되지 않고, 이하 청구 범위에서 청구하는 본 발명의 요지를 벗어남이 없이 당해 발명이 속하는 분야에서 통상의 지식을 가진 자라면 누구든지 다양한 변경 실시가 가능할 것이다.The present invention is not limited to the above-described embodiments, and various changes can be made by those skilled in the art without departing from the gist of the present invention as claimed in the following claims.

Claims (16)

지리 정보와, 교통 정보를 공급하는 원거리 경로 탐색 서버;A long distance search server for supplying geographic information and traffic information; 상기 원거리 경로 탐색 서버로부터 차량 항법 유도 장치에 정보를 공급하기 위한 통신 서버;A communication server for supplying information to the vehicle navigation guidance apparatus from the remote path search server; 차량의 위치를 정보를 공급하는 GPS 위성; 및GPS satellites that provide information about the location of the vehicle; And 상기 통신 서버로부터 지리 정보와, 교통 정보를 수신하는 탐색 경로 수신부와, 상기 GPS 위성으로부터 차량의 위치 정보를 수신하는 차량 위치 정보 수신부와, 상기 차량의 자체 내장되어 있는 지리 정보 공급부, 차량 경로 탐색부와, 상기 차량 위치 정보 수신부로부터 주기적으로 차량 주행 정보를 추출하는 차량 주행 정보 추출부와, 상기 탐색 경로 수신부, 차량 위치 정보 수신부, 지리 정보 공급부 및 차량 경로 탐색부를 이용하여 차량을 유도하는 경로 안내/이탈 판단부로 구성된 차량 항법 유도장치; 를 포함하는 것을 특징으로 하는 차량 항법 유도 시스템.A search path receiving unit for receiving geographic information and traffic information from the communication server, a vehicle location information receiving unit for receiving location information of the vehicle from the GPS satellites, a geographic information supply unit and a vehicle path searching unit which are built in the vehicle; And a vehicle guide information extracting unit periodically extracting vehicle driving information from the vehicle location information receiving unit, and a route guide for guiding a vehicle using the search path receiving unit, the vehicle location information receiving unit, a geographic information supply unit, and a vehicle path searching unit. A vehicle navigation guidance device composed of a deviation determination unit; Vehicle navigation guidance system comprising a. GPS 위성으로부터 차량의 위치 정보를 수신하는 GPS 수신부;A GPS receiver for receiving location information of the vehicle from a GPS satellite; 차량의 주행 각도와 속력에 대한 정보를 출력하는 자이로 센서부;A gyro sensor unit configured to output information about a driving angle and a speed of the vehicle; 이동하고 있는 차량의 속도 정보를 공급하는 스피드 센서부;A speed sensor unit supplying speed information of a moving vehicle; 상기 GPS 수신부, 자이로 센서부 및 스피드 센서부에서 공급되는 데이터를 처리하는 드라이버부;A driver unit for processing data supplied from the GPS receiver, a gyro sensor unit, and a speed sensor unit; 상기 드라이버부에서 처리된 상기 자이로 센서부와 스피드 센서부의 각속도,속도를 적분한 진행 방향 및 진행 거리를 측정하는 DR;DR for measuring a travel direction and a travel distance integrating the angular velocity and speed of the gyro sensor unit and the speed sensor unit processed by the driver unit; 상기 DR에서 처리된 정보에서 스피드 오차를 보정하는 제 1 칼만 필터;A first Kalman filter correcting a speed error in the information processed in the DR; 상기 제 1 칼만 필터에서 공급되는 보정된 오차와 상기 DR에서 공급되는 에러 보상 값의 차를 이용하여 위치 정보를 판단하는 합산기; 및A summer for determining position information by using a difference between a corrected error supplied from the first Kalman filter and an error compensation value supplied from the DR; And 상기 합산기의 정보와 상기 GPS 수신부에서 수신된 정보를 이용하여 위치 보정을 하는 제 2 칼만 필터; 를 포함하는 것을 특징으로 하는 차량 항법 유도 시스템.A second Kalman filter for correcting a position using information of the summer and information received from the GPS receiver; Vehicle navigation guidance system comprising a. 제 2 항에 있어서,The method of claim 2, 상기 제 1 칼만 필터와 제 2 칼만 필터에서는 상기 자이로 센서부에서의 자이로 노미널 전압 계수, 자이로 스케일 펙터 계수 정보를 보정하는 것을 특징으로 하는 차량 항법 유도 시스템.And the first Kalman filter and the second Kalman filter correct gyro nominal voltage coefficients and gyro scale factor coefficient information in the gyro sensor unit. 차량 항법 유도 장치의 자이로 노미널 전압을 초기화 하는 단계;Initializing a gyro nominal voltage of the vehicle navigation guidance device; 차량이 정지 상태인지 이동 중인지를 판단하는 단계;Determining whether the vehicle is stationary or moving; 상기 차량이 주행 중인 상태로 판단될 경우에는 GPS 위성으로부터의 수신 상태의 양호도를 확인하는 단계;Checking the goodness of a reception state from a GPS satellite when it is determined that the vehicle is in a driving state; 상기 GPS 수신 상태가 양호한 경우에는 GPS의 방향각 추이가 임계각 이하인지를 판단하는 단계;Determining whether the direction angle of the GPS is less than or equal to the threshold angle when the GPS reception state is good; 상기 방향각 추이가 임계각 이하인 경우에는 직성 주행으로 판단하고, 주행상태의 시간과 이때의 자이로 노미널 전압을 저장하는 단계;If the direction angle transition is less than or equal to a threshold angle, determining that driving is straight and storing the time of the driving state and the gyro nominal voltage at this time; 상기 주행 상태 시간이 지정 고속 주행 상태 시간보다 큰 경우에는 상기 저장된 자이로 노미널 전압의 평균치를 고속 자이로 노미널 전압으로 수정하는 단계; 및Modifying an average value of the stored gyro nominal voltage to a high speed gyro nominal voltage when the driving state time is greater than a designated high speed driving state time; And 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링하는 단계; 를 포함하는 것을 특징으로 하는 차량 항법 유도 방법.Modifying the nominal voltage according to the high speed and the low speed of the vehicle driving speed based on the modified gyro nominal voltage and filtering the Kalman filter of the independent navigation apparatus; Vehicle navigation guidance method comprising a. 제 4 항에 있어서,The method of claim 4, wherein 상기 차량이 정지상태인 경우에는 정지 상태의 시간과 이때의 자이로 노미널 전압 값을 저장하는 것을 특징으로 하는 차량 항법 유도방법.If the vehicle is in a stopped state, the vehicle navigation guidance method characterized in that the time of the stop state and the gyro nominal voltage value at this time is stored. 제 4 항 또는 제 5 항에 있어서,The method according to claim 4 or 5, 상기 정지 상태의 시간이 지정 저속 상태 시간 간격보다 큰 경우에는 상기 저장된 노미널 전압의 평균치를 자이로 노미널 전압으로 보정하는 것을 특징으로 하는 차량 항법 유도방법.And if the time of the stop state is greater than a designated low-speed state time interval, correcting an average value of the stored nominal voltage to a gyro nominal voltage. 제 4 항에 있어서,The method of claim 4, wherein 상기 GPS 위성 수신 상태가 양호하지 않는 경우에는 곧 바로 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을수정하여 자립 항법 장치의 칼만 필터로 필터링하는 단계로 넘어 가는 것을 특징으로 하는 차량 항법 유도방법.If the GPS satellite reception condition is not good, the vehicle traveling speed is immediately modified based on the modified gyro nominal voltage according to the high speed and the low speed, and the filtering is performed by the Kalman filter of the independent navigation device. Vehicle navigation method, characterized in that going. 제 4 항에 있어서,The method of claim 4, wherein 상기 GPS의 방향각 추이가 임계 각보다 큰 경우에는 직선 주행과 곡선 주행을 함께 하고 있는 것으로 판단하여 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링하는 단계로 넘어 가는 것을 특징으로 하는 차량 항법 유도방법.When the direction angle change of the GPS is larger than the critical angle, it is determined that both linear driving and curved driving are performed. Based on the modified gyro nominal voltage, the vehicle driving speed is corrected according to the high speed and the low speed. Vehicle navigation guidance method comprising the step of filtering by the Kalman filter of the independent navigation device. 제 4 항에 있어서,The method of claim 4, wherein 상기 주행 상태 시간이 지정 고속 주행 상태 시간보다 작은 경우에는 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링하는 단계로 넘어 가는 것을 특징으로 하는 차량 항법 유도방법.When the driving state time is less than the designated high speed driving state time, the vehicle driving speed is modified based on the modified gyro nominal voltage according to the high speed and the low speed, and the filtering is performed by the Kalman filter of the independent navigation apparatus. Vehicle navigation guidance method characterized in that the passing. 제 6 항에 있어서,The method of claim 6, 상기 정지 상태의 시간이 지정 저속 상태 시간 간격보다 작은 경우에는 상기 수정된 자이로 노미널 전압을 기준으로 차량 주행 속력이 고속과 저속에 따라 노미널 전압을 수정하여 자립 항법 장치의 칼만 필터로 필터링하는 단계로 넘어 가는것을 특징으로 하는 차량 항법 유도방법.If the stop time is less than the designated low-speed time interval, the vehicle driving speed is modified based on the modified gyro nominal voltage according to the high speed and the low speed to filter by the Kalman filter of the autonomous navigation device. Vehicle navigation method, characterized in that going to. 차량 항법 유도 장치의 자이로 스케일 펙터 값을 초기화 하는 단계;Initializing a gyro scale factor value of the vehicle navigation guidance device; GPS 위성으로부터의 수신 상태와 차량의 속도의 양호도를 확인하는 단계;Confirming a goodness of the reception state from the GPS satellite and the speed of the vehicle; 상기 GPS 수신 상태와 차량의 속도가 양호한 경우에는 GPS의 방향각 추이가 0보다 큰가를 판단하는 단계;Determining whether the direction angle of the GPS is greater than zero when the GPS reception state and the vehicle speed are good; 상기 GPS의 방향각 추이가 0보다 큰 경우에는 우측 방향의 자이로 스케일 펙터 값을 업데이트 하는 단계;Updating the gyro scale factor value in the right direction when the direction angle change of the GPS is greater than zero; 상기 업데이트된 자이로 스케일 펙터를 이용하여 자립 항법 장치내의 칼만 필터에서 필터링하는 단계;Filtering at a Kalman filter in a self-supporting navigation device using the updated gyro scale factor; 상기 보정된 우측 방향의 자이로 스케일 펙터 값(SfN+)을 저장하는 단계;Storing the corrected gyro scale factor value Sf N + in the right direction; 상기 보정된 우측 방향의 자이로 스케일 펙터 값과, 이전에 보정후 저장된 GPS 방향각 추이가 0보다 큰 경우의 좌측 방향의 자이로 스케일 펙터 값(SfN-) 이 같은지를 판단하는 단계; 및Determining whether the corrected gyro scale factor value and the left gyro scale factor value (Sf N− ) when the previously corrected GPS direction angle trend is greater than zero are equal to each other; And 상기 우측과 좌측 방향의 자이로 스케일 펙터 값이 상기 GPS 위성 수신 상태와 차량 속도 상태가 불량한 경우에 구해지는 일측 방향의 자이로 스케일 펙터 값 (SfN+l-)과 비교하여 같은 경우에는 상기 일측 방향의 자이로 스케일 펙터 값을 보정 값으로 하여 저장하는 단계; 를 포함하는 것을 특징으로 하는 차량 항법 유도방법.When the gyro scale factor values of the right and left directions are the same as those of the one-way gyro scale factor value Sf N + l− , which is obtained when the GPS satellite reception state and the vehicle speed state are poor, Storing the gyro scale factor value as a correction value; Vehicle navigation guidance method comprising a. 제 11 항에 있어서,The method of claim 11, 상기 GPS 수신 상태와 차량의 속도가 양호하지 않은 경우에는 일측 방향의 스케일 펙터 값의 평균을 업데이트 하는 것을 특징으로 하는 차량 항법 유도방법.If the GPS reception state and the vehicle speed is not good, the vehicle navigation guidance method characterized in that for updating the average of the scale factor value in one direction. 제 12 항에 있어서,The method of claim 12, 상기 업데이트된 일측 방향의 자이로 스케일 펙터 값을 자립 항법 장치내의 칼만 필터에서 필터링하고, 저장하는 것을 특징으로 하는 차량 항법 유도방법.And update and update the updated one-way gyro scale factor value in a Kalman filter in a self-supporting navigation apparatus. 제 11 항에 있어서,The method of claim 11, 상기 GPS 수신 상태와 차량의 속도가 양호하고, GPS의 방향각 추이가 0보다 작은 경우에는 좌측 방향의 자이로 스케일 펙터 값을 업데이트 하는 것을 특징으로 하는 차량 항법 유도방법.And when the GPS reception state and the vehicle speed are good and the direction angle of the GPS is less than 0, updating the left gyro scale factor value. 제 14 항에 있어서,The method of claim 14, 상기 업데이트된 좌측 방향의 자이로 스케일 펙터 값을 자립 항법 장치내의 칼만 필터에서 필터링하고, 저장하는 것을 특징으로 하는 차량 항법 유도방법.And update and update the updated gyro scale factor value in the Kalman filter in the independent navigation apparatus. 제 11 항에 있어서,The method of claim 11, 상기 우측과 좌측 방향의 자이로 스케일 펙터 값이 상기 일측 방향의 자이로스케일 펙터 값(SfN+l-)과 비교하여 다른 경우에는 자이로 스케일 펙터 값을 상기 일측 방향의 자이로 스케일 펙터 값으로 설정하는 것을 특징으로 하는 차량 항법 유도방법.When the gyro scale factor values in the right and left directions are different from the gyro scale factor values Sf N + l− in the one direction, the gyro scale factor values are set as the gyro scale factor values in the one direction. Vehicle navigation guidance method.
KR1020020061006A 2002-10-07 2002-10-07 Navigation guidance for car and method for car navigation guidance using the same KR100541485B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020020061006A KR100541485B1 (en) 2002-10-07 2002-10-07 Navigation guidance for car and method for car navigation guidance using the same

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020020061006A KR100541485B1 (en) 2002-10-07 2002-10-07 Navigation guidance for car and method for car navigation guidance using the same

Publications (2)

Publication Number Publication Date
KR20040031871A true KR20040031871A (en) 2004-04-14
KR100541485B1 KR100541485B1 (en) 2006-01-10

Family

ID=37331914

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020020061006A KR100541485B1 (en) 2002-10-07 2002-10-07 Navigation guidance for car and method for car navigation guidance using the same

Country Status (1)

Country Link
KR (1) KR100541485B1 (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101160630B1 (en) * 2010-03-26 2012-06-28 위드로봇 주식회사 Method for motion mode decision, navigation system using the method, and providing method thereof
KR20180081835A (en) * 2015-05-26 2018-07-17 크라운 이큅먼트 코포레이션 Systems and methods for materials handling vehicle odometry calibration
KR20190003916A (en) * 2017-06-30 2019-01-10 현대엠엔소프트 주식회사 Inertial sensor unit caliberation method for navigation
CN109444929A (en) * 2018-09-11 2019-03-08 上海欣佳信息科技有限公司 Vehicle positioning system based on vehicle CAN bus and satellite positioning
US11454515B2 (en) * 2017-06-30 2022-09-27 Hyundai Autoever Corp. Method for calibrating gyro sensor on basis of vehicle speed

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01316607A (en) * 1988-03-30 1989-12-21 Furuno Electric Co Ltd Navigation system
KR19990058332A (en) * 1997-12-30 1999-07-15 오상수 Guide to Deviation of the Path of Vehicle Navigation System

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101160630B1 (en) * 2010-03-26 2012-06-28 위드로봇 주식회사 Method for motion mode decision, navigation system using the method, and providing method thereof
KR20180081835A (en) * 2015-05-26 2018-07-17 크라운 이큅먼트 코포레이션 Systems and methods for materials handling vehicle odometry calibration
KR20190003916A (en) * 2017-06-30 2019-01-10 현대엠엔소프트 주식회사 Inertial sensor unit caliberation method for navigation
US11454515B2 (en) * 2017-06-30 2022-09-27 Hyundai Autoever Corp. Method for calibrating gyro sensor on basis of vehicle speed
CN109444929A (en) * 2018-09-11 2019-03-08 上海欣佳信息科技有限公司 Vehicle positioning system based on vehicle CAN bus and satellite positioning
CN109444929B (en) * 2018-09-11 2023-09-26 上海欣佳信息科技有限公司 Vehicle positioning system based on vehicle CAN bus and satellite positioning

Also Published As

Publication number Publication date
KR100541485B1 (en) 2006-01-10

Similar Documents

Publication Publication Date Title
US8195357B2 (en) In-vehicle sensor-based calibration algorithm for yaw rate sensor calibration
US5115238A (en) Calibration apparatus of angular velocity sensor in self-contained navigational system
KR100713459B1 (en) Method for determinig deviation of the path of a mobile in navigation system and navigation system
US20060025922A1 (en) Walker navigation device and program
JP4746374B2 (en) Position correction method and navigation apparatus
CN111309001B (en) Dead reckoning guidance system and method with principal direction-based coordinate correction
JPH0518774A (en) Vehicle position-azimuth computing device
KR100526571B1 (en) Off-board navigation system and method for calibrating error using the same
US8401787B2 (en) Method of determining drive lane using steering wheel model
KR100948089B1 (en) Method for deciding car position by pseudo dead reckoning and car navigation system using the same
KR20080036099A (en) Method for the operation of a navigation system, and navigation system
JP2001522986A (en) Vehicle navigation equipment
US7400946B2 (en) Method and apparatus for measuring velocity of land vehicle using accelerometer and route guidance information data
JPH0735558A (en) Current position detecting device for vehicle
KR100675362B1 (en) Car Navigation System and Control Method Thereof
KR100541485B1 (en) Navigation guidance for car and method for car navigation guidance using the same
JP3552267B2 (en) Vehicle position detection device
JP4848931B2 (en) Signal correction device for angular velocity sensor
JPH06111196A (en) Current position display device for moving body
JP3451636B2 (en) Speed sensor coefficient calculation device
JP4738196B2 (en) Method for determining error circle of position calculation device
KR101105144B1 (en) Method for determining position of vehicle
KR102622582B1 (en) Navigation apparatus and control method thereof
KR20180003728A (en) Gyro sensor correction apparatus and method for improving accuracy location of car navigation system
JP2603766B2 (en) Direction detection method and direction detection device

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: 20100929

Year of fee payment: 6

LAPS Lapse due to unpaid annual fee