• 제목/요약/키워드: Unscented Kalman filtering algorithm

검색결과 13건 처리시간 0.023초

Indoor Mobile Localization System and Stabilization of Localization Performance using Pre-filtering

  • Ko, Sang-Il;Choi, Jong-Suk;Kim, Byoung-Hoon
    • International Journal of Control, Automation, and Systems
    • /
    • 제6권2호
    • /
    • pp.204-213
    • /
    • 2008
  • In this paper, we present the practical application of an Unscented Kalman Filter (UKF) for an Indoor Mobile Localization System using ultrasonic sensors. It is true that many kinds of localization techniques have been researched for several years in order to contribute to the realization of a ubiquitous system; particularly, such a ubiquitous system needs a high degree of accuracy to be practical and efficient. Unfortunately, a number of localization systems for indoor space do not have sufficient accuracy to establish any special task such as precise position control of a moving target even though they require comparatively high developmental cost. Therefore, we developed an Indoor Mobile Localization System having high localization performance; specifically, the Unscented Kalman Filter is applied for improving the localization accuracy. In addition, we also present the additive filter named 'Pre-filtering' to compensate the performance of the estimation algorithm. Pre-filtering has been developed to overcome negative effects from unexpected external noise so that localization through the Unscented Kalman Filter has come to be stable. Moreover, we tried to demonstrate the performance comparison of the Unscented Kalman Filter and another estimation algorithm, such as the Unscented Particle Filter (UPF), through simulation for our system.

Investigation into SINS/ANS Integrated Navigation System Based on Unscented Kalman Filtering

  • Ali, Jamshaid;Jiancheng, Fang
    • 제어로봇시스템학회:학술대회논문집
    • /
    • 제어로봇시스템학회 2005년도 ICCAS
    • /
    • pp.241-245
    • /
    • 2005
  • Strapdown inertial navigation system (SINS) integrated with astronavigation system (ANS) yields reliable mission capability and enhanced navigational accuracy for spacecrafts. The theory and characteristics of integrated system based on unscented Kalman filtering is investigated in this paper. This Kalman filter structure uses unscented transform to approximate the result of applying a specified nonlinear transformation to a given mean and covariance estimate. The filter implementation subsumed here is in a direct feedback mode. Axes misalignment angles of the SINS are observation to the filter. A simple approach for simulation of axes misalignment using stars observation is presented. The SINS error model required for the filtering algorithm is derived in space-stabilized mechanization. Simulation results of the integrated navigation system using a medium accuracy SINS demonstrates the validity of this method on improving the navigation system accuracy with the estimation and compensation for gyros drift, and the position and velocity errors that occur due to the axes misalignments.

  • PDF

언센티드 칼만/FIR 하이브리드 필터를 이용한 실내 위치 추정 (Indoor Localization Using Unscented Kalman/FIR Hybrid Filter)

  • 박정민;안춘기;임묘택;송문규
    • 제어로봇시스템학회논문지
    • /
    • 제21권11호
    • /
    • pp.1057-1063
    • /
    • 2015
  • This paper proposes a new nonlinear filtering algorithm that combines the unscented Kalman filter (UKF) and the finite impulse response (FIR) filter. The proposed filter is called the unscented Kalman/FIR hybrid filter (UKFHF). In the UKFHF algorithm, the UKF is used as the main filter, which produces state estimates under ideal conditions. When failures of the UKF are detected, the FIR filter is operated. Using the output of the FIR filter, the UKF is reset and rebooted. In this way, the UKFHF recovers from failures. The proposed UKFHF is applied to indoor human localization using wireless sensor networks. Through simulations, the performance of the UKFHF is demonstrated in comparison with that of the UKF.

An IMM Algorithm for Tracking Maneuvering Vehicles in an Adaptive Cruise Control Environment

  • Kim, Yong-Shik;Hong, Keum-Shik
    • International Journal of Control, Automation, and Systems
    • /
    • 제2권3호
    • /
    • pp.310-318
    • /
    • 2004
  • In this paper, an unscented Kalman filter (UKF) for curvilinear motions in an interacting multiple model (IMM) algorithm to track a maneuvering vehicle on a road is investigated. Driving patterns of vehicles on a road are modeled as stochastic hybrid systems. In order to track the maneuvering vehicles, two kinematic models are derived: A constant velocity model for linear motions and a constant-speed turn model for curvilinear motions. For the constant-speed turn model, an UKF is used because of the drawbacks of the extended Kalman filter in nonlinear systems. The suggested algorithm reduces the root mean squares error for linear motions and rapidly detects possible turning motions.

