KR100867375B1 - ３개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보측정 장치 및 방법 - Google Patents

Abstract

본 발명의 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법은 x, y축으로 이루어진 면에 각각 대응하는 2개의 자기장 센서를 상기 이동체에 설치하고, z축에 대응하여 자기장 센서를 상기 이동체에 설치하는 설치단계와, 이동체는 상기 각각의 x, y, z축에 해당하는 지구자기장을 측정하여 기준 자기장의 정보값을 내부의 메모리에 저장하는 저장단계와, 이동체가 이동하면서 x, y, z축에 자기장의 크기를 측정한 후에 측정된 z축 자기장 값과 z축 기준 자기장값 차의 절대값이 자기장 센서가 가지는 오차범위보다 작은지의 여부를 판단하는 판단단계와, 판단단계에서 판단하여 z축의 측정값과 기준값의 차이의 절대값이 센서의 오차범위보다 작다면, x, y축 자기장 측정값을 활용하여 이동체의 방향 정보값을 갱신시키는 갱신단계로 이루어지는 것을 특징으로 하므로, 오차가 누적되지 않아 정확한 위치 및 방향을 획득할 수 있는 효과가 있다.

이동체, 나침반, 자기장 간섭 차폐, 방향 정보

Description

３개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 장치 및 방법 {Apparatus and Method for Measuring the Information of Location and Direction Using Three Magnetism Sensor}

도 1은 본 발명의 실시예에 따른 자기장 센서의 기본 작동 개념을 나타낸 개념도.

도 2는 본 발명의 실시예에 따른 3개의 자기장 센서를 이용한 외부 자기장으로부터의 외란을 방지하기 위한 나침반 구성을 좌표상에 나타낸 블록 구성도.

도 3은 본 발명의 실시예에 따른 외부 자기장 외란 발생 유무를 판별하기 위한 기준을 나타낸 그래프.

도 4는 본 발명의 실시예에 따른 3개의 자기장 센서를 활용한 이동체의 위치방향 정보를 갱신하는 단계를 나타낸 순서도.

<도면의 주요부분에 대한 부호의 간단한 설명>

10 : 제1 자기장 센서 20 : 제2 자기장 센서

30 : 제3 자기장 센서

본 발명은 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법에 관한 것으로써, 더욱 상세하게는 일반적인 자기장 센서에 방향을 감지하는 2개의 센서와 오류, 즉, 외란을 감지하는 하나의 센서가 상호 직교하도록 하여 외란을 감지하는 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법에 관한 것이다.

이동로봇과 같은 이동체가 미지의 환경에서 사전지식 없이 스스로 그 환경에 대처할 수 있는 능력을 가졌다면, 여러 분야에 걸쳐 두루 사용될 수 있을 것이다. 예를 들어, 장애인을 도와주는 일, 공장에서 물류를 이송하는 작업, 우주탐사, 핵폐기물 처리장 또는 심해탐사와 같은 위험한 환경에서의 작업 등을 인간을 대신해서 수행할 수 있을 것이다. 뿐만 아니라 무인 청소기, 무인 잔디 깎기 등과 같이 인간의 일상생활에서도 사용이 가능하다. 이런 역할을 이동체가 수행할 수 있을 경우 인간 개인들에게는 생활의 윤택함을 제공해 줄 것이며, 기업들에게는 이동체 제조의 산업화로 경제적인 고부가가치 시장을 창출할 수 있을 것이다.

하지만, 현재까지 이동로봇과 같은 이동체의 인지능력과 추론능력이 인간과 비교하여 현저히 열등하기 때문에, 앞서 이야기한 기능들을 수행하는데 매우 제한적이다. 따라서 많은 분야에서 이동체의 지능을 높이기 위한 연구가 이루어지고 있다.

이 중에 가장 기본적으로 이동체가 가져야 할 기능은 원하는 목표지점까지 충돌없이 이동하는 것이다. 이동체가 복잡한 생활공간 속에서 자유롭게 이동하기 위해서는 스스로 어디에 있는지를 판단할 수 있는 능력이 필요하다. 이러한 기능을 위치측정(localization)기술이라고 일컫는다.

