opvector3.cpp

Go to the documentation of this file.

/*
    Copyright (C) 1998,1999,2000 by Jorrit Tyberghein
    Largely rewritten by Ivan Avramovic <ivan@avramovic.com>
  
    This library is free software; you can redistribute it and/or
    modify it under the terms of the GNU Library 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
    Library General Public License for more details.
  
    You should have received a copy of the GNU Library General Public
    License along with this library; if not, write to the Free
    Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

#include <math.h>
#include <float.h>
#include "cmd/collide2/opcodesysdef.h"
#include "cmd/collide2/opcodeqint.h"
#include "cmd/collide2/opcodeqsqrt.h"
#include "opvector3.h"

//---------------------------------------------------------------------------

float csVector3::Norm () const
{ 
  return qsqrt (x*x + y*y + z*z); 
}

void csVector3::Normalize ()
{
  float sqlen = x*x + y*y + z*z;
  if (sqlen < SMALL_EPSILON) return;
  float invlen = qisqrt (sqlen);
  *this *= invlen;
}


//---------------------------------------------------------------------------