working flexible cube count

Test weil es chris fickt

.gitignore

@@ -1,2 +1,3 @@
 cmake-build-debug/
 cmake-build-debug-mingw/
+.idea/workspace.xml

.idea/.gitignore

@@ -1,8 +0,0 @@
-# Default ignored files
-/shelf/
-/workspace.xml
-# Editor-based HTTP Client requests
-/httpRequests/
-# Datasource local storage ignored files
-/dataSources/
-/dataSources.local.xml

.idea/Programmieren 3B.iml

@@ -1,2 +0,0 @@
-<?xml version="1.0" encoding="UTF-8"?>
-<module classpath="CMake" type="CPP_MODULE" version="4" />

.idea/modules.xml

@@ -2,7 +2,6 @@
 <project version="4">
   <component name="ProjectModuleManager">
     <modules>
-      <module fileurl="file://$PROJECT_DIR$/.idea/Programmieren 3B.iml" filepath="$PROJECT_DIR$/.idea/Programmieren 3B.iml" />
       <module fileurl="file://$PROJECT_DIR$/.idea/Stone_Development.iml" filepath="$PROJECT_DIR$/.idea/Stone_Development.iml" />
     </modules>
   </component>

.idea/workspace.xml

@@ -7,7 +7,6 @@
     <option name="/Default/RiderDebugger/RiderRestoreDecompile/RestoreDecompileSetting/@EntryValue" value="false" type="bool" />
     <option name="/Default/Housekeeping/GlobalSettingsUpgraded/IsUpgraded/@EntryValue" value="true" type="bool" />
     <option name="/Default/Housekeeping/FeatureSuggestion/FeatureSuggestionManager/DisabledSuggesters/=SwitchToGoToActionSuggester/@EntryIndexedValue" value="true" type="bool" />
