• Journal of Institute of Control, Robotics and Systems
• /
• v.18 no.1
• /
• pp.54-61
• /
• 2012

In this paper, the pose estimation method for the satellite GTB (Ground Test Bed) using vision/MEMS IMU (Inertial Measurement Unit) integrated system is presented. The GTB for verifying a satellite system on the ground is similar to the mobile robot having thrusters and a reaction wheel as actuators and floating on the floor by compressed air. The EKF (Extended Kalman Filter) is also used for fusion of MEMS IMU and vision system that consists of a single camera and infrared LEDs that is ceiling landmarks. The fusion filter generally utilizes the position of feature points from the image as measurement. However, this method can cause position error due to the bias of MEMS IMU when the camera image is not obtained if the bias is not properly estimated through the filter. Therefore, it is proposed that the fusion method which uses the position of feature points and the velocity of the camera determined from optical flow of feature points. It is verified by experiments that the performance of the proposed method is robust to the bias of IMU compared to the method that uses only the position of feature points.

• Journal of the Korea Academia-Industrial cooperation Society
• /
• v.18 no.10
• /
• pp.15-23
• /
• 2017

This paper reports a SOC(State-of-Charge) estimation method using the extended Kalman filter(EKF) algorithm, which can allow real-time implementation and reduce the error of the model and be robust against noise, to accurately estimate and evaluate the charging/discharging state of the EV(Electric Vehicle) battery. The battery was modeled as the first order Thevenin model for the EKF algorithm and the parameters were derived through experiments. This paper proposes the changed method, which can have the SOC to 0% ~ 100% regardless of the aging of the battery by replacing the rated capacity specified in the battery with the maximum chargeable capacity. In addition, This paper proposes the EKF algorithm to estimate the non-linearity interval of the battery and simulation result based on Ah-counting shows that the proposed algorithm reduces the estimation error to less than 5% in all intervals of the SOC.

• Journal of Positioning, Navigation, and Timing
• /
• v.9 no.3
• /
• pp.207-214
• /
• 2020

In this paper, we implement linear-quadratic-Gaussian based vector tracking loop (LQG-VTL) instead of conventional extended Kalman filter based vector tracking loop (EKF-VTL). The LQG-VTL can improve the performance compared to the EKF-VTL by generating optimal control input at a specific performance index. Performance analysis is conducted through two factors, frequency thermal noise and frequency dynamic stress error, which determine total frequency tracking error. We derive the thermal noise and the dynamic stress error formula in the LQG-VTL. From frequency tracking error analysis, we can determine control gain matrix in the LQG controller and show that the frequency tracking error of the LQG-VTL is lower than that of the EKF-VTL in all C/N0 ranges. The simulation results show that the LQG-VTL improves performance by 30% in Doppler tracking, so the LQG-VTL can extend pre-integration time longer and track weaker signals than the EKF-VTL. Therefore, the LQG-VTL algorithm is more robust than the EKF-VTL in weak signal environments.

• Journal of the Korean Society for Aeronautical & Space Sciences
• /
• v.44 no.4
• /
• pp.308-315
• /
• 2016

A new technique for Attitude & Heading Reference System (AHRS) by using sequential measurement noise covariance (SMNC) is addressed in a vibration environments in this paper. In particular, a low-cost inertial measurement unit in general diverges in the acceleration phase or vibrating environments due to inherent properties of gravity and acceleration. In this paper, by considering current and prior measurements to estimate actual attitudes and headings in a local frame, the proposed technique overcomes these problems efficiently. Finally, the performance of the suggested approach is verified by numerical simulations.

• Journal of Broadcast Engineering
• /
• v.1 no.2
• /
• pp.176-187
• /
• 1996

This paper deals with the accurate estimation of 3- D pose (position and orientation) of a moving object with reference to the world frame (or robot base frame), based on a sequence of stereo images taken by cameras mounted on the end - effector of a robot manipulator. This work is an extension of the previous work[1]. Emphasis is given to the 3-D pose estimation relative to the world (or robot base) frame under the presence of not only the measurement noise in 2 - D images[ 1] but also the camera position errors due to the random noise involved in joint angles of a robot manipulator. To this end, a new set of discrete linear Kalman filter equations is derived, based on the following: 1) the orientation error of the object frame due to measurement noise in 2 - D images is modeled with reference to the camera frame by analyzing the noise propagation through 3- D reconstruction; 2) an extended Jacobian matrix is formulated by combining the result of 1) and the orientation error of the end-effector frame due to joint angle errors through robot differential kinematics; and 3) the rotational motion of an object, which is nonlinear in nature, is linearized based on quaternions. Motion parameters are computed from the estimated quaternions based on the iterated least-squares method. Simulation results show the significant reduction of estimation errors and also demonstrate an accurate convergence of the actual motion parameters to the true values.

• Journal of Astronomy and Space Sciences
• /
• v.36 no.4
• /
• pp.293-306
• /
• 2019

