GPS/INS/Wheel Count Sensor Acquisition and Fusion.

Slides:



Advertisements
Similar presentations
Navigation Fundamentals
Advertisements

ROBOT LOCALISATION & MAPPING: MAPPING & LIDAR By James Mead.
(Includes references to Brian Clipp
Lab 2 Lab 3 Homework Labs 4-6 Final Project Late No Videos Write up
“Real-time” Transient Detection Algorithms Dr. Kang Hyeun Ji, Thomas Herring MIT.
Attitude Determination - Using GPS. 20/ (MJ)Danish GPS Center2 Table of Contents Definition of Attitude Attitude and GPS Attitude Representations.
Final Demonstration: Dead Reckoning System for Mobile Robots Lee FithianSteven Parkinson Ajay JosephSaba Rizvi.
ECE 480 Design Team 6 Lightweight Speed and Distance Sensor for Skiers and Snowboarders Michael Bekkala Michael Blair Michael Carpenter Matthew Guibord.
Critical Design Review: Dead Reckoning System for Mobile Robots Lee FithianSteven Parkinson Ajay JosephSaba Rizvi.
The Future Soldier Group 4 Vincent Leone Elliot Levy Bencheton Asim Chaudhry.
ME 224 Experimental Engineering: Professor Espinosa 2005 TEAM : Jamie Charles Carlo Niko Javier.
Visual Odometry for Ground Vehicle Applications David Nister, Oleg Naroditsky, James Bergen Sarnoff Corporation, CN5300 Princeton, NJ CPSC 643, Presentation.
GPS/Dead Reckoning Navigation with Kalman Filter Integration
Weighted Range Sensor Matching Algorithms for Mobile Robot Displacement Estimation Sam Pfister, Kristo Kriechbaum, Stergios Roumeliotis, Joel Burdick Mechanical.
What is GPS and UTM and how do they work? K. Michalski.
Ruolin Fan, Silas Lam, Emanuel Lin, Oleksandr Artemenkoⱡ, Mario Gerla
Shanshan Chen, Christopher L. Cunningham, John Lach UVA Center for Wireless Health University of Virginia BSN, 2011 Extracting Spatio-Temporal Information.
Overview and Mathematics Bjoern Griesbach
Ground-Based Altimetry Using a Single- Receiver Single-Frequency GNSS Phase Ambiguity Resolution Technique G. Stienne* S. Reboul J.-B. Choquel M. Benjelloun.
Virtual Imaging Peripheral for Enhanced Reality Aaron Garrett, Ryan Hannah, Justin Huffaker, Brendon McCool.
An INS/GPS Navigation System with MEMS Inertial Sensors for Small Unmanned Aerial Vehicles Masaru Naruoka The University of Tokyo 1.Introduction.
In general, H 1 (f) and H 2 (f) can be chosen to best suit the application. For example, to accentuate the signals at the frequencies in which the signal-to-noise.
Smartphone Overview iPhone 4 By Anthony Poland 6 Nov 2014.
What is Physics? Physics is a branch of science that involves the study of the physical world: energy, matter, and how they are related. Physicists investigate.
Computer Vision Group Prof. Daniel Cremers Autonomous Navigation for Flying Robots Lecture 3.2: Sensors Jürgen Sturm Technische Universität München.
Localisation & Navigation
David Wheeler Kyle Ingersoll EcEn 670 December 5, 2013 A Comparison between Analytical and Simulated Results The Kalman Filter: A Study of Covariances.
Methee Srisupundit Final Defense.  Intelligent Vehicle  Localization  Observer (Estimator) Kalman Filter Particle Filter  Methodology Control Input.
Sérgio Ronaldo Barros dos Santos (ITA-Brazil)
Princeton University Prospect Eleven Nov. 17, 2005 System Architecture Event-Based –Modules “subscribe” to the information they need and receive it as.
Introduction to Unit Circle Trigonometry 1. The Unit Circle on the Coordinate Plane (1,0) (0,1) (-1,0) (0, -1) Quadrant I X – Pos Y - Pos X Y Radius =
Wireless Sensor Project Search Triangulation Aerial Rescue Team (START)
Karman filter and attitude estimation Lin Zhong ELEC424, Fall 2010.
Company LOGO Mid semester presentation Spring 2008/9 Performed by: Alexander PavlovDavid Domb Supervisor: Mony Orbach GPS/INS Computing System.
INS: Inertial Navigation Systems An overview of 4 sensors.
Inertial Navigation System Overview – Mechanization Equation
Working with the robot_localization Package
Geology Study of the Earth, its systems and processes.
Swerve Drive Software Design. Software Layers Joystick Axis Correction Joystick Response Calculation Field-oriented Angle Adjustment Swerve Drive Steer.
Simultaneous Localization and Mapping (SLAM). Localization Perfect Map + Observations with errors = Pretty good Localization (Average out errors in observations,
CARLOC: Precisely Tracking Automobile Position
Underwater Vehicle Navigation Techniques Chris Barngrover CSE 237D.
Current Works Corrected unit conversions in code Found an error in calculating offset (to zero sensors) – Fixed error, but still not accurately integrating.
1 SVY 207: Lecture 12 Modes of GPS Positioning Aim of this lecture: –To review and compare methods of static positioning, and introduce methods for kinematic.
Particle Filtering. Sensors and Uncertainty Real world sensors are noisy and suffer from missing data (e.g., occlusions, GPS blackouts) Use dynamics models.
Optimizing Attitude Determination for Sun Devil Satellite – 1
Current Works Determined drift during constant velocity test caused by slight rotation which results in gravity affecting accelerometers Analyzed data.
Visual Odometry for Ground Vehicle Applications David Nistér, Oleg Naroditsky, and James Bergen Sarnoff Corporation CN5300 Princeton, New Jersey
Quadcopters A CEV Talk. Agenda Flight PreliminariesWhy Quadcopters The Quadcopter SystemStability: The NotionSensors and FusionControl AlgorithmsThe Way.
Company LOGO Project Characterization Spring 2008/9 Performed by: Alexander PavlovDavid Domb Supervisor: Mony Orbach GPS/INS Computing System.
Sensor Fusion Donald Heer 11/10/10. The Questions Can two things happen at the ‘same’ time? Can the same thing be observed ‘identically’ by two different.
Mobile Robot Localization and Mapping Using Range Sensor Data Dr. Joel Burdick, Dr. Stergios Roumeliotis, Samuel Pfister, Kristo Kriechbaum.
Section 4.1. Radian and Degree Measure The angles in Quadrant I are between 0 and 90 degrees. The angles in Quadrant II are between 90 and 180 degrees.
Copyright 2011 controltrix corpwww. controltrix.com Global Positioning System ++ Improved GPS using sensor data fusion
Testing of The System This test is the Impact caused by change in the rotation angle of GPS antenna is investigated. The experimented system is clarified.
Younis H. Karim, AbidYahya School of Computer University Malaysia Perlis 1.
6.1 Radian and Degree Measure
Chapter 1 Introduction.
Sensors Fusion for Mobile Robotics localization
Using Sensor Data Effectively
Circular Motion How do we work out the velocity of something which is moving at constant speed in a circle ? Answer: We use the simple formula: But in.
GPS + Inertial Sensor Fusion (GISF) Fall 2013 Presentation
Florian Shkurti, Ioannis Rekleitis, Milena Scaccia and Gregory Dudek
Inertial Measurement Unit (IMU) Basics
Angles and Their Measures
College Physics Chapter 1 Introduction.
13.2A General Angles Alg. II.
777 Neptune Groundschool Navigation.
Exploring Alternatives to GPS Navigation Systems
Graphing Polar Coordinates
Presentation transcript:

GPS/INS/Wheel Count Sensor Acquisition and Fusion

What do GPS, INS, and Wheel Counts do?  Report and record the position of the robot Position relative to a starting position for INS and wheel count.Position relative to a starting position for INS and wheel count. GPS gives location in Latitude and LongitudeGPS gives location in Latitude and Longitude

Why do we need three methods to determine position?  All three systems use different methods to calculate location.  By looking at all three, a better approximation of position can be established.  Redundancy  The weaknesses of each system can be offset by the other systems.

Sensor Function Overview  GPS: Triangulates position by sending signals to a satellite array. Time to receive signals from different satellites allows calculation of position. Strengths: gives latittude/longitude readings anywhere in the world. No drifting of measurement.Strengths: gives latittude/longitude readings anywhere in the world. No drifting of measurement. Weaknesses: inaccuracies, outagesWeaknesses: inaccuracies, outages

Sensor Function Overview  INS (Inertial Navigation System) uses a set of rate gyroscopes and accelerometers mounted on each of the three axis. Strengths: fast refresh, accurate values, fairly reliable with no outages.Strengths: fast refresh, accurate values, fairly reliable with no outages. Weaknesses: drifts over timeWeaknesses: drifts over time  Wheel Count measures the number of rotations of each wheel. Strengths: Works consistently, simple systemStrengths: Works consistently, simple system Weaknesses: No way to measure wheel slip.Weaknesses: No way to measure wheel slip.

Modeling System Clock to GPS Time  GPS has relatively large update time  Unacceptable for Speed based GPS estimates  dt(GPS) = loop_time * a  A =

Modeling Dead Reckoning Angle to Gyroscope Angle  Both initialize to –pi/2  Differences are related to wheel slip  Simple degrees to radians conversion  Implementation requires infrequent linking

Wheel speed to GPS speed  Sporadic GPS speed  Conversion based on experimental data  GPS speed = wheel_speed*b  b =

(X, Y) Coordinates to GPS Longitude and Latitude  latlen = m1 + (m2.*cos(2.*gps_lat))+ (m3.*cos(4.*gps_lat)) + (m4.*cos(6.*gps_lat))  longlen = (p1 * cos(gps_lat)) + (p2.*cos(3.*gps_lat)) + (p3.*cos(5.*gps_lat))  Two sets of (x,y) coordinates (x,y) and (x+dx/dt,y+dy/dt)(x,y) and (x+dx/dt,y+dy/dt)  Difference between points as a vector  Rotate Vector to match GPS angle New_angle = original angle- GPS_angle_offsetNew_angle = original angle- GPS_angle_offset  Convert from meters to degrees  Add to current GPS latitude and longitude to get new value

Inertial Navigation System Implementation (ins_conv.c)  get_gps_est(double est_long, double est_lat, double est_speed, double est_angle, double est_loop_time, int sys_num, double x, double y,double link_offset_angle, rstatus r) System I: GPS onlySystem I: GPS only System II: Dead Reckoning to GPSSystem II: Dead Reckoning to GPS System III: Wheel Speed and Gyroscope to GPSSystem III: Wheel Speed and Gyroscope to GPS System IV: GPS Speed and Gyroscope to GPSSystem IV: GPS Speed and Gyroscope to GPS  link_gyro_angle_to_gps

Sensor Fusion  By combining all sensor inputs and finding “average”, weaknesses of each system can be factored out.  Kalman filter is the most common method to integrate this sensor data.

Kalman Filter A digital filter which uses a recursive process to determine a least-squares fit to data obtained over time. MIMO, filter for noisy sensor data. A digital filter which uses a recursive process to determine a least-squares fit to data obtained over time. MIMO, filter for noisy sensor data. Works on a theory of states with uncertainties added in at each recursion. The uncertainties and weights are updated and improved during each cycle. Works on a theory of states with uncertainties added in at each recursion. The uncertainties and weights are updated and improved during each cycle. Source: The Kalman Filter: Navigation's Integration Workhorse by Larry J Levy

Where would we go from here?  Add full INS system to robot.  Implement real-time Kalman filter including full INS and GPS data.