Design, Build, Test, Iterate

Orientation Kinematics with Direction Cosine Matrices

In a sentence, a direction cosine matrix is a 3×3 matrix containing the cosines between each of the 9 possible pairs of axes of two separate Cartesian coordinate systems.

In the context of inertial measurement units in robotics applications, a 3D vector could be represented in either the global (earth) or the body (local) frames of reference. For example, the location of an end effector may be represented as <1, 0, 0> in the body frame but have different and changing x, y, and z components in the global frame, and vice versa.

My OpenGL visualization of the DCM.

My OpenGL visualization of the DCM.

There is plenty of documentation on direction cosine matrices available on the web:

But the gist of it is that in talking about DCMs, we are considering only very small intervals of time, on the order of milliseconds. Certain assumptions can be made. Within these timeframes:

If, in sketching out various DCMs, matrices and vectors on paper in an effort to understand what is going on, you notice that you are drawing vectors in any more dimensions than one (maybe two, definitely not three), stop.

All you should need is this rotation matrix calculated from gyro outputs:

Math.

Math.

I’ve implemented this in imu.cpp (with lots of in-line documentation) for my tricopter on my github repository. (This is a direct link to the file, but it might break if I ever decide to change the filename.)

Update the DCM fast enough (50 to 200 Hz?) with the rotation matrix, and provided your gyro isn’t drifting too badly, the DCM should be fairly accurate even without input from an accelerometer and magnetometer.



2 Comments

  1. Leonardo Garberoglio says:

    Hi, it seems to be a really cool gui, are you sharing it?
    regards!

  2. Tim Painter says:

    Hi
    As a mechanical engineer trying to visualize what a rotation matrix is ,your sketch diagram suddenly made it all come into clear focus.
    Thanks
    Tim Painter

Leave a Reply

Your email address will not be published. Required fields are marked *

You may use these HTML tags and attributes: <a href="" title=""> <abbr title=""> <acronym title=""> <b> <blockquote cite=""> <cite> <code> <del datetime=""> <em> <i> <q cite=""> <strike> <strong>