从GLKQuaternion中提取的意外滚动和俯仰

时间:2016-11-24 20:15:39

标签: ios scenekit quaternions core-motion

我使用CMAttitude中的四元数来旋转SceneKit相机。 另外我需要使用从四元数中提取的Y旋转角度。 我预计它会滚动,但是在提取之后Y旋转角度对应于具有-90:90范围的间距。 如何将此范围转换为0:180或0:360?

- (SCNQuaternion)SCNQuaternionFromCMQuaternion:(CMQuaternion)q {

    GLKQuaternion Q = GLKQuaternionMake(q.x, q.y, q.z, q.w);
    GLKQuaternion xRotQ = GLKQuaternionMakeWithAngleAndAxis(-M_PI_2, 1, 0, 0);
    Q = GLKQuaternionMultiply(xRotQ, Q);

    double roll = atan2(2.0 * (Q.y * Q.z - Q.w * Q.x), 1.0 - 2.0 * (Q.x * Q.x + Q.y * Q.y)); // 0:180 but around X

    double pitch = RADIANS_TO_DEGREES(asin(-2.0f * (Q.x * Q.z + Q.w * Q.y))); // 0:90 around Y

    NSLog(@"%f", pitch);
    // ...

    CMQuaternion rq = {.x = Q.x, .y = Q.y, .z = Q.z, .w = Q.w};

    return SCNVector4Make(rq.x, rq.y, rq.z, rq.w);
}

1 个答案:

答案 0 :(得分:1)

我发现了这种方式:

- (SCNQuaternion)SCNQuaternionFromCMQuaternion:(CMQuaternion)q {

    GLKQuaternion Q = GLKQuaternionMake(q.x, q.y, q.z, q.w);
    GLKQuaternion xRotQ = GLKQuaternionMakeWithAngleAndAxis(-M_PI_2, 1, 0, 0);
    Q = GLKQuaternionMultiply(xRotQ, Q);

    double gx = 2.0 * (Q.y * Q.w - Q.x * Q.z);
    //double gy = 2.0 * (Q.x * Q.y + Q.z * Q.w);
    double gz = Q.x * Q.x - Q.y * Q.y - Q.z * Q.z + Q.w * Q.w;

    double pitch = RADIANS_TO_DEGREES(-asin( -2.0 * (Q.y * Q.w - Q.x * Q.z))); 

    if (gx >= 0 && gz < 0)
        pitch = 180 - pitch;
    else if (gx < 0 && gz < 0)
        pitch = 180 - pitch;
    else if (gx < 0 && gz >= 0)
        pitch = 360 + pitch;

    NSLog(@"%f", pitch); // now it has 0-360 range

    CMQuaternion rq = {.x = Q.x, .y = Q.y, .z = Q.z, .w = Q.w};

    return SCNVector4Make(rq.x, rq.y, rq.z, rq.w);
}