Corretto disegno porta utensile

- Nuovo porta-utensile

.gitignore

@@ -1,6 +1,7 @@
 /Tools
 /Machinings
 /SetUp
+/Beam/AISetup
 /Beam/Ts3Data.bak
 /Beam/CutData.lua
 /Beam/DrillData.lua

Beam/BeamData.lua

@@ -76,6 +76,7 @@ local BeamData = {
    PRECUT_TAIL = true,                      -- flag abilitazione pretaglio grezzo a zero in coda
    MIN_HEIGHT_ADDED_CUTS = 400,             -- altezza minima pezzo per effettuare tagli orizzontali aggiuntivi in testa e coda
    GAIN_RECLAMPING = 1000,                  -- in caso di scarso pinzaggio, mm da recuperare con pinzaggio ulteriore prima di spostare
+   NEWTOPC = true,
    STRATEGIES_SCRIPT = 'Essetre',
    STRATEGIES_CONFIG_FILE = 'Std1.json'
 }
@@ -117,6 +118,8 @@ if EgtExistsFile( sData) then
          if Machine.Offsets.FASTCLAMPING ~= nil then BeamData.FASTCLAMPING = ( Machine.Offsets.FASTCLAMPING == 1) end
          if Machine.Offsets.ROT90 ~= nil then BeamData.ROT90 = ( Machine.Offsets.ROT90 == 1) end
          if Machine.Offsets.ROT180 ~= nil then BeamData.ROT180 = ( Machine.Offsets.ROT180 == 1) end
+         if Machine.Offsets.CUT_SIC then BeamData.CUT_SIC = EgtClamp( Machine.Offsets.CUT_SIC, 15, 50) end
+         if Machine.Offsets.NEWTOPC then BeamData.NEWTOPC = ( Machine.Offsets.NEWTOPC == 1) end
       end
       if Machine.Trave then
          BeamData.MIN_WIDTH = Machine.Trave.XMIN or BeamData.MIN_WIDTH
@@ -190,69 +193,107 @@ end
 BeamData.GetChainSawInitAngs = GetChainSawInitAngs
 
 ---------------------------------------------------------------------
-local function GetMinNzTopHead( vtNFace)
-   if vtNFace and abs( vtNFace:getY()) > 0.8659 then
-      return -0.2499
+local function GetSCC( vtToolDirection, vtEdgeDirection, vtNFace)
+   local nSCC = MCH_SCC.NONE
+
+   if abs( vtToolDirection:getX()) > abs( vtToolDirection:getY()) - GEO.EPS_SMALL then
+      -- se il taglio è orizzontale, si gira aggregato lama per facilitare caduta del legno
+      if abs( vtEdgeDirection:getZ()) < 10 * GEO.EPS_SMALL and not AreSameOrOppositeVectorApprox( vtNFace, Z_AX()) then
+         nSCC = EgtIf( ( vtToolDirection:getX() > -GEO.EPS_SMALL), MCH_SCC.ADIR_XM, MCH_SCC.ADIR_XP)
+      else
+         nSCC = EgtIf( ( vtToolDirection:getX() > -GEO.EPS_SMALL), MCH_SCC.ADIR_XP, MCH_SCC.ADIR_XM)
+      end
    else
-      return sin( -45)
+      -- se il taglio è orizzontale, si gira aggregato lama per facilitare caduta del legno
+      if abs( vtEdgeDirection:getZ()) < 10 * GEO.EPS_SMALL and not AreSameOrOppositeVectorApprox( vtNFace, Z_AX()) then
+         nSCC = EgtIf( ( vtToolDirection:getY() > -GEO.EPS_SMALL), MCH_SCC.ADIR_YM, MCH_SCC.ADIR_YP)
+      else
+         nSCC = EgtIf( ( vtToolDirection:getY() > -GEO.EPS_SMALL), MCH_SCC.ADIR_YP, MCH_SCC.ADIR_YM)
+      end
    end
+
+   return nSCC
 end
 
 ---------------------------------------------------------------------
-local function GetMinNzDownUp( b3Raw, vtNFace, vtToolDirection)
-   if vtToolDirection and vtToolDirection:getZ() > 0.35 then
-      -- N_HorAng < 15° or N_HorAng > 55°
-      if vtNFace and ( abs( vtNFace:getY()) < 0.259 or abs( vtNFace:getY()) > 0.819) then
-         return -0.708
-      -- N_HorAng > 50°
-      elseif vtNFace and abs( vtNFace:getY()) > 0.766 then
-         return -0.383
-      else
-         return EgtIf( b3Raw:getDimZ() < BeamData.MIN_DIM_HBEAM, -0.609, -0.383)
-      end
-   elseif vtToolDirection and vtToolDirection:getZ() < - 0.01
-          and ( vtNFace and ( abs( vtNFace:getY()) > 0.983))
-          and ( b3Raw:getDimY() < 210) then
-          
-          return -0.173
-   else
-      -- N_HorAng > 60°
-      if vtNFace and ( abs( vtNFace:getY()) > 0.866) then
-         return -0.708
-      else
-         if b3Raw:getDimZ() < 120 then
-            return -0.708
-         elseif b3Raw:getDimZ() < 200 then
-            -- N_HorAng < 15° or N_HorAng > 55°
-            if vtNFace and ( abs( vtNFace:getY()) < 0.259 or abs( vtNFace:getY()) > 0.819) then
-               return -0.5
-            else
-               return -0.383
-            end
-         elseif b3Raw:getDimZ() < 300 then
-            -- N_HorAng < 10°
-            if vtNFace and ( abs( vtNFace:getY()) < 0.174) then
-               return -0.5
-            else
-               return -0.259
-            end
-         elseif b3Raw:getDimZ() < BeamData.MIN_DIM_HBEAM then
-            -- N_HorAng < 10°
-            if vtNFace and ( abs( vtNFace:getY()) < 0.174) then
-               return -0.342
-            else
-               return -0.259
-            end
-         else
-            -- N_HorAng < 10°
-            if vtNFace and ( abs( vtNFace:getY()) < 0.174) then
-               return -0.383
-            else
-               return -0.188
-            end
-         end
-      end
+-- sAxis può essere AB, C, Z; restituisce direzioni, profondità di estrusione e punti per il controllo precollisione
+local function GetPreCollisionData( sAxis, vtC, vtHead)
+
+   local PreCollisionData = {}
+
+   -- Pivot uguale per tutti; non c'è aggregato quindi non dipende da SCC
+   -- riferimento vtPivot
+--    - vtHead (Z): asse rotazione utensile, guarda il mandrino
+--    - vtToolSCC (X): direzione asse C o aggregato
+--    - vtEdge (Y): direzione lato, verso in base a X e Z
+--    - punto di applicazione: naso mandrino o aggregato
+   PreCollisionData.vtMovePivot = Vector3d( 0, 0, 242.55)
+
+   -- carro Z
+   if sAxis == 'Z' then
+
+      PreCollisionData.Directions = { vtDirectionX = X_AX(), vtDirectionY = Z_AX(), vtDirectionZ = -Y_AX()}
+      PreCollisionData.bSurfTmByRevolve = true
+      PreCollisionData.Points = {
+         Point3d( 0, 523, 0),
+         Point3d( 109.556, 523, 0),
+         Point3d( 109.556, 583, 0),
+         Point3d( 143.113, 583, 0),
+         Point3d( 143.113, 2533, 0),
+         Point3d( 0, 2533, 0)
+      }
+
+   -- motore (asse A o B)
+   elseif sAxis == 'AB' then
+
+      PreCollisionData.Directions = { vtDirectionX = vtC, vtDirectionY = -vtHead, vtDirectionZ = vtC ^ -vtHead}
+      PreCollisionData.dExtrusionDepth = 180
+      PreCollisionData.Points = {
+         Point3d( 100,-122,0),
+         Point3d( 100, -232.5, 0),
+         Point3d( -90, -232.5, 0),
+         Point3d( -90, 204.505, 0),
+         Point3d( -77.5, 216.55, 0),
+         Point3d( -89, 234.05, 0),
+         Point3d( -89, 242.55, 0),
+         Point3d( 89, 242.55, 0),
+         Point3d( 89, 234.05, 0),
+         Point3d( 77.5, 216.55, 0),
+         Point3d( 90, 204.505, 0),
+         Point3d( 90, 93, 0),
+         Point3d( 125, 93, 0),
+         Point3d( 125, -122, 0),
+         Point3d( 100, -122, 0)
+      }
+
+   -- asse C
+   elseif sAxis == 'C' then
+
+      PreCollisionData.Directions = { vtDirectionX = vtC, vtDirectionY = Z_AX(), vtDirectionZ = vtC ^ Z_AX()}
+      PreCollisionData.dExtrusionDepth = 200
+      PreCollisionData.Points = {
+         Point3d( 125, -92.752, 0),
+         Point3d( 203.5, -92.752, 0),
+         Point3d( 203.5, -100, 0),
+         Point3d( 400, -100, 0),
+         Point3d( 450, -50, 0),
+         Point3d( 450, 400, 0),
+         Point3d( 360, 490, 0),
+         Point3d( 170, 490, 0),
+         Point3d( 170, 523, 0),
+         Point3d( EgtIf( BeamData.NEWTOPC, -110, -175), 523, 0),
+         Point3d( EgtIf( BeamData.NEWTOPC, -110, -175), 400, 0),
+         Point3d( 230.858, 400, 0),
+         Point3d( 325, 305.858, 0),
+         Point3d( 325, 146, 0),
+         Point3d( 203.5, 146, 0),
+         Point3d( 203.5, 93, 0),
+         Point3d( 125, 93, 0),
+         Point3d( 125, -92.752, 0)
+      }
    end
+
+   return PreCollisionData
 end
 
 ---------------------------------------------------------------------
@@ -263,20 +304,23 @@ local function GetSetupInfo( sHead)
    SetupInfo.bIsCSymmetrical = false
    SetupInfo.dCAxisEncumbrance = 180
    SetupInfo.dCAxisSideEncumbrance = 200
