|
1 /* vim: set ts=8 sw=8 noexpandtab: */ |
|
2 // qcms |
|
3 // Copyright (C) 2009 Mozilla Foundation |
|
4 // Copyright (C) 1998-2007 Marti Maria |
|
5 // |
|
6 // Permission is hereby granted, free of charge, to any person obtaining |
|
7 // a copy of this software and associated documentation files (the "Software"), |
|
8 // to deal in the Software without restriction, including without limitation |
|
9 // the rights to use, copy, modify, merge, publish, distribute, sublicense, |
|
10 // and/or sell copies of the Software, and to permit persons to whom the Software |
|
11 // is furnished to do so, subject to the following conditions: |
|
12 // |
|
13 // The above copyright notice and this permission notice shall be included in |
|
14 // all copies or substantial portions of the Software. |
|
15 // |
|
16 // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
|
17 // EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO |
|
18 // THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
|
19 // NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE |
|
20 // LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION |
|
21 // OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION |
|
22 // WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
|
23 |
|
24 #include <stdlib.h> |
|
25 #include "qcmsint.h" |
|
26 #include "matrix.h" |
|
27 |
|
28 struct vector matrix_eval(struct matrix mat, struct vector v) |
|
29 { |
|
30 struct vector result; |
|
31 result.v[0] = mat.m[0][0]*v.v[0] + mat.m[0][1]*v.v[1] + mat.m[0][2]*v.v[2]; |
|
32 result.v[1] = mat.m[1][0]*v.v[0] + mat.m[1][1]*v.v[1] + mat.m[1][2]*v.v[2]; |
|
33 result.v[2] = mat.m[2][0]*v.v[0] + mat.m[2][1]*v.v[1] + mat.m[2][2]*v.v[2]; |
|
34 return result; |
|
35 } |
|
36 |
|
37 //XXX: should probably pass by reference and we could |
|
38 //probably reuse this computation in matrix_invert |
|
39 float matrix_det(struct matrix mat) |
|
40 { |
|
41 float det; |
|
42 det = mat.m[0][0]*mat.m[1][1]*mat.m[2][2] + |
|
43 mat.m[0][1]*mat.m[1][2]*mat.m[2][0] + |
|
44 mat.m[0][2]*mat.m[1][0]*mat.m[2][1] - |
|
45 mat.m[0][0]*mat.m[1][2]*mat.m[2][1] - |
|
46 mat.m[0][1]*mat.m[1][0]*mat.m[2][2] - |
|
47 mat.m[0][2]*mat.m[1][1]*mat.m[2][0]; |
|
48 return det; |
|
49 } |
|
50 |
|
51 /* from pixman and cairo and Mathematics for Game Programmers */ |
|
52 /* lcms uses gauss-jordan elimination with partial pivoting which is |
|
53 * less efficient and not as numerically stable. See Mathematics for |
|
54 * Game Programmers. */ |
|
55 struct matrix matrix_invert(struct matrix mat) |
|
56 { |
|
57 struct matrix dest_mat; |
|
58 int i,j; |
|
59 static int a[3] = { 2, 2, 1 }; |
|
60 static int b[3] = { 1, 0, 0 }; |
|
61 |
|
62 /* inv (A) = 1/det (A) * adj (A) */ |
|
63 float det = matrix_det(mat); |
|
64 |
|
65 if (det == 0) { |
|
66 dest_mat.invalid = true; |
|
67 } else { |
|
68 dest_mat.invalid = false; |
|
69 } |
|
70 |
|
71 det = 1/det; |
|
72 |
|
73 for (j = 0; j < 3; j++) { |
|
74 for (i = 0; i < 3; i++) { |
|
75 double p; |
|
76 int ai = a[i]; |
|
77 int aj = a[j]; |
|
78 int bi = b[i]; |
|
79 int bj = b[j]; |
|
80 |
|
81 p = mat.m[ai][aj] * mat.m[bi][bj] - |
|
82 mat.m[ai][bj] * mat.m[bi][aj]; |
|
83 if (((i + j) & 1) != 0) |
|
84 p = -p; |
|
85 |
|
86 dest_mat.m[j][i] = det * p; |
|
87 } |
|
88 } |
|
89 return dest_mat; |
|
90 } |
|
91 |
|
92 struct matrix matrix_identity(void) |
|
93 { |
|
94 struct matrix i; |
|
95 i.m[0][0] = 1; |
|
96 i.m[0][1] = 0; |
|
97 i.m[0][2] = 0; |
|
98 i.m[1][0] = 0; |
|
99 i.m[1][1] = 1; |
|
100 i.m[1][2] = 0; |
|
101 i.m[2][0] = 0; |
|
102 i.m[2][1] = 0; |
|
103 i.m[2][2] = 1; |
|
104 i.invalid = false; |
|
105 return i; |
|
106 } |
|
107 |
|
108 struct matrix matrix_invalid(void) |
|
109 { |
|
110 struct matrix inv = matrix_identity(); |
|
111 inv.invalid = true; |
|
112 return inv; |
|
113 } |
|
114 |
|
115 |
|
116 /* from pixman */ |
|
117 /* MAT3per... */ |
|
118 struct matrix matrix_multiply(struct matrix a, struct matrix b) |
|
119 { |
|
120 struct matrix result; |
|
121 int dx, dy; |
|
122 int o; |
|
123 for (dy = 0; dy < 3; dy++) { |
|
124 for (dx = 0; dx < 3; dx++) { |
|
125 double v = 0; |
|
126 for (o = 0; o < 3; o++) { |
|
127 v += a.m[dy][o] * b.m[o][dx]; |
|
128 } |
|
129 result.m[dy][dx] = v; |
|
130 } |
|
131 } |
|
132 result.invalid = a.invalid || b.invalid; |
|
133 return result; |
|
134 } |
|
135 |
|
136 |