Code covered by the BSD License  

Highlights from
Dual quaternion toolbox

5.0

5.0 | 4 ratings Rate this file 34 Downloads (last 30 days) File Size: 217 KB File ID: #39288
image thumbnail

Dual quaternion toolbox

by

 

04 Dec 2012 (Updated )

This toolbox provides dual quaternion methods, focusing on 3D kinematics for points and lines.

| Watch this File

File Information
Description

The toolbox provides functions to (see the related journal article: http://www.frontiersin.org/Behavioral_Neuroscience/10.3389/fnbeh.2013.00007/abstract) :
   - encode dual quaternions: a point position, velocity, a line position, velocity, a rotation, a translation, a screw,...
   - do operations on dual quaternions: the dual quaternion multiplication, the dual quaternion conjugates, the inverse,...
   - retrieve parameters from a dual quaternion: finding the parameters of a rotation dual quaternion, or a screw dual quaternion,...
   - easily going back and forth between Fick rotation coordinates, 3*3 rotation matrices, rotation dual quaternions, angular vector
   - find the shortest rotation between two unitary vectors
   - find the shortest screw motion between two lines (it answers if two lines intersect, and if relevant, what the intersection point is)
The toolbox also provides one example file (example_forward_kinematics.m) (see also the file "html/example_forward_kinematics.html"). This
example describes the forward kinematics of the end-effector of a two- or three-link arm in 3D space. The user can choose between two methods
(alternating rotation and translation dual quaternions, or using screw motion dual quaternions) to encode the forward kinematics: the results are
identical, whatever the method which is used. Furthermore, for the three-link arm, the orientation of the end-effector is also taken into account
(via line transformations).

For each of these methods and example, the user will find an extensive documentation by typing HELP NAME_OF_THE_FUNCTION in the MATLAB environment

Acknowledgements

This file inspired Dual Quaternion Symbolic Toolbox.

Required Products MATLAB
MATLAB release MATLAB 7.10 (R2010a)
Tags for This File   Please login to tag files.
Please login to add a comment or rating.
Comments and Ratings (13)
24 Jun 2014 Walter Markus

Good toolbox.

Is shortestRotation not handling (anti)parallel vectors for a reason?

If no, then you could add something like
what is done in rotationTo() in src/gl-matrix/quat.js on
https://github.com/toji/gl-matrix

26 Mar 2014 Guillaume Leclercq

Thanks for noticing this bug.
I just updated the rotMatrix2dquat function. Now it deals with 180deg angles, and it implements the efficient method in Funda et al. (1990) such that the method is accurate and efficient even for angles close to 0 or 180 deg.

25 Mar 2014 Raviteja Vemulapalli

In the file rotMatrix2dquat, when DQ0 is zero, the quaternion has Inf values (because of division by DQ0).

18 Feb 2014 Hanfucius

Thanks for your splendid reply~
I did not get direct answer in your paper and thus got confused.
Surely I've read many geometric algebra books and I know that quaternion is isomorphic to G+3,0,0 and i,j,k is indeed another representation 2-blade bases of this geometric algebra. However,never did I paid attention to handedness of the coordinates.
Though we use the same mathematical tool,we use different mathematical conventions in your bio science and my robotics. I think this is the reason why gap happens.
Thanks again for your reply!

18 Feb 2014 Guillaume Leclercq

It is true that in many books, it is indeed a + instead of a - just before the cross product. However, this is because the historical basis for quaternions is a left-handed basis (the famous i, j, k and their relationship).

Here, we use a right-handed basis, that's why the sign is different (thus this is not a mistake). Actually, you can find a proof of the derivation of this expression in the article http://www.frontiersin.org/Behavioral_Neuroscience/10.3389/fnbeh.2013.00007/abstract : at p3 of the paper, we explain the quaternion product and refer to appendix A where we derive the expression from the concepts of geometric algebra.

Actually, using the left-handed basis (and thus the + sign), you have to exchange the dual quaterniopn and its conjugate in the kinematics expression to retrieve the same results.

13 Feb 2014 Hanfucius

I think you have made a mistake.
In function Qmult,line 49,I refered many books,

sv = repmat(r0,3,1).*qv+repmat(q0,3,1).*rv-cross(qv,rv);

should be

sv = repmat(r0,3,1).*qv+repmat(q0,3,1).*rv+cross(qv,rv);

21 Jan 2014 Hanfucius

Sorry to have done such stupid things as modify your code and redistribute it. I have delete all of them.

06 Sep 2013 Guillaume Leclercq

For details on the example, you can read section 3.2.1 of the article that you can freely download here: http://www.frontiersin.org/Behavioral_Neuroscience/10.3389/fnbeh.2013.00007/abstract
In particular, take a look on equation 18 (p10). Actually we can not simply reverse the conjugates as we like (thus it is quite normal that you obtain a different result): You may want to read sections 2.4 and 2.5 of the same article, for more details about the kinematic transformations.

06 Sep 2013 Hanfucius

In kinematics example file, why the total transformation is multiplied in reverse order?
Also why DQconj comes first?
S_tot = DQmult(R_LU,T_ES,R_UB);
P_BS_dq = DQmult(DQconj(S_tot),P_LE_dq,S_tot);

I tried this :
S_tot = DQmult(R_UB,T_ES,R_LU);
P_BS_dq = DQmult(S_tot,P_LE_dq,DQconj(S_tot));
But the answer is different.

05 Sep 2013 Guillaume Leclercq

That's because you need to specify two output arguments. I modified this file such that an error is generated if the wrong number of output arguments is specified: it should be here in a few days (once Matlab will have reviewed it).

05 Sep 2013 Hanfucius

Why function dquat2line loses a vector?

>> line2dquat([1 2 3],[4 5 6])

ans =

0
0.2673
0.5345
0.8018
0
0.8018
-1.6036
0.8018

>> dquat2line(ans)

ans =

0.2673
0.5345
0.8018

02 Sep 2013 Guillaume Leclercq

Thanks.
The toolbox is not intended for symbolic computing. However, feel free to inspire from the toolbox to develop your own symbolic toolbox

02 Sep 2013 Hanfucius

This is very useful and I use it a lot.
The question is, can this toolbox be used in the area of symbolic computing?

Updates
04 Sep 2013

I provided the link (in the description) towards the journal publication linked to these methods.

05 Sep 2013

I modified the following files:
- dquat2line
- dquat2linevel
- dquat2screw
- rotMatrix2fick
such that these functions return an error if the wrong number of output arguments is specified by the user.

26 Mar 2014

function rotMatrix2dquat updated, such that it deals with 180 deg rotations and implements the method described in https://www.researchgate.net/publication/3298038_On_homogeneous_transforms_quaternions_and_computationalefficiency

Contact us