/src/ghostpdl/lcms2mt/src/cmsmtrx.c

Source
//---------------------------------------------------------------------------------
//
//  Little Color Management System
//  Copyright (c) 1998-2020 Marti Maria Saguer
//
// Permission is hereby granted, free of charge, to any person obtaining
// a copy of this software and associated documentation files (the "Software"),
// to deal in the Software without restriction, including without limitation
// the rights to use, copy, modify, merge, publish, distribute, sublicense,
// and/or sell copies of the Software, and to permit persons to whom the Software
// is furnished to do so, subject to the following conditions:
//
// The above copyright notice and this permission notice shall be included in
// all copies or substantial portions of the Software.
//
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
// EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO
// THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
// NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
// LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
// OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
// WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
//
//---------------------------------------------------------------------------------
//

#include "lcms2_internal.h"


#define DSWAP(x, y)     {cmsFloat64Number tmp = (x); (x)=(y); (y)=tmp;}


// Initiate a vector
void CMSEXPORT _cmsVEC3init(cmsContext ContextID, cmsVEC3* r, cmsFloat64Number x, cmsFloat64Number y, cmsFloat64Number z)
{
    cmsUNUSED_PARAMETER(ContextID);
    r -> n[VX] = x;
    r -> n[VY] = y;
    r -> n[VZ] = z;
}

// Vector subtraction
void CMSEXPORT _cmsVEC3minus(cmsContext ContextID, cmsVEC3* r, const cmsVEC3* a, const cmsVEC3* b)
{
    cmsUNUSED_PARAMETER(ContextID);
    r -> n[VX] = a -> n[VX] - b -> n[VX];
    r -> n[VY] = a -> n[VY] - b -> n[VY];
    r -> n[VZ] = a -> n[VZ] - b -> n[VZ];
}

// Vector cross product
void CMSEXPORT _cmsVEC3cross(cmsContext ContextID, cmsVEC3* r, const cmsVEC3* u, const cmsVEC3* v)
{
    cmsUNUSED_PARAMETER(ContextID);
    r ->n[VX] = u->n[VY] * v->n[VZ] - v->n[VY] * u->n[VZ];
    r ->n[VY] = u->n[VZ] * v->n[VX] - v->n[VZ] * u->n[VX];
    r ->n[VZ] = u->n[VX] * v->n[VY] - v->n[VX] * u->n[VY];
}

// Vector dot product
cmsFloat64Number CMSEXPORT _cmsVEC3dot(cmsContext ContextID, const cmsVEC3* u, const cmsVEC3* v)
{
    cmsUNUSED_PARAMETER(ContextID);
    return u->n[VX] * v->n[VX] + u->n[VY] * v->n[VY] + u->n[VZ] * v->n[VZ];
}

// Euclidean length
cmsFloat64Number CMSEXPORT _cmsVEC3length(cmsContext ContextID, const cmsVEC3* a)
{
    cmsUNUSED_PARAMETER(ContextID);
    return sqrt(a ->n[VX] * a ->n[VX] +
                a ->n[VY] * a ->n[VY] +
                a ->n[VZ] * a ->n[VZ]);
}

// Euclidean distance
cmsFloat64Number CMSEXPORT _cmsVEC3distance(cmsContext ContextID, const cmsVEC3* a, const cmsVEC3* b)
{
    cmsFloat64Number d1 = a ->n[VX] - b ->n[VX];
    cmsFloat64Number d2 = a ->n[VY] - b ->n[VY];
    cmsFloat64Number d3 = a ->n[VZ] - b ->n[VZ];

    cmsUNUSED_PARAMETER(ContextID);

    return sqrt(d1*d1 + d2*d2 + d3*d3);
}



// 3x3 Identity
void CMSEXPORT _cmsMAT3identity(cmsContext ContextID, cmsMAT3* a)
{
    _cmsVEC3init(ContextID, &a-> v[0], 1.0, 0.0, 0.0);
    _cmsVEC3init(ContextID, &a-> v[1], 0.0, 1.0, 0.0);
    _cmsVEC3init(ContextID, &a-> v[2], 0.0, 0.0, 1.0);
}

static
cmsBool CloseEnough(cmsFloat64Number a, cmsFloat64Number b)
{
    return fabs(b - a) < (1.0 / 65535.0);
}


cmsBool CMSEXPORT _cmsMAT3isIdentity(cmsContext ContextID, const cmsMAT3* a)
{
    cmsMAT3 Identity;
    int i, j;

    _cmsMAT3identity(ContextID, &Identity);

    for (i=0; i < 3; i++)
        for (j=0; j < 3; j++)
            if (!CloseEnough(a ->v[i].n[j], Identity.v[i].n[j])) return FALSE;

    return TRUE;
}