-    <option name="/Default/Housekeeping/FeatureSuggestion/FeatureSuggestionManager/DisabledSuggesters/=SwitchToGoToActionSuggester/@EntryIndexRemoved" />
   </component>
   <component name="CMakePresetLoader">{
   &quot;useNewFormat&quot;: true
@@ -21,16 +20,22 @@
   <component name="CMakeRunConfigurationManager">
     <generated>
       <config projectName="Prog3B" targetName="Prog3B" />
+      <config projectName="Prog3B" targetName="Prog3B_tests" />
     </generated>
   </component>
   <component name="CMakeSettings">
     <configurations>
-      <configuration PROFILE_NAME="Debug-MinGW" ENABLED="true" CONFIG_NAME="Debug" TOOLCHAIN_NAME="MinGW" />
+      <configuration PROFILE_NAME="Debug" ENABLED="true" CONFIG_NAME="Debug" />
     </configurations>
   </component>
   <component name="ChangeListManager">
-    <list default="true" id="e1b17018-ef5c-443f-8959-8b1378194905" name="Changes" comment="">
+    <list default="true" id="db070755-9708-4a46-a9cb-e7c4dc1bfb77" name="Changes" comment="">
+      <change afterPath="$PROJECT_DIR$/createCube.cpp" afterDir="false" />
+      <change afterPath="$PROJECT_DIR$/createCube.h" afterDir="false" />
+      <change beforePath="$PROJECT_DIR$/.idea/editor.xml" beforeDir="false" afterPath="$PROJECT_DIR$/.idea/editor.xml" afterDir="false" />
       <change beforePath="$PROJECT_DIR$/.idea/workspace.xml" beforeDir="false" afterPath="$PROJECT_DIR$/.idea/workspace.xml" afterDir="false" />
+      <change beforePath="$PROJECT_DIR$/CMakeLists.txt" beforeDir="false" afterPath="$PROJECT_DIR$/CMakeLists.txt" afterDir="false" />
+      <change beforePath="$PROJECT_DIR$/main.cpp" beforeDir="false" afterPath="$PROJECT_DIR$/main.cpp" afterDir="false" />
     </list>
     <option name="SHOW_DIALOG" value="false" />
     <option name="HIGHLIGHT_CONFLICTS" value="true" />
@@ -40,73 +45,79 @@
   <component name="ClangdSettings">
     <option name="formatViaClangd" value="false" />
   </component>
-  <component name="ExecutionTargetManager" SELECTED_TARGET="CMakeBuildProfile:Debug-MinGW" />
+  <component name="ExecutionTargetManager" SELECTED_TARGET="CMakeBuildProfile:Debug" />
   <component name="Git.Settings">
     <option name="RECENT_GIT_ROOT_PATH" value="$PROJECT_DIR$" />
   </component>
-  <component name="HighlightingSettingsPerFile">
+  <component name="ProjectApplicationVersion">
-    <setting file="file://$PROJECT_DIR$/main.cpp" root0="FORCE_HIGHLIGHTING" />
+    <option name="ide" value="CLion" />
-    <setting file="mock://C:/Users/marce/Desktop/Prog Praktikum C++/Semester 3/Stone_Development/tests.cpp" root0="SKIP_HIGHLIGHTING" />
+    <option name="majorVersion" value="2024" />
-    <setting file="mock://C:/Users/marce/Desktop/Prog Praktikum C++/Semester 3/Stone_Development/tests.cpp" root0="SKIP_HIGHLIGHTING" />
+    <option name="minorVersion" value="3.4" />
+    <option name="productBranch" value="Classic" />
   </component>
   <component name="ProjectColorInfo">{
   &quot;customColor&quot;: &quot;&quot;,
-  &quot;associatedIndex&quot;: 0
+  &quot;associatedIndex&quot;: 1
 }</component>
-  <component name="ProjectId" id="34yCUQNT5FEzK3w2FlmvvgM9a9g" />
+  <component name="ProjectId" id="35dvDDehATN0hwwCgiPHEpDQPia" />
   <component name="ProjectViewState">
     <option name="hideEmptyMiddlePackages" value="true" />
     <option name="showLibraryContents" value="true" />
   </component>
-  <component name="PropertiesComponent">{
+  <component name="PropertiesComponent"><![CDATA[{
-  &quot;keyToString&quot;: {
+  "keyToString": {
-    &quot;CMake Application.Prog3B.executor&quot;: &quot;Run&quot;,
+    "CMake Application.Prog3B.executor": "Run",
-    &quot;CMake Application.Prog3B_tests.executor&quot;: &quot;Run&quot;,
+    "RunOnceActivity.RadMigrateCodeStyle": "true",
-    &quot;RunOnceActivity.RadMigrateCodeStyle&quot;: &quot;true&quot;,
+    "RunOnceActivity.ShowReadmeOnStart": "true",
-    &quot;RunOnceActivity.ShowReadmeOnStart&quot;: &quot;true&quot;,
+    "RunOnceActivity.cidr.known.project.marker": "true",
-    &quot;RunOnceActivity.cidr.known.project.marker&quot;: &quot;true&quot;,
+    "RunOnceActivity.git.unshallow": "true",
-    &quot;RunOnceActivity.git.unshallow&quot;: &quot;true&quot;,
+    "RunOnceActivity.readMode.enableVisualFormatting": "true",
-    &quot;RunOnceActivity.readMode.enableVisualFormatting&quot;: &quot;true&quot;,
+    "RunOnceActivity.west.config.association.type.startup.service": "true",
-    &quot;RunOnceActivity.west.config.association.type.startup.service&quot;: &quot;true&quot;,
+    "cf.first.check.clang-format": "false",
-    &quot;cf.first.check.clang-format&quot;: &quot;false&quot;,
+    "cidr.known.project.marker": "true",
-    &quot;cidr.known.project.marker&quot;: &quot;true&quot;,
+    "git-widget-placeholder": "Flexible-cube-count",
-    &quot;git-widget-placeholder&quot;: &quot;main&quot;,
+    "last_opened_file_path": "C:/Desktop/StudiumME/3.Sem/Prog3/B/MatrixPybind",
-    &quot;last_opened_file_path&quot;: &quot;C:/Users/marce/Desktop/Prog Praktikum C++/Vorlesung/Lambda&quot;,
+    "node.js.detected.package.eslint": "true",
-    &quot;node.js.detected.package.eslint&quot;: &quot;true&quot;,
+    "node.js.detected.package.tslint": "true",
-    &quot;node.js.detected.package.tslint&quot;: &quot;true&quot;,
+    "node.js.selected.package.eslint": "(autodetect)",
-    &quot;node.js.selected.package.eslint&quot;: &quot;(autodetect)&quot;,
+    "node.js.selected.package.tslint": "(autodetect)",
-    &quot;node.js.selected.package.tslint&quot;: &quot;(autodetect)&quot;,
+    "nodejs_package_manager_path": "npm",
-    &quot;nodejs_package_manager_path&quot;: &quot;npm&quot;,
+    "vue.rearranger.settings.migration": "true"
-    &quot;settings.editor.selected.configurable&quot;: &quot;CMakeSettings&quot;,
-    &quot;vue.rearranger.settings.migration&quot;: &quot;true&quot;
   }
-}</component>
+}]]></component>
-  <component name="RunManager">
+  <component name="RunManager" selected="CMake Application.Prog3B">
-    <configuration name="Prog3B" type="CMakeRunConfiguration" factoryName="Application" REDIRECT_INPUT="false" ELEVATE="false" USE_EXTERNAL_CONSOLE="false" EMULATE_TERMINAL="false" PASS_PARENT_ENVS_2="true" PROJECT_NAME="Prog3B" TARGET_NAME="Prog3B" CONFIG_NAME="Debug-MinGW" RUN_TARGET_PROJECT_NAME="Prog3B" RUN_TARGET_NAME="Prog3B">
+    <configuration default="true" type="CLionExternalRunConfiguration" factoryName="Application" REDIRECT_INPUT="false" ELEVATE="false" USE_EXTERNAL_CONSOLE="false" EMULATE_TERMINAL="false" PASS_PARENT_ENVS_2="true">
+      <method v="2">
+        <option name="CLION.EXTERNAL.BUILD" enabled="true" />
+      </method>
+    </configuration>
+    <configuration name="Prog3B" type="CMakeRunConfiguration" factoryName="Application" REDIRECT_INPUT="false" ELEVATE="false" USE_EXTERNAL_CONSOLE="false" EMULATE_TERMINAL="false" PASS_PARENT_ENVS_2="true" PROJECT_NAME="Prog3B" TARGET_NAME="Prog3B" CONFIG_NAME="Debug" RUN_TARGET_PROJECT_NAME="Prog3B" RUN_TARGET_NAME="Prog3B">
       <method v="2">
         <option name="com.jetbrains.cidr.execution.CidrBuildBeforeRunTaskProvider$BuildBeforeRunTask" enabled="true" />
       </method>
     </configuration>
-    <configuration default="true" type="CMakeRunConfiguration" factoryName="Application" REDIRECT_INPUT="false" ELEVATE="false" USE_EXTERNAL_CONSOLE="false" EMULATE_TERMINAL="false" PASS_PARENT_ENVS_2="true">
+    <configuration name="Prog3B_tests" type="CMakeRunConfiguration" factoryName="Application" REDIRECT_INPUT="false" ELEVATE="false" USE_EXTERNAL_CONSOLE="false" EMULATE_TERMINAL="false" PASS_PARENT_ENVS_2="true" PROJECT_NAME="Prog3B" TARGET_NAME="Prog3B_tests" CONFIG_NAME="Debug" RUN_TARGET_PROJECT_NAME="Prog3B" RUN_TARGET_NAME="Prog3B_tests">
       <method v="2">
         <option name="com.jetbrains.cidr.execution.CidrBuildBeforeRunTaskProvider$BuildBeforeRunTask" enabled="true" />
       </method>
     </configuration>
+    <list>
+      <item itemvalue="CMake Application.Prog3B" />
+      <item itemvalue="CMake Application.Prog3B_tests" />
+    </list>
   </component>
   <component name="SpellCheckerSettings" RuntimeDictionaries="0" Folders="0" CustomDictionaries="0" DefaultDictionary="application-level" UseSingleDictionary="true" transferred="true" />
   <component name="TaskManager">
     <task active="true" id="Default" summary="Default task">
-      <changelist id="e1b17018-ef5c-443f-8959-8b1378194905" name="Changes" comment="" />
+      <changelist id="db070755-9708-4a46-a9cb-e7c4dc1bfb77" name="Changes" comment="" />
-      <created>1762176441912</created>
+      <created>1763452643165</created>
       <option name="number" value="Default" />
       <option name="presentableId" value="Default" />
-      <updated>1762176441912</updated>
+      <updated>1763452643165</updated>
-      <workItem from="1762176443926" duration="3810000" />
+      <workItem from="1763452645145" duration="329000" />
-      <workItem from="1762783055261" duration="74000" />
+      <workItem from="1763652636624" duration="1226000" />
-      <workItem from="1763367345575" duration="665000" />
+      <workItem from="1763653877709" duration="28000" />
-      <workItem from="1763368121506" duration="692000" />
+      <workItem from="1763895078693" duration="5675000" />
-      <workItem from="1763385066418" duration="421000" />
-      <workItem from="1763385896177" duration="1973000" />
     </task>
     <servers />
   </component>
@@ -118,7 +129,4 @@
     <isAutomaticFoundErrors value="true" />
     <isAutomaticReloadCMake value="true" />
   </component>
-  <component name="VcsManagerConfiguration">
-    <option name="LAST_COMMIT_MESSAGE" value="" />
-  </component>
 </project>

CMakeLists.txt

@@ -15,7 +15,8 @@ endif()
 set(SRC_FILES
         ${CMAKE_CURRENT_LIST_DIR}/main.cpp
         ${CMAKE_CURRENT_LIST_DIR}/gamecube.cpp
-        tests.cpp
+        ${CMAKE_CURRENT_LIST_DIR}/gamematrix.cpp
+        ${CMAKE_CURRENT_LIST_DIR}/createCube.cpp
 )
 
 set(INCLUDE_DIRS
@@ -49,11 +50,8 @@ endif()
 add_executable(${EXECUTABLE_NAME} ${SRC_FILES})
 target_include_directories(${EXECUTABLE_NAME} PRIVATE ${INCLUDE_DIRS})
 
-
-
 # === Bibliotheken verlinken ===
 target_link_libraries(${EXECUTABLE_NAME} PRIVATE
-        ${CMAKE_CURRENT_LIST_DIR}/${OS_DIR}/libgamematrix.a
         ${CMAKE_CURRENT_LIST_DIR}/${OS_DIR}/libraylib.a
 )
 
@@ -71,7 +69,5 @@ if(APPLE)
     )
 endif()
 
-
 add_executable(Prog3B_tests tests.cpp)
 set_target_properties(Prog3B_tests PROPERTIES WIN32_EXECUTABLE OFF)
-

createCube.cpp

@@ -0,0 +1,71 @@
+#include "createCube.h"
+#include <iostream>
+
+std::vector<Vec3> createCubes(int pairs)
+{
+  //zwei bis zehn paare
+  if (pairs >10 || pairs <= 1)
+  {
+    // 6 Karten-Positionen im 3x2 Raster
+    return {{-2, 0, -2}, {0, 0, -2}, {2, 0, -2},{-2, 0,  0}, {0, 0,  0}, {2, 0,  0}}; // Default field
+  }
+  std::vector<int> fieldSize = calculateFieldSize(pairs);
+  std::vector<Vec3> cubePositions;
+  //std::cout<<(fieldSize[0])<<std::endl;
+  //std::cout<<(fieldSize[1]) <<std::endl;
+  int start_x = (fieldSize[0]/2) * -2;
+  int start_y = (fieldSize[1]/2) * -2;
+  for (int i = 0; i < fieldSize[0]; i++)
+  {
+    for (int j = 0; j < fieldSize[1]; j++)
+    {
+      cubePositions.push_back(Vec3(start_x + 2*i, 0, start_y + 2*j));
+    }
+  }
+  return cubePositions;
+};
+
+std::vector<int> calculateFieldSize(int pairs)
+{
+  std::vector<int> best_field = {pairs, 2};
+  int cube_count = pairs *2;
+  int test_count = 3;
+  while (test_count < pairs)
+  {
+    for (int i = 3; i < pairs; i++)
+    {
+      if (test_count * i == cube_count && test_count + i < best_field[0] + best_field[1])
+      {
+        best_field[1] = test_count;
+        best_field[0] = i;
+      }
+    }
+    test_count++;
+  }
+  return best_field;
+
+};
+
+std::vector<Color> getColors(int pairs)
+{
+  if (pairs >10) pairs = 10;
+  std::vector<Color> returnColors;
+  Color colors[] = {
+    {230, 25, 75, 255},   // Red
+    {60, 180, 75, 255},   // Green
+    {0, 130, 200, 255},   // Blue
+    {245, 130, 48, 255},  // Orange
+    {145, 30, 180, 255},  // Purple
+    {255, 225, 25, 255},  // Yellow
+    {70, 240, 240, 255},  // Cyan
+    {240, 50, 230, 255},  // Magenta
+    {210, 245, 60, 255},  // Lime
+    {250, 190, 190, 255}  // Pink
+  };
+  for (int i = 0; i < pairs; i++)
+  {
+    returnColors.push_back(colors[i]);
+  }
+  std::cout << returnColors.size() << std::endl;
+  return returnColors;
+};

createCube.h

@@ -0,0 +1,11 @@
+#pragma once
+#include "gamecube.h"
+
+
+
+std::vector<Vec3> createCubes(int pairs);
+
+std::vector<Color> getColors(int pairs);
+
+std::vector<int> calculateFieldSize(int pairs);
+

gamecube.cpp

@@ -44,11 +44,11 @@ void gamecube::Draw() const
     rlPushMatrix();
 
     // Matrizen für Rotation und Translation erzeugen
-    auto matrix_a = gameMatrix::translate({ position.x, position.y, position.z});
+    auto matrix_a = Matrix3D::gameMatrix::translate({ position.x, position.y, position.z});
-    auto matrix_b = gameMatrix::rot3D(rotation, 'y');
+    auto matrix_b = Matrix3D::gameMatrix::rot3D(rotation, 'y');
 
     // Matrizen multiplizieren (Translation * Rotation)
-    auto model = gameMatrix::matmul(matrix_a, matrix_b);
+    auto model = Matrix3D::gameMatrix::matmul(matrix_a, matrix_b);
 
     // transform for raylib matrix
     float f[16];

gamematrix.cpp

@@ -0,0 +1,87 @@
+#include "gamematrix.h"
+
+
+using namespace Matrix3D;
+
+///
+/// @param matrix1 - First matrix
+/// @param matrix2 - Second matrix
+/// @return Returns the multiplication of matrix 1 and matrix 2.
+std::array<std::array<double,4>,4> gameMatrix::matmul(const std::array<std::array<double,4>,4>& matrix1,
+                                           const std::array<std::array<double,4>,4>& matrix2) {
+
+    std::array<std::array<double,4>,4> matrix3 = {};
+    if (matrix1[0].size() != matrix2.size()) {
+          throw std::invalid_argument("Number of columns of matrix 1 must be equal to number of rows of matrix 2");
+    };
+    for (int i = 0; i < matrix1.size(); i++) {
+      std::array<double,4> temp_array = {};
+      for (int j = 0; j < matrix2[i].size(); j++) {
+        double temp = 0;
+        for (int k = 0; k < matrix2.size(); k++) {
+          temp += matrix1[i][k] * matrix2[k][j];
+        }
+        temp_array[j] = temp;
+      }
+      matrix3[i] = temp_array;
+    }
+    return matrix3;
+}
+
+///
+/// @param angle_deg Rotation angle
+/// @param axis Rotation axis (x, y, z)
+/// @return Returns a rotation matrix based on a given angle and axis.
+std::array<std::array<double,4>,4> gameMatrix::rot3D(double angle_deg, char axis) {
+  if (axis != 'x' && axis != 'y' && axis != 'z') {
+    throw std::invalid_argument("Invalid axis");
+  };
+  const auto angle_rad = angle_deg * M_PI / 180;
+  std::array<std::array<double,4>,4> rotationMatrix = {};
+  switch (axis) {
+    case 'x': {
+      std::array<std::array<double,4>,4> rMx = {{
+        {1, 0, 0, 0},
+        {0, cos(angle_rad), -sin(angle_rad), 0},
+        {0, sin(angle_rad), cos(angle_rad), 0},
+        {0, 0, 0, 1}
+      }};
+      rotationMatrix = rMx;
+    }
+      break;
+    case 'y': {
+      std::array<std::array<double,4>,4> rMy = {{
+        {cos(angle_rad), 0, sin(angle_rad), 0},
+        {0, 1, 0, 0},
+        {-sin(angle_rad), 0, cos(angle_rad), 0},
+        {0, 0, 0, 1}
+      }};
+      rotationMatrix = rMy;
+    }
+      break;
+
+    case 'z': {
+      std::array<std::array<double,4>,4> rMz = {{
+        {cos(angle_rad), -sin(angle_rad), 0, 0},
+        {sin(angle_rad), cos(angle_rad), 0, 0},
+        {0, 0, 1, 0},
+        {0, 0, 0, 1}
+      }};
+      rotationMatrix = rMz;
+    }
+      break;
+  }
+  return rotationMatrix;
+};
+
+
+///
+/// @param pos 3 point vector (x, y, z)
+/// @return Returns a 4x4 translation matrix base on a given vector.
+std::array<std::array<double,4>,4> gameMatrix::translate(const std::array<double, 3>& pos) {
+  std::array<std::array<double,4>,4> transMatrix = {{{1, 0, 0, pos[0]}, {0, 1, 0, pos[1]}, {0, 0, 1, pos[2]}, {0, 0, 0, 1}}};
+  return transMatrix;
+};
+
+
+

gamematrix.h

@@ -4,16 +4,23 @@
 #include <stdexcept>
 #include <cmath>
 
-class gameMatrix
+namespace Matrix3D {
-{
+    class gameMatrix
-public:
+    {
-    // Matrix Multiplikation
+    public:
-    static std::array<std::array<double,4>,4> matmul(const std::array<std::array<double,4>,4>& A,
+        // Matrix Multiplikation
-                                                   const std::array<std::array<double,4>,4>& B);
+        static std::array<std::array<double,4>,4> matmul(const std::array<std::array<double,4>,4>& matrix1,
+                                                       const std::array<std::array<double,4>,4>& matrix2);
 
-    // Rotationsmatrix um Achse x/y/z
+        // Rotationsmatrix um Achse x/y/z
-    static std::array<std::array<double,4>,4> rot3D(double angle_deg, char axis);
+        static std::array<std::array<double,4>,4> rot3D(double angle_deg, char axis);
 
-    // Verschiebung
+        // Verschiebung
-    static std::array<std::array<double,4>,4> translate(const std::array<double, 3>& pos);
+        static std::array<std::array<double,4>,4> translate(const std::array<double, 3>& pos);
-};
+
+    private:
+        //TODO: Was für eine Rolle spielen Vec3 und Mat4???
+        struct Vec3 {double x,y,z;};
+        std::array<std::array<double,4>,4> Mat4 {};
+    };
+}

main.cpp

@@ -1,4 +1,5 @@
 #include "gamecube.h"
+#include "createCube.h"
 #include <algorithm>
 #include <ctime>
 
@@ -17,21 +18,22 @@ int main()
     SetTargetFPS(60);
 
     Camera3D camera{};
-    camera.position = {6.0f, 6.0f, 6.0f};
+    camera.position = {8.0f, 8.5f, 8.0f};
     camera.target   = {0.0f, 0.0f, 0.0f};
     camera.up       = {0.0f, 1.0f, 0.0f};
     camera.fovy     = 45.0f;
     camera.projection = CAMERA_PERSPECTIVE;
 
+    int cubePairs = 3; //Cube count => 2*cubePairs
+    std::vector<Vec3> positions =createCubes(cubePairs);
+
     // Nur 3 Farben für 3 Paare
-    Color colors[] = { RED, GREEN, BLUE };
+    std::vector<Color> colors= getColors(cubePairs);
 
-    // 6 Karten-Positionen im 3x2 Raster
-    std::vector<Vec3> positions = {{-2, 0, -2}, {0, 0, -2}, {2, 0, -2},{-2, 0,  0}, {0, 0,  0}, {2, 0,  0}};
 
     // Farben doppelt in einen Pool legen und mischen
     std::vector<Color> colorPool;
-    for (int i = 0; i < 3; i++)
+    for (int i = 0; i < cubePairs; i++)
     {
         colorPool.push_back(colors[i]);
         colorPool.push_back(colors[i]);
@@ -46,7 +48,7 @@ int main()
 
     // Karten/Würfel erstellen
     std::vector<gamecube> cubes;
-    for (int i = 0; i < 6; i++)
+    for (int i = 0; i < cubePairs*2; i++)
         cubes.emplace_back(positions[i], colorPool[i]);
 
     gamecube* first  = nullptr;

tests.cpp

@@ -1,13 +1,53 @@
-#include <array>
+#include <cassert>
+#include <cmath>
+#include <iostream>
+#include "gamematrix.cpp"
 
-int main()
+void test_matmul_basic() {
-{
+    std::array<std::array<double,4>,4> A = {{
+        {1, 0, 0, 0},
+        {0, 1, 0, 0},
+        {0, 0, 1, 0},
+        {0, 0, 0, 1}
+    }};
 
+    std::array<std::array<double,4>,4> B = {{
+        {2, 3, 4, 5},
+        {1, 1, 1, 1},
+        {0, 0, 0, 0},
+        {7, 7, 7, 7}
+    }};
 
+    auto C = Matrix3D::gameMatrix::matmul(A, B);
+
+    assert(C[0][0] == 2);
+    assert(C[0][1] == 3);
+    assert(C[1][0] == 1);
+    assert(C[3][3] == 7);
 }
 
-bool test_matmul()
+void test_translate_basic() {
-{
+    std::array<double, 3> pos = {3, -2, 8};
 
+    auto T = Matrix3D::gameMatrix::translate(pos);
 
+    assert(T[0][3] == 3);
+    assert(T[1][3] == -2);
+    assert(T[2][3] == 8);
+}
+
+void test_rot3D_basic() {
+    auto R = Matrix3D::gameMatrix::rot3D(90, 'x');
+    // cos(90°) ≈ 0, sin(90°) ≈ 1
+    assert(std::abs(R[1][1]) < 1e-6);
+    assert(std::abs(R[1][2] + 1.0) < 1e-6);
+}
+
+int main() {
+    test_matmul_basic();
+    test_translate_basic();
+    test_rot3D_basic();
+
+    std::cout << "Test bestanden!\n";
+    return 0;
 }