-   SetupInfo.dPivot = 175
+   SetupInfo.dPivot = 175 -- per uscita fresa, diverso da uscita lama
    SetupInfo.bToolOnAggregate = false
+   SetupInfo.vtRotationAxisC = Z_AX()
+   SetupInfo.vtRotationAxisAB = X_AX()
 
    -- testa 5 assi da sopra
    if sHead == 'H1' then
       SetupInfo.HeadType = { bTop = true, bBottom = false}
       SetupInfo.PreferredSide = {}
-      SetupInfo.GetMinNz = GetMinNzTopHead
+      SetupInfo.GetMinNz = function() return sin( -45) end
    -- lama su testa 5 assi da sopra
    elseif sHead == 'H2' then
       SetupInfo.HeadType = { bTop = true, bBottom = false}
       SetupInfo.PreferredSide = {}
-      SetupInfo.GetMinNz = GetMinNzTopHead
-      SetupInfo.GetMinNzDownUp = GetMinNzDownUp
+      SetupInfo.GetMinNz = function() return sin( -45) end
+      SetupInfo.GetPreCollisionData = GetPreCollisionData
+      SetupInfo.GetSCC = GetSCC
    -- motosega
    elseif sHead == 'H3' then
       SetupInfo.HeadType = { bTop = true, bBottom = false}

Beam/BeamDataNew.lua

