Calibration of Inertial Measurement Units Using Pendulum Motion

Similar documents
Inertial Navigation Systems

Satellite and Inertial Navigation and Positioning System

Autonomous Navigation for Flying Robots

Testing the Possibilities of Using IMUs with Different Types of Movements

CHARACTERIZATION AND CALIBRATION OF MEMS INERTIAL MEASUREMENT UNITS

Strapdown Inertial Navigation Technology, Second Edition D. H. Titterton J. L. Weston

INTEGRATED TECH FOR INDUSTRIAL POSITIONING

Strapdown Inertial Navigation Technology

ADVANTAGES OF INS CONTROL SYSTEMS

Navigational Aids 1 st Semester/2007/TF 7:30 PM -9:00 PM

Strapdown inertial navigation technology

Performance Evaluation of INS Based MEMES Inertial Measurement Unit

Strapdown Inertial Navigation Technology. Second Edition. Volume 207 PROGRESS IN ASTRONAUTICS AND AERONAUTICS

E80. Experimental Engineering. Lecture 9 Inertial Measurement

Quaternion Kalman Filter Design Based on MEMS Sensors

navigation Isaac Skog

ROTATING IMU FOR PEDESTRIAN NAVIGATION

Line of Sight Stabilization Primer Table of Contents

Introduction to Inertial Navigation (INS tutorial short)

MULTI-SENSOR DATA FUSION FOR LAND VEHICLE ATTITUDE ESTIMATION USING A FUZZY EXPERT SYSTEM

Satellite/Inertial Navigation and Positioning System (SINAPS)

Acceleration Data Correction of an Inertial Navigation Unit Using Turntable Test Bed

An Intro to Gyros. FTC Team #6832. Science and Engineering Magnet - Dallas ISD

An Alternative Gyroscope Calibration Methodology

GPS + Inertial Sensor Fusion

This was written by a designer of inertial guidance machines, & is correct. **********************************************************************

The Performance Evaluation of the Integration of Inertial Navigation System and Global Navigation Satellite System with Analytic Constraints

TEST RESULTS OF A GPS/INERTIAL NAVIGATION SYSTEM USING A LOW COST MEMS IMU

Estimation of Altitude and Vertical Velocity for Multirotor Aerial Vehicle using Kalman Filter

Inertial Navigation Static Calibration

Camera Drones Lecture 2 Control and Sensors

Inertial Measurement Units I!

Development of a MEMs-Based IMU Unit

Satellite Attitude Determination

Strapdown system technology

Testing Approaches for Characterization and Selection of MEMS Inertial Sensors 2016, 2016, ACUTRONIC 1

State Estimation and Parameter Identification of Flexible Manipulators Based on Visual Sensor and Virtual Joint Model

13. Learning Ballistic Movementsof a Robot Arm 212

Real Time Implementation of a Low-Cost INS/GPS System Using xpc Target

Use of Image aided Navigation for UAV Navigation and Target Geolocation in Urban and GPS denied Environments

Orientation Capture of a Walker s Leg Using Inexpensive Inertial Sensors with Optimized Complementary Filter Design

EE 570: Location and Navigation: Theory & Practice

Indoor navigation using smartphones. Chris Hide IESSG, University of Nottingham, UK

SIMA Raw Data Simulation Software for the Development and Validation of Algorithms. Platforms

Modeling, Parameter Estimation, and Navigation of Indoor Quadrotor Robots

LPMS-B Reference Manual

Inertial Systems. Ekinox Series TACTICAL GRADE MEMS. Motion Sensing & Navigation IMU AHRS MRU INS VG

Error Simulation and Multi-Sensor Data Fusion

Accelerometer-based Orientation Sensing for Head Tracking in AR & Robotics

Introduction to Inertial Navigation and Kalman filtering

Selection and Integration of Sensors Alex Spitzer 11/23/14

Unscented Kalman Filtering for Attitude Determination Using MEMS Sensors

Development of a Ground Based Cooperating Spacecraft Testbed for Research and Education

Dynamic Modelling for MEMS-IMU/Magnetometer Integrated Attitude and Heading Reference System

LPMS-B Reference Manual

Inertial Measurement Units II!

Redundancy Resolution by Minimization of Joint Disturbance Torque for Independent Joint Controlled Kinematically Redundant Manipulators

Review Paper: Inertial Measurement

FAB verses tradition camera-based motion capture systems

Inflight Alignment Simulation using Matlab Simulink

