• Title/Summary/Keyword: attitude quaternion

Search Result 67, Processing Time 0.024 seconds

Development of an Initial Coarse Alignment Algorithm for Strapdown Inertial Navigation System (스트랩다운 관성항법시스템의 초기 개략정렬 알고리즘 개발)

  • 박찬국;김광진;박흥원;이장규
    • Journal of Institute of Control, Robotics and Systems
    • /
    • v.4 no.5
    • /
    • pp.674-679
    • /
    • 1998
  • In this paper, a new coarse alignment algorithm is proposed for roughly determining the initial attitude of the vehicle. The algorithm, referred as two-step coarse alignment algorithm, computes roll and pitch angle of the vehicle using accelerometer outputs, and then determines yaw angle with gyro outputs. With the geometric relation between sensor outputs and attitude angles, the algorithm error is analytically derived and compared with the previous coarse alignment algorithm that computes a transformation matrix using accelerometer md gyro outputs simultaneously. The simulation is also performed by varying the sensor errors. The results show that the proposed two-step coarse alignment algorithm has better performance for east tilt angle.

  • PDF

Optimal strapdown coning compensation algorithm (최적 스트랩다운 원추 보상 알고리듬)

  • Park, Chan-Gook;Kim, Kwang-Jin;Lee, Jang-Gyu
    • Journal of Institute of Control, Robotics and Systems
    • /
    • v.2 no.3
    • /
    • pp.242-247
    • /
    • 1996
  • In this paper, an optimal coning compensation algorithm for strapdown system is proposed by minimizing the coning error. The proposed algorithm is derived as a generalized form in that it contains the class of the existing coning algorithms and allows the design of optimal algorithm for various combinations of gyro samples. It is shown the magnitude of resulting algorithm errors depends mainly on the total number of gyro samples including present and previous gyro samples. Based on the results, the proposed algorithm enables the algorithm designers to develop the effective coning compensation algorithm according to their attitude computation specifications with ease. In addition, the multirate method which can efficiently implement the algorithm is presented.

  • PDF

A Robust Extended Filter Design for SDINS In-Flight Alignment

  • Yu, Myeong-Jong;Lee, Sang-Woo
    • International Journal of Control, Automation, and Systems
    • /
    • v.1 no.4
    • /
    • pp.520-526
    • /
    • 2003
  • In the case of a strapdown inertial navigation system (SDINS) with sizeable attitude errors, the uncertainty caused by linearization of the system degrades the performance of the filter. In this paper, a robust filter and various error models for the uncertainty are presented. The analytical characteristics of the proposed filter are also investigated. The results show that the filter does not require the statistical property of the system disturbance and that the region of the estimation error depends on a freedom parameter in the worst case. Then, the uncertainty of the SDINS is derived. Depending on the choice of the reference frame and the attitude error state, several error models are presented. Finally, various in-flight alignment methods are proposed by combining the robust filter with the error models. Simulation results demonstrate that the proposed filter effectively improves the performance.

Unscented KALMAN Filtering for Spacecraft Attitude and Rate Determination Using Magnetometer

  • Kim, Sung-Woo;Abdelrahman, Mohammad;Park, Sang-Young;Choi, Kyu-Hong
    • Journal of Astronomy and Space Sciences
    • /
    • v.26 no.1
    • /
    • pp.31-46
    • /
    • 2009
  • An Unscented Kalman Filter (UKF) for estimation of the attitude and rate of a spacecraft using only magnetometer vector measurement is developed. The attitude dynamics used in the estimation is the nonlinear Euler's rotational equation which is augmented with the quaternion kinematics to construct a process model. The filter is designed for small satellite in low Earth orbit, so the disturbance torques include gravity-gradient torque, magnetic disturbance torque, and aerodynamic drag torque. The magnetometer measurements are simulated based on time-varying position of the spacecraft. The filter has been tested not only in the standby mode but also in the detumbling mode. Two types of actuators have been modeled and applied in the simulation. The PD controller is used for the two types of actuators (reaction wheels and thrusters) to detumble the spacecraft. The estimation error converged to within 5 deg for attitude and 0.1 deg/s for rate respectively when the two types of actuators were used. A joint state parameter estimation has been tested and the effect of the process noise covariance on the parameter estimation has been indicated. Also, Monte-Carlo simulations have been performed to test the capability of the filter to converge with the initial conditions sampled from a uniform distribution. Finally, the UKF performance has been compared to that of the EKF and it demonstrates that UKF slightly outperforms EKF. The developed algorithm can be applied to any type of small satellites that are actuated by magnetic torquers, reaction wheels or thrusters with a capability of magnetometer vector measurements for attitude and rate estimation.