고른 필터를 이용한 인공위성의 자세 추정 (Spacecraft Attitude Estimation by Unscented Filtering)

  • 이현재;최윤혁;방효충;박종오
    • 제어로봇시스템학회논문지
    • /
    • 제14권9호
    • /
    • pp.865-872
    • /
    • 2008
  • Spacecraft attitude estimation using the nonlinear unscented filter is addressed to fully utilize capabilities of the unscented transformation. To release significant computational load, an efficient technique is proposed by reasonably removing correlation between random variables. This modification introduces considerable reduction of sigma points and computational burden in matrix square-root calculation for most nonlinear systems. Unscented filter technique makes use of a set of sample points to predict mean and covariance. The general QUEST(QUaternion ESTimator) algorithm preserves explicitly the quaternion normalization, whereas extended Kalman filter(EKF) implicitly obeys the constraint. For spacecraft attitude estimation based on quaternion, an approach to computing quaternion means from sampled quaternions with guarantee of the quaternion norm constraint is introduced applying a constrained optimization technique. Finally, the performance of the new approach is demonstrated using a star tracker and rate-gyro measurements.

GPS 신호의 단일차분을 이용한 편대위성의 상대위치 결정을 위한 필터링 성능 분석 (Filtering Performance Analyizing for Relative Navigation Using Single Difference Carrier-Phase GPS)

  • 박인관;박상영;최규홍;조성기;박종욱
    • Journal of Astronomy and Space Sciences
    • /
    • 제25권3호
    • /
    • pp.283-290
    • /
    • 2008
  • 이 논문에서는 간섭계 구성의 기본이 되는 위성 간 상대위치 추정에 관한 알고리즘을 개발하고 검증하였다. 편대위성 간 상대위치 추정을 실시간으로 수행하기 위해 확장칼만필터 (EKF, Extended Kalman Filter)와 Unscented 칼만필터 (UKF, Unscented Kalman Filter) 를 사용하였다. 칼만 필터를 이용한 상태벡터 (state-vector)의 갱신(update)을 위한 관측 데이터는 시뮬레이션을 통해 얻어진 GPS 위성 신호의 단일차분 (Single Difference)에 대한 값을 사용하였다. 이 연구에서 개발한 알고리즘으로 추정된 편대위성 간 상대위치는 확장칼만필터와 Unscented 칼만필터 모두 참 값으로 가정한 STK(Satellite Tool Kit) 의 시뮬레이션된 관측 값에 대해 ${\pm}1m$ 이내의 오차로 수렴함을 확인하였다. 또한 두 종류의 칼만필터를 이용하여 상대위치 결정을 수행함으로써 비선 형성을 가지는 경우 Unscented 칼만필터의 성능이 상대적으로 우수함을 확인할 수 있었다.

Autonomous Navigation of AGVs in Automated Container Terminals

  • Kim, Yong-Shik;Hong, Keum-Shik
    • 한국항해항만학회:학술대회논문집
    • /
    • 한국항해항만학회 2004년도 춘계학술대회 논문집
    • /
    • pp.459-464
    • /
    • 2004
  • In this paper, an autonomous navigation system for autonomous guided vehicles (AGVs) operated in an automated container terminal is designed. The navigation system is based on the sensors detecting the range and bearing. The navigation algorithm used is an interacting multiple model (IMM) algorithm to detect other AGVs and avoid other obstacles using informations obtained from multiple sensors. As models to detect other AGVs (or obstacles), two kinematic models are derived: Constant velocity model for linear motion and constant speed turn model for curvilinear motion. For constant speed turn model, an unscented Kalman filter (UKF) is used because of drawbacks of the extended Kalman filter (EKF) in nonlinear system. The suggested algorithm reduces the root mean squares error for linear motions, while it can rapidly detect possible turning motions.

  • PDF

