• 한국군사과학기술학회지
• /
• 제17권4호
• /
• pp.537-543
• /
• 2014

RLG(Ring Laser Gyroscope) is a main device of LINS(Laser Inertial Navigation System). RLG has the lock-in region in which there is no output signal. To alleviate the lock-in problem, a mechanical oscillation, the dither motion, is applied on RLG. A LPF(Low Pass Filter) is usually used on the output of RLG and accelerometer to remove the noise that is made by the dither motion. When the LINS is induced the disturbance during the initial alignment, it takes more time on alignment due to the use of the LPF and a fixed gain controller. In this paper, an initial alignment using UKF(Unscented Kalman Filter) is designed and analysed. Analysis include comparison between conventional initial alignment loop using fixed gain type controller and proposed initial alignment using UKF. Moreover, Disturbance inducing test results are demonstrated.

• 한국해양공학회지
• /
• 제17권6호
• /
• pp.83-90
• /
• 2003

This paper presents an underwater hybrid navigation system for a semi-autonomous underwater vehicle (SAUV). The navigation system consists of an inertial measurement unit (IMU), and a Doppler velocity log (DVL), accompanied by a magnetic compass. The errors of inertial measurement units increase with time, due to the bias errors of gyros and accelerometers. A navigational system model is derived, to include the scale effect and bias errors of the DVL, of which the state equation composed of the navigation states and sensor parameters is 20. The conventional extended Kalman filter was used to propagate the error covariance, update the measurement errors, and correct the state equation when the measurements are available. Simulation was performed with the 6-d.o,f equations of motion of SAUV, using a lawn-mowing survey mode. The hybrid underwater navigation system shows good tracking performance, by updating the error covariance and correcting the system's states with the measurement errors from a DVL, a magnetic compass, and a depth sensor. The error of the estimated position still slowly drifts in the horizontal plane, about 3.5m for 500 seconds, which could be eliminated with the help of additional USBL information.

• 제어로봇시스템학회논문지
• /
• 제19권8호
• /
• pp.702-708
• /
• 2013

Underwater TRN (Underwater Terrain Referenced Navigation) estimates an underwater vehicle state by measuring a distance between the vehicle and undersea terrain, and comparing it with the known terrain database. TRN belongs to absolute navigation methods, which are used to compensate a drift error of dead reckoning measurements such as IMU (Inertial Measurement Unit) or DVL (Doppler Velocity Log). However, underwater TRN is different to other absolute methods such as USBL (Ultra-Short Baseline) and LBL (Long Baseline), because TRN is independent of the external environment. As a magnetic-field-based navigation, TRN is a kind of geophysical navigation. This paper develops an EKF (Extended Kalman Filter) formulation for underwater TRN. A filter propagation part is composed by an inertial navigation system, and a filter update is executed with echo-sounder measurement. For large-initial-error cases, an adaptive EKF approach is also presented, to keep the filter be stable. At the end, simulation studies are given to verify the performance of the proposed TRN filter. With simplified sensor and terrain database models, the simulation results show that the underwater TRN could support conventional underwater navigation methods.

• 대한의용생체공학회:의공학회지
• /
• 제32권2호
• /
• pp.118-126
• /
• 2011

This study proposes a human body orientation tracking system by inertial and earth magnetic sensors. These sensors were fused by indirect Kalman filter. The proposed tracking system was configured and the filter was implemented. The tracking performance was evaluated with static and dynamic tests. In static test, the sensor was fixed on the floor while its static characteristics was analyzed. In dynamic test, the sensor was held and moved manually for 30 seconds. The dynamic test included x, y, z axis rotations, and elbow flection/extension motions that mimic drinking. For these dynamic motions, the tracking angle error was under $4.1^{\circ}$ on average. The proposed tracking method is expected to be useful for various human body motion analysis.

• 제어로봇시스템학회:학술대회논문집
• /
• 제어로봇시스템학회 2005년도 ICCAS
• /
• pp.1450-1455
• /
• 2005

This paper describes a DR construction for land navigation and the sigma point based receding horizon Kalman FIR (SPRHKF) filter for DR/GPS hybrid navigation system. A simple DR construction is adopted to improve the performance both of the pure land DR navigation and the DR/GSP hybrid navigation system. In order to overcome the flaws of the EKF, the SPKF is merged with the receding horizon strategy. This filter has several advantages over the EKF, the SPKF, and the RHKF filter. The advantages include the robustness to the system model uncertainty, the initial estimation error, temporary unknown bias, and etc. The computational burden is reduced. Especially, the proposed filter works well even in the case of exiting the unmodeled random walk of the inertial sensors, which can be occurred in the MEMS inertial sensors by temperature variation. Therefore, the SPRHKF filter can provide the navigation information with good quality in the DR/GPS hybrid navigation system for land navigation seamlessly.

