1 |
1
이동물체를 이동시키며 오도메트리(Odometry) 정보를 획득하는 구동감지부;상기 구동감지부의 속도 및 방향을 제어하여 상기 구동감지부를 구동시키는 구동제어부;고유의 ID(Identification) 및 위치정보가 저장된 다수의 RFID 태그(Radio Frequency Identification Tag) 각각과 통신하여 상기 태그에 저장된 정보를 수신하는 RFID 리더부;상기 구동감지부, 상기 구동제어부 및 상기 RFID 리더부를 제어하는 컴퓨터부를 포함하는 이동물체의 이동을 인식하는 위치추정 시스템에 있어서,상기 컴퓨터부는 주기적으로 수신되는 상기 오도메트리 정보와 상기 태그 정보에 의해 선택되는 상기 이동물체의 상태정보를 갖는 다수의 상태점을 이용하여 상기 이동물체의 위치를 추정하며, 상기 태그가 인식된 영역의 중심으로부터 상기 영역의 인식범위의 2배 이내에 존재하는 상태점들을 위치 추정에 유효한 상태점으로서 선택하는 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 시스템
|
2 |
2
제 1항에 있어서,상기 컴퓨터부는 상기 RFID 태그의 ID에 대응하는 좌표 정보와 인식 가능한 인식범위 정보를 테이블 형태로 저장하는 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 시스템
|
3 |
3
제 1항에 있어서,상기 상태점은 2차원 좌표 및 자세성분을 포함하는 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 시스템
|
4 |
4
구동감지부가 이동물체를 구동시켜 이동물체의 오도메트리 정보를 획득하는 구동감지부, RFID 태그를 인식하는 RFID 리더부, 상기 구동감지부와 상기 RFID 리더부로부터 정보를 주기적으로 수신하는 컴퓨터부로 이루어지는 이동물체를 사용하여 이동물체의 이동을 인식하는 위치추정 방법에 있어서,(a) 상기 컴퓨터부가 상기 이동물체의 상태정보를 갖는 다수의 상태점을 상기 RFID 태그의 ID에 대응하는 맵에 초기화하는 단계;(b) 상기 컴퓨터부가 상기 구동감지부의 구동에 따라 상기 RFID 태그의 인식 여부를 확인하고, 상기 태그가 인식되면 인식된 영역의 중심으로부터 상기 영역의 인식범위의 2배 이내에 존재하는 상태점들을 유효한 상태점으로서 상기 맵에서 선택하는 단계;(c) 상기 컴퓨터부가 상기 유효한 상태점들로부터 상기 이동물체의 위치(x, y) 및 자세(θ)를 추정하는 단계;(d) 상기 맵에 상태점을 추가하는 단계를 포함하고;상기 이동물체의 구동이 멈출때까지 상기 (b) 단계 내지 (d) 단계를 반복하면서 상기 이동체의 이동에 따른 위치 및 자세를 추정하는 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 방법
|
5 |
5
제 4항에 있어서,상기 (a) 단계는상기 컴퓨터부가 상기 맵을 생성하는 단계,상기 RFID 태그의 위치에 해당하는 상기 맵상의 위치에 상기 상태점들을 생성하는 단계,상기 상태점들에 방향(θ)을 부여하는 단계를 포함하는 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 방법
|
6 |
6
제 4항에 있어서,상기 (b) 단계에서 상기 태그가 인식되지 않으면상기 맵의 상태점들을 유효한 상태점으로서 선택하고, 상기 유효한 상태점들을 상기 구동감지부로부터 획득된 오도메트리 정보로부터 얻은 거리, 방향, 노이즈를 고려하여 이동시키는 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 방법
|
7 |
7
제 6항에 있어서,상기 유효한 상태점들이 이동할 위치 및 자세는 식의 실행에 의해 연산되며,상기 Pi,t는 시간 t에서의 i번째 상태점의 위치 및 자세이고, 상기 △l은 상기 이동물체의 이동거리이고, 상기 Vt는 시간 t에서 상기 이동물체의 이동거리 및 자세의 변화 정도에 비례하는 변수이고, 상기 rand()는 0~2까지의 수 중 하나를 택하여 소수 첫째 자리수를 반환하는 함수이며, 상기 Vt와 rand()는 상기 노이즈의 특성을 표현하기 위한 변수인 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 방법
|
8 |
8
삭제
|
9 |
9
제 4항에 있어서,상기 (c) 단계는(c1) 상기 맵의 유효한 상태점들을 x축, y축, θ축으로 투영하여 상기 x축, 상기 y축, 상기 θ축에 대한 히스토그램(Histogram)으로 생성하는 단계,(c2) 상기 맵에서 상기 유효한 상태점들이 이루는 최대 군집의 위치를 찾는 단계,(c3) 상기 히스토그램의 x축 최대값(xmax)과 y축 최대값(ymax)이 이루는 점을 원의 중심으로 하여 상기 맵에서 상기 중심점으로부터 미리 지정된 거리(L) 안의 상태점들을 선택하는 단계,(c4) 상기 (c3) 단계에서 선택된 상태점들 중에서 상기 히스토그램의 θ축 최대값(θmax)-미리 지정된 각도(K) ~ θ축의 최대값(θmax)+미리 지정된 각도(K) 사이의 자세를 갖는 상태점들을 유효한 상태점으로 선택하는 단계,(c5) 상기 (c4) 단계에서 선택된 유효한 상태점들로부터 상기 이동물체의 위치(x, y) 및 자세(θ)를 추정하는 단계를 포함하는 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 방법
|
10 |
10
제 9항에 있어서,상기 (c5) 단계는 식의 실행에 의해 연산되며,상기 P이동물체는 상기 이동물체의 추정된 위치 및 자세이고, 상기 Pi는 상기 유효한 상태점들 중 i번째 상태점의 위치 및 자세이고, 상기 N은 상기 유효한 상태점들의 총 개수인 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 방법
|
11 |
11
제 4항에 있어서,상기 (d) 단계는 상기 이동물체의 추정된 위치를 중심으로 거리 이하의 원안에 상기 이동물체의 자세와 동일한 자세를 갖는 상태점을 Ndim개를 추가로 생성하며, 상기 Ndim은 상기 (b) 단계 및 (c) 단계에서 제거된 상태점의 수인 것을 특징으로 하는 이동물체 상태군을 적용한 이동물체 위치추정 방법
|