@@ -0,0 +1,302 @@
+-- BeamData.lua by Egalware s.r.l. 2025/12/03
+-- Raccolta dati generali per Travi
+
+EgtOutLog( ' FAST-BeamData started', 1)
+
+-- Tabella per definizione modulo
+local BeamData = {
+   RIGHT_LOAD = false,                      -- flag carico da destra
+   ROT90 = false,                           -- flag abilitazione rotazione 90 gradi
+   ROT180 = true,                           -- flag abilitazione rotazione 180 gradi
+   MIN_WIDTH = 40,                          -- larghezza minima del grezzo
+   MIN_HEIGHT = 40,                         -- altezza minima del grezzo
+   MAX_WIDTH = 240,                         -- larghezza massima del grezzo
+   MAX_HEIGHT = 625,                        -- altezza massima del grezzo
+   MAX_WIDTH2 = 305,                        -- seconda larghezza massima del grezzo
+   MAX_HEIGHT2 = 625,                       -- altezza massima per seconda larghezza massima del grezzo
+   LEN_SHORT_PART = 1200,                   -- RENAME lunghezza massima pezzo corto
+   LEN_VERY_SHORT_PART = 400,               -- RENAME lunghezza massima pezzo molto corto (molto probabile lo scarico a caduta)
+   MAX_RAW = 30000,                         -- massima lunghezza grezzo (deve essere minore di LenTable - RAW_OFFSET)
+   STD_RAW = 14000,                         -- lunghezza standard della barra di grezzo
+   OVM_HEAD = 10,                           -- sovramateriale testa
+   OVM_MID = 5.4,                           -- sovramateriale intermedio (spessore lama)
+   MINRAW_S = 750,                          -- minimo grezzo in coda scaricabile per sezioni piccole
+   MINRAW_L = 1070,                         -- minimo grezzo in coda scaricabile per sezioni grandi
+   MAX_DIM_HTCUT = 200,                     -- SOLO DICE larghezza massima taglio di testa o coda
+   MIN_DIM_HBEAM = 380,                     -- SOLO DICE altezza minima di trave alta
+   MAX_DIM_DICE = 155,                      -- dimensione trasversale massima cubetto
+   MAX_LEN_DICE = 400,                      -- SOLO DICE lunghezza massima cubetto
+   COLL_SIC = 5,                            -- distanza di sicurezza per collisioni
+   CUT_SIC = 20,                            -- distanza di sicurezza per tagli
+   CUT_EXTRA = 5,                           -- affondamento extra standard per tagli di lama e fresature
+   CUT_EXTRA_MIN = 1,                       -- affondamento extra ridotto per tagli di lama e fresature
+   MILL_OVERLAP = 5,                        -- sovrapposizione tra due mezze fresature
+   LONGCUT_ENDLEN = 600,                    -- RENAME??lunghezza lavoro estremi iniziale e finale (std=600)
+   LONGCUT_MAXLEN = 1200,                   -- RENAME??lunghezza massima sezione di taglio longitudinale
+   DIM_STRIP = -1,                          -- dimensione codolo sostegno parti lasciate su contorno libero o archi (-1 = da Q...)
+   DIM_STRIP_SMALL = 1,                     -- dimensione codolo piccolo (quando le parti sostenute sono sicuramente sulla parte sopra del pezzo)
+   RAWCOL = { 255, 160, 32, 30},            -- colore del grezzo
+   RAW_OFFSET = 2000,                       -- spostamento grezzo rimanente dopo split
+   VICE_MINH = 110,                         -- altezza minima della morsa
+   VICE_MAXH = 370,                         -- altezza massima zona pinzaggio orizzontale
+   USER_HOLE_DIAM = 0,                      -- diametro foro per L20
+   STRATEGIES_SCRIPT = 'Essetre',
+   STRATEGIES_CONFIG_FILE = 'Std1.json'
+}
+
+-- costanti riportate da mlde non necessarie per automatismo (sostituire con GetParameters o simile)
+local MldeParameters = {}
+MldeParameters.NumericalControl = 'TPA'                                      -- NUM o TPA o NUM_PLUS
+MldeParameters.MinX = 0
+MldeParameters.MaxX = 1350
+MldeParameters.MinZ = -1350
+MldeParameters.MaxZ = 0
+MldeParameters.MillOffs = 177.35
+MldeParameters.SawOffs = -242.68
+MldeParameters.DeltaTabY = 898.0
+MldeParameters.DeltaTabZ = -1017.8 + MldeParameters.MillOffs                 -- per TPA : -1013.3 + MillOffs    -- per NUM : -838.4
+MldeParameters.NewTopC = true
+
+-- Aggiornamento con dati macchina personalizzati
+-- TODO sostituire con GetParameters o simile
+local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-Fast.data"
+local sData = EgtGetCurrMachineDir().."\\Beam\\Ts3Data.lua"
+if EgtExistsFile( sTs3Data) then
+   EgtCopyFile( sTs3Data, sData)
+   local sTs3DataOld = sTs3Data..'.old'
+   EgtEraseFile( sTs3DataOld)
+   EgtRenameFile( sTs3Data, sTs3DataOld)
+end
+if EgtExistsFile( sData) then
+   local Machine = dofile( sData)
+   if Machine then
+      if Machine.Offsets then
+         if Machine.Offsets.TIPO_CN == 0 then
+            MldeParameters.NumericalControl =  'NUM'
+         elseif Machine.Offsets.TIPO_CN == 2 then
+            MldeParameters.NumericalControl =  'NUM_PLUS'
+         else
+            MldeParameters.NumericalControl = 'TPA'
+         end
+         if Machine.Offsets.MAX_X then MldeParameters.MinX = - Machine.Offsets.MAX_X end
+         if Machine.Offsets.MIN_X then MldeParameters.MaxX = - Machine.Offsets.MIN_X end
+         if Machine.Offsets.MIN_Z then MldeParameters.MinZ = Machine.Offsets.MIN_Z end
+         if Machine.Offsets.MAX_Z then MldeParameters.MaxZ = Machine.Offsets.MAX_Z end
+         if Machine.Offsets.PIVOTFRESA then MldeParameters.MillOffs = - Machine.Offsets.PIVOTFRESA end
+         if Machine.Offsets.PIVOTLAMA then MldeParameters.SawOffs = - Machine.Offsets.PIVOTLAMA end
+         if Machine.Offsets.OFFSETX then MldeParameters.DeltaTabY = - Machine.Offsets.OFFSETX end
+         if Machine.Offsets.OFFSETZ then MldeParameters.DeltaTabZ = Machine.Offsets.OFFSETZ + EgtIf( MldeParameters.NumericalControl == 'TPA', MldeParameters.MillOffs, 0) end
+         if Machine.Offsets.NEWTOPC then MldeParameters.NewTopC = ( Machine.Offsets.NEWTOPC == 1) end
+         BeamData.MINRAW_S = max( BeamData.MINRAW_S, Machine.Offsets.MINRAW_S or BeamData.MINRAW_S)
+         BeamData.MINRAW_L = max( BeamData.MINRAW_L, Machine.Offsets.MINRAW_L or BeamData.MINRAW_L)
+         BeamData.CUT_EXTRA = Machine.Offsets.CUT_EXTRA or BeamData.CUT_EXTRA
+         BeamData.CUT_EXTRA_MIN = Machine.Offsets.CUT_EXTRA_MIN or BeamData.CUT_EXTRA_MIN
+         BeamData.DIM_STRIP_SMALL = Machine.Offsets.DIM_STRIP_SMALL or BeamData.DIM_STRIP_SMALL
+         BeamData.LONGCUT_ENDLEN = Machine.Offsets.LONGCUT_ENDLEN or BeamData.LONGCUT_ENDLEN
+         BeamData.LONGCUT_MAXLEN = Machine.Offsets.LONGCUT_MAXLEN or BeamData.LONGCUT_MAXLEN
+         BeamData.LEN_VERY_SHORT_PART = Machine.Offsets.LEN_VERY_SHORT_PART or BeamData.LEN_VERY_SHORT_PART
+         BeamData.LEN_SHORT_PART = Machine.Offsets.LEN_SHORT_PART or BeamData.LEN_SHORT_PART
+         BeamData.MAX_HEIGHT2 = Machine.Offsets.MAX_HEIGHT2 or BeamData.MAX_HEIGHT2
+         BeamData.OVM_MID = Machine.Offsets.OVM_MID or BeamData.OVM_MID
+         if Machine.Offsets.ROT90 ~= nil then BeamData.ROT90 = ( Machine.Offsets.ROT90 == 1) end
+         if Machine.Offsets.ROT180 ~= nil then BeamData.ROT180 = ( Machine.Offsets.ROT180 == 1) end
+         if Machine.Offsets.CUT_SIC then BeamData.CUT_SIC = EgtClamp( Machine.Offsets.CUT_SIC, 15, 50) end
+      end
+      if Machine.Trave then
+         BeamData.MIN_WIDTH = Machine.Trave.XMIN or BeamData.MIN_WIDTH
+         BeamData.MIN_HEIGHT = Machine.Trave.ZMIN or BeamData.MIN_HEIGHT
+         BeamData.MAX_WIDTH = Machine.Trave.XMAX or BeamData.MAX_WIDTH
+         BeamData.MAX_HEIGHT = Machine.Trave.ZMAX or BeamData.MAX_HEIGHT
+      end
+      if Machine.User then
+         BeamData.USER_HOLE_DIAM = Machine.User.L020_DIAM_HOLE or BeamData.USER_HOLE_DIAM
+      end
+   end
+end
+
+---------------------------------------------------------------------
+local function GetBlockedAxis( sHead, nToolType, sBlockedAxis)
+   -- lama
+   if nToolType == MCH_TY.SAW_STD or nToolType == MCH_TY.SAW_FLAT then
+      return ''
+   -- sega a catena
+   elseif nToolType == MCH_TY.MORTISE_STD then
+      if sHead == 'H3' then
+         if sBlockedAxis == 'parallel' then
+            return 'A=0'
+         elseif sBlockedAxis == 'perpendicular' then
+            return 'A=90'
+         end
+      else
+         return ''
+      end
+   -- fresa
+   elseif nToolType == MCH_TY.MILL_STD or nToolType == MCH_TY.MILL_NOTIP then
+      return ''
+   -- punta
+   elseif nToolType == MCH_TY.DRILL_STD or nToolType == MCH_TY.DRILL_LONG then
+      return ''
+   else
+      return ''
+   end
+end
+BeamData.GetBlockedAxis = GetBlockedAxis
+
+---------------------------------------------------------------------
+local function GetChainSawInitAngs( vtN, vtO, nInd)
+   if nInd == 1 then
+      return ''
+   else
+      return EgtIf( vtN:getY() > 0, 'C=180', 'C=-180')
+   end
+end
+BeamData.GetChainSawInitAngs = GetChainSawInitAngs
+
+---------------------------------------------------------------------
+local function GetSCC( vtToolDirection, vtEdgeDirection, vtNFace)
+   local nSCC = MCH_SCC.NONE
+
+   if abs( vtToolDirection:getX()) > abs( vtToolDirection:getY()) - GEO.EPS_SMALL then
+      -- se il taglio è orizzontale, si gira aggregato lama per facilitare caduta del legno
+      if abs( vtEdgeDirection:getZ()) < 10 * GEO.EPS_SMALL and not AreSameOrOppositeVectorApprox( vtNFace, Z_AX()) then
+         nSCC = EgtIf( ( vtToolDirection:getX() > -GEO.EPS_SMALL), MCH_SCC.ADIR_XM, MCH_SCC.ADIR_XP)
+      else
+         nSCC = EgtIf( ( vtToolDirection:getX() > -GEO.EPS_SMALL), MCH_SCC.ADIR_XP, MCH_SCC.ADIR_XM)
+      end
+   else
+      -- se il taglio è orizzontale, si gira aggregato lama per facilitare caduta del legno
+      if abs( vtEdgeDirection:getZ()) < 10 * GEO.EPS_SMALL and not AreSameOrOppositeVectorApprox( vtNFace, Z_AX()) then
+         nSCC = EgtIf( ( vtToolDirection:getY() > -GEO.EPS_SMALL), MCH_SCC.ADIR_YM, MCH_SCC.ADIR_YP)
+      else
+         nSCC = EgtIf( ( vtToolDirection:getY() > -GEO.EPS_SMALL), MCH_SCC.ADIR_YP, MCH_SCC.ADIR_YM)
+      end
+   end
+
+   return nSCC
+end
+
+---------------------------------------------------------------------
+-- sAxis può essere AB, C, Z; restituisce direzioni, profondità di estrusione e punti per il controllo precollisione
+local function GetPreCollisionData( sAxis, vtC, vtHead)
+
+   local PreCollisionData = {}
+
+   -- Pivot uguale per tutti; non c'è aggregato quindi non dipende da SCC
+   -- riferimento vtPivot
+--    - vtHead (Z): asse rotazione utensile, guarda il mandrino
+--    - vtToolSCC (X): direzione asse C o aggregato
+--    - vtEdge (Y): direzione lato, verso in base a X e Z
+--    - punto di applicazione: naso mandrino o aggregato
+   PreCollisionData.vtMovePivot = Vector3d( 0, 0, -MldeParameters.SawOffs)
+
+   -- carro Z
+   if sAxis == 'Z' then
+
+      PreCollisionData.Directions = { vtDirectionX = X_AX(), vtDirectionY = Z_AX(), vtDirectionZ = -Y_AX()}
+      PreCollisionData.bSurfTmByRevolve = true
+      PreCollisionData.Points = {
+         Point3d( 0, 523, 0),
+         Point3d( 109.556, 523, 0),
+         Point3d( 109.556, 583, 0),
+         Point3d( 143.113, 583, 0),
+         Point3d( 143.113, 2533, 0),
+         Point3d( 0, 2533, 0)
+      }
+
+   -- motore (asse A o B)
+   elseif sAxis == 'AB' then
+
+      PreCollisionData.Directions = { vtDirectionX = vtC, vtDirectionY = -vtHead, vtDirectionZ = vtC ^ -vtHead}
+      PreCollisionData.dExtrusionDepth = 180
+      PreCollisionData.Points = {
+         Point3d( 100,-122,0),
+         Point3d( 100, -232.5, 0),
+         Point3d( -90, -232.5, 0),
+         Point3d( -90, 204.505, 0),
+         Point3d( -77.5, 216.55, 0),
+         Point3d( -89, 234.05, 0),
+         Point3d( -89, 242.55, 0),
+         Point3d( 89, 242.55, 0),
+         Point3d( 89, 234.05, 0),
+         Point3d( 77.5, 216.55, 0),
+         Point3d( 90, 204.505, 0),
+         Point3d( 90, 93, 0),
+         Point3d( 125, 93, 0),
+         Point3d( 125, -122, 0),
+         Point3d( 100, -122, 0)
+      }
+
+   -- asse C
+   elseif sAxis == 'C' then
+
+      PreCollisionData.Directions = { vtDirectionX = vtC, vtDirectionY = Z_AX(), vtDirectionZ = vtC ^ Z_AX()}
+      PreCollisionData.dExtrusionDepth = 200
+      PreCollisionData.Points = {
+         Point3d( 125, -92.752, 0),
+         Point3d( 203.5, -92.752, 0),
+         Point3d( 203.5, -100, 0),
+         Point3d( 400, -100, 0),
+         Point3d( 450, -50, 0),
+         Point3d( 450, 400, 0),
+         Point3d( 360, 490, 0),
+         Point3d( 170, 490, 0),
+         Point3d( 170, 523, 0),
+         Point3d( EgtIf( MldeParameters.NewTopC, -110, -175), 523, 0),
+         Point3d( EgtIf( MldeParameters.NewTopC, -110, -175), 400, 0),
+         Point3d( 230.858, 400, 0),
+         Point3d( 325, 305.858, 0),
+         Point3d( 325, 146, 0),
+         Point3d( 203.5, 146, 0),
+         Point3d( 203.5, 93, 0),
+         Point3d( 125, 93, 0),
+         Point3d( 125, -92.752, 0)
+      }
+   end
+
+   return PreCollisionData
+end
+
+---------------------------------------------------------------------
+local function GetSetupInfo( sHead)
+   local SetupInfo = {}
+
+   -- dati comuni
+   SetupInfo.bIsCSymmetrical = false
+   SetupInfo.dCAxisEncumbrance = 180
+   SetupInfo.dCAxisSideEncumbrance = 200
+   SetupInfo.bToolOnAggregate = false
+   SetupInfo.vtRotationAxisC = EgtGetAxisDir( 'C')
+   SetupInfo.vtRotationAxisAB = EgtGetAxisDir( 'B')
+
+   -- testa 5 assi da sopra
+   if sHead == 'H1' then
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.dPivot = MldeParameters.MillOffs -- per uscita fresa, diverso da uscita lama
+      SetupInfo.GetMinNz = function() return sin( -45) end
+   -- lama su testa 5 assi da sopra
+   elseif sHead == 'H2' then
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMinNz = function() return sin( -45) end
+      SetupInfo.GetPreCollisionData = GetPreCollisionData
+      SetupInfo.GetSCC = GetSCC
+   -- motosega
+   elseif sHead == 'H3' then
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMinNz = function() return 0 end
+   -- rinvio angolare 90° (considerato come fosse una testa da sotto)
+   elseif sHead == 'H5' then
+      SetupInfo.bToolOnAggregate = true
+      SetupInfo.HeadType = { bTop = false, bBottom = true}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMaxNz = function() return 0 end
+   end
+
+   return SetupInfo
+end
+BeamData.GetSetupInfo = GetSetupInfo
+
+---------------------------------------------------------------------
+return BeamData

Beam/MachiningTypes.ini

@@ -32,6 +32,9 @@
 19=Long2CutSide
 20=SmallToolContour
 21=AntiSplintMillCut
+22=Prof_end
+23=SideMillAsBlade
+24=FloatingAggregate
 
 [Pocketing]
 1=Pocket

Common_FAST.NUM.mlpe

@@ -496,6 +496,7 @@ function OnMachiningEnd()
    EMT.U_STD = nil
    EMT.PREVTOOL = EMT.TOOL
    EMT.PREVHEAD = EMT.HEAD
+   EMT.PREVET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
 end
 
 ---------------------------------------------------------------------
@@ -626,15 +627,32 @@ function OnRapid()
          end
       end
 