• 제어로봇시스템학회:학술대회논문집
• /
• 제어로봇시스템학회 2003년도 ICCAS
• /
• pp.2594-2599
• /
• 2003

We consider some problems of the Modified SPRT(Sequential Probability Ratio Test) method for fault detection and isolation of inertial redundant sensor systems and propose an Advanced SPRT method to solve the problems of the Modified SPRT method. One problem of the Modified SPRT method to apply to inertial sensor system comes from the effect of inertial sensor errors such as misalignment, scale factor error and sensor bias in the parity vector, which make the Modified SPRT method hard to be applicable. The other problem is due to the correlation of parity vector components which may induce false alarm. We use a two-stage Kalman filter to remove effects of the inertial sensor errors and propose the modified parity vector and the controlled parity vector which removes the effect of correlation of parity vector components. The Advanced SPRT method is derived form the modified parity vector and the controlled parity vector. Some simulation results are presented to show the usefulness of the Advanced SPRT method to redundant inertial sensor systems.

• 제어로봇시스템학회논문지
• /
• 제14권2호
• /
• pp.133-140
• /
• 2008

In this paper, a small and effective attitude estimation system for a humanoid robot was developed. Four small inertial sensors were packed and used for inertial measurements(3D accelerometer and three 1D gyroscopes.) An effective 3D pose estimation algorithm for low cost DSP using an extended Kalman filter was developed and evaluated. The 3D pose estimation algorithm has a very simple structure composed by 3 modules of a linear acceleration estimator, an external acceleration detector and an pseudo-accelerometer output estimator. The algorithm also has an effective switching structure based on probability and simple feedback loop for the extended Kalman filter. A special test equipment using linear motor for the testing of the 3D pose sensor was developed and the experimental results showed its very fast convergence to real values and effective responses. Popular DSP of TMS320F2812 was used to calculate robot's 3D attitude and translated acceleration, and the whole system were packed in a small size for humanoids robots. The output of the 3D sensors(pitch, roll, 3D linear acceleration, and 3D angular rate) can be transmitted to a humanoid robot at 200Hz frequency.

• Journal of Positioning, Navigation, and Timing
• /
• 제6권4호
• /
• pp.167-179
• /
• 2017

In this paper, a simplified Cubature Kalman Filter (SCKF) is proposed to reduce the computation load of CKF, which is then used as a filter for transfer alignment of shipboard INS. CKF is an approximate Bayesian filter that can be applied to non-linear systems. When an initial estimation error is large, convergence characteristic of the CKF is more stable than that of the Extended Kalman Filter (EKF), and the reliability of the filter operation is more ensured than that of the Unscented Kalman Filter (UKF). However, when a system degree is large, the computation amount of CKF is also increased significantly, becoming a burden on real-time implementation in embedded systems. A simplified CKF is proposed to address this problem. This filter is applied to shipboard inertial navigation system (INS) transfer alignment. In the filter design for transfer alignment, measurement type and measurement update rate should be determined first, and if an application target is a ship, lever-arm problem, flexure of the hull, and asynchronous time problem between Master Inertial Navigation System (MINS) and Slave Inertial Navigation System (SINS) should be taken into consideration. In this paper, a transfer alignment filter based on SCKF is designed by considering these problems, and its performance is validated based on simulations.

• 제어로봇시스템학회논문지
• /
• 제7권11호
• /
• pp.944-952
• /
• 2001

Inertial navigation system(INS) errors increase with time due to inertial sensor errors, and therefore it is desired to combine INS with external aids such as GPS. However GPS informations have a randomly abrupt jump due to a sudden corruption of the received satellite signals and environment, and moreover GPS can\`t provide navigation solutions. In this paper, smoothing and prediction schemes are proposed for GPS`s jump or unavailable GPS. The smoothing algorithm which is designed as a scalar adaptive filter, smooths abrupt jump. The prediction algorithm which is proved by Schuler error model of INS, estimates INS error in appropriate time. The outputs of proposed algorithm apply stable measurements to GPS aided INS Kalman filter. Simulations show that the proposed algorithm can effectively remove measurement jump and predict INS error.

• 한국항행학회논문지
• /
• 제11권2호
• /
• pp.146-153
• /
• 2007

무인자동차는 스스로 목적지와 경유지를 찾아서 항행할 수 있는 이동체이다. 이러한 항행의 성능을 보다 정밀하게 향상시키기 위하여 본 논문에서는 관성항법과 GPS를 융합한 확장형 칼만필터를 적용한 보정 알고리즘을 개발하였다. 확장형 칼만필터의 성능을 검증하기 위하여 무인자동차의 실차실험을 실시하고 그 결과로서 필터의 효율성을 확인하였다.