Vehicle Localization Using In-Vehicle Pitch Data and Dynamical Models

This paper describes a dynamical model-based method for the localization of road vehicles using terrain data from the vehicle's onboard sensors. Road data are encoded using linear dynamical models and then, during travel, the location is identified through continuous comparison of a bank of linear models. The approach presented has several advantages over previous methods described in the literature. First, it creates computationally efficient linear model map representations of the road data. Second, the use of linear models eliminates the need for metrics during the localization process. Third, the localization algorithm is a computationally efficient approach that can have a bounded localization distance in the absence of noise, given certain uniqueness assumptions on the data. Fourth, encoding road data using linear models has the potential to compress the data, while retaining the sensory information. Finally, performing only linear operations on observed noisy data simplifies the creation of noise mitigation algorithms.

[1]  J. C. Gerdes,et al.  Practical Position and Yaw Rate Estimation with GPS and Differential Wheelspeeds , 2022 .

[2]  Clu-istos Foutsos,et al.  Fast subsequence matching in time-series databases , 1994, SIGMOD '94.

[3]  Sean N. Brennan,et al.  Terrain-Aided Localization Using Feature-Based Particle Filtering , 2011 .

[4]  Constantino M. Lagoa,et al.  Terrain-based vehicle localization from real-time data using dynamical models , 2012, 2012 IEEE 51st IEEE Conference on Decision and Control (CDC).

[5]  Xiaoji Niu,et al.  Thermal Calibration of Low Cost MEMS Sensors for Integrated Positioning, Navigation Systems , 2007 .

[6]  Stefan B. Williams,et al.  Map Management for Efficient Simultaneous Localization and Mapping (SLAM) , 2002, Auton. Robots.

[7]  Christos Faloutsos,et al.  Efficiently supporting ad hoc queries in large datasets of time sequences , 1997, SIGMOD '97.

[8]  Trygve Randen,et al.  Filtering for Texture Classification: A Comparative Study , 1999, IEEE Trans. Pattern Anal. Mach. Intell..

[9]  René Vidal,et al.  Categorizing Dynamic Textures Using a Bag of Dynamical Systems , 2013, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[10]  Hui Ding,et al.  Querying and mining of time series data: experimental comparison of representations and distance measures , 2008, Proc. VLDB Endow..

[11]  Krystian Mikolajczyk,et al.  Action recognition with motion-appearance vocabulary forest , 2008, 2008 IEEE Conference on Computer Vision and Pattern Recognition.

[12]  Ye Wang,et al.  Singing voice detection for karaoke application , 2005, Visual Communications and Image Processing.

[13]  Howie Choset,et al.  Relative localization using path odometry information , 2006, Auton. Robots.

[14]  Mohinder S. Grewal,et al.  Global Positioning Systems, Inertial Navigation, and Integration , 2000 .

[15]  Donald A. Adjeroh,et al.  Comparison of Texture Analysis Schemes Under Nonideal Conditions , 2011, IEEE Transactions on Image Processing.

[16]  Håkan Pettersson,et al.  Fulfilling the pedestrian protection directive using a long-wavelength infrared camera designed to meet both performance and cost targets , 2006, SPIE Photonics Europe.

[17]  Ming Yang,et al.  Ground-Texture-Based Localization for Intelligent Vehicles , 2009, IEEE Transactions on Intelligent Transportation Systems.

[18]  Mohan M. Trivedi,et al.  This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination. IEEE TRANSACTIONS ON INTELLIGENT TRANSPORTATION SYSTEMS 1 Integrated Lane and Vehicle Detection, Localization, , 2022 .

[19]  N. El-Sheimy,et al.  Wavelet de-noising for IMU alignment , 2004, IEEE Aerospace and Electronic Systems Magazine.

[20]  Hui Zhang,et al.  A Non-parametric Wavelet Feature Extractor for Time Series Classification , 2004, PAKDD.

[21]  Sean N. Brennan,et al.  Pitch based vehicle localization using time series subsequence matching with Multi-scale Extrema Features , 2011, Proceedings of the 2011 American Control Conference.

[22]  Rama Chellappa,et al.  Ieee Transactions on Pattern Analysis and Machine Intelligence 1 Matching Shape Sequences in Video with Applications in Human Movement Analysis. Ieee Transactions on Pattern Analysis and Machine Intelligence 2 , 2022 .

[23]  Isaac Skog,et al.  Calibration of a MEMS inertial measurement unit , 2006 .

[24]  P.P.J. van den Bosch,et al.  Modeling, identification, and simulation of dynamical systems , 1994 .

[25]  Vishisht Vijay Gupta Vehicle localization using low-accuracy GPS, IMU and map-aided vision , 2009 .

[26]  Liqiang Feng,et al.  Measurement and correction of systematic odometry errors in mobile robots , 1996, IEEE Trans. Robotics Autom..

