zbuffer done
[dosdemo] / libs / cgmath / cgmath.h
1 /* gph-cmath - C graphics math library
2  * Copyright (C) 2018 John Tsiombikas <nuclear@member.fsf.org>
3  *
4  * This program is free software. Feel free to use, modify, and/or redistribute
5  * it under the terms of the MIT/X11 license. See LICENSE for details.
6  * If you intend to redistribute parts of the code without the LICENSE file
7  * replace this paragraph with the full contents of the LICENSE file.
8  *
9  * Function prefixes signify the data type of their operand(s):
10  * - cgm_v... functions are operations on cgm_vec3 vectors
11  * - cgm_w... functions are operations on cgm_vec4 vectors
12  * - cgm_q... functions are operations on cgm_quat quaternions (w + xi + yj + zk)
13  * - cgm_m... functions are operations on 4x4 matrices (stored as linear 16 float arrays)
14  * - cgm_r... functions are operations on cgm_ray rays
15  *
16  * NOTE: *ALL* matrix arguments are pointers to 16 floats. Even the functions
17  * which operate on 3x3 matrices, actually use the upper 3x3 of a 4x4 matrix,
18  * and still expect an array of 16 floats.
19  *
20  * NOTE: matrices are treated by all operations as column-major, to match OpenGL
21  * conventions, so everything is pretty much transposed.
22 */
23 #ifndef CGMATH_H_
24 #define CGMATH_H_
25
26 #include <math.h>
27 #include <string.h>
28
29 #ifdef __WATCOMC__
30 #define inline __inline
31 #endif
32
33 typedef struct {
34         float x, y;
35 } cgm_vec2;
36
37 typedef struct {
38         float x, y, z;
39 } cgm_vec3;
40
41 typedef struct {
42         float x, y, z, w;
43 } cgm_vec4, cgm_quat;
44
45 typedef struct {
46         cgm_vec3 origin, dir;
47 } cgm_ray;
48
49 typedef enum cgm_euler_mode {
50         CGM_EULER_XYZ,
51         CGM_EULER_XZY,
52         CGM_EULER_YXZ,
53         CGM_EULER_YZX,
54         CGM_EULER_ZXY,
55         CGM_EULER_ZYX,
56         CGM_EULER_ZXZ,
57         CGM_EULER_ZYZ,
58         CGM_EULER_YXY,
59         CGM_EULER_YZY,
60         CGM_EULER_XYX,
61         CGM_EULER_XZX
62 } cgm_euler_mode;
63
64 #ifdef __cplusplus
65 extern "C" {
66 #endif
67
68 /* --- operations on cgm_vec3 --- */
69 static inline void cgm_vcons(cgm_vec3 *v, float x, float y, float z);
70
71 static inline void cgm_vadd(cgm_vec3 *a, const cgm_vec3 *b);
72 static inline void cgm_vsub(cgm_vec3 *a, const cgm_vec3 *b);
73 static inline void cgm_vmul(cgm_vec3 *a, const cgm_vec3 *b);
74 static inline void cgm_vscale(cgm_vec3 *v, float s);
75 static inline void cgm_vmul_m4v3(cgm_vec3 *v, const float *m);  /* m4x4 * v */
76 static inline void cgm_vmul_v3m4(cgm_vec3 *v, const float *m);  /* v * m4x4 */
77 static inline void cgm_vmul_m3v3(cgm_vec3 *v, const float *m);  /* m3x3 * v (m still 16 floats) */
78 static inline void cgm_vmul_v3m3(cgm_vec3 *v, const float *m);  /* v * m3x3 (m still 16 floats) */
79
80 static inline float cgm_vdot(const cgm_vec3 *a, const cgm_vec3 *b);
81 static inline void cgm_vcross(cgm_vec3 *res, const cgm_vec3 *a, const cgm_vec3 *b);
82 static inline float cgm_vlength(const cgm_vec3 *v);
83 static inline float cgm_vlength_sq(const cgm_vec3 *v);
84 static inline float cgm_vdist(const cgm_vec3 *a, const cgm_vec3 *b);
85 static inline float cgm_vdist_sq(const cgm_vec3 *a, const cgm_vec3 *b);
86 static inline void cgm_vnormalize(cgm_vec3 *v);
87
88 static inline void cgm_vreflect(cgm_vec3 *v, const cgm_vec3 *n);
89 static inline void cgm_vrefract(cgm_vec3 *v, const cgm_vec3 *n, float ior);
90
91 static inline void cgm_vrotate_quat(cgm_vec3 *v, const cgm_quat *q);
92 static inline void cgm_vrotate_axis(cgm_vec3 *v, int axis, float angle);
93 static inline void cgm_vrotate(cgm_vec3 *v, float angle, float x, float y, float z);
94 static inline void cgm_vrotate_euler(cgm_vec3 *v, float a, float b, float c, enum cgm_euler_mode mode);
95
96 static inline void cgm_vlerp(cgm_vec3 *res, const cgm_vec3 *a, const cgm_vec3 *b, float t);
97
98 #define cgm_velem(vptr, idx)    ((&(vptr)->x)[idx])
99
100 /* --- operations on cgm_vec4 --- */
101 static inline void cgm_wcons(cgm_vec4 *v, float x, float y, float z, float w);
102
103 static inline void cgm_wadd(cgm_vec4 *a, const cgm_vec4 *b);
104 static inline void cgm_wsub(cgm_vec4 *a, const cgm_vec4 *b);
105 static inline void cgm_wmul(cgm_vec4 *a, const cgm_vec4 *b);
106 static inline void cgm_wscale(cgm_vec4 *v, float s);
107
108 static inline void cgm_wmul_m4v4(cgm_vec4 *v, const float *m);
109 static inline void cgm_wmul_v4m4(cgm_vec4 *v, const float *m);
110 static inline void cgm_wmul_m34v4(cgm_vec4 *v, const float *m); /* doesn't affect w */
111 static inline void cgm_wmul_v4m43(cgm_vec4 *v, const float *m); /* doesn't affect w */
112 static inline void cgm_wmul_m3v4(cgm_vec4 *v, const float *m); /* (m still 16 floats) */
113 static inline void cgm_wmul_v4m3(cgm_vec4 *v, const float *m); /* (m still 16 floats) */
114
115 static inline float cgm_wdot(const cgm_vec4 *a, const cgm_vec4 *b);
116
117 static inline float cgm_wlength(const cgm_vec4 *v);
118 static inline float cgm_wlength_sq(const cgm_vec4 *v);
119 static inline float cgm_wdist(const cgm_vec4 *a, const cgm_vec4 *b);
120 static inline float cgm_wdist_sq(const cgm_vec4 *a, const cgm_vec4 *b);
121 static inline void cgm_wnormalize(cgm_vec4 *v);
122
123 static inline void cgm_wlerp(cgm_vec4 *res, const cgm_vec4 *a, const cgm_vec4 *b, float t);
124
125 #define cgm_welem(vptr, idx)    ((&(vptr)->x)[idx])
126
127 /* --- operations on quaternions --- */
128 static inline void cgm_qcons(cgm_quat *q, float x, float y, float z, float w);
129
130 static inline void cgm_qneg(cgm_quat *q);
131 static inline void cgm_qadd(cgm_quat *a, const cgm_quat *b);
132 static inline void cgm_qsub(cgm_quat *a, const cgm_quat *b);
133 static inline void cgm_qmul(cgm_quat *a, const cgm_quat *b);
134
135 static inline float cgm_qlength(const cgm_quat *q);
136 static inline float cgm_qlength_sq(const cgm_quat *q);
137 static inline void cgm_qnormalize(cgm_quat *q);
138 static inline void cgm_qconjugate(cgm_quat *q);
139 static inline void cgm_qinvert(cgm_quat *q);
140
141 static inline void cgm_qrotation(cgm_quat *q, float angle, float x, float y, float z);
142 static inline void cgm_qrotate(cgm_quat *q, float angle, float x, float y, float z);
143
144 static inline void cgm_qslerp(cgm_quat *res, const cgm_quat *a, const cgm_quat *b, float t);
145 static inline void cgm_qlerp(cgm_quat *res, const cgm_quat *a, const cgm_quat *b, float t);
146
147 #define cgm_qelem(qptr, idx)    ((&(qptr)->x)[idx])
148
149 /* --- operations on matrices --- */
150 static inline void cgm_mcopy(float *dest, const float *src);
151 static inline void cgm_mzero(float *m);
152 static inline void cgm_midentity(float *m);
153
154 static inline void cgm_mmul(float *a, const float *b);
155 static inline void cgm_mpremul(float *a, const float *b);
156
157 static inline void cgm_msubmatrix(float *m, int row, int col);
158 static inline void cgm_mupper3(float *m);
159 static inline float cgm_msubdet(const float *m, int row, int col);
160 static inline float cgm_mcofactor(const float *m, int row, int col);
161 static inline float cgm_mdet(const float *m);
162 static inline void cgm_mtranspose(float *m);
163 static inline void cgm_mcofmatrix(float *m);
164 static inline int cgm_minverse(float *m);       /* returns 0 on success, -1 for singular */
165
166 static inline void cgm_mtranslation(float *m, float x, float y, float z);
167 static inline void cgm_mscaling(float *m, float sx, float sy, float sz);
168 static inline void cgm_mrotation_x(float *m, float angle);
169 static inline void cgm_mrotation_y(float *m, float angle);
170 static inline void cgm_mrotation_z(float *m, float angle);
171 static inline void cgm_mrotation_axis(float *m, int idx, float angle);
172 static inline void cgm_mrotation(float *m, float angle, float x, float y, float z);
173 static inline void cgm_mrotation_euler(float *m, float a, float b, float c, int mode);
174 static inline void cgm_mrotation_quat(float *m, const cgm_quat *q);
175
176 static inline void cgm_mtranslate(float *m, float x, float y, float z);
177 static inline void cgm_mscale(float *m, float sx, float sy, float sz);
178 static inline void cgm_mrotate_x(float *m, float angle);
179 static inline void cgm_mrotate_y(float *m, float angle);
180 static inline void cgm_mrotate_z(float *m, float angle);
181 static inline void cgm_mrotate_axis(float *m, int idx, float angle);
182 static inline void cgm_mrotate(float *m, float angle, float x, float y, float z);
183 static inline void cgm_mrotate_euler(float *m, float a, float b, float c, int mode);
184 static inline void cgm_mrotate_quat(float *m, const cgm_quat *q);
185
186 static inline void cgm_mpretranslate(float *m, float x, float y, float z);
187 static inline void cgm_mprescale(float *m, float sx, float sy, float sz);
188 static inline void cgm_mprerotate_x(float *m, float angle);
189 static inline void cgm_mprerotate_y(float *m, float angle);
190 static inline void cgm_mprerotate_z(float *m, float angle);
191 static inline void cgm_mprerotate_axis(float *m, int idx, float angle);
192 static inline void cgm_mprerotate(float *m, float angle, float x, float y, float z);
193 static inline void cgm_mprerotate_euler(float *m, float a, float b, float c, int mode);
194 static inline void cgm_mprerotate_quat(float *m, const cgm_quat *q);
195
196 static inline void cgm_mget_translation(const float *m, cgm_vec3 *res);
197 static inline void cgm_mget_rotation(const float *m, cgm_quat *res);
198 static inline void cgm_mget_scaling(const float *m, cgm_vec3 *res);
199 static inline void cgm_mget_frustum_plane(const float *m, int p, cgm_vec4 *res);
200
201 static inline void cgm_mlookat(float *m, const cgm_vec3 *pos, const cgm_vec3 *targ,
202                 const cgm_vec3 *up);
203 static inline void cgm_minv_lookat(float *m, const cgm_vec3 *pos, const cgm_vec3 *targ,
204                 const cgm_vec3 *up);
205 static inline void cgm_mortho(float *m, float left, float right, float bot, float top,
206                 float znear, float zfar);
207 static inline void cgm_mfrustum(float *m, float left, float right, float bot, float top,
208                 float znear, float zfar);
209 static inline void cgm_mperspective(float *m, float vfov, float aspect, float znear, float zfar);
210
211 static inline void cgm_mmirror(float *m, float a, float b, float c, float d);
212
213 /* --- operations on rays --- */
214 static inline void cgm_rcons(cgm_ray *r, float x, float y, float z, float dx, float dy, float dz);
215
216 static inline void cgm_rmul_mr(cgm_ray *ray, const float *m);   /* m4x4 * ray */
217 static inline void cgm_rmul_rm(cgm_ray *ray, const float *m);   /* ray * m4x4 */
218
219 static inline void cgm_rreflect(cgm_ray *ray, const cgm_vec3 *n);
220 static inline void cgm_rrefract(cgm_ray *ray, const cgm_vec3 *n, float ior);
221
222 /* --- miscellaneous utility functions --- */
223 static inline float cgm_deg_to_rad(float deg);
224 static inline float cgm_rad_to_deg(float rad);
225
226 static inline float cgm_smoothstep(float a, float b, float x);
227 static inline float cgm_lerp(float a, float b, float t);
228 static inline float cgm_bezier(float a, float b, float c, float d, float t);
229 static inline float cgm_bspline(float a, float b, float c, float d, float t);
230 static inline float cgm_spline(float a, float b, float c, float d, float t);
231
232 static inline void cgm_discrand(cgm_vec3 *v, float rad);
233 static inline void cgm_sphrand(cgm_vec3 *v, float rad);
234
235 static inline void cgm_unproject(cgm_vec3 *res, const cgm_vec3 *norm_scrpos,
236                 const float *inv_viewproj);
237 static inline void cgm_glu_unproject(float winx, float winy, float winz,
238                 const float *view, const float *proj, const int *vp,
239                 float *objx, float *objy, float *objz);
240
241 static inline void cgm_pick_ray(cgm_ray *ray, float nx, float ny,
242                 const float *viewmat, const float *projmat);
243
244 static inline void cgm_raypos(cgm_vec3 *p, const cgm_ray *ray, float t);
245
246 /* calculate barycentric coordinates of point pt in triangle (a, b, c) */
247 static inline void cgm_bary(cgm_vec3 *bary, const cgm_vec3 *a,
248                 const cgm_vec3 *b, const cgm_vec3 *c, const cgm_vec3 *pt);
249
250 #include "cgmvec3.inl"
251 #include "cgmvec4.inl"
252 #include "cgmquat.inl"
253 #include "cgmmat.inl"
254 #include "cgmray.inl"
255 #include "cgmmisc.inl"
256
257 #ifdef __cplusplus
258 }
259 #endif
260
261 #endif  /* CGMATH_H_ */