42 #include "magick/studio.h"
43 #include "magick/blob.h"
44 #include "magick/blob-private.h"
45 #include "magick/exception.h"
46 #include "magick/exception-private.h"
47 #include "magick/image-private.h"
48 #include "magick/matrix.h"
49 #include "magick/memory_.h"
50 #include "magick/memory-private.h"
51 #include "magick/pixel-private.h"
52 #include "magick/resource_.h"
53 #include "magick/semaphore.h"
54 #include "magick/thread-private.h"
55 #include "magick/utility.h"
124 static void MatrixSignalHandler(
int magick_unused(status))
126 magick_unreferenced(status);
127 ThrowFatalException(CacheFatalError,
"UnableToExtendMatrixCache");
131 static inline MagickOffsetType WriteMatrixElements(
132 const MatrixInfo *magick_restrict matrix_info,
const MagickOffsetType offset,
133 const MagickSizeType length,
const unsigned char *magick_restrict buffer)
141 #if !defined(MAGICKCORE_HAVE_PWRITE)
142 LockSemaphoreInfo(matrix_info->semaphore);
143 if (lseek(matrix_info->file,offset,SEEK_SET) < 0)
145 UnlockSemaphoreInfo(matrix_info->semaphore);
146 return((MagickOffsetType) -1);
150 for (i=0; i < (MagickOffsetType) length; i+=count)
152 #if !defined(MAGICKCORE_HAVE_PWRITE)
153 count=write(matrix_info->file,buffer+i,(
size_t) MagickMin(length-i,
154 (MagickSizeType) MagickMaxBufferExtent));
156 count=pwrite(matrix_info->file,buffer+i,(
size_t) MagickMin(length-i,
157 (MagickSizeType) MagickMaxBufferExtent),(off_t) (offset+i));
166 #if !defined(MAGICKCORE_HAVE_PWRITE)
167 UnlockSemaphoreInfo(matrix_info->semaphore);
172 static MagickBooleanType SetMatrixExtent(
173 MatrixInfo *magick_restrict matrix_info,MagickSizeType length)
180 if (length != (MagickSizeType) ((MagickOffsetType) length))
182 offset=(MagickOffsetType) lseek(matrix_info->file,0,SEEK_END);
185 if ((MagickSizeType) offset >= length)
187 extent=(MagickOffsetType) length-1;
188 count=WriteMatrixElements(matrix_info,extent,1,(
const unsigned char *)
"");
189 #if defined(MAGICKCORE_HAVE_POSIX_FALLOCATE)
190 if (matrix_info->synchronize != MagickFalse)
191 (void) posix_fallocate(matrix_info->file,offset+1,extent-offset);
194 (void) signal(SIGBUS,MatrixSignalHandler);
196 return(count != (MagickOffsetType) 1 ? MagickFalse : MagickTrue);
199 MagickExport
MatrixInfo *AcquireMatrixInfo(
const size_t columns,
200 const size_t rows,
const size_t stride,
ExceptionInfo *exception)
211 matrix_info=(
MatrixInfo *) AcquireMagickMemory(
sizeof(*matrix_info));
214 (void) memset(matrix_info,0,
sizeof(*matrix_info));
215 matrix_info->signature=MagickCoreSignature;
216 matrix_info->columns=columns;
217 matrix_info->rows=rows;
218 matrix_info->stride=stride;
219 matrix_info->semaphore=AllocateSemaphoreInfo();
220 synchronize=GetEnvironmentValue(
"MAGICK_SYNCHRONIZE");
221 if (synchronize != (
const char *) NULL)
223 matrix_info->synchronize=IsStringTrue(synchronize);
224 synchronize=DestroyString(synchronize);
226 matrix_info->length=(MagickSizeType) columns*rows*stride;
227 if (matrix_info->columns != (
size_t) (matrix_info->length/rows/stride))
229 (void) ThrowMagickException(exception,GetMagickModule(),CacheError,
230 "CacheResourcesExhausted",
"`%s'",
"matrix cache");
231 return(DestroyMatrixInfo(matrix_info));
233 matrix_info->type=MemoryCache;
234 status=AcquireMagickResource(AreaResource,matrix_info->length);
235 if ((status != MagickFalse) &&
236 (matrix_info->length == (MagickSizeType) ((
size_t) matrix_info->length)) &&
237 ((
size_t) matrix_info->length <= GetMaxMemoryRequest()))
239 status=AcquireMagickResource(MemoryResource,matrix_info->length);
240 if (status != MagickFalse)
242 matrix_info->mapped=MagickFalse;
243 matrix_info->elements=MagickAssumeAligned(AcquireAlignedMemory(1,
244 (
size_t) matrix_info->length));
245 if (matrix_info->elements == NULL)
247 matrix_info->mapped=MagickTrue;
248 matrix_info->elements=MapBlob(-1,IOMode,0,(
size_t)
249 matrix_info->length);
251 if (matrix_info->elements == (
unsigned short *) NULL)
252 RelinquishMagickResource(MemoryResource,matrix_info->length);
255 matrix_info->file=(-1);
256 if (matrix_info->elements == (
unsigned short *) NULL)
258 status=AcquireMagickResource(DiskResource,matrix_info->length);
259 if (status == MagickFalse)
261 (void) ThrowMagickException(exception,GetMagickModule(),CacheError,
262 "CacheResourcesExhausted",
"`%s'",
"matrix cache");
263 return(DestroyMatrixInfo(matrix_info));
265 matrix_info->type=DiskCache;
266 matrix_info->file=AcquireUniqueFileResource(matrix_info->path);
267 if (matrix_info->file == -1)
268 return(DestroyMatrixInfo(matrix_info));
269 status=AcquireMagickResource(MapResource,matrix_info->length);
270 if (status != MagickFalse)
272 status=SetMatrixExtent(matrix_info,matrix_info->length);
273 if (status != MagickFalse)
274 matrix_info->elements=(
void *) MapBlob(matrix_info->file,IOMode,0,
275 (
size_t) matrix_info->length);
276 if (matrix_info->elements != NULL)
277 matrix_info->type=MapCache;
279 RelinquishMagickResource(MapResource,matrix_info->length);
317 MagickExport
double **AcquireMagickMatrix(
const size_t number_rows,
327 matrix=(
double **) AcquireQuantumMemory(number_rows,
sizeof(*matrix));
328 if (matrix == (
double **) NULL)
329 return((
double **) NULL);
330 for (i=0; i < (ssize_t) number_rows; i++)
332 matrix[i]=(
double *) AcquireQuantumMemory(size,
sizeof(*matrix[i]));
333 if (matrix[i] == (
double *) NULL)
335 for (j=0; j < i; j++)
336 matrix[j]=(
double *) RelinquishMagickMemory(matrix[j]);
337 matrix=(
double **) RelinquishMagickMemory(matrix);
338 return((
double **) NULL);
340 for (j=0; j < (ssize_t) size; j++)
372 assert(matrix_info->signature == MagickCoreSignature);
373 LockSemaphoreInfo(matrix_info->semaphore);
374 switch (matrix_info->type)
378 if (matrix_info->mapped == MagickFalse)
379 matrix_info->elements=RelinquishAlignedMemory(matrix_info->elements);
382 (void) UnmapBlob(matrix_info->elements,(
size_t) matrix_info->length);
383 matrix_info->elements=(
unsigned short *) NULL;
385 RelinquishMagickResource(MemoryResource,matrix_info->length);
390 (void) UnmapBlob(matrix_info->elements,(
size_t) matrix_info->length);
391 matrix_info->elements=NULL;
392 RelinquishMagickResource(MapResource,matrix_info->length);
397 if (matrix_info->file != -1)
398 (void) close(matrix_info->file);
399 (void) RelinquishUniqueFileResource(matrix_info->path);
400 RelinquishMagickResource(DiskResource,matrix_info->length);
406 UnlockSemaphoreInfo(matrix_info->semaphore);
407 DestroySemaphoreInfo(&matrix_info->semaphore);
408 return((
MatrixInfo *) RelinquishMagickMemory(matrix_info));
481 MagickExport MagickBooleanType GaussJordanElimination(
double **matrix,
482 double **vectors,
const size_t rank,
const size_t number_vectors)
484 #define GaussJordanSwap(x,y) \
490 #define GaussJordanSwapLD(x,y) \
492 long double temp = (x); \
496 #define ThrowGaussJordanException() \
498 for (i=0; i < (ssize_t) rank; i++) \
499 hp_matrix[i]=(long double *) RelinquishMagickMemory(hp_matrix[i]); \
500 hp_matrix=(long double **) RelinquishMagickMemory(hp_matrix); \
501 if (pivots != (ssize_t *) NULL) \
502 pivots=(ssize_t *) RelinquishMagickMemory(pivots); \
503 if (rows != (ssize_t *) NULL) \
504 rows=(ssize_t *) RelinquishMagickMemory(rows); \
505 if (columns != (ssize_t *) NULL) \
506 columns=(ssize_t *) RelinquishMagickMemory(columns); \
507 return(MagickFalse); \
511 **hp_matrix = (
long double **) NULL,
516 *columns = (ssize_t *) NULL,
519 *pivots = (ssize_t *) NULL,
521 *rows = (ssize_t *) NULL;
526 hp_matrix=(
long double **) AcquireQuantumMemory(rank,
sizeof(*hp_matrix));
527 if (hp_matrix == (
long double **) NULL)
529 for (i=0; i < (ssize_t) rank; i++)
531 hp_matrix[i]=(
long double *) AcquireQuantumMemory(rank,
532 sizeof(*hp_matrix[i]));
533 if (hp_matrix[i] == (
long double *) NULL)
534 ThrowGaussJordanException();
535 for (j=0; j < (ssize_t) rank; j++)
536 hp_matrix[i][j]=(
long double)matrix[i][j];
538 columns=(ssize_t *) AcquireQuantumMemory(rank,
sizeof(*columns));
539 rows=(ssize_t *) AcquireQuantumMemory(rank,
sizeof(*rows));
540 pivots=(ssize_t *) AcquireQuantumMemory(rank,
sizeof(*pivots));
541 if ((columns == (ssize_t *) NULL) || (rows == (ssize_t *) NULL) ||
542 (pivots == (ssize_t *) NULL))
543 ThrowGaussJordanException();
544 (void) memset(columns,0,rank*
sizeof(*columns));
545 (void) memset(rows,0,rank*
sizeof(*rows));
546 (void) memset(pivots,0,rank*
sizeof(*pivots));
547 for (i=0; i < (ssize_t) rank; i++)
561 for (j=0; j < (ssize_t) rank; j++)
563 for (k=0; k < (ssize_t) rank; k++)
564 if ((pivots[k] == 0) && (fabsl(hp_matrix[j][k]) > max))
566 max=fabsl(hp_matrix[j][k]);
570 if ((column == -1) || (row == -1) || (fabsl(max) < LDBL_MIN))
571 ThrowGaussJordanException();
575 for (k=0; k < (ssize_t) rank; k++)
576 GaussJordanSwapLD(hp_matrix[row][k],hp_matrix[column][k]);
577 for (k=0; k < (ssize_t) number_vectors; k++)
578 GaussJordanSwap(vectors[k][row],vectors[k][column]);
582 if (fabsl(hp_matrix[column][column]) < LDBL_MIN)
583 ThrowGaussJordanException();
584 scale=1.0L/hp_matrix[column][column];
585 hp_matrix[column][column]=1.0;
586 for (j=0; j < (ssize_t) rank; j++)
587 hp_matrix[column][j]*=scale;
588 for (j=0; j < (ssize_t) number_vectors; j++)
589 vectors[j][column]*=(
double) scale;
590 for (j=0; j < (ssize_t) rank; j++)
593 scale=hp_matrix[j][column];
594 hp_matrix[j][column]=0.0;
595 for (k=0; k < (ssize_t) rank; k++)
596 hp_matrix[j][k]-=scale*hp_matrix[column][k];
597 for (k=0; k < (ssize_t) number_vectors; k++)
598 vectors[k][j]-=(
double)(scale*(
long double) vectors[k][column]);
601 for (j=(ssize_t) rank-1; j >= 0; j--)
602 if (columns[j] != rows[j])
603 for (i=0; i < (ssize_t) rank; i++)
604 GaussJordanSwapLD(hp_matrix[i][columns[j]],hp_matrix[i][rows[j]]);
608 for (i=0; i < (ssize_t) rank; i++)
609 for (j=0; j < (ssize_t) rank; j++)
610 matrix[i][j]=(
double)hp_matrix[i][j];
614 for (i=0; i < (ssize_t) rank; i++)
615 hp_matrix[i]=(
long double *) RelinquishMagickMemory(hp_matrix[i]);
616 hp_matrix=(
long double **) RelinquishMagickMemory(hp_matrix);
617 pivots=(ssize_t *) RelinquishMagickMemory(pivots);
618 rows=(ssize_t *) RelinquishMagickMemory(rows);
619 columns=(ssize_t *) RelinquishMagickMemory(columns);
645 MagickExport
size_t GetMatrixColumns(
const MatrixInfo *matrix_info)
648 assert(matrix_info->signature == MagickCoreSignature);
649 return(matrix_info->columns);
682 static inline ssize_t EdgeX(
const ssize_t x,
const size_t columns)
686 if (x >= (ssize_t) columns)
687 return((ssize_t) (columns-1));
691 static inline ssize_t EdgeY(
const ssize_t y,
const size_t rows)
695 if (y >= (ssize_t) rows)
696 return((ssize_t) (rows-1));
700 static inline MagickOffsetType ReadMatrixElements(
701 const MatrixInfo *magick_restrict matrix_info,
const MagickOffsetType offset,
702 const MagickSizeType length,
unsigned char *magick_restrict buffer)
710 #if !defined(MAGICKCORE_HAVE_PREAD)
711 LockSemaphoreInfo(matrix_info->semaphore);
712 if (lseek(matrix_info->file,offset,SEEK_SET) < 0)
714 UnlockSemaphoreInfo(matrix_info->semaphore);
715 return((MagickOffsetType) -1);
719 for (i=0; i < (MagickOffsetType) length; i+=count)
721 #if !defined(MAGICKCORE_HAVE_PREAD)
722 count=read(matrix_info->file,buffer+i,(
size_t) MagickMin(length-i,
723 (MagickSizeType) MagickMaxBufferExtent));
725 count=pread(matrix_info->file,buffer+i,(
size_t) MagickMin(length-i,
726 (MagickSizeType) MagickMaxBufferExtent),(off_t) (offset+i));
735 #if !defined(MAGICKCORE_HAVE_PREAD)
736 UnlockSemaphoreInfo(matrix_info->semaphore);
741 MagickExport MagickBooleanType GetMatrixElement(
const MatrixInfo *matrix_info,
742 const ssize_t x,
const ssize_t y,
void *value)
748 assert(matrix_info != (
const MatrixInfo *) NULL);
749 assert(matrix_info->signature == MagickCoreSignature);
750 i=(MagickOffsetType) EdgeY(y,matrix_info->rows)*matrix_info->columns+
751 EdgeX(x,matrix_info->columns);
752 if (matrix_info->type != DiskCache)
754 (void) memcpy(value,(
unsigned char *) matrix_info->elements+i*
755 matrix_info->stride,matrix_info->stride);
758 count=ReadMatrixElements(matrix_info,i*matrix_info->stride,
759 matrix_info->stride,(
unsigned char *) value);
760 if (count != (MagickOffsetType) matrix_info->stride)
787 MagickExport
size_t GetMatrixRows(
const MatrixInfo *matrix_info)
789 assert(matrix_info != (
const MatrixInfo *) NULL);
790 assert(matrix_info->signature == MagickCoreSignature);
791 return(matrix_info->rows);
865 MagickExport
void LeastSquaresAddTerms(
double **matrix,
double **vectors,
866 const double *terms,
const double *results,
const size_t rank,
867 const size_t number_vectors)
873 for (j=0; j < (ssize_t) rank; j++)
875 for (i=0; i < (ssize_t) rank; i++)
876 matrix[i][j]+=terms[i]*terms[j];
877 for (i=0; i < (ssize_t) number_vectors; i++)
878 vectors[i][j]+=results[i]*terms[j];
929 assert(matrix_info != (
const MatrixInfo *) NULL);
930 assert(matrix_info->signature == MagickCoreSignature);
932 assert(exception->signature == MagickCoreSignature);
933 if (matrix_info->stride <
sizeof(
double))
934 return((
Image *) NULL);
938 (void) GetMatrixElement(matrix_info,0,0,&value);
941 for (y=0; y < (ssize_t) matrix_info->rows; y++)
946 for (x=0; x < (ssize_t) matrix_info->columns; x++)
948 if (GetMatrixElement(matrix_info,x,y,&value) == MagickFalse)
950 if (value < min_value)
953 if (value > max_value)
957 if ((min_value == 0.0) && (max_value == 0.0))
960 if (min_value == max_value)
962 scale_factor=(double) QuantumRange/min_value;
966 scale_factor=(double) QuantumRange/(max_value-min_value);
971 image->columns=matrix_info->columns;
972 image->rows=matrix_info->rows;
973 image->colorspace=GRAYColorspace;
975 image_view=AcquireAuthenticCacheView(image,exception);
976 #if defined(MAGICKCORE_OPENMP_SUPPORT)
977 #pragma omp parallel for schedule(static) shared(status) \
978 magick_number_threads(image,image,image->rows,2)
980 for (y=0; y < (ssize_t) image->rows; y++)
991 if (status == MagickFalse)
993 q=QueueCacheViewAuthenticPixels(image_view,0,y,image->columns,1,exception);
999 for (x=0; x < (ssize_t) image->columns; x++)
1001 if (GetMatrixElement(matrix_info,x,y,&value) == MagickFalse)
1003 value=scale_factor*(value-min_value);
1004 q->red=ClampToQuantum(value);
1009 if (SyncCacheViewAuthenticPixels(image_view,exception) == MagickFalse)
1012 image_view=DestroyCacheView(image_view);
1013 if (status == MagickFalse)
1014 image=DestroyImage(image);
1040 MagickExport MagickBooleanType NullMatrix(
MatrixInfo *matrix_info)
1052 assert(matrix_info != (
const MatrixInfo *) NULL);
1053 assert(matrix_info->signature == MagickCoreSignature);
1054 if (matrix_info->type != DiskCache)
1056 (void) memset(matrix_info->elements,0,(
size_t)
1057 matrix_info->length);
1061 (void) lseek(matrix_info->file,0,SEEK_SET);
1062 for (y=0; y < (ssize_t) matrix_info->rows; y++)
1064 for (x=0; x < (ssize_t) matrix_info->length; x++)
1066 count=write(matrix_info->file,&value,
sizeof(value));
1067 if (count != (ssize_t)
sizeof(value))
1070 if (x < (ssize_t) matrix_info->length)
1073 return(y < (ssize_t) matrix_info->rows ? MagickFalse : MagickTrue);
1103 MagickExport
double **RelinquishMagickMatrix(
double **matrix,
1104 const size_t number_rows)
1109 if (matrix == (
double **) NULL )
1111 for (i=0; i < (ssize_t) number_rows; i++)
1112 matrix[i]=(
double *) RelinquishMagickMemory(matrix[i]);
1113 matrix=(
double **) RelinquishMagickMemory(matrix);
1147 MagickExport MagickBooleanType SetMatrixElement(
const MatrixInfo *matrix_info,
1148 const ssize_t x,
const ssize_t y,
const void *value)
1154 assert(matrix_info != (
const MatrixInfo *) NULL);
1155 assert(matrix_info->signature == MagickCoreSignature);
1156 i=(MagickOffsetType) y*matrix_info->columns+x;
1158 ((MagickSizeType) (i*matrix_info->stride) >= matrix_info->length))
1159 return(MagickFalse);
1160 if (matrix_info->type != DiskCache)
1162 (void) memcpy((
unsigned char *) matrix_info->elements+i*
1163 matrix_info->stride,value,matrix_info->stride);
1166 count=WriteMatrixElements(matrix_info,i*matrix_info->stride,
1167 matrix_info->stride,(
unsigned char *) value);
1168 if (count != (MagickOffsetType) matrix_info->stride)
1169 return(MagickFalse);