summary refs log tree commit diff
path: root/src/Math/Matrix.hpp
blob: 9a6b7e68c10d07cbc17b50f909cdadd21e779a03 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
#pragma once

#include <sstream>
#include <cstddef>
#include <iostream>

template <size_t R, size_t C, typename T = float>
struct Matrix {
public:
    Matrix<R, C, T>() : elements{} {};

    Matrix<R, C, T>(T scalar) {
        std::fill(elements, elements + R * C, scalar);
    };

    template<typename ...Args>
    Matrix<R, C, T>(Args... args): elements{ args... } {};

    Matrix<R, C, T>(T values[R * C]) {
        std::copy(values, values + R * C, elements);
    };

    static Matrix<R, R, T> identity() {
        Matrix<R, R, T> result{};
        for (int i = 0; i < R; i++) {
            result(i, i) = 1;
        }
        return result;
    }

    Vector<C, T> row(size_t index) {
        return { &elements[index * C] };
    }

    Vector<R, T> col(size_t index) {
        Vector<R, T> result{};
        for (int i = 0; i < R; i++) {
            result[i] = this->operator()(index, i);
        }
        return result;
    }

    Matrix<R, C, T> operator+(Matrix<R, C, T> other) {
        Matrix<R, C, T> result{};
        for (int i = 0; i < R * C; i++) {
            result.elements[i] = elements[i] + other.elements[i];
        }
        return result;
    }

    Matrix<R, C, T> operator*(float scalar) {
        Matrix<R, C, T> result{};
        for (int i = 0; i < R * C; i++) {
            result.elements[i] = elements[i] * scalar;
        }
        return result;
    }

    template<size_t N>
    Matrix<R, N, T> operator*(Matrix<C, N, T> other) {
        Matrix<R, N, T> result{};
        for (int y = 0; y < R; y++) {
            for (int x = 0; x < N; x++) {
                auto r = row(y);
                auto c = other.col(x);

                auto dot = r * c;

                result(x, y) = dot;
            }
        }
        return result;
    }

    Vector<R, T> operator*(Vector<R, T> vector) {
        Matrix<R, 1, T> matrix(vector.elements);
        matrix = this->operator*(matrix);
        return { matrix.elements };
    }

    auto& operator()(size_t x, size_t y) {
        return elements[y * C + x];
    }

    std::string string() {
        std::stringstream str{};
        for (int x = 0; x < R; x++) {
            for (int y = 0; y < C; y++) {
                str << this->operator()(x, y) << " ";
            }

            str << "\n";
        }

        return str.str();
    }

    T elements[R * C];
};