tools/quake2/common/mathlib.c

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