glc_camera.cpp

Go to the documentation of this file.

/****************************************************************************

 This file is part of the GLC-lib library.
 Copyright (C) 2005-2008 Laurent Ribon (laumaya@users.sourceforge.net)
 Copyright (C) 2009 Laurent Bauer
 Version 2.0.0 Beta 1, packaged on April 2010.

 http://glc-lib.sourceforge.net

 GLC-lib is free software; you can redistribute it and/or modify
 it under the terms of the GNU General Public License as published by
 the Free Software Foundation; either version 2 of the License, or
 (at your option) any later version.

 GLC-lib is distributed in the hope that it will be useful,
 but WITHOUT ANY WARRANTY; without even the implied warranty of
 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 GNU General Public License for more details.

 You should have received a copy of the GNU General Public License
 along with GLC-lib; if not, write to the Free Software
 Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA

*****************************************************************************/


#include "glc_camera.h"

#include <QtDebug>

using namespace glc;
// Constructor Destructor
GLC_Camera::GLC_Camera()
: GLC_Object("Camera")
, m_Eye(0,0,1)
, m_Target()
, m_VectUp(Y_AXIS)
, m_MatCompOrbit()
, m_DefaultVectUp(Y_AXIS)
{

}

GLC_Camera::GLC_Camera(const GLC_Point3d &Eye, const GLC_Point3d &Target, const GLC_Vector3d &Up)
: GLC_Object("Camera")
, m_Eye()
, m_Target()
, m_VectUp()
, m_MatCompOrbit()
, m_DefaultVectUp(Y_AXIS)
{
        setCam(Eye, Target, Up);
        createMatComp();
}

// Copy constructor
GLC_Camera::GLC_Camera(const GLC_Camera& cam)
: GLC_Object(cam)
, m_Eye(cam.m_Eye)
, m_Target(cam.m_Target)
, m_VectUp(cam.m_VectUp)
, m_MatCompOrbit(cam.m_MatCompOrbit)
, m_DefaultVectUp(cam.m_DefaultVectUp)
{

}

// Get Functions

// equality operator
bool GLC_Camera::operator==(const GLC_Camera& cam) const
{
        return (m_Eye == cam.m_Eye) && (m_Target == cam.m_Target)
                        && (m_VectUp == cam.m_VectUp) && (m_DefaultVectUp == cam.m_DefaultVectUp);
}


// Set Functions
GLC_Camera& GLC_Camera::orbit(GLC_Vector3d VectOldPoss, GLC_Vector3d VectCurPoss)
{
        // Map Vectors
        GLC_Matrix4x4 invMat(m_MatCompOrbit);
        invMat.invert();
        VectOldPoss= invMat * VectOldPoss;
        VectCurPoss= invMat * VectCurPoss;

        // Compute rotation matrix
        const GLC_Vector3d VectAxeRot(VectCurPoss ^ VectOldPoss);
        // Check if rotation vector is not null
        if (!VectAxeRot.isNull())
        {  // Ok, is not null
                const double Angle= acos(VectCurPoss * VectOldPoss);
                const GLC_Matrix4x4 MatOrbit(VectAxeRot, Angle);

                // Camera transformation
                m_Eye= (MatOrbit * (m_Eye - m_Target)) + m_Target;
                m_VectUp= MatOrbit * m_VectUp;
                createMatComp();
        }

        return *this;
}

GLC_Camera& GLC_Camera::pan(GLC_Vector3d VectDep)
{
        // Vector mapping
        GLC_Matrix4x4 invMat(m_MatCompOrbit);
        invMat.invert();
        VectDep= invMat * VectDep;

        // Camera transformation
        m_Eye= m_Eye + VectDep;
        m_Target= m_Target + VectDep;

        return *this;
}

GLC_Camera& GLC_Camera::zoom(double factor)
{
        Q_ASSERT(factor > 0);
        // Eye->target vector
        GLC_Vector3d VectCam(m_Eye - m_Target);

        // Compute new vector length
        const double Norme= VectCam.length() * 1 / factor;
        VectCam.setLength(Norme);

        m_Eye= VectCam + m_Target;

        return *this;
}

// Move camera
GLC_Camera& GLC_Camera::move(const GLC_Matrix4x4 &MatMove)
{
        m_Eye= MatMove * m_Eye;
        m_Target= MatMove * m_Target;
        m_VectUp= MatMove.rotationMatrix() * m_VectUp;
        createMatComp();

        return *this;
}

// Rotate around an axis
GLC_Camera& GLC_Camera::rotateAround(const GLC_Vector3d& axis, const double& angle, const GLC_Point3d& point)
{
        const GLC_Matrix4x4 rotationMatrix(axis, angle);
        translate(-point);
        move(rotationMatrix);
        translate(point);

        return *this;
}

// Rotate around camera target
GLC_Camera& GLC_Camera::rotateAroundTarget(const GLC_Vector3d& axis, const double& angle)
{
        GLC_Point3d target(m_Target);
        rotateAround(axis, angle, target);

        return *this;
}

