1 |
1
이동 로봇에 장착된 동적 위치 및 방향 인식 장치가, 이동 로봇의 이동시 그 위치 및 방향을 동적으로 인식하는 방법으로서,(a) 특정 송신기(이하 '현 주기 송신기'라 한다)에서 송신된 초음파 신호를, 이동 로봇 동적 위치 및 방향 인식 장치의 초음파 수신기가 수신하는 단계;(b) 상기 수신된 초음파 신호를 이용하여, 이동 로봇의 현재 위치에서 상기 현 주기 송신기로부터 상기 초음파 수신기까지의 초음파 거리를 측정하는 단계;(c) 상기 이동 로봇의 이전 주기 위치에서의 상기 초음파 수신기로부터 타 송신기(이하 '이전 주기 송신기'라 한다)까지의 초음파 거리를, 상기 이동 로봇의 현재 위치에서 상기 초음파 수신기로부터 상기 이전 주기 송신기까지의 초음파 거리로 환산하도록 시간 보상을 수행하는 단계; 및(d) 상기 단계(b)에서 측정된 초음파 거리 및 단계(c)에서 시간 보상된 초음파 거리로부터 상기 이동 로봇의 현재 위치와 방향을 산출하는 단계를 포함하고,상기 단계(c)는,(c11) 이동 로봇의 양 바퀴의 회전량을 나타내는 엔코더 신호로부터, 다수의 선속도와 각속도를 산출하는 단계;(c12) 상기 다수의 선속도와 각속도 정보로부터 상기 이동 로봇의 현재 위치와 방향을 산출하는 단계;(c13) 상기 단계(c12)에서 산출된 이동 로봇의 위치와 방향으로부터 초음파 수신기의 현재 위치를 산출하는 단계; 및(c14) 상기 이동 로봇의 이전 주기 위치에서 상기 초음파 수신기와 상기 이전 주기 송신기 간의 초음파 거리 측정시 발생된 측정 오차를, 상기 단계(c13)에서 산출된 초음파 수신기의 위치와 상기 이전 주기 송신기 간의 거리에 적용하여, 시간 보상된 초음파 거리를 구하는 단계를 포함하며,상기 단계(c11)의 선속도와 각속도 산출주기는,송신기의 초음파 송신주기보다 작은 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 방법
|
2 |
2
청구항 1에 있어서,상기 초음파 수신기는 두 개 이상 설치되며,상기 단계(a) 내지 단계(c)는 설치된 상기 각각의 초음파 수신기에 대하여 수행되고,상기 단계(d)에서 산출되는 이동 로봇의 동적 위치 및 방향은, 상기 각 초음파 수신기에서 수신된 초음파로부터 측정되거나 시간 보상된 모든 초음파 거리를 이용하여 산출되는 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 방법
|
3 |
3
청구항 1에 있어서,상기 단계(b)의 초음파 거리는,상기 단계(a)에서 수신한 초음파 신호에 대하여 정합 필터 계산을 수행하여 산출되는 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 방법
|
4 |
4
삭제
|
5 |
5
삭제
|
6 |
6
청구항 1에 있어서,m 개의 송신기가 존재하고 현재 시각을 tk, 이전 시각을 순차적으로 tk-1, tk-2,
|
7 |
7
청구항 1에 있어서,m 개의 송신기가 존재하고 현재 시각을 tk, 이전 시각을 순차적으로 tk-1, tk-2,
|
8 |
8
청구항 1에 있어서,상기 단계(d) 이후,(e) 확장 칼만 필터(extended Kalman filter)가, 상기 단계(d)에서 산출된 상기 이동 로봇의 현재 위치와 방향 정보 및, 엔코더 신호로부터 산출한 선속도 및 각속도 정보를 포함하는 오도메트리(odometry) 정보로부터, 이동 로봇의 위치와 방향을 산출하는 단계를 더 포함하는 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 방법
|
9 |
9
청구항 8에 있어서,상기 단계(e)는,(e11) 상기 오도메트리 정보 및 이전 주기에 상기 확장 칼만 필터에서 산출된 이동 로봇의 위치와 방향 값으로부터, 현재 주기의 이동 로봇의 위치와 방향 예측값 및 그 예측값의 표준편차의 제곱을 나타내는 공분산 행렬(covariance matrix) 예측값을 산출하는 단계; 및(e12) 상기 단계(d)에서 산출된 상기 이동 로봇의 현재 위치와 방향 정보 및, 상기 단계(e11)에서 산출된 현재 주기의 이동 로봇의 위치와 방향 예측값 및 공분산 행렬 예측값을 이용하여 최종적으로 이동 로봇의 위치와 방향값 및 그 공분산행렬 갱신값을 산출하는 단계를 포함하는 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 방법
|
10 |
10
이동 로봇의 이동시 그 위치 및 방향을 동적으로 인식하는 장치로서,송신기에서 송신된 초음파 신호를 수신하는 초음파 수신기;상기 수신된 초음파 신호를 이용하여, 송신기로부터 상기 초음파 수신기까지의 초음파 거리를 측정하는 초음파 거리 측정 모듈;상기 이동 로봇의 이전 주기 위치에서의 상기 초음파 수신기로부터 타 송신기(이하 '이전 주기 송신기'라 한다)까지의 초음파 거리를, 상기 이동 로봇의 현재 위치에서 상기 초음파 수신기로부터 상기 이전 주기 송신기까지의 초음파 거리로 환산하도록 시간 보상을 수행하는 시간 보상부;상기 초음파 거리 측정 모듈에서 측정된 초음파 거리 및 상기 시간 보상부에서 시간 보상된 초음파 거리로부터 상기 이동 로봇의 현재 위치와 방향을 산출하는 위치와 방향 산출부;이동 로봇의 선속도 및 각속도 정보를 포함하는 오도메트리(odometry) 정보를 산출하는 오도메트리 정보 산출부; 및상기 위치와 방향 산출 모듈에 의해 산출된 상기 이동 로봇의 현재 위치와 방향 정보 및, 상기 오도메트리 정보 산출부에 의해 산출된 오도메트리 정보로부터 이동 로봇의 위치와 방향을 산출하는 확장 칼만 필터(extended Kalman filter)부를 포함하고,상기 확장 칼만 필터부는,상기 오도메트리 정보 및 이전 주기에 상기 확장 칼만 필터부에서 최종 산출된 이동 로봇의 위치와 방향 값으로부터, 현재 주기의 이동 로봇의 위치와 방향 예측값 및 그 예측값의 표준편차의 제곱을 나타내는 공분산 행렬(covariance matrix) 예측값을 산출하는 위치와 방향값 예측부; 및상기 위치와 방향 산출 모듈에 의해 산출된 상기 이동 로봇의 현재 위치와 방향 정보 및, 상기 위치와 방향값 예측부에서 산출된 현재 주기의 이동 로봇의 위치와 방향 예측값 및 공분산 행렬 예측값을 이용하여 최종적으로 이동 로봇의 위치와 방향값 및 그 공분산행렬 갱신값을 산출하는 위치와 방향값 갱신부를 포함하는 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 장치
|
11 |
11
청구항 10에 있어서,상기 초음파 거리 측정 모듈은,상기 수신된 초음파 신호로부터, 정합 필터에 의한 계산을 수행하여 초음파 거리를 산출하는 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 장치
|
12 |
12
삭제
|
13 |
13
청구항 10에 있어서,상기 오도메트리 정보 산출부는,이동 로봇의 양 바퀴의 회전량을 엔코더 신호로서 출력하는 엔코더; 및상기 엔코더 신호로부터 이동 로봇의 선속도 및 각속도 정보를 포함하는 오도메트리(odometry) 정보를 산출하는 오도메트리 정보 산출 모듈을 포함하는 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 장치
|
14 |
14
청구항 10에 있어서,상기 시간 보상부는,상기 오도메트리 정보 산출부에 의해 산출된 오도메트리 정보를 이용하여 상기 이동 로봇의 현재 위치와 방향을 산출하는 위치와 방향 산출 모듈;상기 위치와 방향 산출 모듈에서 산출된 이동 로봇의 위치와 방향으로부터 초음파 수신기의 현재 위치를 산출하는 수신기 위치 산출 모듈; 및상기 이동 로봇의 이전 주기 위치에서 상기 초음파 수신기와 상기 이전 주기 송신기 간의 초음파 거리 측정시 발생된 측정 오차를, 상기 수신기 위치 산출 모듈에서 산출된 초음파 수신기의 위치와 상기 이전 주기 송신기 간의 거리에 적용하여, 시간 보상된 초음파 거리를 구하는 시간 보상 모듈을 포함하는 것을 특징으로 하는 이동 로봇의 동적 위치 및 방향 인식 장치
|
15 |
15
삭제
|
16 |
16
삭제
|