C-API: Add set/get origin, xyz2enh and enh2xyz functions

c-api/baselib/CMakeLists.txt

@@ -24,6 +24,7 @@ endif()
 # Source files
 set(OPENCRG_SOURCES
     src/crgContactPoint.c
+    src/crgEvalenh.c
     src/crgEvalpk.c
     src/crgEvaluv2xy.c
     src/crgEvalxy2uv.c

c-api/baselib/inc/crgBaseLib.h

@@ -146,11 +146,12 @@
 #endif 
 /* ====== TYPE DEFINITIONS ====== */
 
-/* ====== METHODS in crgMgr.c ====== */
 #ifdef __cplusplus
 extern "C"
 {
 #endif
+
+/* ====== METHODS in crgMgr.c ====== */
     /**
     * destroy the data of the given data set
     * @param dataSetId    identifier of the applicable dataset
@@ -298,6 +299,30 @@ extern "C"
     */
     extern void crgDataSetOptionSetDefault( int dataSetId );
 
+    /**
+    * set the global offset values for a data set;
+    * the local coordinates are changed accordingly, so that no shift
+    * of evaluated global coordinates will occur
+    * @param  dataSetId    identifier of the applicable dataset
+    * @param  xoff         new x offset
+    * @param  yoff         new y offset
+    * @param  zoff         new z offset
+    * @param  poff         new p angle offset
+    * @return 1 if successful, otherwise 0
+    */
+    extern int crgDataSetSetGlobalOrigin(int dataSetId, double xoff, double yoff, double zoff, double poff);
+
+    /**
+    * get the global offset values for a data set;
+    * @param  dataSetId    identifier of the applicable dataset
+    * @param  xoff         x offset return value
+    * @param  yoff         y offset return value
+    * @param  zoff         z offset return value
+    * @param  poff         p angle offset return value
+    * @return 1 if successful, otherwise 0
+    */
+    extern int crgDataSetGetGlobalOrigin(int dataSetId, double* xoff, double* yoff, double* zoff, double* poff);
+
     /**
     * release all data held by the crg library
     */
@@ -540,6 +565,33 @@ extern "C"
     */
     extern int crgEvalxy2pk( int cpId, double x, double y, double* phi, double* curv );
 
+/* ====== METHODS in crgEvalenh.c ====== */
+    /**
+    * convert a given local (x,y,z) position into the corresponding global (e,n,h) position
+    * @param cpId  id of the contact point that is used for the query
+    * @param x     x coordinate
+    * @param y     y coordinate
+    * @param z     z coordinate
+    * @param e     e coordinate
+    * @param n     n coordinate
+    * @param h     h coordinate
+    * @return 1 if successful, otherwise 0
+    */
+    extern int crgEvalxyz2enh( int cpId, double x, double y, double z, double* e, double* n, double* h );
+
+    /**
+    * convert a given global (e,n,h) position into the corresponding local (x,y,z) position
+    * @param cpId  id of the contact point that is used for the query
+    * @param e     e coordinate
+    * @param n     n coordinate
+    * @param h     h coordinate
+    * @param x     x coordinate
+    * @param y     y coordinate
+    * @param z     z coordinate
+    * @return 1 if successful, otherwise 0
+    */
+    extern int crgEvalenh2xyz( int cpId, double e, double n, double h, double* x, double* y, double* z );
+
 /* ====== METHODS in crgPortability.c ====== */
     /**
     * print a message with a defined criticality level

c-api/baselib/inc/crgBaseLibPrivate.h

@@ -115,6 +115,8 @@ typedef struct
     double  phiFirstCos;  /* cosine of first phi value                        [-] */
     double  phiLastSin;   /* sine   of last phi value                         [-] */
     double  phiLastCos;   /* cosine of last phi value                         [-] */
+    double  phiOffSin;    /* sine   of phi offset value                       [-] */
+    double  phiOffCos;    /* cosine of phi offset value                       [-] */
 } CrgUtilityStruct;
 
 /**
@@ -694,6 +696,33 @@ extern int mCrgBigEndian;             /* endian-ness of machine */
     */
     extern int crgDataEvaluv2pk( const CrgDataStruct *crgData, const CrgOptionsStruct* optionList, double u, double v, double* phi, double* curv );
 
+/* ====== METHODS in crgEvalenh.c ====== */
+    /**
+    * convert a given local (x,y,z) position into the corresponding global (e,n,h) position
+    * @param crgData  pointer to data set which holds the data
+    * @param x        x coordinate
+    * @param y        y coordinate
+    * @param z        z coordinate
+    * @param e        e coordinate
+    * @param n        n coordinate
+    * @param h        h coordinate
+    * @return 1 if successful, otherwise 0
+    */
+    extern int crgDataEvalxyz2enh( const CrgDataStruct* crgData, double x, double y, double z, double* e, double* n, double* h );
+
+    /**
+    * convert a given global (e,n,h) position into the corresponding local (x,y,z) position
+    * @param crgData  pointer to data set which holds the data
+    * @param e        e coordinate
+    * @param n        n coordinate
+    * @param h        h coordinate
+    * @param x        x coordinate
+    * @param y        y coordinate
+    * @param z        z coordinate
+    * @return 1 if successful, otherwise 0
+    */
+    extern int crgDataEvalenh2xyz( const CrgDataStruct* crgData, double e, double n, double h, double* x, double* y, double* z );
+
 /* ====== METHODS in crgPortability.c ====== */
     /**
     * set the maximum level of messages that will be handled,

c-api/baselib/makefile

@@ -50,6 +50,7 @@ SOURCES = \
 	crgEvaluv2xy.c \
 	crgEvalz.c \
 	crgEvalpk.c \
+	crgEvalenh.c \
         crgLoader.c \
         crgOptionMgmt.c \
         crgPortability.c

c-api/baselib/src/crgEvalenh.c

@@ -0,0 +1,110 @@
+/* ===================================================
+ *  convert a xyz to enh coordinates and vice versa
+ * ---------------------------------------------------
+ *
+ * See the NOTICE file distributed with this work regarding copyright ownership.
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *    https://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ * More Information on ASAM OpenCRG can be found here:
+ * https://www.asam.net/standards/detail/opencrg/
+ *
+ */
+/* ====== INCLUSIONS ====== */
+#include "crgBaseLibPrivate.h"
+#include <math.h>
+#include <stdio.h>
+#include <stdlib.h>
+
+/* ====== DEFINITIONS ====== */
+
+/* ====== TYPE DEFINITIONS ====== */
+
+/* ====== LOCAL METHODS ====== */
+
+/* ====== IMPLEMENTATION ====== */
+int
+crgEvalxyz2enh( int cpId, double x, double y, double z, double* e, double* n, double* h)
+{
+    const CrgContactPointStruct* cp;
+
+    if ( !( cp = crgContactPointGetFromId( cpId ) ) )
+        return 0;
+
+    return crgDataEvalxyz2enh(cp->crgData, x, y, z, e, n, h);
+}
+
+int
+crgDataEvalxyz2enh( const CrgDataStruct *crgData, double x, double y, double z, double* e, double* n, double* h )
+{
+    if (!crgData)
+        return 0;
+
+    double xbeg = crgData->channelX.info.first;
+    double ybeg = crgData->channelY.info.first;
+
+    double ps = crgData->util.phiOffSin;
+    double pc = crgData->util.phiOffCos;
+
+    /* --- rotate around(xbeg, ybeg) --- */
+    double dx = x - xbeg;
+    double dy = y - ybeg;
+
+    *e = xbeg + dx * pc - dy * ps;
+    *n = ybeg + dx * ps + dy * pc;
+    *h = z;
+
+    /* --- translate --- */
+    *e += crgData->channelX.info.offset;
+    *n += crgData->channelY.info.offset;
+    *h += crgData->channelRefZ.info.offset;
+
+    return 1;
+}
+
+int
+crgEvalenh2xyz( int cpId, double e, double n, double h, double* x, double* y, double* z )
+{
+    const CrgContactPointStruct* cp;
+
+    if (!(cp = crgContactPointGetFromId(cpId)))
+        return 0;
+
+    return crgDataEvalenh2xyz(cp->crgData, e, n, h, x, y, z);
+}
+
+int
+crgDataEvalenh2xyz( const CrgDataStruct* crgData, double e, double n, double h, double* x, double* y, double* z )
+{
+    if (!crgData)
+        return 0;
+
+    double xbeg = crgData->channelX.info.first;
+    double ybeg = crgData->channelY.info.first;
+
+    double ps = crgData->util.phiOffSin;
+    double pc = crgData->util.phiOffCos;
+
+    /* --- translate --- */
+    *x = e - crgData->channelX.info.offset;
+    *y = n - crgData->channelY.info.offset;
+    *z = h - crgData->channelRefZ.info.offset;
+
+    /* --- rotate around(xbeg, ybeg) --- */
+    double dx = *x - xbeg;
+    double dy = *y - ybeg;
+    *x = xbeg + dx * pc + dy * ps;
+    *y = ybeg - dx * ps + dy * pc;
+
+    return 1;
+}