EXPERIMENTAL COMPARISON BETWEEN MAHONEY AND COMPLEMENTARY SENSOR FUSION ALGORITHM FOR ATTITUDE DETERMINATION BY RAW SENSOR DATA OF XSENS IMU ON BUOY

The Applanix Approach to GPS/INS Integration

4INERTIAL NAVIGATION CHAPTER 20. INTRODUCTION TO INERTIAL NAVIGATION...333

Exterior Orientation Parameters

TEPZZ 85 9Z_A_T EP A1 (19) (11) EP A1 (12) EUROPEAN PATENT APPLICATION

COMPARISON OF TWO FINITE ELEMENT MODELS OF BRISTLES OF GUTTER BRUSHES FOR STREET SWEEPING

Inertial Measurement for planetary exploration: Accelerometers and Gyros

COARSE LEVELING OF INS ATTITUDE UNDER DYNAMIC TRAJECTORY CONDITIONS. Paul G. Savage Strapdown Associates, Inc.

DYNAMIC POSITIONING CONFERENCE September 16-17, Sensors

Inertial Measurement Unit (IMU) ISIS-IMU (Rev. C)

An IMU-based Wearable Presentation Pointing Device

COMPARISON OF TWO STATIC CALIBRATION METHODS OF AN INERTIAL MEASUREMENT UNIT

AMG Series. Motorized Position and Rate Gimbals. Continuous 360 rotation of azimuth and elevation including built-in slip ring

Automated Parameterization of the Joint Space Dynamics of a Robotic Arm. Josh Petersen

Proceedings of the 2013 SpaceVision Conference November 7-10 th, Tempe, AZ, USA ABSTRACT

Motion Capture & Simulation

VELOCITY OPTIMIZATION METHOD OF X-BAND ANTTENA FOR JTTER ATTENUATION

Preliminary Results with a Low-Cost Fiber-Optic Gyrocompass System

RESEARCH ON THE APPLICATION OF STABLE ATTITUDE ALGORITHM BASED ON DATA FUSION OF MULTI- DIMENSIONAL MEMS INERTIAL SENSORS

3D Motion Tracking by Inertial and Magnetic sensors with or without GPS

HG4930 INERTIAL MEASUREMENT UNIT (IMU) Installation and Interface Manual

INERTIAL NAVIGATION SYSTEM DEVELOPED FOR MEMS APPLICATIONS

Research Article An Intuitive Approach to Inertial Sensor Bias Estimation

Low Cost solution for Pose Estimation of Quadrotor

Sensor Integration and Image Georeferencing for Airborne 3D Mapping Applications

Application of FOG for seismic measurements. Alex Velikoseltsev

Electronics Design Contest 2016 Wearable Controller VLSI Category Participant guidance

CHAPTER 2 SENSOR DATA SIMULATION: A KINEMATIC APPROACH

LOW COST 3D LOCALIZATION SYSTEM FOR APPLICATIONS ON AERIAL ROBOTS

EE565:Mobile Robotics Lecture 2

GNSS-aided INS for land vehicle positioning and navigation

ASSESSING DISABILITY USING SMARTPHONE. Wisconsin, Milwaukee, WI

Electronic Letters on Science & Engineering 11(2) (2015) Available online at

Low-cost MEMS Sensor-based Attitude Determination System by Integration of Magnetometers and GPS: A Real-Data Test and Performance Evaluation

(1) and s k ωk. p k vk q

SENSORIC SUBSYSTEM DESIGN FOR SMALL MODEL OF HELICOPTER

Computationally Efficient Visual-inertial Sensor Fusion for GPS-denied Navigation on a Small Quadrotor

A SWITCHED-ANTENNA NADIR-LOOKING INTERFEROMETRIC SAR ALTIMETER FOR TERRAIN-AIDED NAVIGATION

DriftLess Technology to improve inertial sensors

ALAR Series. Direct Drive, Large-Aperture, Rotary Stage. 5 different aperture sizes: 100 mm, 150 mm, 200 mm, 250 mm, 325 mm

Transcription:

