42#include "MagickCore/studio.h"
43#include "MagickCore/blob.h"
44#include "MagickCore/blob-private.h"
45#include "MagickCore/cache.h"
46#include "MagickCore/exception.h"
47#include "MagickCore/exception-private.h"
48#include "MagickCore/image-private.h"
49#include "MagickCore/matrix.h"
50#include "MagickCore/matrix-private.h"
51#include "MagickCore/memory_.h"
52#include "MagickCore/memory-private.h"
53#include "MagickCore/nt-base-private.h"
54#include "MagickCore/pixel-accessor.h"
55#include "MagickCore/resource_.h"
56#include "MagickCore/semaphore.h"
57#include "MagickCore/thread-private.h"
58#include "MagickCore/utility.h"
59#include "MagickCore/utility-private.h"
82 path[MagickPathExtent];
128static void MatrixSignalHandler(
int magick_unused(status))
130 magick_unreferenced(status);
131 ThrowFatalException(CacheFatalError,
"UnableToExtendMatrixCache");
135static inline MagickOffsetType WriteMatrixElements(
136 const MatrixInfo *magick_restrict matrix_info,
const MagickOffsetType offset,
137 const MagickSizeType length,
const unsigned char *magick_restrict buffer)
145#if !defined(MAGICKCORE_HAVE_PWRITE)
146 LockSemaphoreInfo(matrix_info->semaphore);
147 if (lseek(matrix_info->file,offset,SEEK_SET) < 0)
149 UnlockSemaphoreInfo(matrix_info->semaphore);
150 return((MagickOffsetType) -1);
154 for (i=0; i < (MagickOffsetType) length; i+=count)
156#if !defined(MAGICKCORE_HAVE_PWRITE)
157 count=write(matrix_info->file,buffer+i,(
size_t) MagickMin(length-
158 (MagickSizeType) i,(MagickSizeType) MagickMaxBufferExtent));
160 count=pwrite(matrix_info->file,buffer+i,(
size_t) MagickMin(length-
161 (MagickSizeType) i,(MagickSizeType) MagickMaxBufferExtent),offset+i);
170#if !defined(MAGICKCORE_HAVE_PWRITE)
171 UnlockSemaphoreInfo(matrix_info->semaphore);
176static MagickBooleanType SetMatrixExtent(
177 MatrixInfo *magick_restrict matrix_info,MagickSizeType length)
184 if (length != (MagickSizeType) ((MagickOffsetType) length))
186 offset=(MagickOffsetType) lseek(matrix_info->file,0,SEEK_END);
189 if ((MagickSizeType) offset >= length)
191 extent=(MagickOffsetType) length-1;
192 count=WriteMatrixElements(matrix_info,extent,1,(
const unsigned char *)
"");
193#if defined(MAGICKCORE_HAVE_POSIX_FALLOCATE)
194 if (matrix_info->synchronize != MagickFalse)
195 (void) posix_fallocate(matrix_info->file,offset+1,extent-offset);
198 (void) signal(SIGBUS,MatrixSignalHandler);
200 return(count != (MagickOffsetType) 1 ? MagickFalse : MagickTrue);
203MagickExport
MatrixInfo *AcquireMatrixInfo(
const size_t columns,
204 const size_t rows,
const size_t stride,
ExceptionInfo *exception)
215 matrix_info=(
MatrixInfo *) AcquireMagickMemory(
sizeof(*matrix_info));
218 (void) memset(matrix_info,0,
sizeof(*matrix_info));
219 matrix_info->signature=MagickCoreSignature;
220 matrix_info->columns=columns;
221 matrix_info->rows=rows;
222 matrix_info->stride=stride;
223 matrix_info->semaphore=AcquireSemaphoreInfo();
224 synchronize=GetEnvironmentValue(
"MAGICK_SYNCHRONIZE");
225 if (synchronize != (
const char *) NULL)
227 matrix_info->synchronize=IsStringTrue(synchronize);
228 synchronize=DestroyString(synchronize);
230 matrix_info->length=(MagickSizeType) columns*rows*stride;
231 if (matrix_info->columns != (
size_t) (matrix_info->length/rows/stride))
233 (void) ThrowMagickException(exception,GetMagickModule(),CacheError,
234 "CacheResourcesExhausted",
"`%s'",
"matrix cache");
235 return(DestroyMatrixInfo(matrix_info));
237 matrix_info->type=MemoryCache;
238 status=AcquireMagickResource(AreaResource,matrix_info->length);
239 if ((status != MagickFalse) &&
240 (matrix_info->length == (MagickSizeType) ((
size_t) matrix_info->length)) &&
241 ((
size_t) matrix_info->length <= GetMaxMemoryRequest()))
243 status=AcquireMagickResource(MemoryResource,matrix_info->length);
244 if (status != MagickFalse)
246 matrix_info->mapped=MagickFalse;
247 matrix_info->elements=MagickAssumeAligned(AcquireAlignedMemory(1,
248 (
size_t) matrix_info->length));
249 if (matrix_info->elements == NULL)
251 matrix_info->mapped=MagickTrue;
252 matrix_info->elements=MapBlob(-1,IOMode,0,(
size_t)
253 matrix_info->length);
255 if (matrix_info->elements == (
unsigned short *) NULL)
256 RelinquishMagickResource(MemoryResource,matrix_info->length);
259 matrix_info->file=(-1);
260 if (matrix_info->elements == (
unsigned short *) NULL)
262 status=AcquireMagickResource(DiskResource,matrix_info->length);
263 if (status == MagickFalse)
265 (void) ThrowMagickException(exception,GetMagickModule(),CacheError,
266 "CacheResourcesExhausted",
"`%s'",
"matrix cache");
267 return(DestroyMatrixInfo(matrix_info));
269 matrix_info->type=DiskCache;
270 matrix_info->file=AcquireUniqueFileResource(matrix_info->path);
271 if (matrix_info->file == -1)
272 return(DestroyMatrixInfo(matrix_info));
273 status=AcquireMagickResource(MapResource,matrix_info->length);
274 if (status != MagickFalse)
276 status=SetMatrixExtent(matrix_info,matrix_info->length);
277 if (status != MagickFalse)
278 matrix_info->elements=(
void *) MapBlob(matrix_info->file,IOMode,0,
279 (
size_t) matrix_info->length);
280 if (matrix_info->elements != NULL)
281 matrix_info->type=MapCache;
283 RelinquishMagickResource(MapResource,matrix_info->length);
321MagickExport
double **AcquireMagickMatrix(
const size_t number_rows,
331 matrix=(
double **) AcquireQuantumMemory(number_rows,
sizeof(*matrix));
332 if (matrix == (
double **) NULL)
333 return((
double **) NULL);
334 for (i=0; i < (ssize_t) number_rows; i++)
336 matrix[i]=(
double *) AcquireQuantumMemory(size,
sizeof(*matrix[i]));
337 if (matrix[i] == (
double *) NULL)
339 for (j=0; j < i; j++)
340 matrix[j]=(
double *) RelinquishMagickMemory(matrix[j]);
341 matrix=(
double **) RelinquishMagickMemory(matrix);
342 return((
double **) NULL);
344 for (j=0; j < (ssize_t) size; j++)
376 assert(matrix_info->signature == MagickCoreSignature);
377 LockSemaphoreInfo(matrix_info->semaphore);
378 switch (matrix_info->type)
382 if (matrix_info->mapped == MagickFalse)
383 matrix_info->elements=RelinquishMagickMemory(matrix_info->elements);
386 (void) UnmapBlob(matrix_info->elements,(
size_t) matrix_info->length);
387 matrix_info->elements=(
unsigned short *) NULL;
389 RelinquishMagickResource(MemoryResource,matrix_info->length);
394 (void) UnmapBlob(matrix_info->elements,(
size_t) matrix_info->length);
395 matrix_info->elements=NULL;
396 RelinquishMagickResource(MapResource,matrix_info->length);
401 if (matrix_info->file != -1)
402 (void) close_utf8(matrix_info->file);
403 (void) RelinquishUniqueFileResource(matrix_info->path);
404 RelinquishMagickResource(DiskResource,matrix_info->length);
410 UnlockSemaphoreInfo(matrix_info->semaphore);
411 RelinquishSemaphoreInfo(&matrix_info->semaphore);
412 return((
MatrixInfo *) RelinquishMagickMemory(matrix_info));
485MagickPrivate MagickBooleanType GaussJordanElimination(
double **matrix,
486 double **vectors,
const size_t rank,
const size_t number_vectors)
488#define GaussJordanSwap(x,y) \
514 columns=(ssize_t *) AcquireQuantumMemory(rank,
sizeof(*columns));
515 rows=(ssize_t *) AcquireQuantumMemory(rank,
sizeof(*rows));
516 pivots=(ssize_t *) AcquireQuantumMemory(rank,
sizeof(*pivots));
517 if ((rows == (ssize_t *) NULL) || (columns == (ssize_t *) NULL) ||
518 (pivots == (ssize_t *) NULL))
520 if (pivots != (ssize_t *) NULL)
521 pivots=(ssize_t *) RelinquishMagickMemory(pivots);
522 if (columns != (ssize_t *) NULL)
523 columns=(ssize_t *) RelinquishMagickMemory(columns);
524 if (rows != (ssize_t *) NULL)
525 rows=(ssize_t *) RelinquishMagickMemory(rows);
528 (void) memset(columns,0,rank*
sizeof(*columns));
529 (void) memset(rows,0,rank*
sizeof(*rows));
530 (void) memset(pivots,0,rank*
sizeof(*pivots));
533 for (i=0; i < (ssize_t) rank; i++)
536 for (j=0; j < (ssize_t) rank; j++)
539 for (k=0; k < (ssize_t) rank; k++)
546 if (fabs(matrix[j][k]) >= max)
548 max=fabs(matrix[j][k]);
556 for (k=0; k < (ssize_t) rank; k++)
557 GaussJordanSwap(matrix[row][k],matrix[column][k]);
558 for (k=0; k < (ssize_t) number_vectors; k++)
559 GaussJordanSwap(vectors[k][row],vectors[k][column]);
563 if (matrix[column][column] == 0.0)
565 scale=PerceptibleReciprocal(matrix[column][column]);
566 matrix[column][column]=1.0;
567 for (j=0; j < (ssize_t) rank; j++)
568 matrix[column][j]*=scale;
569 for (j=0; j < (ssize_t) number_vectors; j++)
570 vectors[j][column]*=scale;
571 for (j=0; j < (ssize_t) rank; j++)
574 scale=matrix[j][column];
575 matrix[j][column]=0.0;
576 for (k=0; k < (ssize_t) rank; k++)
577 matrix[j][k]-=scale*matrix[column][k];
578 for (k=0; k < (ssize_t) number_vectors; k++)
579 vectors[k][j]-=scale*vectors[k][column];
582 for (j=(ssize_t) rank-1; j >= 0; j--)
583 if (columns[j] != rows[j])
584 for (i=0; i < (ssize_t) rank; i++)
585 GaussJordanSwap(matrix[i][rows[j]],matrix[i][columns[j]]);
586 pivots=(ssize_t *) RelinquishMagickMemory(pivots);
587 rows=(ssize_t *) RelinquishMagickMemory(rows);
588 columns=(ssize_t *) RelinquishMagickMemory(columns);
614MagickExport
size_t GetMatrixColumns(
const MatrixInfo *matrix_info)
617 assert(matrix_info->signature == MagickCoreSignature);
618 return(matrix_info->columns);
651static inline ssize_t EdgeX(
const ssize_t x,
const size_t columns)
655 if (x >= (ssize_t) columns)
656 return((ssize_t) (columns-1));
660static inline ssize_t EdgeY(
const ssize_t y,
const size_t rows)
664 if (y >= (ssize_t) rows)
665 return((ssize_t) (rows-1));
669static inline MagickOffsetType ReadMatrixElements(
670 const MatrixInfo *magick_restrict matrix_info,
const MagickOffsetType offset,
671 const MagickSizeType length,
unsigned char *magick_restrict buffer)
679#if !defined(MAGICKCORE_HAVE_PREAD)
680 LockSemaphoreInfo(matrix_info->semaphore);
681 if (lseek(matrix_info->file,offset,SEEK_SET) < 0)
683 UnlockSemaphoreInfo(matrix_info->semaphore);
684 return((MagickOffsetType) -1);
688 for (i=0; i < (MagickOffsetType) length; i+=count)
690#if !defined(MAGICKCORE_HAVE_PREAD)
691 count=read(matrix_info->file,buffer+i,(
size_t) MagickMin(length-i,
692 (MagickSizeType) MagickMaxBufferExtent));
694 count=pread(matrix_info->file,buffer+i,(
size_t) MagickMin(length-
695 (MagickSizeType) i,(MagickSizeType) MagickMaxBufferExtent),offset+i);
704#if !defined(MAGICKCORE_HAVE_PREAD)
705 UnlockSemaphoreInfo(matrix_info->semaphore);
710MagickExport MagickBooleanType GetMatrixElement(
const MatrixInfo *matrix_info,
711 const ssize_t x,
const ssize_t y,
void *value)
717 assert(matrix_info != (
const MatrixInfo *) NULL);
718 assert(matrix_info->signature == MagickCoreSignature);
719 i=EdgeY(y,matrix_info->rows)*(MagickOffsetType) matrix_info->columns+
720 EdgeX(x,matrix_info->columns);
721 if (matrix_info->type != DiskCache)
723 (void) memcpy(value,(
unsigned char *) matrix_info->elements+i*
724 (MagickOffsetType) matrix_info->stride,matrix_info->stride);
727 count=ReadMatrixElements(matrix_info,i*(MagickOffsetType) matrix_info->stride,
728 matrix_info->stride,(
unsigned char *) value);
729 if (count != (MagickOffsetType) matrix_info->stride)
756MagickExport
size_t GetMatrixRows(
const MatrixInfo *matrix_info)
758 assert(matrix_info != (
const MatrixInfo *) NULL);
759 assert(matrix_info->signature == MagickCoreSignature);
760 return(matrix_info->rows);
834MagickPrivate
void LeastSquaresAddTerms(
double **matrix,
double **vectors,
835 const double *terms,
const double *results,
const size_t rank,
836 const size_t number_vectors)
842 for (j=0; j < (ssize_t) rank; j++)
844 for (i=0; i < (ssize_t) rank; i++)
845 matrix[i][j]+=terms[i]*terms[j];
846 for (i=0; i < (ssize_t) number_vectors; i++)
847 vectors[i][j]+=results[i]*terms[j];
897 assert(matrix_info != (
const MatrixInfo *) NULL);
898 assert(matrix_info->signature == MagickCoreSignature);
900 assert(exception->signature == MagickCoreSignature);
901 if (matrix_info->stride <
sizeof(
double))
902 return((
Image *) NULL);
906 (void) GetMatrixElement(matrix_info,0,0,&min_value);
908 for (y=0; y < (ssize_t) matrix_info->rows; y++)
913 for (x=0; x < (ssize_t) matrix_info->columns; x++)
918 if (GetMatrixElement(matrix_info,x,y,&value) == MagickFalse)
920 if (value < min_value)
923 if (value > max_value)
927 if ((min_value == 0.0) && (max_value == 0.0))
930 if (min_value == max_value)
932 scale_factor=(double) QuantumRange/min_value;
936 scale_factor=(double) QuantumRange/(max_value-min_value);
940 image=AcquireImage((
ImageInfo *) NULL,exception);
941 image->columns=matrix_info->columns;
942 image->rows=matrix_info->rows;
943 image->colorspace=GRAYColorspace;
945 image_view=AcquireAuthenticCacheView(image,exception);
946#if defined(MAGICKCORE_OPENMP_SUPPORT)
947 #pragma omp parallel for schedule(static) shared(status) \
948 magick_number_threads(image,image,image->rows,2)
950 for (y=0; y < (ssize_t) image->rows; y++)
961 if (status == MagickFalse)
963 q=QueueCacheViewAuthenticPixels(image_view,0,y,image->columns,1,exception);
964 if (q == (Quantum *) NULL)
969 for (x=0; x < (ssize_t) image->columns; x++)
971 if (GetMatrixElement(matrix_info,x,y,&value) == MagickFalse)
973 value=scale_factor*(value-min_value);
974 *q=ClampToQuantum(value);
975 q+=(ptrdiff_t) GetPixelChannels(image);
977 if (SyncCacheViewAuthenticPixels(image_view,exception) == MagickFalse)
980 image_view=DestroyCacheView(image_view);
981 if (status == MagickFalse)
982 image=DestroyImage(image);
1008MagickExport MagickBooleanType NullMatrix(
MatrixInfo *matrix_info)
1020 assert(matrix_info != (
const MatrixInfo *) NULL);
1021 assert(matrix_info->signature == MagickCoreSignature);
1022 if (matrix_info->type != DiskCache)
1024 (void) memset(matrix_info->elements,0,(
size_t)
1025 matrix_info->length);
1029 (void) lseek(matrix_info->file,0,SEEK_SET);
1030 for (y=0; y < (ssize_t) matrix_info->rows; y++)
1032 for (x=0; x < (ssize_t) matrix_info->length; x++)
1034 count=write(matrix_info->file,&value,
sizeof(value));
1035 if (count != (ssize_t)
sizeof(value))
1038 if (x < (ssize_t) matrix_info->length)
1041 return(y < (ssize_t) matrix_info->rows ? MagickFalse : MagickTrue);
1071MagickExport
double **RelinquishMagickMatrix(
double **matrix,
1072 const size_t number_rows)
1077 if (matrix == (
double **) NULL )
1079 for (i=0; i < (ssize_t) number_rows; i++)
1080 matrix[i]=(
double *) RelinquishMagickMemory(matrix[i]);
1081 matrix=(
double **) RelinquishMagickMemory(matrix);
1115MagickExport MagickBooleanType SetMatrixElement(
const MatrixInfo *matrix_info,
1116 const ssize_t x,
const ssize_t y,
const void *value)
1122 assert(matrix_info != (
const MatrixInfo *) NULL);
1123 assert(matrix_info->signature == MagickCoreSignature);
1124 i=y*(MagickOffsetType) matrix_info->columns+x;
1126 (((MagickSizeType) i*matrix_info->stride) >= matrix_info->length))
1127 return(MagickFalse);
1128 if (matrix_info->type != DiskCache)
1130 (void) memcpy((
unsigned char *) matrix_info->elements+i*
1131 (MagickOffsetType) matrix_info->stride,value,matrix_info->stride);
1134 count=WriteMatrixElements(matrix_info,i*(MagickOffsetType)
1135 matrix_info->stride,matrix_info->stride,(
unsigned char *) value);
1136 if (count != (MagickOffsetType) matrix_info->stride)
1137 return(MagickFalse);