OLD | NEW |
(Empty) | |
| 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 Softwar
e |
| 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 |
OLD | NEW |