In this study, the observational arc-length effect on orbit determination (OD) for the Korea Pathfinder Lunar Orbiter (KPLO) in the Earth-Moon Transfer phase was investigated. For the OD, we employed a sequential estimation using the extended Kalman filter and a fixed-point smoother. The mission periods, comprised between the perigee maneuvers (PM) and the lunar orbit insertion (LOI) maneuver in a 3.5 phasing loop of the KPLO, was the primary target. The total period was divided into three phases: launch-PM1, PM1-PM3, and PM3-LOI. The Doppler and range data obtained from three tracking stations [included in the deep space network (DSN) and Korea Deep Space Antenna (KDSA)] were utilized for the OD. Six arc-length cases (24 hrs, 48 hrs, 60 hrs, 3 days, 4 days, and 5 days) were considered for the arc-length effect investigation. In order to evaluate the OD accuracy, we analyzed the position uncertainties, the precision of orbit overlaps, and the position differences between true and estimated trajectories. The maximum performance of 3-day OD approach was observed in the case of stable flight dynamics operations and robust navigation capability. This study provides a guideline for the flight dynamics operations of the KPLO in the trans-lunar phase.

• Journal of information and communication convergence engineering
• /
• v.7 no.2
• /
• pp.119-124
• /
• 2009

In this paper, we propose a novel approach to estimating the real-time moving trajectory of an object is proposed in this paper. The object's position is obtained from the image data of a CCD camera, while a state estimator predicts the linear and angular velocities of the moving object. To overcome the uncertainties and noises residing in the input data, a Extended Kalman Filter(EKF) and neural networks are utilized cooperatively. Since the EKF needs to approximate a nonlinear system into a linear model in order to estimate the states, there still exist errors as well as uncertainties. To resolve this problem, in this approach the Kohonen networks, which have a high adaptability to the memory of the input-output relationship, are utilized for the nonlinear region. In addition to this, the Kohonen network, as a sort of neural network, can effectively adapt to the dynamic variations and become robust against noises. This approach is derived from the observation that the Kohonen network is a type of self-organized map and is spatially oriented, which makes it suitable for determining the trajectories of moving objects. The superiority of the proposed algorithm compared with the EKF is demonstrated through real experiments.

• International Journal of Fuzzy Logic and Intelligent Systems
• /
• v.10 no.2
• /
• pp.101-106
• /
• 2010

We propose an approach to estimate the real-time moving trajectory of an object in this paper. The object's position is obtained from the image data of a CCD camera, while a state estimator predicts the linear and angular velocities of the moving object. To overcome the uncertainties and noises residing in the input data, a Extended Kalman Filter(EKF) and neural networks are utilized cooperatively. Since the EKF needs to approximate a nonlinear system into a linear model in order to estimate the states, there still exist errors as well as uncertainties. To resolve this problem, in this approach the Kohonen networks, which have a high adaptability to the memory of the inputoutput relationship, are utilized for the nonlinear region. In addition to this, the Kohonen network, as a sort of neural network, can effectively adapt to the dynamic variations and become robust against noises. This approach is derived from the observation that the Kohonen network is a type of self-organized map and is spatially oriented, which makes it suitable for determining the trajectories of moving objects. The superiority of the proposed algorithm compared with the EKF is demonstrated through real experiments.

• Transactions of the Korean Society of Automotive Engineers
• /
• v.24 no.4
• /
• pp.408-415
• /
• 2016

The vehicle attitude and sideslip is critical information to control the vehicle to prevent from unintended motion. Many of estimation strategy use bicycle model or IMU integration, but both of them have limits on application. The main purpose of this paper is development of vehicle orientation estimator which is robust to various vehicle state and road shape. The suggested estimator use 3-axis magnetometer, yaw rate sensor and lateral acceleration sensor to estimate three Euler angles of vehicle. The estimator is composed of two individual observers: First, comparing the known magnetic field and gravity with measured value, the TRIAD algorithm calculates optimal rotational matrix when vehicle is in static or quasi-static condition. Next, merging 3-axis magnetometer with inertial sensors, the extended Kalman filter is used to estimate vehicle orientation under dynamic condition. A validation through simulation tools, Carsim and Simulink, is performed and the results show the feasibility of the suggested estimation method.

• Journal of Institute of Control, Robotics and Systems
• /
• v.17 no.5
• /
• pp.429-435
• /
• 2011

This paper presents a sensor fusion-based estimation of heading and a Bezier curve-based motion planning for unmanned ground vehicle. For the vehicle to drive itself autonomously and safely, it should estimate its pose with sufficient accuracy in reasonable processing time. The vehicle should also have a path planning algorithm that enables to adapt to various situations on the road, especially at intersections. First, we address a sensor fusion-based estimation of the heading of the vehicle. Based on extended Kalman filter, the algorithm estimates the heading using the GPS, IMU, and wheel encoders considering the reliability of each sensor measurement. Then, we propose a Bezier curve-based path planner that creates several number of path candidates which are described as Bezier curves with adaptive control points, and selects the best path among them that has the maximum probability of passing through waypoints or arriving at target points. Experiments under various outdoor conditions including at intersections, verify the reliability of our algorithm.