DtCoordinatePack.h

Go to the documentation of this file.

/******************************************************************************
** Copyright (c) 2023 MAK Technologies, Inc.
** All rights reserved.
******************************************************************************/

#pragma once
#include <vrvCore/vrvCore.h>

#include <math.h>

namespace makVrv
{
   class DT_DLL_VRVCORE DtCoordinatePack
   {
   public:

      static inline void pack(const double pos[3], float pospack[4])
      {
         double tmp[3];
         tmp[0] = floor(pos[0]);
         tmp[1] = floor(pos[1]);
         tmp[2] = floor(pos[2]);

         double frac = floor((pos[0] - tmp[0]) * 256.0) +
            (floor((pos[1] - tmp[1]) * 256.0) * 256.0) + 
            (floor((pos[2] - tmp[2]) * 256.0)) * 65536.0;

         pospack[0] = static_cast<float>(tmp[0]);
         pospack[1] = static_cast<float>(tmp[1]);
         pospack[2] = static_cast<float>(tmp[2]);
         pospack[3] = static_cast<float>(frac); 
      }

      static inline void unpack( const float pospack[4], double pos[3] )
      {  
          double frac = pospack[3];
          pos[2] = floor(frac / 65536.0);
          frac -= pos[2] * 65536.0;
          pos[2] /= 256.0;
          pos[2] += pospack[2];

          pos[1] = floor(frac / 256.0);
          frac -= pos[1] * 256.0;
          pos[1] /= 256.0;
          pos[1] += pospack[1];

          pos[0] = frac / 256.0;          
          pos[0] += pospack[0];
      }
   };
}