X-Git-Url: https://harrygodden.com/git/?a=blobdiff_plain;f=vg%2Fvg_m.h;h=9e70c9290ca48d859df9f9c054065c506040df23;hb=18aa936b41a102700b6fc9fc9f0ac49712a0fced;hp=cb98db2d1a5a64f060a5c150b9bdc9d663a6b3d3;hpb=026b67150e9bd238709a6aeab656f7d01f3765a8;p=fishladder.git diff --git a/vg/vg_m.h b/vg/vg_m.h index cb98db2..9e70c92 100644 --- a/vg/vg_m.h +++ b/vg/vg_m.h @@ -17,6 +17,11 @@ 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)) @@ -77,6 +82,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]; @@ -87,6 +98,33 @@ 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 ) ); +} + // Vector 3 // ==================================================================================================================