added pointOp.c for compiling (mex pointOp.c)

matlabPyrTools/MEX/pointOp.c

@@ -0,0 +1,126 @@
+/* 
+RES = pointOp(IM, LUT, ORIGIN, INCREMENT, WARNINGS)
+  >>> See pointOp.m for documentation <<<
+  EPS, ported from OBVIUS, 7/96.
+*/
+
+#define V4_COMPAT
+#include <matrix.h>  /* Matlab matrices */
+#include <mex.h>
+
+#include <stddef.h>  /* NULL */
+
+#define notDblMtx(it) (!mxIsNumeric(it) || !mxIsDouble(it) || mxIsSparse(it) || mxIsComplex(it))
+
+void internal_pointop();
+
+void mexFunction(int nlhs,	     /* Num return vals on lhs */
+		 mxArray *plhs[],    /* Matrices on lhs      */
+		 int nrhs,	     /* Num args on rhs    */
+		 const mxArray *prhs[]     /* Matrices on rhs */
+		 )
+  {
+  double *image, *lut, *res;
+  double origin, increment;
+  int x_dim, y_dim, lx_dim, ly_dim;
+  int warnings = 1;
+  const mxArray *arg0,*arg1,*arg2,*arg3,*arg4;
+  double *mxMat;
+
+  if (nrhs < 4 ) mexErrMsgTxt("requres  at least 4 args.");
+
+  /* ARG 1: IMAGE  */
+  arg0 = prhs[0];
+  if notDblMtx(arg0) mexErrMsgTxt("IMAGE arg must be a real non-sparse matrix.");
+  image = mxGetPr(arg0);
+  x_dim = (int) mxGetM(arg0); /* X is inner index! */
+  y_dim = (int) mxGetN(arg0);
+
+  /* ARG 2: Lookup table */
+  arg1 = prhs[1];
+  if notDblMtx(arg1) mexErrMsgTxt("LUT arg must be a real non-sparse matrix.");
+  lut = mxGetPr(arg1);
+  lx_dim = (int) mxGetM(arg1); /* X is inner index! */
+  ly_dim = (int) mxGetN(arg1);
+  if ( (lx_dim != 1) && (ly_dim != 1) )
+    mexErrMsgTxt("Lookup table must be a row or column vector.");
+
+  /* ARG 3: ORIGIN */
+  arg2 = prhs[2];
+  if notDblMtx(arg2) mexErrMsgTxt("ORIGIN arg must be a real scalar.");
+  if (mxGetM(arg2) * mxGetN(arg2) != 1)
+     mexErrMsgTxt("ORIGIN arg must be a real scalar.");
+  mxMat = mxGetPr(arg2);
+  origin = *mxMat;
+
+  /* ARG 4: INCREMENT */
+  arg3 = prhs[3];
+  if notDblMtx(arg3) mexErrMsgTxt("INCREMENT arg must be a real scalar.");
+  if (mxGetM(arg3) * mxGetN(arg3) != 1)
+     mexErrMsgTxt("INCREMENT arg must be a real scalar.");
+  mxMat = mxGetPr(arg3);
+  increment = *mxMat;
+
+  /* ARG 5: WARNINGS */
+  if (nrhs>4)
+    {
+    arg4 = prhs[4];
+    if notDblMtx(arg4) mexErrMsgTxt("WARINGS arg must be a real scalar.");
+    if (mxGetM(arg4) * mxGetN(arg4) != 1)
+      mexErrMsgTxt("WARNINGS arg must be a real scalar.");
+    mxMat = mxGetPr(arg4);
+    warnings = (int) *mxMat;
+    }
+
+  plhs[0] = (mxArray *)  mxCreateDoubleMatrix(x_dim,y_dim,mxREAL);
+  if (plhs[0] == NULL) mexErrMsgTxt("Cannot allocate result matrix");
+  res = mxGetPr(plhs[0]);
+
+  internal_pointop(image, res, x_dim*y_dim, lut, lx_dim*ly_dim, 
+		   origin, increment, warnings);
+  return;
+  }      
+
+
+/* Use linear interpolation on a lookup table.
+   Taken from OBVIUS.  EPS, Spring, 1987.
+ */
+void internal_pointop (im, res, size, lut, lutsize, origin, increment, warnings)
+  register double *im, *res, *lut;
+  register double origin, increment; 
+  register int size, lutsize, warnings;
+  {
+  register int i, index;
+  register double pos;
+  register int l_unwarned = warnings;
+  register int r_unwarned = warnings;
+
+  lutsize = lutsize - 2;	/* Maximum index value */
+  if (increment > 0)
+    for (i=0; i<size; i++)
+	{
+	pos = (im[i] - origin) / increment;
+	index = (int) pos;   /* Floor */
+	if (index < 0)
+	    {
+	    index = 0;
+	    if (l_unwarned)
+		{
+		mexPrintf("Warning: Extrapolating to left of lookup table...\n");
+		l_unwarned = 0;
+		}
+	    }
+	else if (index > lutsize)
+	    {
+	    index = lutsize;
+	    if (r_unwarned)
+		{
+		mexPrintf("Warning: Extrapolating to right of lookup table...\n");
+		r_unwarned = 0;
+		}
+	    }
+	res[i] = lut[index] + (lut[index+1] - lut[index]) * (pos - index);
+	}
+  else
+    for (i=0; i<size; i++) res[i] = *lut;
+  }