KNGeometricCoordination.cpp

Go to the documentation of this file.

#include "stdafx.h"
#include <math.h>
#include "KNGeometricCoordination.h"

CKNGeometricCoordination::CKNGeometricCoordination()
{
    m_fCoordination[_X] = 0;
    m_fCoordination[_Y] = 0;
    m_fCoordination[_Z] = 0;
}

CKNGeometricCoordination::~CKNGeometricCoordination()
{
}

void CKNGeometricCoordination::SetCoordination(double* pfCoordination)
{ 
    m_fCoordination[_X] = pfCoordination[0];
    m_fCoordination[_Y] = pfCoordination[1];
    m_fCoordination[_Z] = pfCoordination[2];
}

void CKNGeometricCoordination::SetCoordination(double fXCoordination, double fYCoordination, double fZCoordination)
{
    m_fCoordination[_X] = fXCoordination;
    m_fCoordination[_Y] = fYCoordination;
    m_fCoordination[_Z] = fZCoordination;
}

double CKNGeometricCoordination::GetCoordination(AXIS_DEFINE coord)
{
    return m_fCoordination[coord];
}

void CKNGeometricCoordination::Rotate(AXIS_DEFINE axis, double fDegree)
{
    switch (axis)
    {
    case _X:
        m_fCoordination[_Y] = m_fCoordination[_Y] * cos(fDegree) - m_fCoordination[_Z] * sin(fDegree);
        m_fCoordination[_Z] = m_fCoordination[_Y] * sin(fDegree) + m_fCoordination[_Z] * cos(fDegree);
        break;
    case _Y:
        m_fCoordination[_Z] = m_fCoordination[_Z] * cos(fDegree) - m_fCoordination[_X] * sin(fDegree);
        m_fCoordination[_X] = m_fCoordination[_Z] * sin(fDegree) + m_fCoordination[_X] * cos(fDegree);
        break;
    case _Z:
        m_fCoordination[_X] = m_fCoordination[_X] * cos(fDegree) - m_fCoordination[_Y] * sin(fDegree);
        m_fCoordination[_Y] = m_fCoordination[_X] * sin(fDegree) + m_fCoordination[_Y] * cos(fDegree);
        break;
    }
}

void CKNGeometricCoordination::SetOffset(CKNGeometricCoordination coord)
{
    SetOffset(coord.GetCoordination(_X), coord.GetCoordination(_Y), coord.GetCoordination(_Z));
}

void CKNGeometricCoordination::SetOffset(double fXCoordination, double fYCoordination, double fZCoordination)
{
    m_fCoordination[_X] += fXCoordination;
    m_fCoordination[_Y] += fYCoordination;
    m_fCoordination[_Z] += fZCoordination;
}

void CKNGeometricCoordination::SetRatio(double fRatio[3])
{
    m_fCoordination[_X] *= fRatio[_X];
    m_fCoordination[_Y] *= fRatio[_Y];
    m_fCoordination[_Z] *= fRatio[_Z];
}

bool CKNGeometricCoordination::IsSame(CKNGeometricCoordination compare)
{
    double          *fCompare = compare.GetCoordinationAll();
    double          fTolerance = 1e-8;

    if (fabs(m_fCoordination[_X] - fCompare[_X]) > fTolerance)
        return false;

    if (fabs(m_fCoordination[_Y] - fCompare[_Y]) > fTolerance)
        return false;

    if( fabs(m_fCoordination[_Z] - fCompare[_Z]) > fTolerance)
        return false;

    return true;
}

bool CKNGeometricCoordination::operator==(const CKNGeometricCoordination &compare)
{
    return IsSame(compare);
}

bool CKNGeometricCoordination::operator!=(const CKNGeometricCoordination &compare)
{
    return !IsSame(compare);
}