KR20200038271A - 자기 센서에 의해 측정된 자기장으로부터 진행 방향의 결정 - Google Patents
자기 센서에 의해 측정된 자기장으로부터 진행 방향의 결정 Download PDFInfo
- Publication number
- KR20200038271A KR20200038271A KR1020207006057A KR20207006057A KR20200038271A KR 20200038271 A KR20200038271 A KR 20200038271A KR 1020207006057 A KR1020207006057 A KR 1020207006057A KR 20207006057 A KR20207006057 A KR 20207006057A KR 20200038271 A KR20200038271 A KR 20200038271A
- Authority
- KR
- South Korea
- Prior art keywords
- travel
- magnetic
- magnetic field
- determining
- function
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/165—Navigation; 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 combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/02—Magnetic compasses
- G01C17/28—Electromagnetic compasses
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/38—Testing, calibrating, or compensating of compasses
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/165—Navigation; 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 combined with non-inertial navigation instruments
- G01C21/1654—Navigation; 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 combined with non-inertial navigation instruments with electromagnetic compass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Measuring Magnetic Variables (AREA)
- Navigation (AREA)
- Geophysics And Detection Of Objects (AREA)
Abstract
본 발명은 자기 센서들에 의해 진행 방향을 결정하는 방법에 관한 것으로, 자기장은 자력계에 의해 측정되고, 계산 수단은 주어진 샘플링 시간에 대하여:
- 이전 샘플링 시간에 결정된 진행 방향의 함수인 진행 방향 예측의 추정,
- 자력계 측정치로부터 결정된 자기 진행 방향(magnetic heading)의 함수로서 추정된 예측 진행 방향의 재설정
을 계산하는 재귀 처리(recursive processing)를 구현한다.
상기 재설정 동안, 계산 수단은
- 2개의 샘플링 시간들 사이의 자기 교란의 변화의 모델, 및
- 교란 강도의 선행 추정(a priori estimation)
의 함수로서 재설정의 강도를 추정한다.
- 이전 샘플링 시간에 결정된 진행 방향의 함수인 진행 방향 예측의 추정,
- 자력계 측정치로부터 결정된 자기 진행 방향(magnetic heading)의 함수로서 추정된 예측 진행 방향의 재설정
을 계산하는 재귀 처리(recursive processing)를 구현한다.
상기 재설정 동안, 계산 수단은
- 2개의 샘플링 시간들 사이의 자기 교란의 변화의 모델, 및
- 교란 강도의 선행 추정(a priori estimation)
의 함수로서 재설정의 강도를 추정한다.
Description
본 발명은, 일반적으로, 자력-관성 기술에 관한 것이다.
더 자세하게는, 자력계에 의한 진행 방향(heading)의 결정에 관한 것이다.
특히, 도시 영역이나 "실내" 즉 건물 내부에서 측정하는 경우에 유리한 응용이다.
전통적으로, 자력계는 내장 시스템의 진행 방향을 계산하는데 사용된다.
이 경우에, 센서에 의해 측정되는 자기장이 그 수평 성분이 자북(magnetic north)을 향하는 지구 자기장이라는 전제가 있다. 자북과 진북(geographic north) 사이의 차이는('자기 편각(magnetic declination)'이라 불림) 알려져 있고 표로 만들어져 있다. 일반성을 잃지 않고, 이하에서는 자북과 진북이 합쳐진 것으로 고려될 것이며, 따라서 자력계가 북쪽(north)으로 불리는 곳을 가리킨다고 간주한다.
전형적으로, 자력계 측정으로부터 진행 방향을 계산하는데 쓰이는 결정 방법은 다음에 기초한다:
- 자력계에 의해 공급되는 측정치와 시스템의 진행 방향에 관한 정보를 연결하는 모델링,
- 수행되는 측정에 대한 이 관계의 관련성의 특정화.
종래의 접근법에서는, 구현되는 계산은 측정치로서 자기장과 함께 Kalman 유형의 필터링일 수 있으며, 관련성(relevance)의 특성화의 함수인 측정 노이즈와 함께 상태에 포함된 진행 방향을 재설정할 수 있게 하였다.
모델링은 측정된 자기장 M이 진행 방향 정보를 포함하는 것을 기술하는 것을 포함하는데, 예컨대 다음 공식에 의해서이다:
이 공식의 관련성은 측정 분산(measurement variance)에 의해 특성화되는데, 즉 이 등식에서의 오차는 0의 기대값을 갖는 Gaussian 무작위 분산임을 전제한다는 것이다.
이 분산은 Kalman 이득(gain)을 자동으로 계산하는데 쓰이는데, 다른 노이즈를 고려하기 위하여 재설정에 가중치를 부여한다(외부 환경과 연결되는 동적 노이즈와 자력계의 측정 노이즈).
또다른 접근법에서는, 동일한 유형의 모델링과 특성화를 사용하는 선형 필터링에 의한 계산이 구현된다.
이 접근법에서는, 그 관련성을 특성화하는 것은 공식의 이득의 세기의 상대적인 조절이다. 일반적으로, 이 이득은 손으로 조절된다. 그러면 당업자는 그것을 모델링의 관련성의 함수로서 어떻게 가중치를 부여하는지를 알게 될 것이다.
그러므로, 이 2가지 접근법에서, 모델의 관련성을 특성화하는 파라미터들(Kalman 필터의 경우에 Gaussian 노이즈의 분산, 선형 피팅의 경우의 이득)은 일반적으로 상수 파라미터들이며, 측정된 자기장에 독립적이다.
측정된 자기장을 고려한 모델링의 관련성의 특성화가 최근에 제안되었는데, 예컨대 다음 문헌들이다:
-
W. T. Faulkner, R. Alwood, W. T. David, and J. Bohlin, "Gps-denied pedestrian tracking in indoor environments using an imu and magnetic compass," in Proceedings of the 2010 International Technical Meeting of The Institute of Navigation, (San Diego, CA), pp. 198 - 204, January 2010.
-
M. H. Afzal, V. Renaudin, and G. Lachapelle, "Magnetic field based heading estimation for pedestrian navigation environments," in 2011 International Conference on Indoor Positioning and Indoor Navigation, (Guimaraes, Portugal), Sep 2011.
그러나 수행된 특성화는 완전한 만족을 주지 않는데, 우선 그들이 적어도 그들이 원하는 정밀도로 정확한 모델을 가질 것을 요구하는 자기장의 선행 모델(a priori model)에 기초하기 때문이고 다음으로는 그들이 모든 교란을 제거하는 것이 가능하지 않기 때문이다.
"Unscented Filtering for Spacecraft Attitude Estimation" (J.L. Crassidis and F. Landis Markley) 문서는 우주선의 방향을 추정하는 모델을 기술한다. 이 모델은 Kalman 필터의 응용에 기초하며 아무런 상관관계를 고려하지 않는다. 그러나 이 모델도 그 부분에 대하여 바이어스를 가지며 크게 신뢰할 수 없게 만든다.
또한 EP 2264485로부터 단순화된 모델이 제안되었는데, 여기서 추정된 자기장은 측정된 자기장의 값을 합산한 것에, 자기 교란을 더하고, 측정 노이즈를 더한 것과 같다. 그러나, 이 모델의 교란의 변화는 교란의 시간적 관계만을 고려하며, 크게 신뢰할 수 없다.
W. T. Faulkner, R. Alwood, W. T. David, and J. Bohlin, "Gps-denied pedestrian tracking in indoor environments using an imu and magnetic compass," in Proceedings of the 2010 International Technical Meeting of The Institute of Navigation, (San Diego, CA), pp. 198 - 204, January 2010.
M. H. Afzal, V. Renaudin, and G. Lachapelle, "Magnetic field based heading estimation for pedestrian navigation environments," in 2011 International Conference on Indoor Positioning and Indoor Navigation, (Guimaraes, Portugal), Sep 2011.
"Unscented Filtering for Spacecraft Attitude Estimation" (J.L. Crassidis and F. Landis Markley)
"Assessment of Indoor Magnetic Field Anomalies using Multiple Magnetometers Assessment of Indoor" - M.H. Afzal, V. Renaudin, G. Lachapelle - Proceedings of the 23rd International Technical Meeting of The Satellite Division of the Institute of Navigation (ION GNSS 2010) September 21 - 24, 2010.
본 발명의 일반적인 목적은, 특히 심하게 교란된 환경에서, 사용되는 모델링의 관련성을 더 잘 특성화 할 수 있는 솔류션을 제공하는 것이다.
특히, 본 발명은 자기 센서들에 의해 진행 방향을 결정하는 방법에 관한 것으로, 자기장은 자력계에 의해 측정되고, 계산 수단은 주어진 샘플링 시간에 대하여:
- 이전 샘플링 시간에 결정된 진행 방향의 함수인 진행 방향 예측의 추정,
- 자력계 측정치로부터 결정된 자기 진행 방향(magnetic heading)의 함수로서 추정된 예측 진행 방향의 재설정
을 계산하는 재귀 처리(recursive processing)를 구현한다.
선호하는 실시예에서는, 상기 재설정 동안, 계산 수단은
- 교란의 변화의 공간적 상관관계를 고려하기 위해 미리 결정된 2개의 샘플링 시간들 사이의 자기 교란의 변화의 모델, 및
- 교란 강도의 선행 추정(a priori estimation)
의 함수로서 재설정의 강도를 추정한다.
이런 방식으로, 처리는 2개의 샘플링 시간들 사이의 자기 진행 방향 교란의 변화를 고려하고 2개의 연속된 샘플링 시간들의 경우에 환경에 의한 교란의 잠재적 공간적 상관관계를 고려한다.
그로 인한 재설정은 종래 기술보다 더 신뢰할 수 있다.
상기 재설정은 유리하게도 측정된 자기장 기울기(magnetic field gradient)의 함수이다. 이런 방식으로, 환경이 더 교란될 수록, 기울기가 더 커지고 따라서 진행 방향의 측정이 더 위조된다는 사실을 고려한다.
특히, 주어진 샘플링 시간 k+1에 대하여, 계산 수단은
을 계산함으로서 환경에 연결된 진행 방향 교란을 추정하고,
- k는 이전 샘플링 시간이고,
유리하게도, 파라미터 는 그 부분에 대하여 시간 k+1과 k에 대한 자력계 출력으로부터 직접적으로 결정되는 자기 진행 방향 사이의 차이로서 계산 수단에 의해 계산되고, 그로부터 예측된 진행 방향 변화 (ω[k]dt)가 차감된다.
파라미터 σu 는 2개의 연속된 샘플링 시간들 사이의 변위(displacement)나 변위 속도의 함수로서 추정될 수 있다.
진행 방향 예측은 관성 유닛의 하나 또는 그 이상의 센서의 측정치의 함수로서 결정된다.
변화 모델은 교란의 변화의 시간적 상관관계를 고려하기 위하여 미리 결정된다.
본 발명은 또한 자기 센서에 의하여 진행 방향을 결정하는 장치에 관한 것으로서, 자력계 및 상기 자력계에 의해 측정된 자기장으로부터 진행 방향을 계산하는 계산 수단을 포함하고, 계산 수단은 서로 다른 연속된 샘플링 시간들에 대하여, 전술한 처리를 구현한다.
그것은 또한 그러한 진행 방향을 결정하기 위한 적어도 하나의 장치를 포함하는, 자력-관성 내비게이션 시스템을 제안한다.
그러한 시스템은 도시 환경이나 건물 내부에서 유리하게 사용된다.
본 발명은 또한:
- 컴퓨터 상에서 프로그램이 실행되었을 때, 전술한 유형의 방법의 실행을 위한 코드 명령어를 포함한 컴퓨터 프로그램 제품;
- 컴퓨터 프로그램 제품이 그러한 방법의 실행을 위한 코드 명령어를 포함하는 컴퓨터 장비에 의해 판독가능한 저장 수단
에 관련된 것이다.
본 발명에 따르면, 특히 심하게 교란된 환경에서, 사용되는 모델링의 관련성을 더 잘 특성화 할 수 있는 솔류션이 제공된다.
본 발명의 다른 특성과 장점들은 이하의 순수하게 예시적이고 비한정적인 설명으로부터 그리고 첨부된 도면에 관하여 읽혀짐으로서 명백하게 될 것이다:
- 도 1은 본 발명에 따른 방법의 구현을 위한 장비의 다이어그램이다.
- 도 2는 본 발명에 따른 방법의 구현을 위한 예시를 더 상세히 표현한 것이다.
- 도 3은 본 발명의 실시예를 준수하는 방법의 주요 단계들을 도시한 것이다.
- 도 1은 본 발명에 따른 방법의 구현을 위한 장비의 다이어그램이다.
- 도 2는 본 발명에 따른 방법의 구현을 위한 예시를 더 상세히 표현한 것이다.
- 도 3은 본 발명의 실시예를 준수하는 방법의 주요 단계들을 도시한 것이다.
일반적 특징 - 측정 장치
도 1을 참조하면, 제안된 측정 장치는 예컨대 로 표시되는, 로 표기되는 배경 자기장(전형적으로 지구 자기장으로, 근처의 금속 물체에 의해 약간 변화될 수 있다)에서 움직이는 물체(1)의 움직임의 추정에 사용된다. 알려진 것처럼, 자기장은 3차원 벡터 장, 즉 3차원 벡터를 움직일 수 있는 물체의 3차원 위치에 연관시키는 것이다.
이 물체(1)은 그 위치 정보를 알기를 원하는 임의의 이동가능한 물체일 수 있으며, 예컨대 바퀴달린 차량, 드론 등 뿐만 아니라 보행인일 수도 있다.
물체(1)는 케이스(2) 내에 복수의 자기 측정 센서(20) 즉 축상 자력계(axial magnetometer)(20)를 포함한다. 축상 자력계는 상기 자기장의 성분 즉 그 축을 따라 상기 자력계(20)의 레벨에서 상기 자기장 벡터 의 투사를 측정할 수 있는 요소를 의미하는 것이다.
더 자세하게는, 자력계(20)는 케이스(2)와 연계된다. 그들은 지상 기준 프레임에서 케이스(2)와 물체(1)와 실질적으로 동일한 움직임을 갖는다.
선호되기로는, 물체(1)의 기준 프레임이 직교 카테시안 기준점에 제공되어 자력계(20)가 이 기준점에서 미리 정해진 위치를 가진다.
도 2에서, 케이스(2)는 부착 수단(23)에 의해 물체(1)(예컨대 보행인의 팔다리) 상에 고정된다. 이 부착 수단(23)은 예컨대 팔찌, 예컨대 팔다리를 쥐고 일체형 링크를 가능케 하는 셀프-그리핑 스트랩으로 구성될 수 있다.
명백하게, 발명은 보행인의 움직임의 추정에 한정되지 않지만, 그러한 경우에는 특히 유리한데 왜냐하면 이것이 매우 절감된 부피를 가지고, 인체공학적인 방식으로 인간에 의해 휴대가능한 경우에 필요하기 때문이다.
케이스(2)는 본 방법의 처리 작업을 실시간으로 직접 구현하기 위한 계산 수단(21)(전형적으로 프로세서)을 포함하거나, 또는 그 대신 측정치들이 통신 수단(25)을 통해 모바일 터미널(스마트폰)(3), 또는 원격 서버(4)와 같은 외부 장치로 전송될 수 있거나, 또는 그 대신 측정치들이 예컨대 서버(4) 상에서 후처리를 위해 지역 데이터 저장 메모리 수단(22)(예컨대 플래시 유형의 메모리)로 기록될 수 있다.
통신 수단(25)은 예컨대 블루투스(Bluetooth)나 Wi-Fi 같은 단거리 무선통신(특히 모바일 터미널(3)을 가진 실시예의 경우)이나 심지어는 장거리 통신을 위한 모바일 네트워크(전형적으로 UMTS/LTE)로 연결되기 위한 수단을 구현할 수 있다. 통신 수단(25)은 예컨대 로컬 데이터 저장 수단(22)으로부터 모바일 터미널(3)이나 서버(4)로 데이터를 전송하기 위한 유선 연결(전형적으로 USB)일 수 있다.
만약 모바일 터미널(3)(서버(4))가 "인텔리전스"를 호스팅하는 것이라면, 그것은 설명될 본 방법의 처리 작업을 구현하기 위한 프로세서와 같은 계산 수단(31)((41))을 포함한다. 계산 수단이 사용되는 경우가 케이스(2)의 (21)이며, 그것은 또한 추정된 위치를 전송하는 통신 수단(25)을 더 포함할 수 있다. 예컨대, 착용자의 위치가 모바일 터미널(3)로 송신되어 내비게이션 소프트웨어 인터페이스에 디스플레이 될 수 있다.
각각 케이스(2), 스마트폰(3), 원격 서버(4)의 데이터 계산 수단(21, 31, 41)은 동일하게 그리고 응용범위에 따라 방법의 전부 또는 일부를 수행할 수 있다.
그들은 각각 이 목적을 위해 방법의 실행을 위한 코드 명령어의 시퀀스의 전부 또는 일부를 기억하는 저장 수단을 포함한다.
예측 및 재설정
계산 수단은 (도 3) 한편으로는 예측에 의해 진행 방향 값의 추정을 계산하는 필터링(100)을 구현하고(단계 (101)) 다른 한편으로는 오차 추정의 함수로서 재설정을 구현한다(단계 (102)).
재설정 (102)은 자력계(20)에 의해 수행된 측정치를 반영한다.
전형적으로, 자기 진행 방향은 다음과 같이 주어진다
여기서 My와 Mx는 자기장의 지상 기준 프레임에서의 2개의 수평 성분이고, 이 2개의 성분은 관성 유닛의 물체(1)에 대해 정해지는 자세(attitude)의 함수로서 계산된다.
- 이전 시간 k에 대해 계산되거나 조정된 이득 Kk
그러므로, 계산 수단은 상태를 재설정할 자력계에 의한 측정치로부터 유도된 자기 진행 방향을 사용하고, 특히 다음을 계산함으로써 진행 방향을 계산한다
그럼에도 불구하고 다른 오차 함수들이 가능하며, 특히 비선형 필터링의 경우에 그러하다.
이렇게, 재설정 보정은 자기장이 강하게 변화할 때 항상 중요하고 따라서 진행 방향 측정시에 중요한 오차를 유발하는 경향이 있다.
그렇게 얻어진 재설정 진행 방향값은 상기 계산 수단(21, 31, 41)에 의해 저장되거나 그리고/또는 상기 수단에 의해 프로세싱의 남은 부분을 위하여 그리고 자력-관성 내비게이션 정보(선속도, 각속도, 위치, 진행 방향 등)의 계산을 위하여 사용된다.
또한, 그것은 계산 수단에 의하여 인터페이스 수단 예컨대 전화기로 전송되어, 그 스크린 상에 디스플레이될 수 있다.
환경과 연결된 교란의 변화의 모델
여기서,
- ("d"는 교란(disturbance)을 의미)는 환경에 연결된 자기 진행 방향 교란에 대응한다(전형적으로, 도시 환경이나 빌딩에서 금속 인프라스트럭쳐와 전기 케이블에 연결된 교란들).
환경에 연결된 자기 진행 방향 교란은 공간적으로 상당히 상관(correlated)되어 있다. 환경의 교란과 연결된 자기장은 사실 연속 벡터장(continuous vector field)이고 주어진 두 지점 A와 B에서의 자기장은 이 두 지점 A와 B가 공간 상에서 이웃해 있을 때 항상 더 가깝다.
일 실시예에서, 환경에 연결된 진행 방향 교란 는 2개의 연속된 샘플링 시간 사이의 (시간적, 공간적 상관관계 또는 더 복잡한) 자기장 교란에 대해 예측될 수 있는 변화 상관관계(change correlation)을 고려한 공식을 수단으로 하여 계산 수단에 의해 추정된다.
● (시간적, 공간적 상관관계 또는 더 복잡한) 자기 진행 방향 교란의 변화의 모델을 고려할 수 있도록 해주고,
● 진행 방향이 관측가능한 필터링 모델을 구축할 수 있게 해준다(그렇지 않으면, 진행 방향 추정기를 구축할 아무런 희망이 없어진다).
제안된 추정에서, 재설정의 강도가 2개의 샘플링 시간 사이의 자기 교란 변화의 모델의 함수로서 그리고 교란 강도의 선행 추정(a priori estimation)으로 추정된다.
발명자들은 공간 상관관계의 경우(도시 영역이나 실내 교란의 경우), 시간 스텝에 의해 분리되는 2개의 샘플링 시간 사이의 교란 의 변화의 적절한 추정이 다음과 같음을 발견하였다(그리고 수학적으로 확인하였다):
- a[k]는 자기 교란의 선행 강도를 나타내는 파라미터이다.
a[k] 파라미터의 결정
파라미터 a[k]는 자기 진행 방향 교란의 선행 강도를 나타낸다. 그것은 진행 방향을 특헝화하고, 예컨대 자기장 기울기의 놈의 선형 함수로 계산된다.
예컨대,
파라미터 a[k]를 결정하기 위하여 다른 방법들도 가능하다.
특히, a[k]는 예컨대 아래 문헌에 제안된 것과 같은 기술들을 구현함으로써, 지구 자기장의 모델과 함께 비교함으로써 결정될 수도 있다:
"Assessment of Indoor Magnetic Field Anomalies using Multiple Magnetometers Assessment of Indoor" - M.H. Afzal, V. Renaudin, G. Lachapelle - Proceedings of the 23rd International Technical Meeting of The Satellite Division of the Institute of Navigation (ION GNSS 2010) September 21 - 24, 2010.
그러나 파라미터 a[k]가 자기장 기울기의 함수인 솔류션은 더 나은 보정을 가능케 하며, 지구 자기장의 모델을 요구하지 않는다.
이 파라미터는 예컨대 짧은 기간 동안 맞는 것으로 가정되는 자이로미터를 사용하여 계산된다. 교란에서 가장 가능성 높은 변화는 그 후 자기 진행 방향 측정의 변화와 자이로미터의 진행 방향의 차이 사이의 차이에 의해 주어진다:
여기서: E[.]는 수학적 기대값을, ω[k]는 자이로미터 회전 속도 그리고 dt는 샘플링 피치를 의미한다.
그러므로, 는 시간 k+1과 k에 대한 자력계 출력으로부터 직접 결정되는 자기 진행 방향들 사이의 차이에 따라 계산 수단에 의해 계산되며, 그로부터 예측된 회전 ω[k]dt가 차감된다.
파라미터 σ
u
의 결정
파라미터 σu는 단계 k와 단계 k+1에서 교란 사이의 상관관계의 이미지를 나타낸다.
자기 교란의 공간적 상관관계를 고려하는 방식으로 변위(displacement)의 속도(또는 유사한 2개의 연속 샘플링 시간들 사이의 변위)에서 그것을 색인화하는 것이 유리하게 선택될 수 있다.
Claims (14)
- 자기 센서들에 의해 진행 방향을 결정하는 방법으로서, 자기장은 자력계에 의해 측정되고, 계산 수단은 주어진 샘플링 시간에 대하여:
- 이전 샘플링 시간에 결정된 진행 방향의 함수인 진행 방향 예측의 추정,
- 자력계 측정치로부터 결정된 자기 진행 방향(magnetic heading)의 함수로서 추정된 예측 진행 방향의 재설정
을 계산하는 재귀 처리(recursive processing)를 구현하며,
상기 재설정 동안, 계산 수단은
- 교란의 변화의 공간적 상관관계를 고려하기 위해 미리 결정된 2개의 샘플링 시간들 사이의 자기 교란의 변화의 모델, 및
- 교란 강도의 선행 추정(a priori estimation)
의 함수로서 재설정의 강도를 추정하는, 자기 센서들에 의해 진행 방향을 결정하는 방법. - 앞선 청구항들 중 어느 한 항에 있어서,
상기 재설정은 측정된 자기장 기울기(magnetic field gradient)의 함수인, 자기 센서들에 의해 진행 방향을 결정하는 방법. - 제2항 또는 제3항에 있어서,
계산 수단은 파라미터 a[k]를 자기장 기울기의 놈(norm)의 선형 함수로서 추정하는, 자기 센서들에 의해 진행 방향을 결정하는 방법. - 제2항에 있어서,
파라미터 σu 는 2개의 연속된 샘플링 시간들 사이의 변위(displacement)나 변위 속도의 함수로서 추정되는, 자기 센서들에 의해 진행 방향을 결정하는 방법. - 앞선 청구항들 중 어느 한 항에 있어서,
진행 방향 예측은 관성 유닛의 하나 또는 그 이상의 센서의 측정치의 함수로서 결정되는, 자기 센서들에 의해 진행 방향을 결정하는 방법. - 제1항에 있어서,
변화 모델은 교란의 변화의 시간적 상관관계를 고려하기 위하여 미리 결정되는, 자기 센서들에 의해 진행 방향을 결정하는 방법. - 자기 센서에 의하여 진행 방향을 결정하는 장치로서, 자력계 및 상기 자력계에 의해 측정된 자기장으로부터 진행 방향을 계산하는 계산 수단을 포함하고, 계산 수단은 서로 다른 연속된 샘플링 시간들에 대하여, 앞선 청구항들 중 어느 한 항에 따른 방법의 처리를 구현하는, 자기 센서에 의하여 진행 방향을 결정하는 장치.
- 제10항에 따른 진행 방향을 결정하기 위한 적어도 하나의 장치를 포함하는, 자력-관성 내비게이션 시스템.
- 제11항에 따른 시스템을 도시 환경이나 건물 내부에서 응용하는 사용법.
- 컴퓨터 상에서 프로그램이 실행되었을 때, 제1항 내지 제9항 중 어느 한 항에 따른 자기장 측정 방법의 실행을 위한 코드 명령어를 포함한 컴퓨터 프로그램 제품.
- 컴퓨터 프로그램 제품이 제1항 내지 제9항 중 어느 한 항에 따른 자기장 측정 방법의 실행을 위한 코드 명령어를 포함하는 컴퓨터 장비에 의해 판독가능한 저장 수단.
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
FR1757223A FR3069633B1 (fr) | 2017-07-28 | 2017-07-28 | Determination de cap a partir du champ mesure par des capteurs magnetiques |
FR1757223 | 2017-07-28 | ||
PCT/FR2018/051941 WO2019020962A1 (fr) | 2017-07-28 | 2018-07-27 | Determination de cap a partir du champ mesure par des capteurs magnetiques |
Publications (1)
Publication Number | Publication Date |
---|---|
KR20200038271A true KR20200038271A (ko) | 2020-04-10 |
Family
ID=60302238
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020207006057A KR20200038271A (ko) | 2017-07-28 | 2018-07-27 | 자기 센서에 의해 측정된 자기장으로부터 진행 방향의 결정 |
Country Status (7)
Country | Link |
---|---|
US (1) | US11287259B2 (ko) |
EP (1) | EP3658852A1 (ko) |
JP (1) | JP7241732B2 (ko) |
KR (1) | KR20200038271A (ko) |
CN (1) | CN111148966B (ko) |
FR (1) | FR3069633B1 (ko) |
WO (1) | WO2019020962A1 (ko) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112595317A (zh) * | 2020-10-26 | 2021-04-02 | 一飞(海南)科技有限公司 | 无人机起飞控制方法、系统、介质、计算机设备、无人机 |
CN114821823B (zh) * | 2022-04-12 | 2023-07-25 | 马上消费金融股份有限公司 | 图像处理、人脸防伪模型的训练及活体检测方法和装置 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2264485A1 (en) | 2009-06-04 | 2010-12-22 | Tracedge | Method for analysing moving object continuous trajectory based on sampled GPS position |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01219610A (ja) * | 1988-02-29 | 1989-09-01 | Nissan Motor Co Ltd | 車両用走行方位検出装置 |
JPH04238221A (ja) * | 1991-01-21 | 1992-08-26 | Sumitomo Electric Ind Ltd | 方位検出装置 |
US7451549B1 (en) * | 2006-08-09 | 2008-11-18 | Pni Corporation | Automatic calibration of a three-axis magnetic compass |
WO2008120145A1 (en) * | 2007-04-02 | 2008-10-09 | Nxp B.V. | Method and system for orientation sensing |
CN102252689A (zh) * | 2010-05-19 | 2011-11-23 | 北京国浩传感器技术研究院(普通合伙) | 一种基于磁传感器的电子罗盘校准方法 |
CN202177381U (zh) * | 2011-05-06 | 2012-03-28 | 微迈森惯性技术开发(北京)有限公司 | 运动姿态数据获取装置与人体运动姿态追踪系统 |
WO2013188548A2 (en) * | 2012-06-12 | 2013-12-19 | Trxs Systems, Inc. | Methods for improved heading estimation |
JP2014089113A (ja) * | 2012-10-30 | 2014-05-15 | Yamaha Corp | 姿勢推定装置及びプログラム |
US20140297212A1 (en) * | 2013-04-02 | 2014-10-02 | Kionix, Inc. | Systems and Methods for Compensating for a Misalignment Angle Between an Accelerometer and a Magnetometer |
CN104237822B (zh) * | 2013-06-20 | 2018-10-19 | 意法半导体(中国)投资有限公司 | 用于电子磁力计传感器的补偿磁干扰 |
CN105606096B (zh) * | 2016-01-28 | 2018-03-30 | 北京航空航天大学 | 一种载体运动状态信息辅助的姿态和航向计算方法和系统 |
US10429185B2 (en) * | 2016-03-11 | 2019-10-01 | SenionLab AB | Indoor rotation sensor and directional sensor for determining the heading angle of portable device |
CN106017459B (zh) * | 2016-05-19 | 2019-03-19 | 极翼机器人(上海)有限公司 | 一种抗磁干扰的方法 |
US10809317B2 (en) * | 2016-09-23 | 2020-10-20 | Apple Inc. | Spatially dependent correction of magnetic field sensor readings |
-
2017
- 2017-07-28 FR FR1757223A patent/FR3069633B1/fr active Active
-
2018
- 2018-07-27 CN CN201880063659.8A patent/CN111148966B/zh active Active
- 2018-07-27 US US16/634,426 patent/US11287259B2/en active Active
- 2018-07-27 JP JP2020504122A patent/JP7241732B2/ja active Active
- 2018-07-27 KR KR1020207006057A patent/KR20200038271A/ko not_active Application Discontinuation
- 2018-07-27 WO PCT/FR2018/051941 patent/WO2019020962A1/fr active Application Filing
- 2018-07-27 EP EP18765692.1A patent/EP3658852A1/fr active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2264485A1 (en) | 2009-06-04 | 2010-12-22 | Tracedge | Method for analysing moving object continuous trajectory based on sampled GPS position |
Non-Patent Citations (4)
Title |
---|
"Assessment of Indoor Magnetic Field Anomalies using Multiple Magnetometers Assessment of Indoor" - M.H. Afzal, V. Renaudin, G. Lachapelle - Proceedings of the 23rd International Technical Meeting of The Satellite Division of the Institute of Navigation (ION GNSS 2010) September 21 - 24, 2010. |
"Unscented Filtering for Spacecraft Attitude Estimation" (J.L. Crassidis and F. Landis Markley) |
M. H. Afzal, V. Renaudin, and G. Lachapelle, "Magnetic field based heading estimation for pedestrian navigation environments," in 2011 International Conference on Indoor Positioning and Indoor Navigation, (Guimaraes, Portugal), Sep 2011. |
W. T. Faulkner, R. Alwood, W. T. David, and J. Bohlin, "Gps-denied pedestrian tracking in indoor environments using an imu and magnetic compass," in Proceedings of the 2010 International Technical Meeting of The Institute of Navigation, (San Diego, CA), pp. 198 - 204, January 2010. |
Also Published As
Publication number | Publication date |
---|---|
JP7241732B2 (ja) | 2023-03-17 |
FR3069633B1 (fr) | 2019-08-23 |
FR3069633A1 (fr) | 2019-02-01 |
CN111148966B (zh) | 2022-04-05 |
EP3658852A1 (fr) | 2020-06-03 |
JP2020529016A (ja) | 2020-10-01 |
WO2019020962A1 (fr) | 2019-01-31 |
US20200158505A1 (en) | 2020-05-21 |
US11287259B2 (en) | 2022-03-29 |
CN111148966A (zh) | 2020-05-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10247556B2 (en) | Method for processing feature measurements in vision-aided inertial navigation | |
US20180018783A1 (en) | Techniques for Accurate Pose Estimation | |
Stančić et al. | The integration of strap-down INS and GPS based on adaptive error damping | |
JP2021527214A (ja) | 物体の磁力計を較正する方法 | |
US11709056B2 (en) | Method and device for magnetic field measurement by magnetometers | |
US9163943B1 (en) | Systems and methods for using magnetic field readings to refine device location estimates | |
KR102547926B1 (ko) | 자기장 측정치로부터 결정된 진행 방향을 특정화하는 방법 및 장치 | |
CN110567491A (zh) | 惯性导航系统的初始对准方法、装置及电子设备 | |
KR20200038271A (ko) | 자기 센서에 의해 측정된 자기장으로부터 진행 방향의 결정 | |
EP3227634B1 (en) | Method and system for estimating relative angle between headings | |
JP5511088B2 (ja) | 自律測位に用いる重力ベクトルを補正する携帯装置、プログラム及び方法 | |
US20200132464A1 (en) | Method for estimating the movement of an object moving in a magnetic field | |
US11519728B2 (en) | Method for estimating the movement of an object moving in a magnetic field | |
Qian et al. | Optical flow based step length estimation for indoor pedestrian navigation on a smartphone | |
JP2013122384A (ja) | カルマンフィルタ、及び、状態推定装置 | |
Emami et al. | A customized H-infinity algorithm for underwater navigation system: With experimental evaluation | |
US20160349057A1 (en) | Multiple data sources pedestrian navigation system | |
Qian et al. | Optical flow-based gait modeling algorithm for pedestrian navigation using smartphone sensors | |
Bayat et al. | An augmented strapdown inertial navigation system using jerk and jounce of motion for a flying robot | |
JPWO2019020962A5 (ko) | ||
Gessesse et al. | Multi-sensor attitude and heading reference system using genetically optimized kalman filter | |
CN110579212B (zh) | 室内定位方法及装置 | |
Kuusniemi et al. | Evaluation of Bayesian approaches for multi-sensor multi-network seamless positioning | |
Duong et al. | On-line Smoothing for Mobile Mapping Systems Utilizing a Low Cost MEMS IMU | |
JP2012198147A (ja) | 移動端末及び移動経路算出プログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal |