-- CalcToolPath.lua by Egaltech s.r.l. 2022/03/29
-- Calcolo percorsi di lavoro per Stampa 3d

-- Tabella per definizione modulo
local CalcToolPath = {}

-- Intestazioni
require( 'EgtBase')

EgtOutLog( ' CalcToolPath started', 1)

-- Dati
local AMD = require( 'AddManData')

---------------------------------------------------------------------
local function GetLayerParamsForToolPathCalc()
   local nParamsGrp = EgtGetFirstNameInGroup( GDB_ID.ROOT, PARAMS_GRP)
   local LayerParams = {}     
   LayerParams.dLayHeight = EgtGetInfo( nParamsGrp, KEY_SLICE_STEP, 'd')
   LayerParams.bInvert = EgtGetInfo( nParamsGrp, KEY_PRINT_DIRECTION, 'b')
   LayerParams.nOrder = EgtGetInfo( nParamsGrp, KEY_PRINT_ORDER, 'i')
   LayerParams.LinkType = EgtGetInfo( nParamsGrp, KEY_LINK_TYPE, 'i')
   LayerParams.LinkParam = EgtGetInfo( nParamsGrp, KEY_LINK_PARAM, 'd')
   return LayerParams 
end

---------------------------------------------------------------------
function CalcToolPath.Exec( nPartId)

   -- Verifico il pezzo
   if not nPartId then
      EgtOutBox( 'Error missing part', 'ToolPathCalc')
      return 
   end

   -- Recupero i layer da processare
   local vLayIds = EgtGetNameInGroup( nPartId, SLICE_LAYER.."*") 
   if not vLayIds then
      EgtOutBox( 'Error missing slices', 'ToolPathCalc')
      return 
   end

   -- Ciclo sui layer
   for nIdx = 1, #vLayIds do
      -- recupero i parametri relativi al layer
      local LayerParams = GetLayerParamsForToolPathCalc()
      -- scorro tutti i gruppi di contorni
      local nCrvGrpId = EgtGetFirstNameInGroup( vLayIds[ nIdx], CONTOUR_GRP.."*")
      while nCrvGrpId do
         -- recupero il gruppo dei percorsi
         local nPathGrpId = EgtGetFirstNameInGroup( nCrvGrpId, PATH_GRP)
         if not nPathGrpId then
            EgtOutBox( 'Error missing paths', 'ToolPathCalc')
            return 
         else
            EgtSetStatus( nPathGrpId, GDB_ST.OFF)
         end         
         -- recupero il gruppo dei percorsi utensile
         local nTpathGrpId = EgtGetFirstNameInGroup( nCrvGrpId, TOOLPATH_GRP)
         if not nTpathGrpId then
            nTpathGrpId = EgtGroup( nCrvGrpId)
            EgtSetName( nTpathGrpId, TOOLPATH_GRP)
         else
            EgtEmptyGroup( nTpathGrpId)
         end
         -- creo il percorso di lavoro :
         -- copio le curve, le ordino, le oriento e le muovo in Z
         local nEntId = EgtGetFirstInGroup( nPathGrpId)
         while nEntId do
            local nNewEntId = EgtCopyGlob( nEntId, nTpathGrpId, EgtIf( LayerParams.nOrder == PRINT_ORDER.INT_EXT_INF, GDB_IN.FIRST_SON, GDB_IN.LAST_SON))
            EgtMove( nNewEntId, Vector3d( 0, 0, LayerParams.dLayHeight), GDB_RT.GLOB)
            if LayerParams.bInvert then
               EgtInvertCurve( nNewEntId)
            end
            nEntId = EgtGetNext( nEntId)
         end
         -- aggiungo gli opportuni raccordi
         local nPrevId = EgtGetFirstInGroup( nTpathGrpId)
         local nCurrId = EgtGetNext( nPrevId or GDB_ID.NULL)
         while nCurrId do            
            local nLinkId
            if LayerParams.LinkType == LINK_TYPE.LINEAR then  
               nLinkId = EgtLine( nTpathGrpId, EgtEP( nPrevId), EgtSP( nCurrId))
            else
               EgtTrimCurveEndAtLen( nPrevId, EgtCurveLength( nPrevId) - LayerParams.LinkParam / 2)
               EgtTrimCurveStartAtLen( nCurrId, LayerParams.LinkParam / 2)
               local _, _, dAngIni = SphericalFromVector( EgtEV( nPrevId))
               local _, _, dAngFin = SphericalFromVector( EgtSV( nCurrId))
               nLinkId = EgtBiArc( nTpathGrpId, EgtEP( nPrevId), EgtSP( nCurrId), dAngIni, dAngFin, 0.5)
            end
            EgtRelocate( nLinkId, nCurrId, GDB_IN.BEFORE)
            local nType = EgtGetInfo( nCurrId, KEY_TYPE, 'i')
            EgtSetInfo( nLinkId, KEY_TYPE, TYPE.LINK)
            nPrevId = nCurrId
            nCurrId = EgtGetNext( nCurrId)
         end
         
         --passo al gruppo di contorni successivo
         nCrvGrpId = EgtGetNextName( nCrvGrpId, CONTOUR_GRP.."*")
      end
   end
end

---------------------------------------------------------------------
return CalcToolPath