+      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+
+      local bGoToHome = false
+      -- se gli assi rotanti cambiano parecchio, con motosega si va in parcheggio 
+      if EMT.PREVHEAD == 'H3' and EMT.HEAD == 'H3' and sET == EMT.PREVET and ( abs( EMT.R2pp - EMT.R2) > 25 or abs( EMT.R1pp - EMT.R1) > 25)  then
+         bGoToHome = true
+      end
+
+      -- ricavo i dati per la lavorazione
+      local sEE = ' EE' .. EgtIf( bZmax, '3', '4')
+      local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
+      local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
+      local sES = ' ES'..EgtNumToString( EMT.S, 0)
+
       -- primo posizionamento
       local MyZHome = EgtGetAxisHomePos( 'Z')
       local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
       -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.FLAG2 == 1 then
          local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
                                        ' B' .. EmtLenToString( EMT.R2pp, 3) .. ' C' .. EmtLenToString( EMT.R1pp, 3) .. 
                                        ' EE' .. EgtIf( bZmax, '3', '4') .. EMT.PREVsEL .. EMT.PREVsER .. EMT.PREVsET .. EMT.PREVsES
          EmtOutput( sOutPreMove)
+         sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1pp, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOutPreMove)
          EmtOutput( 'G101 ET1001')
          EmtOutput( 'G101 ET2001')
       end
@@ -644,19 +662,21 @@ function OnRapid()
          EmtOutput( '( *** ' .. sOut .. ' *** )')
       end
 
-      -- ricavo i dati per la lavorazione
-      local sEE = ' EE' .. EgtIf( bZmax, '3', '4')
-      local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
-      local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
-      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
-      local sES = ' ES'..EgtNumToString( EMT.S, 0)
-
       -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
-      if not EMT.LOAD and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TTOTLEN > 200)) and 
-         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350)) and EMT.FLAG2 == 1 then
+      if not EMT.LOAD and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TTOTLEN > 200)) and
+         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350) or bGoToHome) and EMT.FLAG2 == 1 then
          local sEEPreMove = ' EE' .. EgtIf( bZmax, '3', '4')
-         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
-                                       EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+         local sOutPreMove
+         if EMT.HEAD == 'H3' and bGoToHome then
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1pp, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+         end
+         sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( EMT.R2, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
          EmtOutput( sOutPreMove)
          EmtOutput( 'G101 ET1001')
          EmtOutput( 'G101 ET2001')
@@ -846,13 +866,13 @@ function OnRapid()
          local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
          local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
          local sES = ' ES'..EgtNumToString( EMT.S, 0)
-         local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..' B=' .. EgtNumToString( dBAxis, 3) ..
-                      ' C=' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..' B' .. EgtNumToString( dBAxis, 3) ..
+                      ' C' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
          EmtOutput( sOut)
          EmtOutput( 'G101 ET1001')
          EmtOutput( 'G101 ET2001')
-         sOut = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. EmtGetAxis( 'L3') ..' B=' .. EgtNumToString( dBAxis, 3) ..
-                ' C=' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         sOut = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. EmtGetAxis( 'L3') ..' B' .. EgtNumToString( dBAxis, 3) ..
+                ' C' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
          EmtOutput( sOut)
          EmtOutput( 'G101 ET1001')
          EmtOutput( 'G101 ET2001')

Common_FAST.NUM_PLUS.mlpe

@@ -207,9 +207,9 @@ function OnDispositionEnd()
       local BtlInfoId = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or EgtGetCurrMachGroup() or GDB_ID.NULL
       local nLoad90 = EgtGetInfo( BtlInfoId, 'LOAD90', 'i') or 0
       -- calcolo dati pinze
-      local AccPinze, AccMaxPinze, RidFeed, TempoAcc = CalcDinamicaPinze( HTrave, STrave, LBarra)
-      local AccPinz1, AccMaxPinz1, RidFeed1, TempoAcc1 = CalcDinamicaPinze( HTrave, STrave, LBarra - LTrave)
-      local AccPinz2, AccMaxPinz2, RidFeed2, TempoAcc2 = CalcDinamicaPinze( HTrave, STrave, LTrave)
+      local AccPinze, AccMaxPinze, RidFeed, TempoAcc = CalcDinamicaPinze_NUM( HTrave, STrave, LBarra)
+      local AccPinz1, AccMaxPinz1, RidFeed1, TempoAcc1 = CalcDinamicaPinze_NUM( HTrave, STrave, LBarra - LTrave)
+      local AccPinz2, AccMaxPinz2, RidFeed2, TempoAcc2 = CalcDinamicaPinze_NUM( HTrave, STrave, LTrave)
       if IdTrave >= 0 then
          local sOut = '( SN='..IdTrave..' LBarra='..EmtLenToString( LBarra, 3)..' L='..EmtLenToString( LTrave, 3)..
                       ' H='..EmtLenToString( HTrave, 3)..' S='..EmtLenToString( STrave, 3)..' Acc='..EgtNumToString( TempoAcc, 1)..
@@ -544,6 +544,7 @@ function OnMachiningEnd()
    EMT.PREVTOOL = EMT.TOOL
    EMT.PREVHEAD = EMT.HEAD
    EMT.PREVR3 = EMT.R3
+   EMT.PREVET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
 end
 
 ---------------------------------------------------------------------
@@ -675,22 +676,12 @@ function OnRapid()
          end
       end
 
-      -- primo posizionamento
-      local MyZHome = EgtGetAxisHomePos( 'Z')
-      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
-      -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
-         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
-                                       ' B' .. EmtLenToString( EMT.R2pp, 3) .. ' C' .. EmtLenToString( EMT.R1pp, 3) .. 
-                                       ' EE' .. EgtIf( bZmax, '3', '4') .. EMT.PREVsEL .. EMT.PREVsER .. EMT.PREVsET .. EMT.PREVsES
-         EmtOutput( sOutPreMove)
-         EmtOutput( 'G101 ET1001')
-         EmtOutput( 'G101 ET2001')
-      end
+      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
 
-      if not EMT.LOAD then
-         local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '-'), '%)', '-')
-         EmtOutput( '( *** ' .. sOut .. ' *** )')
+      local bGoToHome = false
+      -- se gli assi rotanti cambiano parecchio, con motosega si va in parcheggio 
+      if EMT.PREVHEAD == 'H3' and EMT.HEAD == 'H3' and sET == EMT.PREVET and ( abs( EMT.R2pp - EMT.R2) > 25 or abs( EMT.R1pp - EMT.R1) > 25)  then
+         bGoToHome = true
       end
 
       -- ricavo i dati per la lavorazione
@@ -720,15 +711,44 @@ function OnRapid()
          sER = sER..EmtLenToString( EMT.TDIAM / 2, 3)
       end
 
-      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
       local sES = ' ES'..EgtNumToString( EMT.S, 0)
 
+      -- primo posizionamento
+      local MyZHome = EgtGetAxisHomePos( 'Z')
+      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
+      -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
+      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.FLAG2 == 1 then
+         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EmtLenToString( EMT.R2pp, 3) .. ' C' .. EmtLenToString( EMT.R1pp, 3) .. 
+                                       ' EE' .. EgtIf( bZmax, '3', '4') .. EMT.PREVsEL .. EMT.PREVsER .. EMT.PREVsET .. EMT.PREVsES
+         EmtOutput( sOutPreMove)
+         sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOutPreMove)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
+      end
+
+      if not EMT.LOAD then
+         local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '-'), '%)', '-')
+         EmtOutput( '( *** ' .. sOut .. ' *** )')
+      end
+
       -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
       if not EMT.LOAD and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TTOTLEN > 200)) and 
-         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350)) and EMT.FLAG2 == 1 then
+         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350) or bGoToHome) and EMT.FLAG2 == 1 then
          local sEEPreMove = ' EE' .. EgtIf( bZmax, '3', '4')
-         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
-                                       EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+         local sOutPreMove
+         if EMT.HEAD == 'H3' and bGoToHome then
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1pp, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+         end
+         sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( EMT.R2, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
          EmtOutput( sOutPreMove)
          EmtOutput( 'G101 ET1001')
          EmtOutput( 'G101 ET2001')
@@ -928,13 +948,13 @@ function OnRapid()
          local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
          local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
          local sES = ' ES'..EgtNumToString( EMT.S, 0)
-         local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..' B=' .. EgtNumToString( dBAxis, 3) ..
-                      ' C=' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..' B' .. EgtNumToString( dBAxis, 3) ..
+                      ' C' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
          EmtOutput( sOut)
          EmtOutput( 'G101 ET1001')
          EmtOutput( 'G101 ET2001')
-         sOut = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. EmtGetAxis( 'L3') ..' B=' .. EgtNumToString( dBAxis, 3) ..
-                ' C=' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         sOut = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. EmtGetAxis( 'L3') ..' B' .. EgtNumToString( dBAxis, 3) ..
+                ' C' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
          EmtOutput( sOut)
          EmtOutput( 'G101 ET1001')
          EmtOutput( 'G101 ET2001')
@@ -1096,24 +1116,6 @@ function FindNextTool()
    return sTool, sHead, sTcPos
 end
 
----------------------------------------------------------------------
-function CalcDinamicaPinze( dH, dS, dL)
-   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
-   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
-   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
-   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
-   local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
-   local AccMaxPinze = EMT.MAXACC
-   local AccPinze = EgtClamp( FMaxPinze / ( 60 * TempoAcc), EMT.MINACC, EMT.MAXACC)
-   local RidFeed = 100 / Massa * 100
-   if RidFeed > 100 then
-      RidFeed = 100
-   elseif RidFeed < 10 then
-      RidFeed = 10
-   end
-   return AccPinze, AccMaxPinze, RidFeed, TempoAcc
-end
-
 ---------------------------------------------------------------------
 function CalcCharStatus( sCmd, bSkipPress)
    -- aperto

Common_FAST.TPA.mlpe

@@ -225,9 +225,9 @@ function OnDispositionEnd()
       local HOverM = EMT.HOVM
 
       -- calcolo dati pinze
-      local TempAccPinze, TempMinAccPinze, RidFeed = CalcDinamicaPinze( HTrave, STrave, LBarra)
-      local TempAccPinz1, TempMinAccPinz1, RidFeed1 = CalcDinamicaPinze( HTrave, STrave, LBarra - LTrave)
-      local TempAccPinz2, TempMinAccPinz2, RidFeed2 = CalcDinamicaPinze( HTrave, STrave, LTrave)
+      local TempAccPinze, TempMinAccPinze, RidFeed = CalcDinamicaPinze_TPA( HTrave, STrave, LBarra)
+      local TempAccPinz1, TempMinAccPinz1, RidFeed1 = CalcDinamicaPinze_TPA( HTrave, STrave, LBarra - LTrave)
+      local TempAccPinz2, TempMinAccPinz2, RidFeed2 = CalcDinamicaPinze_TPA( HTrave, STrave, LTrave)
 
       if IdTrave >= 0 then
          local sPrt = '( *** Part '.. EgtNumToString( IdTrave, 0) ..' ***)'
@@ -658,16 +658,28 @@ function OnRapid()
             bHeadFirst = false
          end
       end
+
+      local bGoToHome = false
+      -- se gli assi rotanti cambiano parecchio, con motosega si va in parcheggio 
+      if EMT.PREVHEAD == 'H3' and EMT.HEAD == 'H3' and EMT.TCPOS == EMT.PREVTCPOS and ( abs( EMT.R2pp - EMT.R2) > 25 or abs( EMT.R1pp - EMT.R1) > 25)  then
+         bGoToHome = true
+      end
+   
       -- primo posizionamento
       local MyZHome = EgtGetAxisHomePos( 'Z')
       local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or EMT.L3 > -1)
       -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.FLAG2 == 1 then
          local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
                                  ' P4=' .. EgtNumToString( EMT.R2pp, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1pp, EMT.DECMACRO) .. 
                                  ' P6=' .. EgtNumToString( EMT.PREVTCPOS, EMT.DECMACRO) .. ' P7=' .. EgtNumToString( EMT.PREVS, 0) ..
                                  ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
          EmtOutput( sOutPreMove)
