Got the matrix library compiling in the tests
This commit is contained in:
@@ -29,6 +29,7 @@ set_target_properties(Matrix
|
||||
LINKER_LANGUAGE CXX
|
||||
)
|
||||
|
||||
target_include_directories(Matrix PUBLIC
|
||||
include
|
||||
target_include_directories(Matrix
|
||||
PUBLIC
|
||||
.
|
||||
)
|
||||
252
Matrix.hpp
252
Matrix.hpp
@@ -1,16 +1,17 @@
|
||||
#pragma once
|
||||
|
||||
#include <cstdint>
|
||||
#include <array>
|
||||
#include <type_traits>
|
||||
#include <cmath>
|
||||
#include <cstdint>
|
||||
#include <cstdlib>
|
||||
#include <type_traits>
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
class Matrix{
|
||||
public:
|
||||
|
||||
template <uint8_t rows, uint8_t columns> class Matrix {
|
||||
public:
|
||||
Matrix();
|
||||
|
||||
Matrix(const std::array<float, columns> & array);
|
||||
Matrix(const std::array<float, columns> &array);
|
||||
|
||||
/**
|
||||
* @brief Element-wise matrix addition
|
||||
@@ -18,7 +19,8 @@ class Matrix{
|
||||
* @param result A buffer to store the result into
|
||||
* @note there is no problem if result == this
|
||||
*/
|
||||
void Add(const Matrix<rows, columns> & other, Matrix<rows, columns> & result) const;
|
||||
void Add(const Matrix<rows, columns> &other,
|
||||
Matrix<rows, columns> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Element-wise subtract matrix
|
||||
@@ -26,7 +28,8 @@ class Matrix{
|
||||
* @param result A buffer to store the result into
|
||||
* @note there is no problem if result == this
|
||||
*/
|
||||
void Subtract(const Matrix<rows, columns> & other, Matrix<rows, columns> & result) const;
|
||||
void Subtract(const Matrix<rows, columns> &other,
|
||||
Matrix<rows, columns> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Matrix multiply the two matrices
|
||||
@@ -34,7 +37,8 @@ class Matrix{
|
||||
* @param result A buffer to store the result into
|
||||
*/
|
||||
template <uint8_t other_columns>
|
||||
void Multiply(const Matrix<rows, columns> & other, Matrix<columns, other_columns> & result) const;
|
||||
void Multiply(const Matrix<rows, columns> &other,
|
||||
Matrix<columns, other_columns> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Multiply the matrix by a scalar
|
||||
@@ -42,26 +46,26 @@ class Matrix{
|
||||
* @param result A buffer to store the result into
|
||||
* @note there is no problem if result == this
|
||||
*/
|
||||
void Multiply(float scalar, Matrix<rows, columns> & result) const;
|
||||
void Multiply(float scalar, Matrix<rows, columns> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Invert this matrix
|
||||
* @param result A buffer to store the result into
|
||||
* @warning this is super slow! Only call it if you absolutely have to!!!
|
||||
*/
|
||||
void Invert(Matrix<rows, columns> & result) const;
|
||||
void Invert(Matrix<rows, columns> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Transpose this matrix
|
||||
* @param result A buffer to store the result into
|
||||
*/
|
||||
void Transpose(Matrix<columns, rows> & result) const;
|
||||
void Transpose(Matrix<columns, rows> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Square this matrix
|
||||
* @param result A buffer to store the result into
|
||||
*/
|
||||
void Square(Matrix<rows, columns> & result) const;
|
||||
void Square(Matrix<rows, columns> &result) const;
|
||||
|
||||
/**
|
||||
* @return Get the determinant of the matrix
|
||||
@@ -72,7 +76,7 @@ class Matrix{
|
||||
* @brief Calculate the eigenvalues for a square matrix
|
||||
* @param result a buffer to store the result into
|
||||
*/
|
||||
void EigenValues(Matrix<rows, 1> & result) const;
|
||||
void EigenValues(Matrix<rows, 1> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Element-wise multiply the two matrices
|
||||
@@ -80,7 +84,8 @@ class Matrix{
|
||||
* @param result A buffer to store the result into
|
||||
* @note there is no problem if result == this
|
||||
*/
|
||||
void ElementMultiply(const Matrix<rows, columns> & other, Matrix<rows, columns> & result) const;
|
||||
void ElementMultiply(const Matrix<rows, columns> &other,
|
||||
Matrix<rows, columns> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Element-wise divide the two matrices
|
||||
@@ -88,7 +93,8 @@ class Matrix{
|
||||
* @param result A buffer to store the result into
|
||||
* @note there is no problem if result == this
|
||||
*/
|
||||
void ElementDivide(const Matrix<rows, columns> & other, Matrix<rows, columns> & result) const;
|
||||
void ElementDivide(const Matrix<rows, columns> &other,
|
||||
Matrix<rows, columns> &result) const;
|
||||
|
||||
/**
|
||||
* @brief Get an element from the matrix
|
||||
@@ -96,81 +102,83 @@ class Matrix{
|
||||
* @param column the column index of the element
|
||||
* @return The value of the element you want to get
|
||||
*/
|
||||
float & Get(uint8_t row_index, uint8_t column_index) const;
|
||||
float &Get(uint8_t row_index, uint8_t column_index) const;
|
||||
|
||||
/**
|
||||
* @brief get the specified row of the matrix returned as a reference to the internal array
|
||||
* @brief get the specified row of the matrix returned as a reference to the
|
||||
* internal array
|
||||
*/
|
||||
std::array<float, columns> & operator[](uint8_t row_index) const;
|
||||
std::array<float, columns> &operator[](uint8_t row_index) const;
|
||||
|
||||
void operator=(Matrix<rows, columns> & other);
|
||||
void operator=(Matrix<rows, columns> &other);
|
||||
|
||||
/**
|
||||
* @brief Get a row from the matrix
|
||||
* @param row_index the row index to get
|
||||
* @param row a buffer to write the row into
|
||||
*/
|
||||
void GetRow(uint8_t row_index, Matrix<1, columns> & row) const;
|
||||
void GetRow(uint8_t row_index, Matrix<1, columns> &row) const;
|
||||
|
||||
/**
|
||||
* @brief Get a row from the matrix
|
||||
* @param column_index the row index to get
|
||||
* @param column a buffer to write the row into
|
||||
*/
|
||||
void GetColumn(uint8_t column_index, Matrix<rows, 1> & column) const;
|
||||
void GetColumn(uint8_t column_index, Matrix<rows, 1> &column) const;
|
||||
|
||||
/**
|
||||
* @brief Get the number of rows in this matrix
|
||||
*/
|
||||
constexpr uint8_t GetRowSize(){return rows;}
|
||||
constexpr uint8_t GetRowSize() { return rows; }
|
||||
|
||||
/**
|
||||
* @brief Get the number of columns in this matrix
|
||||
*/
|
||||
constexpr uint8_t GetColumnSize(){return columns;}
|
||||
constexpr uint8_t GetColumnSize() { return columns; }
|
||||
|
||||
private:
|
||||
private:
|
||||
/**
|
||||
* @brief take the dot product of the two vectors
|
||||
*/
|
||||
template <uint8_t vector_size>
|
||||
float dotProduct(const Matrix<vector_size, 1> & vec1, const Matrix<vector_size, 1> & vec2);
|
||||
float dotProduct(const Matrix<vector_size, 1> &vec1,
|
||||
const Matrix<vector_size, 1> &vec2);
|
||||
|
||||
/**
|
||||
* @brief Set all elements in this matrix to zero
|
||||
*/
|
||||
void zeroMatrix();
|
||||
|
||||
void matrixOfMinors(Matrix<rows, columns> & result) const;
|
||||
void matrixOfMinors(Matrix<rows, columns> &result) const;
|
||||
|
||||
void minorMatrix(Matrix<rows-1, columns-1> & result, uint8_t row_idx, uint8_t column_idx) const;
|
||||
void minorMatrix(Matrix<rows - 1, columns - 1> &result, uint8_t row_idx,
|
||||
uint8_t column_idx) const;
|
||||
|
||||
void adjugate(Matrix<rows, columns> & result) const;
|
||||
void adjugate(Matrix<rows, columns> &result) const;
|
||||
|
||||
/**
|
||||
* @brief reduce the matrix so the sum of its elements equal 1
|
||||
* @param result a buffer to store the result into
|
||||
*/
|
||||
void normalize(Matrix<rows, columns> & result) const;
|
||||
void normalize(Matrix<rows, columns> &result) const;
|
||||
|
||||
constexpr bool isSquare(){return rows==columns;}
|
||||
constexpr bool isSquare() { return rows == columns; }
|
||||
std::array<std::array<float, columns>, rows> matrix;
|
||||
};
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
Matrix<rows, columns>::Matrix(){
|
||||
template <uint8_t rows, uint8_t columns> Matrix<rows, columns>::Matrix() {
|
||||
this->zeroMatrix();
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
Matrix<rows, columns>::Matrix(const std::array<float, columns> & array){
|
||||
for(uint8_t row_idx{0}; row_idx < rows; row_idx++){
|
||||
for(uint8_t column_idx{0}; column_idx < columns; column_idx++){
|
||||
uint16_t i = static_cast<uint16_t>(row_idx) + static_cast<uint16_t>(column_idx);
|
||||
if(i < array.size()){
|
||||
Matrix<rows, columns>::Matrix(const std::array<float, columns> &array) {
|
||||
for (uint8_t row_idx{0}; row_idx < rows; row_idx++) {
|
||||
for (uint8_t column_idx{0}; column_idx < columns; column_idx++) {
|
||||
uint16_t i =
|
||||
static_cast<uint16_t>(row_idx) + static_cast<uint16_t>(column_idx);
|
||||
if (i < array.size()) {
|
||||
this->Get(row_idx, column_idx) = array[i];
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
this->Get(row_idx, column_idx) = 0;
|
||||
}
|
||||
}
|
||||
@@ -178,18 +186,20 @@ Matrix<rows, columns>::Matrix(const std::array<float, columns> & array){
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::Add(const Matrix<rows, columns> & other, Matrix<rows, columns> & result) const{
|
||||
for(uint8_t row{0}; row < rows; row++){
|
||||
for(uint8_t column{0}; column < columns; column++){
|
||||
void Matrix<rows, columns>::Add(const Matrix<rows, columns> &other,
|
||||
Matrix<rows, columns> &result) const {
|
||||
for (uint8_t row{0}; row < rows; row++) {
|
||||
for (uint8_t column{0}; column < columns; column++) {
|
||||
result.Get(row, column) = this->Get(row, column) + other.Get(row, column);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::Subtract(const Matrix<rows, columns> & other, Matrix<rows, columns> & result) const{
|
||||
for(uint8_t row{0}; row < rows; row++){
|
||||
for(uint8_t column{0}; column < columns; column++){
|
||||
void Matrix<rows, columns>::Subtract(const Matrix<rows, columns> &other,
|
||||
Matrix<rows, columns> &result) const {
|
||||
for (uint8_t row{0}; row < rows; row++) {
|
||||
for (uint8_t column{0}; column < columns; column++) {
|
||||
result.Get(row, column) = this->Get(row, column) - other.Get(row, column);
|
||||
}
|
||||
}
|
||||
@@ -197,9 +207,11 @@ void Matrix<rows, columns>::Subtract(const Matrix<rows, columns> & other, Matrix
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
template <uint8_t other_columns>
|
||||
void Matrix<rows, columns>::Multiply(const Matrix<rows, columns> & other, Matrix<columns, other_columns> & result) const{
|
||||
for(uint8_t row_idx{0}; row_idx < rows; row_idx++){
|
||||
for(uint8_t column_idx{0}; column_idx < columns; column_idx++){
|
||||
void Matrix<rows, columns>::Multiply(
|
||||
const Matrix<rows, columns> &other,
|
||||
Matrix<columns, other_columns> &result) const {
|
||||
for (uint8_t row_idx{0}; row_idx < rows; row_idx++) {
|
||||
for (uint8_t column_idx{0}; column_idx < columns; column_idx++) {
|
||||
// get our row
|
||||
Matrix<rows, 1> this_row;
|
||||
this->GetRow(row_idx, this_row);
|
||||
@@ -211,34 +223,40 @@ void Matrix<rows, columns>::Multiply(const Matrix<rows, columns> & other, Matrix
|
||||
other_column.Transpose(other_column_t);
|
||||
|
||||
// the result's index is equal to the dot product of these two vectors
|
||||
result.Get(row_idx, column_idx) = this->dotProduct(this_row, other_column_t);
|
||||
result.Get(row_idx, column_idx) =
|
||||
this->dotProduct(this_row, other_column_t);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::Multiply(float scalar, Matrix<rows, columns> & result) const{
|
||||
for(uint8_t row_idx{0}; row_idx < rows; row_idx++){
|
||||
for(uint8_t column_idx{0}; column_idx < columns; column_idx++){
|
||||
void Matrix<rows, columns>::Multiply(float scalar,
|
||||
Matrix<rows, columns> &result) const {
|
||||
for (uint8_t row_idx{0}; row_idx < rows; row_idx++) {
|
||||
for (uint8_t column_idx{0}; column_idx < columns; column_idx++) {
|
||||
result.Get(row_idx, column_idx) = this->Get(row_idx, column_idx) * scalar;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::Invert(Matrix<rows, columns> & result) const{
|
||||
// since all matrix sizes have to be statically specified at compile time we can do this
|
||||
static_assert(rows == columns, "Your matrix isn't square and can't be inverted");
|
||||
void Matrix<rows, columns>::Invert(Matrix<rows, columns> &result) const {
|
||||
// since all matrix sizes have to be statically specified at compile time we
|
||||
// can do this
|
||||
static_assert(rows == columns,
|
||||
"Your matrix isn't square and can't be inverted");
|
||||
|
||||
// unfortunately we can't calculate this at compile time so we'll just reurn zeros
|
||||
if(this->Det() < 0){
|
||||
// unfortunately we can't calculate this at compile time so we'll just reurn
|
||||
// zeros
|
||||
if (this->Det() < 0) {
|
||||
// you can't invert a matrix with a negative determinant
|
||||
result.zeroMatrix();
|
||||
return;
|
||||
}
|
||||
|
||||
// TODO: This algorithm is really inneficient because of the matrix of minors. We should make a different algorithm
|
||||
// how to calculate the inverse: https://www.mathsisfun.com/algebra/matrix-inverse-minors-cofactors-adjugate.html
|
||||
// TODO: This algorithm is really inneficient because of the matrix of minors.
|
||||
// We should make a different algorithm how to calculate the inverse:
|
||||
// https://www.mathsisfun.com/algebra/matrix-inverse-minors-cofactors-adjugate.html
|
||||
|
||||
// calculate the matrix of minors
|
||||
Matrix<rows, columns> minors{};
|
||||
@@ -249,33 +267,34 @@ void Matrix<rows, columns>::Invert(Matrix<rows, columns> & result) const{
|
||||
float determinant = this->Det();
|
||||
|
||||
// scale the result by 1/determinant and we have our answer
|
||||
result.Multiply(1/determinant);
|
||||
result.Multiply(1 / determinant);
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::Transpose(Matrix<columns, rows> & result) const{
|
||||
for(uint8_t column_idx{0}; column_idx < rows; column_idx++){
|
||||
for(uint8_t row_idx{0}; row_idx < columns; row_idx++){
|
||||
void Matrix<rows, columns>::Transpose(Matrix<columns, rows> &result) const {
|
||||
for (uint8_t column_idx{0}; column_idx < rows; column_idx++) {
|
||||
for (uint8_t row_idx{0}; row_idx < columns; row_idx++) {
|
||||
result.Get(row_idx, column_idx) = this->Get(column_idx, row_idx);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::Square(Matrix<rows, columns> & result) const{
|
||||
void Matrix<rows, columns>::Square(Matrix<rows, columns> &result) const {
|
||||
static_assert(this->isSquare(), "You can't square an non-square matrix.");
|
||||
|
||||
this->Multiply(this, result);
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
float Matrix<rows, columns>::Det() const{
|
||||
static_assert(this->isSquare(), "You can't take the determinant of a non-square matrix.");
|
||||
float Matrix<rows, columns>::Det() const {
|
||||
static_assert(this->isSquare(),
|
||||
"You can't take the determinant of a non-square matrix.");
|
||||
Matrix<1, columns> eigenValues{};
|
||||
this->EigenValues(eigenValues);
|
||||
|
||||
float determinant{1};
|
||||
for(uint8_t i{0}; i < columns; i++){
|
||||
for (uint8_t i{0}; i < columns; i++) {
|
||||
determinant *= eigenValues.Get(0, i);
|
||||
}
|
||||
|
||||
@@ -283,9 +302,11 @@ float Matrix<rows, columns>::Det() const{
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::EigenValues(Matrix<rows, 1> & eigenvalues) const{
|
||||
static_assert(rows == columns, "Eigenvalues can only be computed for square matrices.");
|
||||
// I got this code from: https://www.quora.com/What-is-the-C-code-for-finding-eigenvalues
|
||||
void Matrix<rows, columns>::EigenValues(Matrix<rows, 1> &eigenvalues) const {
|
||||
static_assert(rows == columns,
|
||||
"Eigenvalues can only be computed for square matrices.");
|
||||
// I got this code from:
|
||||
// https://www.quora.com/What-is-the-C-code-for-finding-eigenvalues
|
||||
Matrix<rows, 1> v{};
|
||||
Matrix<rows, 1> Av{};
|
||||
Matrix<rows, 1> z{};
|
||||
@@ -335,45 +356,53 @@ void Matrix<rows, columns>::EigenValues(Matrix<rows, 1> & eigenvalues) const{
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::ElementMultiply(const Matrix<rows, columns> & other, Matrix<rows, columns> & result) const{
|
||||
for(uint8_t row_idx{0}; row_idx < rows; row_idx++){
|
||||
for(uint8_t column_idx{0}; column_idx < columns; column_idx++){
|
||||
result.Get(row_idx, column_idx) = this->Get(row_idx, column_idx) * other.Get(row_idx, column_idx);
|
||||
void Matrix<rows, columns>::ElementMultiply(
|
||||
const Matrix<rows, columns> &other, Matrix<rows, columns> &result) const {
|
||||
for (uint8_t row_idx{0}; row_idx < rows; row_idx++) {
|
||||
for (uint8_t column_idx{0}; column_idx < columns; column_idx++) {
|
||||
result.Get(row_idx, column_idx) =
|
||||
this->Get(row_idx, column_idx) * other.Get(row_idx, column_idx);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::ElementDivide(const Matrix<rows, columns> & other, Matrix<rows, columns> & result) const{
|
||||
for(uint8_t row_idx{0}; row_idx < rows; row_idx++){
|
||||
for(uint8_t column_idx{0}; column_idx < columns; column_idx++){
|
||||
result.Get(row_idx, column_idx) = this->Get(row_idx, column_idx) / other.Get(row_idx, column_idx);
|
||||
void Matrix<rows, columns>::ElementDivide(const Matrix<rows, columns> &other,
|
||||
Matrix<rows, columns> &result) const {
|
||||
for (uint8_t row_idx{0}; row_idx < rows; row_idx++) {
|
||||
for (uint8_t column_idx{0}; column_idx < columns; column_idx++) {
|
||||
result.Get(row_idx, column_idx) =
|
||||
this->Get(row_idx, column_idx) / other.Get(row_idx, column_idx);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
float & Matrix<rows, columns>::Get(uint8_t row_index, uint8_t column_index) const{
|
||||
float &Matrix<rows, columns>::Get(uint8_t row_index,
|
||||
uint8_t column_index) const {
|
||||
return this->matrix[row_index][column_index];
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::GetRow(uint8_t row_index, Matrix<1, columns> & row) const{
|
||||
void Matrix<rows, columns>::GetRow(uint8_t row_index,
|
||||
Matrix<1, columns> &row) const {
|
||||
row = Matrix<1, columns>(this->matrix[row_index]);
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::GetColumn(uint8_t column_index, Matrix<rows, 1> & column) const{
|
||||
for(uint8_t row_idx{0}; row_idx < rows; row_idx++){
|
||||
void Matrix<rows, columns>::GetColumn(uint8_t column_index,
|
||||
Matrix<rows, 1> &column) const {
|
||||
for (uint8_t row_idx{0}; row_idx < rows; row_idx++) {
|
||||
column.Get(0, column_index) = this->Get(row_idx, column_index);
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
template <uint8_t vector_size>
|
||||
float Matrix<rows, columns>::dotProduct(const Matrix<vector_size, 1> & vec1, const Matrix<vector_size, 1> & vec2){
|
||||
float Matrix<rows, columns>::dotProduct(const Matrix<vector_size, 1> &vec1,
|
||||
const Matrix<vector_size, 1> &vec2) {
|
||||
float sum{0};
|
||||
for(uint8_t i{0}; i < vector_size; i++){
|
||||
for (uint8_t i{0}; i < vector_size; i++) {
|
||||
sum += vec1.Get(i, 0) * vec2.Get(i, 0);
|
||||
}
|
||||
|
||||
@@ -381,20 +410,21 @@ float Matrix<rows, columns>::dotProduct(const Matrix<vector_size, 1> & vec1, con
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::zeroMatrix(){
|
||||
for(uint8_t row_idx{0}; row_idx < rows; row_idx++){
|
||||
for(uint8_t column_idx{0}; column_idx < columns; column_idx++){
|
||||
void Matrix<rows, columns>::zeroMatrix() {
|
||||
for (uint8_t row_idx{0}; row_idx < rows; row_idx++) {
|
||||
for (uint8_t column_idx{0}; column_idx < columns; column_idx++) {
|
||||
this->matrix[row_idx][column_idx] = 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::matrixOfMinors(Matrix<rows, columns> & result) const{
|
||||
Matrix<rows-1, columns-1> minorMatrix{};
|
||||
void Matrix<rows, columns>::matrixOfMinors(
|
||||
Matrix<rows, columns> &result) const {
|
||||
Matrix<rows - 1, columns - 1> minorMatrix{};
|
||||
|
||||
for(uint8_t row_idx{0}; row_idx < rows; row_idx++){
|
||||
for(uint8_t column_idx{0}; column_idx < columns; column_idx++){
|
||||
for (uint8_t row_idx{0}; row_idx < rows; row_idx++) {
|
||||
for (uint8_t column_idx{0}; column_idx < columns; column_idx++) {
|
||||
this->minorMatrix(minorMatrix, row_idx, column_idx);
|
||||
result.Get(row_idx, column_idx) = minorMatrix.Det();
|
||||
}
|
||||
@@ -402,50 +432,54 @@ void Matrix<rows, columns>::matrixOfMinors(Matrix<rows, columns> & result) const
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::minorMatrix(Matrix<rows-1, columns-1> & result, uint8_t row_idx, uint8_t column_idx) const{
|
||||
std::array<float, (rows-1)*(columns-1)> subArray{};
|
||||
void Matrix<rows, columns>::minorMatrix(Matrix<rows - 1, columns - 1> &result,
|
||||
uint8_t row_idx,
|
||||
uint8_t column_idx) const {
|
||||
std::array<float, (rows - 1) * (columns - 1)> subArray{};
|
||||
|
||||
for(uint8_t row_iter{0}; row_iter < rows; row_iter++){
|
||||
for(uint8_t column_iter{0}; column_iter < columns; column_iter++){
|
||||
uint16_t i = static_cast<uint16_t>(row_iter) + static_cast<uint16_t>(column_iter);
|
||||
if(row_iter == row_idx || column_iter == column_idx){
|
||||
for (uint8_t row_iter{0}; row_iter < rows; row_iter++) {
|
||||
for (uint8_t column_iter{0}; column_iter < columns; column_iter++) {
|
||||
uint16_t i =
|
||||
static_cast<uint16_t>(row_iter) + static_cast<uint16_t>(column_iter);
|
||||
if (row_iter == row_idx || column_iter == column_idx) {
|
||||
continue;
|
||||
}
|
||||
subArray[i] = this->Get(row_iter, column_iter);
|
||||
}
|
||||
}
|
||||
|
||||
result = Matrix<rows-1, columns-1>{subArray};
|
||||
result = Matrix<rows - 1, columns - 1>{subArray};
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::adjugate(Matrix<rows, columns> & result) const{
|
||||
for(uint8_t row_iter{0}; row_iter < rows; row_iter++){
|
||||
for(uint8_t column_iter{0}; column_iter < columns; column_iter++){
|
||||
void Matrix<rows, columns>::adjugate(Matrix<rows, columns> &result) const {
|
||||
for (uint8_t row_iter{0}; row_iter < rows; row_iter++) {
|
||||
for (uint8_t column_iter{0}; column_iter < columns; column_iter++) {
|
||||
float sign = ((row_iter + 1) % 2) ? -1 : 1;
|
||||
sign *= ((column_iter + 1) % 2) ? -1 : 1;
|
||||
result.Get(row_iter, column_iter) = this->Get(row_iter, column_iter) * sign;
|
||||
result.Get(row_iter, column_iter) =
|
||||
this->Get(row_iter, column_iter) * sign;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
template <uint8_t rows, uint8_t columns>
|
||||
void Matrix<rows, columns>::normalize(Matrix<rows, columns> & result) const{
|
||||
void Matrix<rows, columns>::normalize(Matrix<rows, columns> &result) const {
|
||||
float sum{0};
|
||||
for(uint8_t column_idx{0}; column_idx < rows; column_idx++){
|
||||
for(uint8_t row_idx{0}; row_idx < columns; row_idx++){
|
||||
for (uint8_t column_idx{0}; column_idx < rows; column_idx++) {
|
||||
for (uint8_t row_idx{0}; row_idx < columns; row_idx++) {
|
||||
sum += this->Get(row_idx, column_idx);
|
||||
}
|
||||
}
|
||||
|
||||
if(sum == 0){
|
||||
if (sum == 0) {
|
||||
// this wouldn't do anything anyways
|
||||
result.zeroMatrix();
|
||||
return;
|
||||
}
|
||||
|
||||
for(uint8_t column_idx{0}; column_idx < rows; column_idx++){
|
||||
for(uint8_t row_idx{0}; row_idx < columns; row_idx++){
|
||||
for (uint8_t column_idx{0}; column_idx < rows; column_idx++) {
|
||||
for (uint8_t row_idx{0}; row_idx < columns; row_idx++) {
|
||||
result.Get(row_idx, column_idx) = this->Get(row_idx, column_idx) / sum;
|
||||
}
|
||||
}
|
||||
|
||||
@@ -12,6 +12,10 @@ FetchContent_Declare(
|
||||
|
||||
FetchContent_MakeAvailable(Catch2)
|
||||
|
||||
add_executable(tests matrix-tests.cpp)
|
||||
add_executable(matrix-tests matrix-tests.cpp)
|
||||
|
||||
target_link_libraries(tests PRIVATE Catch2::Catch2WithMain)
|
||||
target_link_libraries(matrix-tests
|
||||
PRIVATE
|
||||
Matrix
|
||||
Catch2::Catch2WithMain
|
||||
)
|
||||
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
@@ -1,5 +1,9 @@
|
||||
// include the unit test framework first
|
||||
#include <catch2/catch_test_macros.hpp>
|
||||
|
||||
// include the module you're going to test next
|
||||
#include "Matrix.hpp"
|
||||
|
||||
unsigned int Factorial(unsigned int number) {
|
||||
return number <= 1 ? number : Factorial(number - 1) * number;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user