OpenRaider/src/Camera.cpp

/*!
 * \file src/Camera.cpp
 * \brief OpenGL camera class
 *
 * \author Mongoose
 */

#include <stdio.h>
#include <math.h>

#include "utils/math.h"
#include "Camera.h"

Camera::Camera() {
    mFlags = 0;
    mViewDistance = 14.0f;
    mTranslateDelta = 256.0f;
    mRotateDelta = HEL_DEG_TO_RAD(15.0f);
    mRotateDelta2 = HEL_DEG_TO_RAD(5.0f);
    mFlags &= Camera_FlyMode;
    reset();
}

void Camera::getPosition(vec3_t pos) {
    pos[0] = mPos[0];
    pos[1] = mPos[1];
    pos[2] = mPos[2];
}

void Camera::getUp(vec3_t up) {
    up[0] = mUp[0];
    up[1] = mUp[1];
    up[2] = mUp[2];
}

void Camera::getTarget(vec3_t target) {
    target[0] = mTarget[0];
    target[1] = mTarget[1];
    target[2] = mTarget[2];
}

float Camera::getYaw() {
    return HEL_RAD_TO_DEG(mTheta);
}

vec_t Camera::getRadianYaw() {
    return mTheta;
}

vec_t Camera::getRadianPitch() {
    return mTheta2;
}

void Camera::rotate(float angle, float x, float y, float z) {
    Quaternion t, n;
    Matrix matrix;
    vec_t side[4] = { 1.0f, 0.0f,  0.0f, 1.0f };
    vec_t up[4] =   { 0.0f, 1.0f,  0.0f, 1.0f };
    vec_t look[4] = { 0.0f, 0.0f, -1.0f, 1.0f };
    unsigned int i;
    matrix_t m;

    t.set(angle, x, y, z);
    n = mQ * t;
    n.normalize();

    n.getMatrix(m);
    matrix.setMatrix(m);
    matrix.multiply4v(side, mSide);
    matrix.multiply4v(look, mTarget);
    matrix.multiply4v(up, mUp);

    for (i = 0; i < 3; ++i) {
        mSide[i] += mPos[i];
        mTarget[i] += mPos[i];
        mUp[i] += mPos[i];
    }

    mQ = n;
}

void Camera::translate(float x, float y, float z) {
    int i;
    vec_t result[4];
    vec_t v[4];
    matrix_t m;
    Matrix matrix;

    v[0] = x;
    v[1] = y;
    v[2] = -z;
    v[3] = 1;

    m[0] = mSide[0] - mPos[0];
    m[1] = mUp[0] - mPos[0];
    m[2] = mTarget[0] - mPos[0];
    m[3] = 0;
    m[4] = mSide[1] - mPos[1];
    m[5] = mUp[1] - mPos[1];
    m[6] = mTarget[1] - mPos[1];
    m[7] = 0;
    m[8] = mSide[2] - mPos[2];
    m[9] = mUp[2] - mPos[2];
    m[10] = mTarget[2] - mPos[2];
    m[11] = 0;
    m[12] = 0;
    m[13] = 0;
    m[14] = 0;
    m[15] = 1;

    matrix.setMatrix(m);
    matrix.multiply4v(v, result);

    for (i = 0; i < 3; ++i) {
        mSide[i] += result[i];
        mUp[i] += result[i];
        mTarget[i] += result[i];
        mPos[i] += result[i];
    }

    mPos[0] = x;
    mPos[1] = y;
    mPos[2] = z;
}

void Camera::reset() {
    mTheta = 0.0f;
    mTheta2 = 0.0f;

    mPos[0] = 0.0f;
    mPos[1] = 0.0f;
    mPos[2] = 0.0f;

    mTarget[0] = 0.0f;
    mTarget[1] = 0.0f;
    mTarget[2] = mViewDistance;

    mSide[0] = 1.0f;
    mSide[1] = 0.0f;
    mSide[2] = 0.0f;

    mUp[0] = 0.0f;
    mUp[1] = 1.0f;
    mUp[2] = 0.0f;

    mQ.setIdentity();
    translate(0.0f, 0.0f, 0.0f);
}

