Coder Social home page Coder Social logo

silenceoverflow / allan_variance_ros Goto Github PK

View Code? Open in Web Editor NEW

This project forked from ori-drs/allan_variance_ros

0.0 0.0 0.0 2.74 MB

ROS compatible tool to generate Allan Deviation plots

License: BSD 3-Clause "New" or "Revised" License

C++ 58.66% Python 36.25% CMake 5.09%

allan_variance_ros's Introduction

Allan Variance ROS

ROS package which loads a rosbag of IMU data and computes Allan Variance parameters

The purpose of this tool is to read a long sequence of IMU data and compute the Angle Random Walk (ARW), Bias Instability and Gyro Random Walk for the gyroscope as well as Velocity Random Walk (VRW), Bias Instability and Accel Random Walk for the accelerometer.

While there are many open source tools which do the same thing, this package has the following features:

  • Fully ROS compatable. Simply record a rosbag and provide it as input. No conversion required.
  • Written in C++ making use of rosbag::View means the rosbag is processed at maximum speed. No need to play back the bag file.
  • Designed for Kalibr. Will produce an imu.yaml file.

This tool is designed for Ubuntu 20.04. Attempting to use on another distro or version may require some code changes.

How to build

catkin build allan_variance_ros

How to use

  1. Place your IMU on some damped surface and record your IMU data to a rosbag. You must record at least 3 hours of data. The longer the sequence, the more accurate the results.

  2. Recommended Reorganize ROS messages by timestamp:

rosrun allan_variance_ros cookbag.py --input original_rosbag --output cooked_rosbag

  1. Run the Allan Variance computation tool (example config files provided):

rosrun allan_variance_ros allan_variance [path_to_folder_containing_bag] [path_to_config_file]

  1. This will compute the Allan Deviation for the IMU and generate a CSV. The next step is to visualize the plots and get parameters. For this run:

rosrun allan_variance_ros analysis.py --data allan_variance.csv

Press space to go to next figure.

Example Log

3 hour log of Realsense D435i IMU with timestamps already re-arranged.

Acceleration Gyroscope

Example terminal output:

ACCELEROMETER:
X Velocity Random Walk:  0.00333 m/s/sqrt(s)  0.19983 m/s/sqrt(hr)
Y Velocity Random Walk:  0.01079 m/s/sqrt(s)  0.64719 m/s/sqrt(hr)
Z Velocity Random Walk:  0.00481 m/s/sqrt(s)  0.28846 m/s/sqrt(hr)
X Bias Instability:  0.00055 m/s^2  7173.28800 m/hr^2
Y Bias Instability:  0.00153 m/s^2  19869.01200 m/hr^2
Z Bias Instability:  0.00052 m/s^2  6701.58000 m/hr^2
X Accel Random Walk:  0.00008 m/s^2/sqrt(s)
Y Accel Random Walk:  0.00020 m/s^2/sqrt(s)
Z Accel Random Walk:  0.00007 m/s^2/sqrt(s)
GYROSCOPE:
X Angle Random Walk:  0.00787 deg/sqrt(s)  0.47215 deg/sqrt(hr)
Y Angle Random Walk:  0.00987 deg/sqrt(s)  0.59204 deg/sqrt(hr)
Z Angle Random Walk:  0.00839 deg/sqrt(s)  0.50331 deg/sqrt(hr)
X Bias Instability:  0.00049 deg/s  1.76568 deg/hr
Y Bias Instability:  0.00136 deg/s  4.88153 deg/hr
Z Bias Instability:  0.00088 deg/s  3.15431 deg/hr
X Rate Random Walk:  0.00007 deg/s/sqrt(s)
Y Rate Random Walk:  0.00028 deg/s/sqrt(s)
Z Rate Random Walk:  0.00011 deg/s/sqrt(s)

Kalibr

Kalibr is a useful collection of tools for calibrating cameras and IMUs. For IMU calibration it needs the noise parameters of the IMU generated in a yaml file. allan_variance_ros automatically generates this file file as imu.yaml:

#Accelerometer
accelerometer_noise_density: 0.006308226052016165 
accelerometer_random_walk: 0.00011673723527962174 

#Gyroscope
gyroscope_noise_density: 0.00015198973532354657 
gyroscope_random_walk: 2.664506559330434e-06 

rostopic: '/sensors/imu' #Make sure this is correct
update_rate: 400.0 #Make sure this is correct

Allan Variance ROS Evaluation

IMU Noise Simulator

Thanks to @kekeliu-whu who contributed an IMU noise simulator is based on the Kalibr IMU noise model. You can generate a rosbag of simulated IMU noise and run allan_variance_ros to verify the tool is working. As shown in PR ori-drs#24 accuracy is quite good.

To generate simulated noise

rosrun allan_variance_ros imu_simulator [path_to_output_bag_file] [path_to_simulation_config_file]

A simulation config file is provided in allan_variance_ros/config/simulation/imu_simulator.yaml

To test Allan Variance ROS on simulated rosbag

rosrun allan_variance_ros allan_variance [path_to_folder_containing_bag] [path_to_config_file]

A config file is provided in allan_variance_ros/config/sim.yaml

Additional Example bags

Some additional rosbags of real IMU data for different sensors is available here. Thanks to Patrick Geneva.

Author

Russell Buchanan

References

allan_variance_ros's People

Contributors

mintar avatar goldbattle avatar flex-transformer avatar dwisth avatar mauricefallon avatar

Recommend Projects

  • React photo React

    A declarative, efficient, and flexible JavaScript library for building user interfaces.

  • Vue.js photo Vue.js

    ๐Ÿ–– Vue.js is a progressive, incrementally-adoptable JavaScript framework for building UI on the web.

  • Typescript photo Typescript

    TypeScript is a superset of JavaScript that compiles to clean JavaScript output.

  • TensorFlow photo TensorFlow

    An Open Source Machine Learning Framework for Everyone

  • Django photo Django

    The Web framework for perfectionists with deadlines.

  • D3 photo D3

    Bring data to life with SVG, Canvas and HTML. ๐Ÿ“Š๐Ÿ“ˆ๐ŸŽ‰

Recommend Topics

  • javascript

    JavaScript (JS) is a lightweight interpreted programming language with first-class functions.

  • web

    Some thing interesting about web. New door for the world.

  • server

    A server is a program made to process requests and deliver data to clients.

  • Machine learning

    Machine learning is a way of modeling and interpreting data that allows a piece of software to respond intelligently.

  • Game

    Some thing interesting about game, make everyone happy.

Recommend Org

  • Facebook photo Facebook

    We are working to build community through open source technology. NB: members must have two-factor auth.

  • Microsoft photo Microsoft

    Open source projects and samples from Microsoft.

  • Google photo Google

    Google โค๏ธ Open Source for everyone.

  • D3 photo D3

    Data-Driven Documents codes.