-- MachiningLib.lua by Egalware s.r.l. 2024/04/02
-- Libreria ricerca lavorazioni per Travi
-- 2024/04/02 PRIMA VERSIONE CALCOLO LAVORAZIONI CON STRATEGIE

-- Tabella per definizione modulo
local MachiningLib = {}

-- Include
require( 'EgtBase')

-- Carico i dati globali
local BeamData = require( 'BeamData')

EgtOutLog( ' MachiningLib started', 1)

---------------------------------------------------------------------
-- TODO da considerare solo angolo 2D??
local function GetToolEntryAngle( Proc, vtTool)
   local Angle = {}

   local dSinAngle = -10 * GEO.EPS_SMALL
   local vtNorm
   if Proc.AffectedFaces.bTop then
      vtNorm = Z_AX()
      dSinAngle = max( dSinAngle, vtTool * vtNorm)
   end
   if Proc.AffectedFaces.bBottom then
      vtNorm = -Z_AX()
      dSinAngle = max( dSinAngle, vtTool * vtNorm)
   end
   if Proc.AffectedFaces.bFront then
      vtNorm = -Y_AX()
      dSinAngle = max( dSinAngle, vtTool * vtNorm)
   end
   if Proc.AffectedFaces.bBack then
      vtNorm = Y_AX()
      dSinAngle = max( dSinAngle, vtTool * vtNorm)
   end
   if Proc.AffectedFaces.bLeft then
      vtNorm = -X_AX()
      dSinAngle = max( dSinAngle, vtTool * vtNorm)
   end
   if Proc.AffectedFaces.bRight then
      vtNorm = X_AX()
      dSinAngle = max( dSinAngle, vtTool * vtNorm)
   end

   local dCosAngle = sqrt( 1 - sqr( dSinAngle))
   local dAngle = acos( dCosAngle)
   local dTanAngle
   if dAngle ~= 0 and dAngle ~= 90 then
      dTanAngle = sqrt( 1 - dCosAngle * dCosAngle) / dCosAngle
   end

   Angle.dValue = dAngle
   Angle.dSin = dSinAngle
   Angle.dCos = dCosAngle
   Angle.dTan = dTanAngle

   return Angle
 end

-------------------------------------------------------------------------------------------------------------
function MachiningLib.GetMachiningSteps( dMachiningDepth, dStep)

   local MachiningSteps = {}
   MachiningSteps.StepLength = 0
   MachiningSteps.Count = ceil( ( dMachiningDepth - 10 * GEO.EPS_SMALL) / dStep)
   if MachiningSteps.Count > 1 then
      MachiningSteps.StepLength = ( dMachiningDepth - dStep) / ( MachiningSteps.Count - 1)
   end

   return MachiningSteps
end

 -------------------------------------------------------------------------------------------------------------