[27]  Payam Saisan,et al.  Dynamic texture recognition , 2001, Proceedings of the 2001 IEEE Computer Society Conference on Computer Vision and Pattern Recognition. CVPR 2001.

[28]  Washington Y. Ochieng,et al.  GPS Integrity and Potential Impact on Aviation Safety , 2003, Journal of Navigation.

[29]  Stefan B. Williams,et al.  Reduced SIFT Features For Image Retrieval And Indoor Localisation , 2004 .

[30]  Ryan David Martini GPS/INS SENSING COORDINATION FOR VEHICLE STATE IDENTIFICATION AND ROAD GRADE POSITIONING , 2006 .

[31]  D. Powell,et al.  Land-vehicle navigation using GPS , 1999, Proc. IEEE.

[32]  Andreas Schindler Vehicle Self-localization Using High-precision Digital Maps , 2013 .

[33]  Carsten Hasberg,et al.  Simultaneous Localization and Mapping for Path-Constrained Motion , 2012, IEEE Transactions on Intelligent Transportation Systems.

[34]  Isaac Skog,et al.  In-Car Positioning and Navigation Technologies—A Survey , 2009, IEEE Transactions on Intelligent Transportation Systems.

[35]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[36]  Bart De Schutter,et al.  IEEE TRANSACTIONS ON INTELLIGENT TRANSPORTATION SYSTEMS Editor-In-Chief , 2005 .

[37]  Thomas B. Schön,et al.  Particle Filter SLAM with High Dimensional Vehicle Model , 2009, J. Intell. Robotic Syst..

[38]  Dan Gusfield,et al.  Algorithms on Strings, Trees, and Sequences - Computer Science and Computational Biology , 1997 .

[39]  Henrik André-Jönsson,et al.  Using Signature Files for Querying Time-Series Data , 1997, PKDD.

[40]  A.J. Dean,et al.  Terrain-based road vehicle localization using particle filters , 2008, 2008 American Control Conference.

[41]  Xiaoji Niu,et al.  Analysis and Modeling of Inertial Sensors Using Allan Variance , 2008, IEEE Transactions on Instrumentation and Measurement.

[42]  Hugh F. Durrant-Whyte,et al.  Simultaneous Mapping and Localization with Sparse Extended Information Filters: Theory and Initial Results , 2004, WAFR.

[43]  Andreas Schindler,et al.  Vehicle Self-Localization Using High-Precision Digital Maps , 2013 .

[44]  N. Nathan Self and will , 1997 .

[45]  Tsuhan Chen,et al.  Reinterpreting the Application of Gabor Filters as a Manipulation of the Margin in Linear Support Vector Machines , 2010, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[46]  A. Kornhauser,et al.  An Introduction to Map Matching for Personal Navigation Assistants , 1998 .

[47]  Magne Hallstein Johnsen,et al.  Joint feature and model training for minimum detection errors applied to speech subword detection , 2012, 2012 IEEE International Workshop on Machine Learning for Signal Processing.

[48]  Hugh F. Durrant-Whyte,et al.  Mobile robot localization by tracking geometric beacons , 1991, IEEE Trans. Robotics Autom..

[49]  Fei Wang,et al.  Calibration of low cost MEMS inertial Measurement Unit for an FPGA-based navigation system , 2011, 2011 IEEE International Conference on Information and Automation.

[50]  SkogIsaac,et al.  In-car positioning and navigation technologies , 2009 .

[51]  Washington Y. Ochieng,et al.  A general map matching algorithm for transport telematics applications , 2003 .

[52]  Rama Chellappa,et al.  Advances in Video-Based Human Activity Analysis: Challenges and Approaches , 2010, Adv. Comput..

[53]  Jiri Matas,et al.  Tracking by an Optimal Sequence of Linear Predictors , 2009, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[54]  Hongguang Ma,et al.  Improving Accuracy of the Vehicle Attitude Estimation for Low-Cost INS/GPS Integration Aided by the GPS-Measured Course Angle , 2013, IEEE Transactions on Intelligent Transportation Systems.

[55]  Edvard Govekar,et al.  Application of psychoacoustic filtering for machine fault detection , 2006 .

[56]  Toshiyuki Amagasa,et al.  The L - index: An indexing structure for ecient subsequence matching in time sequence databases , 2001 .

[57]  Sharath Pankanti,et al.  Filterbank-based fingerprint matching , 2000, IEEE Trans. Image Process..

[58]  Andrey V. Savkin,et al.  A model validation approach to texture recognition and inpainting , 2010, Pattern Recognit..

[59]  Luis Miguel Bergasa,et al.  Real-Time Hierarchical Outdoor SLAM Based on Stereovision and GPS Fusion , 2009, IEEE Transactions on Intelligent Transportation Systems.

[60]  Liqiang Feng,et al.  Gyrodometry: a new method for combining data from gyros and odometry in mobile robots , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[61]  Otman A. Basir,et al.  GPS Localization Accuracy Classification: A Context-Based Approach , 2013, IEEE Transactions on Intelligent Transportation Systems.

