Рефакторинг и оптимизация вычислений / Refactoring and optimization of computations

basic-geometry/vector3.c

@@ -1,5 +1,41 @@
 #include "vector3.h"
 
+// =============== Normalization ================ //
+
+int bg_fp32_vector3_normalize(BgFP32Vector3* vector)
+{
+    const float square_modulus = bg_fp32_vector3_get_square_modulus(vector);
+
+    if (1.0f - BG_FP32_TWO_EPSYLON <= square_modulus && square_modulus <= 1.0f + BG_FP32_TWO_EPSYLON) {
+        return 1;
+    }
+
+    if (square_modulus <= BG_FP32_SQUARE_EPSYLON) {
+        bg_fp32_vector3_reset(vector);
+        return 0;
+    }
+
+    bg_fp32_vector3_multiply(vector, sqrtf(1.0f / square_modulus), vector);
+    return 1;
+}
+
+int bg_fp64_vector3_normalize(BgFP64Vector3* vector)
+{
+    const double square_modulus = bg_fp64_vector3_get_square_modulus(vector);
+
+    if (1.0 - BG_FP64_TWO_EPSYLON <= square_modulus && square_modulus <= 1.0 + BG_FP64_TWO_EPSYLON) {
+        return 1;
+    }
+