Integrated System for Autonomous Proximity Operations and Docking

  • Lee, Dae-Ro;Pernicka, Henry
    • International Journal of Aeronautical and Space Sciences
    • /
    • v.12 no.1
    • /
    • pp.43-56
    • /
    • 2011
  • An integrated system composed of guidance, navigation and control (GNC) system for autonomous proximity operations and the docking of two spacecraft was developed. The position maneuvers were determined through the integration of the state-dependent Riccati equation formulated from nonlinear relative motion dynamics and relative navigation using rendezvous laser vision (Lidar) and a vision sensor system. In the vision sensor system, a switch between sensors was made along the approach phase in order to provide continuously effective navigation. As an extension of the rendezvous laser vision system, an automated terminal guidance scheme based on the Clohessy-Wiltshire state transition matrix was used to formulate a "V-bar hopping approach" reference trajectory. A proximity operations strategy was then adapted from the approach strategy used with the automated transfer vehicle. The attitude maneuvers, determined from a linear quadratic Gaussian-type control including quaternion based attitude estimation using star trackers or a vision sensor system, provided precise attitude control and robustness under uncertainties in the moments of inertia and external disturbances. These functions were then integrated into an autonomous GNC system that can perform proximity operations and meet all conditions for successful docking. A six-degree of freedom simulation was used to demonstrate the effectiveness of the integrated system.

Unscented Kalman Filtering for Spacecraft Attitude and Rate Determination Using Magnetometer

  • Kim, Sung-Woo;Park, Sang-Young;Abdelrahman, Mohammad;Choi, Kyu-Hong
    • Bulletin of the Korean Space Science Society
    • /
    • 2008.10a
    • /
    • pp.36.1-36.1
    • /
    • 2008
  • An Unscented Kalman Filter(UKF) for estimation of attitude and rate of a spacecraft using only magnetometer vector measurement is presented. The dynamics used in the filter is nonlinear rotational equation which is augmented by the quaternion kinematics to construct a process model. The filter is designed for low Earth orbit satellite, so the disturbance torques include gravity-gradient torque, magnetic disturbance torque, and aerodynamic drag. The magnetometer measurements are simulated based on time-varying position of the spacecraft. The filter has been tested not only in the standby mode but also in the detumbling mode. To stabilize the attitude, linear PD controller is applied and the actuator is assumed to be thruster. A Monte-Carlo simulation has been done to guarantee the stability of the filter performance to the various initial conditions. The UKF performance is compared to that of EKF and it reveals that UKF outperforms EKF.

  • PDF

Design of AHRS using Low-Cost MEMS IMU Sensor and Multiple Filters (저가형 MEMS IMU센서와 다중필터를 활용한 AHRS 설계)

  • Jang, Woojin;Park, Chansik
    • Asia-pacific Journal of Multimedia Services Convergent with Art, Humanities, and Sociology
    • /
    • v.7 no.1
    • /
    • pp.177-186
    • /
    • 2017
  • Recently, Autonomous vehicles are getting hot attention. Amazon, the biggest online shopping service provider is developing a delivery system that uses drones. This kinds of platforms are need accurate attitude information for navigation. In this paper, a structure design of AHRS using low-cost inertia sensor is proposed. To estimate attitudes a Kalman filter which uses a quaternion based dynamic model, bias-removed measurements from MEMS Gyro, raw measurements from MEMS accelerometer and magnetometer, is designed. To remove bias from MEMS Gyro, an additional Kalman filter which uses raw Gyro measurements and attitude estimates, is designed. The performance of implemented AHRS is compared with high price off-the-shelf 3DM-GX3-25 AHRS from Microstrain. The Gyro bias was estimated within 0.0001[deg/s]. And from the estimated attitude, roll and pitch angle error is smaller than 0.2 and 0.3 degree. Yaw angle error is smaller than 6 degree.

