vec3-ext.h 7.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345
  1. /*
  2. * Copyright (c), Recep Aslantas.
  3. *
  4. * MIT License (MIT), http://opensource.org/licenses/MIT
  5. * Full license can be found in the LICENSE file
  6. */
  7. /*!
  8. * @brief SIMD like functions
  9. */
  10. /*
  11. Functions:
  12. CGLM_INLINE void glm_vec3_broadcast(float val, vec3 d);
  13. CGLM_INLINE void glm_vec3_fill(vec3 v, float val);
  14. CGLM_INLINE bool glm_vec3_eq(vec3 v, float val);
  15. CGLM_INLINE bool glm_vec3_eq_eps(vec3 v, float val);
  16. CGLM_INLINE bool glm_vec3_eq_all(vec3 v);
  17. CGLM_INLINE bool glm_vec3_eqv(vec3 a, vec3 b);
  18. CGLM_INLINE bool glm_vec3_eqv_eps(vec3 a, vec3 b);
  19. CGLM_INLINE float glm_vec3_max(vec3 v);
  20. CGLM_INLINE float glm_vec3_min(vec3 v);
  21. CGLM_INLINE bool glm_vec3_isnan(vec3 v);
  22. CGLM_INLINE bool glm_vec3_isinf(vec3 v);
  23. CGLM_INLINE bool glm_vec3_isvalid(vec3 v);
  24. CGLM_INLINE void glm_vec3_sign(vec3 v, vec3 dest);
  25. CGLM_INLINE void glm_vec3_abs(vec3 v, vec3 dest);
  26. CGLM_INLINE void glm_vec3_fract(vec3 v, vec3 dest);
  27. CGLM_INLINE void glm_vec3_floor(vec3 v, vec3 dest);
  28. CGLM_INLINE float glm_vec3_mods(vec3 v, float s, vec3 dest);
  29. CGLM_INLINE float glm_vec3_steps(float edge, vec3 v, vec3 dest);
  30. CGLM_INLINE void glm_vec3_stepr(vec3 edge, float v, vec3 dest);
  31. CGLM_INLINE float glm_vec3_hadd(vec3 v);
  32. CGLM_INLINE void glm_vec3_sqrt(vec3 v, vec3 dest);
  33. */
  34. #ifndef cglm_vec3_ext_h
  35. #define cglm_vec3_ext_h
  36. #include "common.h"
  37. #include "util.h"
  38. /*!
  39. * @brief fill a vector with specified value
  40. *
  41. * @param[in] val value
  42. * @param[out] d dest
  43. */
  44. CGLM_INLINE
  45. void
  46. glm_vec3_broadcast(float val, vec3 d) {
  47. d[0] = d[1] = d[2] = val;
  48. }
  49. /*!
  50. * @brief fill a vector with specified value
  51. *
  52. * @param[out] v dest
  53. * @param[in] val value
  54. */
  55. CGLM_INLINE
  56. void
  57. glm_vec3_fill(vec3 v, float val) {
  58. v[0] = v[1] = v[2] = val;
  59. }
  60. /*!
  61. * @brief check if vector is equal to value (without epsilon)
  62. *
  63. * @param[in] v vector
  64. * @param[in] val value
  65. */
  66. CGLM_INLINE
  67. bool
  68. glm_vec3_eq(vec3 v, float val) {
  69. return v[0] == val && v[0] == v[1] && v[0] == v[2];
  70. }
  71. /*!
  72. * @brief check if vector is equal to value (with epsilon)
  73. *
  74. * @param[in] v vector
  75. * @param[in] val value
  76. */
  77. CGLM_INLINE
  78. bool
  79. glm_vec3_eq_eps(vec3 v, float val) {
  80. return fabsf(v[0] - val) <= GLM_FLT_EPSILON
  81. && fabsf(v[1] - val) <= GLM_FLT_EPSILON
  82. && fabsf(v[2] - val) <= GLM_FLT_EPSILON;
  83. }
  84. /*!
  85. * @brief check if vector members are equal (without epsilon)
  86. *
  87. * @param[in] v vector
  88. */
  89. CGLM_INLINE
  90. bool
  91. glm_vec3_eq_all(vec3 v) {
  92. return glm_vec3_eq_eps(v, v[0]);
  93. }
  94. /*!
  95. * @brief check if vector is equal to another (without epsilon)
  96. *
  97. * @param[in] a vector
  98. * @param[in] b vector
  99. */
  100. CGLM_INLINE
  101. bool
  102. glm_vec3_eqv(vec3 a, vec3 b) {
  103. return a[0] == b[0]
  104. && a[1] == b[1]
  105. && a[2] == b[2];
  106. }
  107. /*!
  108. * @brief check if vector is equal to another (with epsilon)
  109. *
  110. * @param[in] a vector
  111. * @param[in] b vector
  112. */
  113. CGLM_INLINE
  114. bool
  115. glm_vec3_eqv_eps(vec3 a, vec3 b) {
  116. return fabsf(a[0] - b[0]) <= GLM_FLT_EPSILON
  117. && fabsf(a[1] - b[1]) <= GLM_FLT_EPSILON
  118. && fabsf(a[2] - b[2]) <= GLM_FLT_EPSILON;
  119. }
  120. /*!
  121. * @brief max value of vector
  122. *
  123. * @param[in] v vector
  124. */
  125. CGLM_INLINE
  126. float
  127. glm_vec3_max(vec3 v) {
  128. float max;
  129. max = v[0];
  130. if (v[1] > max)
  131. max = v[1];
  132. if (v[2] > max)
  133. max = v[2];
  134. return max;
  135. }
  136. /*!
  137. * @brief min value of vector
  138. *
  139. * @param[in] v vector
  140. */
  141. CGLM_INLINE
  142. float
  143. glm_vec3_min(vec3 v) {
  144. float min;
  145. min = v[0];
  146. if (v[1] < min)
  147. min = v[1];
  148. if (v[2] < min)
  149. min = v[2];
  150. return min;
  151. }
  152. /*!
  153. * @brief check if one of items is NaN (not a number)
  154. * you should only use this in DEBUG mode or very critical asserts
  155. *
  156. * @param[in] v vector
  157. */
  158. CGLM_INLINE
  159. bool
  160. glm_vec3_isnan(vec3 v) {
  161. #ifndef CGLM_FAST_MATH
  162. return isnan(v[0]) || isnan(v[1]) || isnan(v[2]);
  163. #else
  164. return false;
  165. #endif
  166. }
  167. /*!
  168. * @brief check if one of items is INFINITY
  169. * you should only use this in DEBUG mode or very critical asserts
  170. *
  171. * @param[in] v vector
  172. */
  173. CGLM_INLINE
  174. bool
  175. glm_vec3_isinf(vec3 v) {
  176. #ifndef CGLM_FAST_MATH
  177. return isinf(v[0]) || isinf(v[1]) || isinf(v[2]);
  178. #else
  179. return false;
  180. #endif
  181. }
  182. /*!
  183. * @brief check if all items are valid number
  184. * you should only use this in DEBUG mode or very critical asserts
  185. *
  186. * @param[in] v vector
  187. */
  188. CGLM_INLINE
  189. bool
  190. glm_vec3_isvalid(vec3 v) {
  191. return !glm_vec3_isnan(v) && !glm_vec3_isinf(v);
  192. }
  193. /*!
  194. * @brief get sign of 32 bit float as +1, -1, 0
  195. *
  196. * Important: It returns 0 for zero/NaN input
  197. *
  198. * @param v vector
  199. */
  200. CGLM_INLINE
  201. void
  202. glm_vec3_sign(vec3 v, vec3 dest) {
  203. dest[0] = glm_signf(v[0]);
  204. dest[1] = glm_signf(v[1]);
  205. dest[2] = glm_signf(v[2]);
  206. }
  207. /*!
  208. * @brief absolute value of each vector item
  209. *
  210. * @param[in] v vector
  211. * @param[out] dest destination vector
  212. */
  213. CGLM_INLINE
  214. void
  215. glm_vec3_abs(vec3 v, vec3 dest) {
  216. dest[0] = fabsf(v[0]);
  217. dest[1] = fabsf(v[1]);
  218. dest[2] = fabsf(v[2]);
  219. }
  220. /*!
  221. * @brief fractional part of each vector item
  222. *
  223. * @param[in] v vector
  224. * @param[out] dest destination vector
  225. */
  226. CGLM_INLINE
  227. void
  228. glm_vec3_fract(vec3 v, vec3 dest) {
  229. dest[0] = fminf(v[0] - floorf(v[0]), 0.999999940395355224609375f);
  230. dest[1] = fminf(v[1] - floorf(v[1]), 0.999999940395355224609375f);
  231. dest[2] = fminf(v[2] - floorf(v[2]), 0.999999940395355224609375f);
  232. }
  233. /*!
  234. * @brief floor of each vector item
  235. *
  236. * @param[in] v vector
  237. * @param[out] dest destination vector
  238. */
  239. CGLM_INLINE
  240. void
  241. glm_vec3_floor(vec3 v, vec3 dest) {
  242. dest[0] = floorf(v[0]);
  243. dest[1] = floorf(v[1]);
  244. dest[2] = floorf(v[2]);
  245. }
  246. /*!
  247. * @brief mod of each vector item, result is written to dest (dest = v % s)
  248. *
  249. * @param[in] v vector
  250. * @param[in] s scalar
  251. * @param[out] dest destination vector
  252. */
  253. CGLM_INLINE
  254. void
  255. glm_vec3_mods(vec3 v, float s, vec3 dest) {
  256. dest[0] = fmodf(v[0], s);
  257. dest[1] = fmodf(v[1], s);
  258. dest[2] = fmodf(v[2], s);
  259. }
  260. /*!
  261. * @brief threshold each vector item with scalar
  262. * condition is: (x[i] < edge) ? 0.0 : 1.0
  263. *
  264. * @param[in] edge threshold
  265. * @param[in] x vector to test against threshold
  266. * @param[out] dest destination
  267. */
  268. CGLM_INLINE
  269. void
  270. glm_vec3_steps(float edge, vec3 x, vec3 dest) {
  271. dest[0] = glm_step(edge, x[0]);
  272. dest[1] = glm_step(edge, x[1]);
  273. dest[2] = glm_step(edge, x[2]);
  274. }
  275. /*!
  276. * @brief threshold a value with *vector* as the threshold
  277. * condition is: (x < edge[i]) ? 0.0 : 1.0
  278. *
  279. * @param[in] edge threshold vector
  280. * @param[in] x value to test against threshold
  281. * @param[out] dest destination
  282. */
  283. CGLM_INLINE
  284. void
  285. glm_vec3_stepr(vec3 edge, float x, vec3 dest) {
  286. dest[0] = glm_step(edge[0], x);
  287. dest[1] = glm_step(edge[1], x);
  288. dest[2] = glm_step(edge[2], x);
  289. }
  290. /*!
  291. * @brief vector reduction by summation
  292. * @warning could overflow
  293. *
  294. * @param[in] v vector
  295. * @return sum of all vector's elements
  296. */
  297. CGLM_INLINE
  298. float
  299. glm_vec3_hadd(vec3 v) {
  300. return v[0] + v[1] + v[2];
  301. }
  302. /*!
  303. * @brief square root of each vector item
  304. *
  305. * @param[in] v vector
  306. * @param[out] dest destination vector
  307. */
  308. CGLM_INLINE
  309. void
  310. glm_vec3_sqrt(vec3 v, vec3 dest) {
  311. dest[0] = sqrtf(v[0]);
  312. dest[1] = sqrtf(v[1]);
  313. dest[2] = sqrtf(v[2]);
  314. }
  315. #endif /* cglm_vec3_ext_h */