X-Git-Url: https://harrygodden.com/git/?a=blobdiff_plain;f=vg%2Fvg_m.h;h=a567092e79b130fa83dfe2234ead19aa95ad4d78;hb=c87000a5e48d2cf3afdf308189767951eb819c09;hp=27481ae995db9b3aca8694ffea139671e9f27438;hpb=b6c9cb0ad0f55deb891ea14fecfd80d3a73f2fe1;p=fishladder.git

diff --git a/vg/vg_m.h b/vg/vg_m.h
index 27481ae..a567092 100644
--- a/vg/vg_m.h
+++ b/vg/vg_m.h
@@ -17,6 +17,15 @@ static inline float vg_maxf( float a, float b )
 	return a > b? a: b;
 }
 
+static inline float vg_clampf( float a, float min, float max )
+{
+	return vg_minf( max, vg_maxf( a, min ) );
+}
+
+#define VG_MIN( A, B ) ((A)<(B)?(A):(B))
+#define VG_MAX( A, B ) ((A)>(B)?(A):(B))
+
+// Hopefully deprecate this!!
 static inline int vg_min( int a, int b )
 {
 	return a < b? a: b;
@@ -41,6 +50,26 @@ static inline void v2_copy( v2f a, v2f b )
 	b[0] = a[0]; b[1] = a[1];
 }
 
+static inline void v2i_copy( v2i a, v2i b )
+{
+	b[0] = a[0]; b[1] = a[1];
+}
+
+static inline int v2i_eq( v2i a, v2i b )
+{
+	return ((a[0] == b[0]) && (a[1] == b[1]));
+}
+
+static inline void v2i_add( v2i a, v2i b, v2i d )
+{
+	d[0] = a[0]+b[0]; d[1] = a[1]+b[1];
+}
+
+static inline void v2i_sub( v2i a, v2i b, v2i d )
+{
+	d[0] = a[0]-b[0]; d[1] = a[1]-b[1];
+}
+
 static inline void v2_minv( v2f a, v2f b, v2f dest ) 
 {
 	dest[0] = vg_minf(a[0], b[0]);
@@ -73,6 +102,12 @@ static inline void v2_muls( v2f a, float s, v2f d )
 	d[0] = a[0]*s; d[1] = a[1]*s;
 }
 
+static inline void v2_divs( v2f a, float s, v2f d )
+{
+	d[0] = a[0]/s; d[1] = a[1]/s;
+}
+
+
 static inline void v2_mul( v2f a, v2f b, v2f d )
 {
 	d[0] = a[0]*b[0]; d[1] = a[1]*b[1];
@@ -83,6 +118,39 @@ static inline void v2_div( v2f a, v2f b, v2f d )
 	d[0] = a[0]/b[0]; d[1] = a[1]/b[1];
 }
 
+static inline void v2_muladds( v2f a, v2f b, float s, v2f d )
+{
+	d[0] = a[0]+b[0]*s; d[1] = a[1]+b[1]*s;
+}
+
+static inline float v2_length2( v2f a )
+{
+	return a[0]*a[0] + a[1]*a[1];
+}
+
+static inline float v2_length( v2f a )
+{
+	return sqrtf( v2_length2( a ) );
+}
+
+static inline float v2_dist2( v2f a, v2f b )
+{
+	v2f delta;
+	v2_sub( a, b, delta );
+	return v2_length2( delta );
+}
+
+static inline float v2_dist( v2f a, v2f b )
+{
+	return sqrtf( v2_dist2( a, b ) );
+}
+
+static inline void v2_lerp( v2f a, v2f b, float t, v2f d )
+{
+	d[0] = a[0] + t*(b[0]-a[0]);
+	d[1] = a[1] + t*(b[1]-a[1]);
+}
+
 // Vector 3
 // ==================================================================================================================
 
@@ -170,7 +238,7 @@ static inline void v3_normalize( v3f a )
 	v3_muls( a, 1.f / v3_length( a ), a );
 }
 
-static inline float csr_lerpf( float a, float b, float t )
+static inline float vg_lerpf( float a, float b, float t )
 {
 	return a + t*(b-a);
 }
@@ -226,6 +294,40 @@ static inline void v4_zero( v4f a )
 	a[0] = 0.f; a[1] = 0.f; a[2] = 0.f; a[3] = 0.f;
 }
 
+// Matrix 2x2
+// ===========================================================================================================
+
+#define M2X2_INDENTIY 	{{1.0f, 0.0f, }, \
+							  	{ 0.0f, 1.0f, }}
+							  	
+#define M2X2_ZERO			{{0.0f, 0.0f, }, \
+								{ 0.0f, 0.0f, }}
+
+static inline void m2x2_copy( m2x2f a, m2x2f b )
+{
+	v2_copy( a[0], b[0] );
+	v2_copy( a[1], b[1] );
+}
+
+static inline void m2x2_identity( m2x2f a )
+{
+	m2x2f id = M2X2_INDENTIY;
+	m2x2_copy( id, a );
+}
+
+static inline void m2x2_create_rotation( m2x2f a, float theta )
+{
+	float s, c;
+	
+	s = sinf( theta );
+	c = cosf( theta );
+	
+	a[0][0] =  c;
+	a[0][1] = -s;
+	a[1][0] =  s;
+	a[1][1] =  c;
+}
+
 // Matrix 3x3
 //======================================================================================================