Games/XInvaders3D/vec4x1.c

   1 /*------------------------------------------------------------------
   2   vec4x1.c:
   3
   4     XINVADERS 3D - 3d Shoot'em up
   5     Copyright (C) 2000 Don Llopis
   6
   7     This program 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     This program 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 this program; if not, write to the Free Software
  19     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  20
  21 ------------------------------------------------------------------*/
  22 #include <stdio.h>
  23 #include <stdlib.h>
  24 #include <string.h>
  25 #include <memory.h>
  26 #include <math.h>
  27
  28 #include "vec4x1.h"
  29
  30 /*================================================================*/
  31
  32 void Vector_init ( VECTOR4 a )
  33 {
  34    a[0] = a[1] = a[2] = 0.0f;
  35    a[3] = 1.0f;
  36 }
  37
  38 /*================================================================*/
  39
  40 void Vector_set ( VECTOR4 a, float x, float y, float z )
  41 {
  42    a[0] = x;
  43    a[1] = y;
  44    a[2] = z;
  45    a[3] = 1.0f;
  46 }
  47
  48 /*================================================================*/
  49
  50 void Vector_copy ( VECTOR4 a, VECTOR4 b )
  51 {
  52    memcpy ( b, a, sizeof ( VECTOR4 ) );
  53 }
  54
  55 /*================================================================*/
  56
  57 void Vector_print ( VECTOR4 a )
  58 {
  59    fprintf ( stderr, "%5.5f %5.5f %5.5f\n", a[0], a[1], a[2] );
  60 }
  61
  62 /*================================================================*/
  63
  64 void Vector_negate ( VECTOR4 a )
  65 {
  66    a[0] *= -1.0f;
  67    a[1] *= -1.0f;
  68    a[2] *= -1.0f;
  69 }
  70
  71 /*================================================================*/
  72
  73 void Vector_add ( VECTOR4 a, VECTOR4 b, VECTOR4 c )
  74 {
  75    c[0] = a[0] + b[0];
  76    c[1] = a[1] + b[1];
  77    c[2] = a[2] + b[2];
  78 }
  79
  80 void Vector_addd ( VECTOR4 a, VECTOR4 b )
  81 {
  82    a[0] = a[0] + b[0];
  83    a[1] = a[1] + b[1];
  84    a[2] = a[2] + b[2];
  85 }
  86
  87 /*================================================================*/
  88
  89 void Vector_sub ( VECTOR4 a, VECTOR4 b, VECTOR4 c )
  90 {
  91    c[0] = a[0] - b[0];
  92    c[1] = a[1] - b[1];
  93    c[2] = a[2] - b[2];
  94 }
  95
  96 void Vector_subb ( VECTOR4 a, VECTOR4 b )
  97 {
  98    a[0] = a[0] - b[0];
  99    a[1] = a[1] - b[1];
 100    a[2] = a[2] - b[2];
 101 }
 102
 103 /*================================================================*/
 104
 105 void Vector_cross ( VECTOR4 a, VECTOR4 b, VECTOR4 c )
 106 {
 107    c[0] = ( a[1] * b[2] ) - ( a[2] * b[1] );
 108    c[1] = ( a[2] * b[0] ) - ( a[0] * b[2] );
 109    c[2] = ( a[0] * b[1] ) - ( a[1] * b[0] );
 110 }
 111
 112 /*================================================================*/
 113
 114 float Vector_mag ( VECTOR4 a )
 115 {
 116    return (float) sqrt ( ( a[0] * a[0] + a[1] * a[1] + a[2] * a[2] ) );
 117 }
 118
 119 float Vector_mag_squared ( VECTOR4 a )
 120 {
 121    return ( a[0] * a[0] + a[1] * a[1] + a[2] * a[2] );
 122 }
 123
 124
 125 /*================================================================*/
 126
 127 float Vector_dist ( VECTOR4 a, VECTOR4 b )
 128 {
 129    float x, y, z;
 130
 131    x = b[0] - a[0];
 132    y = b[1] - a[1];
 133    z = b[2] - a[2];
 134
 135    return (float) sqrt ( (x*x) + (y*y) + (z*z) );
 136 }
 137
 138 /*================================================================*/
 139
 140 float Vector_dist_squared ( VECTOR4 a, VECTOR4 b )
 141 {
 142    float x, y, z;
 143
 144    x = b[0] - a[0];
 145    y = b[1] - a[1];
 146    z = b[2] - a[2];
 147
 148    return ( (x*x) + (y*y) + (z*z) );
 149 }
 150
 151 /*================================================================*/
 152
 153 float Vector_dot ( VECTOR4 a, VECTOR4 b )
 154 {
 155    return ( (a[0] * b[0]) + (a[1] * b[1]) + (a[2] * b[2]) );
 156 }
 157
 158 /*================================================================*/
 159
 160 void Vector_norm ( VECTOR4 a )
 161 {
 162    float len;
 163
 164    len = (float) sqrt ( (a[0] * a[0]) + (a[1] * a[1]) + (a[2] * a[2]) );
 165
 166    a[0] /= len;
 167    a[1] /= len;
 168    a[2] /= len;
 169 }
 170
 171 /*================================================================*/
 172
 173 void Vector_scale ( VECTOR4 a, float s )
 174 {
 175    a[0] *= s;
 176    a[1] *= s;
 177    a[2] *= s;
 178 }
 179
 180 /*================================================================*/