Technical Paper Int l J. of Aeronautical & Space Sci. 11(3), 234 239 (2010) DOI:10.5139/IJASS.2010.11.3.234 Calibration of Inertial Measurement Units Using Pendulum Motion Keeyoung Choi* and Se-ah Jang** Department of Aerospace Engineering, Inha University, Incheon 402-751, Korea Yongho Kim*** Department of PGM Technology, Hanwha Corporation R&D Center, Daejeon 305-156, Korea Abstract The utilization of micro-electro-mechanical system (MEMS) gyros and accelerometers in low-level inertial measurement unit (IMU) influences cost effectiveness in a positive way under the condition that device error characteristics are fully calibrated. The conventional calibration process utilizes a rate table; however, this paper proposes a new method for achieving reference calibration data from the natural motion of pendulum to which the IMU undergoing calibration is attached. This concept was validated with experimental data. The pendulum angle measurements correlate extremely well with the solutions acquired from the pendulum equation of motion. The calibration data were computed using the regression method. The whole process was validated by comparing the measurement from the 6 sensor components with the measurements reconstructed using the identified calibration data. Key words: Inertial measurement unit, Calibration, Pendulum, MEMS 1. Introduction Inertial measurement units (IMU) consist of gyros and accelerometers. An inertial navigation system (INS) is able to compute its attitude and location using rotation rates and translational accelerations taken from an IMU. Since the INS integrates sensor signals, errors tend to accumulate as time persists. Thus, INS grades vary dramatically depending on the quality of the sensor components. High accuracy systems typically use ring laser gyros or fiber optic gyros. Inexpensive systems, which are widely used for experimental unmanned aerial vehicles, rely on micro-electro-mechanical system (MEMS) components. Cost effective MEMS gyros and accelerometers present great potential in many areas outside of the aerospace field. However, certain characteristics of MEMS components cannot be easily controlled; such characteristics are susceptible to environmental influences. Because these components are mass produced sold at relatively low prices, manufacturers cannot individually calibrate the components. Consequently, the effectiveness of MEMS based INS becomes limited without appropriately calibrating the sensors. Sensor fusion is commonly used to improve the accuracy of the INS. By combining a conventional INS with a global positioning system, a magnetometer, and other on-board sensors, users can prevent divergence due to bias from occurring as well as improve the accuracy. However, taking into consideration a worst case scenario in which the supplementary sensors are lost, the importance of the original accuracy of the inertial sensors must be profoundly emphasized. The conventional method used for calibrating inertial sensors comprises the utilization of rate tables, which consist of gimbals and high accuracy control systems. Users place IMU sensors on top of the innermost table, and they either set the table at a constant angle or drive it at a constant rate. Users calibrate the sensors by comparing the sensor outputs with the reference values of gravity components and angular * Professor, Corresponding author ** Ph.D. Candidate E-mail: kchoi@inha.ac.kr Tel: +82-32-860-7352 Fax: +82-32-865-5401 *** Researcher Copyright c The Korean Society for Aeronautical & Space Sciences 234 http://ijass.or.kr pissn: 2093-274x eissn: 2093-2480

Choi. et. al Calibration of Inertial Measurement Units Using Pendulum Motion rates. Such rate tables may be used for HILS (hardware inthe-loop simulation), and are highly priced. An essential component for calibrating inertial sensors is acquiring the reference rotation rate and acceleration. For calibration only, high accuracy motion control is unnecessary as long as there are reliable reference values. This paper introduces a pendulum based calibration system. The sensors are located at the bob. The movement of pendulum is measured using high accuracy angle sensors such as resolvers or encoders. Based on this angle measurement, rotation rates and accelerations at the sensors are reconstructed. The reference data are then compared to the measurements. Afterwards, the error characteristics of individual sensors are identified. The authors implemented this and built an experimental setup. This paper will demonstrate the feasibility and usefulness of the method. 2. MEMS IMU and Error Characteristics The characteristics of errors vary depending on the sensors. Typical mechanical gyros depend on accelerations in addition to scale and bias errors. Since an IMU consists of 3 or more gyros, alignment errors may also be present. By combining these error sources, measurements acquired from the gyros and accelerometers can be described with the following equations Eqs. (1-6). (1) (2) λ ai : scale factor error Q i : Squared error η ai : measurement noise The utility of the sensors or IMU becomes fairly limited without accurately identifying the coefficients incorporated in the aforementioned equations. Figure 1 shows an IMU developed by the Aerospace Control and System Laboratory (ACSL) in the Department of Aerospace Engineering, Inha University. The IMU consists of 3 MEMS gyros and 3 MEMS accelerometers. During the system s first trial, the sensor characteristics varied significantly from component to component. Even identical sets of gyros exhibited drastically different characteristics. This observation led to the conclusion that calibrations must be performed in order to properly utilize the device. 3. Characteristics Calibration Using Pendulum Dynamics 3.1 Acquiring the complete set of data for pendulum motion The most critical aspect for calibration is acquiring reliable reference data from sources other than the sensors. The conventional method for acquiring reference data is controlling the motion of a rate table with high accuracy. For example, to calibrate a rate gyro, the user places the gyro on a motion table, and rotates the table at a preset speed. Since the motion of the table is controlled with extreme precision, the preset speed can be used as a reference value. The gyro output is compared with the reference speed to find the scale factor and bias. (3) where, ω i : true angular rate α ij : misalignment error m ω i : measurement of angular rate b wi : bias λ wi : scale factor error η wi : measurement noise (4) (5) (6) where, a i : true acceleration ε ij : misalignment error m a i : measurement of acceleration b ai : bias Fig. 1. Inertial measurement unit developed by the Inha Aerospace Control and System Laboratory. 235 http://ijass.or.kr