+         sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( 0, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1pp, EMT.DECMACRO) .. 
+                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+         EmtOutput( sOutPreMove)
          EmtOutput( 'M101 P1=2')
          EmtOutput( 'M101 P1=3')
       end
@@ -679,8 +691,21 @@ function OnRapid()
 
       -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
       if not EMT.LOAD and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TTOTLEN > 200)) and 
-         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350)) and EMT.FLAG2 == 1 then
-         local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350) or bGoToHome) and EMT.FLAG2 == 1 then
+         local sOutPreMove
+         if EMT.HEAD == 'H3' and bGoToHome then
+            sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( 0, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1pp, EMT.DECMACRO) .. 
+                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+            EmtOutput( sOutPreMove)
+            sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( 0, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1, EMT.DECMACRO) .. 
+                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+            EmtOutput( sOutPreMove)
+         end
+         sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
                                  ' P4=' .. EgtNumToString( EMT.R2, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1, EMT.DECMACRO) .. 
                                  ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
                                  ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
@@ -1056,24 +1081,6 @@ function FindNextTool()
    return sTool, sHead, sTcPos
 end
 
----------------------------------------------------------------------
-function CalcDinamicaPinze( dH, dS, dL)
-   local MinTempoAcc = EMT.MINACC        -- [ms] ~300
-   local MaxTempoAcc = EMT.MAXACC        -- [ms] ~4000
-   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
-   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
-   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
-   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
-   local TempoAcc = EgtClamp( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito), MinTempoAcc, MaxTempoAcc)
-   local RidFeed = 100 / Massa * 100
-   if RidFeed > 100 then
-      RidFeed = 100
-   elseif RidFeed < 10 then
-      RidFeed = 10
-   end
-   return TempoAcc, MinTempoAcc, RidFeed
-end
-
 ---------------------------------------------------------------------
 function CalcCharStatus( sCmd, bSkipPress)
    -- aperto

Common_FAST.mlpe

@@ -7,9 +7,6 @@ EgtEnableDebug( false)
 -- carico librerie
 local BD = require( 'BeamData')
 
-LONG_TOOL_MINLEN = 221
-BIG_TOOL_DIAM = 300
-
 ---------------------------------------------------------------------
 -- *** GENERATION ***
 ---------------------------------------------------------------------
@@ -82,6 +79,14 @@ function OnSimulStart()
          for j = 1, #( vTools or {}) do
             if vTools[j] ~= '' then
                EgtLoadTool( vTcPos[i], j, vTools[j])
+               -- Aggiunto controllo lunghezza lama minima * 0.9 per ricavare la tolleranza del VMILL
+               if EgtTdbSetCurrTool(vTools[j]) then -- set utensile corrente
+                  if EgtTdbGetCurrToolParam( MCH_TP.TYPE) == MCH_TY.SAW_STD or EgtTdbGetCurrToolParam( MCH_TP.TYPE) == MCH_TY.SAW_FLAT then -- controllo tipo utensile sega
+                     local dCurrSawLen = EgtTdbGetCurrToolParam( MCH_TP.LEN) * 0.9
+                     -- se non definito o minore del valore precedente aggiorna la tolleranza
+                     EMT.VMILLTOL = EgtIf( not EMT.VMILLTOL or dCurrSawLen < EMT.VMILLTOL, dCurrSawLen, EMT.VMILLTOL) 
+                  end
+               end
             end
          end
          ShowToolInTcPos( vTcPos[i], true)
@@ -118,7 +123,8 @@ function OnSimulStart()
                      { Grp = 'V', Sub = 'COLLISION', Name = 'VOL2'},
                      { Grp = 'PV', Sub = 'COLLISION', Name = 'VOL'},
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'SIDE1'},
-                     { Grp = 'Base', Sub = 'COLLISION', Name = 'SIDE2'}}
+                     { Grp = 'Base', Sub = 'COLLISION', Name = 'SIDE2'},
+                     { Grp = 'C', Sub = 'COLLISION2', Name = 'C_TOP'}}
    EgtOutLog( 'MCODET Objects :', 4)
    local nMcdNullCnt = 0
    for i = 1, #McdData do
@@ -168,13 +174,13 @@ function OnSimulDispositionStart()
       -- Determino dimensioni del grezzo
       local nSolId = EgtGetFirstNameInGroup( EgtGetFirstRawPart() or GDB_ID.NULL, 'RawSolid') or GDB_ID.NULL
       local b3Sol = EgtGetBBoxGlob( nSolId, GDB_BB.STANDARD)
-      EMT.LB = 0
-      EMT.SB = 0
-      EMT.HB = 0
+      EMT.LT = 0
+      EMT.ST = 0
+      EMT.HT = 0
       if b3Sol then
-         EMT.LB = b3Sol:getDimX()
-         EMT.SB = b3Sol:getDimY()
-         EMT.HB = b3Sol:getDimZ()
+         EMT.LT = b3Sol:getDimX()
+         EMT.ST = b3Sol:getDimY()
+         EMT.HT = b3Sol:getDimZ()
       end
       -- Carico primo utensile sulla testa 1
       local sTool, nTlen = FindFirstToolOnHead( 'H1')
@@ -215,7 +221,7 @@ function OnSimulDispositionStart()
             -- determino la risoluzione dello Zmap
             local dTol = 4.71
             if EmtGetVMillStep then
-               dTol = EmtGetVMillStep( b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), 4.71)
+               dTol = EmtGetVMillStep( b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), dTol)
             else
                local dArea = b3Raw:getDimX() * b3Raw:getDimY() + b3Raw:getDimX() * b3Raw:getDimZ() + b3Raw:getDimY() * b3Raw:getDimZ()
                if dArea < 0.075e6 then
@@ -232,6 +238,7 @@ function OnSimulDispositionStart()
                   dTol = 3.77
                end
             end
+            dTol = min( dTol, EMT.VMILLTOL or dTol) -- imposto dTol al valore minore tra quello per volume e quello per spessore lama
             -- creo lo Zmap
             local VMillId = EgtVolZmapBox( nPartRawId, b3Raw:getMin(), b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), dTol, true, GDB_RT.GLOB)
             if VMillId then
@@ -558,24 +565,24 @@ function OnSimulToolDeselect()
       -- movimento scarico sega a catena
       if EMT.HEAD == 'H3' then
          -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-         if  EMT.HB > BeamHeightForFixRot then
-            SimulMoveAxis( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID)
-         end
+         SimulMoveAxis( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID)
+         -- raddrizzo asse B prima di ruotare il C
+         SimulMoveAxis( 'B', 0, MCH_SIM_STEP.COLLROT)
          local dPosA = EgtGetAxisPos( 'A')
          if abs( dPosA) < 0.1 then
-            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 180, 0), MCH_SIM_STEP.COLLROT)
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, -180, 0), MCH_SIM_STEP.COLLROT)
          else
-            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, 270), MCH_SIM_STEP.COLLROT)
          end
          SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
       -- movimento scarico rinvio
       elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
-         SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', -90, MCH_SIM_STEP.COLLROT)
+         SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
          SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
       -- movimento scarico aggregato BlockHaus
       elseif EMT.HEAD == 'H7' then
          SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
-         SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', -90, MCH_SIM_STEP.COLLROT)
+         SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
       -- movimento scarico punta lunga su T111
       elseif EMT.TOTLEN > LONG_TOOL_MINLEN then
          -- se su cambio utensile T111
@@ -586,9 +593,9 @@ function OnSimulToolDeselect()
          else
             SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
             if GetTCSet( EMT.TCPOS) == 1 then
-               SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', -90, MCH_SIM_STEP.COLLROT)
+               SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
             else
-               SimulMoveAxes( 'B', -90, MCH_SIM_STEP.COLLROT, 'C', -90, MCH_SIM_STEP.COLLROT)
+               SimulMoveAxes( 'B', -90, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
             end
          end
       -- movimento scarico utensile di grosso diametro (su T111)
@@ -608,7 +615,16 @@ function OnSimulToolDeselect()
       if EMT.NEXTHEAD ~= 'H3' and EMT.NEXTHEAD ~= 'H5' and EMT.NEXTHEAD ~= 'H6' then
          SimulMoveAxes( 'B', EgtIf( GetTCSet( EMT.TCPOS) == 1, 90, -90), MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
       else
-         SimulMoveAxes( 'B', 0, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
+         if EMT.NEXTHEAD == 'H3' then
+            local dPosA = EgtGetAxisPos( 'A')
+            if abs( dPosA) < 0.1 then
+               SimulMoveAxes( 'B', 0, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, 270), MCH_SIM_STEP.RAPROT)
+            else
+               SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, -180, 0), MCH_SIM_STEP.COLLROT)
+            end
+         else
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
+         end
       end
       -- se segue lama, carico utensile di default
       if EMT.NEXTHEAD == 'H2' then
