KR100552688B1 - Methods and apparatuses for compensating attitude of and locating inertial navigation system - Google Patents

Methods and apparatuses for compensating attitude of and locating inertial navigation system Download PDF

Info

Publication number
KR100552688B1
KR100552688B1 KR1020030062779A KR20030062779A KR100552688B1 KR 100552688 B1 KR100552688 B1 KR 100552688B1 KR 1020030062779 A KR1020030062779 A KR 1020030062779A KR 20030062779 A KR20030062779 A KR 20030062779A KR 100552688 B1 KR100552688 B1 KR 100552688B1
Authority
KR
South Korea
Prior art keywords
posture
acceleration
information
section
error
Prior art date
Application number
KR1020030062779A
Other languages
Korean (ko)
Other versions
KR20050025836A (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 KR1020030062779A priority Critical patent/KR100552688B1/en
Priority to US10/935,303 priority patent/US7366612B2/en
Publication of KR20050025836A publication Critical patent/KR20050025836A/en
Application granted granted Critical
Publication of KR100552688B1 publication Critical patent/KR100552688B1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • 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
    • G01C21/183Compensation of inertial measurements, e.g. for temperature effects
    • G01C21/185Compensation of inertial measurements, e.g. for temperature effects for gravity

Abstract

관성 항법 시스템의 자세 보상 방법 및 장치, 이를 이용한 관성 항법 시스템의 위치 계산 방법 및 장치가 개시된다. 본 발명의 관성 항법 시스템의 자세 보상 방법은 (a) 시스템의 움직임 여부를 감지하여, 시스템의 정지 구간 및 움직임 구간 정보를 출력하는 단계; (b) 각 구간마다 시스템의 각속도 정보를 입력받아 각속도 정보로부터 시스템의 제1자세를 계산하는 단계; (c) 정지 구간에서 시스템의 중력방향 정보를 입력받아 중력방향 정보로부터 시스템의 제2자세를 계산하고, 제1자세 및 제2자세로부터 각 구간에서의 시스템의 자세 오차를 계산하는 단계; 및 (d) 제1자세에 대해 시스템의 자세 오차를 보상하여 출력하는 단계를 포함함을 특징으로한다.Disclosed are a method and apparatus for compensating a posture of an inertial navigation system and a method and apparatus for calculating a position of the inertial navigation system using the same. The posture compensating method of the inertial navigation system of the present invention includes the steps of: (a) detecting the movement of the system, and outputting information on the stopping section and the movement section of the system; (b) receiving the angular velocity information of the system for each section and calculating a first posture of the system from the angular velocity information; (c) receiving the gravitational direction information of the system in the stop section and calculating the second posture of the system from the gravitational direction information, and calculating the attitude error of the system in each section from the first posture and the second posture; And (d) compensating for the posture error of the system with respect to the first posture and outputting the posture error.

Description

관성 항법 시스템의 자세 보상 방법 및 장치, 이를 이용한 관성 항법 시스템의 위치 계산 방법 및 장치{Methods and apparatuses for compensating attitude of and locating inertial navigation system}Posture compensation method and apparatus of inertial navigation system, method and apparatus for calculating position of inertial navigation system using same {Methods and apparatuses for compensating attitude of and locating inertial navigation system}

도 1은 본 발명에 따른 관성 항법 시스템이 적용되는 펜 타입의 공간형 입력장치에 대한 개략적인 블록도이다.1 is a schematic block diagram of a pen type spatial input device to which an inertial navigation system according to the present invention is applied.

도 2는 본 발명에 따른 관성 항법 시스템의 자세 보상 장치에 대한 블록도이다.2 is a block diagram of an attitude compensating device of an inertial navigation system according to the present invention.

도 3은 각속도 정보로부터 얻어진 관성항법시스템의 자세를 보상하는 과정을 도시한 것이다.3 illustrates a process of compensating the attitude of the inertial navigation system obtained from the angular velocity information.

도 4는 관성 항법 시스템의 자세 보상 과정에 대한 흐름도이다.4 is a flowchart illustrating a posture compensation process of the inertial navigation system.

도 5는 본 발명에 따른 관성 항법 시스템의 자세 보상 장치를 이용하여 관성 항법 시스템의 위치를 계산하는 장치에 대한 블록도이다.5 is a block diagram of an apparatus for calculating the position of the inertial navigation system using the attitude compensation device of the inertial navigation system according to the present invention.

도 6은 가속도의 선형화 과정을 도시한 것이다.6 illustrates a linearization process of acceleration.

도 7은 서로 다른 문자에 대해 펜의 스트로크의 궤적을 측정할 때, 보상이 없는 종래 기술과 보상이 이루어진 본 발명에 의한 궤적 추적 에러를 비교하여 표로 도시한 것이다.7 is a table comparing trajectory tracking errors according to the present invention in which compensation is made with the prior art without compensation when measuring the trajectory of the stroke of the pen for different characters.

도 8a 내지 8c는 태블릿(tablet)을 레퍼런스 궤적으로하여 가속도 보상으로 서 영속도 보상만 이루어진 종래기술과 가속도 및 각속도 보상이 모두 이루어진 본 발명에 의한 궤적 추적 결과를 도시한 것이다.8A to 8C illustrate a trace tracking result according to the present invention in which both the acceleration and the angular velocity compensation and the prior art having only zero speed compensation as acceleration compensation by using a tablet as a reference trajectory.

본 발명은 관성 항법 시스템의 자세 보상 방법 및 장치, 이를 이용한 관성 항법 시스템의 위치 계산 방법 및 장치에 관한 것이다.The present invention relates to a method and apparatus for compensating a posture of an inertial navigation system and a method and apparatus for calculating a position of an inertial navigation system using the same.

관성 센서를 이용하여 3차원 공간에서 움직이는 물체의 위치와 자세를 측정하려면 3축 가속도 센서와 3축 각속도 센서로 구성되는 관성 측정 장치(Inertial Measurement Unit)를 사용해야 한다. 관성 항법 시스템의 자세는 각속도 센서인 자이로스코프가 측정한 각속도를 적분하는 형태의 미분방정식을 풀어서 구할 수 있고, 위치는 가속도 센서가 측정한 가속도에서 관성 항법 시스템의 자세를 고려하여 중력 성분을 제거하고, 시간에 대해 이중 적분을 계산하여 구할 수 있다. 이 때, 센서의 측정 오차에 의하여 관성 항법 시스템의 자세는 각속도의 측정 오차에 대해 시간에 따라 비례하는 오차를 갖게 되어, 중력 성분을 제거한 가속도 또한 각속도의 측정 오차에 대해 시간에 따라 비례하는 오차를 갖게 된다. 따라서, 위치는 가속도 측정 오차에 대해 시간의 제곱에 비례하고, 자세는 각속도 측정 오차에 대해 시간의 세제곱에 비례하는 오차를 갖게 된다. 이렇게 시간에 따라 급격하게 증가하는 오차 때문에 관성센서를 이용하여 장시간 동안 위치를 계산해 내는 것은 매우 어려운 일이다. 따라서, 관성 센서들로부터 측정된 가속도 및 각속도로부터 움직이 는 물체의 자세를 보상하고 그 위치를 측정하는 것이 필요하다.To measure the position and attitude of a moving object in three-dimensional space using an inertial sensor, an inertial measurement unit consisting of a three-axis acceleration sensor and a three-axis angular velocity sensor should be used. The attitude of the inertial navigation system can be obtained by solving the differential equation in the form of integrating the angular velocity measured by the gyroscopic angular velocity sensor, and the position is removed by considering the attitude of the inertial navigation system from the acceleration This can be obtained by calculating the double integral over time. At this time, the attitude of the inertial navigation system has an error proportional to time with respect to the measurement error of the angular velocity due to the measurement error of the sensor. Will have Therefore, the position is proportional to the square of time with respect to the acceleration measurement error, and the posture has an error proportional to the cube of time with respect to the angular velocity measurement error. Because of this rapidly increasing error, it is very difficult to calculate the position for a long time using the inertial sensor. Therefore, it is necessary to compensate and measure the position of the moving object from the acceleration and the angular velocity measured from the inertial sensors.

본 발명이 이루고자하는 기술적 과제는 관성 측정 장치로부터 얻어지는 가속도 및 각속도를 보상하고, 보상된 값들을 이용하여 관성 항법 시스템의 위치를 측정하는 관성 항법 시스템의 자세 보상 방법 및 장치, 이를 이용한 관성 항법 시스템의 위치 계산 방법 및 장치를 제공하는데 있다.The technical problem to be achieved by the present invention is to compensate for the acceleration and angular velocity obtained from the inertial measurement apparatus, the attitude compensation method and apparatus of the inertial navigation system for measuring the position of the inertial navigation system using the compensated values, the inertial navigation system of the same The present invention provides a method and apparatus for calculating a position.

상기 기술적 과제를 이루기위한, 본 발명의 관성 항법 시스템의 자세 보상 방법은 (a) 시스템의 움직임 여부를 감지하여, 상기 시스템의 정지 구간 및 움직임 구간 정보를 출력하는 단계; (b) 상기 각 구간마다 상기 시스템의 각속도 정보를 입력받아 상기 각속도 정보로부터 상기 시스템의 제1자세를 계산하는 단계; (c) 상기 정지 구간에서 상기 시스템의 중력방향 정보를 입력받아 상기 중력방향 정보로부터 상기 시스템의 제2자세를 계산하고, 상기 제1자세 및 제2자세로부터 상기 각 구간에서의 상기 시스템의 자세 오차를 계산하는 단계; 및 (d) 상기 제1자세에 대해 상기 시스템의 자세 오차를 보상하여 출력하는 단계를 포함함을 특징으로한다.In order to achieve the above technical problem, the attitude compensation method of the inertial navigation system of the present invention comprises the steps of: (a) detecting the movement of the system, and outputting the information on the stop section and the movement section of the system; (b) receiving the angular velocity information of the system for each section and calculating a first posture of the system from the angular velocity information; (c) receiving the gravity direction information of the system in the stop section and calculating the second posture of the system from the gravity direction information, and the attitude error of the system in each section from the first posture and the second posture; Calculating; And (d) compensating for and outputting an attitude error of the system with respect to the first posture.

상기 기술적 과제를 이루기위한, 본 발명의 관성 항법 시스템의 자세 보상 장치는 시스템의 움직임 여부를 감지하여, 상기 시스템의 정지 구간 및 움직임 구간의 정보를 출력하는 움직임 감지부; 상기 시스템의 각속도 정보를 입력받아 상기 각속도 정보로부터 상기 시스템의 제1자세를 계산하는 자세 계산부; 상기 시스템의 중력방향 정보를 입력받아 상기 중력방향 정보로부터 상기 시스템의 제2자세를 계 산하고, 상기 제1자세 및 제2자세로부터 상기 각 구간에 대한 상기 시스템의 자세의 오차를 계산하는 자세 에러 계산부; 및 상기 제1자세에 대해 상기 자세 오차를 보상하는 자세 보상부를 포함함을 특징으로한다.In order to achieve the above technical problem, the attitude compensating device of the inertial navigation system of the present invention detects the movement of the system, the motion detection unit for outputting information of the stop section and the movement section of the system; A posture calculator configured to receive angular velocity information of the system and calculate a first posture of the system from the angular velocity information; A posture error that receives the gravity direction information of the system and calculates a second posture of the system from the gravitational direction information, and calculates an error of the posture of the system with respect to each section from the first posture and the second posture; A calculator; And a posture compensator configured to compensate the posture error with respect to the first posture.

상기 기술적 과제를 이루기위한, 본 발명의 관성 항법 시스템의 위치 계산 방법은 (a) 시스템의 움직임 여부를 감지하여, 상기 시스템의 정지 구간 및 움직임 구간의 정보를 출력하는 단계; (b) 상기 시스템의 각속도 정보를 입력받아 상기 각속도 정보로부터 상기 시스템의 자세를 계산하고, 상기 시스템의 가속도 정보를 입력받아 상기 가속도 정보를 이용하여 상기 시스템의 자세를 보상하는 단계; (c) 보상된 자세를 이용하여 상기 가속도 정보를 상기 시스템을 포함하고있는 공간에서의 가속도 정보로 변환하는 단계; 및 (d) 상기 변환된 가속도 정보로부터 상기 공간에서의 상기 시스템의 위치를 계산하는 단계를 포함함을 특징으로한다.In order to achieve the above technical problem, the position calculation method of the inertial navigation system of the present invention comprises the steps of: (a) detecting the movement of the system, and outputting information of the stop section and the movement section of the system; (b) receiving the angular velocity information of the system to calculate the posture of the system from the angular velocity information, and receiving the acceleration information of the system to compensate for the posture of the system using the acceleration information; (c) converting the acceleration information into acceleration information in the space containing the system using the compensated attitude; And (d) calculating the position of the system in the space from the converted acceleration information.

상기 기술적 과제를 이루기위한, 본 발명의 관성 항법 시스템의 위치 계산 장치는 시스템의 움직임 여부를 감지하여, 상기 시스템의 정지 구간 및 움직임 구간의 정보를 출력하는 움직임 감지부; 상기 시스템의 각속도 정보를 입력받아 상기 각속도 정보로부터 상기 시스템의 자세를 계산하고, 상기 시스템의 가속도 정보를 입력받아 상기 가속도 정보를 이용하여 상기 시스템의 자세를 보상하는 자세 보상 장치; 보상된 자세를 이용하여 상기 가속도 정보를 상기 시스템을 포함하고있는 공간에서의 가속도 정보로 변환하는 가속도 변환부; 및 변환된 가속도 정보로부터 상기 공간에서의 상기 시스템의 위치를 계산하는 위치 계산부를 포함함을 특징으로한다.In order to achieve the above technical problem, the position calculation device of the inertial navigation system of the present invention detects the movement of the system, the motion detection unit for outputting information of the stop section and the movement section of the system; A posture compensation device configured to receive the angular velocity information of the system, calculate the posture of the system from the angular velocity information, and receive the acceleration information of the system and compensate the posture of the system using the acceleration information; An acceleration converter converting the acceleration information into acceleration information in a space including the system using a compensated posture; And a position calculator for calculating a position of the system in the space from the converted acceleration information.

이하에서 첨부된 도면을 참조하여 본 발명을 보다 상세하게 설명하기로 한다.Hereinafter, the present invention will be described in more detail with reference to the accompanying drawings.

도 1은 본 발명에 따른 관성 항법 시스템이 적용되는 펜 타입의 공간형 입력장치(3D input device)에 대한 개략적인 블록도이다. 도시된 바에 따른 공간형 입력 장치(1)는 중력방향 감지 센서(10), 각속도 센서(11), 회로부(12), 프로세서부(13) 및 무선통신부(14)를 구비한다. 여기서, 상기 중력방향 감지 센서(10)는 펜(1)의 움직임에 대한 중력 방향을 감지하여 3축 방향에 대해 기울어진 정도를 나타내는 중력방향 정보를 출력하는 기울기(tilt) 센서일 수 있고, 바람직하기로는 가속도 센서가 적절하다. 이하에서 중력방향 감지 센서(10)는 가속도 센서인 경우를 한정하여 기술하지만, 본래는 중력방향 정보를 말한다.1 is a schematic block diagram of a pen type 3D input device to which an inertial navigation system according to the present invention is applied. As shown, the spatial input device 1 includes a gravity direction sensor 10, an angular velocity sensor 11, a circuit unit 12, a processor unit 13, and a wireless communication unit 14. Here, the gravity direction sensor 10 may be a tilt sensor that detects the gravity direction for the movement of the pen 1 and outputs gravity direction information indicating the degree of inclination with respect to the three axis directions. Acceleration sensors are suitable below. In the following description, the gravity direction sensor 10 is limited to the case of the acceleration sensor, but originally refers to the gravity direction information.

가속도 센서(10)는 펜(1)의 움직임의 3축에 대한 가속도를 감지하여 출력하고, 각속도 센서(11)는 펜(1)의 회전에 따른 3축에 대한 각속도를 감지하여 출력한다. The acceleration sensor 10 detects and outputs an acceleration about three axes of the movement of the pen 1, and the angular velocity sensor 11 detects and outputs an angular velocity about three axes according to the rotation of the pen 1.

회로부(12)는 출력된 가속도 및 각속도를 디지털 값으로 변환한다. 프로세서부(13)는 펜(1)의 어느 한 점, 예를 들어 펜(1)의 팁(tip, 15)을 원점으로하는 바디 프레임(body frame)에서 얻어진 상기 가속도 및 각속도로부터 펜(1)이 위치하는 공간상의 어느 한 점을 원점으로하는 항법 프레임(navigation frame)에서 펜(1)이 차지하는 위치를 계산한다. 또한 상기 프로세서(13)는 각속도 센서(11)에 필연적으로 포함되는 에러를 보상함으로써 펜(1)의 자세를 보상하고, 보상된 자세를 이용하여 펜(1)의 움직임에 대한 가속도를 이용하여 보상함으로써, 관성 프레임에서 보다 정확한 펜(1)의 위치를 계산한다. 무선통신부(14)는 프로세서(13)에서 계산된 펜(1)의 위치를 기반으로하여 펜(1)을 입력장치로 사용하는 다른 장치, 예를 들어 컴퓨터, 디지털 TV 또는 PDA 등과 소정의 무선통신 방식으로 통신한다.The circuit unit 12 converts the output acceleration and angular velocity into digital values. The processor unit 13 is adapted from the acceleration and angular velocity obtained at a body frame starting from any point of the pen 1, for example, the tip 15 of the pen 1. The position occupied by the pen 1 in the navigation frame whose origin is any one point in the space where the position is located is calculated. In addition, the processor 13 compensates an error inevitably included in the angular velocity sensor 11 to compensate the posture of the pen 1, and compensates using the acceleration for the movement of the pen 1 using the compensated posture. By doing this, a more accurate position of the pen 1 in the inertial frame is calculated. The wireless communication unit 14 is based on the position of the pen 1 calculated by the processor 13 based on the position of the pen 1 and other wireless communication devices using the pen 1 as an input device, such as a computer, a digital TV or a PDA, and the like. Communicate in a way.

도 2는 본 발명에 따른 관성 항법 시스템의 자세 보상 장치에 대한 블록도이다. 상기 자세 보상 장치는 상기 프로세서부(13)에 대응될 수 있는 것으로, 펜(1)의 자세를 보상하기 위한 것이다. 그 구성요소로는 움직임 감지부(20), 자세 계산부(21), 자세 에러 계산부(22) 및 자세 보상부(23)를 구비한다.2 is a block diagram of an attitude compensating device of an inertial navigation system according to the present invention. The posture compensating device may correspond to the processor 13 and compensates for the posture of the pen 1. The components include a motion detector 20, a posture calculator 21, a posture error calculator 22, and a posture compensator 23.

움직임 감지부(20)는 펜(1)의 스트로크시 펜(1)의 움직임 여부를 판단하여 정지 또는 움직임 시간 구간을 검출한다. 움직임의 판단여부는 움직임과 정지를 구분하여 감지할 수 있는 수단을 통해서 이루어진다. 또는 가속도 센서(10) 또는 각속도 센서(11)로부터 각각 입력되는 가속도 정보

Figure 112005054670641-pat00001
또는 각속도 정보
Figure 112005054670641-pat00002
를 이용하여 얻는다.
Figure 112005054670641-pat00003
또는
Figure 112005054670641-pat00004
로부터 움직임 여부를 판단하는 것은, 예를 들어,
Figure 112005054670641-pat00005
또는
Figure 112005054670641-pat00006
의 표준편차를 구하고, 구해진 표준편차가 소정의 임계치 이하이면 펜(1)이 일시 정지한 것으로 판단할 수 있다. 여기서, 위첨자 b는 바디 프레임에서의 측정값임을 의미한다.
Figure 112005054670641-pat00094
의 표준편차에 대한 소정의 임계치는 0.15 ㎨이고,
Figure 112005054670641-pat00095
의 표준편차에 대한 소정의 임계치는 0.1 ㎮이다. The motion detector 20 determines whether the pen 1 moves when the pen 1 strokes, and detects a stop or movement time section. Judgment of the movement is made through a means that can detect the movement and stop separately. Or acceleration information respectively input from the acceleration sensor 10 or the angular velocity sensor 11.
Figure 112005054670641-pat00001
Or angular velocity information
Figure 112005054670641-pat00002
Get using
Figure 112005054670641-pat00003
or
Figure 112005054670641-pat00004
Determining whether or not to move from, for example,
Figure 112005054670641-pat00005
or
Figure 112005054670641-pat00006
When the standard deviation is obtained and the obtained standard deviation is less than or equal to a predetermined threshold, it can be determined that the pen 1 is paused. Here, the superscript b means the measured value in the body frame.
Figure 112005054670641-pat00094
The predetermined threshold for the standard deviation of is 0.15 Hz,
Figure 112005054670641-pat00095
The predetermined threshold for the standard deviation of is 0.1 Hz.

자세 계산부(21)는 각속도 정보

Figure 112003033666045-pat00007
로부터 공지의 관성항법시스템(Inertial Navigation System, INS) 이론에 따라 항법 프레임에서 펜(1)의 자세를 나타내는 파라미터들, 예를 들어, 오일러 각들(Euler angles), 즉, 롤각(roll angle),
Figure 112003033666045-pat00008
피치각(pitch angle),
Figure 112003033666045-pat00009
및 요각(yaw angle),
Figure 112003033666045-pat00010
을 계산하고, 이들로부터 바디 프레임에 대한 항법 프레임에서의 펜(1)의 자세를 나타내는 자세 매트릭스(attitude matrix)
Figure 112003033666045-pat00011
를 계산한다.Posture calculation unit 21 is the angular velocity information
Figure 112003033666045-pat00007
Parameters representing the posture of the pen 1 in the navigation frame according to the known Inertial Navigation System (INS) theory, for example Euler angles, ie roll angle,
Figure 112003033666045-pat00008
Pitch angle,
Figure 112003033666045-pat00009
And yaw angle,
Figure 112003033666045-pat00010
An attitude matrix representing the pose of the pen 1 in the navigation frame relative to the body frame from
Figure 112003033666045-pat00011
Calculate

자세 에러 계산부(22)는 가속도 정보

Figure 112003033666045-pat00012
와 움직임 감지부(20)에서 검출된 움직임 시간을 이용하여 자세 에러 매트릭스
Figure 112003033666045-pat00013
를 계산한다. 이를 보다 상세히 설명하면 다음과 같다.Posture error calculation unit 22 is acceleration information
Figure 112003033666045-pat00012
And posture error matrix using the motion time detected by the motion detector 20.
Figure 112003033666045-pat00013
Calculate This will be described in more detail as follows.

가속도 센서(10)에 의해 측정되는 펜(1)의 가속도는 펜(1)에 작용하는 중력 가속도와 비교해보면 아주 작다. 가속도에 미치는 중력의 영향을 제거하기위해 펜(1)의 자세를 정확하게 측정하는 것이 중요하다. 각속도 센서(11)의 드리프트(drift)와 기타 잡음에 의해 자세 에러는 시간에 따라 증가하게 된다. 펜(1)이 정지해있는 시간구간을 고려해보면, 가속도 센서(10)는 중력 성분만을 감지한다. 그러나 각 축에 대한 가속도 측정값들은 펜(1)의 자세에 따라 달라진다. 가속도 측정값들로부터 얻어지는 펜(1)의 자세에는 오일러 각들중 롤각

Figure 112003033666045-pat00014
과 피치각
Figure 112003033666045-pat00015
만이 사용된다. 상기 가속도 정보로 부터 얻는 롤각과 피치각은 다음식과 같이 측정된다.The acceleration of the pen 1 measured by the acceleration sensor 10 is very small compared to the gravitational acceleration acting on the pen 1. It is important to accurately measure the posture of the pen (1) in order to eliminate the effect of gravity on acceleration. Due to the drift and other noise of the angular velocity sensor 11, the posture error increases with time. Considering the time period during which the pen 1 is stationary, the acceleration sensor 10 detects only gravity components. However, the acceleration measurements for each axis depend on the posture of the pen 1. In the posture of the pen 1 obtained from the acceleration measurements, the roll angle of the Euler angles
Figure 112003033666045-pat00014
And pitch angle
Figure 112003033666045-pat00015
Only used. The roll angle and pitch angle obtained from the acceleration information are measured as follows.

Figure 112005054670641-pat00096
Figure 112005054670641-pat00096

여기서, g는 중력 가속도이고,

Figure 112003033666045-pat00017
는 3축의 중력방향 정보이다.Where g is the acceleration of gravity,
Figure 112003033666045-pat00017
Is gravity information of three axes.

상기

Figure 112003033666045-pat00018
Figure 112003033666045-pat00019
는 중력방향 감지 수단이 채택된 경우, 중력 방향 기울기로부터 수학식 1과 동일한 과정에 의해 얻어질 수도 있다.remind
Figure 112003033666045-pat00018
and
Figure 112003033666045-pat00019
When the gravity direction detection means is adopted, may be obtained by the same process as the equation (1) from the gravity direction inclination.

자세를 나타내는 오일러 각들은 INS 이론에 의해서도 얻어질 수 있다. 즉, 각속도 센서(11)에 의해 감지된 각속도를 적분함으로써 얻어진다. 따라서, 감지된 각속도에 에러가 포함된다면 자세에도 에러가 발생된다. 특히 자세 에러는 각속도 센서(11)의 드리프트에 의해 시간에 따라 누적된다. 그러나, 자세가 수학식 1에 따라 가속도 정보로부터 얻어졌다면, 자세 에러는 시간에 따라 증가하지않고, 다만 가속도 센서(10)의 측정 잡음에만 의존한다. 그러므로, 가속도 정보로부터 얻어진 자세를 펜(1)이 정지했을 때의 기준 자세로 사용할 수 있다.Posture Euler angles can also be obtained by the INS theory. That is, it is obtained by integrating the angular velocity detected by the angular velocity sensor 11. Therefore, if an error is included in the detected angular velocity, an error occurs in the posture. In particular, the attitude error accumulates with time due to the drift of the angular velocity sensor 11. However, if the attitude is obtained from the acceleration information according to Equation 1, the attitude error does not increase with time, but only depends on the measurement noise of the acceleration sensor 10. Therefore, the posture obtained from the acceleration information can be used as the reference posture when the pen 1 is stopped.

하지만 요각

Figure 112003033666045-pat00020
은 가속도 측정으로부터 얻어질 수 없고, 초기 요각은 펜(1)의 자세 측정에 중요한 요소가 아니다. 일반적으로 요각은 펜(1)의 스트로크의 시작시에는 0°로 설정된다.But the whistle
Figure 112003033666045-pat00020
Cannot be obtained from the acceleration measurement, and the initial yaw angle is not an important factor for the posture measurement of the pen 1. In general, the yaw angle is set to 0 degrees at the start of the stroke of the pen 1.

각속도 센서(11)의 드리프트는 각속도 측정에 주 에러 요소이고 자세를 나타 내는 각은 각속도의 적분에 의해 얻어지기 때문에, 자세의 에러는 필기동작(handwriting) 동안에는 시간에 대한 선형 함수로 나타낼 수 있다. 펜(1)의 스트로크 동안의 자세 에러는 스트로크의 시작과 종료사이의 기간동안 측정된 가속도 정보로부터 계산되는 자세에 따라 추정될 수 있다. Since the drift of the angular velocity sensor 11 is the main error factor in the angular velocity measurement and the angle representing the attitude is obtained by the integration of the angular velocity, the error of the attitude can be represented as a linear function of time during handwriting. The posture error during the stroke of the pen 1 can be estimated according to the posture calculated from the acceleration information measured during the period between the start and the end of the stroke.

자세 에러를 보상하기위해서, 필기동작 구간을 세 구간으로 나눈다. 즉,

Figure 112005054670641-pat00021
의 일시 정지(pause) 시작 구간,
Figure 112005054670641-pat00022
의 필기 구간 그리고
Figure 112005054670641-pat00023
의 일시 정지 종료 구간으로 나뉜다.
Figure 112005054670641-pat00024
의 시간동안 INS이론으로부터 얻은 자세를
Figure 112005054670641-pat00025
로 나타내면, 가속도 정보로부터 얻어진 자세는
Figure 112005054670641-pat00026
로 나타낼 수 있다. 상기 세 시간구간동안에는 서로 다른 레퍼런스(reference) 정보가 얻어지므로 자세 에러의 추정에도 서로 다른 방법이 사용된다. 예로서, 롤각에 대한 보상 원리를 설명하면 다음과 같다.To compensate for the posture error, the writing motion section is divided into three sections. In other words,
Figure 112005054670641-pat00021
Pause start interval for,
Figure 112005054670641-pat00022
Handwriting interval and
Figure 112005054670641-pat00023
Is divided into a pause end section.
Figure 112005054670641-pat00024
Posture from INS theory
Figure 112005054670641-pat00025
, The attitude obtained from the acceleration information is
Figure 112005054670641-pat00026
It can be represented by. Since different reference information is obtained during the three time periods, different methods are used to estimate posture errors. As an example, the principle of compensation for the roll angle is as follows.

Figure 112003033666045-pat00027
의 시간구간동안, t=0에서 초기 잘못된 정렬(misalignment)에 의한 에러는 발생되지않았다고 가정하면, 롤각의 에러는 시간에 따라 선형적으로 증가하게 되어 다음 식과 같이 모델링될 수 있다.
Figure 112003033666045-pat00027
Assuming that no error due to the initial misalignment did not occur at t = 0, the error of the roll angle increases linearly with time and can be modeled as follows.

Figure 112003033666045-pat00028
Figure 112003033666045-pat00028

Figure 112003033666045-pat00029
의 시간구간에는 기준 자세가 없기 때문에, 다른 시간구간의 기준 자세 정보만이 자세 에러를 추정하는데 사용된다. 자세 에러 모델이 시간에 따른 선형 함수를 만족하다고하면, 다음 식과 같이 모델링될 수 있다.
Figure 112003033666045-pat00029
Since there is no reference posture in the time interval of, only the reference posture information of another time interval is used to estimate the posture error. If the posture error model satisfies the linear function over time, it may be modeled as follows.

Figure 112003033666045-pat00030
Figure 112003033666045-pat00030

Figure 112003033666045-pat00031
의 시간구간동안 펜(1)의 궤적은 주로
Figure 112003033666045-pat00032
의 시간구간의 위치 정보를 사용하게 되고, 따라서
Figure 112003033666045-pat00033
시간구간의 자세 에러가 일정하다고하면 롤각의 에러는 시간에 따라 여전히 증가하게되어 상기 수학식 3의 모델을 그대로 사용할 수 있다. 피치각의 에러도 상기 롤각의 에러와 동일한 방법으로 모델링할 수 있다.
Figure 112003033666045-pat00031
The trajectory of the pen (1) during
Figure 112003033666045-pat00032
The location information of the time interval is used.
Figure 112003033666045-pat00033
If the posture error of the time interval is constant, the error of the roll angle still increases with time, so that the model of Equation 3 can be used as it is. The error of the pitch angle can also be modeled in the same manner as the error of the roll angle.

상기한 선형 모델링에 따라 자세 에러가 추정되면, 추정된 자세 에러로부터 자세 에러 매트릭스

Figure 112003033666045-pat00034
를 구한다.If the posture error is estimated according to the linear modeling described above, the posture error matrix is estimated from the estimated posture error.
Figure 112003033666045-pat00034
Obtain

자세 보상부(23)는

Figure 112003033666045-pat00035
및 자세 계산부(21)에서 출력되는
Figure 112003033666045-pat00036
를 이용하여 에러가 보상된 자세 매트릭스
Figure 112003033666045-pat00037
을 출력한다.Posture compensator 23
Figure 112003033666045-pat00035
And the posture calculator 21
Figure 112003033666045-pat00036
Posture matrix with error compensation using
Figure 112003033666045-pat00037
Outputs

자세의 보상과정을 롤각을 예로 들어 도 3 및 도 4에 도시된 도면을 참조하 여 설명하면 다음과 같다. 도 3은 각속도 정보로부터 얻어진 롤각을 보상하는 과정을 도시한 것이고, 도 4는 그에 따른 흐름도이다.The posture compensation process will be described with reference to the drawings illustrated in FIGS. 3 and 4 by taking the roll angle as an example. 3 shows a process of compensating a roll angle obtained from the angular velocity information, and FIG. 4 is a flowchart accordingly.

각속도 센서(11)는 각속도 정보

Figure 112003033666045-pat00038
를 감지하여 출력한다(40단계). 출력된 각속도는 도 3(a)에 도시된 바와 같이 펜(1)의 스트로크 시간구간동안에는 그 크기가 크고 일시 정지 기간동안에는 센서 자체에 의한 잡음 등에 의해 완전이 0이 되지않는 드리프트
Figure 112003033666045-pat00039
를 가지고 있음을 알 수 있다.Angular velocity sensor 11 is the angular velocity information
Figure 112003033666045-pat00038
Detect and output (step 40). As shown in Fig. 3 (a), the output angular velocity is large during the stroke time period of the pen 1, and during the pause period, the drift does not become completely zero due to noise caused by the sensor itself.
Figure 112003033666045-pat00039
It can be seen that it has.

상기 각속도 정보를 INS이론에 따라 초기치

Figure 112003033666045-pat00040
를 고려하여 적분하면
Figure 112003033666045-pat00041
를 구할 수 있다(41단계). 구해진
Figure 112003033666045-pat00042
는 도 3(b)와 같이 나타난다. 또한 가속도 정보
Figure 112003033666045-pat00043
에 대해 수학식 1과 같은 연산을 수행하면
Figure 112003033666045-pat00044
가 구해진다(42단계). 구해진
Figure 112003033666045-pat00045
는 도 3(c)에 도시된 바와 같이 초기치
Figure 112003033666045-pat00046
와 최종치
Figure 112003033666045-pat00047
로 나타난다.Initial value of the angular velocity information according to INS theory
Figure 112003033666045-pat00040
Integrating in consideration of
Figure 112003033666045-pat00041
Can be obtained (step 41). Saved
Figure 112003033666045-pat00042
Is shown in Figure 3 (b). Also acceleration information
Figure 112003033666045-pat00043
If you perform an operation like
Figure 112003033666045-pat00044
Is obtained (step 42). Saved
Figure 112003033666045-pat00045
Is the initial value as shown in FIG.
Figure 112003033666045-pat00046
And the final value
Figure 112003033666045-pat00047
Appears.

Figure 112003033666045-pat00048
Figure 112003033666045-pat00049
를 이용하여 수학식 2 및 3과 같이 롤각의 에러
Figure 112003033666045-pat00050
를 선형 근사하면(43단계), 도 3(d)에 도시된 바와 같이 근사된다. 롤각의 보상은 다음 식과 같이 이루어진다(44단계).
Figure 112003033666045-pat00048
Wow
Figure 112003033666045-pat00049
Error of the roll angle as shown in Equations 2 and 3 using
Figure 112003033666045-pat00050
Is approximated as shown in Fig. 3 (d). Compensation of the roll angle is performed as follows (step 44).

Figure 112003033666045-pat00051
Figure 112003033666045-pat00051

최종적으로 보상된 롤각은 도 3(e)에 도시된 바와 같이 스트로크 시작 전 또 는 스트로크 종료 후에 시간에 따라 증가하는 현상을 보이지않고, 안정적이다.Finally, the compensated roll angle does not show a phenomenon of increasing with time before the start of the stroke or after the end of the stroke, as shown in FIG.

도 5는 본 발명에 따른 관성 항법 시스템의 자세 보상 장치를 이용하여 관성 항법 시스템의 위치를 계산하는 장치에 대한 블록도이다.5 is a block diagram of an apparatus for calculating the position of the inertial navigation system using the attitude compensation device of the inertial navigation system according to the present invention.

도시된 바에 따른 관성 항법 시스템의 위치 계산 장치는 자세 보상 장치(50), 가속도 변환부(51), 가속도 보상부(52), 위치 계산부(53)를 구비한다. 여기서, 가속도 보상부(52)는 선택적으로 구비될 수 있다.The position calculation device of the inertial navigation system as illustrated includes a posture compensation device 50, an acceleration converter 51, an acceleration compensator 52, and a position calculator 53. Here, the acceleration compensator 52 may be selectively provided.

자세 보상 장치(50)는 도 2에 도시된 바와 같은 구조를 갖는다. 다만, 입력받는 정보는 가속도 정보와 각속도 정보이다. 자세 보상 장치(50)는 펜(1)의 움직임 시간 t와 보상된 자세 매트릭스

Figure 112003033666045-pat00052
를 출력한다. 가속도 변환부(51)는
Figure 112003033666045-pat00053
와 가속도 센서(10)에서 출력되는 가속도 정보
Figure 112003033666045-pat00054
로부터 다음 식과 같이 계산되는 항법 프레임에서의 가속도
Figure 112003033666045-pat00055
를 출력한다.The attitude compensating device 50 has a structure as shown in FIG. 2. However, the input information is acceleration information and angular velocity information. The posture compensating device 50 includes the movement time t of the pen 1 and the compensated posture matrix.
Figure 112003033666045-pat00052
Outputs Acceleration converter 51
Figure 112003033666045-pat00053
And acceleration information output from the acceleration sensor 10
Figure 112003033666045-pat00054
Acceleration in Navigation Frames Calculated as
Figure 112003033666045-pat00055
Outputs

Figure 112003033666045-pat00056
Figure 112003033666045-pat00056

가속도 보상부(52)는 상기 t를 이용하여

Figure 112005054670641-pat00057
을 보상한다. 여기서, 가속도 보상부(52)는 선택적으로 구비될 수 있다. 즉, 위치 계산부(53)는 가속도 변환부(51)에서 출력되는 항법 프레임에서의 가속도를 보상없이 이중적분하여 항법 프레임에서의 펜(1)의 위치를 계산하게된다.The acceleration compensator 52 uses the t
Figure 112005054670641-pat00057
To compensate. Here, the acceleration compensator 52 may be selectively provided. That is, the position calculation unit 53 calculates the position of the pen 1 in the navigation frame by integrating the acceleration in the navigation frame output from the acceleration conversion unit 51 without compensation.

가속도 보상부(52)를 구비하는 경우, 가속도 보상 과정은 다음과 같다.When the acceleration compensation unit 52 is provided, the acceleration compensation process is as follows.

Figure 112003033666045-pat00058
의 에러
Figure 112003033666045-pat00059
는 기본적으로 가속도 센서(10) 및 각속도 센서(11)의 에러로부터 발생되고, 다음 식과 같이 표현될 수 있다.
Figure 112003033666045-pat00058
Error in
Figure 112003033666045-pat00059
Is basically generated from an error of the acceleration sensor 10 and the angular velocity sensor 11, and may be expressed as follows.

Figure 112003033666045-pat00060
Figure 112003033666045-pat00060

여기서,

Figure 112003033666045-pat00061
는 가속도 에러 및 자세 에러에 의해 발생되는 바디 프레임에서의 가속도 에러이고,
Figure 112003033666045-pat00062
은 자세 에러 각
Figure 112003033666045-pat00063
과 초기 잘못된 정렬(misalignment)에 의한 에러 각
Figure 112003033666045-pat00064
으로부터 얻어지는 자세 에러 매트릭스이다. here,
Figure 112003033666045-pat00061
Is an acceleration error in the body frame caused by the acceleration error and the posture error,
Figure 112003033666045-pat00062
Posture error angle
Figure 112003033666045-pat00063
And error angle due to initial misalignment
Figure 112003033666045-pat00064
The attitude error matrix obtained from.

바디 프레임에서 측정된 가속도 정보는 항법 프레임에서의 값으로 변환된다. 상기 수학식 6의 두번째 행의 첫번째 항은 바디 프레임에 대해 계산된 자세 매트릭스

Figure 112003033666045-pat00065
를 이용하여 참값(true value)에서 편이된(deviated) 가속도를 나타낸다.Acceleration information measured in the body frame is converted into values in the navigation frame. The first term of the second row of Equation 6 is the pose matrix calculated for the body frame.
Figure 112003033666045-pat00065
It represents the acceleration deviated from the true value using.

대략적인 측정(rough estimation)값을 살펴보면, 중력의 영향으로 각 에러(angular error)에 의해 일어나는 수평 가속도 에러는

Figure 112003033666045-pat00066
의 항으로 표현될 수 있고, 이 값은 항법 프레임에서 가속도 벡터에 더해진다. 예를 들어, 필기동작중에 0.1mg 단위의 정확도를 갖는 가속도 센서에서 가속도의 정확도가 유지된다면, 피치각과 롤각의 정확도는 0.0057°로 유지될 것이다. 이러한 정확도에서조 차 5초 후의 위치 에러는 약 1.225cm가 된다.Looking at rough estimates, the horizontal acceleration error caused by angular error under the influence of gravity
Figure 112003033666045-pat00066
It can be expressed in terms of, which is added to the acceleration vector in the navigation frame. For example, if the acceleration accuracy is maintained in an acceleration sensor having an accuracy of 0.1 mg during the writing operation, the accuracy of the pitch angle and the roll angle will be maintained at 0.0057 °. At this accuracy, the position error after 5 seconds is approximately 1.225 cm.

상기 수학식 6의 두번째 항은

Figure 112003033666045-pat00067
Figure 112003033666045-pat00068
에 종속하면서
Figure 112003033666045-pat00069
에 영향을 미치는 것을 보여준다. 상기 두번째 항은 명백하게 시간에 대한 복잡한 비선형 함수로 나타나는 것을 알 수 있다. 만일 자세의 변화가 없다면, 바디 프레임에서의 일정한 가속도 에러는 항법 프레임에서의 일정한 가속도 에러로 나타난다. 그러나, 실제로는 필기동작중 자세는 시간에 따라 끊임없이 변한다. 가속도 에러가 일정하다고할지라도
Figure 112003033666045-pat00070
에 미치는 영향은 시간에 대해 상기 복잡한 비선형 함수를 따라 변화하게 된다. 동시에, 가변 자세 에러는 이러한 비선형 관계의 복잡성을 증가시킨다.The second term of Equation 6
Figure 112003033666045-pat00067
end
Figure 112003033666045-pat00068
Subordinate to
Figure 112003033666045-pat00069
Show that affects. It can be seen that the second term manifests itself as a complex nonlinear function of time. If there is no change in posture, a constant acceleration error in the body frame results in a constant acceleration error in the navigation frame. In practice, however, the posture during writing is constantly changing with time. Even if the acceleration error is constant
Figure 112003033666045-pat00070
The effect on the will change along the complex nonlinear function with respect to time. At the same time, variable posture errors increase the complexity of this nonlinear relationship.

이러한 비선형성을 선형화하는 모델이 본 발명과 동일한 출원인에 의해 국내특허출원번호 2003-38682호로 출원되었다.A model for linearizing such nonlinearity has been filed in Korean Patent Application No. 2003-38682 by the same applicant as the present invention.

본 발명에서는 상기 선행 특허에서 개시된 가속도의 선형화 모델을 채택하여 적용하기로한다. 상기 선행 특허에 따르면, 가속도의 선형화 모델은 도 6에 도시된 바와 같이 이루어진다. 도 6은 가속도의 선형화 과정을 도시한 것이다.In the present invention, the linearization model of acceleration disclosed in the above patent is adopted. According to the preceding patent, a linearization model of acceleration is made as shown in FIG. 6 illustrates a linearization process of acceleration.

펜(1)이 움직이기 이전의 시간 구간(0<t<t1)에 기록된 가속도 값들에 선형회귀(linear regression) 방법을 적용하여 도 6(a) 에 도시된 바와 같이, 측정된 가속도 값들을 선형 근사화한 직선 a1t+c1 을 구한다. 마찬가지로, 펜(1)이 멈춘 시간 구간 (t>t2)에 기록된 가속도 값들에 대해서도 선형회귀 방법을 적용하여 도 6(a) 에 도시된 바와 같이, 측정된 가속도 값들을 선형 근사화한 직선 a2t+c2 을 구한다. As shown in FIG. 6 (a) by applying a linear regression method to the acceleration values recorded in the time interval 0 <t <t 1 before the pen 1 moves, the measured acceleration values Find a straight line a 1 t + c 1 with the linear approximation. Similarly, as shown in FIG. 6 (a), a linear regression method is applied to the acceleration values recorded in the time interval t> t 2 at which the pen 1 stops, and the straight line a is a linear approximation of the measured acceleration values. Find 2 t + c 2 .

직관적으로, 펜(1)의 정지 구간(0<t<t1 및 t>t2)에서 펜(1)의 움직임 속도는 실질적으로 0 이 된다는 것을 알 수 있고, 따라서, 정지 구간에서의 가속도도 0 이 된다는 것을 알 수 있다. 따라서 도 6(b)에 도시된 바와 같이 각 정지 구간에서의 가속도는 0으로 보상되고, 결과적으로 선형화된 직선 성분들이 오차가 된다. 이를 영속도 보상(Zero Velocity Compensation)이라고 하기로한다.Intuitively, it can be seen that the movement speed of the pen 1 becomes substantially zero in the stop sections 0 <t <t 1 and t> t 2 of the pen 1, and therefore, the acceleration in the stop section You can see that it becomes zero. Therefore, as illustrated in FIG. 6B, the acceleration in each stop section is compensated to 0, and as a result, linearized linear components become an error. This is called Zero Velocity Compensation.

상기 각 정지 구간의 근사화된 가속도 오차 a1t+c1 및 a2t+c2 를 이용하여 움직임 구간(t1<t<t2)의 가속도 오차 at+c를 근사화하는데, 근사화된 움직임 구간의 가속도 오차의 기울기 a를 다음 식에 따라 먼저 결정하고, 그 후, 상수 c를 결정한다.The acceleration error at + c of the movement section t 1 <t <t 2 is approximated by using the approximate acceleration errors a 1 t + c 1 and a 2 t + c 2 of each stop section, and the approximated movement section The slope a of the acceleration error of is first determined according to the following equation, and then the constant c is determined.

Figure 112003033666045-pat00071
Figure 112003033666045-pat00071

또한, 정지 구간의 근사화된 가속도 오차의 기울기를 이용하여 상기 가속도 오차의 기울기 a를 다음의 수학식에 따라서 결정할 수도 있다.In addition, the slope a of the acceleration error may be determined according to the following equation using the slope of the approximate acceleration error of the stop section.

Figure 112003033666045-pat00072
Figure 112003033666045-pat00072

상기 수학식 8과 같이 정지 구간의 가속도 오차의 기울기들의 평균을 구함으 로써 움직임 구간의 가속도 오차의 기울기를 결정하는 것은 펜(1)에서 측정된 가속도 오차는 연속적으로 변화될 것이라는 직관에 기초한다.Determining the slope of the acceleration error of the movement section by obtaining the average of the slopes of the acceleration error of the stop section as shown in Equation 8 is based on the intuition that the acceleration error measured in the pen 1 will be continuously changed.

한편, 시간 t1과 t2에서 펜(1)은 속도가 0인 상태이므로 도 6(a)에 도시된 실제 측정 가속도에서 오차를 보상한 실제 가속도를 t1에서 t2까지 적분하면 0이 되어야 한다는 다음의 수학식에 따르는 조건에서, 상수 c를 구할 수 있다. On the other hand, since at time t1 and t2 the pen 1 is in a state of zero velocity, the following mathematical equation should be made by integrating the actual acceleration that compensates for the error in the actual measured acceleration shown in FIG. 6 (a) from t1 to t2. Under the conditions of the equation, the constant c can be found.

Figure 112003033666045-pat00073
Figure 112003033666045-pat00073

여기서,

Figure 112003033666045-pat00074
는 보상된 가속도, A는 측정된 가속도를 나타낸다.here,
Figure 112003033666045-pat00074
Is the compensated acceleration, A is the measured acceleration.

수학식 9를 상수 c 에 관하여 정리하면 다음의 수학식을 얻는다.Summarizing Equation 9 with respect to the constant c, the following equation is obtained.

Figure 112003033666045-pat00075
Figure 112003033666045-pat00075

상술한 수학식 7 또는 8, 및 수학식 10에 의해서 구해진 움직임 구간(t1<t<t2)의 가속도 오차 at+c를, 영속도 보상된 가속도의 곡선과 함께 도시하면 도 6(b)와 같다.The acceleration error at + c of the movement section t 1 <t <t 2 obtained by the above-described equations (7) or (8) and (10) together with the zero speed compensated acceleration curve is shown in FIG. Same as

움직임 구간동안, 측정된 가속도에서 계산된 가속도 오차 at+c를 감산하여 항법 프레임에서의 보상된 가속도 A''를 구한다.During the motion period, the compensated acceleration A '' in the navigation frame is obtained by subtracting the acceleration error at + c calculated from the measured acceleration.

Figure 112003033666045-pat00076
Figure 112003033666045-pat00076

도 6(c)는 영속도 보상 및 움직임 구간에서의 가속도 오차가 보상된 가속도를 도시한 것이다.FIG. 6 (c) shows accelerations in which zero error compensation and acceleration errors in a movement section are compensated.

가속도 보상부(52)에서 상술한 바와 같은 과정에 따라 가속도 보상이 이루어지면, 위치 계산부(53)는 가속도를 이중적분하여 항법 프레임에서의 펜(1)의 위치를 계산한다.When acceleration compensation is performed in the acceleration compensation unit 52 according to the above-described process, the position calculation unit 53 calculates the position of the pen 1 in the navigation frame by double-integrating the acceleration.

가속도 보상의 다른 예로서, 가속도 오차가 일정하다고 가정하고, 움직이기 시작한 순간과 멈춘 순간의 속도가 0 이라는 조건을 만족하는 가속도 오차 값을 계산하여 보상할 수 있다. 계산된 가속도 오차값은 측정된 가속도에서 뺀 후 이를 시간에 대해 이중 적분하여 위치를 구하게 된다.As another example of acceleration compensation, assuming that the acceleration error is constant, the acceleration error value satisfying the condition that the velocity at the moment of starting and stopping the motion is 0 may be calculated and compensated. The calculated acceleration error value is subtracted from the measured acceleration and then doubled integrated over time to find the position.

도 7은 서로 다른 문자에 대해 펜의 스트로크의 궤적(trajectory)을 측정할 때, 보상이 없는 종래 기술과 보상이 이루어진 본 발명에 의한 궤적 추적 에러를 비교하여 표로 도시한 것이다. Wacom Intous 태블릿(tablet)에 의해 기록된 궤적을 레퍼런스 궤적으로 하였고, 상기 레퍼런스 궤적에 대해 INS 펜에 의해 얻어진 궤적을 각각 보상이 없는 종래기술과 본 발명에 따라 재생한 궤적의 위치 에러를 나타내었다. 위치 에러는 다음의 식에 따라 계산되었다.FIG. 7 is a table comparing trajectory tracking errors according to the present invention in which compensation is made with the prior art without compensation when measuring the trajectory of the stroke of a pen for different characters. The trajectory recorded by the Wacom Intous tablet (tablet) was referred to as a reference trajectory, and the position error of the trajectory reproduced according to the prior art and the present invention without compensation for the trajectory obtained by the INS pen for the reference trajectory, respectively. The position error was calculated according to the following equation.

Figure 112003033666045-pat00077
Figure 112003033666045-pat00077

여기서, N은 각 문자의 샘플링 수, T는 샘플링 간격,

Figure 112003033666045-pat00078
는 태블릿으로부터 얻어진 레퍼런스 위치 정보이고,
Figure 112003033666045-pat00079
는 종래 기술과 본 발명에 의해 계산된 위치 정보를 나타낸다. 즉, 동일한 문자에 대해 레퍼런스 위치 정보와 종래 기술 또는 본 발명에 의한 위치 정보간의 거리를 나타낸 것이다. 도시된 표에 따르면, 문자에 대해 최대, 최소 혹은 평균거리에 있어서 종래 기술에 의한 결과보다 본 발명에 의한 에러가 작고 그에 따라 본 발명에 의한 궤적의 재생이 보다 우수함을 알 수 있다. 특히 평균 위치 에러가 0.0195m에서 0.016m로 개선되었음을 알 수 있다.Where N is the number of samples for each character, T is the sampling interval,
Figure 112003033666045-pat00078
Is the reference position information obtained from the tablet,
Figure 112003033666045-pat00079
Denotes position information calculated by the prior art and the present invention. That is, the distance between the reference position information and the position information according to the prior art or the present invention is shown for the same character. According to the table shown, it can be seen that the error according to the present invention is smaller in the maximum, minimum or average distance to the character than the result according to the prior art, and thus the reproduction of the trajectory according to the present invention is better. In particular, it can be seen that the average position error is improved from 0.0195 m to 0.016 m.

도 8a 내지 8c는 태블릿을 레퍼런스 궤적으로하여 가속도 보상으로서 영속도 보상만 이루어진 종래기술과 가속도 및 각속도 보상이 모두 이루어진 본 발명에 의한 궤적 추적 결과를 도시한 것이다. 각각 "9", "q" 및 "y"의 궤적을 나타낸다. 도시된 바에 따르면, 본 발명에 따른 보상결과가 레퍼런스 궤적을 보다 정확하게 추적하는 것을 알 수 있다.8a to 8c show the trajectory tracking results according to the present invention in which both the acceleration and the angular velocity compensation and the prior art having only zero speed compensation as acceleration compensation by using the tablet as a reference trajectory. The trajectories of "9", "q" and "y" are shown respectively. As shown, it can be seen that the compensation result according to the present invention tracks the reference trajectory more accurately.

본 발명에 따르면, INS의 궤적 추적시 가속도 보상 뿐 만 아니라 각속도 보상도 고려함으로써 보다 정확한 추적이 가능하다. 또한 가속도 보상 또는 각속도 보상시 복잡한 비선형 함수를 선형 함수로 근사하여 보상함으로써 보다 계산이 간단하다.According to the present invention, more accurate tracking is possible by considering not only acceleration compensation but also angular velocity compensation when tracking the INS trajectory. In addition, the calculation is simplified by approximating a complex nonlinear function to the linear function for acceleration compensation or angular velocity compensation.

Claims (25)

(a) 시스템의 움직임 여부를 감지하여, 상기 시스템의 정지 구간 및 움직임 구간 정보를 출력하는 단계;(a) detecting whether the system is in motion and outputting information about a stop period and a motion section of the system; (b) 상기 각 구간마다 상기 시스템의 각속도 정보를 입력받아 상기 각속도 정보로부터 상기 시스템의 제1자세를 계산하는 단계;(b) receiving the angular velocity information of the system for each section and calculating a first posture of the system from the angular velocity information; (c) 상기 정지 구간에서 상기 시스템의 중력방향 정보를 입력받아 상기 중력방향 정보로부터 상기 시스템의 제2자세를 계산하고, 상기 제1자세 및 제2자세로부터 상기 각 구간에서의 상기 시스템의 자세 오차를 계산하는 단계; 및(c) receiving the gravity direction information of the system in the stop section and calculating the second posture of the system from the gravity direction information, and the attitude error of the system in each section from the first posture and the second posture; Calculating; And (d) 상기 제1자세에 대해 상기 시스템의 자세 오차를 보상하여 출력하는 단계를 포함함을 특징으로하는 관성 항법 시스템의 자세 보상 방법.and (d) compensating for the posture error of the system with respect to the first posture and outputting the posture error. 제1항에 있어서, 상기 정지 구간은 The method of claim 1, wherein the stop section 상기 시스템이 움직이기 이전의 제1정지 구간과 상기 시스템의 움직임이 종료된 이후의 제2정지 구간으로 구분되는 것을 특징으로하는 관성 항법 시스템의 자세 보상 방법.And a first stop section before the system is moved and a second stop section after the movement of the system is terminated. 제2항에 있어서, 상기 제1 또는 제2정지 구간에서는The method of claim 2, wherein the first or second stop section 상기 중력 방향 정보의 표준편차 또는 각속도 정보의 표준 편차가 소정의 임계치 이하인것을 특징으로하는 관성 항법 시스템의 자세 보상 방법.And a standard deviation of the gravitational direction information or a standard deviation of the angular velocity information is equal to or less than a predetermined threshold. 제2항에 있어서, 상기 제1정지 구간에서 시스템의 자세 오차는The method of claim 2, wherein the attitude error of the system in the first stop section is 상기 제1자세 및 제2자세의 차가 시간에 대해 선형적으로 변화하고, 상기 제1정지 구간의 시작시간에서의 상기 제1자세 및 제2자세의 차는 0이 되도록 출력되는 것을 특징으로하는 관성 항법 시스템의 자세 보상 방법.The difference between the first posture and the second posture varies linearly with respect to time, and the difference between the first posture and the second posture at the start time of the first stop section is output to be 0 Posture compensation method of the system. 제4항에 있어서, 상기 움직임 구간의 시스템의 자세 오차는The attitude error of the system of the movement section is 상기 움직임 구간의 시작시간과 종료시간에 계산된 상기 제1자세 및 제2자세의 차가 시간에 대해 선형적으로 변화하고, 상기 움직임 구간의 시작시간에서의 상기 제1자세 및 제2자세의 차는 상기 제1정지 구간의 종료시간에 계산된 상기 제1자세 및 제2자세의 차가 되도록 출력되는 것을 특징으로하는 관성 항법 시스템의 자세 보상 방법.The difference between the first posture and the second posture calculated at the start time and the end time of the movement section varies linearly with respect to time, and the difference between the first posture and the second posture at the start time of the movement section is And outputting the difference between the first posture and the second posture calculated at the end time of the first stop section. 제5항에 있어서, 상기 제2정지 구간의 시스템의 자세 오차는The attitude error of the system of the second stop section is 상기 제2정지 구간의 종료시간까지 상기 움직임 구간의 시스템 자세 오차의 선형적 변화가 연장되어 출력되는 것을 특징으로하는 관성 항법 시스템의 자세 보상 방법.And a linear change in the system attitude error of the movement section until the end time of the second stopping section is output. 제1항에 있어서, 상기 제2자세는The method of claim 1, wherein the second posture 다음 식Following expression
Figure 112005054670641-pat00097
Figure 112005054670641-pat00097
여기서, g는 중력 가속도,
Figure 112005054670641-pat00081
는 상기 중력방향 정보
Where g is the acceleration of gravity,
Figure 112005054670641-pat00081
The gravity direction information
와 같이 얻어지는 것을 특징으로하는 관성 항법 시스템의 자세 보상 방법.The attitude compensation method of the inertial navigation system, characterized in that obtained as follows.
시스템의 움직임 여부를 감지하여, 상기 시스템의 정지 구간 및 움직임 구간의 정보를 출력하는 움직임 감지부(20);A motion detector 20 which detects whether the system is in motion and outputs information on the stop period and the motion section of the system; 상기 시스템의 각속도 정보를 입력받아 상기 각속도 정보로부터 상기 시스템의 제1자세를 계산하는 자세 계산부(21);A posture calculation unit (21) for receiving angular velocity information of the system and calculating a first posture of the system from the angular velocity information; 상기 시스템의 중력방향 정보를 입력받아 상기 중력방향 정보로부터 상기 시스템의 제2자세를 계산하고, 상기 제1자세 및 제2자세로부터 상기 각 구간에 대한 상기 시스템의 자세의 오차를 계산하는 자세 에러 계산부(22); 및Posture error calculation for receiving the gravity direction information of the system and calculating the second posture of the system from the gravity direction information, and calculating the error of the posture of the system for each section from the first posture and the second posture Part 22; And 상기 제1자세에 대해 상기 자세 오차를 보상하는 자세 보상부(23)를 포함함을 특징으로하는 관성 항법 시스템의 자세 보상 장치.And a posture compensator (23) for compensating the posture error with respect to the first posture. 제8항에 있어서, 상기 움직임 감지부(20)는The method of claim 8, wherein the motion detection unit 20 상기 정지 구간을 상기 시스템이 움직이기 이전의 제1정지 구간과 상기 시스템의 움직임이 종료된 이후의 제2정지 구간으로 구분하는 수단을 구비하는 것을 특징으로하는 관성 항법 시스템의 자세 보상 장치.And a means for dividing the stop section into a first stop section before the system is moved and a second stop section after the movement of the system is completed. 제9항에 있어서, 상기 자세 에러 계산부(22)는The posture error calculation unit 22 of claim 9, wherein 상기 각 구간의 시작 시간 및 종료 시간에 계산된 상기 제1자세 및 제2자세의 차가 시간에 따라 선형적으로 변화하도록 근사하여 상기 시스템의 자세 에러를 계산하는 수단을 구비하는 것을 특징으로하는 관성 항법 시스템의 자세 보상 장치.Means for calculating an attitude error of the system by approximating a difference between the first posture and the second posture calculated at the start time and the end time of each section to change linearly with time. Posture compensation device of the system. 제8항에 있어서, 상기 자세 에러 계산부(22)는The posture error calculation unit 22 of claim 8, wherein 다음 식Following expression
Figure 112005054670641-pat00098
Figure 112005054670641-pat00098
여기서, g는 중력 가속도,
Figure 112005054670641-pat00083
는 상기 중력 방향 정보
Where g is the acceleration of gravity,
Figure 112005054670641-pat00083
The gravity direction information
와 같이 상기 제2자세를 얻는 수단을 구비하는 것을 특징으로하는 관성 항법 시스템의 자세 보상 장치.And a means for obtaining the second posture as in the above.
(a) 시스템의 움직임 여부를 감지하여, 상기 시스템의 정지 구간 및 움직임 구간의 정보를 출력하는 단계;(a) detecting whether the system is in motion and outputting information on the stop period and the motion period of the system; (b) 상기 시스템의 각속도 정보를 입력받아 상기 각속도 정보로부터 상기 시스템의 자세를 계산하고, 상기 시스템의 가속도 정보를 입력받아 상기 가속도 정보를 이용하여 상기 시스템의 자세를 보상하는 단계;(b) receiving the angular velocity information of the system to calculate the posture of the system from the angular velocity information, and receiving the acceleration information of the system to compensate for the posture of the system using the acceleration information; (c) 보상된 자세를 이용하여 상기 가속도 정보를 상기 시스템을 포함하고있는 공간에서의 가속도 정보로 변환하는 단계; 및(c) converting the acceleration information into acceleration information in the space containing the system using the compensated attitude; And (d) 상기 변환된 가속도 정보로부터 상기 공간에서의 상기 시스템의 위치를 계산하는 단계를 포함함을 특징으로하는 관성 항법 시스템의 위치 계산 방법.(d) calculating a position of the system in the space from the converted acceleration information. 제12항에 있어서, 상기 정지 구간은 The method of claim 12, wherein the stop section 상기 시스템이 움직이기 이전의 제1정지 구간과 상기 시스템의 움직임이 종료된 이후의 제2정지 구간으로 구분되는 것을 특징으로하는 관성 항법 시스템의 위치 계산 방법.And a first stop section before the system is moved and a second stop section after the movement of the system is terminated. 제13항에 있어서, 상기 제1 또는 제2정지 구간에서는The method of claim 13, wherein in the first or second stop section 상기 가속도 정보의 표준편차 또는 각속도 정보의 표준 편차가 소정의 임계치 이하인것을 특징으로하는 관성 항법 시스템의 위치 계산 방법.The standard deviation of the acceleration information or the standard deviation of the angular velocity information is less than a predetermined threshold position calculation method of the inertial navigation system. 제14항에 있어서, 상기 (b)단계는The method of claim 14, wherein step (b) (b1) 상기 각 구간마다 상기 각속도 정보로부터 상기 시스템의 제1자세를 계산하는 단계;(b1) calculating a first posture of the system from the angular velocity information in each section; (b2) 상기 각 구간마다 상기 가속도 정보로부터 상기 시스템의 제2자세를 계산하고, 상기 제1자세 및 제2자세로부터 상기 각 구간에서의 상기 시스템의 자세 오차를 계산하는 단계; 및(b2) calculating a second posture of the system from the acceleration information for each section, and calculating an attitude error of the system in each section from the first posture and the second posture; And (b3) 상기 제1자세에 대해 상기 시스템의 자세 오차를 보상하여 출력하는 단계를 구비함을 특징으로하는 관성 항법 시스템의 위치 계산 방법.and (b3) compensating for and outputting an attitude error of the system with respect to the first posture. 제14항에 있어서, 상기 (c)단계 및 (d)단계 사이에15. The method of claim 14, wherein steps (c) and (d) 상기 움직임 구간에서 상기 변환된 가속도 정보로부터 움직이기 시작한 순간과 멈춘 순간의 속도가 0 이라는 조건을 만족하는 가속도 오차 값을 계산하고, 계산된 가속도 오차값을 상기 변환된 가속도 정보로부터 감산하여 상기 변환된 가속도 정보를 보상하는 것을 특징으로하는 관성 항법 시스템의 위치 계산 방법.In the movement section, an acceleration error value that satisfies the condition that the speed at which the motion starts and stops is 0 is calculated from the converted acceleration information is calculated, and the calculated acceleration error value is subtracted from the converted acceleration information to convert the converted acceleration information. A method for calculating the position of an inertial navigation system, characterized by compensating acceleration information. 제14항에 있어서, 상기 (c)단계 및 (d)단계 사이에15. The method of claim 14, wherein steps (c) and (d) (e) 상기 (c)단계에서 변환된 가속도 정보를 각 구간별로 선형근사하여 가속도 오차를 구하고, 상기 변환된 가속도 정보에 대해 가속도 오차를 보상하는 단계를 더 구비하는 것을 특징으로하는 관성 항법 시스템의 위치 계산 방법.(e) obtaining an acceleration error by linearly approximating the acceleration information converted in step (c) for each section, and compensating for the acceleration error with respect to the converted acceleration information. Location calculation method. 제17항에 있어서, 상기 (e)단계는The method of claim 17, wherein step (e) (e1) 상기 제1 및 제2정지 구간에서 상기 변환된 가속도 정보가 시간에 따라 선형적으로 변화하도록 근사하고, 상기 선형 근사된 가속도 정보를 0으로 하는 단 계;(e1) approximating the converted acceleration information to change linearly with time in the first and second stop sections, and setting the linearly approximated acceleration information to zero; (e2) 상기 제1 및 제2정지 구간에서 각각 선형 근사된 기울기들 및 소정 초기조건을 이용하여 상기 움직임 구간에서 상기 변환된 가속도 정보를 선형 근사하는 단계; 및(e2) linearly approximating the converted acceleration information in the movement section by using the linear approximations and predetermined initial conditions in the first and second stop sections, respectively; And (e3) 상기 움직임 구간에서 상기 변환된 가속도 정보에 대해 상기 선형 근사된 가속도 정보를 보상하는 단계를 구비함을 특징으로하는 관성 항법 시스템의 위치 계산 방법.(e3) compensating for the linearly approximated acceleration information with respect to the converted acceleration information in the movement section. 시스템의 움직임 여부를 감지하여, 상기 시스템의 정지 구간 및 움직임 구간의 정보를 출력하는 움직임 감지부(20);A motion detector 20 which detects whether the system is in motion and outputs information on the stop period and the motion section of the system; 상기 시스템의 각속도 정보를 입력받아 상기 각속도 정보로부터 상기 시스템의 자세를 계산하고, 상기 시스템의 가속도 정보를 입력받아 상기 가속도 정보를 이용하여 상기 시스템의 자세를 보상하는 자세 보상 장치(50);A posture compensator (50) for receiving the angular velocity information of the system to calculate the posture of the system from the angular velocity information, and receiving the acceleration information of the system to compensate for the posture of the system using the acceleration information; 보상된 자세를 이용하여 상기 가속도 정보를 상기 시스템을 포함하고있는 공간에서의 가속도 정보로 변환하는 가속도 변환부(51); 및An acceleration conversion unit (51) for converting the acceleration information into acceleration information in a space including the system using a compensated attitude; And 변환된 가속도 정보로부터 상기 공간에서의 상기 시스템의 위치를 계산하는 위치 계산부(53)를 포함함을 특징으로하는 관성 항법 시스템의 위치 계산 장치.And a position calculator (53) for calculating the position of the system in the space from the converted acceleration information. 제19항에 있어서, 상기 움직임 감지부(20)는The method of claim 19, wherein the motion detection unit 20 상기 정지 구간을 상기 시스템이 움직이기 이전의 제1정지 구간과 상기 시스템의 움직임이 종료된 이후의 제2정지 구간으로 구분하는 수단을 구비하는 것을 특징으로하는 관성 항법 시스템의 위치 계산 장치.And a means for dividing the stop section into a first stop section before the system is moved and a second stop section after the movement of the system is completed. 제20항에 있어서, 상기 움직임 감지부(20)는The method of claim 20, wherein the motion detection unit 20 상기 가속도 정보의 표준편차 또는 각속도 정보의 표준 편차가 소정의 임계치 이하이면 상기 제1 또는 제2정지 구간으로 판정하는 수단을 구비하는 것을 특징으로하는 관성 항법 시스템의 위치 계산 장치.And a means for determining the first or second stop section when the standard deviation of the acceleration information or the standard deviation of the angular velocity information is equal to or less than a predetermined threshold value. 제19항에 있어서, 상기 가속도 변환부(51)와 위치 계산부(53) 사이에20. The method according to claim 19, wherein between the acceleration converter (51) and the position calculator (53) 상기 움직임 구간에서 상기 변환된 가속도 정보로부터 상기 시스템이 움직이기 시작한 순간과 멈춘 순간의 속도가 0 이라는 조건을 만족하는 가속도 오차 값을 계산하고, 계산된 가속도 오차값을 상기 변환된 가속도 정보로부터 감산하여 상기 변환된 가속도 정보를 보상하는 가속도 보상부(52)를 더 구비하는 것을 특징으로하는 관성 항법 시스템의 위치 계산 장치.In the movement section, an acceleration error value satisfying the condition that the speed at which the system starts and stops is zero is calculated from the converted acceleration information, and the calculated acceleration error value is subtracted from the converted acceleration information. And an acceleration compensator (52) for compensating the converted acceleration information. 제19항에 있어서, 상기 가속도 변환부(51)와 위치 계산부(53) 사이에20. The method according to claim 19, wherein between the acceleration converter (51) and the position calculator (53) 상기 각 구간에 대해 상기 가속도 변환부(51)에서 변환된 가속도 정보를 선형 근사하고, 상기 선형 근사된 가속도 정보를 이용하여 상기 변환된 가속도 정보를 보상하는 가속도 보상부(52)를 더 구비하는 것을 특징으로하는 관성 항법 시스템의 위치 계산 장치.Further comprising an acceleration compensation unit 52 for linearly approximating the acceleration information converted by the acceleration conversion unit 51 for each section, and compensating the converted acceleration information by using the linear approximated acceleration information. A device for calculating the position of an inertial navigation system. 제23항에 있어서, 상기 가속도 보상부(52)는The method of claim 23, wherein the acceleration compensation unit 52 상기 제1 및 제2정지 구간에서 상기 가속도 변환부(51)에서 변환된 가속도 정보가 시간에 따라 선형적으로 변화하도록 근사하고, 상기 선형 근사된 가속도 정보의 기울기들을 이용하여 상기 움직임 구간에서 상기 가속도 변환부(51)에서 변환된 가속도 정보를 선형 근사하며, 상기 제1 및 제2정지 구간에서 선형 근사된 가속도 정보를 0으로 보정하고, 상기 움직임 구간에서 상기 선형 근사된 가속도 정보를 이용하여 상기 변환된 가속도 정보를 보상하는 수단을 구비하는 것을 특징으로하는 관성 항법 시스템의 위치 계산 장치. It is approximated so that the acceleration information converted by the acceleration conversion unit 51 changes linearly with time in the first and second stop periods, and the accelerations in the movement period using gradients of the linearly approximated acceleration information. Linearly approximating the acceleration information converted by the conversion unit 51, correcting the acceleration information linearly approximated in the first and second stop sections to 0, and converting the acceleration information using the linear approximation acceleration information in the movement section. And means for compensating for the accelerated acceleration information. 제19항에 있어서, 상기 위치 계산부(53)는The method of claim 19, wherein the position calculation unit 53 상기 각 구간마다 상기 각속도 정보 및 가속도 정보로부터 각각 상기 시스템의 제1자세 및 제2자세를 계산하고, 상기 제1자세 및 제2자세로부터 상기 각 구간에서의 상기 시스템의 자세 오차를 계산하며, 상기 제1자세에 대해 상기 시스템의 자세 오차를 보상하는 수단을 구비하는 것을 특징으로하는 관성 항법 시스템의 위치 계산 장치.Calculating the first and second postures of the system from the angular velocity information and the acceleration information for each section, and calculating the attitude error of the system in each section from the first and second postures, And means for compensating the attitude error of the system with respect to a first posture.
KR1020030062779A 2003-09-08 2003-09-08 Methods and apparatuses for compensating attitude of and locating inertial navigation system KR100552688B1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
KR1020030062779A KR100552688B1 (en) 2003-09-08 2003-09-08 Methods and apparatuses for compensating attitude of and locating inertial navigation system
US10/935,303 US7366612B2 (en) 2003-09-08 2004-09-08 Method and apparatus for compensating attitude of inertial navigation system and method and apparatus for calculating position of inertial navigation system using the same

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020030062779A KR100552688B1 (en) 2003-09-08 2003-09-08 Methods and apparatuses for compensating attitude of and locating inertial navigation system

Publications (2)

Publication Number Publication Date
KR20050025836A KR20050025836A (en) 2005-03-14
KR100552688B1 true KR100552688B1 (en) 2006-02-20

Family

ID=34309405

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020030062779A KR100552688B1 (en) 2003-09-08 2003-09-08 Methods and apparatuses for compensating attitude of and locating inertial navigation system

Country Status (2)

Country Link
US (1) US7366612B2 (en)
KR (1) KR100552688B1 (en)

Families Citing this family (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4615287B2 (en) * 2004-11-01 2011-01-19 東京計器株式会社 Azimuth and orientation detection device
KR100797391B1 (en) * 2004-12-21 2008-01-28 한국전자통신연구원 Method and Apparatus for Correcting Position And Attitude Information of Camera
JP5127128B2 (en) 2004-12-21 2013-01-23 韓國電子通信研究院 Camera position and orientation information correction method and apparatus
KR100666048B1 (en) * 2005-05-20 2007-01-10 삼성전자주식회사 Portable terminal measuring reference tilt and method of reference tilt using the same
US7792640B2 (en) * 2005-10-24 2010-09-07 Motorola, Inc. Altitude correction of a navigational device
JP4842885B2 (en) 2007-05-23 2011-12-21 トヨタ自動車株式会社 In-vehicle device control system and vehicle
WO2009008372A1 (en) * 2007-07-06 2009-01-15 Sony Corporation Input device, controller, control system, control method, and hand-held device
US9848981B2 (en) * 2007-10-12 2017-12-26 Mayo Foundation For Medical Education And Research Expandable valve prosthesis with sealing mechanism
US8010308B1 (en) * 2007-11-23 2011-08-30 Microstrain, Inc. Inertial measurement system with self correction
US8224575B2 (en) * 2008-04-08 2012-07-17 Ensco, Inc. Method and computer-readable storage medium with instructions for processing data in an internal navigation system
KR101607476B1 (en) * 2009-06-12 2016-03-31 삼성전자주식회사 Apparatus and method for motion detection in portable terminal
KR101259560B1 (en) * 2009-12-21 2013-04-30 한국전자통신연구원 Apparatus and method for fall-down detection, and system for emergency aid using the same
JP5614527B2 (en) * 2010-03-05 2014-10-29 セイコーエプソン株式会社 Attitude information calculation apparatus, attitude information calculation system, attitude information calculation method, and attitude information calculation program
KR101640072B1 (en) * 2010-03-31 2016-07-15 삼성전자주식회사 Apparatus and method for revising value of accelerometer sensor in portalble terminal
JP5459179B2 (en) * 2010-05-14 2014-04-02 カシオ計算機株式会社 Moving state discriminating apparatus, moving state discriminating method and program
JP5685842B2 (en) * 2010-07-12 2015-03-18 セイコーエプソン株式会社 Robot device and control method of robot device
JP5477238B2 (en) * 2010-09-13 2014-04-23 富士通株式会社 Information processing method, apparatus and program
CN103019093B (en) * 2011-09-26 2015-10-07 东莞易步机器人有限公司 The preparation method of two-wheel vehicle used sensor fusion angle
KR101193917B1 (en) * 2012-06-08 2012-10-29 한국항공우주연구원 Measuring method for rotational speed of sphere using accelerometers
US20140236529A1 (en) * 2013-02-18 2014-08-21 Motorola Mobility Llc Method and Apparatus for Determining Displacement from Acceleration Data
CN103364842B (en) * 2013-07-29 2017-03-01 中国人民解放军国防科学技术大学 A kind of error separation method of strapdown airborne gravitometer
CN103968848A (en) * 2014-05-20 2014-08-06 东莞市泰斗微电子科技有限公司 Navigation method and navigation system based on inertial sensor
CN106575150B (en) 2014-08-16 2020-03-03 谷歌有限责任公司 Method for recognizing gestures using motion data and wearable computing device
US10231337B2 (en) 2014-12-16 2019-03-12 Inertial Sense, Inc. Folded printed circuit assemblies and related methods
CN109764878B (en) * 2019-04-01 2022-03-29 中国民航大学 Indoor positioning method of intelligent mobile phone inertial sensor based on zero acceleration correction
CN112082544B (en) * 2019-06-12 2022-09-30 杭州海康汽车技术有限公司 IMU data compensation method and device
CN111024070A (en) * 2019-12-23 2020-04-17 哈尔滨工程大学 Inertial foot binding type pedestrian positioning method based on course self-observation
CN111811536B (en) * 2020-05-29 2022-09-16 中国船舶重工集团公司第七0七研究所 Inertial navigation position error estimation method based on gravity and base velocity information
CN113175926B (en) * 2021-04-21 2022-06-21 哈尔滨工程大学 Self-adaptive horizontal attitude measurement method based on motion state monitoring

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3695554A (en) * 1970-10-16 1972-10-03 Rca Corp Nutation damping in dual-spin spacecraft
WO2002037827A2 (en) * 2000-10-30 2002-05-10 Naval Postgraduate School Method and apparatus for motion tracking of an articulated rigid body

Also Published As

Publication number Publication date
US20050065728A1 (en) 2005-03-24
US7366612B2 (en) 2008-04-29
KR20050025836A (en) 2005-03-14

Similar Documents

Publication Publication Date Title
KR100552688B1 (en) Methods and apparatuses for compensating attitude of and locating inertial navigation system
KR100480793B1 (en) Method and apparatus for compensating the acceleration error and inertial navigation system using thereof
US8170726B2 (en) System and method for road angle estimation
KR101185144B1 (en) Method and apparatus for estimating 2-dimension trajectory of a gesture
CN107560613B (en) Robot indoor track tracking system and method based on nine-axis inertial sensor
KR100643304B1 (en) Apparatus and method for correcting inertia measurement unit and recording medium for recording the method
JP4876204B2 (en) Small attitude sensor
KR101950359B1 (en) Method for position estimation of hybird motion capture system
KR20190041315A (en) Inertial-based navigation device and Inertia-based navigation method based on relative preintegration
CN110926460A (en) Uwb positioning abnormal value processing method based on IMU
CN105404296A (en) Two-wheeled self-balancing intelligent vehicle posture control method
KR100898169B1 (en) Initial alignment method of inertial navigation system
CN106370178B (en) Attitude measurement method and device of mobile terminal equipment
CN111723624B (en) Head movement tracking method and system
CN107941212B (en) Vision and inertia combined positioning method
CN109764870B (en) Carrier initial course estimation method based on transformation estimation modeling scheme
CN113031639B (en) Robot step processing method and device, robot control equipment and storage medium
CN108663067A (en) A kind of adaptive calibration method and system of motion sensor
Yang et al. Analysis and compensation of errors in the input device based on inertial sensors
JP2014240266A (en) Sensor drift amount estimation device and program
CN104819717A (en) Multi-rotor aircraft attitude detection method based on MEMS inertial sensor group
TWI472953B (en) Inertial sensing input apparatus, system and method thereof
KR101226767B1 (en) System and Method for localizationing of Autonomous Vehicle
CN115540854A (en) Active positioning method, equipment and medium based on UWB assistance
US20220348188A1 (en) System and method of calibrating an inertial measurement unit on a vehicle

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

Year of fee payment: 8

FPAY Annual fee payment

Payment date: 20140124

Year of fee payment: 9

FPAY Annual fee payment

Payment date: 20150116

Year of fee payment: 10

FPAY Annual fee payment

Payment date: 20160118

Year of fee payment: 11

FPAY Annual fee payment

Payment date: 20170117

Year of fee payment: 12

FPAY Annual fee payment

Payment date: 20180117

Year of fee payment: 13

FPAY Annual fee payment

Payment date: 20200120

Year of fee payment: 15