이동체의 위치추정기술은 그 필요성만큼이나 다양한 분야의 연구자 및 개발자들이 그 성능을 향상시켜 왔다.

특히 학계에서는 미국의 엠아이티, 스탠포드, 카네기 멜론 대학등에서 그 연구에 선두주자로 있다. 이들은 주로 이동체에 장착된 외부 측정 센서들을 이용하여 이동체의 위치를 추정하는데, 그 연구의 초점이 이루어져 있다. 이런 방법은 외부환경에서 특정 사물 및 공간특성을 자연표식물로 추출하고 참조하여 이동체의 위치를 보정하는데, 이때 주로 사용되고 연구되어지는 토픽은 참조할 만한 사물 및 공간특성에 해당하는 자연표식물을 보다 정확하게 추출해 내는 것이다. 하지만, 이 방법은 잘못된 사물의 위치 및 공간특성 파악으로 인해 이동체의 위치 추정 오차가 발생할 경우에는 오차가 누적되어 복구되기 힘들다는 단점을 가지고 있으며, 이런 이유로 현재 많은 수요에도 불구하고 산업계에서는 이동체의 위치추적 기술을 제품화하지 못하고 있다.

위에 제시한 학계에서 연구하는 문제점을 보다 단순화하고, 그 복잡성을 줄이기 위해 세계 유수의 산업계에 포함된 연구소에서는 인공표식물을 사용하는 방법을 제시하고 있다. 그 중 가장 대표적으로서 미국 이알로보트사의 노스-스타, 국내의 한국전자통신연구원의 스타라이트, 포항산업과학연구원의 스타게이져가 있다. 이들은 산업계에 실제 제품화가 되어 있을 정도로 그 안정성이 검증되었다. 하지만, 전술한 로봇들은 바닥 및 천장에 외부 인공표식물을 설치를 하여야 하는 데에 그 어려움이 있으며, 사용자에게 편리성이 적어 그 활용도는 극히 적은 것이 현재 추세이다.

이와 같이 자연표식물 및 인공표식물을 사용하는 방법들이 가지는 단점을 획기적으로 줄이고, 그것들의 장점을 잘 활용할 수 있는 방법을 본 발명에서는 중점적으로 개발하였다. 이를 위해 자연표식물로서 발생한 오차에도 불구하고 오차값을 지속적으로 줄여나갈 수 있는 표식물의 특성을 지니며, 인공표식물처럼 설치의 번거로움 없이 어느 곳에서든지 이용할 수 있는 표식물로서 가장 좋은 것이 지구 자기장이라는 결론을 내렸다.

이동체가 기본적으로 주행하기 위해서는 자신의 위치 정보가 필요하다. 이때 이동체에 기본적으로 장착되어 있는 엔코더를 이용한 주행거리계 정보는 이동한 거리값에 있어서는 정확하지만, 회전한 각도에 있어서는 그 값의 오차가 큰 것이 보통이다. 따라서 이동체의 엔코더를 이용한 주행거리계 정보만을 가지고 이동체 위치추정을 할 경우, 회전 각도의 오차가 누적되어 그 값의 신뢰성이 매우 떨어지는 문제가 발생하게 된다.