@@ -785,13 +801,26 @@ function OnSimulMoveStart()
    VerifyVStroke( EMT.A2)
    -- se inizio lavorazione
    if EMT.MCHFIRST then
+
+      local bGoToHome = false
+      -- se gli assi rotanti cambiano parecchio, con motosega si va in parcheggio 
+      if EMT.PREVHEAD == 'H3' and EMT.HEAD == 'H3' and EMT.TOOL == EMT.PREVTOOL and abs( EMT.R3p - EMT.R3) < 100 * GEO.EPS_SMALL and ( abs( EMT.R2p - EMT.R2) > 25 or abs( EMT.R1p - EMT.R1) > 25)  then
+         bGoToHome = true
+      end
+
       EgtOutText( '')
       EMT.MCHFIRST = false
       local bZmax = ( EMT.TOOL ~= EMT.PREVTOOL  or EMT.L3 > -1)
       -- con pezzi alti aggiorno gli assi rotanti prima di muovermi sopra il pezzo
-      if not EMT.LOAD and EMT.MOVE == 0 and ( EMT.HB > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TOTLEN > 350)) and EMT.FLAG2 == 1 then
-         -- se motosega mi muovo a X di sicurezza per ruotare
-         if ( EMT.HEAD == 'H3' or ( bZmax and EMT.TOTLEN > 200)) then
+      if not EMT.LOAD and EMT.MOVE == 0 and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TOTLEN > 200)) and 
+         ( EMT.HT > BeamHeightForFixRot  or ( EMT.HEAD == 'H1' and EMT.TOTLEN > 350) or bGoToHome) and EMT.FLAG2 == 1 then
+         -- se motosega mi muovo a X di sicurezza per ruotare, prima si raddrizza B e poi C in posizione
+         if EMT.HEAD == 'H3' or bGoToHome then
+            SimulMoveAxis( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID)
+            SimulMoveAxis( 'B', 0, MCH_SIM_STEP.COLLROT)
+            SimulMoveAxis( 'C', EMT.R1, MCH_SIM_STEP.COLLROT)
+            SimulMoveAxis( 'B', EMT.R2, MCH_SIM_STEP.COLLROT)
+         elseif ( bZmax and EMT.TOTLEN > 200) then
             SimulMoveAxes( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID, 'C', EMT.R1, MCH_SIM_STEP.COLLROT, 'B', EMT.R2, MCH_SIM_STEP.COLLROT)
          end
       end
@@ -916,14 +945,14 @@ function ExecAuxCmd( sCmd)
    elseif Cmd[1] == '11' then
       local dPY = MaxOpen
       if Cmd[2] ~= '0' then
-         dPY = EgtIf( EMT.ROT == -1, EMT.HB, EMT.SB)
+         dPY = EgtIf( EMT.ROT == -1, EMT.HT, EMT.ST)
       end
       SimulMoveAxis( 'PY', dPY, MCH_SIM_STEP.RAPID)
       SetPYLight( Cmd[2] ~= '0')
    elseif Cmd[1] == '12' then
       local dPV = MaxOpen
       if Cmd[2] ~= '0' then
-         dPV = EgtIf( EMT.ROT == -1, EMT.HB, EMT.SB)
+         dPV = EgtIf( EMT.ROT == -1, EMT.HT, EMT.ST)
       end
       SimulMoveAxis( 'PV', dPV, MCH_SIM_STEP.RAPID)
       SetPVLight( Cmd[2] ~= '0')
@@ -990,7 +1019,7 @@ function ExecUnloading()
       -- li sposto per lasciare spazio al nuovo pezzo
       local nId = EgtGetFirstInGroup( nVmGrpId)
       while nId do
-         EgtMove( nId, Vector3d( 0, EgtIf( BD.RIGHT_LOAD, ( EMT.SB + 50.0), -( EMT.SB + 50.0)), 0), GDB_RT.GLOB)
+         EgtMove( nId, Vector3d( 0, EgtIf( BD.RIGHT_LOAD, ( EMT.ST + 50.0), -( EMT.ST + 50.0)), 0), GDB_RT.GLOB)
          nId = EgtGetNext( nId)
       end
       -- creo un nuovo layer e vi inserisco il nuovo pezzo
@@ -1192,11 +1221,11 @@ end
 --   *** ESTIMATION T&L ***
 ---------------------------------------------------------------------
 local ESTIMATION_RAPID_COEFF = EstimationRapidMultiplier or 1
-local RAPID_X_FEED =  75000 / ESTIMATION_RAPID_COEFF    -- mm/min
+local RAPID_X_FEED =  100000 / ESTIMATION_RAPID_COEFF   -- mm/min
 local RAPID_Y_FEED = 100000 / ESTIMATION_RAPID_COEFF    -- mm/min
-local RAPID_Z_FEED =  50000 / ESTIMATION_RAPID_COEFF    -- mm/min
-local RAPID_C_FEED =  15000 / ESTIMATION_RAPID_COEFF    -- deg/min
-local RAPID_B_FEED =  15000 / ESTIMATION_RAPID_COEFF    -- deg/min
+local RAPID_Z_FEED =  100000 / ESTIMATION_RAPID_COEFF   -- mm/min
+local RAPID_C_FEED =  12000 / ESTIMATION_RAPID_COEFF    -- deg/min
+local RAPID_B_FEED =  12000 / ESTIMATION_RAPID_COEFF    -- deg/min
 local RAPID_MIN_T = 0.1 * ESTIMATION_RAPID_COEFF       -- s
 local LOAD_T = 2  * ESTIMATION_RAPID_COEFF              -- s
 local CHAR_ONE_MOVE_T = 1  * ESTIMATION_RAPID_COEFF     -- s
@@ -1208,6 +1237,18 @@ local FALL_T = 2  * ESTIMATION_RAPID_COEFF              -- s
 ---------------------------------------------------------------------
 function OnEstimStart()
    EMT.INCHES = not EgtUiUnitsAreMM()      -- unità di misura mm/inches
+
+   -- TPA
+   if NumericalControl == 'TPA' then
+      EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 154000, 20000, 160000)  -- feed massima pinze
+      EMT.MAXACC = MaxAcc or 4000    -- accelerazione massima pinze. In realtà è il tempo in millisecondi, quindi MAXACC corrisponde al tempo massimo per raggiungere la velocità desiderata
+      EMT.MINACC = MinAcc or 300     -- accelerazione minima pinze. In realtà è il tempo in millisecondi, quindi MINACC corrisponde al tempo massimo per raggiungere la velocità desiderata
+   -- NUM_PLUS e NUM
+   else
+      EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 154000, 20000, 160000)  -- feed massima pinze
+      EMT.MAXACC = MaxAcc or ( EMT.FMAXPINZE / ( 60 * 0.3))  -- accelerazione massima pinze
+      EMT.MINACC = MinAcc or ( EMT.FMAXPINZE / ( 60 * 4))    -- accelerazione minima pinze
+   end
 end
 
 ---------------------------------------------------------------------
@@ -1293,6 +1334,15 @@ function OnEstimDispositionEnd()
    EMT.OPEISDISP = false
 end
 
+---------------------------------------------------------------------
+function OnEstimRawMoveData()
+   -- se start del pezzo
+   if IsStartOrRestPhase( EMT.PHASE) then
+      EMT.SPLIT = false
+   end
+   OnRawMoveData()
+end
+
 ---------------------------------------------------------------------
 function OnEstimToolSelect()
    -- reset indice utensile in tabella lunghezze
@@ -1349,6 +1399,12 @@ function OnEstimMachiningEnd()
       EMT.TLE_NAME = nil
       EMT.TLE_TIME = nil
    end
+
+   EMT.MCHUSERNOTES = EgtGetMachiningParam( MCH_MP.USERNOTES) or ''
+   EMT.MCHSPLIT = ( EMT.MCHUSERNOTES:find( 'Split;', 1, true) ~= nil)
+   if EMT.MCHSPLIT then
+      EMT.SPLIT = true
+   end
 end
 
 ---------------------------------------------------------------------
@@ -1479,15 +1535,15 @@ function OnEstimRapid()
    EMT.MCHEXTLEN = EMT.MCHEXTLEN + dLen
    -- calcolo tempo
    local dTime = RAPID_MIN_T
-   local dT1 = abs( dL1) / RAPID_X_FEED * 60
+   local dT1 = CalcMoveTime( abs( dL1), EMT.FMAXPINZE, EMT.SPLIT)
    if dT1 > dTime then dTime = dT1 end
-   local dT2 = abs( dL2) / RAPID_Y_FEED * 60
+   local dT2 = abs( dL2) / ( RAPID_X_FEED / 60) -- CalcMoveTime( abs( dL2), RAPID_X_FEED, EMT.SPLIT)
    if dT2 > dTime then dTime = dT2 end
-   local dT3 = abs( dL3) / RAPID_Z_FEED * 60
+   local dT3 = abs( dL3) / ( RAPID_Z_FEED * 60) -- CalcMoveTime( abs( dL3), RAPID_Z_FEED, EMT.SPLIT)
    if dT3 > dTime then dTime = dT3 end
-   local dT4 = abs( dR1) / RAPID_C_FEED * 60
+   local dT4 = abs( dR1) / ( RAPID_C_FEED / 60)
    if dT4 > dTime then dTime = dT4 end
