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

A new approach to the straightforward implementation of the unscented filter in a unit quaternion space is proposed for spacecraft attitude estimation. Since the unscented filter is formulated in a vector space and the unit quaternions do not belong to a vector space but lie on a nonlinear manifold, the weighted sum of quaternion samples does not produce a unit quaternion estimate. To overcome this difficulty, a method of weighted mean computation for quaternions is derived in rotational space, leading to a quaternion with unit norm. A quaternion multiplication is used for predicted covariance computation and quaternion update, which makes a quaternion in a filter lie in the unit quaternion space. Since the quaternion process noise increases the uncertainty in attitude orientation, modeling it either as the vector part of a quaternion or as a rotation vector is considered. Simulation results illustrate that the proposed approach successfully estimates spacecraft attitude for large initial errors and high tip-off rates, and modeling the quaternion process noise as a rotation vector is more optimal than handling it as the vector part of a quaternion.

• 한국항공우주학회지
• /
• 제38권7호
• /
• pp.693-701
• /
• 2010

본 논문에서는 스테레오 카메라 시스템을 이용하여 헬멧의 자세 및 위치를 추정하는 알고리즘을 제안한다. 본 논문에서 구축한 시스템은 두 대의 CCD카메라와 헬멧 그리고 적외선 LED, 영상편집 보드로 구성된다. 이 중 15개의 적외선 LED는 헬멧에 서로 다른 길이로 삼각형 패턴으로 고정되어, 헬멧의 자세 및 위치를 결정하기 위한 특징점이 된다. 본 논문에서 제안한 알고리즘은 특징점 추출, 투영 재구성, 모델 인덱싱 과정으로 구성되며, 단위 쿼터니언(UQ, Unit Quaternion)을 이용하여 자세 및 위치를 추정한다. UQ를 이용하여 회전행렬를 구하면, 회전 행렬이 유니터리 행렬(Unitary Matrix)이 되는 것을 보장할 수 있다. 제안된 알고리즘은 시뮬레이션과 실제 실험 데이터를 이용하여 그 성능을 검증하였다.

• International Journal of Aeronautical and Space Sciences
• /
• 제12권1호
• /
• pp.24-36
• /
• 2011

A new approach for spacecraft absolute attitude estimation based on the unscented Kalman filter (UKF) is extended to relative attitude estimation and navigation. This approach for nonlinear systems has faster convergence than the approach based on the standard extended Kalman filter (EKF) even with inaccurate initial conditions in attitude estimation and navigation problems. The filter formulation employs measurements obtained from a vision sensor to provide multiple line(-) of(-) sight vectors from the spacecraft to another spacecraft. The line-of-sight measurements are coupled with gyro measurements and dynamic models in an UKF to determine relative attitude, position and gyro biases. A vector of generalized Rodrigues parameters is used to represent the local error-quaternion between two spacecraft. A multiplicative quaternion-error approach is derived from the local error-quaternion, which guarantees the maintenance of quaternion unit constraint in the filter. The scenario for bounded relative motion is selected to verify this extended application of the UKF. Simulation results show that the UKF is more robust than the EKF under realistic initial attitude and navigation error conditions.

• 제어로봇시스템학회논문지
• /
• 제19권10호
• /
• pp.941-946
• /
• 2013

In this paper, an enhanced method for attitude determination is proposed for systems using an IMU (Inertial Measurement Unit). In attitude determination with IMU, it is generally assumed that the IMU can be located in the center of gravity on the vehicle. If the IMU is not located in the center of gravity, the accelerometers of the IMU are disturbed from additive accelerations such as centripetal acceleration and tangential acceleration. Additive accelerations are derived from the lever arm which is the distance between the center of gravity and the position of the IMU. The performance of estimation errors can be maintained in system with a non-zero lever arm, if the lever arm is estimated to remove the additive accelerations from the accelerometer's measurements. In this paper, an estimation using Kalman filter is proposed to include the lever arm in the state variables of the state space equation. For the Kalman filter, the process model and the measurement model for attitude determination are made up by using quaternion. In order to evaluate the proposed algorithm, both of the simulations and the experiments are performed for the simplified scenario of motion.

• 대한수학회지
• /
• 제44권6호
• /
• pp.1313-1327
• /
• 2007

We review the algebraic structure of $\mathbb{H}{\sharp}$ and show that $\mathbb{H}{\sharp}$ has a scalar product that allows as to identify it with semi Euclidean ${\mathbb{E}}^4_2$. We show that a pair q and p of unit split quaternions in $\mathbb{H}{\sharp}$ determines a rotation $R_{qp}:\mathbb{H}{\sharp}{\rightarrow}\mathbb{H}{\sharp}$. Moreover, we prove that $R_{qp}$ is a product of rotations in a pair of orthogonal planes in ${\mathbb{E}}^4_2$. To do that we call upon one tool from the theory of second ordinary differential equations.

• 센서학회지
• /
• 제28권2호
• /
• pp.81-87
• /
• 2019

One of the major issues in inertial and magnetic measurement unit (IMMU)-based 3D orientation estimation is compensation for magnetic disturbances in magnetometer signals, as the magnetic disturbance is a major cause of inaccurate yaw estimation. In the proposed approach, a kinematic constraint is used to provide a measurement equation in addition to the accelerometer and magnetometer signals to mitigate the disturbance effect on the orientation estimation. Although a Kalman filter (KF) is the most popular framework for IMMU-based orientation estimation, a complementary filter (CF) has its own advantages over KF in terms of mathematical simplicity and ease of implementation. Accordingly, this paper introduces a quaternion-based CF with a constraint-combined correction equation. Furthermore, the weight of the constraint relative to the magnetometer signal is adjusted to adapt to magnetic environments to optimally deal with the magnetic disturbance. In the results of our validation experiments, the average and maximum of yaw errors were $1.17^{\circ}$ and $1.65^{\circ}$ from the proposed CF, respectively, and $8.88^{\circ}$ and $14.73^{\circ}$ from the conventional CF, respectively, showing the superiority of the proposed approach.