Добавление swap функций для векторов, кватернионов и матриц / Swap functions have been added for vectors, quaternions and matrixes

basic-geometry-dev/main.c

@@ -236,6 +236,7 @@ int main()
             bg_fp32_versor_combine(&versors1[i], &versors2[i], &results[i]);
             bg_fp32_versor_get_rotation_matrix(&versors1[i], &matrixes[i]);
             bg_fp32_matrix3x3_right_product(&matrixes[i], &vectors[i], &vectors[i]);
+            //bg_fp32_versor_turn(&results[i], &vectors[i], &vectors[i]);
         }
     }
 

basic-geometry/matrix2x2.h

@@ -105,6 +105,50 @@ static inline void bg_fp64_matrix2x2_copy(const BgFP64Matrix2x2* from, BgFP64Mat
     to->r2c2 = from->r2c2;
 }
 
+// ==================== Swap ==================== //
+
+static inline void bg_fp32_matrix2x2_swap(BgFP32Matrix2x2* matrix1, BgFP32Matrix2x2* matrix2)
+{
+    const float r1c1 = matrix2->r1c1;
+    const float r1c2 = matrix2->r1c2;
+
+    const float r2c1 = matrix2->r2c1;
+    const float r2c2 = matrix2->r2c2;
+
+    matrix2->r1c1 = matrix1->r1c1;
+    matrix2->r1c2 = matrix1->r1c2;
+
+    matrix2->r2c1 = matrix1->r2c1;
+    matrix2->r2c2 = matrix1->r2c2;
+
+    matrix1->r1c1 = r1c1;
+    matrix1->r1c2 = r1c2;
+
+    matrix1->r2c1 = r2c1;
+    matrix1->r2c2 = r2c2;
+}
+
+static inline void bg_fp64_matrix2x2_swap(BgFP64Matrix2x2* matrix1, BgFP64Matrix2x2* matrix2)
+{
+    const double r1c1 = matrix2->r1c1;
+    const double r1c2 = matrix2->r1c2;
+
+    const double r2c1 = matrix2->r2c1;
+    const double r2c2 = matrix2->r2c2;
+
+    matrix2->r1c1 = matrix1->r1c1;
+    matrix2->r1c2 = matrix1->r1c2;
+
+    matrix2->r2c1 = matrix1->r2c1;
+    matrix2->r2c2 = matrix1->r2c2;
+
+    matrix1->r1c1 = r1c1;