Add Unit Tests for Matrix and Extend Test Coverage for Math Utilities

[jnyfah]

Currently, our Matrix class lacks dedicated unit tests. While there's some initial test structure and inspiration in matrix_test.cpp, we need to formalize and expand this coverage.

Tasks:

• Add comprehensive unit tests for the Matrix class.
• Validate operations such as construction, indexing, arithmetic, and transformations.
• Use matrix_test.cpp as a reference or starting point.
• If we introduce new math utilities like Quaternion, include corresponding test files and coverage as well.

[jnyfah]

@AmanMenda