vos/corelibs/tracking/mock_orientation.cc

Go to the documentation of this file.

/*
    This file is part of the Virtual Object System of
    the Interreality project (http://interreality.org).

    Copyright (C) 2002  Reed Hedges

    This software was written at the University of Massachusetts with
    support from NSF grant #EIA 9703217

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

    This library 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
    Lesser General Public License for more details.

    You should have received a copy of the GNU Lesser General Public
    License along with this library; if not, write to the Free Software
    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307  USA

    Reed Hedges <reed@interreality.org>
*/



#include "mock_orientation.hh"


MockOrientation::MockOrientation() : yawAngle(0), pitchAngle(0), rollAngle(0)
{
    for(int i = 0; i < 3; i++) 
        for(int j = 0; j < 3; j++) 
            matrix[i][j] = 0;
}


void MockOrientation::getOrientationMatrix(double mat[3][3]) 
{
    for(int i = 0; i < 3; i++) 
        for(int j = 0; j < 3; j++) 
            mat[i][j] = matrix[i][j];
}

void MockOrientation::setOrientationMatrix(double mat[3][3])
{
    for(int i = 0; i < 3; i++) 
        for(int j = 0; j < 3; j++) 
            matrix[i][j] = mat[i][j];
}

    

void MockOrientation::getEulerAngles(double* yaw, double* pitch, double* roll)
{
    *yaw  = yawAngle + eulerYawOffset;
    *pitch = pitchAngle +  eulerPitchOffset;
    *roll = rollAngle + eulerRollOffset;

}

void MockOrientation::setEulerAnglres(double yaw, double pitch, double roll) {
    yawAngle = yaw;
    pitchAngle = pitch;
    rollAngle = roll;
}

---