Int l J. of Aeronautical & Space Sci. 11(3), 234 239 (2010) The whole purpose of the high precision control is to gain reference data. If there is a way to acquire reference data without relying on high precision control, then the expensive control and driving mechanism would not necessary; thus, the cost associated with the calibration process can be significantly reduced. Figure 2 shows a flow chart of a new calibration method that uses reference data acquired from natural pendulum motion. One dimensional pendulum motion is governed by the following equation of motion. The second term represents damping and the third one is associated with gravity. If angle θ is small, we can use a linear Angle Sensor Reference Angle Measurements E.O.M. Solver Reference Angular Rate Reference Acceleration Calibration Algorithm Correction Factors IMU Gyro, Accelerometer Angular rate & Acceleration Measurements Fig. 2. Error compensation based on pendulum angle measurements. resolver (7) equation. However, because we need to generate accurate signals for calibration, the equation of motion is considered with nonlinearity of gravity effect. If one knows the physical coefficients c 1 and c 2, and the initial conditions of the pendulum, the entire history of the angular motion can be found. One benefit for solving the equation of motion is that the angular rates and accelerations are also easily available without the numerical differentiation process. Figure 3 shows the actual calibration device manufactured by the authors. The sensors to be calibrated are located at the end of the rod. The pendulum angles are measured using a resolver mounted at the rotation hinge. Figure 4 shows the functional diagram of the data acquisition system that is located next to the resolver. One must find the coefficients and initial conditions to solve the equation of motion. Because the equation of motion is nonlinear, determining the coefficients and initial conditions may be arduous. However, these values are found by using accurate angle measurements from the resolver. The decay rate and period are used to find the coefficients. The initial velocity is set to zero by chopping off the signals before the first peak. Figures 5 and 6 explain this concept. To find the parameters c 1, c 2, we constructed a neural network as shown in the right hand side of Fig. 6. First numerical simulations were conducted with various combinations of c 1, c 2 and θ 0. The decay rate and period were found from each simulation. Using the data, a neural network having these inputs and outputs was constructed. This neural network has two hidden layers, inputs of θ 0, period and decay rate, outputs of c 1 and c 2. In practice, angle measurements using a resolver or an encoder are used for finding θ 0, decay rate and period as shown in the left hand side of Fig. 6. Thus, during the experimental investigations, these three values were entered to the neural networks as inputs, and the neural network estimates c 1, c 2. θ and θ were calculated with pendulum equation of motion Eq. (7). IMU Sensor Components (Gyro, Accelerometer ) Select Switch A/D RS-232 Signal Processing μp (C8051F021) RS-232 IMU RS-485 A/D Angle Sensor Fig. 3. Pendulum calibration system. Fig. 4. Data acquisition part of the calibration system. DOI:10.5139/IJASS.2010.11.3.234 236

Choi. et. al Calibration of Inertial Measurement Units Using Pendulum Motion 3.2 Signal reconstruction Once the equation of motion was solved, the reference data for the IMU were reconstructed. The single axis pendulum generates signals in 3 degrees of freedom; rotation, tangential acceleration, and normal acceleration. The terms that contribute to the acceleration are the centrifugal acceleration, tangential acceleration, gravity, and the earth s rotation. For a rotation with respect to the x-axis, the reference values were reconstructed based on the following formula. outputs were digitized using a built-in A/D converter. The measurements were constructed as follows. (10) where z is the difference between the measurements and the reference data. (11) (8) M, S, and N are defined as follows, respectively. (9) where, Ω : Earth s rotational rate a c : acceleration caused by earth rotation L : length between sensor and rotation axis By repeating the procedures 3 times with different orientation settings of the IMU, a complete 6 degrees of freedom reference data are acquired. 3.3 Sensor calibration Once the reference data set has been constructed, the data was compared to the sensor measurements. The sensor outputs were either in digital or analog. The analog sensor The sensor calibration parameters xˆ=[x T x 1T ] are defined as follows Now, the calibration parameters are identified by solving (12) θ(t) Acquisition of Pendulum Experiment Data θ with accurate angle sensor t Find θ0 and period t, and decay rate yaaaa / k yk 1 Pendulum simulation for various c1, c θ 1, c2, θ0 + cθ + c sinθ = 0 1 2 θ 0 Find and period t, and decay rate aaaaaa y / k yk 1 Δt Δt Find c, c 1 2 using the neural network Construct neural network Input 1 st Column 2 nd Column 3 rd Column period decay θ 0 rate t Solve the E.O.M. θ, θ, θ Output 1 st Column 2 nd Column c1 c2 Fig. 5. Representative angle measurements. Fig. 6. Procedures of solver for pendulum equation of motion. 237 http://ijass.or.kr