-   local dT5 = abs( dR2) / RAPID_B_FEED * 60
+   local dT5 = abs( dR2) / ( RAPID_B_FEED / 60)
    if dT5 > dTime then dTime = dT5 end
    EMT.MCHEXTTIME = EMT.MCHEXTTIME + dTime
    EgtOutLog( string.format( '  G0 Len=%.0f Rot=%.0f° Time=%.2f', dLen, abs( dR1) + abs( dR2), dTime), 5)
@@ -1505,7 +1561,7 @@ function OnEstimLinear()
    local dLen = sqrt( dL1 * dL1 + dL2 * dL2 + dL3 * dL3)
    EMT.MCHCUTLEN = EMT.MCHCUTLEN + dLen
    -- calcolo tempo
-   local dTime = dLen / EMT.F * 60
+   local dTime = dLen / ( EMT.F / 60) -- CalcMoveTime( dLen, EMT.F, EMT.SPLIT)
    EMT.MCHCUTTIME = EMT.MCHCUTTIME + dTime
    EgtOutLog( string.format( '  G1 Len=%.0f Time=%.2f', dLen, dTime), 5)
    -- aggiorno valori come precedenti
@@ -1652,6 +1708,70 @@ function GetParkT()
    end
 end
 
+---------------------------------------------------------------------
+function CalcDinamicaPinze_TPA( dH, dS, dL)
+   local MinTempoAcc = EMT.MINACC        -- [ms] ~300
+   local MaxTempoAcc = EMT.MAXACC        -- [ms] ~4000
+   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
+   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
+   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
+   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
+   local TempoAcc = EgtClamp( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito), MinTempoAcc, MaxTempoAcc)
+   local RidFeed = 100 / Massa * 100
+   if RidFeed > 100 then
+      RidFeed = 100
+   elseif RidFeed < 10 then
+      RidFeed = 10
+   end
+   return TempoAcc, MinTempoAcc, RidFeed
+end
+
+---------------------------------------------------------------------
+function CalcDinamicaPinze_NUM( dH, dS, dL)
+   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
+   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
+   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
+   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
+   local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
+   local AccMaxPinze = EMT.MAXACC
+   local AccPinze = EgtClamp( FMaxPinze / ( 60 * TempoAcc), EMT.MINACC, EMT.MAXACC)
+   local RidFeed = 100 / Massa * 100
+   if RidFeed > 100 then
+      RidFeed = 100
+   elseif RidFeed < 10 then
+      RidFeed = 10
+   end
+   return AccPinze, AccMaxPinze, RidFeed, TempoAcc
+end
+
+---------------------------------------------------------------------
+function CalcMoveTime( dPathLen, dFeed, bIsSplitted)
+   local dTime
+   local dFeedInSec = dFeed / 60
+
+   if NumericalControl == 'TPA' then
+      local dTempoAcc, _, _ = CalcDinamicaPinze_TPA( EMT.HT, EMT.ST, EgtIf( bIsSplitted, EMT.LT, EMT.LB))
+      dTempoAcc = dTempoAcc / 1000
+      -- se si raggiunge la velocità massima
+      if dPathLen >= dFeedInSec * dTempoAcc then
+         dTime = dTempoAcc * 2 + ( ( dPathLen - dFeedInSec * dTempoAcc) / dFeedInSec)
+      else
+         dTime = 2 * sqrt( (dPathLen * dTempoAcc) / dFeedInSec)
+      end
+   else
+      local dAcc, _, _, _ = CalcDinamicaPinze_NUM( EMT.HT, EMT.ST, EgtIf( bIsSplitted, EMT.LT, EMT.LB))
+      -- Caso 1: dFeed raggiunta
+      if dPathLen >= ( dFeedInSec ^ 2) / dAcc then
+         dTime = ( dFeedInSec / dAcc) + ( dPathLen / dFeedInSec)
+      -- Caso 2: dFeed non raggiunta
+      else
+         dTime = 2 * sqrt( dPathLen / dAcc)
+      end
+   end
+
+   return dTime
+end
+
 ---------------------------------------------------------------------
 -- *** END GENERAL ***
 ---------------------------------------------------------------------

Common_FAST.mlse

@@ -1642,7 +1642,9 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
       --    * deve effettivamente spostarsi
       --    * non si arriva da gestione passo del pellegrino
       --    * se riesce a raggiungere la posizione con le corse a disposizione per come sono posizionate le morse attualmente
-      if ( dYDeltaI - dVDeltaF) + 10 * GEO.EPS_SMALL >= MyMinY - MaxV and abs( dVDeltaF - dVDeltaI) > 10 * GEO.EPS_SMALL and  not EMC.PILGRIMSTEP and
+      if ( dYDeltaI - dVDeltaF) + 10 * GEO.EPS_SMALL >= MyMinY - MaxV and
+         ( abs( dVDeltaF - dVDeltaI) > 10 * GEO.EPS_SMALL or not EMC.VDELTA) and
+         not EMC.PILGRIMSTEP and
          ( dVDeltaF - dVDeltaI > MinV - dVPosI + MyMinY - dYPosI) then
          table.insert( vCmd, { 0, 'Direct-V-Y'})
          -- se l'altra morsa non era in presa, vado a pinzare il pezzo
@@ -1747,7 +1749,9 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
       --    * deve effettivamente spostarsi
       --    * non si arriva da gestione passo del pellegrino
       --    * se riesce a raggiungere la posizione con le corse a disposizione per come sono posizionate le morse attualmente
-      elseif ( dYDeltaF - dVDeltaI) + 10 * GEO.EPS_SMALL >= MyMinY - MaxV and abs( dYDeltaF - dYDeltaI) > 10 * GEO.EPS_SMALL and  not EMC.PILGRIMSTEP and
+      elseif ( dYDeltaF - dVDeltaI) + 10 * GEO.EPS_SMALL >= MyMinY - MaxV and 
+             ( abs( dYDeltaF - dYDeltaI) > 10 * GEO.EPS_SMALL or not EMC.YDELTA) and
+             not EMC.PILGRIMSTEP and
              ( dYDeltaF - dYDeltaI < MaxY - dYPosI + MaxV - dVPosI) then
          table.insert( vCmd, { 0, 'Direct-Y-V'})
          -- se l'altra morsa non era in presa, vado a pinzare il pezzo

Essetre-FAST.mlde

@@ -24,9 +24,9 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '2.7g2'
-PP_NVER = '2.7.7.2'
-MIN_MACH_VER = '2.5k1'
+PP_VER = '2.7l4'
+PP_NVER = '2.7.12.4'
+MIN_MACH_VER = '2.7j1'
 MACH_NAME = string.match( EgtGetCurrMachineDir(), "[^\\]+$")  -- si ricava il nome della macchina dal direttorio
 
 -- Carico i dati globali
@@ -93,6 +93,10 @@ AggreBlockHaus = false
 SecondToolChanger = false
 EstimationRapidMultiplier = 1
 
+-- costanti dimensioni utensili
+LONG_TOOL_MINLEN = 221
+BIG_TOOL_DIAM = 300
+
 -- leggo e aggiorno con parametri da BeamData
 if BD then
    BeamHeightForFixRot = BD.MAX_HEIGHT_ROT_B_ABOVE or BeamHeightForFixRot
@@ -165,6 +169,7 @@ if EgtExistsFile( sData) then
          if Machine.Offsets.AGGRE_BH then AggreBlockHaus = ( Machine.Offsets.AGGRE_BH == 1) end
          if Machine.Offsets.SEC_TC then SecondToolChanger = ( Machine.Offsets.SEC_TC == 1) end
          if Machine.Offsets.COEFF_STIMATEMPI and Machine.Offsets.COEFF_STIMATEMPI > 0 then EstimationRapidMultiplier = Machine.Offsets.COEFF_STIMATEMPI end
+         if Machine.Offsets.MAX_HEIGHT_ROT_B_ABOVE then BeamHeightForFixRot = Machine.Offsets.MAX_HEIGHT_ROT_B_ABOVE end
       end
    end
 end
@@ -219,7 +224,7 @@ local CId = EmtAxis {
       Stroke = {MinC, MaxC},
       Home = 0,
       Geo = 'C_AXIS/GEO',
-      Aux = {'C_AXIS/SOLID', 'C_AXIS/COLLISION'}}
+      Aux = {'C_AXIS/SOLID', 'C_AXIS/COLLISION', 'C_AXIS/COLLISION2'}}
 if NewTopC then
    local vtMove = Vector3d( 65,0,0)
    local SolidArmId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( CId, 'SOLID'), 'ARM')
@@ -234,9 +239,13 @@ if NewTopC then
    local CollTopId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( CId, 'COLLISION'), 'TOP')
    EgtMove( CollTopId, vtMove, GDB_RT.GLOB)
    EgtSetName( CollTopId, 'BOX')
+   local RefId = CollTopId + EgtGetInfo( CollTopId, 'Frame', 'i')
+   EgtSetInfo( RefId, 'CollSkip', 'C_TOP')
 else
    local CollTopId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( CId, 'COLLISION'), 'TOP')
    EgtSetName( CollTopId, 'BOX')
+   local RefId = CollTopId + EgtGetInfo( CollTopId, 'Frame', 'i')
+   EgtSetInfo( RefId, 'CollSkip', 'C_TOP')
 end
 EmtAxis {
       Name = 'B',
@@ -556,13 +565,6 @@ if SecondToolChanger then
          TDir = X_AX(),
          ADir = -Y_AX(),
          Geo = 'BASE/T28'}
-   EmtTcPos {
-         Name = 'T101',
-         Parent = 'Base',
-         Pos = Point3d( -510.4, 113.2, -1160.8),
-         TDir = X_AX(),
-         ADir = Z_AX(),
-         Geo = 'BASE/T101S'}
 else
    if not SpecialBH then
       EmtTcPos {
@@ -572,14 +574,6 @@ else
             TDir = X_AX(),
             ADir = Z_AX(),
             Geo = 'BASE/T101'}
-   else
-      EmtTcPos {
-            Name = 'T101',
-            Parent = 'Base',
-            Pos = Point3d( -510.4, 113.2, -1160.8),
-            TDir = X_AX(),
-            ADir = Z_AX(),
-            Geo = 'BASE/T101S'}
    end
    if SecondSupport == 1 then
       -- supporto per punta