// Multiply two matrices
void CMSEXPORT _cmsMAT3per(cmsContext ContextID, cmsMAT3* r, const cmsMAT3* a, const cmsMAT3* b)
{
#define ROWCOL(i, j) \
    a->v[i].n[0]*b->v[0].n[j] + a->v[i].n[1]*b->v[1].n[j] + a->v[i].n[2]*b->v[2].n[j]

    _cmsVEC3init(ContextID, &r-> v[0], ROWCOL(0,0), ROWCOL(0,1), ROWCOL(0,2));
    _cmsVEC3init(ContextID, &r-> v[1], ROWCOL(1,0), ROWCOL(1,1), ROWCOL(1,2));
    _cmsVEC3init(ContextID, &r-> v[2], ROWCOL(2,0), ROWCOL(2,1), ROWCOL(2,2));

#undef ROWCOL //(i, j)
}



// Inverse of a matrix b = a^(-1)
cmsBool  CMSEXPORT _cmsMAT3inverse(cmsContext ContextID, const cmsMAT3* a, cmsMAT3* b)
{
   cmsFloat64Number det, c0, c1, c2;
   cmsUNUSED_PARAMETER(ContextID);

   c0 =  a -> v[1].n[1]*a -> v[2].n[2] - a -> v[1].n[2]*a -> v[2].n[1];
   c1 = -a -> v[1].n[0]*a -> v[2].n[2] + a -> v[1].n[2]*a -> v[2].n[0];
   c2 =  a -> v[1].n[0]*a -> v[2].n[1] - a -> v[1].n[1]*a -> v[2].n[0];

   det = a -> v[0].n[0]*c0 + a -> v[0].n[1]*c1 + a -> v[0].n[2]*c2;

   if (fabs(det) < MATRIX_DET_TOLERANCE) return FALSE;  // singular matrix; can't invert

   b -> v[0].n[0] = c0/det;
   b -> v[0].n[1] = (a -> v[0].n[2]*a -> v[2].n[1] - a -> v[0].n[1]*a -> v[2].n[2])/det;
   b -> v[0].n[2] = (a -> v[0].n[1]*a -> v[1].n[2] - a -> v[0].n[2]*a -> v[1].n[1])/det;
   b -> v[1].n[0] = c1/det;
   b -> v[1].n[1] = (a -> v[0].n[0]*a -> v[2].n[2] - a -> v[0].n[2]*a -> v[2].n[0])/det;
   b -> v[1].n[2] = (a -> v[0].n[2]*a -> v[1].n[0] - a -> v[0].n[0]*a -> v[1].n[2])/det;
   b -> v[2].n[0] = c2/det;
   b -> v[2].n[1] = (a -> v[0].n[1]*a -> v[2].n[0] - a -> v[0].n[0]*a -> v[2].n[1])/det;
   b -> v[2].n[2] = (a -> v[0].n[0]*a -> v[1].n[1] - a -> v[0].n[1]*a -> v[1].n[0])/det;

   return TRUE;
}


// Solve a system in the form Ax = b
cmsBool  CMSEXPORT _cmsMAT3solve(cmsContext ContextID, cmsVEC3* x, cmsMAT3* a, cmsVEC3* b)
{
    cmsMAT3 m, a_1;

    memmove(&m, a, sizeof(cmsMAT3));

    if (!_cmsMAT3inverse(ContextID, &m, &a_1)) return FALSE;  // Singular matrix

    _cmsMAT3eval(ContextID, x, &a_1, b);
    return TRUE;
}

// Evaluate a vector across a matrix
void CMSEXPORT _cmsMAT3eval(cmsContext ContextID, cmsVEC3* r, const cmsMAT3* a, const cmsVEC3* v)
{
    cmsUNUSED_PARAMETER(ContextID);

    r->n[VX] = a->v[0].n[VX]*v->n[VX] + a->v[0].n[VY]*v->n[VY] + a->v[0].n[VZ]*v->n[VZ];
    r->n[VY] = a->v[1].n[VX]*v->n[VX] + a->v[1].n[VY]*v->n[VY] + a->v[1].n[VZ]*v->n[VZ];
    r->n[VZ] = a->v[2].n[VX]*v->n[VX] + a->v[2].n[VY]*v->n[VY] + a->v[2].n[VZ]*v->n[VZ];
}



