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
//! 2次元Affine変換
//!
//! 2次元平面上の点の回転

#![allow(clippy::needless_range_loop)]

/// # AffineMatrix
/// アフィン変換(3x3行列)
#[derive(Debug, Clone, Copy)]
pub struct AffineMatrix {
    pub arr: [[isize; 3]; 3],
}

impl AffineMatrix {
    pub fn e() -> Self {
        Self {
            arr: [[1, 0, 0], [0, 1, 0], [0, 0, 1]],
        }
    }

    pub fn rotate90() -> Self {
        Self {
            arr: [[0, -1, 0], [1, 0, 0], [0, 0, 1]],
        }
    }

    pub fn rotate270() -> Self {
        Self {
            arr: [[0, 1, 0], [-1, 0, 0], [0, 0, 1]],
        }
    }

    pub fn mirror_x(p: isize) -> Self {
        Self {
            arr: [[-1, 0, 2 * p], [0, 1, 0], [0, 0, 1]],
        }
    }

    pub fn mirror_y(p: isize) -> Self {
        Self {
            arr: [[1, 0, 0], [0, -1, 2 * p], [0, 0, 1]],
        }
    }

    pub fn dot(&self, other: &Self) -> Self {
        let mut arr = [[0, 0, 0], [0, 0, 0], [0, 0, 0]];
        for i in 0..3 {
            for j in 0..3 {
                for k in 0..3 {
                    arr[i][j] += self.arr[i][k] * other.arr[k][j];
                }
            }
        }
        Self { arr }
    }

    pub fn apply(&self, vec: (isize, isize)) -> (isize, isize) {
        (
            self.arr[0][0] * vec.0 + self.arr[0][1] * vec.1 + self.arr[0][2],
            self.arr[1][0] * vec.0 + self.arr[1][1] * vec.1 + self.arr[1][2],
        )
    }
}