GLC_Camera& GLC_Camera::translate(const GLC_Vector3d &VectTrans)
{
        m_Eye= m_Eye + VectTrans;
        m_Target= m_Target + VectTrans;

        return *this;
}

GLC_Camera& GLC_Camera::setEyeCam(const GLC_Point3d &Eye)
{
        // Old camera's vector
        GLC_Vector3d VectOldCam(m_Eye - m_Target);
        // New camera's vector
        GLC_Vector3d VectCam(Eye - m_Target);
        if ( !(VectOldCam - VectCam).isNull() )
        {
                VectOldCam.setLength(1);
                VectCam.setLength(1);
                const double Angle= acos(VectOldCam * VectCam);
                if ( !qFuzzyCompare(Angle, 0.0) && !qFuzzyCompare(PI - Angle, 0.0))
                {
                        const GLC_Vector3d VectAxeRot(VectOldCam ^ VectCam);
                        const GLC_Matrix4x4 MatRot(VectAxeRot, Angle);
                        m_VectUp= MatRot * m_VectUp;
                }
                else
                {
                        if ( qFuzzyCompare(PI - Angle, 0.0))
                        {       // Angle de 180%
                                m_VectUp.invert();
                        }
                }

                setCam(Eye, m_Target, m_VectUp);
        }

        return *this;
}

GLC_Camera& GLC_Camera::setTargetCam(const GLC_Point3d &Target)
{
        // Old camera's vector
        GLC_Vector3d VectOldCam(m_Eye - m_Target);
        // New camera's vector
        GLC_Vector3d VectCam(m_Eye - Target);
        if ( !(VectOldCam - VectCam).isNull() )
        {
                VectOldCam.setLength(1);
                VectCam.setLength(1);
                const double Angle= acos(VectOldCam * VectCam);
                if ( !qFuzzyCompare(Angle, 0.0) && !qFuzzyCompare(PI - Angle, 0.0))
                {
                        const GLC_Vector3d VectAxeRot(VectOldCam ^ VectCam);
                        const GLC_Matrix4x4 MatRot(VectAxeRot, Angle);
                        m_VectUp= MatRot * m_VectUp;
                }
                else
                {
                        if ( qFuzzyCompare(PI - Angle, 0.0))
                        {       // Angle of 180%
                                m_VectUp.invert();
                        }
                }

                setCam(m_Eye, Target, m_VectUp);
        }

        return *this;
}

GLC_Camera& GLC_Camera::setUpCam(const GLC_Vector3d &Up)
{
        if ( !(m_VectUp - Up).isNull() )
        {
                if (!qFuzzyCompare(forward().angleWithVect(Up), 0.0))
                {
                        setCam(m_Eye, m_Target, Up);
                }
        }

        return *this;
}

GLC_Camera& GLC_Camera::setCam(GLC_Point3d Eye, GLC_Point3d Target, GLC_Vector3d Up)
{
        Up.setLength(1);

        const GLC_Vector3d VectCam((Eye - Target).setLength(1));
        const double Angle= acos(VectCam * Up);

        /* m_VectUp and VectCam could not be parallel
         * m_VectUp could not be NULL
         * VectCam could not be NULL */
        //Q_ASSERT((Angle > EPSILON) && ((PI - Angle) > EPSILON));

        if ( !qFuzzyCompare(Angle - (PI / 2), 0.0))
        {       // Angle not equal to 90¡
                const GLC_Vector3d AxeRot(VectCam ^ Up);
                GLC_Matrix4x4 MatRot(AxeRot, PI / 2);
                Up= MatRot * VectCam;
        }

        m_Eye= Eye;
        m_Target= Target;
        m_VectUp= Up;
        createMatComp();

        return *this;
}

GLC_Camera& GLC_Camera::setCam(const GLC_Camera& cam)
{
        m_Eye= cam.m_Eye;
        m_Target= cam.m_Target;
        m_VectUp= cam.m_VectUp;
        m_MatCompOrbit= cam.m_MatCompOrbit;

        return *this;
}


GLC_Camera& GLC_Camera::setDistEyeTarget(double Longueur)
{
    GLC_Vector3d VectCam(forward());
    VectCam.setLength(Longueur);
    m_Eye= m_Target - VectCam;

    return *this;
}
GLC_Camera& GLC_Camera::setDistTargetEye(double Longueur)
{
    GLC_Vector3d VectCam(forward());
    VectCam.setLength(Longueur);
    m_Target= m_Eye + VectCam;

    return *this;
}

// Assignment operator
GLC_Camera &GLC_Camera::operator=(const GLC_Camera& cam)
{
        GLC_Object::operator=(cam);
        m_Eye= cam.m_Eye;
        m_Target= cam.m_Target;
        m_VectUp= cam.m_VectUp;
        m_MatCompOrbit= cam.m_MatCompOrbit;
        m_DefaultVectUp= cam.m_DefaultVectUp;

        return *this;
}
// almost equality (Bauer Laurent)
bool GLC_Camera::isAlmostEqualTo(const GLC_Camera& cam, const double distanceAccuracy) const
{
      GLC_Vector3d incident1 = m_Target - m_Eye;
      GLC_Vector3d incident2 = cam.m_Target - cam.m_Eye;

      double allowedGap =  incident1.length() * distanceAccuracy;
      GLC_Point3d left1 = incident1 ^ m_VectUp;
      GLC_Point3d left2 = incident2 ^ cam.m_VectUp;

      return ((m_Eye - cam.m_Eye).length() < allowedGap ) && ( (m_Target - cam.m_Target).length() < allowedGap)
                  && ((left1 - left2).length() < allowedGap) ;
}

