X-Git-Url: http://git.mutantstargoat.com/user/nuclear/?p=gph-cmath;a=blobdiff_plain;f=src%2Fcgmvec4.inl;fp=src%2Fcgmvec4.inl;h=f33340390e7abeb757bc5716c31f19265fa2a896;hp=0000000000000000000000000000000000000000;hb=cc26f59c90c0935eef7d7fdcf8ac327e23d14ebc;hpb=b5babc8bdd95af48fc377bb888c70aad4956d58a

diff --git a/src/cgmvec4.inl b/src/cgmvec4.inl
new file mode 100644
index 0000000..f333403
--- /dev/null
+++ b/src/cgmvec4.inl
@@ -0,0 +1,145 @@
+static inline void cgm_wcons(cgm_vec4 *v, float x, float y, float z, float w)
+{
+	v->x = x;
+	v->y = y;
+	v->z = z;
+	v->w = w;
+}
+
+static inline void cgm_wadd(cgm_vec4 *a, const cgm_vec4 *b)
+{
+	a->x += b->x;
+	a->y += b->y;
+	a->z += b->z;
+	a->w += b->w;
+}
+
+static inline void cgm_wsub(cgm_vec4 *a, const cgm_vec4 *b)
+{
+	a->x -= b->x;
+	a->y -= b->y;
+	a->z -= b->z;
+	a->w -= b->w;
+}
+
+static inline void cgm_wmul(cgm_vec4 *a, const cgm_vec4 *b)
+{
+	a->x *= b->x;
+	a->y *= b->y;
+	a->z *= b->z;
+	a->w *= b->w;
+}
+
+static inline void cgm_wscale(cgm_vec4 *v, float s)
+{
+	v->x *= s;
+	v->y *= s;
+	v->z *= s;
+	v->w *= s;
+}
+
+static inline void cgm_wmul_m4v4(cgm_vec4 *v, const float *m)
+{
+	float x = v->x * m[0] + v->y * m[4] + v->z * m[8] + v->w * m[12];
+	float y = v->x * m[1] + v->y * m[5] + v->z * m[9] + v->w * m[13];
+	float z = v->x * m[2] + v->y * m[6] + v->z * m[10] + v->w * m[14];
+	v->w = v->x * m[3] + v->y * m[7] + v->z * m[11] + v->w * m[15];
+	v->x = x;
+	v->y = y;
+	v->z = z;
+}
+
+static inline void cgm_wmul_v4m4(cgm_vec4 *v, const float *m)
+{
+	float x = v->x * m[0] + v->y * m[1] + v->z * m[2] + v->w * m[3];
+	float y = v->x * m[4] + v->y * m[5] + v->z * m[6] + v->w * m[7];
+	float z = v->x * m[8] + v->y * m[9] + v->z * m[10] + v->w * m[11];
+	v->w = v->x * m[12] + v->y * m[13] + v->z * m[14] + v->w * m[15];
+	v->x = x;
+	v->y = y;
+	v->z = z;
+}
+
+static inline void cgm_wmul_m34v4(cgm_vec4 *v, const float *m)
+{
+	float x = v->x * m[0] + v->y * m[4] + v->z * m[8] + v->w * m[12];
+	float y = v->x * m[1] + v->y * m[5] + v->z * m[9] + v->w * m[13];
+	v->z = v->x * m[2] + v->y * m[6] + v->z * m[10] + v->w * m[14];
+	v->x = x;
+	v->y = y;
+}
+
+static inline void cgm_wmul_v4m43(cgm_vec4 *v, const float *m)
+{
+	float x = v->x * m[0] + v->y * m[1] + v->z * m[2] + v->w * m[3];
+	float y = v->x * m[4] + v->y * m[5] + v->z * m[6] + v->w * m[7];
+	v->z = v->x * m[8] + v->y * m[9] + v->z * m[10] + v->w * m[11];
+	v->x = x;
+	v->y = y;
+}
+
+static inline void cgm_wmul_m3v4(cgm_vec4 *v, const float *m)
+{
+	float x = v->x * m[0] + v->y * m[4] + v->z * m[8];
+	float y = v->x * m[1] + v->y * m[5] + v->z * m[9];
+	v->z = v->x * m[2] + v->y * m[6] + v->z * m[10];
+	v->x = x;
+	v->y = y;
+}
+
+static inline void cgm_wmul_v4m3(cgm_vec4 *v, const float *m)
+{
+	float x = v->x * m[0] + v->y * m[1] + v->z * m[2];
+	float y = v->x * m[4] + v->y * m[5] + v->z * m[6];
+	v->z = v->x * m[8] + v->y * m[9] + v->z * m[10];
+	v->x = x;
+	v->y = y;
+}
+
+static inline float cgm_wlength(const cgm_vec4 *v)
+{
+	return sqrt(v->x * v->x + v->y * v->y + v->z * v->z + v->w * v->w);
+}
+
+static inline float cgm_wlength_sq(const cgm_vec4 *v)
+{
+	return v->x * v->x + v->y * v->y + v->z * v->z + v->w * v->w;
+}
+
+static inline float cgm_wdist(const cgm_vec4 *a, const cgm_vec4 *b)
+{
+	float dx = a->x - b->x;
+	float dy = a->y - b->y;
+	float dz = a->z - b->z;
+	float dw = a->w - b->w;
+	return sqrt(dx * dx + dy * dy + dz * dz + dw * dw);
+}
+
+static inline float cgm_wdist_sq(const cgm_vec4 *a, const cgm_vec4 *b)
+{
+	float dx = a->x - b->x;
+	float dy = a->y - b->y;
+	float dz = a->z - b->z;
+	float dw = a->w - b->w;
+	return dx * dx + dy * dy + dz * dz + dw * dw;
+}
+
+static inline void cgm_wnormalize(cgm_vec4 *v)
+{
+	float len = cgm_wlength(v);
+	if(len != 0.0f) {
+		float s = 1.0f / len;
+		v->x *= s;
+		v->y *= s;
+		v->z *= s;
+		v->w *= s;
+	}
+}
+
+static inline void cgm_wlerp(cgm_vec4 *res, const cgm_vec4 *a, const cgm_vec4 *b, float t)
+{
+	res->x = a->x + (b->x - a->x) * t;
+	res->y = a->y + (b->y - a->y) * t;
+	res->z = a->z + (b->z - a->z) * t;
+	res->w = a->w + (b->w - a->w) * t;
+}