• Title/Summary/Keyword: Augmented state Kalman filter

Search Result 27, Processing Time 0.017 seconds

A Study on Vehicle Ego-motion Estimation by Optimizing a Vehicle Platform (차량 플랫폼에 최적화한 자차량 에고 모션 추정에 관한 연구)

  • Song, Moon-Hyung;Shin, Dong-Ho
    • Journal of Institute of Control, Robotics and Systems
    • /
    • v.21 no.9
    • /
    • pp.818-826
    • /
    • 2015
  • This paper presents a novel methodology for estimating vehicle ego-motion, i.e. tri-axis linear velocities and angular velocities by using stereo vision sensor and 2G1Y sensor (longitudinal acceleration, lateral acceleration, and yaw rate). The estimated ego-motion information can be utilized to predict future ego-path and improve the accuracy of 3D coordinate of obstacle by compensating for disturbance from vehicle movement representatively for collision avoidance system. For the purpose of incorporating vehicle dynamic characteristics into ego-motion estimation, the state evolution model of Kalman filter has been augmented with lateral vehicle dynamics and the vanishing point estimation has been also taken into account because the optical flow radiates from a vanishing point which might be varied due to vehicle pitch motion. Experimental results based on real-world data have shown the effectiveness of the proposed methodology in view of accuracy.

The Realization of the Three Dimensional Guidance Law Using Modified Augmented Proportional Navigation (개선된 부가비례항법을 이용한 3차원 유도법칙의 구현)

  • Kim, Y.M.;Seo, J.H.
    • Proceedings of the KIEE Conference
    • /
    • 1995.11a
    • /
    • pp.222-224
    • /
    • 1995
  • This paper deals with 3-dimensional missile guidance law. This presents the general optimal solution of the state equation which includes the target maneuvering as the Gauss-Markov processing. The main results ore about the transformation between the Cartesian coordinates on which both the guidance law and the filter are bused and the polar coordinates system in real missile guidance and measurement information. And the extended Kalman filter and adjustment of the estimated target acceleration by triangular functions is proposed solution to this transformation problem. It is shown that this proposed transformation is valid in real 3-dimensional guidance problem by the computer simulation.

  • PDF

Roll Angle Estimation of Slowly Rolling Guided Munition With Time-delayed Measurement and Its Verification Through Flight Experiment (지연된 측정치를 가진 저속 회전 유도형 탄약의 롤각 추정 및 비행 실험을 통한 검증)

  • Park, Junwoo;Ahn, Hyungjoo;Jung, Sungmin;Noh, Junyoung;Hong, Kyungwoo;Jang, Kwangwoo;Kim, Sungjoong;Bang, Hyochoong;Kim, Jin-Won;Heo, Junhoe;Pak, Chang-Ho;Seo, Songwon
    • Journal of the Korean Society for Aeronautical & Space Sciences
    • /
    • v.49 no.5
    • /
    • pp.373-381
    • /
    • 2021
  • This paper details the result of flight experiment that examines performance of roll angle estimation algorithm of slowly rolling munition taking time delay of measurement into account when measurement comes in delayed fashion. As the measurement is passed through low pass filter for numerical stabilization and de-noising purpose which induces time delay, we design augmented state Kalman filter that incorporates distribution models of stochastic delay over time. Flight experiment was conducted to verify the algorithm at around 250m high AGL(Above Ground Level) conveying velocity of 28m/s from fixed-wing mother plane to the munition. Munition was made spun with respect to its roll axis using internal reaction wheel afterward. Numerical comparison of proposing method's roll estimation performance with that of commercial aerospace graded GPS/INS shows that proposed filter design can effectively compensate time delay of measurement.

