summaryrefslogtreecommitdiffstats
path: root/test_polymatrix/test_polymatrix.py
blob: 1f0bb73be01f14033fe4c734d313eabab625dee4 (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
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
import unittest

from polymatrix.polystruct import init_equation, init_poly_matrix, init_poly_vector
from polymatrix.utils import variable_to_index

class TestPolyMatrix(unittest.TestCase):
    @staticmethod
    def assert_term_in_eq(terms, degree, eq_idx, row_idx, value, monoms=None):
        if monoms is None:
            monoms = tuple()

        assert degree in terms, f'could not find {degree} in {terms}'
        degree_terms = terms[degree]

        key = eq_idx, monoms
        assert key in degree_terms, f'could not find {key} in {degree_terms}'
        eq_terms = degree_terms[key]

        assert row_idx in eq_terms, f'could not find {row_idx} in {eq_terms}'
        assert eq_terms[row_idx] == value, f'value {eq_terms[row_idx]} and {value} do not match'

    def test_param_matrix_param_vector_degree_0(self):
        """
        param = [a11 a21 a31 a41 v11 v21]
        """

        mat = init_poly_matrix(degrees=(0,))
        vec = init_poly_vector(degrees=(0,))
        n_param = 6

        eq = init_equation(
            terms = [(mat, vec)],
            n_var = 2,
        )

        terms, offset_dict = list(eq.create())

        # a11 v11
        self.assert_term_in_eq(
            terms = terms,
            degree = 2,
            eq_idx = 0,
            row_idx = variable_to_index(n_param, (offset_dict[(mat, 0)], offset_dict[(vec, 0)])),
            value = 1,
        )

        # a21 v11
        self.assert_term_in_eq(
            terms = terms,
            degree = 2,
            eq_idx = 1,
            row_idx = variable_to_index(n_param, (offset_dict[(mat, 0)]+2, offset_dict[(vec, 0)])),
            value = 1,
        )

    def test_param_matrix_param_vector_degree_01(self):
        """
        param = [a11 a21 a31 a41 v011 v021 v111 v112 v121 v122]
        """

        mat = init_poly_matrix(degrees=(0,))
        vec = init_poly_vector(degrees=(0,1))
        n_param = 10

        eq = init_equation(
            terms = [(mat, vec)],
            n_var = 2,
        )

        terms, offset_dict = list(eq.create())

        # a11 v011
        self.assert_term_in_eq(
            terms = terms,
            degree = 2,
            eq_idx = 0,
            row_idx = variable_to_index(n_param, (offset_dict[(mat, 0)], offset_dict[(vec, 0)])),
            value = 1,
        )

        # a11 v011
        self.assert_term_in_eq(
            terms = terms,
            degree = 2,
            eq_idx = 0,
            monoms=(0,),
            row_idx = variable_to_index(n_param, (offset_dict[(mat, 0)], offset_dict[(vec, 1)])),
            value = 1,
        )

    def test_param_matrix_const_vector_degree_0(self):
        """
        param = [a11 a21 a31 a41]
        """

        mat = init_poly_matrix(degrees=(0,))
        vec = init_poly_vector(subs={0: {(0, 0): 1, (1, 0): 1}})

        eq = init_equation(
            terms = [(mat, vec)],
            n_var = 2,
        )

        terms, offset_dict = list(eq.create())

        # a11
        self.assert_term_in_eq(
            terms = terms,
            degree = 1,
            eq_idx = 0,
            row_idx = offset_dict[(mat, 0)],
            value = 1,
        )

    def test_const_matrix_const_vector_degree_0(self):
        """
        param = [a11 a21 a31 a41]
        """

        mat = init_poly_matrix(subs={0: {(0, 0): 1, (1, 0): 1, (0, 1): 1, (1, 1): 1}})
        vec = init_poly_vector(subs={0: {(0, 0): 1, (1, 0): 1}})

        eq = init_equation(
            terms = [(mat, vec)],
            n_var = 2,
        )

        terms, offset_dict = list(eq.create())

        self.assert_term_in_eq(
            terms = terms,
            degree = 0,
            eq_idx = 0,
            row_idx = 0,
            value = 2,
        )
    
    def test_param_matrix_const_vector_skew_symmetric(self):
        """
        param = [a11 a21 a31 a41]
        """

        def skew_symmetric(idx1, idx2):
            if idx1 == idx2:
                return idx1, idx2, 0
            elif idx2 < idx1:
                return idx2, idx1, -1

        mat = init_poly_matrix(
            degrees=(0,), 
            re_index_func=skew_symmetric,
        )
        vec = init_poly_vector(subs={0: {(0, 0): 1, (1, 0): 1}})

        eq = init_equation(
            terms = [(mat, vec)],
            n_var = 2,
        )

        terms, offset_dict = list(eq.create())

        self.assert_term_in_eq(
            terms = terms,
            degree = 1,
            eq_idx = 0,
            row_idx = offset_dict[(mat, 0)] + 1,
            value = 1,
        )

        self.assert_term_in_eq(
            terms = terms,
            degree = 1,
            eq_idx = 1,
            row_idx = offset_dict[(mat, 0)] + 1,
            value = -1,
        )