From 14c9f64def7439aa4b6b74d57ba9bc2b82177dd6 Mon Sep 17 00:00:00 2001 From: Tiago Chaves Date: Wed, 4 Mar 2020 10:24:21 +1100 Subject: BLI_math: add clamp_v# and clamp_v#_v#v# utility functions --- source/blender/blenlib/BLI_math_vector.h | 7 +++++ source/blender/blenlib/intern/math_vector.c | 42 +++++++++++++++++++++++++++++ 2 files changed, 49 insertions(+) (limited to 'source/blender/blenlib') diff --git a/source/blender/blenlib/BLI_math_vector.h b/source/blender/blenlib/BLI_math_vector.h index 19a378269fe..e210bae11d6 100644 --- a/source/blender/blenlib/BLI_math_vector.h +++ b/source/blender/blenlib/BLI_math_vector.h @@ -440,6 +440,13 @@ void dist_ensure_v2_v2fl(float v1[2], const float v2[2], const float dist); void axis_sort_v3(const float axis_values[3], int r_axis_order[3]); +void clamp_v2(float vec[2], const float min, const float max); +void clamp_v3(float vec[3], const float min, const float max); +void clamp_v4(float vec[4], const float min, const float max); +void clamp_v2_v2v2(float vec[2], const float min[2], const float max[2]); +void clamp_v3_v3v3(float vec[3], const float min[3], const float max[3]); +void clamp_v4_v4v4(float vec[4], const float min[4], const float max[4]); + /***************************** Array Functions *******************************/ /* follow fixed length vector function conventions. */ double dot_vn_vn(const float *array_src_a, diff --git a/source/blender/blenlib/intern/math_vector.c b/source/blender/blenlib/intern/math_vector.c index 5919b7e1dd6..d1b36884038 100644 --- a/source/blender/blenlib/intern/math_vector.c +++ b/source/blender/blenlib/intern/math_vector.c @@ -1051,6 +1051,48 @@ void axis_sort_v3(const float axis_values[3], int r_axis_order[3]) #undef SWAP_AXIS } +void clamp_v2(float vec[2], const float min, const float max) +{ + CLAMP(vec[0], min, max); + CLAMP(vec[1], min, max); +} + +void clamp_v3(float vec[3], const float min, const float max) +{ + CLAMP(vec[0], min, max); + CLAMP(vec[1], min, max); + CLAMP(vec[2], min, max); +} + +void clamp_v4(float vec[4], const float min, const float max) +{ + CLAMP(vec[0], min, max); + CLAMP(vec[1], min, max); + CLAMP(vec[2], min, max); + CLAMP(vec[3], min, max); +} + +void clamp_v2_v2v2(float vec[2], const float min[2], const float max[2]) +{ + CLAMP(vec[0], min[0], max[0]); + CLAMP(vec[1], min[1], max[1]); +} + +void clamp_v3_v3v3(float vec[3], const float min[3], const float max[3]) +{ + CLAMP(vec[0], min[0], max[0]); + CLAMP(vec[1], min[1], max[1]); + CLAMP(vec[2], min[2], max[2]); +} + +void clamp_v4_v4v4(float vec[4], const float min[4], const float max[4]) +{ + CLAMP(vec[0], min[0], max[0]); + CLAMP(vec[1], min[1], max[1]); + CLAMP(vec[2], min[2], max[2]); + CLAMP(vec[3], min[3], max[3]); +} + /***************************** Array Functions *******************************/ MINLINE double sqr_db(double f) -- cgit v1.2.3