-- funzione per cercare utensile tipo FRESA con certe caratteristiche
function MachiningLib.FindMill( Proc, ToolSearchParameters)
   local ToolInfo = {}

   local nBestToolIndex
   local dBestToolResidualDepth = 0
   for i = 1, #TOOLS do
      -- prima verifico che utensile sia compatibile
      local bIsToolCompatible = true
      if TOOLS[i].sType ~= ToolSearchParameters.sType then
         bIsToolCompatible = false
      elseif TOOLS[i].dDiameter > ToolSearchParameters.dMaxToolDiameter then
         bIsToolCompatible = false
      elseif ToolSearchParameters.sMillShape == 'STANDARD' and  ( TOOLS[i].dSideAngle ~= 0 or TOOLS[i].bIsPen) then
         bIsToolCompatible = false
      elseif ToolSearchParameters.sMillShape == 'DOVETAIL' and  not TOOLS[i].bIsDoveTail then
         bIsToolCompatible = false
      elseif ToolSearchParameters.sMillShape == 'TSHAPEMILL' and  not TOOLS[i].bIsTMill then
         bIsToolCompatible = false
      elseif ToolSearchParameters.sMillShape == 'PEN' and  not TOOLS[i].bIsPen then
         bIsToolCompatible = false
      -- TODO controllare montaggio e verificare se direzione utensile raggiungibile. Serve funzione in BeamData
      end

      -- scelgo il migliore
      if bIsToolCompatible then
         -- calcolo riduzione del massimo materiale utilizzabile
         local ToolEntryAngle = GetToolEntryAngle( Proc, ToolSearchParameters.vtToolDir)
         -- se ToolHolder più grande dell'utensile, il primo oggetto in collisione è il ToolHolder. Altrimenti il motore.
         local dDimObjToCheck = EgtIf( TOOLS[i].ToolHolder.dDiameter > TOOLS[i].dDiameter, TOOLS[i].ToolHolder.dDiameter, BeamData.C_SIMM_ENC)
         local dCurrentMaxMatReduction = BeamData.COLL_SIC or 5

         -- TODO implementare le funzioni di Tool Collision Avoidance (vedi wiki e FacesBysaw -> CalcLeadInOutPerpGeom)
         -- TODO considerare anche il caso in cui lo stelo sia più grande del diametro utensile
         -- TODO nei confronti tra valori gestire tolleranze
         -- calcolo riduzione per non toccare con ToolHolder / Motore
         if ToolEntryAngle.dValue > 0 and ToolEntryAngle.dValue < 90  then
            dCurrentMaxMatReduction = dCurrentMaxMatReduction / ToolEntryAngle.dSin + ( ( dDimObjToCheck - TOOLS[i].dDiameter) / 2) / ToolEntryAngle.dTan
         end
         -- dCurrMachReduction = negativo -> limitare, positivo -> mm extra disponibili
         local dCurrentResidualDepth = ToolSearchParameters.dElevation + dCurrentMaxMatReduction - TOOLS[i].dMaxDepth

         -- se non ancora trovato, oppure se completo e il migliore fino ad ora non è completo: corrente è il migliore
         if not nBestToolIndex or ( dBestToolResidualDepth > 0 and dCurrentResidualDepth <= 0) then
            nBestToolIndex = i
            dBestToolResidualDepth = dCurrentResidualDepth
         -- altrimenti scelgo il migliore
         else
            -- se entrambi completi
            if dBestToolResidualDepth <= 0 and dCurrentResidualDepth <= 0 then
               -- scelgo utensile con rapporto lunghezza / diametro minore
               if ( TOOLS[i].dLength / pow( TOOLS[i].dDiameter, 1.5)) < ( TOOLS[nBestToolIndex].dLength / pow( TOOLS[nBestToolIndex].dDiameter, 1.5)) then
                  nBestToolIndex = i
                  dBestToolResidualDepth = dCurrentResidualDepth
               end
            -- se entrambi incompleti
            elseif dBestToolResidualDepth > 0 and dCurrentResidualDepth > 0 then
               --scelgo quello che lavora di più
               if dCurrentResidualDepth > dBestToolResidualDepth then
                  nBestToolIndex = i
                  dBestToolResidualDepth = dCurrentResidualDepth
               end
            end
         end
      end
   end

   ToolInfo.nToolIndex = nBestToolIndex
   ToolInfo.dResidualDepth = dBestToolResidualDepth

   return ToolInfo
end

-------------------------------------------------------------------------------------------------------------
-- funzione per cercare utensile tipo LAMA con certe caratteristiche
-- TODO da completare
function MachiningLib.FindBlade( Proc, ToolSearchParameters)
   local ToolInfo = {}

   -- parametri obbligatori
   if type( ToolSearchParameters.vtToolDirection) ~= 'table' then
      error( 'FindBlade : missing tool direction')
   end
   if type( ToolSearchParameters.bAllowTopHead) ~= 'boolean' then
      error( 'FindBlade : missing top head info')
   end
   if type( ToolSearchParameters.bAllowBottomHead) ~= 'boolean' then
      error( 'FindBlade : missing bottom head info')
   end
   if not ToolSearchParameters.bAllowTopHead and not ToolSearchParameters.bAllowBottomHead then
      error( 'FindBlade : wrong head info')
   end

   -- parametri opzionali
   ToolSearchParameters.dElevation = ToolSearchParameters.dElevation or 0
   ToolSearchParameters.bForceLongcutBlade = ToolSearchParameters.bForceLongcutBlade or false

   local nBestToolIndex
   for i = 1, #TOOLS do
      local bIsToolCompatible = true

      if ToolSearchParameters.bAllowTopHead and not ToolSearchParameters.bAllowBottomHead then
         bIsToolCompatible = TOOLS[i].bIsTopHead
      elseif ToolSearchParameters.bAllowBottomHead and not ToolSearchParameters.bAllowTopHead then
         bIsToolCompatible = TOOLS[i].bIsBottomHead
      end

      if bIsToolCompatible then
         nBestToolIndex = i
         break
      end
   end

   ToolInfo.nToolIndex = nBestToolIndex

   return ToolInfo
