Discussions

Open Source Attitude Estimation Code with Euler Angle and Quaternion Support

Posted by Caleb Chamberlain on February 9, 2011 at 4:11pm

Hey everyone. I recently finished a new AHRS (see the picture below). The firmware is open-source, and I thought it might be interesting to you guys. The firmware supports EKF-based Euler Angle and Quaternion estimation, depending on what you want to use (you can estimate using euler angles if you want to limit the magnetometer so that it only affects yaw). For anyone who wants to write their own estimation code, the UM6 firmware might be a good starting place.

Sourceforge project: https://sourceforge.net/projects/um6firmware/

The source code can be checked out using SVN with:

svn co https://um6firmware.svn.sourceforge.net/svnroot/um6firmware/trunk

You need to be a member of diydrones to add comments!

Join diydrones

ekf, angles, euler, quaternions

Email me when people reply –

Replies

Nikola Rabchevsky April 13, 2014 at 8:02am

Is the source code for the most recent firmware (UM3?) and version 3.0.x of the CHR Serial interface program available anywhere? Seems like the Sourceforge repositories are a bit out of date.
Alex October 10, 2011 at 7:28am

Attitude estimation ONLY 3axis ACCELEROMETERS.

Dear DIYdrones friends,

I'm looking for an Attitude Estimation algorithm, and only have 3 axis accelerometers. I know this will may not be optimal, and will be slow. But, if you know an algorithm, forum topic, or wiki how to set this up for my limited arduino hardware please tell me.

Thanks!
Bot Thoughts September 25, 2011 at 8:28pm

I'm probably going to be working on something similar over the next few months. Maybe even with the 6DM that I bought. If I ever have something to show for my efforts, will let you know. :)
Michael Zaffuto February 9, 2011 at 5:56pm

I noticed your firmware was developed with Raisonance Ride7? The produced hex file appears to be greater than 32KB, the limit for their low cost R-Link Standard for debugging. Is it true that you may not be able to debug programs greater than 32KB, but program uploading with rlink std does not have that limitation? Are you using the R-Link Pro? BTW, thank you for posting your code, real operational EKF code like this (especially with your selection of sensors...which I'm fond of) can be a great learning tool for innumberable students/hobbyists/professionals.
Caleb Chamberlain February 9, 2011 at 4:13pm

As an added note, the UM6 doesn't do anything to compensate for centripetal acceleration right now. There are a bunch of extra pins routed out through two 2x6 2mm headers on the bottom of the sensor, so GPS and airspeed could easily be brought in. If anyone wants to work on centripetal compensation code, I'll give you a UM6 and create a SVN branch for you. Let me know if you are interested.