비선형 칼만 필터 기반의 지형참조항법 성능 비교 (A Performance Comparison of Nonlinear Kalman Filtering Based Terrain Referenced Navigation)

  • 목성훈;방효충;유명종
    • 한국항공우주학회지
    • /
    • 제40권2호
    • /
    • pp.108-117
    • /
    • 2012
  • 본 논문은 비선형 필터 기법에 따른 지형참조항법 성능 분석에 관한 연구를 수행하였다. 지형참조항법에 사용되는 기본 필터에는 확장 칼만 필터(EKF)가 있다. 본 연구는 EKF 원형외에 반복형 EKF(IEKF), stochastic linearization(SL) 조건이 추가된 EKF-SL과 unscented Kalman Filter(UKF) 알고리듬을 소개한다. 또한, 연속적(sequential) 필터 외에 일괄적(batch)필터 기법인 칼만 필터 무리(bank of Kalman filters)를 이용한 항법 기술도 비교군으로 추가하고 필터 간 항법 성능을 분석한다. 가상 궤적을 가진 항공기 시뮬레이션을 통해 초기위치 오차가 클 때도 강건한(robust) 필터로 stochastic linearization EKF가 선정되었으며, 다만 빠른 항법 해의 수렴이 요구될 때에는 칼만 필터 무리를 이용한 일괄적 필터가 효과적인 것으로 분석되었다.

Unscented Filtering Approach to Magnetometer-Only Orbit Determination

  • Cheon, Yee-Jin
    • 제어로봇시스템학회:학술대회논문집
    • /
    • 제어로봇시스템학회 2003년도 ICCAS
    • /
    • pp.2331-2334
    • /
    • 2003
  • The basic difference between the EKF(Extended Kalman Filter) and UKF(Unscented Kalman Filter) stems from the manner in which Gaussian random variables(GRV) are represented for propagating through system dynamics. In the EKF, the state distribution is approximated by a GRV, which is then propagated analytically through the first-order linearization of the nonlinear system. This can possibly introduce large errors in the true posterior mean and covariance of the transformed GRV, which may lead to sub-optimal performance and sometimes divergence of the filter. However, the UKF addresses this problem by using a deterministic sampling approach. The state distribution is also approximated by a GRV, but is now represented using a minimal set of carefully chosen sample points. These sample points completely capture the true mean and covariance of the GRV, and UKF captures the posterior mean and covariance accurately up to the 2nd order(Taylor series expansion) for any nonlinearity. This paper utilizes the UKF to determine spacecraft orbit when only magnetometer is available. Several catastrophic failures of spacecraft in orbit have been attributed to failures of the spacecraft mission. Recently studies on contingency-major sensor failure cases- have been performed. For mission success, contingency design or plan should be implemented in case of a major sensor failure. Therefore the algorithm presented in this paper can be used for a spacecraft without GPS or contingency design in case of GPS failure.

  • PDF

영상 기반의 이차 칼만 필터를 이용한 객체 추적 (Quadratic Kalman Filter Object Tracking with Moving Pictures)

  • 박선배;유도식
    • 한국항행학회논문지
    • /
    • 제20권1호
    • /
    • pp.53-58
    • /
    • 2016
  • 우리는 본 논문에서 이차 칼만 필터를 이용한 영상 기반 객체 추적분야의 새로운 알고리즘을 제안한다. 최근에 발표된 이차 칼만 필터는 영상 기반의 객체의 실제 3차원 공간의 위치를 추적하는 것에는 아직 적용되지 않았다. 2차원 영상 내의 위치를 3차원 공간상의 위치로 환원시키는 것은 비선형적 변환을 수반하기 때문에 그에 맞는 추적 알고리즘을 사용해야만 한다. 이러한 상황에서, 비선형 수식을 이차식으로 근사화하는 이차 칼만 필터가 선형으로 근사화하는 확장 칼만 필터보다 더 정확한 성능을 낼 수 있다. 우리는 동일한 상황을 가정하여 확장 칼만 필터, 무향 칼만 필터, 파티클 필터, 그리고 우리가 제안한 이차 칼만 필터를 이용하여 객체를 추적하고, 그 결과를 비교해 본다. 결론적으로 이차 칼만 필터가 발산율이 확장 칼만 필터에 비해 거의 절반가량 감소하며, 추적 정확도 측면에서 무향 칼만 필터에 비해 1% 가량 우수한 성능을 나타낸다.