1 files changed, 146 insertions, 0 deletions
diff --git a/sci_gateway/cpp/opencv_xyz2uint16.cpp b/sci_gateway/cpp/opencv_xyz2uint16.cpp
new file mode 100644
index 0000000..969cb68
--- /dev/null
+++ b/sci_gateway/cpp/opencv_xyz2uint16.cpp
@@ -0,0 +1,146 @@
+/*--------------------------------------  
+ function-lab2uint16
+ Author :Tess Zacharias    
+------------------------------------- */
+#include <numeric>
+#include "opencv2/core/core.hpp"
+#include "opencv2/highgui/highgui.hpp"
+#include "opencv2/opencv.hpp"
+#include <iostream>
+#include<stdio.h>
+#include <sciprint.h>
+#include<string.h>
+using namespace cv;
+using namespace std;
+extern "C"
+{
+  #include "api_scilab.h"
+  #include "Scierror.h"
+  #include "BOOL.h"
+  #include <localization.h>
+  #include "../common.h"
+  struct Color
+  {
+    float R,G,B,X,Y,Z;
+  };
+ Color xyz2uint16(float X, float Y, float Z)
+ {
+   /* xyz to uint16 conversion  */
+  float R1=round((65535 * (X / (1 + (32767/32768))))/2);
+  float G1=round((65535 * (Y / (1 + (32767/32768))))/2);
+  float B1=round((65535 * (Z / (1 + (32767/32768))))/2);
+  
+  Color rgb;
+  rgb.R = R1;
+  rgb.G = G1;
+  rgb.B = B1;
+    return rgb;
+ }
+ int opencv_xyz2uint16(char *fname, unsigned long fname_len)
+ {
+        SciErr sciErr;
+  	int iRows= 0;
+	int iCols= 0;
+        int* piAddr=NULL;
+        int* piAddr1=NULL;
+        int* piAddr3=NULL;
+        int i,j;
+        int error;
+        Color out;
+        float X,Y,Z;
+        int *piAddrNew = NULL;                      
+        CheckOutputArgument(pvApiCtx,1,1);
+        int k=0;
+        double *pstDataR = NULL;
+        double *pstDataG = NULL;
+        double *pstDataB = NULL; 
+        sciErr = getVarAddressFromPosition(pvApiCtx,1,&piAddr);
+        if(sciErr.iErr)   
+          {
+               printError(&sciErr, 0);
+               return 0;
+          }
+        sciErr =  getMatrixOfDoubleInList(pvApiCtx, piAddr, 1, &iRows, &iCols, &pstDataR);
+        if(sciErr.iErr)
+          {
+               printError(&sciErr, 0);
+               return 0;
+          }
+        sciErr = getVarAddressFromPosition(pvApiCtx,1,&piAddr);
+        if(sciErr.iErr)   
+          {
+               printError(&sciErr, 0);
+               return 0;
+          }   
+        sciErr = getMatrixOfDoubleInList(pvApiCtx, piAddr, 2, &iRows, &iCols, &pstDataG);
+        if(sciErr.iErr)
+          {
+               printError(&sciErr, 0);
+               return 0;
+          }
+        sciErr = getVarAddressFromPosition(pvApiCtx,1,&piAddr);
+        if(sciErr.iErr)   
+          {
+               printError(&sciErr, 0);
+               return 0;
+          }   
+         sciErr = getMatrixOfDoubleInList(pvApiCtx, piAddr, 3, &iRows, &iCols, &pstDataB);
+         if(sciErr.iErr)
+          {
+               printError(&sciErr, 0);
+               return 0;
+          }
+         int m=0;
+         unsigned short *r1,*g1,*b1;
+         r1=(unsigned short *)malloc(sizeof(unsigned short )*iRows*iCols);
+         g1=(unsigned short  *)malloc(sizeof(unsigned short )*iRows*iCols);
+         b1=(unsigned short  *)malloc(sizeof(unsigned short )*iRows*iCols);
+         for(int i=0;i<iRows;i++)
+           {
+             for(int j=0;j<iCols;j++)
+              {
+                   X= (pstDataR[k]);
+                   Y= (pstDataG[k]);
+                   Z= (pstDataB[k++]);
+                   out=xyz2uint16(X,Y,Z);
+                   r1[m]=(out.R);
+                   g1[m]=(out.G);
+                   b1[m++]=(out.B);  
+                }
+            }
+                     
+    sciErr = createList(pvApiCtx, nbInputArgument(pvApiCtx) + 1, 3, &piAddrNew);
+    if(sciErr.iErr)
+    {
+        printError(&sciErr, 0);
+        return 0;
+    }
+    sciErr = createMatrixOfUnsignedInteger16InList(pvApiCtx, nbInputArgument(pvApiCtx)+1 , piAddrNew, 1, iRows,iCols, r1);
+    free(r1);
+    if(sciErr.iErr)
+    {
+        printError(&sciErr, 0);
+        return 0;
+    }
+    sciErr = createMatrixOfUnsignedInteger16InList(pvApiCtx, nbInputArgument(pvApiCtx)+1 , piAddrNew, 2, iRows, iCols, g1);
+    free(g1);
+    if(sciErr.iErr)
+    {
+        printError(&sciErr, 0);
+        return 0;
+    }
+    sciErr = createMatrixOfUnsignedInteger16InList(pvApiCtx, nbInputArgument(pvApiCtx)+1 , piAddrNew, 3, iRows, iCols, b1);
+    free(b1);
+    if(sciErr.iErr)
+    {
+        printError(&sciErr, 0);
+        return 0;
+    }
+
+              
+             AssignOutputVariable(pvApiCtx, 1) = nbInputArgument(pvApiCtx) + 1;
+            ReturnArguments(pvApiCtx);            
+            return 0;                
+}
+}
+