diff options
Diffstat (limited to 'prbm.c')
| -rw-r--r-- | prbm.c | 392 |
1 files changed, 220 insertions, 172 deletions
@@ -1,297 +1,345 @@ #include "prbm.h" +#include "macros.h" #include <math.h> -struct v2 fillv2(f32 a) +v2 +fillv2(f32 a) { - return (struct v2){a, a}; + return (v2){a, a}; } -struct v2 invv2(struct v2 a) +v2 +invv2(v2 a) { - return (struct v2){-a.x, -a.y}; + return (v2){-a.x, -a.y}; } -struct v2 addv2(struct v2 a, struct v2 b) +v2 +addv2(v2 a, v2 b) { - return (struct v2){a.x + b.x, a.y + b.y}; + return (v2){a.x + b.x, a.y + b.y}; } -struct v2 subv2(struct v2 a, struct v2 b) +v2 +subv2(v2 a, v2 b) { - return (struct v2){a.x - b.x, a.y - b.y}; + return (v2){a.x - b.x, a.y - b.y}; } -struct v2 scalev2(struct v2 a, f32 s) +v2 +scalev2(v2 a, f32 s) { - return (struct v2){a.x * s, a.y * s}; + return (v2){a.x * s, a.y * s}; } -struct v2 scalevv2(struct v2 a, struct v2 s) +v2 +scalevv2(v2 a, v2 s) { - return (struct v2){a.x * s.x, a.y * s.y}; + return (v2){a.x * s.x, a.y * s.y}; } -f32 dotv2(struct v2 a, struct v2 b) +f32 +dotv2(v2 a, v2 b) { - return (a.x * b.x + a.y * b.y); + return (a.x * b.x + a.y * b.y); } -f32 len2v2(struct v2 a) +f32 +len2v2(v2 a) { - return dotv2(a, a); + return dotv2(a, a); } -f32 lenv2(struct v2 a) +f32 +lenv2(v2 a) { - return sqrtf(len2v2(a)); + return sqrtf(len2v2(a)); } -struct v2 normv2(struct v2 a) +v2 +normv2(v2 a) { - f32 len = lenv2(a); - if (len) { - return v2_zero; - } - f32 ilen = 1.0f / len; - return (struct v2){a.x * len, a.y * len}; + f32 len = lenv2(a); + if (len) { + return v2_zero; + } + f32 ilen = 1.0f / len; + return (v2){a.x * len, a.y * len}; } -struct v3 fillv3(f32 a) +v3 +fillv3(f32 a) { - return (struct v3){a, a, a}; + return (v3){a, a, a}; } -struct v3 invv3(struct v3 a) +v3 +invv3(v3 a) { - return (struct v3){-a.x, -a.y, -a.z}; + return (v3){-a.x, -a.y, -a.z}; } -struct v3 addv3(struct v3 a, struct v3 b) +v3 +addv3(v3 a, v3 b) { - return (struct v3){a.x + b.x, a.y + b.y, a.z + b.z}; + return (v3){a.x + b.x, a.y + b.y, a.z + b.z}; } -struct v3 subv3(struct v3 a, struct v3 b) +v3 +subv3(v3 a, v3 b) { - return (struct v3){a.x - b.x, a.y - b.y, a.z - b.z}; + return (v3){a.x - b.x, a.y - b.y, a.z - b.z}; } -struct v3 scalev3(struct v3 a, f32 s) +v3 +scalev3(v3 a, f32 s) { - return (struct v3){a.x * s, a.y * s, a.z * s}; + return (v3){a.x * s, a.y * s, a.z * s}; } -struct v3 scalevv3(struct v3 a, struct v3 s) +v3 +scalevv3(v3 a, v3 s) { - return (struct v3){a.x * s.x, a.y * s.y, a.z * s.z}; + return (v3){a.x * s.x, a.y * s.y, a.z * s.z}; } -f32 dotv3(struct v3 a, struct v3 b) +f32 +dotv3(v3 a, v3 b) { - return (a.x * b.x + a.y * b.y + a.z * b.z); + return (a.x * b.x + a.y * b.y + a.z * b.z); } -struct v3 crossv3(struct v3 l, struct v3 r) +v3 +crossv3(v3 l, v3 r) { - return (struct v3){ - (l.y * r.z - r.y * l.z), - (r.x * l.z - l.x * r.z), - (l.x * r.y - r.x * l.y) - }; + return (v3){ + (l.y * r.z - r.y * l.z), + (r.x * l.z - l.x * r.z), + (l.x * r.y - r.x * l.y) + }; } -f32 len2v3(struct v3 a) +f32 +len2v3(v3 a) { - return dotv3(a, a); + return dotv3(a, a); } -f32 lenv3(struct v3 a) +f32 +lenv3(v3 a) { - return sqrtf(len2v3(a)); + return sqrtf(len2v3(a)); } -struct v3 normv3(struct v3 a) +v3 +normv3(v3 a) { - f32 len = lenv3(a); - if (!len) - return v3_zero; - f32 ilen = 1.0f / len; - return (struct v3){a.x * len, a.y * len, a.z * len}; + f32 len = lenv3(a); + if (!len) + return v3_zero; + f32 ilen = 1.0f / len; + return (v3){a.x * len, a.y * len, a.z * len}; } -struct v4 fillv4(f32 a) +v3 +maxv3(v3 a, v3 b) { - return (struct v4){a, a, a, a}; + return (v3){max(a.x, b.x), max(a.y, b.y), max(a.z, b.z)}; } -struct v4 invv4(struct v4 a) +v4 +fillv4(f32 a) { - return (struct v4){-a.x, -a.y, -a.z, -a.w}; + return (v4){a, a, a, a}; } -struct v4 addv4(struct v4 a, struct v4 b) +v4 +invv4(v4 a) { - return (struct v4){a.x + b.x, a.y + b.y, a.z + b.z, a.w + b.w}; + return (v4){-a.x, -a.y, -a.z, -a.w}; } -struct v4 subv4(struct v4 a, struct v4 b) +v4 +addv4(v4 a, v4 b) { - return (struct v4){a.x - b.x, a.y - b.y, a.z - b.z, a.w - b.w}; + return (v4){a.x + b.x, a.y + b.y, a.z + b.z, a.w + b.w}; } -struct v4 scalev4(struct v4 a, f32 s) +v4 +subv4(v4 a, v4 b) { - return (struct v4){a.x * s, a.y * s, a.z * s, a.w * s}; + return (v4){a.x - b.x, a.y - b.y, a.z - b.z, a.w - b.w}; } -struct v4 scalevv4(struct v4 a, struct v4 s) +v4 +scalev4(v4 a, f32 s) { - return (struct v4){a.x * s.x, a.y * s.y, a.z * s.z, a.w * s.w}; + return (v4){a.x * s, a.y * s, a.z * s, a.w * s}; } -f32 dotv4(struct v4 a, struct v4 b) +v4 +scalevv4(v4 a, v4 s) { - return (a.x * b.x + a.y * b.y + a.z * b.z + a.w * b.w); + return (v4){a.x * s.x, a.y * s.y, a.z * s.z, a.w * s.w}; } -f32 len2v4(struct v4 a) +f32 +dotv4(v4 a, v4 b) { - return dotv4(a, a); + return (a.x * b.x + a.y * b.y + a.z * b.z + a.w * b.w); } -f32 lenv4(struct v4 a) +f32 +len2v4(v4 a) { - return sqrtf(len2v4(a)); + return dotv4(a, a); } -struct v4 normv4(struct v4 a) +f32 +lenv4(v4 a) { - f32 len = lenv4(a); - if (!len) - return v4_zero; - f32 ilen = 1.0f / len; - return (struct v4){a.x * ilen, a.y * ilen, a.z * ilen, a.w * ilen}; + return sqrtf(len2v4(a)); } -struct mat transpmat(struct mat m) +v4 +normv4(v4 a) { - struct mat r = m; - r.c0.y = m.c1.x; - r.c0.z = m.c2.x; - r.c0.w = m.c3.x; - r.c1.z = m.c2.y; - r.c1.w = m.c3.y; - r.c2.w = m.c3.z; - return r; + f32 len = lenv4(a); + if (!len) + return v4_zero; + f32 ilen = 1.0f / len; + return (v4){a.x * ilen, a.y * ilen, a.z * ilen, a.w * ilen}; } -struct mat mulmat(struct mat left, struct mat right) +mat +transpose_mat(mat m) { - f32 l00 = left.c0.x, l01 = left.c0.y, l02 = left.c0.z, l03 = left.c0.w; - f32 l10 = left.c1.x, l11 = left.c1.y, l12 = left.c1.z, l13 = left.c1.w; - f32 l20 = left.c2.x, l21 = left.c2.y, l22 = left.c2.z, l23 = left.c2.w; - f32 l30 = left.c3.x, l31 = left.c3.y, l32 = left.c3.z, l33 = left.c3.w; - f32 r00 = right.c0.x, r01 = right.c0.y, r02 = right.c0.z, r03 = right.c0.w; - f32 r10 = right.c1.x, r11 = right.c1.y, r12 = right.c1.z, r13 = right.c1.w; - f32 r20 = right.c2.x, r21 = right.c2.y, r22 = right.c2.z, r23 = right.c2.w; - f32 r30 = right.c3.x, r31 = right.c3.y, r32 = right.c3.z, r33 = right.c3.w; - return (struct mat){ - { - l00*r00 + l10*r01 + l20*r02 + l30*r03, - l01*r00 + l11*r01 + l21*r02 + l31*r03, - l02*r00 + l12*r01 + l22*r02 + l32*r03, - l03*r00 + l13*r01 + l23*r02 + l33*r03 - }, - { - l00*r10 + l10*r11 + l20*r12 + l30*r13, - l01*r10 + l11*r11 + l21*r12 + l31*r13, - l02*r10 + l12*r11 + l22*r12 + l32*r13, - l03*r10 + l13*r11 + l23*r12 + l33*r13 - }, - { - l00*r20 + l10*r21 + l20*r22 + l30*r23, - l01*r20 + l11*r21 + l21*r22 + l31*r23, - l02*r20 + l12*r21 + l22*r22 + l32*r23, - l03*r20 + l13*r21 + l23*r22 + l33*r23 - }, - { - l00*r30 + l10*r31 + l20*r32 + l30*r33, - l01*r30 + l11*r31 + l21*r32 + l31*r33, - l02*r30 + l12*r31 + l22*r32 + l32*r33, - l03*r30 + l13*r31 + l23*r32 + l33*r33 - } - }; + mat r = m; + r.c0.y = m.c1.x; + r.c0.z = m.c2.x; + r.c0.w = m.c3.x; + r.c1.z = m.c2.y; + r.c1.w = m.c3.y; + r.c2.w = m.c3.z; + return r; } -struct mat make_translate(struct v3 v) +mat +mulmat(mat left, mat right) { - return (struct mat){ - {1.0f, 0.0f, 0.0f, 0.0f}, - {0.0f, 1.0f, 0.0f, 0.0f}, - {0.0f, 0.0f, 1.0f, 0.0f}, - {v.x, v.y, v.z, 1.0f} - }; + f32 l00 = left.c0.x, l01 = left.c0.y, l02 = left.c0.z, l03 = left.c0.w; + f32 l10 = left.c1.x, l11 = left.c1.y, l12 = left.c1.z, l13 = left.c1.w; + f32 l20 = left.c2.x, l21 = left.c2.y, l22 = left.c2.z, l23 = left.c2.w; + f32 l30 = left.c3.x, l31 = left.c3.y, l32 = left.c3.z, l33 = left.c3.w; + f32 r00 = right.c0.x, r01 = right.c0.y, r02 = right.c0.z, r03 = right.c0.w; + f32 r10 = right.c1.x, r11 = right.c1.y, r12 = right.c1.z, r13 = right.c1.w; + f32 r20 = right.c2.x, r21 = right.c2.y, r22 = right.c2.z, r23 = right.c2.w; + f32 r30 = right.c3.x, r31 = right.c3.y, r32 = right.c3.z, r33 = right.c3.w; + return (mat){ + { + l00*r00 + l10*r01 + l20*r02 + l30*r03, + l01*r00 + l11*r01 + l21*r02 + l31*r03, + l02*r00 + l12*r01 + l22*r02 + l32*r03, + l03*r00 + l13*r01 + l23*r02 + l33*r03 + }, + { + l00*r10 + l10*r11 + l20*r12 + l30*r13, + l01*r10 + l11*r11 + l21*r12 + l31*r13, + l02*r10 + l12*r11 + l22*r12 + l32*r13, + l03*r10 + l13*r11 + l23*r12 + l33*r13 + }, + { + l00*r20 + l10*r21 + l20*r22 + l30*r23, + l01*r20 + l11*r21 + l21*r22 + l31*r23, + l02*r20 + l12*r21 + l22*r22 + l32*r23, + l03*r20 + l13*r21 + l23*r22 + l33*r23 + }, + { + l00*r30 + l10*r31 + l20*r32 + l30*r33, + l01*r30 + l11*r31 + l21*r32 + l31*r33, + l02*r30 + l12*r31 + l22*r32 + l32*r33, + l03*r30 + l13*r31 + l23*r32 + l33*r33 + } + }; } -struct mat make_scale(struct v3 v) +mat +make_translate(v3 v) { - return (struct mat){ - {v.x, 0.0f, 0.0f, 0.0f}, - {0.0f, v.y, 0.0f, 0.0f}, - {0.0f, 0.0f, v.z, 0.0f}, - {0.0f, 0.0f, 0.0f, 1.0f} - }; + return (mat){ + {1.0f, 0.0f, 0.0f, 0.0f}, + {0.0f, 1.0f, 0.0f, 0.0f}, + {0.0f, 0.0f, 1.0f, 0.0f}, + {v.x, v.y, v.z, 1.0f} + }; } -struct mat make_rotate(struct v3 x, struct v3 y, struct v3 z) +mat +make_scale(v3 v) { - return (struct mat){ - {x.x, x.y, x.z, 0.0f}, - {y.x, y.y, y.z, 0.0f}, - {z.x, z.y, z.z, 0.0f}, - {0.0f, 0.0f, 0.0f, 1.0f} - }; + return (mat){ + {v.x, 0.0f, 0.0f, 0.0f}, + {0.0f, v.y, 0.0f, 0.0f}, + {0.0f, 0.0f, v.z, 0.0f}, + {0.0f, 0.0f, 0.0f, 1.0f} + }; } -struct mat translate_mat(struct mat m, struct v3 v) +mat +make_rotate(v3 x, v3 y, v3 z) { - return mulmat(make_translate(v), m); + return (mat){ + {x.x, x.y, x.z, 0.0f}, + {y.x, y.y, y.z, 0.0f}, + {z.x, z.y, z.z, 0.0f}, + {0.0f, 0.0f, 0.0f, 1.0f} + }; } -struct mat scale_mat(struct mat m, struct v3 v) +mat +translate_mat(mat m, v3 v) { - return mulmat(make_scale(v), m); + return mulmat(make_translate(v), m); } -struct mat rotate_mat(struct mat m, struct v3 angles) +mat +scale_mat(mat m, v3 v) { - f32 angle = deg2rad(angles.x); - f32 cx = cosf(angle); - f32 sx = sinf(angle); - angle = deg2rad(angles.y); - f32 cy = cosf(angle); - f32 sy = sinf(angle); - angle = deg2rad(angles.z); - f32 cz = cosf(angle); - f32 sz = sinf(angle); - struct v3 x = { cy*cz, sx*sy*cz + cx*sz, -cx*sy*cz + sx*sz}; - struct v3 y = {-cy*sz, -sx*sy*sz + cx*cz, cx*sy*sz + sx*cz}; - struct v3 z = { sy, -sx*cy, cx*cy}; - return mulmat(make_rotate(x, y, z), m); + return mulmat(make_scale(v), m); } -struct v4 mulmatv4(struct mat m, struct v4 v) +mat +rotate_mat(mat m, v3 angles) { - return (struct v4){ - m.c0.x*v.x + m.c1.x*v.y + m.c2.x*v.z + m.c3.x*v.w, - m.c0.y*v.x + m.c1.y*v.y + m.c2.y*v.z + m.c3.y*v.w, - m.c0.z*v.x + m.c1.z*v.y + m.c2.z*v.z + m.c3.z*v.w, - m.c0.w*v.x + m.c1.w*v.y + m.c2.w*v.z + m.c3.w*v.w - }; + f32 angle = deg2rad(angles.x); + f32 cx = cosf(angle); + f32 sx = sinf(angle); + angle = deg2rad(angles.y); + f32 cy = cosf(angle); + f32 sy = sinf(angle); + angle = deg2rad(angles.z); + f32 cz = cosf(angle); + f32 sz = sinf(angle); + v3 x = { cy*cz, sx*sy*cz + cx*sz, -cx*sy*cz + sx*sz}; + v3 y = {-cy*sz, -sx*sy*sz + cx*cz, cx*sy*sz + sx*cz}; + v3 z = { sy, -sx*cy, cx*cy}; + return mulmat(make_rotate(x, y, z), m); } -i32 in_rect(struct v2 pos, struct rect rect) +v4 +mulmatv4(mat m, v4 v) { - return (pos.x > rect.start.x) && (pos.x < rect.end.x) && - (pos.y > rect.start.y) && (pos.y < rect.end.y); + return (v4){ + m.c0.x*v.x + m.c1.x*v.y + m.c2.x*v.z + m.c3.x*v.w, + m.c0.y*v.x + m.c1.y*v.y + m.c2.y*v.z + m.c3.y*v.w, + m.c0.z*v.x + m.c1.z*v.y + m.c2.z*v.z + m.c3.z*v.w, + m.c0.w*v.x + m.c1.w*v.y + m.c2.w*v.z + m.c3.w*v.w + }; +} + +i32 +in_rect(v2 pos, rect r) +{ + return (pos.x > r.start.x) && (pos.x < r.end.x) && + (pos.y > r.start.y) && (pos.y < r.end.y); } |