K3dDistance.h

Go to the documentation of this file.

/***************************************************************************
 *   Copyright (C) 2007 by Jan Koci   *
 *   honza.koci@email.cz   *
 *   http://kengine.sourceforge.net/tutorial/
 *                                                                         *
 *   This program 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.                                   *
 *                                                                         *
 *   This program 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 this program; if not, write to the                         *
 *   Free Software Foundation, Inc.,                                       *
 *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
 ***************************************************************************/

#pragma once

#include "K3dVector3.h"
#include "../Geometry/K3dRay.h"
#include "../Geometry/K3dPlane.h"
#include "../System/GameData/K3dGameData.h"
#include "../System/Worker/K3dVector3Work.h"

class K3dDistance
{
                K3dGameData *m_pGameData;       
        public:
                K3dDistance ( K3dGameData *_pGameData );
                ~K3dDistance();

                float Points ( const K3dVector3Obj &_rkV0, const K3dVector3Obj &_rkV1 )
                {
                        // Calculate vector between two points
                        K3dVector3Obj kV;
                        kV = m_pGameData->GetVector3Work()->VectorBetween ( _rkV0, _rkV1 );
                        // Return vector length
                        return m_pGameData->GetVector3Work()->Length ( kV );
                }

                float SqrPointRay ( const K3dVector3Obj &_rkPoint,const K3dRay &_rkRay, float* _pfParam=NULL )
                {
                        float fDotMM;
                        float fT = ( float ) 0;
                        K3dVector3Obj kDiff;

                        //kDiff = kRay.Origin() - kPoint;
                        kDiff = _rkPoint - *_rkRay.GetOrigin();
                        fT = m_pGameData->GetVector3Work()->Dot ( kDiff, *_rkRay.GetDirection() );


                        if ( fT <= ( float ) 0.0 )
                        {
                                fT = ( float ) 0.0;
                        }
                        else
                        {
                                fDotMM = m_pGameData->GetVector3Work()->SquaredLength ( *_rkRay.GetDirection() );
                                if ( fDotMM )
                                {
                                        fT = fT / fDotMM;
                                        kDiff -= *_rkRay.GetDirection() *fT;
                                }
                        }

                        if ( _pfParam )
                                *_pfParam = fT;

                        return m_pGameData->GetVector3Work()->SquaredLength ( kDiff );

                }

                int PointPlane ( const K3dPlane &_rkPlane,const K3dVector3 &_rkPoint )
                {
                        float fD;
                        K3dVector3 kNormal = *_rkPlane.GetNormal();
                        // Calculate distance from  plane
                        fD = kNormal[0] * _rkPoint[0] +
                             kNormal[1] * _rkPoint[1] +
                             kNormal[2] * _rkPoint[2] - _rkPlane.GetDistance();

                        return ( int ) fD;
                }

                int DistLinePlane ( const K3dPlane &_rkPlane, const K3dVector3 &_rkLineOrigin, const K3dVector3 &_rkLineDirection )
                {
                        // Calculate distance plane and line origin point
                        float fDistOrigin = PointPlane ( _rkPlane, _rkLineOrigin );
                        // Calculate distance plane and line direction point
                        float fDistDirection = PointPlane ( _rkPlane, _rkLineDirection );
                        // If sign of origin and direction is equal then return false
                        // Ray direction outside of plane
                        int iSignOrigin = ( int ) K3dMath::Sign ( fDistOrigin );
                        int iSignDirection = ( int ) K3dMath::Sign ( fDistDirection );
                        // If line lies on plane front side return 1
                        // If line lies on plane back side return -1
                        if ( iSignOrigin == iSignDirection )
                        {
                                return iSignOrigin;
                        }
                        else
                        {
                                // If line intersect the plane return 0
                                return 0;
                        }
                }

};

---