이를 보완하기 위하여 서로 다른 방향들에서의 자장들의 크기들을 각각 나타내는 자장 데이터들을 공간상의 다른 방향들로 센서를 회전하면서 시간대별로 측정하여 저장하여, 저장 데이터들에 의해 형성되는 자장 궤적들 중 적어도 하나의 진폭 및 옵셋을 이용하여 자장의 외란(Disturbance)이 발생하였는지를 검사하는 방법 및 장치에 대하는 방법이 대한민국등록특허 제612836호에 개시되어 있다. 개시된 종래의 방법은 외란이 발생하는 실내 또는 자성체가 있는 실외에서도 이동체의 방향 정보 측정에 사용할 수 있는 효과를 지닌 발명이다. 그러나, 개시된 종래의 방법은 그 절차 및 구성이 복잡하다. 또한, 이동하면서 저장되어 있는 자장데이터와 측정데이터의 오차가 클 경우에 오차가 발생함을 인지하는 것으로 이전 데이터를 저장해야 하며, 또한, 이를 비교하기 위해서는 복잡한 알고리즘을 사용해야 하는 등의 문제점이 있다. 따라서, 그 장치의 복잡성이 증가하며, 오차가 발생할 가능성이 높으며, 펌웨어 또는 하드웨어 등의 고장이 발생할 우려가 높다. 한편, 개시된 종래의 방법은 이동체의 특성에 따라 같은 장소에서만 움직일 수 없는 것이므로 미지의 환경, 즉 다른 장소에 가져다 놓으면 이를 감지할 수 없어 새로운 장소에서는 자장 데이터를 이용하여 캘리블레이션할 수 없는 문제점 등이 있다.

본 발명은 전술한 문제점을 해결하기 위하여 제안된 것으로서, 그 목적은 이동체의 주행거리계 정보에서 방향 정보로 활용하기 위하여 지구자기장을 측정하여 절대 방향을 측정할 수 있는 나침반의 방향 정보로 대체하여 사용하고, 이때, 나침반은 지구 자기장처럼 매우 약한 자기장을 측정하는 센서이므로, 외부의 약한 자기장에도 그 값의 오차를 보정할 수 있도록 구성한 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법을 제공하는 데에 있는 것이다.

또한, 본 발명은 이동체가 주변 환경을 이동할 때 필요한 이동체 위치정보 중에 방향 정보를 정확하게 측정하기 위하여 지구자기장을 이용하여 외란의 영향을 받지 않는 절대 방향위치를 측정 가능한 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법을 제공하는 데에 있는 것이다.

본 발명의 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법은 x, y축으로 이루어진 면에 각각 대응하는 2개의 자기장 센서를 상기 이동체에 설치하고, z축에 대응하여 자기장 센서를 상기 이동체에 설치하는 설치단계와, 이동체는 상기 각각의 x, y, z축에 해당하는 지구자기장을 측정하여 기준 자기장의 정보값을 내부의 메모리에 저장하는 저장단계와, 이동체가 이동하면서 x, y, z축에 자기장의 크기를 측정한 후에 측정된 z축 자기장 값과 z축 기준 자기장값 차의 절대값이 자기장 센서가 가지는 오차범위보다 작은지의 여부를 판단하는 판단단계와, 판단단계에서 판단하여 z축의 측정값과 기준값의 차이의 절대값이 센서의 오차범위보다 작다면, x, y축 자기장 측정값을 활용하여 이동체의 방향 정보값을 갱신시키는 갱신단계로 이루어지는 것을 특징으로 한다.

본 발명의 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 장치는 미리 3개의 축의 방향에 대한 각각 지구 자기장 정보를 각각의 3개의 자기장 센서에 저장해 놓고, 방위각을 산출하는 2개의 자기장 센서와, 외란을 감지하도록 구성한 것을 특징으로 하는 한 개의 자기장 센서로 구성되는 것을 특징으로 한다.

이하, 첨부된 도면을 참조하여 본 발명의 구성에 대하여 보다 상세하게 설명 하기로 한다.

도 1은 본 발명의 실시예에 따른 자기장 센서의 기본 작동 개념을 나타낸 개념도이다. 도 2는 본 발명의 실시예에 따른 3개의 자기장 센서를 이용한 외부 자기장으로부터의 외란을 방지하기 위한 나침반 구성을 좌표상에 나타낸 블록 구성도이다.

도 1 및 도 2를 참조하여 보면, 본 발명에서는 자기장 센서를 이용한 전자 나침반을 사용하였다. 자기장 센서는 도 1과 같이 지시된 한방향의 자기장 크기를 측정하는 자기장 센서가 전자 나침반에 응용될 수 있다(이후 자기장 센서로 통일하여 기재함). 이때 자기장 센서(10, 20, 30)에서는 도시된 화살표 방향의 자기장의 크기가 변화함에 따라 출력 전압값이 변화한다. 이를 이용하여 도시된 방향의 자기장의 크기를 측정할 수 있다.

