• 제목/요약/키워드: quaternion constraint

검색결과 6건 처리시간 0.021초

고른 필터를 이용한 인공위성의 자세 추정 (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.

A Comparison Study of Real-Time Solution to All- Attitude Angles of an Aircraft

  • Shin Sung-Sik;Lee Jung-Hoon;Yoon Sug-Joon
    • Journal of Mechanical Science and Technology
    • /
    • 제20권3호
    • /
    • pp.376-381
    • /
    • 2006
  • In this paper, the quaternion, the dual Euler, and the direction cosine methods are numerically compared using a non-aerodynamic 6 degree-of-freedom rigid model at all-attitude angles of an aircraft. The dual Euler method turns out to be superior to the others in the applications because it shows better numerical accuracy, stability, and robustness in integration step sizes. The dual Euler method is affordably less efficient than the quaternion method in terms of computational cost. Numerical accuracy and stability, which allow larger integration step sizes, are more critical in modern real-time applications than computational efficiency because of today's increased computational power. If the quaternion method is required because of constraints in computation time, then a suppression mechanism should be provided for algebraic constraint errors which will eventually add computational burden.

Vision-Based Relative State Estimation Using the Unscented Kalman Filter

  • Lee, Dae-Ro;Pernicka, Henry
    • 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.

Modified Rodrigues Parameter 기반의 인공위성 관성모멘트 추정 연구 (Spacecraft Moment of Inertial Estimation by Modified Rodrigues Parameters)

  • 방효충
    • 한국항공우주학회지
    • /
    • 제38권3호
    • /
    • pp.243-248
    • /
    • 2010
  • 본 연구에서는 인공위성의 관성 모멘트 추정을 위해 MRP(Modified Rodrigues Parameter) 자세 변수기반의 추정기를 설계하였다. MRP는 인공위성 자세 결정시 쿼터니 언(Quaternion) 파라미터의 구속 조건으로부터 발생하는 필터의 오차 공분산 행렬의 특이(Singularity) 현상을 피할 수 있는 장점이 있다. 한편 MRP의 경우 자세각 변위가 클 경우에 역시 특이현상이 발생할 수 있어 이를 피하기 위해 적절한 자세각 범위에서 인위적인 기준 운동을 생성하여 필터 설계에 적용하였다. 쿼터니언 파라미터의 단점을 극복하여 보다 안정된 오차 공분산 갱신 결과의 필터의 개선된 성능을 예상할 수 있다.

Constraint-Combined Adaptive Complementary Filter for Accurate Yaw Estimation in Magnetically Disturbed Environments

  • Jung, Woo Chang;Lee, Jung Keun
    • 센서학회지
    • /
    • 제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.

Dynamic Control Allocation for Shaping Spacecraft Attitude Control Command

  • Choi, Yoon-Hyuk;Bang, Hyo-Choong
    • International Journal of Aeronautical and Space Sciences
    • /
    • 제8권1호
    • /
    • pp.10-20
    • /
    • 2007
  • For spacecraft attitude control, reaction wheel (RW) steering laws with more than three wheels for three-axis attitude control can be derived by using a control allocation (CA) approach.1-2 The CA technique deals with a problem of distributing a given control demand to available sets of actuators.3-4 There are many references for CA with applications to aerospace systems. For spacecraft, the control torque command for three body-fixed reference frames can be constructed by a combination of multiple wheels, usually four-wheel pyramid sets. Multi-wheel configurations can be exploited to satisfy a body-axis control torque requirement while satisfying objectives such as minimum control energy.1-2 In general, the reaction wheel steering laws determine required torque command for each wheel in the form of matrix pseudo-inverse. In general, the attitude control command is generated in the form of a feedback control. The spacecraft body angular rate measured by gyros is used to estimate angular displacement also.⁵ Combination of the body angular rate and attitude parameters such as quaternion and MRPs(Modified Rodrigues Parameters) is typically used in synthesizing the control command which should be produced by RWs.¹ The attitude sensor signals are usually corrupted by noise; gyros tend to contain errors such as drift and random noise. The attitude determination system can estimate such errors, and provide best true signals for feedback control.⁶ Even if the attitude determination system, for instance, sophisticated algorithm such as the EKF(Extended Kalman Filter) algorithm⁶, can eliminate the errors efficiently, it is quite probable that the control command still contains noise sources. The noise and/or other high frequency components in the control command would cause the wheel speed to change in an undesirable manner. The closed-loop system, governed by the feedback control law, is also directly affected by the noise due to imperfect sensor characteristics. The noise components in the sensor signal should be mitigated so that the control command is isolated from the noise effect. This can be done by adding a filter to the sensor output or preventing rapid change in the control command. Dynamic control allocation(DCA), recently studied by Härkegård, is to distribute the control command in the sense of dynamics⁴: the allocation is made over a certain time interval, not a fixed time instant. The dynamic behavior of the control command is taken into account in the course of distributing the control command. Not only the control command requirement, but also variation of the control command over a sampling interval is included in the performance criterion to be optimized. The result is a control command in the form of a finite difference equation over the given time interval.⁴ It results in a filter dynamics by taking the previous control command into account for the synthesis of current control command. Stability of the proposed dynamic control allocation (CA) approach was proved to ensure the control command is bounded at the steady-state. In this study, we extended the results presented in Ref. 4 by adding a two-step dynamic CA term in deriving the control allocation law. Also, the strict equality constraint, between the virtual and actual control inputs, is relaxed in order to construct control command with a smooth profile. The proposed DCA technique is applied to a spacecraft attitude control problem. The sensor noise and/or irregular signals, which are existent in most of spacecraft attitude sensors, can be handled effectively by the proposed approach.