openGL position and orientation from modelview matrix

10,208

If you have the modelview matrix of the object you can extract the position with the following code:

// ... Some rotations/translations has been applied
GLfloat matrix[16]; 
glGetFloatv (GL_MODELVIEW_MATRIX, matrix);
const float position_x = matrix[12];
const float position_y = matrix[13];
const float position_z = matrix[14];

The rotation is a little bit more complex, look at: euler angles. The rotation matrix we want is the transpose of the zyx-one =>

//c1 = cos(alignment_x)
//c2 = cos(alignment_y)
//c3 = cos(alignment_z)
//s1 = sin(alignment_x)
//s2 = sin(alignment_y)
//s3 = sin(alignment_z)
//matrix[0] = c1 * c2
//matrix[1] = -c2 * s1
//matrix[2] = s2
//matrix[4] = c3 * s1 + c1 * s2 * s3
//matrix[5] = c1 * c3 - s1 * s2 * s3
//matrix[6] = -c2 * s3
//matrix[8] = s1 * s3 - c1 * c3 * s2
//matrix[9] = c3 * s1 * s2 + c1 * s3
//matrix[10] = c2 * c3

Extracting the actual angles from this is rather messy because there are a couple of singularities, if we ignore these we get:

// Assumes c2 != 0, you'll need more code to handle the special cases
if (matrix[0] != 0.0f || matrix[1] != 0.0f) {
    const float alignment_x = atanf(-matrix[1], matrix[0]);
    float c2;
    if (0 != cosf(alignment_x)) {
        c2 = matrix(0) / cosf(alignment_x);
    } else {
        c2 = matrix(1) / -sinf(alignment_x);
    }
    const float alignment_y = atanf(matrix[2], c2);
    const float alignment_z = atanf(-matrix[6], matrix[10]);
} else {
    alignment_y = atanf(matrix[2], 0);
    //Too tired to deduce alignment_x and alignment_z, someone else?
}

All the above code assumes you're only using rotations/translations and no scalings or skewings.

Let me just finish by saying euler angles are evil, if I were you I would look for an alternative solution to whatever problem it is you're trying to solve ;)

/A.B.

Share:
10,208
Adam Loska
Author by

Adam Loska

Updated on June 04, 2022

Comments

  • Adam Loska
    Adam Loska almost 2 years

    My problem is the following:

    I have nested object in my opengl scene, and i only know their relative position and orientation.

    How do I get the absolute position and orientation of the inner object? I' thinking of calculating the modelview matrix of the inner object, and after that i have the current matrix, but how do i convert it to position and orientation? In other words, to two float vector, so I can call the following code:

    glTranslatef(position.x,position.y,position.z);
    
    glRotatef(alignment.x,1.0f,0.0f,0.0f);
    glRotatef(alignment.y,0.0f,1.0f,0.0f);
    glRotatef(alignment.z,0.0f,0.0f,1.0f);
    

    Thanks in advance!