Merge branch 'master' into martin-t/globals
[xonotic/xonotic-data.pk3dir.git] / qcsrc / lib / vector.qh
1 #pragma once
2
3 noref vector _vlen2;
4 #define vlen2(v) (_vlen2 = (v), dotproduct(_vlen2, _vlen2))
5
6 #if 1
7 noref float _vdist_f;
8 /** Vector distance comparison, avoids sqrt() */
9 #define vdist(v, cmp, f) (vlen2(v) cmp (_vdist_f = (f), _vdist_f * _vdist_f))
10 #else
11 #define vdist(v, cmp, f) (vlen(v) cmp (f))
12 #endif
13
14 #if 1
15 #define dotproduct(a, b) ((a) * (b))
16 #else
17 noref vector _dotproduct_a, _dotproduct_b;
18 #define dotproduct(a, b) \
19         (_dotproduct_a = (a), _dotproduct_b = (b), \
20           _dotproduct_a.x * _dotproduct_b.x \
21         + _dotproduct_a.y * _dotproduct_b.y \
22         + _dotproduct_a.z * _dotproduct_b.z)
23 #endif
24
25 #if 1
26 #define cross(a, b) ((a) >< (b))
27 #else
28 ERASEABLE
29 vector cross(vector a, vector b)
30 {
31         return
32                 '1 0 0' * (a.y * b.z - a.z * b.y)
33         +       '0 1 0' * (a.z * b.x - a.x * b.z)
34         +       '0 0 1' * (a.x * b.y - a.y * b.x);
35 }
36 #endif
37
38 noref vector _vmul_a, _vmul_b;
39 #define vmul(a, b) \
40     (_vmul_a = (a), _vmul_b = (b), \
41           '1 0 0' * (_vmul_a.x * _vmul_b.x) \
42         + '0 1 0' * (_vmul_a.y * _vmul_b.y) \
43         + '0 0 1' * (_vmul_a.z * _vmul_b.z))
44
45 const vector eX = '1 0 0';
46 const vector eY = '0 1 0';
47 const vector eZ = '0 0 1';
48
49 ERASEABLE
50 vector randompos(vector m1, vector m2)
51 {
52         vector v;
53         m2 = m2 - m1;
54         v_x = m2_x * random() + m1_x;
55         v_y = m2_y * random() + m1_y;
56         v_z = m2_z * random() + m1_z;
57         return v;
58 }
59
60 ERASEABLE
61 float vlen_maxnorm2d(vector v)
62 {
63         return max(v.x, v.y, -v.x, -v.y);
64 }
65
66 ERASEABLE
67 float vlen_minnorm2d(vector v)
68 {
69         return min(max(v.x, -v.x), max(v.y, -v.y));
70 }
71
72 ERASEABLE
73 float dist_point_line(vector p, vector l0, vector ldir)
74 {
75         ldir = normalize(ldir);
76
77         // remove the component in line direction
78         p = p - (p * ldir) * ldir;
79
80         // vlen of the remaining vector
81         return vlen(p);
82 }
83
84 /** requires that m2>m1 in all coordinates, and that m4>m3 */
85 ERASEABLE
86 float boxesoverlap(vector m1, vector m2, vector m3, vector m4) { return m2_x >= m3_x && m1_x <= m4_x && m2_y >= m3_y && m1_y <= m4_y && m2_z >= m3_z && m1_z <= m4_z; }
87
88 /** requires the same as boxesoverlap, but is a stronger condition */
89 ERASEABLE
90 float boxinsidebox(vector smins, vector smaxs, vector bmins, vector bmaxs) { return smins.x >= bmins.x && smaxs.x <= bmaxs.x && smins.y >= bmins.y && smaxs.y <= bmaxs.y && smins.z >= bmins.z && smaxs.z <= bmaxs.z; }
91
92 #define PITCH(v) ((v).x)
93 #define YAW(v) ((v).y)
94 #define ROLL(v) ((v).z)
95
96 //pseudo prototypes:
97 // vector vec2(vector v); // returns a vector with just the x and y components of the given vector
98 // vector vec2(float x, float y); // returns a vector with the given x and y components
99
100 noref vector _vec2;
101 #define vec2(...) EVAL(OVERLOAD(vec2, __VA_ARGS__))
102 #define vec2_1(v) (_vec2 = (v), _vec2.z = 0, _vec2)
103 #define vec2_2(x, y) (_vec2_x = (x), _vec2_y = (y), _vec2)
104
105 noref vector _vec3;
106 #define vec3(_x, _y, _z) (_vec3.x = (_x), _vec3.y = (_y), _vec3.z = (_z), _vec3)
107
108 #define VEC_NAN vec3(FLOAT_NAN, FLOAT_NAN, FLOAT_NAN);
109
110 ERASEABLE
111 bool is_all_nans(vector v) {
112         return isnan(v.x) && isnan(v.y) && isnan(v.z);
113 }
114
115 ERASEABLE
116 vector Rotate(vector v, float a)
117 {
118         float a_sin = sin(a), a_cos = cos(a);
119         return vec2(v.x * a_cos + v.y * a_sin, -v.x * a_sin + v.y * a_cos);
120 }
121
122 noref vector _yinvert;
123 #define yinvert(v) (_yinvert = (v), _yinvert.y = 1 - _yinvert.y, _yinvert)
124
125 /**
126  * @param dir the directional vector
127  * @param norm the normalized normal
128  * @returns dir reflected by norm
129  */
130 ERASEABLE
131 vector reflect(vector dir, vector norm)
132 {
133         return dir - 2 * (dir * norm) * norm;
134 }
135
136 /**
137  * clip vel along the plane defined by norm (assuming 0 distance away), bounciness determined by bounce 0..1
138  */
139 ERASEABLE
140 vector vec_reflect(vector vel, vector norm, float bounce)
141 {
142         return vel - (1 + bounce) * (vel * norm) * norm;
143 }
144
145 ERASEABLE
146 vector vec_epsilon(vector this, float eps)
147 {
148         if (this.x > -eps && this.x < eps) this.x = 0;
149         if (this.y > -eps && this.y < eps) this.y = 0;
150         if (this.z > -eps && this.z < eps) this.z = 0;
151         return this;
152 }
153
154 #define ClipVelocity(in, normal, out, overbounce) \
155         (out = vec_epsilon(vec_reflect(in, normal, (overbounce) - 1), 0.1))
156
157 #ifdef GAMEQC
158         ERASEABLE
159         vector get_corner_position(entity box, int corner)
160         {
161                 switch (corner)
162                 {
163                         case 1: return vec3(box.absmin.x, box.absmin.y, box.absmin.z);
164                         case 2: return vec3(box.absmax.x, box.absmin.y, box.absmin.z);
165                         case 3: return vec3(box.absmin.x, box.absmax.y, box.absmin.z);
166                         case 4: return vec3(box.absmin.x, box.absmin.y, box.absmax.z);
167                         case 5: return vec3(box.absmax.x, box.absmax.y, box.absmin.z);
168                         case 6: return vec3(box.absmin.x, box.absmax.y, box.absmax.z);
169                         case 7: return vec3(box.absmax.x, box.absmin.y, box.absmax.z);
170                         case 8: return vec3(box.absmax.x, box.absmax.y, box.absmax.z);
171                         default: return '0 0 0';
172                 }
173         }
174
175         ERASEABLE
176         vector NearestPointOnBox(entity box, vector org)
177         {
178                 vector m1 = box.mins + box.origin;
179                 vector m2 = box.maxs + box.origin;
180
181                 return vec3(
182                         bound(m1.x, org.x, m2.x),
183                         bound(m1.y, org.y, m2.y),
184                         bound(m1.z, org.z, m2.z)
185                 );
186         }
187 #endif