@@ -600,19 +594,6 @@ else
                            ADir = Z_AX(),
                            Geo = 'BASE/T111M'}
       EgtSetInfo( TcpSsId, 'Mortiser', true)
-   elseif SecondSupport == 3 then
-      -- supporto per rinvio angolare
-      local TcpSsId = EmtTcPos {
-                           Name = 'T91',
-                           Parent = 'Base',
-                           ExitNbr = 2,
-                           Pos1 = Point3d( -710.4-150, 113.2, -329.8-170),
-                           TDir1 = X_AX(),
-                           Pos2 = Point3d( -710.4+150, 113.2, -329.8-170),
-                           TDir2 = -X_AX(),
-                           ADir = Z_AX(),
-                           Geo = 'BASE/T91',
-                           Aux = 'BASE/T91_HS'}
    end
    if SpecialBH then
       EmtTcPos {
@@ -624,6 +605,37 @@ else
             Geo = 'BASE/T111S'}
    end
 end
+-- motosega in caso di magazzino 2 o SpecialBH
+if SpecialBH or SecondToolChanger then
+   local TcpSsId = EmtTcPos {
+                        Name = 'T101',
+                        Parent = 'Base',
+                        Pos = Point3d( -510.4, 113.2, -1160.8),
+                        TDir = X_AX(),
+                        ADir = Z_AX(),
+                        Geo = 'BASE/T101S'}
+   -- spostamento in caso di magazzino 2
+   if SecondToolChanger then
+      EgtMove( TcpSsId, Vector3d( 0, 0, 140), GDB_RT.GLOB)
+   end
+end
+if SecondSupport == 3 then
+   -- supporto per rinvio angolare
+   local TcpSsId = EmtTcPos {
+                        Name = 'T91',
+                        Parent = 'Base',
+                        ExitNbr = 2,
+                        Pos1 = Point3d( -710.4-150, 113.2, -329.8-170),
+                        TDir1 = X_AX(),
+                        Pos2 = Point3d( -710.4+150, 113.2, -329.8-170),
+                        TDir2 = -X_AX(),
+                        ADir = Z_AX(),
+                        Geo = 'BASE/T91',
+                        Aux = 'BASE/T91_HS'}
+   if SecondToolChanger then
+      EgtMove( TcpSsId, Vector3d( 0, 0, -900), GDB_RT.GLOB)
+   end
+end
 
 -- Aggiusto posizioni geometriche
 local vtMove = Vector3d( 0, ( DeltaTabY - 913.16), ( DeltaTabZ + 830.037))
@@ -654,18 +666,27 @@ PVLightId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( PVId, 'SOLID') or GD
 ---------------------------------------------------------------------
 function OnSetHead()
    -- se testa lama
-   if EMC.HEAD == 'H2' then
-      EmtModifyAxisDirection( 'B', VectorFromRotated( X_AX(), Z_AX(), -SawCOffs))
-   -- altrimenti
+   if EMC.HEAD == 'H1' then
+      if EMC.TOTLEN and EMC.TOTLEN < LONG_TOOL_MINLEN then
+         EmtModifyAxisStroke( 'B', {MinB, MaxB})
+      else
+         EmtModifyAxisStroke( 'B', {-140, 140})
+      end
    else
-      EmtModifyAxisDirection( 'B', X_AX())
-      if EMC.HEAD == 'H3' then
-         local dDist = EgtIf( EMC.DIST and abs( EMC.DIST) > 1, EMC.DIST, ChSawLen)
-         EmtModifyExitPosition( EMC.HEAD, EMC.EXIT, Point3d( 0, 0, -dDist))
-         if not EMC.VER or EMC.VER < '2.5h2' then
-            local vtMove = Point3d( 0, 0, -dDist) - Point3d( EMC.EXITPOS)
-            local ExitId = EgtGetFirstNameInGroup( EgtGetHeadId( EMC.HEAD), 'T'..tostring( EMC.EXIT))
-            EgtMove( ExitId, vtMove)
+      EmtModifyAxisStroke( 'B', {MinB, MaxB})
+      if EMC.HEAD == 'H2' then
+         EmtModifyAxisDirection( 'B', VectorFromRotated( X_AX(), Z_AX(), -SawCOffs))
+      -- altrimenti
+      else
+         EmtModifyAxisDirection( 'B', X_AX())
+         if EMC.HEAD == 'H3' then
+            local dDist = EgtIf( EMC.DIST and abs( EMC.DIST) > 1, EMC.DIST, ChSawLen)
+            EmtModifyExitPosition( EMC.HEAD, EMC.EXIT, Point3d( 0, 0, -dDist))
+            if not EMC.VER or EMC.VER < '2.5h2' then
+               local vtMove = Point3d( 0, 0, -dDist) - Point3d( EMC.EXITPOS)
+               local ExitId = EgtGetFirstNameInGroup( EgtGetHeadId( EMC.HEAD), 'T'..tostring( EMC.EXIT))
+               EgtMove( ExitId, vtMove)
+            end
          end
       end
    end

MachNotes.ini

@@ -22,7 +22,7 @@
 4=l,MaxOptSize,0
 
 [Mortising]
-0=d,MaxElev,0
+0=l,MaxElev,0
 
 [Chiseling]
 

Scripts/SetUp.lua

@@ -51,6 +51,9 @@ if IsTC2Active then
                            {Pos = "Pos19",  TcPos = "T26",  Head = "H1", Group = "G3"},
                            {Pos = "Pos20",  TcPos = "T27",  Head = "H1", Group = "G3"},
                            {Pos = "Pos21",  TcPos = "T28",  Head = "H1", Group = "G3"}}
+   if EgtGetHeadId( 'H5') then
+      table.insert( PositionTableTC2, {Pos = "Pos22", TcPos = "T91", Head = "H5", Group = "G2"})
+   end
    EgtJoinTables( PositionTable, PositionTableTC2)
 else
    local SecSuppId = EgtGetTcPosId( 'T111')

ToolNotes.ini

@@ -6,38 +6,38 @@
 
 [DRILL_STD]
 0=th,TH,
-1=d,STEP
-2=s,DOUBLE
+1=l,STEP
+2=tl,DOUBLE
 
 [SAW_STD]
 0=th,TH,
-1=d,STEP
-2=d,SIDESTEP
+1=l,STEP
+2=l,SIDESTEP
 3=b,LONGCUT
 
 [SAW_FLAT]
 0=th,TH,
-1=d,STEP
-2=d,SIDESTEP
+1=l,STEP
+2=l,SIDESTEP
 3=b,LONGCUT
 
 [MILL_STD]
 0=th,TH,
-1=d,STEP
-2=d,SIDESTEP
-3=d,SIDEDEPTH
-4=s,DOUBLE
-5=dr,TOOL_OVERHANG
+1=l,STEP
+2=l,SIDESTEP
+3=l,SIDEDEPTH
+4=tl,DOUBLE
+5=lr,TOOL_OVERHANG
 
 [MILL_NOTIP]
 0=th,TH,
-1=d,STEP
-2=d,SIDESTEP
-3=d,SIDEDEPTH
-4=s,DOUBLE
-5=dr,TOOL_OVERHANG
+1=l,STEP
+2=l,SIDESTEP
+3=l,SIDEDEPTH
+4=tl,DOUBLE
+5=lr,TOOL_OVERHANG
 
 [MORTISE_STD]
 0=b,MORTISE
-1=d,STEP
-2=d,SIDESTEP
+1=l,STEP
+2=l,SIDESTEP

UpdateLog.txt

@@ -1,5 +1,33 @@
            ==== Common_FAST Update Log ====
 
+Versione 2.7l1 (10/12/2025)
+- (SIM) Aggiornata risoluzione VMillTol in funzione dello spessore lama
+- (EST) Modifiche a calcolo stima tempi, da verificare.
+- (SIM) Corretto movimento in simulazione che non rispettava movimento generato.
+- (GEN) Con controllo NUM/NUM_PLUS nella scrittura della coordinata tolto il simbolo '='
+- (SIM) Aggiunto controllo C in base a carico Dx o Sx durante il cambio utensile
+
+Versione 2.7k1 (10/11/2025)
+- (GEN) Corretto set variabili info utensile prima del movimento in home in caso di pezzi alti per NUM/NUM_PLUS.
+
+Versione 2.7j2 (08/10/2025)
+- (SIM-GEN) Quando si scarica motosega, si raddrizza prima l'asse B e poi si muove il C. Ora sempre e non solo se pezzo alto.
+
+Versione 2.7j1 (06/10/2025)
+- (SIM-GEN) Quando si scarica motosega, si raddrizza prima l'asse B e poi si muove il C.
+- (MLDE-SIM) Controllo collisione tra utensile e TOP testa C. Serve CAM5 2.7j1
+
+Versione 2.7i3 (23/09/2025)
+- (MLDE-ALL) Spostate costanti dimensioni utensili in MLDE.
+
+Versione 2.7i2 (17/09/2025)
+- (EST) Stima tempi considerando accelerazioni
+- (SIM) Prelievo e deposito motosega con gli angoli comunicati da Essetre
+
+Versione 2.7i1 (08/09/2025)
+- (SIM-GEN) Se lavorazione precedente e successiva con motosega e si cambiano assi rotanti, vado in parcheggio per ruotare. Ticket#1844
+- (SIM-GEN) Per NEWCLAMPING, corretto un caso di riposizionemento allo scarico dove la pinza V poteva andare in posizione direttamente, ma cercava di fare passo pellegrino. Ticket#2572
+
 Versione 2.7g1 (01/07/2025)
 - (GEN) Aggiunti parametri FMAXPINZE, MAXACC, MINACC configurabili da TS3. Ticket#2052
 

Version.lua

@@ -3,7 +3,7 @@
 
 local InfoCommon_STD_PP = {
    NAME = 'Common_FAST',            -- nome script PP standard
-   VERSION = '2.7g1',                 -- versione script
+   VERSION = '2.7l1',                 -- versione script
    MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
 }