본 발명은 지구자기장을 표식물로서 사용하는 나침반을 이용하여 이동체의 방향위치를 추정할 수 있는 방법을 제시하고자 한다. 이때, 이동체의 2차원 위치를 추정할 때, 이동체의 이동한 거리는 정확하다고 전제하며, 실제로도 방향정보를 제외한 이동한 거리는 이동체에 탑재된 모터 엔코더만으로도 정확하게 추출할 수 있다.

이를 응용하여, 도 2와 같이 임의의 직교 좌표계를 갖는 3개의 축에 대하여 상호 직교하는 자기장 센서(10, 20, 30)를 3개 장착한다면 3개의 축의 자기장 변화를 측정할 수 있다.

이를 전자 나침반에 응용하여, 미리 3개의 축의 방향에 대한 각각 지구 자기 장 정보를 각각의 3개의 전자 나침반, 즉 3개의 자기장 센서(10, 20, 30)에 저장해 놓는다. 보통의 자기장 센서는 2개의 축에 대한 지구 자기장의 정보를 저장해 놓음으로써, 서로 직교되는 x축 및 y축 성분을 검출하여 방위각을 산출한다. 그러나, 본 발명에서는 외부 자기장 간섭을 측정하기 위하여 2개의 직교하는 축을 담당하는 자기장 센서(10, 20)는 방위각을 산출하는 정보로 활용되고, 2개의 축과 직교하는 1개의 축을 담당하는 자기장 센서(30)는 오류를 감지하는 정보로 활용된다. 예를 들어, 도 2에서 x축의 자기장의 세기를 감지하는 제1 자기장 센서(10)와 y축의 자기장의 세기를 감지하는 제2 자기장 센서(20)로 구성되어 각각 x축과 y축으로 이루어진 평평한 장소에 설치하였을 때, 제1 자기장 센서(10)와 제2 자기장 센서(20)는 지구자기장의 동서남북 방향에 대한 지자기 정보를 측정하여 위치한 방향을 측정할 수 있게 된다.

이와 같이 제1 자기장 센서(10)와 제2 자기장 센서(20)의 2개의 자기장 센서(10, 20)를 설치하였을 경우 지구 자기장을 제외한 외부 자기장의 외란이 발생할 경우 갑자기 자기장의 세기에 변화가 생김에 따라 지구 자기장을 측정하는 제1 자기장 센서(10)와 제2 자기장 센서(20)를 통해 얻은 위치 방향 정보값은 큰 오차를 가지게 되며, 오차가 발생한 방향 정보를 이동체의 방향정보에 사용할 경우 이동체의 방향 오차는 커지게 될 것이다. 이 문제를 해결하기 위하여 자기장 센서의 외란이 발생하였는지를 판별하기 위한 수단이 필요하다. 이를 위해 외부 자기장에 의해 외란이 발생하였는지를 알기위한 제3 자기장 센서(30)의 설치방법을 후술하는 도 2에 도시하였다.

제3 자기장 센서(30)를 이용함으로써 외부 자기장이 제1 자기장 센서(10)와 제2 자기장 센서(20)에 의해 측정된 위치 방향 정보값에 영향을 미치고 있음을 알 수 있을 것이다.

한편, 도 2에는 각 자기장 센서(10, 20, 30)에서 취합된 내용을 연산하는 연산장치 또는 제어부가 도시되어 있지 않지만, 당업자라면, 각각의 자기장 센서(10, 20, 30)를 취합하여 연산하는 연산장치 또는 제어부를 본 발명의 설명에 따라 쉽게 대응하여 설치하고 제어할 수 있음을 알 수 있을 것이다.