[62]  Adam J. Dean Terrain-Based Road Vehicle Localization Using Attitude Measurements , 2008 .

[63]  Christos Faloutsos,et al.  Fast Time Sequence Indexing for Arbitrary Lp Norms , 2000, VLDB.

[64]  J. David Powell,et al.  Error Sources When Land Vehicle Dead Reckoning with Differential Wheelspeeds , 2004 .

[65]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[66]  Sebastian Thrun,et al.  Robust vehicle localization in urban environments using probabilistic maps , 2010, 2010 IEEE International Conference on Robotics and Automation.

[67]  Myoungho Sunwoo,et al.  Interacting Multiple Model Filter-Based Sensor Fusion of GPS With In-Vehicle Sensors for Real-Time Vehicle Positioning , 2012, IEEE Transactions on Intelligent Transportation Systems.

[68]  Hobart R. Everett,et al.  Mobile robot positioning: Sensors and techniques , 1997, J. Field Robotics.

[69]  Stefano Soatto,et al.  Classification and Recognition of Dynamical Models: The Role of Phase, Independent Components, Kernels and Optimal Transport , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[70]  Afsar Saranli,et al.  Characterization and calibration of MEMS inertial sensors for state and parameter estimation applications , 2012 .

[71]  Yan Lu,et al.  Performance Test Results of an Integrated GPS/MEMS Inertial Navigation Package , 2004 .

[72]  H. Franco,et al.  Unsupervised noise model estimation for model-based robust speech recognition , 2003, 2003 IEEE Workshop on Automatic Speech Recognition and Understanding (IEEE Cat. No.03EX721).

[73]  Eamonn J. Keogh,et al.  HOT SAX: efficiently finding the most unusual time series subsequence , 2005, Fifth IEEE International Conference on Data Mining (ICDM'05).

[74]  Michael Bosse,et al.  Keypoint design and evaluation for place recognition in 2D lidar maps , 2009, Robotics Auton. Syst..

[75]  Gert F. Trommer,et al.  Cooperative GNSS-based method for vehicle positioning , 2012 .

[76]  Sean N. Brennan,et al.  GPS-Free Terrain-Based Vehicle Tracking Performance as a Function of Inertial Sensor Characteristics , 2011 .

[77]  Robert B. Noland,et al.  Current map-matching algorithms for transport applications: State-of-the art and future research directions , 2007 .

[78]  Peter Cheeseman,et al.  A stochastic map for uncertain spatial relationships , 1988 .

[79]  Stefano Soatto,et al.  Recognition of human gaits , 2001, Proceedings of the 2001 IEEE Computer Society Conference on Computer Vision and Pattern Recognition. CVPR 2001.

[80]  Rui Li,et al.  Divide, Conquer and Coordinate: Globally Coordinated Switching Linear Dynamical System , 2012, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[81]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[82]  Jay A. Farrell,et al.  Inertial Navigation Aiding by Stationary Updates , 2012, IEEE Transactions on Intelligent Transportation Systems.

[83]  Richard J. Martin A metric for ARMA processes , 2000, IEEE Trans. Signal Process..

[84]  Christos Faloutsos,et al.  Efficient Similarity Search In Sequence Databases , 1993, FODO.

[85]  Raja Chatila,et al.  An Experimental System for Incremental Environment Modelling by an Autonomous Mobile Robot , 1989, ISER.

[86]  Takio Kurita,et al.  Complex Autoregressive Model for Shape Recognition , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[87]  M. E. Cannon,et al.  GPS/MEMS INS integrated system for navigation in urban areas , 2007 .

[88]  Eamonn J. Keogh,et al.  Dimensionality Reduction for Fast Similarity Search in Large Time Series Databases , 2001, Knowledge and Information Systems.

[89]  Ignacio Parra,et al.  Accurate Global Localization Using Visual Odometry and Digital Maps on Urban Environments , 2012, IEEE Transactions on Intelligent Transportation Systems.

[90]  Constantino M. Lagoa,et al.  A Sparsification Approach to Set Membership Identification of Switched Affine Systems , 2012, IEEE Transactions on Automatic Control.

[91]  Eduardo Mario Nebot,et al.  Optimization of the simultaneous localization and map-building algorithm for real-time implementation , 2001, IEEE Trans. Robotics Autom..

[92]  Hans-Peter Kriegel,et al.  Similarity Search on Time Series Based on Threshold Queries , 2006, EDBT.

[93]  Stefano Soatto,et al.  A model (In)validation approach to gait recognition , 2002, Proceedings. First International Symposium on 3D Data Processing Visualization and Transmission.

[94]  Peter Cheeseman,et al.  On the Representation and Estimation of Spatial Uncertainty , 1986 .

[95]  Washington Y. Ochieng,et al.  Integrity of map-matching algorithms , 2006 .