tools/quake2/common/mathlib.c

   1 /*
   2 Copyright (C) 1999-2007 id Software, Inc. and contributors.
   3 For a list of contributors, see the accompanying CONTRIBUTORS file.
   4
   5 This file is part of GtkRadiant.
   6
   7 GtkRadiant is free software; you can redistribute it and/or modify
   8 it under the terms of the GNU General Public License as published by
   9 the Free Software Foundation; either version 2 of the License, or
  10 (at your option) any later version.
  11
  12 GtkRadiant is distributed in the hope that it will be useful,
  13 but WITHOUT ANY WARRANTY; without even the implied warranty of
  14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15 GNU General Public License for more details.
  16
  17 You should have received a copy of the GNU General Public License
  18 along with GtkRadiant; if not, write to the Free Software
  19 Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  20 */
  21 // mathlib.c -- math primitives
  22
  23 #include "cmdlib.h"
  24 #include "mathlib.h"
  25
  26 vec3_t vec3_origin = {0,0,0};
  27
  28
  29 double VectorLength(vec3_t v)
  30 {
  31         int             i;
  32         double  length;
  33
  34         length = 0;
  35         for (i=0 ; i< 3 ; i++)
  36                 length += v[i]*v[i];
  37         length = sqrt (length);         // FIXME
  38
  39         return length;
  40 }
  41
  42 qboolean VectorCompare (vec3_t v1, vec3_t v2)
  43 {
  44         int             i;
  45
  46         for (i=0 ; i<3 ; i++)
  47                 if (fabs(v1[i]-v2[i]) > EQUAL_EPSILON)
  48                         return false;
  49
  50         return true;
  51 }
  52
  53 vec_t Q_rint (vec_t in)
  54 {
  55         return floor (in + 0.5);
  56 }
  57
  58 void VectorMA (vec3_t va, double scale, vec3_t vb, vec3_t vc)
  59 {
  60         vc[0] = va[0] + scale*vb[0];
  61         vc[1] = va[1] + scale*vb[1];
  62         vc[2] = va[2] + scale*vb[2];
  63 }
  64
  65 void CrossProduct (vec3_t v1, vec3_t v2, vec3_t cross)
  66 {
  67         cross[0] = v1[1]*v2[2] - v1[2]*v2[1];
  68         cross[1] = v1[2]*v2[0] - v1[0]*v2[2];
  69         cross[2] = v1[0]*v2[1] - v1[1]*v2[0];
  70 }
  71
  72 vec_t _DotProduct (vec3_t v1, vec3_t v2)
  73 {
  74         return v1[0]*v2[0] + v1[1]*v2[1] + v1[2]*v2[2];
  75 }
  76
  77 void _VectorSubtract (vec3_t va, vec3_t vb, vec3_t out)
  78 {
  79         out[0] = va[0]-vb[0];
  80         out[1] = va[1]-vb[1];
  81         out[2] = va[2]-vb[2];
  82 }
  83
  84 void _VectorAdd (vec3_t va, vec3_t vb, vec3_t out)
  85 {
  86         out[0] = va[0]+vb[0];
  87         out[1] = va[1]+vb[1];
  88         out[2] = va[2]+vb[2];
  89 }
  90
  91 void _VectorCopy (vec3_t in, vec3_t out)
  92 {
  93         out[0] = in[0];
  94         out[1] = in[1];
  95         out[2] = in[2];
  96 }
  97
  98 void _VectorScale (vec3_t v, vec_t scale, vec3_t out)
  99 {
 100         out[0] = v[0] * scale;
 101         out[1] = v[1] * scale;
 102         out[2] = v[2] * scale;
 103 }
 104
 105 vec_t VectorNormalize (vec3_t in, vec3_t out)
 106 {
 107         vec_t   length, ilength;
 108
 109         length = sqrt (in[0]*in[0] + in[1]*in[1] + in[2]*in[2]);
 110         if (length == 0)
 111         {
 112                 VectorClear (out);
 113                 return 0;
 114         }
 115
 116         ilength = 1.0/length;
 117         out[0] = in[0]*ilength;
 118         out[1] = in[1]*ilength;
 119         out[2] = in[2]*ilength;
 120
 121         return length;
 122 }
 123
 124 vec_t ColorNormalize (vec3_t in, vec3_t out)
 125 {
 126         float   max, scale;
 127
 128         max = in[0];
 129         if (in[1] > max)
 130                 max = in[1];
 131         if (in[2] > max)
 132                 max = in[2];
 133
 134         if (max == 0)
 135                 return 0;
 136
 137         scale = 1.0 / max;
 138
 139         VectorScale (in, scale, out);
 140
 141         return max;
 142 }
 143
 144
 145
 146 void VectorInverse (vec3_t v)
 147 {
 148         v[0] = -v[0];
 149         v[1] = -v[1];
 150         v[2] = -v[2];
 151 }
 152
 153 void ClearBounds (vec3_t mins, vec3_t maxs)
 154 {
 155         mins[0] = mins[1] = mins[2] = 99999;
 156         maxs[0] = maxs[1] = maxs[2] = -99999;
 157 }
 158
 159 void AddPointToBounds (vec3_t v, vec3_t mins, vec3_t maxs)
 160 {
 161         int             i;
 162         vec_t   val;
 163
 164         for (i=0 ; i<3 ; i++)
 165         {
 166                 val = v[i];
 167                 if (val < mins[i])
 168                         mins[i] = val;
 169                 if (val > maxs[i])
 170                         maxs[i] = val;
 171         }
 172 }