// Return the standard front view form this camera
GLC_Camera GLC_Camera::frontView() const
{
        GLC_Vector3d eye;

        if (m_DefaultVectUp == glc::Z_AXIS)
        {
                eye.setVect(0.0, -1.0, 0.0);
        }
        else // Y_AXIS or X_AXIS
        {
                eye.setVect(0.0, 0.0, 1.0);
        }
        eye= eye + m_Target;

        GLC_Camera newCam(eye, m_Target, m_DefaultVectUp);
        newCam.setDistEyeTarget(distEyeTarget());
        newCam.setDefaultUpVector(m_DefaultVectUp);
        return newCam;
}

// Return the standard rear view form this camera
GLC_Camera GLC_Camera::rearView() const
{
        return frontView().rotateAroundTarget(m_DefaultVectUp, glc::PI);
}

// Return the standard right view form this camera
GLC_Camera GLC_Camera::rightView() const
{
        return frontView().rotateAroundTarget(m_DefaultVectUp, glc::PI / 2.0);}

// Return the standard left view form this camera
GLC_Camera GLC_Camera::leftView() const
{
        return frontView().rotateAroundTarget(m_DefaultVectUp, - glc::PI / 2.0);
}

// Return the standard top view form this camera
GLC_Camera GLC_Camera::topView() const
{
        GLC_Vector3d eye= m_DefaultVectUp;
        eye= eye + m_Target;
        GLC_Vector3d up;

        if (m_DefaultVectUp == glc::Y_AXIS)
        {
                up.setVect(0.0, 0.0, -1.0);
        }
        else // Z_AXIS or X_AXIS
        {
                up.setVect(0.0, 1.0, 0.0);
        }

        GLC_Camera newCam(eye, m_Target, up);
        newCam.setDistEyeTarget(distEyeTarget());
        newCam.setDefaultUpVector(m_DefaultVectUp);

        return newCam;
}

// Return the standard bottom view form this camera
GLC_Camera GLC_Camera::bottomView() const
{
        GLC_Camera newCam(topView());
        newCam.rotateAroundTarget(newCam.upVector(), glc::PI);

        return newCam;
}

// Return the standard isoview from his camera
GLC_Camera GLC_Camera::isoView() const
{
        GLC_Vector3d eye;
        if (m_DefaultVectUp == glc::Z_AXIS)
        {
                eye.setVect(-1.0, -1.0, 1.0);
        }
        else if (m_DefaultVectUp == glc::Y_AXIS)
        {
                eye.setVect(-1.0, 1.0, 1.0);
        }
        else
        {
                eye.setVect(1.0, 1.0, 1.0);
        }

        eye= eye + m_Target;

        GLC_Camera newCam(eye, m_Target, m_DefaultVectUp);
        newCam.setDistEyeTarget(distEyeTarget());
        newCam.setDefaultUpVector(m_DefaultVectUp);
        return newCam;
}

// OpenGL Functions
void GLC_Camera::glExecute()
{
        gluLookAt(m_Eye.x(), m_Eye.y(), m_Eye.z(),
                m_Target.x(), m_Target.y(), m_Target.z(),
                m_VectUp.x(), m_VectUp.y(), m_VectUp.z());
}

// Private services Functions

void GLC_Camera::createMatComp(void)
{
        const GLC_Vector3d forward((m_Target - m_Eye).normalize());
        const GLC_Vector3d side((forward ^ m_VectUp).normalize());

        // Update camera matrix
        m_MatCompOrbit.data()[0]= side.x();
        m_MatCompOrbit.data()[4]= side.y();
        m_MatCompOrbit.data()[8]= side.z();
        m_MatCompOrbit.data()[12]= 0.0;

        // Vector Up is Y Axis
        m_MatCompOrbit.data()[1]= m_VectUp.x();
        m_MatCompOrbit.data()[5]= m_VectUp.y();
        m_MatCompOrbit.data()[9]= m_VectUp.z();
        m_MatCompOrbit.data()[13]= 0.0;

        // Vector Cam is Z axis
        m_MatCompOrbit.data()[2]= - forward.x();
        m_MatCompOrbit.data()[6]= - forward.y();
        m_MatCompOrbit.data()[10]= - forward.z();
        m_MatCompOrbit.data()[14]= 0.0;

        m_MatCompOrbit.data()[3]= 0.0;
        m_MatCompOrbit.data()[7]= 0.0;
        m_MatCompOrbit.data()[11]= 0.0;
        m_MatCompOrbit.data()[15]= 1.0;

}