
Tags: algorithm, dcm, integration, orientation
Permalink Reply by Scott Harris on February 9, 2011 at 12:41pm Yup. That's the idea. We know the DCM "lives in" SO(3), so the discrete integrator should preserve this. The Euler method doesn't preserve this symmetry, hence the need to renormalize.
The exponential of a matrix is just like the the exponential of a number:
exp(A)=1+A+A^2/2+...A^n/n!+...
What is going on in the Euler integrator is that the DCM is getting updated by multiplying by (1+\Omega). This is just the first two terms in the Taylor expansion for exp(\Omega). Unfortunately, the determinant of (1+\Omega) is not one, so the SO(3) symmetry is violated.
Adding more terms does beat the error down, but doesn't eliminate it. The trick is to get an approximate matrix that's fast to compute and conserves SO(3) from the get-go.
There is a closed form for exp(\Omega), but it is a bit messy with sinh and cosh terms. So from a practical point of view it's not the way to go on small processors, but I use it in Matlab.
However, there are better integrators that do preserve SO(3), I'm playing with them, but again, they may only be of pedagogical value in this application.
In the case of a free body, integrators have other problems like not conserving energy either. That's why nobody integrates the solar system with Euler. Things blow up. Euler's method is really only good as an example method, and it should almost never be used in practice.
I'll type up some notes soon.
Permalink Reply by Roy Brewer on February 9, 2011 at 4:45pm Scott,
I am a big fan of pedagogy! I'm looking forward to reading your notes.
The invariant observer I was talking about is described in this thesis (and the referenced papers by Bonnabel, Martin, and Rouchon) http://cas.ensmp.fr/Publications/Publications/Dissertations_files/S..., if you are interested.
- Roy
Permalink Reply by Kanishka on February 27, 2012 at 5:53pm Hi Bill,
I came across the discussions on this site with a great interest.
And would like to thank you for your great effort you have put on this subject.
I am just a learner and in one point it seems like I lost the track in some aspects
I have 2 questions (I know they are really stupid questions but still couldn't understand it properly).
Really do appreciate if you can help me out with this.
1. When we say body fixed frame we think that the aircraft is steady and the reference frame is rotating. right ?
According to the youtube video http://www.youtube.com/watch?v=E7XVvv8XHgI
after the first turn (2. Do a quick roll of 180 degrees.) instead of having a roll how the plane takes a 180 turn around the pitch axis. I just realized that this happens if we define roll, pitch and yaw in the inertial frame instead of the body frame. ( is that the way it considered ? ) if its so can you please explain why ( because aircraft pitch gyro always measure the rotation around the pitch axis ie the gyro is fixed to the body)
2. Regarding the non commutativeness how do you address this with DCM. When we measure some rotations on body frame at a time by changing the reference frame how can we overcome the problem.
add :Does it helps to convert the frame conversion when correcting the gyro drift which is measured in body fixed frame by the help of accelerometer inputs measured in inertial frame
Thanks a lot again in advance for your time and appreciate your help a lot.
The difference for what I'm understanding here is that DCM will compute with axis rotating along with the object and Direct Integration will use a reference static initial axis, is that correct ?
Permalink Reply by Jason Dorie on March 1, 2012 at 1:06pm Yes, that's correct. Rotations are not commutative, but direct integration assumes they are - it takes many small rotations and simply adds them to a running total for each axis. Since the order of those rotations is important, the end result can be anywhere from "mostly right" to "grossly incorrect", depending on the set of rotations applied.
The DCM applies each small rotation sample and applies it to a rotating reference frame, so the order of operations is preserved.
Permalink Reply by Martin Seven on August 1, 2010 at 10:00am
Permalink Reply by Hassan Azeem on September 12, 2010 at 2:11pm
Permalink Reply by Fabien Bruning on December 10, 2010 at 5:19pm Hey , do you still have this file?
It sounds very useful to have a Matlab implementation with graphical output.
Thanks in advance!
Permalink Reply by Rich Weaver on December 10, 2010 at 5:46pm You may also find Paul Bizard's link on the UAVDevBoard Home page useful:
http://gentlenav.googlecode.com/files/SfunctionsPaulBizard.zip
and Paul's "Matlab/Simulink/AVL simulator" forum discussion
Permalink Reply by Fabien Bruning on December 13, 2010 at 4:54pm Ah thanks, I'll take a look!
Season Two of the Trust Time Trial (T3) Contest has now begun. The fourth round is an accuracy round for multicopters, which requires contestants to fly a cube. The deadline is April 14th.24 members
184 members
87 members
51 members
682 members
© 2013 Created by Chris Anderson.
Powered by
