flightsim/plane.cpp at main · beefhands/flightsim · GitHub

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
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
/**
 * plane.cpp
 * -------------------------------
 * See plane.h for all method documentation
 *
 * @author Paul Lambert
 * @note CS418
 * @see plane.h
 */

#include "plane.h"

Plane::Plane(GLfloat initial[], float velocity,
        GLfloat v_up[], GLfloat v_forward[], GLfloat v_right[])
{
    this->position = initial;
    this->velocity = velocity;
    this->v_up = v_up;
    this->v_forward = v_forward;
    this->v_right = v_right;
}

void Plane::move()
{
    position = wizard->add_v(position, wizard->mult_v(v_forward, velocity));
}

void Plane::roll(float theta)
{
    GLfloat *cos_term = wizard->mult_v(v_right, cos(theta));
    GLfloat *sin_term = wizard->mult_v(v_up, sin(theta));
    GLfloat *unit_sum = wizard->unit_v(wizard->add_v(cos_term, sin_term));

    v_right[0] = unit_sum[0];
    v_right[1] = unit_sum[1];
    v_right[2] = unit_sum[2];


    // up = right X forward
    GLfloat *cross = wizard->cross_product(v_right, v_forward);

    v_up[0] = cross[0];
    v_up[1] = cross[1];
    v_up[2] = cross[2];
}
void Plane::pitch(float theta)
{
    GLfloat *pre_normalized =
        wizard->add_v(
                wizard->mult_v(v_forward, cos(theta)),
                wizard->mult_v(v_up, sin(theta))
                );

    GLfloat *f = wizard->unit_v(pre_normalized);
    v_forward[0] = f[0];
    v_forward[1] = f[1];
    v_forward[2] = f[2];

    // up = right X forward
    GLfloat *u = wizard->cross_product(v_right, v_forward);
    v_up[0] = u[0];
    v_up[1] = u[1];
    v_up[2] = u[2];
}

void Plane::getPosition(GLfloat *look)
{
    look[0] = position[0];
    look[1] = position[1];
    look[2] = position[2];
}

void Plane::getDestination(GLfloat *dest)
{
    GLfloat *destVec = wizard->add_v(position, v_forward);
    dest[0] = destVec[0];
    dest[1] = destVec[1];
    dest[2] = destVec[2];
}

void Plane::getUp(GLfloat *up)
{
    up[0] = v_up[0];
    up[1] = v_up[1];
    up[2] = v_up[2];
}