Austin Brown
/
MikeEtekController
Mike Etek Controller
math_ops/math_ops.cpp
- Committer:
- austinbrown124
- Date:
- 2019-04-06
- Revision:
- 1:94193b31f0ee
- Parent:
- 0:9edd6ec0f56a
File content as of revision 1:94193b31f0ee:
#include "math_ops.h" float fmaxf(float x, float y){ return (((x)>(y))?(x):(y)); } float fminf(float x, float y){ return (((x)<(y))?(x):(y)); } float fmaxf3(float x, float y, float z){ return (x > y ? (x > z ? x : z) : (y > z ? y : z)); } float fminf3(float x, float y, float z){ return (x < y ? (x < z ? x : z) : (y < z ? y : z)); } void limit_norm(float *x, float *y, float limit){ float norm = sqrt(*x * *x + *y * *y); if(norm > limit){ *x = *x * limit/norm; *y = *y * limit/norm; } } void limit_abs(float *x, float limit){ limit = abs(limit); if(*x > limit){ *x = limit; } if(*x < -limit){ *x = -limit; } } float constrain(float x, float bot, float top){ x = (((x)>(top))?(top):(x)); x = (((x)<(bot))?(bot):(x)); return x; }