Recognition of Basic Motions for Figure Skating using AHRS (AHRS를 이용한 피겨스케이팅 기본 동작 인식)

  • Kwon, Ki-Hyeon;Lee, Hyung-Bong
    • Journal of the Korea Society of Computer and Information
    • /
    • v.20 no.3
    • /
    • pp.89-96
    • /
    • 2015
  • IT is widely used for biomechanics and AHRS sensor also be highlighted with small sized characteristics and price competitiveness in the field of motion measurement and analysis of sports. In this paper, we attach the AHRS to the figure skate shoes to measure the motion data like spin, forward/backward, jump, in/out edge and toe movement. In order to reduce the measurement error, we have adopted the sensors equipped with Madgwick complementary filtering and also use Euler angle to quaternion conversion to reduce the Gimbal-lock effect. We test and experiment the accuracy and execution time of the pattern recognition algorithms like PCA, ICA, LDA, SVM to show the recognition possibility of it on the basic motions of figure skating from the 9-axis trajectory information which is gathered from AHRS sensor. From the result, PCA, ICA have low accuracy, but LDA, SVM have good accuracy to use for recognition of basic motions of figure skating.

Extended Kalman Filtering for I.M.U. using MEMs Sensors (반도체 센서의 확장칼만필터를 이용한 자세추정)

  • Jeon, Yong-Ho
    • The Journal of the Korea institute of electronic communication sciences
    • /
    • v.10 no.4
    • /
    • pp.469-475
    • /
    • 2015
  • This paper describes about the method for designing an extended Kalman filter to accurately measure the position of the spatial-phase system using a semiconductor sensor. Spatial position is expressed by the correlation of the rotated coordinate system attached to the body from the inertia coordinate system (a fixed coordinate system). To express the attitude, quaternion was adapted as a state variable, Then, the state changes were estimated from the input value which was measured in the gyro sensor. The observed data is the value obtained from the acceleration sensor. By matching between the measured value in the acceleration sensor and the predicted calculation value, the best variable was obtained. To increase the accuracy of estimation, designation of the extended Kalman filter was performed, which showed excellent ability to adjust the estimation period relative to the sensor property. As a result, when a three-axis gyro sensor and a three-axis acceleration sensor were adapted in the estimator, the RMS(Root Mean Square) estimation error in simulation was retained less than 1.7[$^{\circ}$], and the estimator displayed good property on the prediction of the state in 100 ms measurement period.

Robust Slewing Control of A Flexible Space Structure using Sliding Surface (슬라이딩 평면을 이용한 유연우주비행체의 강인 선회제어)

  • Kim, Jin Hyeong;Hong, Chang Ho;Seok, Jin Yeong;Bang, Hyo Chung
    • Journal of the Korean Society for Aeronautical & Space Sciences
    • /
    • v.31 no.2
    • /
    • pp.63-71
    • /
    • 2003
  • This paper presents a robust slewing control of a flexible space structure based on sliding surface design. A sliding surface is designed for a single-axis rest-to-rest slewing in view of target angle, target angular velocity, and root monent of the flexible appendage. In comparison with the Lypunov control law, both controllers guarantee the stability and command tracking capabilities for nominal system. It is also shown that the designed control law provides further robustness to internal/external uncertainties. Extending the results of a single-axis maneuver, a sliding mode control law was sought for an arbitrary three-axis maneuver. Quaternion was used to determine the attitude of a space structure and sliding surfaces were designed for each axis, thereby a robust control law was derived considering the coupling effects between each rotational axis during the maneuver. Several numerical examples were demonstrated to show the effectiveness of the designed control law.