end

-------------------------------------------------------------------------------------------------------------
-- funzione per cercare utensile tipo PUNTA A FORARE con certe caratteristiche
-- TODO da fare
function MachiningLib.FindDrill()
end

-------------------------------------------------------------------------------------------------------------
-- funzione per cercare utensile tipo SEGA A CATENA con certe caratteristiche
-- TODO da completare
-- TODO implementare sorting in base a sSortingCriterion
function MachiningLib.FindChainSaw( Proc, ToolSearchParameters)
   local ToolInfo = {}

   -- parametri obbligatori
   if type( ToolSearchParameters.vtToolDirection) ~= 'table' then
      error( 'FindBlade : missing tool direction')
   end
   if type( ToolSearchParameters.bAllowTopHead) ~= 'boolean' then
      error( 'FindBlade : missing top head info')
   end
   if type( ToolSearchParameters.bAllowBottomHead) ~= 'boolean' then
      error( 'FindBlade : missing bottom head info')
   end
   if not ToolSearchParameters.bAllowTopHead and not ToolSearchParameters.bAllowBottomHead then
      error( 'FindBlade : wrong head info')
   end

   -- parametri opzionali
   ToolSearchParameters.dElevation = ToolSearchParameters.dElevation or 0
   ToolSearchParameters.bExtendWithCornerRadius = ToolSearchParameters.bExtendWithCornerRadius or false
   ToolSearchParameters.sSortingCriterion = ToolSearchParameters.sSortingCriterion or 'Standard'

   local nBestToolIndex
   local dBestToolResidualDepth = 0
   for i = 1, #TOOLS do
      local bIsToolCompatible = true

      if ToolSearchParameters.bAllowTopHead and not ToolSearchParameters.bAllowBottomHead then
         bIsToolCompatible = TOOLS[i].bIsTopHead
      elseif ToolSearchParameters.bAllowBottomHead and not ToolSearchParameters.bAllowTopHead then
         bIsToolCompatible = TOOLS[i].bIsBottomHead
      end

      -- TODO nei confronti tra valori gestire tolleranze
      if bIsToolCompatible then
         if ToolSearchParameters.dElevation > 10 * GEO.EPS_SMALL and ToolSearchParameters.bExtendWithCornerRadius then
            ToolSearchParameters.dElevation = ToolSearchParameters.dElevation + TOOLS[i].dCornerRadius
         end
         -- TODO gestire accorciamento massimo materiale per inclinazione
         local dCurrentResidualDepth = ToolSearchParameters.dElevation - TOOLS[i].dMaxDepth
         -- se non ancora trovato, oppure se completo e il migliore fino ad ora non è completo: corrente è il migliore
         if not nBestToolIndex or ( dBestToolResidualDepth > 0 and dCurrentResidualDepth <= 0) then
            nBestToolIndex = i
            dBestToolResidualDepth = dCurrentResidualDepth
         -- altrimenti scelgo il migliore
         else
            -- se entrambi completi
            if dBestToolResidualDepth <= 0 and dCurrentResidualDepth <= 0 then
               -- scelgo utensile con rapporto lunghezza / diametro minore
               if ( TOOLS[i].dLength / pow( TOOLS[i].dDiameter, 1.5)) < ( TOOLS[nBestToolIndex].dLength / pow( TOOLS[nBestToolIndex].dDiameter, 1.5)) then
                  nBestToolIndex = i
                  dBestToolResidualDepth = dCurrentResidualDepth
               end
            -- se entrambi incompleti
         elseif dBestToolResidualDepth > 0 and dCurrentResidualDepth > 0 then
               --scelgo quello che lavora di più
               if dCurrentResidualDepth > dBestToolResidualDepth then
                  nBestToolIndex = i
                  dBestToolResidualDepth = dCurrentResidualDepth
               end
            end
         end
      end
   end

   ToolInfo.nToolIndex = nBestToolIndex

   return ToolInfo
end

-------------------------------------------------------------------------------------------------------------
-- funzione per aggiungere una nuova lavorazione
-- TODO da fare
function MachiningLib.AddNewMachining( Machining)
end

-------------------------------------------------------------------------------------------------------------
return MachiningLib