Getting quaternions out of the ArduIMU

My goal today was to get the ArduIMU sending quaternions.  I couldn’t get the official ArduIMU firmware to compile not could I install their software, so I decided to start from scratch.  I knew this would not be a small code project so the first thing to do was to gain an understanding the Arduino IDE, compiler and general coding style.  This was extremely frustrating and I really don’t like the way use of .pde and .ino files.  In the end I decided I would write everything in C++ and used the core libraries as a reference for style.

The core libraries use a pseudo singleton class approach.  A class is name is that of the library with the word “Class” appended (e.g. SPIClass).  The .h file then contains an external reference to an instance of the class named after the library (e.g. SPI).  This object is defined in the library .cpp file.  It is a simple approach that minimises code and results in simple usage at the application level, so I went along with it.

// SPI.h

class SPIClass {
};

extern SPIClass SPI;
</pre>
// SPI.cpp

#include "SPI.h"

SPIClass SPI;

I had already used the MPU-6000 (gyroscope and accelerometer) and HMC5883L (magnetometer) in other projects so getting them working was fairly straight forward.  I don’t know why the HMC5883L I2C address is 0x1E but this works reliably and the expected address 0x3C dosn’t work at all.  It is disappointing that the ArduIMU uses I2C for the HMC5883L and SPI for the MPU-6000 rather than sharing I2C as this wastes 3 I/O!  I started by plotting the individual sensor values in real-time using a C# app I wrote.  It was Immediately obvious that there are communication errors on both the SPI and I2C bus causing random spikes in the data.  I’ve seen these kinds of errors before and suspect it is due to poor electrical design or poor peripheral configuration.  I’m not so impressed with the ArduIMU design and suspect the forma.

Spikes in Gyroscope Datahttp://dev-blog.mimugloves.com/wp-content/uploads/2013/01/Spikes-in-Gyroscope-Data-300x200.png 300w" sizes="(max-width: 600px) 100vw, 600px" />

Redesigning the ArduIMU PCB and manufacturing our own version in small volumes would defeat the purpose of using a low-cost, off-the-shelf board so we are just going to have to work around these errors.  The spikes are probably going to be an issue for the drum beat detection algorithm Tom and I wrote. Fortunately, these errors would not be too much of an issue for a AHRS algorithm so I wrapped up one of my open-source AHRS algorithms in C++ and went straight for the finishing line.  I was really impressed with how well it worked.  I was previously worried that the 16 MHz 8-bit Arduino would struggle but it was updating the algorithm and sending all data at 100 Hz with around 40% idle time!

The ArduIMU gloves are developing quickly and will soon be able to do everything Imogen’s gloves.  All that remains is to…

  • Calibrated the gyroscope, accelerometer and magnetometer
  • Got the RGB LED and vibration motor working
  • Work with Tom to integrate the ArduIMU gloves with Glover

3 Comments so far

  1. oliver loyau on August 24th, 2013

    Hi,

    I am working on a little project with ArduIMUV3 and FreeIMU software, it seems I have got strange results in quaternions output:
    http://sdrv.ms/13MUINd
    q0 is sometimes negative, also my objective is to detect full rotations and I cannot differentiate a change in the direction of a rotation around an axis from the sensor passing at 90° because in both cases values start decreasing.

    So I was wondering if you could share your code to output quaternions, so that I can check I get the same behaviour or if this is the freeimu softaware that gives that kind of values.

    Thanks a lot,

    Best Regards,

  2. Seb Madgwick on October 1st, 2013

    Hi Oliver, The occasional negative values you see are probably irrelevant, the information contained in the quaternion is the same. The same applies to the Euler angles. I can’t give a full explanation here, I suggest you Google ‘Euler angles’ and ‘quaternions’ to get a better understanding of how there representations should be interpreted.

    There are some posts (including code) of quaternions and IMU/AHRS algorithm on my site:
    http://www.x-io.co.uk/category/open-source/

  3. William Simetin-Grenon on October 15th, 2013

    Where can I download the Glover software, I don’t find it anywhere ! And what are the other software that they use in the video on this page ? I will need them very shortly !

    Thank you !

Leave a Reply