Line	Count	Source
1		//---------------------------------------------------------------------------------
2		//
3		// Little Color Management System
4		// Copyright (c) 1998-2020 Marti Maria Saguer
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		//---------------------------------------------------------------------------------
25		//
26
27		#include "lcms2_internal.h"
28
29
30		#define DSWAP(x, y) {cmsFloat64Number tmp = (x); (x)=(y); (y)=tmp;}
31
32
33		// Initiate a vector
34		void CMSEXPORT _cmsVEC3init(cmsContext ContextID, cmsVEC3* r, cmsFloat64Number x, cmsFloat64Number y, cmsFloat64Number z)
35	30.2M	{
36	30.2M	cmsUNUSED_PARAMETER(ContextID);
37	30.2M	r -> n[VX] = x;
38	30.2M	r -> n[VY] = y;
39	30.2M	r -> n[VZ] = z;
40	30.2M	}
41
42		// Vector subtraction
43		void CMSEXPORT _cmsVEC3minus(cmsContext ContextID, cmsVEC3* r, const cmsVEC3* a, const cmsVEC3* b)
44	0	{
45	0	cmsUNUSED_PARAMETER(ContextID);
46	0	r -> n[VX] = a -> n[VX] - b -> n[VX];
47	0	r -> n[VY] = a -> n[VY] - b -> n[VY];
48	0	r -> n[VZ] = a -> n[VZ] - b -> n[VZ];
49	0	}
50
51		// Vector cross product
52		void CMSEXPORT _cmsVEC3cross(cmsContext ContextID, cmsVEC3* r, const cmsVEC3* u, const cmsVEC3* v)
53	0	{
54	0	cmsUNUSED_PARAMETER(ContextID);
55	0	r ->n[VX] = u->n[VY] * v->n[VZ] - v->n[VY] * u->n[VZ];
56	0	r ->n[VY] = u->n[VZ] * v->n[VX] - v->n[VZ] * u->n[VX];
57	0	r ->n[VZ] = u->n[VX] * v->n[VY] - v->n[VX] * u->n[VY];
58	0	}
59
60		// Vector dot product
61		cmsFloat64Number CMSEXPORT _cmsVEC3dot(cmsContext ContextID, const cmsVEC3* u, const cmsVEC3* v)
62	0	{
63	0	cmsUNUSED_PARAMETER(ContextID);
64	0	return u->n[VX] * v->n[VX] + u->n[VY] * v->n[VY] + u->n[VZ] * v->n[VZ];
65	0	}
66
67		// Euclidean length
68		cmsFloat64Number CMSEXPORT _cmsVEC3length(cmsContext ContextID, const cmsVEC3* a)
69	0	{
70	0	cmsUNUSED_PARAMETER(ContextID);
71	0	return sqrt(a ->n[VX] * a ->n[VX] +
72	0	a ->n[VY] * a ->n[VY] +
73	0	a ->n[VZ] * a ->n[VZ]);
74	0	}
75
76		// Euclidean distance
77		cmsFloat64Number CMSEXPORT _cmsVEC3distance(cmsContext ContextID, const cmsVEC3* a, const cmsVEC3* b)
78	0	{
79	0	cmsFloat64Number d1 = a ->n[VX] - b ->n[VX];
80	0	cmsFloat64Number d2 = a ->n[VY] - b ->n[VY];
81	0	cmsFloat64Number d3 = a ->n[VZ] - b ->n[VZ];
82
83	0	cmsUNUSED_PARAMETER(ContextID);
84
85	0	return sqrt(d1d1 + d2d2 + d3*d3);
86	0	}
87
88
89
90		// 3x3 Identity
91		void CMSEXPORT _cmsMAT3identity(cmsContext ContextID, cmsMAT3* a)
92	2.76M	{
93	2.76M	_cmsVEC3init(ContextID, &a-> v[0], 1.0, 0.0, 0.0);
94	2.76M	_cmsVEC3init(ContextID, &a-> v[1], 0.0, 1.0, 0.0);
95	2.76M	_cmsVEC3init(ContextID, &a-> v[2], 0.0, 0.0, 1.0);
96	2.76M	}
97
98		static
99		cmsBool CloseEnough(cmsFloat64Number a, cmsFloat64Number b)
100	188k	{
101	188k	return fabs(b - a) < (1.0 / 65535.0);
102	188k	}
103
104
105		cmsBool CMSEXPORT _cmsMAT3isIdentity(cmsContext ContextID, const cmsMAT3* a)
106	35.8k	{
107	35.8k	cmsMAT3 Identity;
108	35.8k	int i, j;
109
110	35.8k	_cmsMAT3identity(ContextID, &Identity);
111
112	93.0k	for (i=0; i < 3; i++)
113	245k	for (j=0; j < 3; j++)
114	188k	if (!CloseEnough(a ->v[i].n[j], Identity.v[i].n[j])) return FALSE;
115
116	19.0k	return TRUE;
117	35.8k	}
118
119
120		// Multiply two matrices
121		void CMSEXPORT _cmsMAT3per(cmsContext ContextID, cmsMAT3* r, const cmsMAT3* a, const cmsMAT3* b)
122	3.24M	{
123	3.24M	#define ROWCOL(i, j) \
124	29.2M	a->v[i].n[0]b->v[0].n[j] + a->v[i].n[1]b->v[1].n[j] + a->v[i].n[2]*b->v[2].n[j]
125
126	3.24M	_cmsVEC3init(ContextID, &r-> v[0], ROWCOL(0,0), ROWCOL(0,1), ROWCOL(0,2));
127	3.24M	_cmsVEC3init(ContextID, &r-> v[1], ROWCOL(1,0), ROWCOL(1,1), ROWCOL(1,2));
128	3.24M	_cmsVEC3init(ContextID, &r-> v[2], ROWCOL(2,0), ROWCOL(2,1), ROWCOL(2,2));
129
130	3.24M	#undef ROWCOL //(i, j)
131	3.24M	}
132
133
134
135		// Inverse of a matrix b = a^(-1)
136		cmsBool CMSEXPORT _cmsMAT3inverse(cmsContext ContextID, const cmsMAT3* a, cmsMAT3* b)
137	1.78M	{
138	1.78M	cmsFloat64Number det, c0, c1, c2;
139	1.78M	cmsUNUSED_PARAMETER(ContextID);
140
141	1.78M	c0 = a -> v[1].n[1]a -> v[2].n[2] - a -> v[1].n[2]a -> v[2].n[1];
142	1.78M	c1 = -a -> v[1].n[0]a -> v[2].n[2] + a -> v[1].n[2]a -> v[2].n[0];
143	1.78M	c2 = a -> v[1].n[0]a -> v[2].n[1] - a -> v[1].n[1]a -> v[2].n[0];
144
145	1.78M	det = a -> v[0].n[0]c0 + a -> v[0].n[1]c1 + a -> v[0].n[2]*c2;
146
147	1.78M	if (fabs(det) < MATRIX_DET_TOLERANCE) return FALSE; // singular matrix; can't invert
148
149	1.78M	b -> v[0].n[0] = c0/det;
150	1.78M	b -> v[0].n[1] = (a -> v[0].n[2]a -> v[2].n[1] - a -> v[0].n[1]a -> v[2].n[2])/det;
151	1.78M	b -> v[0].n[2] = (a -> v[0].n[1]a -> v[1].n[2] - a -> v[0].n[2]a -> v[1].n[1])/det;
152	1.78M	b -> v[1].n[0] = c1/det;
153	1.78M	b -> v[1].n[1] = (a -> v[0].n[0]a -> v[2].n[2] - a -> v[0].n[2]a -> v[2].n[0])/det;
154	1.78M	b -> v[1].n[2] = (a -> v[0].n[2]a -> v[1].n[0] - a -> v[0].n[0]a -> v[1].n[2])/det;
155	1.78M	b -> v[2].n[0] = c2/det;
156	1.78M	b -> v[2].n[1] = (a -> v[0].n[1]a -> v[2].n[0] - a -> v[0].n[0]a -> v[2].n[1])/det;
157	1.78M	b -> v[2].n[2] = (a -> v[0].n[0]a -> v[1].n[1] - a -> v[0].n[1]a -> v[1].n[0])/det;
158
159	1.78M	return TRUE;
160	1.78M	}
161
162
163		// Solve a system in the form Ax = b
164		cmsBool CMSEXPORT _cmsMAT3solve(cmsContext ContextID, cmsVEC3* x, cmsMAT3* a, cmsVEC3* b)
165	624	{
166	624	cmsMAT3 m, a_1;
167
168	624	memmove(&m, a, sizeof(cmsMAT3));
169
170	624	if (!_cmsMAT3inverse(ContextID, &m, &a_1)) return FALSE; // Singular matrix
171
172	624	_cmsMAT3eval(ContextID, x, &a_1, b);
173	624	return TRUE;
174	624	}
175
176		// Evaluate a vector across a matrix
177		void CMSEXPORT _cmsMAT3eval(cmsContext ContextID, cmsVEC3* r, const cmsMAT3* a, const cmsVEC3* v)
178	3.19M	{
179	3.19M	cmsUNUSED_PARAMETER(ContextID);
180
181	3.19M	r->n[VX] = a->v[0].n[VX]v->n[VX] + a->v[0].n[VY]v->n[VY] + a->v[0].n[VZ]*v->n[VZ];
182	3.19M	r->n[VY] = a->v[1].n[VX]v->n[VX] + a->v[1].n[VY]v->n[VY] + a->v[1].n[VZ]*v->n[VZ];
183	3.19M	r->n[VZ] = a->v[2].n[VX]v->n[VX] + a->v[2].n[VY]v->n[VY] + a->v[2].n[VZ]*v->n[VZ];
184	3.19M	}
185
186

Coverage Report

Created: 2025-12-31 07:31