Int l J. of Aeronautical & Space Sci. 11(3), 234 239 (2010) 4. Test Results The algorithm was implemented and tested with the IMU shown in Fig. 7. The first equation to be validated was the equation of motion. Using the resolver measurements, the coefficients and initial condition were identified. Then the equation of motion was solved using these parameters. The resulting angle history was compared to the original measurements. Figures 7a and b show angle measurements and the calculated angle data using estimated parameters of pendulum motion. These angles correlate very well with one another. The enlarged figure (Fig. 7b) proves that the pendulum obeys the equation of motion well. Since the equation of motion was validated, the angular rate and accelerations that resulted from the equation of motion are considered to be close to the actual rate and accelerations. Figure 7c shows the angular rate solution. Figure 7d shows the same data computed from numerical differentiation of the angle measurements. Even if the angle measurements appear smooth, the numerical differentiation resulted in significant noise. Differentiating this angular rate resulted in the angular acceleration. However, the results were too noisy and thus deemed ineffective Using the above validated results, reference data set for IMU calibration was constructed using Eqs. (8 and 9), and 0.3 0.2 0.1 0.29 0.28 measure estimated θ (rad) 0-0.1-0.2 θ (rad) 0.27 0.26 0 2 4 6 8 10 ( ) 1 0.25 1 8.4 8.5 8.6 8.7 (b) Angular Rate (rad/sec) 0.5 0-0.5 Angular Rate (rad/sec) 0.5 0-0.5-1 0 2 4 6 8 10 (c) -1 0 2 4 6 8 10 (d) Fig. 7. Comparison between angle measurements and equation solutions. Fig. 8. Measurement reconstruction based on the equation solutions. DOI:10.5139/IJASS.2010.11.3.234 238

Choi. et. al Calibration of Inertial Measurement Units Using Pendulum Motion the IMU calibration parameters are identified. Figure 8 shows the 6 sensor measurements along with the reconstructed measurements using the parameters identified in the calibration process. The left side of Fig. 8 shows comparison between calibrated 3-axis angular rate and the reference data. Right side of Fig. 8 shows calibrated 3-axis acceleration and the reference data. The two sets of data match extremely well, which proves the validity of the algorithm. 5. Conclusions A new IMU calibration method using a pendulum was devised, and subsequently implemented in a real pendulum system. The reference angular rates and translational accelerations were computed based on measurements from high precision angle measurement. We constructed the nonlinear pendulum equation, and using this equation the neural network was built for estimating pendulum motion parameters. The angle measurements using accurate angle sensor were entered to neural network as input. After the pendulum motion parameters were estimated, the angular rate and the angular acceleration were calculated using the equation of motion. The acceleration signal, including the Coriolis effect and gravity for calibration, can also be composed by this data. The acquired reference data were compared to the IMU measurements. Consequently, the error characteristics of individual sensors were identified. This concept was validated with experiments. All the results in this paper prove that calibration of IMU using pendulum motion remarkably improves IMU accuracy. References Joos, D. K. (1978). Determination and evaluation of strapdown-sensor-parameters from system-test-data. Symposium on Gyroscope Technology, Bochum, West Germany. Krogmann, U. (1978). Identification procedures for strapdown sensor parameters by laboratory testing. Symposium on Gyroscope Technology, Bochum, West Germany. Titterton, D. H., Weston, J. L., Institution of Electrical Engineers, and American Institute of Aeronautics and Astronautics. (2004). Strapdown Inertial Navigation Technology. 2nd ed. Stevenage: Institution of Electrical Engineers. 239 http://ijass.or.kr