void Camera::setSensitivityY(float angle) {
    mRotateDelta2 = HEL_DEG_TO_RAD(angle);
}

void Camera::setSensitivityX(float angle) {
    mRotateDelta = HEL_DEG_TO_RAD(angle);
}

void Camera::command(enum camera_command cmd) {
    switch (cmd) {
        case CAMERA_MOVE_FORWARD:
            if (mFlags & Camera_FlyMode)
                mPos[2] += (mTranslateDelta * cosf(mTheta));

            mPos[0] += (mTranslateDelta * sinf(mTheta));
            mPos[1] += (mTranslateDelta * sinf(mTheta2));
            break;
        case CAMERA_MOVE_BACKWARD:
            if (mFlags & Camera_FlyMode)
                mPos[2] -= (mTranslateDelta * cosf(mTheta));

            mPos[0] -= (mTranslateDelta * sinf(mTheta));
            mPos[1] -= (mTranslateDelta * sinf(mTheta2));
            break;
        case CAMERA_MOVE_LEFT:
            mPos[0] -= (mTranslateDelta * sinf(mTheta - 90.0f));
            mPos[2] -= (mTranslateDelta * cosf(mTheta - 90.0f));
            break;
        case CAMERA_MOVE_RIGHT:
            mPos[0] -= (mTranslateDelta * sinf(mTheta + 90.0f));
            mPos[2] -= (mTranslateDelta * cosf(mTheta + 90.0f));
            break;
        case CAMERA_ROTATE_UP:
            if (mTheta2 < (M_PI / 2)) {
                mTheta2 += mRotateDelta2;
                rotate(mTheta2, 1.0f, 0.0f, 0.0f);
            }
            break;
        case CAMERA_ROTATE_DOWN:
            if (mTheta2 > -(M_PI / 2)) {
                mTheta2 -= mRotateDelta2;
                rotate(mTheta2, 1.0f, 0.0f, 0.0f);
            }
            break;
        case CAMERA_ROTATE_RIGHT:
            mTheta += mRotateDelta;
            rotate(mTheta, 0.0f, 1.0f, 0.0f);
            break;
        case CAMERA_ROTATE_LEFT:
            mTheta -= mRotateDelta;
            rotate(mTheta, 0.0f, 1.0f, 0.0f);
            break;
        case CAMERA_MOVE_UP:
            mPos[1] -= mTranslateDelta / 2.0f;
            mTarget[1] -= mTranslateDelta / 2.0f;
            break;
        case CAMERA_MOVE_DOWN:
            mPos[1] += mTranslateDelta / 2.0f;
            mTarget[1] += mTranslateDelta / 2.0f;
            break;
        case CAMERA_SPEED_UP:
            ++mTranslateDelta;
            break;
        case CAMERA_SPEED_DOWN:
            if (--mTranslateDelta < 0.0f)
                mTranslateDelta = 1.0f;
            break;
    }
}

void Camera::setSpeed(float s) {
    mTranslateDelta = s;
}

void Camera::update() {
    mTarget[2] = (mViewDistance * cosf(mTheta)) + mPos[2];
    mTarget[0] = (mViewDistance * sinf(mTheta)) + mPos[0];
    mTarget[1] = (mViewDistance * sinf(mTheta2)) + mPos[1]; // + height_offset;
}

void Camera::setPosition(vec3_t pos) {
    mPos[0] = pos[0];
    mPos[1] = pos[1];
    mPos[2] = pos[2];
}

void Camera::setUp(vec3_t up) {
    mUp[0] = up[0];
    mUp[1] = up[1];
    mUp[2] = up[2];
}

void Camera::setTarget(vec3_t target) {
    mTarget[0] = target[0];
    mTarget[1] = target[1];
    mTarget[2] = target[2];
}