vector3.cpp

来自「用于GPU通用计算的编程语言BrookGPU 0.4」· C++ 代码 · 共 44 行

/*
    Copyright (C) 1998,1999,2000 by Jorrit Tyberghein
    Largely rewritten by Ivan Avramovic <[e-mail]>
  
    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 "cs_compat.h"
#include "qint.h"
#include "qsqrt.h"
#include "csgeom/vector3.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 = (float)qisqrt (sqlen);
  *this *= invlen;
}


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