전술한 이동체의 위치 방향 정보를 갱신하기 위하여 설계된 3축의 자기장 센서(10, 20, 30)의 정보는 방위 정보에 사용되므로 이동체의 위치를 파악하기 위해서 이동한 거리를 측정하기 위하여 엔코더 정보인 오드메트리를 활용하여 측정할 수 있다. 또는 이동체의 위치를 파악할 수 있는 자이로스코프를 활용하여 이동체에 대한 위치 정보를 획득하여 그 이동거리 및 위치를 파악할 수도 있다. 또는 이동체의 위치를 파악하기 위하여 사용되는 인공표식물 센서와 함께 사용하여 이동체에 대한 위치 정보를 획득하여 이동체의 이동거리 및 위치를 파악할 수도 있다.

도 3은 본 발명의 실시예에 따른 외부 자기장 외란 발생 유무를 판별하기 위한 기준을 나타낸 그래프이다.

도 3을 참조하여 보면, 앞서 기술한 바와 같이 보통 2차원의 방향값을 알기 위해 평평한 장소에 설치된 이동체는 x와 y축 만으로 형성된 평면상을 이동하므로, z축 자기장 측정에 해당하는 제3 자기장 센서(30)의 출력 전압값은 그 값이 변화하지 않을 것이다. 만약에 움직인다고 하여도 z축의 자기값은 거의 변화가 없어야 정 상이다. 하지만, 외부 자기장의 외란이 영향을 미친다면 제1, 제2 및 제3 자기장 센서(10, 20, 30)에서 측정된 자기장의 크기가 변화할 것이다.

각각 x축 및 y축의 자기장을 감지하는 제1 및 제2 자기장 센서(10, 20)는 이동체의 이동에 따라 변화되는 값이므로 외란을 감지해 내는 것은 매우 복잡한 알고리즘을 필요로 한다. 그러나, 제3 자기장 센서(30)에 외란이 발생하면 자기장값의 변화가 없다가 갑자기 자기장값이 변하는 것이므로, 도 3에서와 같이 출력 자기장의 크기값(Vzo)이 기준 자기장의 크기값(Vzb)보다 일정값 이상 크거나, 작아지면 외란의 영향을 받았음을 쉽게 알 수 있다. 여기서 기준 자기장의 크기값(Vzb)은 외란이 발생하지 않은 상태의 자기장의 크기값을 나타낸다.

도 3을 참조하여 보다 상세하게 설명하면, x축은 시간(t)을 나타내며, y축은 z축에 발생한 자기장의 크기값을 나타낸다. z축에 해당하는 자기장을 측정하는 제3 자기장 센서(30)의 출력 자기장의 크기값(Vzo)이 외부 자기장에 의해 외란이 발생하였을 경우, 초기에 저장해 놓은 기준 자기장 값과 비교하여 그 값이 변화할 것이다. 이와 같이 z축의 기준 자기장의 값과 비교하여 출력 자기장의 값이 차이가 발생한다면, 지구 자기장을 제외한 외부 자기장이 각각의 제1, 제2 및 제3 자기장 센서(10, 20, 30)에 영향을 미치고 있음을 알 수 있다.

| Vzo - Vzb | < Vth

수학식 1에서 Vzo는 z축의 자기장을 측정하는 자기장 센서의 출력 자기장의 크기값을 나타내며, Vzb는 z축의 자기장을 측정하는 자기장 센서의 기준 자기장의 크기값을 나타내고, Vth는 임계치의 자기장값을 의미한다.

따라서, 수학식 1을 풀이하여 보면, 출력 자기장의 크기값(Vzo)과 기준 자기장의 크기값(Vzb)과의 차이의 절대치값이 기설정한 임계치의 자기장값(Vth)보다 작은 경우에는 즉, 수학식 1을 만족시키는 경우에는 외란이 발생하지 않은 것으로 간주하여 각각 x축 및 y축 자기장 센서인 제1 및 제2 자기장 센서(10, 20)를 이용하여 이동체의 위치 방향 정보를 갱신한다.

