KR101147133B1 - 각도측정을 위한 상보필터 및 그 방법 - Google Patents
각도측정을 위한 상보필터 및 그 방법 Download PDFInfo
- Publication number
- KR101147133B1 KR101147133B1 KR1020110014091A KR20110014091A KR101147133B1 KR 101147133 B1 KR101147133 B1 KR 101147133B1 KR 1020110014091 A KR1020110014091 A KR 1020110014091A KR 20110014091 A KR20110014091 A KR 20110014091A KR 101147133 B1 KR101147133 B1 KR 101147133B1
- Authority
- KR
- South Korea
- Prior art keywords
- filter
- sensor
- value
- angle
- pass filter
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B7/00—Measuring arrangements characterised by the use of electric or magnetic techniques
- G01B7/30—Measuring arrangements characterised by the use of electric or magnetic techniques for measuring angles or tapers; for testing the alignment of axes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
-
- H—ELECTRICITY
- H03—ELECTRONIC CIRCUITRY
- H03H—IMPEDANCE NETWORKS, e.g. RESONANT CIRCUITS; RESONATORS
- H03H17/00—Networks using digital techniques
- H03H17/02—Frequency selective networks
- H03H17/0248—Filters characterised by a particular frequency response or filtering method
- H03H17/0264—Filter sets with mutual related characteristics
- H03H17/027—Complementary filters; Phase complementary filters
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Computer Hardware Design (AREA)
- Mathematical Physics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
Abstract
본 발명은 각도측정을 위한 상보필터에 관한 것으로, 최소자승법을 적용하여 n(단, n>=1)차의 필터계수를 산출하는 산출수단, 제1 센서의 출력 값을 필터링 하기 위한 n차의 저역통과필터, 제2 센서의 출력 값을 필터링 하기 위한 n차의 고역통과필터, 저역통과필터와 고역통과필터의 출력 값을 합산하는 합산수단, 합산수단으로부터 출력된 합산결과에 적분을 수행하여 피사체의 움직임에 대한 각도를 산출하는 적분수단을 포함한다.
Description
본 발명은 각도측정을 위한 상보필터 및 그 방법에 관한 것으로, 보다 구체적으로 n(단, n>=1)차의 저역통과필터와 고역통과필터를 적용하고, 최소자승법을 적용하여 n차의 상보필터를 형성함으로써 피사체의 움직임에 대한 각도를 측정하는 각도측정을 위한 상보필터 및 그 방법에 관한 것이다.
고정점을 기준으로 상대각도를 측정하는 엔코더와 같은 센서를 사용할 수 없는 무인 비행체, 밸런싱 로봇 등과 같은 모바일 로봇이 자신의 자세를 측정하기 위해서는 자이로 센서와 같은 관성센서를 이용하는 것이 필수적이다. 여기서 저가의 MEMS(Micro Electro Mechanical Systems) 관성 센서의 성능향상으로 소형로봇에 관성센서를 장착하여 자세 측정에 이용하려는 연구가 많이 진행되고 있다. 특히, 회전 각속도를 측정하는 자이로 센서와 가속도를 측정하는 가속도 센서에 관심이 집중되고 있다.
가속도 센서를 이용해서 각도를 측정하는 방법은 간단하게 수행될 수 있으나, 센서의 중심축이 회전중심축과 동일하지 않은 경우, 병진운동성분이 포함되어 오차가 발생되는 문제점이 있다. 또한, 자이로 센서를 이용하여 각도를 측정하는 방법은 측정된 각속도를 적분하여 각도를 산출해야 하므로 적분오차가 누적되는 에러가 발생하는 문제점이 있다.
이와 같이, 단일 센서를 사용한 경우에 발생하는 문제점으로 인하여 자이로 센서와 가속도 센서를 병합하여 사용하는 칼만필터 또는 상보필터 방법을 사용하기도 한다.
칼만필터 방법은 칼만필터 설계 시에 복잡한 수학적 문제를 다루어야 하고, 실제 구현에 있어서 많은 연산량을 필요로 하기 때문에 응답속도가 지연되는 문제점이 발생한다.
아울러, 상보필터의 설계는 칼만필터의 설계보다 상대적으로 간단한 각도 추정 필터 기법을 이용하고, 자이로 센서와 가속도 센서에 각각 고역통과필터와 저역통과필터를 적용한 후 조합한다.
일반적으로 상보필터는 필터계수를 이용하여 설계되는데 이는 실제 실험 환경을 구축하는 것이 용이하지 않고, 2차 이상의 고역통과필터 및 저역통과필터를 적용하는 경우, 결정해야할 미지수가 많아져 설계하기가 어려운 문제점이 발생한다.
또한, 각도측정을 위해 사용되는 센서의 종류, 센서의 제조사 등에 따라 필터계수는 변경되기 때문에 피사체의 움직임에 따른 각도 값이 정확하지 않은 문제가 발생한다.
따라서, 보다 용이하게 설계할 수 있고, 응답속도의 지연을 방지하면서도 각도측정에 정확한 필터의 설계가 시급한 실정이다.
따라서, 본 발명의 목적은 응답속도의 지연을 방지하고, 보다 용이하게 설계할 수 있으며, 피사체의 움직임에 대한 정확한 각도측정을 수행할 수 있도록 n(단, n>=1)의 저역통과필터와 고역통과필터 및 최소자승법을 적용하여 각도측정을 위한 n차 상보필터를 제공하는 것이다.
상기 목적을 달성하기 위하여, 본 발명에 따른 각도측정을 위한 상보필터는 최소자승법을 적용하여 n(단, n>=1)차의 필터계수를 산출하는 산출수단, 제1 센서의 출력 값을 필터링 하기 위한 n차의 저역통과필터, 제2 센서의 출력 값을 필터링 하기 위한 n차의 고역통과필터, 상기 저역통과필터와 고역통과필터의 출력 값을 합산하는 합산수단, 상기 합산수단으로부터 출력된 합산결과에 적분을 수행하여 피사체의 움직임에 대한 각도를 산출하는 적분수단을 포함하는 것을 특징으로 한다.
또한, 상기 고역통과필터의 출력 값과 필터계수를 연산하는 연산수단을 포함하는 것을 특징으로 한다.
또한, 상기 최소자승법은, 피사체에 발생한 움직임에 대한 각도의 실측정 값과 상기 제2 센서 측정 값의 델타 값을 산출하고, 산출된 델타 값에 대한 n-1회 적분 값과, 상기 제1 센서 측정 값과 상기 실측정 값에 대한 크사이 값을 이용하여 도출되는 것을 특징으로 한다.
또한, 상기 제1 센서는, 자이로 센서인 것을 특징으로 한다.
또한, 상기 제2 센서는, 가속도 센서 또는 기울기 센서인 것을 특징으로 한다.
따라서, 본 발명의 구조를 따르면 본 발명은 n(단, n>=1)차의 저역통과필터와 고역통과필터 및 최소자승법을 적용한 n차 상보필터를 설계하여 필터자체의 설계를 보다 용이하게 설계하고, 피사체의 움직임에 대한 각도측정 시 발생하는 응답속도의 지연을 방지함과 동시에 보다 정확한 각도측정을 수행할 수 있는 효과가 있다.
도 1은 종래기술에 따른 1차 상보필터를 나타내는 회로도
도 2는 본 발명의 실시예에 따른 각도측정을 위한 n(단, n>=1)차 상보필터를 나타내는 회로도
도 3은 본 발명의 실시예에 따른 3차 상보필터의 실험결과를 나타내는 도면
도 2는 본 발명의 실시예에 따른 각도측정을 위한 n(단, n>=1)차 상보필터를 나타내는 회로도
도 3은 본 발명의 실시예에 따른 3차 상보필터의 실험결과를 나타내는 도면
이하, 첨부 도면을 참조하여 본 발명의 실시예를 보다 상세하게 설명하고자 한다. 이에 앞서, 본 명세서 및 청구범위에 사용된 용어나 단어는 통상적이거나 사전적인 의미로 한정하여 해석되어서는 아니 되며, 발명자는 그 자신의 발명을 가장 최선의 방법으로 설명하기 위해 용어의 개념을 적절하게 정의할 수 있다는 원칙에 입각하여, 본 발명의 기술적 사상에 부합하는 의미와 개념으로 해석되어야만 한다.
따라서, 본 명세서에 기재된 실시예와 도면에 도시된 구성은 본 발명의 가장 바람직한 일 실시예에 불과할 뿐이고 본 발명의 기술적 사상을 모두 대변하는 것은 아니므로, 본 출원시점에 있어서 이들을 대체할 수 있는 다양한 균등물과 변형예들이 있을 수 있음을 이해하여야 한다.
도 1은 종래기술에 따른 1차 상보필터를 나타내는 회로도이다.
일반적으로, 종래기술에 따른 1차 상보필터는 고주파 영역에서 응답특성이 좋은 자이로 센서(미도시)에서의 출력 값을 적분한 값에 고역통과필터를 설계하고, 저주파 영역에서 응답특성이 좋은 가속도 센서(미도시) 또는 기울기 센서(미도시)에서 출력된 값에 저역통과필터를 설계한다. 그리고 설계된 각 필터로부터 출력되는 출력 값을 합산하여 피사체의 움직임에 따른 각도 값을 도출한다. 이는 간단하게 정리하면 하기의 수학식 1과 같이 나타낼 수 있고, 수학식 1을 회로도로 나타내면 도 1과 같다.
여기서, 는 피사체의 움직임에 대한 각도 산출의 결과 값, 는 자이로 센서에서 측정된 각속도 값, 는 가속도 센서 또는 기울기 센서(미도시)에서 측정된 각도 값, 은 필터계수를 나타낸다.
도 1을 참조하면, 종래기술에 따른 1차 상보필터(100)는 제1 합산수단(110), 연산수단(120), 제2 합산수단(130), 적분수단(140)으로 구성된다.
이후, 적분수단(140)은 제2 합산수단(130)에서 도출된 값에 적분을 수행하여 피사체의 움직임에 따른 각도 값을 도출한다.
도 2는 본 발명의 실시예에 따른 각도측정을 위한 n(단, n>=1)차 상보필터를 나타내는 회로도이다.
도 2를 참조하면, 본 발명에 따른 각도측정을 위한 n차 상보필터(200, 이하, n차 상보필터라 함)는 제1 합산수단(210), n개의 연산수단(220), 제2 합산수단(230), n개의 적분수단(240)으로 구성되고, 산출수단(미도시)을 포함한다.
n차 상보필터(200)는 각도정보를 가공하고 보정하는데 사용되는 여러 가지 주요 필터 중 하나를 나타내는 것으로, n차 상보필터(200)는 하기의 수학식 2에 의해 설계되고, 도 2는 수학식 2를 도식화한 도면이다.
여기서, 는 피사체의 움직임에 대한 각도 산출의 결과 값, 는 상기 자이로 센서(미도시)에서 측정된 각속도 값, 는 가속도 센서 또는 기울기 센서(미도시)에서 측정된 각도, 은 필터계수, k는 자이로 센서 및 가속도 센서 또는 자이로 센서 및 기울기 센서에서 측정된 측정 횟수를 나타낸다.
보다 구체적으로 설명하면, 제1 합산수단(210)은 n(단, n>=1)차의 고역통과필터를 통해 출력된 가속도 센서 또는 기울기 센서에서 감지된 각도 값과, 피사체의 움직임에 대한 각도 산출의 결과 값을 1차적으로 합산한다.
그리고 연산수단(220)은 제1 합산수단(210)에서 합산된 출력 값에 필터계수를 곱하는 연산을 수행한다. 이때, 연산수단(220)은 n차 상보필터(200)에 해당하는 n개의 필터계수를 곱하는 연산을 수행한다.
연산수단(220)에서 연산이 종료되면, 제2 합산수단(230)은 자이로 센서에서 감지되어 저역통과필터를 통해 출력된 각속도 값과, 연산수단(220)에서 출력된 연산 값을 합산한다.
이후, 적분수단(240)은 최종적으로 합산된 값에 적분을 수행한다. 적분수단(240)에 의해 적분된 최종 값이 피사체의 움직임에 대한 각도 산출의 결과 값이 된다.
아울러, 산출수단은 하기의 수학식 3을 이용하여 수학식 2에 기재된 필터계수를 산출한다. 산출수단은 n개의 필터계수를 산출하는데, 수학식 3에 기재된 , , .., 은 필터계수를 의미하고, 수학식 1에 기재된 와 동일한 의미이다.
수학식 3에 기재된 A와 B는 각각 하기의 수학식 4와 수학식 5를 통해 도출된다.
이와 같이, 본 발명에서는 수학식 3 내지 5를 이용하여 각도 측정 시 사용된 센서에 대한 n차 상보필터(200)에 해당하는 n개의 필터계수를 간단하게 산출하고, 산출된 필터계수를 수학식 2에 대입함으로써, 피사체에서 발생한 움직임에 대한 각도를 정확히 산출할 수 있다.
도 3은 본 발명의 실시예에 따른 3차 상보필터의 실험결과를 나타내는 도면이다.
도 3을 참조하면, 도면부호 11은 엔코더를 이용하여 피사체의 움직임에 대한 각도를 측정한 실제 각도 값이고, 도면부호 12는 3차 상보필터를 이용하여 피사체의 움직임에 대한 각도를 산출한 각도 값이다. 도 3에서와 같이, 3차 상보필터를 이용하여 산출한 피사체의 움직임에 대한 각도와 엔코더를 이용하여 실제로 측정한 각도가 매우 유사함을 확인할 수 있다.
이와 같이, n차 상보필터(200)는 피사체의 움직임에 대한 정확한 각도측정을 수행할 수 있는 효과가 있다.
아울러, 저가의 MEMS 센서를 이용하여 피사체의 움직임에 대한 정확한 각도측정을 수행할 수 있으므로, 엔코더와 같은 센서를 사용할 수 없는 무인 비행체, 밸런싱 로봇 등과 같은 장비의 움직임에 대한 각도측정 장비 설계 시 비용을 절감할 수 있는 효과가 발생한다.
이상과 같이, 본 발명은 비록 한정된 실시예와 도면에 의해 설명되었으나, 본 발명은 이것에 의해 한정되지 않으며 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자에 의해 본 발명의 기술 사상과 하기에 기재될 청구범위의 균등 범위 내에서 다양한 수정 및 변형이 가능함은 물론이다.
200: n차 상보필터
210: 제1 합산수단 220: 연산수단
230: 제2 합산수단 240: 적분수단
210: 제1 합산수단 220: 연산수단
230: 제2 합산수단 240: 적분수단
Claims (5)
- 최소자승법을 적용하여 n(단, n>=1)차의 필터계수를 산출하는 산출수단;
제1 센서의 출력 값을 필터링 하기 위한 n차의 저역통과필터;
제2 센서의 출력 값을 필터링 하기 위한 n차의 고역통과필터;
상기 저역통과필터와 고역통과필터의 출력 값을 합산하는 합산수단;
상기 합산수단으로부터 출력된 합산결과에 적분을 수행하여 피사체의움직임에 대한 각도를 산출하는 적분수단; 및
을 포함하는 것을 특징으로 하는 각도측정을 위한 상보필터. - 제1항에 있어서,
상기 n차의 고역통과필터에서 필터링된 n차의 출력 값과 상기 산출수단에서 산출된 n차의 필터계수를 연산하는 연산수단;
을 포함하는 것을 특징으로 하는 각도측정을 위한 상보필터. - 제2항에 있어서,
상기 최소자승법은,
피사체에 발생한 움직임에 대한 각도의 실측정 값과 상기 제2 센서에 의한 측정 값에 대한 델타 값을 산출하고, 산출된 델타 값에 대한 n-1회 적분 값과, 상기 제1 센서에 의한 측정 값과 상기 실측정 값에 대한 크사이 값을 이용하여 도출되는 것을 특징으로 하는 각도측정을 위한 상보필터. - 제1항에 있어서,
상기 제1 센서는,
자이로 센서인 것을 특징으로 하는 각도측정을 위한 상보필터. - 제1항에 있어서,
상기 제2 센서는,
가속도 센서 또는 기울기 센서인 것을 특징으로 하는 각도측정을 위한 상보필터.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020110014091A KR101147133B1 (ko) | 2011-02-17 | 2011-02-17 | 각도측정을 위한 상보필터 및 그 방법 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020110014091A KR101147133B1 (ko) | 2011-02-17 | 2011-02-17 | 각도측정을 위한 상보필터 및 그 방법 |
Publications (1)
Publication Number | Publication Date |
---|---|
KR101147133B1 true KR101147133B1 (ko) | 2012-05-25 |
Family
ID=46272284
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020110014091A KR101147133B1 (ko) | 2011-02-17 | 2011-02-17 | 각도측정을 위한 상보필터 및 그 방법 |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR101147133B1 (ko) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109674480A (zh) * | 2019-02-02 | 2019-04-26 | 北京理工大学 | 一种基于改进互补滤波的人体运动姿态解算方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06161561A (ja) * | 1992-06-15 | 1994-06-07 | Honeywell Inc | 電気機械式アクチュエータを制御する方法及び装置 |
KR20030041132A (ko) * | 2000-07-28 | 2003-05-23 | 허니웰 인터내셔널 인코포레이티드 | 2차 상보형 위성항법시스템/관성항법시스템 블랜딩 필터 |
-
2011
- 2011-02-17 KR KR1020110014091A patent/KR101147133B1/ko active IP Right Grant
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06161561A (ja) * | 1992-06-15 | 1994-06-07 | Honeywell Inc | 電気機械式アクチュエータを制御する方法及び装置 |
KR20030041132A (ko) * | 2000-07-28 | 2003-05-23 | 허니웰 인터내셔널 인코포레이티드 | 2차 상보형 위성항법시스템/관성항법시스템 블랜딩 필터 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109674480A (zh) * | 2019-02-02 | 2019-04-26 | 北京理工大学 | 一种基于改进互补滤波的人体运动姿态解算方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10101174B2 (en) | Air data aided inertial measurement unit | |
JP4876204B2 (ja) | 小型姿勢センサ | |
CN107543546B (zh) | 一种六轴运动传感器的姿态解算方法及装置 | |
CN109983345B (zh) | 信号处理设备、惯性传感器、加速度测量方法、电子设备和程序 | |
KR100898169B1 (ko) | 관성항법시스템의 초기정렬 방법 | |
CN103913171A (zh) | 基于加速度计和陀螺仪的载体转速与转角补偿测量方法 | |
US11125560B2 (en) | Robust method for tuning of gyroscope demodulation phase | |
Ariffin et al. | Low cost MEMS gyroscope and accelerometer implementation without Kalman Filter for angle estimation | |
WO2014155559A1 (ja) | ノッチフィルタ、外力推定器、モータ制御装置およびロボットシステム | |
CN106767798B (zh) | 一种无人机导航用的位置及速度的实时估计方法及*** | |
JP6383907B2 (ja) | 車輌位置計測装置及び方法 | |
CN107576977B (zh) | 基于多源信息自适应融合的无人机导航***及方法 | |
EP3527948A1 (en) | Air data aided inertial measurement unit | |
Narasimhappa et al. | An innovation based random weighting estimation mechanism for denoising fiber optic gyro drift signal | |
Kowalczuk et al. | Evaluation of position estimation based on accelerometer data | |
KR101584080B1 (ko) | 3차원 회전 모션센서의 가속도 신호처리 방법 | |
US11619492B2 (en) | Sensor linearization based upon correction of static and frequency-dependent non-linearities | |
KR101147133B1 (ko) | 각도측정을 위한 상보필터 및 그 방법 | |
Shen et al. | A new calibration method for low cost MEMS inertial sensor module | |
RU129625U1 (ru) | Инерциальный измерительный модуль | |
US10345329B2 (en) | Inertial force sensor | |
CN106092141B (zh) | 一种改善相对位置传感器性能的方法及装置 | |
KR101160206B1 (ko) | 상보필터를 이용한 각도측정 장치 및 방법 | |
KR20130082327A (ko) | 가속도 센서가 구비된 오브젝트의 진동 제어 방법 및 장치 | |
Lim et al. | A MEMS based, low cost GPS-aided INS for UAV motion sensing |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
A302 | Request for accelerated 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: 20150508 Year of fee payment: 4 |
|
FPAY | Annual fee payment |
Payment date: 20160510 Year of fee payment: 5 |
|
FPAY | Annual fee payment |
Payment date: 20170510 Year of fee payment: 6 |
|
FPAY | Annual fee payment |
Payment date: 20180510 Year of fee payment: 7 |