Study/칼만필터 17

[칼만필터] Chap 9. 위치로 속도 추정하기

Chap 9. 위치로 속도 추정하기 https://github.com/tbmoon/kalman_filter/tree/master/Ch09.Pos2VelKF 참고하였습니다! 열차문제 직선 선로에서 80m/s 속도 유지. 위치, 속도 정보는 0.1s 간격으로 저장 속도 데이터를 저장하지 못함. 위치 정보로 속도정보를 얻어내기 9.1 시스템 모델 속도는 이동거리를 시간으로 나눈 값. 원하는 상태변수 \(x = \begin{bmatrix}위치 \\ 속도 \end{bmatrix} \) 관계식부터 정의해보면 \( 위치_{k+1} = 위치_{k} + 속도_{k} * \Delta t\) \( 속도_{k+1} = 속도_{k} + w_{k} \) \(w_k\)는 시스템 잡음. 관계식만 생각해보면 당연하다. 속도에는 잡음이..

Study/칼만필터 2022.01.15

[칼만필터] Chap 8. 초간단 칼만필터예제

" 칼만필터는 어렵지않아" 파이썬으로 된 내용이 있을까... 검색해보았더니 뙇... 역시 세상은 넓고, 감사한 분들은 많다. https://github.com/tbmoon/kalman_filter 오랜만에 jupyter notebook을 켜서 확인해보았는데, 이미 아름답게 다 구현이 되어있다. 앞으로 글정리에서도 위의 코드들을 쏙쏙 이해만해보도록한다.. Chap 8. 초간단 칼만필터예제 https://github.com/tbmoon/kalman_filter/tree/master/Ch08.SimpleKalmanFilter 배터리의 전압을 측정하는데, 잡음이 심하다. 칼만필터로 측정데이터의 잡음을 제거한다. 전압은 0.2초 간격으로 측정한다. 시스템모델 \(x_{k+1} = x_{k}\) \(z_k = x_..

Study/칼만필터 2022.01.09

[칼만필터] Chap 7. 시스템모델

Chap 7. 시스템모델 중요한 작업은 시스템을 수학적으로 모델링하여 "시스템 모델"을 유도하는 것 7.1 시스템모델 칼만필터는 선형상태모델에 적용된다. State space model \(x_{k+1} = A x_{k} + w_{k}\) \(z_{k} = H x_{k} + v_{k} \) \(x_{k}\) : 상태변수( n x 1) 열벡터 \(z_{k}\) : 측정값, (m x 1) 열벡터 \(A\) : 시스템 행렬(n x n) , 시스템의 운동방정식 \(H\) : 출력 행렬(m x n), 측정값과 상태변수의 관계 \(w_{k}\) : 시스템 잡음 (n x 1) 열벡터 \(v_{k}\) : 측정 잡음(m x 1) 열벡터 칼만필터에서는 잡음이 중요한 역할을 하는데 모든 잡음을 White noise로 가정..

Study/칼만필터 2022.01.09

[칼만필터] Chap 6. 예측과정

Chap 6. 예측과정 현재 시각\(t_{k}\)의 추정값 \(\hat{x}_{k}\)이 \(t_{k+1}\) 에서는 어떤 값이 될까? 6.1 예측값 계산 \(\hat{x}_{k+1}^{-}=A \hat{x}_{k} \) : 추정값을 예측 \(\hat{P}_{k+1}^{-}=A P_{k} A^{T} + Q \) : 오차공분산을 예측 A, Q: 시스템모델 현재시간은 \(t_{k}\), 다음시간 \(t_{k+1}\) 예측값이므로 위첨자 \(-\) 이 붙음. 위첨자'-'은 추정값과 예측값을 구분하기위함 표기 의미 \(\hat{x}_{k}\) 상태변수 추정값 \(\hat{x}_{k}^{-}\) 상태변수 예측값 \(P_{k}\) 오차공분산 계산값 \(P_{k}^{-}\) 오차공분산 예측값 6.2 예측과 추정의 차..

Study/칼만필터 2022.01.09

[칼만필터] Chap.5 추정과정

Chap.5 추정과정 5.1 추정값계산 H를 I(단위행렬)로 가정할 경우 칼만필터의 추정값 계산식은 Lowpass 필터의 식과 매우 유사하다.예측값과 측정값에 적절한 가중치를 곱한 다음, 두값을 더해서 최종 추정값을 계산한다. 직전 추정값 대신 예측값을 사용한다는 점만 다를 뿐, 가중치를 부여하는 방법이 동일함. 5.2 변하는 가중치 H가 단위행렬이라는 가정이 없더라도, 칼만필터가 추정값을 계산하는 방식은 Lowpass 필터와 매우 비슷하다는 것은 유효하다 \(\hat{x}_{k}= \hat{x}_{k}^{-}+ K_{k}(z_{k} - H\hat{x}_{k}^{-}) \) 칼만필터의 경우 재귀필터이므로 예측값과 새로운 측정값이 필요하다. H 는 시스템 모델이며, 칼만 필터 설계 전에 미리 확정된다. \..

Study/칼만필터 2022.01.09

[칼만필터] Chap.4 칼만필터(Kalman filter)

"칼만필터는 어렵지않아" 개인공부 Chap.4 칼만필터(Kalman filter) 1960년대에 나온 이론이기때문에 충분히 검증되어있다. 실무적으로 필요한 내용만을 위한 책이다. 칼만 필터와 lowpass 필터의 개념은 서로 연결되어있다. 칼만필터 변수 용도 변수 외부입력 \(z_{k}\) 최종출력 \(\hat{x}_{k} \) 시스템모델 \(A, H, Q, R \) 내부계산용 \(\hat{x}_{k}^{-}, P_{k}^{-}, P_{k}, K_{k} \) 사용자는 오직 시스템모델의 4개의 변수만을 조정할 수 있다. 이 모델 변수를 어떻게 설계하느냐에 따라 성능이 결정된다. 칼만필터 알고리즘 계산 0단계: 초기값 설정 \(\hat {x}_0, P_0 \) 1단계: 추정값과 오차 공분산 예측 \(\hat..

Study/칼만필터 2022.01.09
반응형