반대로, 자기장의 크기값(Vzo)과 기준 자기장의 크기값(Vzb)과의 차이의 절대치값이 임계치의 자기장값(Vth)보다 크거나 같은 경우에는 즉, 수학식 1을 만족시키지 못하는 경우에는 외란이 발생한 것으로 간주하여 이를 방위값 계산에 반영하지 않도록 한다.

즉, 수학식 1은 제3 자기장 센서(30)가 가지는 외란에 의해 발생하는 오차가 발생하며, 그 오차로 간주되는 임계치의 자기장값(Vth)보다 작다면 지구 자기장을 제외한 외부 자기장의 외란이 발생하지 않았음을 판별할 수 있음을 의미한다.

도 4는 본 발명의 실시예에 따른 3개의 자기장 센서를 활용한 이동체의 위치방향 정보를 갱신하는 단계를 나타낸 순서도이다.

도 4를 참조하여 보면, 제2 및 제3 자기장 센서(20, 30)을 우선 x, y축으로 이루어진 면을 이동체의 평평한 면에 설치하고, 수직한 면에 제1 자기장 센서를 z축에 대응하여 설치한다(S102). 그 후에 x, y, z축에 해당하는 지구자기장을 측정하여 기준 자기장의 정보값을 이동체 내의 메모리에 저장한다(S104).

이동체가 이동하면서 x, y, z축에 자기장의 크기를 측정한 후에(S106), 측정 된 z축 자기장 값과 z축 기준 자기장 값의 차의 절대값이 자기장 센서가 가지는 오차범위보다 작은지를 판단한다(S108).

S108에서 판단하여 z축의 측정값과 기준값의 차이의 절대값이 센서의 오차범위보다 작다면, 지구 자기장을 제외한 외부자기장이 없음을 의미하므로 x, y축 자기장 측정값을 활용하여 이동체의 방향 정보값을 갱신시켜 준다(S110). 반대로 S108에서 판단하여 z축의 측정값과 기준값의 차이의 절대값이 센서의 오차범위보다 크다면, S106으로 리턴한다. 즉, 지구 자기장 이외의 외부 자기장이 발생하였음을 의미하므로 x, y축 자기장 측정값을 사용할 수 없으므로 나침반의 방향정보를 이동체의 위치 방향정보 갱신에 사용하지 않는다.

본 발명은 이동체의 주행거리계 정보에서 방향 정보로 활용하기 위하여 지구자기장을 측정하여 절대 방향을 측정할 수 있는 2개의 자기장 센서를 구성하여 나침반의 방향 정보로 대체하여 사용하고, 이때, 외부의 약한 자기장에도 그 값의 오차를 보정할 수 있도록 1개의 자기장 센서를 구성함으로써 오차가 누적되지 않아 정확한 위치 및 방향을 획득할 수 있는 효과가 있다.

또한, 본 발명은 간략하고 간단한 구성으로 이루어지므로 오류가 거의 발생하지 않으며, 또한, 오류가 발생한다고 하여도 알고리즘이 간단하여 유지 보수가 편리한 장치를 이용하여 정확한 이동체의 위치 및 방향 정보를 획득할 수 있는 효과가 있다.

또한, 본 발명은 이동체가 주변 환경을 이동할 때 필요한 이동체 위치정보 중에 방향 정보를 정확하게 측정하기 위하여, 절대값인 지구자기장을 이용하며 또한, 비교 대상이 절대적인 값이므로 자장데이터를 저장할 필요 없이 장소의 구애를 받지 않고 정확한 이동체의 위치 및 방향 정보를 획득할 수 있는 효과가 있다.

Claims (9)

