I have encountered a rather theoretical problem upon using the Drake library. My robot consists of a free body base (floating base), which has a traditional robot arm attached to it consisting of joints and links.
So let's say, that the generalized state vector for this robot is of size 63. (got from Drake). The first 7 entries of this state vector are the 3 Cartesian positions and the 4 quaternions for the orientation. That means, that the generalized velocity vector is 62 (6 entries for linear and angular velocity). If I construct my state vector based on the order scheme described earlier (firstly the 3 positions, secondly the 4 quaternions and then the 56 joint states of the robot arm) and then set the position of the robot accordingly, then Drake runs and does not give any errors.
However, taking the Jacobian of the end effector of the robot gives a strange mismatch. It seems to me, that when getting the Jacobian x_dot = J * q_dot with the CalcJacobianTranslationalVelocity command, the order of the generalized velocity vector is swapped. To be more precise, the order is:
I am quite confused by this, since I could manipulate and set the robot's state using SetPositions and SetVelocities with the state & velocity vectors where the points 1. and 2. from the above list were swapped.
Am I missing something?
Thank You in advance for any help,
Best regards,
Robert
We follow the convention that angular quantities precede translational quantities. For a floating base that means the four quaternions come before the xyz translations, just as you saw for the velocities.