Real-time Monocular Camera Pose Estimation using a Particle Filiter Intergrated with UKF (UKF와 연동된 입자필터를 이용한 실시간 단안시 카메라 추적 기법)

  • Seok-Han Lee
    • The Journal of Korea Institute of Information, Electronics, and Communication Technology
    • /
    • v.16 no.5
    • /
    • pp.315-324
    • /
    • 2023
  • In this paper, we propose a real-time pose estimation method for a monocular camera using a particle filter integrated with UKF (unscented Kalman filter). While conventional camera tracking techniques combine camera images with data from additional devices such as gyroscopes and accelerometers, the proposed method aims to use only two-dimensional visual information from the camera without additional sensors. This leads to a significant simplification in the hardware configuration. The proposed approach is based on a particle filter integrated with UKF. The pose of the camera is estimated using UKF, which is defined individually for each particle. Statistics regarding the camera state are derived from all particles of the particle filter, from which the real-time camera pose information is computed. The proposed method demonstrates robust tracking, even in the case of rapid camera shakes and severe scene occlusions. The experiments show that our method remains robust even when most of the feature points in the image are obscured. In addition, we verify that when the number of particles is 35, the processing time per frame is approximately 25ms, which confirms that there are no issues with real-time processing.

Visual SLAM using Local Bundle Optimization in Unstructured Seafloor Environment (국소 집단 최적화 기법을 적용한 비정형 해저면 환경에서의 비주얼 SLAM)

  • Hong, Seonghun;Kim, Jinwhan
    • The Journal of Korea Robotics Society
    • /
    • v.9 no.4
    • /
    • pp.197-205
    • /
    • 2014
  • As computer vision algorithms are developed on a continuous basis, the visual information from vision sensors has been widely used in the context of simultaneous localization and mapping (SLAM), called visual SLAM, which utilizes relative motion information between images. This research addresses a visual SLAM framework for online localization and mapping in an unstructured seabed environment that can be applied to a low-cost unmanned underwater vehicle equipped with a single monocular camera as a major measurement sensor. Typically, an image motion model with a predefined dimensionality can be corrupted by errors due to the violation of the model assumptions, which may lead to performance degradation of the visual SLAM estimation. To deal with the erroneous image motion model, this study employs a local bundle optimization (LBO) scheme when a closed loop is detected. The results of comparison between visual SLAM estimation with LBO and the other case are presented to validate the effectiveness of the proposed methodology.

A Real-time Particle Filtering Framework for Robust Camera Tracking in An AR Environment (증강현실 환경에서의 강건한 카메라 추적을 위한 실시간 입자 필터링 기법)

  • Lee, Seok-Han
    • Journal of Digital Contents Society
    • /
    • v.11 no.4
    • /
    • pp.597-606
    • /
    • 2010
  • This paper describes a real-time camera tracking framework specifically designed to track a monocular camera in an AR workspace. Typically, the Kalman filter is often employed for the camera tracking. In general, however, tracking performances of conventional methods are seriously affected by unpredictable situations such as ambiguity in feature detection, occlusion of features and rapid camera shake. In this paper, a recursive Bayesian sampling framework which is also known as the particle filter is adopted for the camera pose estimation. In our system, the camera state is estimated on the basis of the Gaussian distribution without employing additional uncertainty model and sample weight computation. In addition, the camera state is directly computed based on new sample particles which are distributed according to the true posterior of system state. In order to verify the proposed system, we conduct several experiments for unstable situations in the desktop AR environments.

Development of a Hover-capable AUV System for In-water Visual Inspection via Image Mosaicking (영상 모자이킹을 통한 수중 검사를 위한 호버링 타입 AUV 시스템 개발)

  • Hong, Seonghun;Park, Jeonghong;Kim, Taeyun;Yoon, Sukmin;Kim, Jinwhan
    • Journal of Ocean Engineering and Technology
    • /
    • v.30 no.3
    • /
    • pp.194-200
    • /
    • 2016
  • Recently, UUVs (unmanned underwater vehicles) have increasingly been applied in various science and engineering applications. In-water inspection, which used to be performed by human divers, is a potential application for UUVs. In particular, the operational safety and performance of in-water inspection missions can be greatly improved by using an underwater robotic vehicle. The capabilities of hovering maneuvers and automatic image mosaicking are essential for autonomous underwater visual inspection. This paper presents the development of a hover-capable autonomous underwater vehicle system for autonomous in-water inspection, which includes both a hardware platform and operational software algorithms. Some results from an experiment in a model basin are presented to demonstrate the feasibility of the developed system and algorithms.