1. 이동체의 위치 및 방향 정보 측정 방법으로서,

   x, y축으로 이루어진 면에 각각 대응하는 2개의 자기장 센서를 상기 이동체에 설치하고, z축에 대응하여 자기장 센서를 상기 이동체에 설치하는 설치단계와;

   상기 이동체는 상기 각각의 x, y, z축에 해당하는 지구자기장을 외란이 발생하지 않은 상태에서 측정한 기준 자기장의 정보값을 내부의 메모리에 저장하는 저장단계와;

   상기 이동체가 이동하면서 x, y, z축에 자기장의 크기를 측정한 후에, 측정된 z축 자기장 값과 상기 저장단계의 z축 기준 자기장값 차의 절대값이 자기장 센서가 가지는 오차범위보다 작은지의 여부를 판단하는 판단단계와;

   상기 판단단계에서 판단하여 상기 측정된 z축 자기장 값과 상기 저장단계의 z축 기준 자기장값 차의 절대값이 센서의 오차범위보다 작다면, x, y축 자기장 측정값을 활용하여 이동체의 방향 정보값을 갱신시키는 갱신단계로 이루어지는 것을 특징으로 하는 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법.
2. 제1항에 있어서,

   상기 판단단계에서 판단하여 z축의 측정값과 기준값의 차이의 절대값이 센서의 오차범위보다 작다면, 외란이 발생하지 않은 것으로 판단하고, x축 및 y축 자기장 센서를 이용하여 이동체의 위치 방향 정보를 갱신하는 것을 특징으로 하는 3개 의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법.
3. 제1항 또는 제2항에 있어서,

   상기 판단단계에서 판단하여 z축의 측정값과 기준값의 차이의 절대값이 상기 자기장 센서의 오차범위보다 크다면, 외란이 발생한 것으로 판단하여 이동체의 위치 방향 정보를 갱신하지 않는 것을 특징으로 하는 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법.
4. 제2항에 있어서,

   x, y, z축에 해당하는 지구자기장 정보와 함께 모터의 엔코더를 이용하여 위치 정보를 생성하고 상기 위치 정보를 이용하여 이동체의 위치 방향 정보를 갱신하는 것을 특징으로 하는 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법.
5. 제2항에 있어서,

   x, y, z축에 해당하는 지구자기장 정보와 함께 자이로스코프를 이용하여 위 치 정보를 생성하고 상기 위치 정보를 이용하여 이동체의 위치 방향 정보를 갱신하는 것을 특징으로 하는 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법.
6. 제2항에 있어서,

   x, y, z축에 해당하는 지구자기장 정보와 함께 인공표식물 센서를 이용하여 위치 정보를 생성하고 상기 위치 정보를 이용하여 이동체의 위치 방향 정보를 갱신하는 것을 특징으로 하는 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 방법.
7. 이동체의 위치 및 방향 정보 측정 장치로서,

   미리 3개의 축 방향에 대한 각각 지구 자기장 정보를 각각의 3개의 자기장 센서에 저장해 놓고, 방위각을 산출하는 2개의 자기장 센서와,

   상기 외란을 감지하는 한 개의 자기장 센서를 포함하며;

   상기 방위각을 산출하는 2개의 자기장 센서는 각각 x축 및 y축 성분의 지구 자기장 정보를 저장하고 있으며, 각각 x축 및 y축 성분의 자기장 정보를 검출하여 방위각을 산출하고, 상기 외란을 감지하는 한 개의 자기장 센서는 z축 성분의 지구 자기장 정보를 저장하고 있는 자기장 센서인 것을 특징으로 하는 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 장치.
8. 삭제
9. 제7항에 있어서,

   상기 외란은 다음의 수학식을 만족시키는 경우에는 외란이 발생하지 않은 것으로 간주하며, 다음의 수학식을 만족시키지 못하는 경우에는 외란이 발생한 것으로 판단하고, 다음의 수학식은 다음과 같이 표기하며,

   | Vzo - Vzb | < Vth

   상기 수학식에서 Vzo는 z축의 자기장을 측정하는 자기장 센서의 출력 자기장의 크기값을 나타내며, Vzb는 z축의 자기장을 측정하는 자기장 센서의 기준 자기장의 크기값을 나타내고, Vth는 임계치의 자기장값을 의미하는 것을 특징으로 하는 3개의 자기장 센서를 이용한 이동체의 위치 및 방향 정보 측정 장치.

Images