08-august/src/math/vector4f.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53

#include "vector4f.h"
#include <SDL2/SDL.h>

vec4_t vec4_add(const vec4_t* a, const vec4_t* b)
{
    vec4_t c;
    c.x = a->x + b->x;
    c.y = a->y + b->y;
    c.z = a->z + b->z;
    c.w = a->w + b->w;
    return c;
}

vec4_t vec4_sub(const vec4_t* a, const vec4_t* b)
{
    vec4_t c;
    c.x = a->x - b->x;
    c.y = a->y - b->y;
    c.z = a->z - b->z;
    c.w = a->w - b->w;
    return c;
}

vec4_t vec4_scalar_mul(const vec4_t* a, GLfloat scalar)
{
    vec4_t c;
    c.x = a->x * scalar;
    c.y = a->y * scalar;
    c.z = a->z * scalar;
    c.w = a->w * scalar;
    return c;
}

GLfloat vec4_dot_mul(const vec4_t* a, const vec4_t* b)
{
    return ( (a->x * b->x) + (a->y * b->y) + (a->z * b->z) + (a->w * b->w) );
}

GLfloat vec4_length(vec4_t* a)
{
    return SDL_sqrtf(SDL_pow(a->x, 2.0f) + SDL_pow(a->y, 2.0f) + SDL_pow(a->z, 2.0f) + SDL_pow(a->w, 2.0f) );
}

vec4_t vec4_normalize(vec4_t* a)
{
    vec4_t b;
    GLfloat length = vec4_length(a);
    b.x = a->x / length;
    b.y = a->y / length;
    b.z = a->z / length;
    b.w = a->w / length;
    return b;
}