blob: da644fda11f514687152575c6f0a8def58b13afd (
plain)
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
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
|
#include "vector.h"
void vect_to_rect(vector *v)
{
if(v->type == RECT)
return;
switch(v->type)
{
case SPH:
{
vector old = *v;
v->type = RECT;
v->rect.x = old.sph.r * cos(old.sph.elevation) * sin(old.sph.azimuth);
v->rect.y = old.sph.r * sin(old.sph.elevation);
v->rect.z = old.sph.r * cos(old.sph.elevation) * cos(old.sph.azimuth);
break;
}
}
}
void vect_to_sph(vector *v)
{
if(v->type == SPH)
return;
switch(v->type)
{
case RECT:
{
vector old = *v;
v->type = SPH;
v->sph.r = vect_abs(&old);
v->sph.elevation = atan2(old.rect.y, sqrt(old.rect.x*old.rect.x + old.rect.z*old.rect.z));
v->sph.azimuth = atan2(old.rect.z, old.rect.x);
break;
}
}
}
scalar vect_abs(const vector *v)
{
switch(v->type)
{
case SPH:
return v->sph.r;
case RECT:
return sqrt(v->rect.x * v->rect.x + v->rect.y * v->rect.y + v->rect.z * v->rect.z);
}
}
void vect_mul(vector *v, scalar s)
{
switch(v->type)
{
case SPH:
v->sph.r *= s;
break;
case RECT:
v->rect.x *= s;
v->rect.y *= s;
v->rect.z *= s;
break;
}
}
void vect_add(vector *v1, const vector *v2)
{
int old_type = v1->type;
vector tmp1 = *v1;
vector tmp2 = *v2;
vect_to_rect(&tmp1);
vect_to_rect(&tmp2);
tmp1.rect.x += tmp2.rect.x;
tmp1.rect.y += tmp2.rect.y;
tmp1.rect.z += tmp2.rect.z;
*v1 = tmp1;
if(old_type == SPH)
vect_to_sph(v1);
}
void vect_negate(vector *v)
{
switch(v->type)
{
case SPH:
v->sph.r = -v->sph.r;
break;
case RECT:
v->rect.x = -v->rect.x;
v->rect.y = -v->rect.y;
v->rect.z = -v->rect.z;
break;
}
}
/* v1 = v1 - v2 */
void vect_sub(vector *v1, const vector *v2)
{
vector neg = *v2;
vect_negate(&neg);
vect_add(v1, &neg);
}
scalar vect_dot(const vector *v1, const vector *v2)
{
vector a = *v1, b = *v2;
vect_to_rect(&a);
vect_to_rect(&b);
return a.rect.x * b.rect.x + a.rect.y * b.rect.y + a.rect.z * b.rect.z;
}
|
