Merge remote-tracking branch 'origin/develop'

Allineamento con common ver. 3.1e1
Aggiunto Clamp di sicurezza per lettura dei parametri MinJoin da Ts3Data
2026-05-12 16:01:00 +02:00 · 2026-05-12 16:00:50 +02:00 · 2026-04-23 13:05:16 +02:00 · 2026-04-23 13:03:26 +02:00 · 2026-03-12 16:24:17 +01:00 · 2026-03-12 16:24:04 +01:00
13 changed files with 1165 additions and 272 deletions
@@ -12,7 +12,8 @@ local BeamData = {
   MAX_WIDTH = 1300,                        -- larghezza massima del grezzo
   MAX_HEIGHT = 600,                        -- altezza massima del grezzo
   LEN_SHORT_PART = 1200,                   -- lunghezza massima pezzo piccolo
-   MAX_RAW = 20000,                         -- massima lunghezza grezzo (deve essere minore di LenTable - RAW_OFFSET)
+   LEN_VERY_SHORT_PART = 800,               -- lunghezza massima pezzo molto corto (molto probabile lo scarico a caduta)
+   MAX_RAW = 26000,                         -- 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)
@@ -40,6 +41,7 @@ local BeamData = {
   DRILL_TOL = 0.2,                         -- tolleranza tra diametro foro e diametro punta
   DRILL_VZ_MIN = - 0.51,                   -- componente limite in Z del versore di un foro
   DRILL_VX_MAX = 0.867,                    -- componente limite in X del versore di un foro sulle facce laterali
+   MAX_ANGLE_DRILL_CUT = 15,                -- delta angolo massimo tra foro e taglio che lo attraversa
   DRILL_OVERLAP = 5,                       -- sovrapposizione tra due mezze forature
   MILL_OVERLAP = 5,                        -- sovrapposizione tra due mezze fresature
   MAX_DIST_HTFEA = 50.0,                   -- massima distanza di feature da testa o coda per essere considerata tale
@@ -105,7 +107,16 @@ if EgtExistsFile( sDataBeam) then
         BeamData.DIM_STRIP_SMALL = Machine.Offsets.DIM_STRIP_SMALL or BeamData.DIM_STRIP_SMALL
         BeamData.DIM_TO_CENTER_STRIP = Machine.Offsets.DIM_TO_CENTER_STRIP or BeamData.DIM_TO_CENTER_STRIP
         BeamData.MAXDIAM_POCK_CORNER = Machine.Offsets.MAXDIAM_POCK_CORNER or BeamData.MAXDIAM_POCK_CORNER
+         BeamData.LONGCUT_ENDLEN = Machine.Offsets.LONGCUT_ENDLEN or BeamData.LONGCUT_ENDLEN
+         BeamData.LONGCUT_MAXLEN = Machine.Offsets.LONGCUT_MAXLEN or BeamData.LONGCUT_MAXLEN
+         BeamData.ADVANCE_TAIL_OFFS = Machine.Offsets.ADVANCE_TAIL_OFFS or BeamData.ADVANCE_TAIL_OFFS
+         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.OVM_MID = Machine.Offsets.OVM_MID or BeamData.OVM_MID
+         if Machine.Offsets.MAX_ANGLE_DRILL_CUT then BeamData.MAX_ANGLE_DRILL_CUT = EgtClamp( Machine.Offsets.MAX_ANGLE_DRILL_CUT, 1, 89) end
+         if Machine.Offsets.CUT_SIC then BeamData.CUT_SIC = EgtClamp( Machine.Offsets.CUT_SIC, 15, 50) end
+         if Machine.Offsets.MIN_JOIN_S then BeamData.MIN_JOIN_S = EgtClamp( Machine.Offsets.MIN_JOIN_S, 80, 150) end
+         if Machine.Offsets.MIN_JOIN_L then BeamData.MIN_JOIN_L = EgtClamp( Machine.Offsets.MIN_JOIN_L, 300, 450) end
      end
      if Machine.Trave then
         BeamData.MIN_WIDTH = Machine.Trave.XMIN or BeamData.MIN_WIDTH
@@ -218,45 +229,65 @@ local function GetBlockedAxis( sHead, nToolType, sBlockedAxis)
 end
 BeamData.GetBlockedAxis = GetBlockedAxis

+---------------------------------------------------------------------
+local function GetMinNzTopBladeDownUp( b3Raw, vtNFace, vtToolDirection)
+   return -0.484
+end
+
 ---------------------------------------------------------------------
 local function GetSetupInfo( sHead)
   local SetupInfo = {}

   -- dati comuni
-   SetupInfo.bIsCSymmetric = true
+   SetupInfo.bIsCSymmetrical = true
   SetupInfo.dCAxisEncumbrance = 180
   SetupInfo.bToolOnAggregate = false
   
   -- testa 5 assi da sopra
   if sHead == 'H11' then
-      SetupInfo.bIsTopHead = true
-      SetupInfo.bIsBottomHead = not SetupInfo.bIsTopHead
-      SetupInfo.dMaxNegativeAngle = sin( -35)
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMinNz = function() return sin( -35) end
   -- lama su aggregato testa 5 assi da sopra
   elseif sHead == 'H12' then
-      SetupInfo.bIsTopHead = true
-      SetupInfo.bIsBottomHead = not SetupInfo.bIsTopHead
-      SetupInfo.dMaxNegativeAngle = sin( -35)
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMinNz = function() return sin( -35) end
+      -- se con aggregato si considera non simmetrico
+      SetupInfo.bIsCSymmetrical = false
+      -- riduzione massimo materiale se usato in tagli orizzontali con affondamento verticale
+      SetupInfo.dMaxMatDecrease = 25
+      SetupInfo.GetMinNzDownUp = GetMinNzTopBladeDownUp
   -- seconda lama su aggregato testa 5 assi da sopra
   elseif sHead == 'H16' then
-      SetupInfo.bIsTopHead = true
-      SetupInfo.bIsBottomHead = not SetupInfo.bIsTopHead
-      SetupInfo.dMaxNegativeAngle = sin( -35)
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMinNz = function() return sin( -35) end
+      -- se con aggregato si considera non simmetrico
+      SetupInfo.bIsCSymmetrical = false
+      -- riduzione massimo materiale se usato in tagli orizzontali con affondamento verticale
+      SetupInfo.dMaxMatDecrease = 25
+      SetupInfo.GetMinNzDownUp = GetMinNzTopBladeDownUp
   -- motosega
   elseif sHead == 'H13' then
-      SetupInfo.bIsTopHead = true
-      SetupInfo.bIsBottomHead = not SetupInfo.bIsTopHead
-      SetupInfo.dMaxNegativeAngle = 0
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMinNz = function() return 0 end
+      SetupInfo.dZSafeDelta = 60
   -- testa 5 assi da sotto
   elseif sHead == 'H21' then
-      SetupInfo.bIsBottomHead = true
-      SetupInfo.bIsTopHead = not SetupInfo.bIsBottomHead
-      SetupInfo.dMaxPositiveAngle = sin( 25)
+      SetupInfo.HeadType = { bTop = false, bBottom = true}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMaxNz = function() return sin( 25) end
   -- lama su aggregato testa 5 assi da sotto
   elseif sHead == 'H22' then
-      SetupInfo.bIsBottomHead = true
-      SetupInfo.bIsTopHead = not SetupInfo.bIsBottomHead
-      SetupInfo.dMaxPositiveAngle = sin( 25)
+      SetupInfo.HeadType = { bTop = false, bBottom = true}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.GetMaxNz = function() return sin( 25) end
+      -- se con aggregato si considera non simmetrico
+      SetupInfo.bIsCSymmetrical = false
+      -- riduzione massimo materiale se usato in tagli orizzontali con affondamento verticale
+      SetupInfo.dMaxMatDecrease = 25
   end

   return SetupInfo
@@ -12,6 +12,8 @@
 4=Pocket_H2
 5=Predrill
 6=Predrill_H2
+7=AngleDrill
+8=AngleDrill_H2

 [Milling]
 1=Prof
@@ -49,6 +51,7 @@
 33=AntiSplintMillCut_H2
 34=SideMillAsBlade
 35=SideMillAsBlade_H2
+36=Prof_end

 [Pocketing]
 1=Pocket
@@ -28,7 +28,9 @@ function OnStart()
   --EMT.LINEINC = 1        -- incremento numerazione linee
   --EMT.Ft = 'F'           -- token per feed
   --EMT.St = 'S'           -- token per speed
-   EMT.FMAXPINZE = 116000 -- feed massima pinze
+   EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 116000, 20000, 130000)  -- feed massima pinze
+   EMT.MAXACC = MaxAcc or 6000    -- accelerazione massima pinze. In realtà è il tempo in millisecondi, quindi MAXACC corrisponde al tempo massimo per raggiungere la velocità desiderata
+   EMT.MINACC = MinAcc or 600     -- accelerazione minima pinze. In realtà è il tempo in millisecondi, quindi MINACC corrisponde al tempo massimo per raggiungere la velocità desiderata
   SetToParkLine()        -- si inizia con linee da parcheggiare su stack
 end

@@ -51,6 +53,7 @@ function OnProgramStart()
   end
   MyOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
   MyOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')')
+   MyOutput( '(HEADER)')

   -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
   if TEST_USE then
@@ -102,6 +105,7 @@ function OnProgramEnd()
   EMT.FALL = nil
   EMT.RELOAD = nil
   EMT.RELOAD2 = nil
+   MyOutput( '(FOOTER)')
   -- Termino il programma
   MyOutput( 'M202')
   MyOutput( 'M02')
@@ -128,6 +132,8 @@ function OnToolData()
         dAddLen = -SawOffsZ
      elseif EMT.HEAD == 'H16' then
         dAddLen = -Saw2OffsZ
+      elseif EMT.HEAD == 'H14' then
+         dAddLen = 206 -- dimensione aggregato
      end
      local sOut = 'M992 P1=' .. EMT.TCPOS:gsub( 'T', '') .. ' P2=' .. EmtLenToString( dAddLen + EMT.TLEN, 3) .. ' P3=' .. EmtLenToString( EMT.TDIAM, 3) ..
                   ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( dAddLen + EMT.TTOTLEN, 3)
@@ -288,6 +294,8 @@ function OnDispositionEnd()
      for i = 1, #EMT.MDCHAR do
         EmitMoveDataChars( EMT.MDCHAR[i])
         if EMT.MDCHAR[i].Y1 then EMT.CHY_ON = true end
+         if EMT.MDCHAR[i].V1 then EMT.V1POS = EMT.MDCHAR[i].V1 end
+         if EMT.MDCHAR[i].V2 then EMT.V2POS = EMT.MDCHAR[i].V2 end
      end
      if #EMT.MDCHAR > 0 then
         local nMoveType = EgtIf( EMT.CHY_ON, 3, 2)
@@ -350,6 +358,7 @@ function OnRawMoveData()
            EMT.HT = b3Part:getDimY()
            EMT.ST = b3Part:getDimZ()
            EMT.HOVM = EgtGetInfo( EMT.RAWID, 'HOVM', 'd') or 0
+            EMT.XMINT = b3Part:getMin():getX()
            EMT.PARTTYPE = 0
            local sMaterial = EgtGetInfo( PartId, 'MATERIAL')
            if sMaterial and sMaterial:find( 'CLT-', 1, true) == 1 then
@@ -397,6 +406,7 @@ function OnMachiningStart()
   EMT.MCHNAME = EgtGetOperationName( EMT.MCHID)
   EMT.MCHTYPE = EgtGetMachiningParam( MCH_MP.TYPE)
   EMT.MCHUSERNOTES = EgtGetMachiningParam( MCH_MP.USERNOTES)
+   EMT.MCHPRECUT = ( EMT.MCHUSERNOTES:find( 'Precut;', 1, true) ~= nil)
   EMT.MCHCUT = ( EMT.MCHUSERNOTES:find( 'Cut;', 1, true) ~= nil)

   -- se sega a catena, aggiusto subito angolo scelto per asse virtuale A
@@ -406,6 +416,13 @@ function OnMachiningStart()
      -- imposto home dell'asse C1 (A=0 -> T101, A=90 -> T104)
      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
      EmtModifyAxisHome( 'C1', MyParkCSawC1)
+   -- aggregato foratura multipla, aggiusto subito angolo scelto per asse virtuale A
+   elseif EMT.HEAD == 'H14' then
+      -- valore dell'asse virtuale
+      dPosA = GetCurrMultiDrillVirtualAxis()
+      -- imposto home dell'asse C1 (A=0 -> T121, A=90 -> T124)
+      local MyParkMultiDrillC1 = GetMultiDrillCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
+      EmtModifyAxisHome( 'C1', MyParkMultiDrillC1)
   -- se lama su aggregato testa sotto, aggiusto subito angolo scelto per asse virtuale A
   elseif EMT.HEAD == 'H22' then
      -- valore dell'asse virtuale
@@ -523,6 +540,7 @@ function OnMachiningEnd()
               local sEnd= 'M113 P1='..tostring( EMT.PRODID)..' P2='..tostring( EMT.PATTID)..' P3='..tostring( EMT.CUTID)..' P4=2' 
               MyOutput( sEnd)
            end
+            EMT.FALL = nil
         elseif not EMT.PREROT then
            MyOutput( 'M77')
         end
@@ -558,12 +576,25 @@ end

 ---------------------------------------------------------------------
 function OnPathStart()
+   if EMT.OPEISDISP then
+      return
+   end
   -- non ancora iniziata la lavorazione
   EMT.MCHFIRST = true
   EMT.MCHFIRSTFEED = true
   -- primo posizionamento sempre in globale
+   -- primo posizionamento sempre in globale
   EMT.REFLOC = nil
   EMT.IPLGL = false
+
+
+   -- se taglio di precut verifico quanto è più lungo il grezzo rispetto al pezzo (non tiene conto dell'ultimo cubetto)
+   EMT.DELTA_LT = 0
+   if EMT.MCHPRECUT then
+      local dCosA = sqrt( max( 1 - EMT.EXTR[1] * EMT.EXTR[1], 0))
+      EMT.DELTA_LT = max( EMT.XMINT - Point3d( EMT.MMAX):getX() - dCosA * EMT.TDIAM / 2, 0) 
+   end
+
   -- leggo se ancora presa iniziale carrello
   --EMT.CNT = EgtGetInfo( EMT.PATHID, 'CNT', 'i')
   --MyOutput( 'CNT='.. tostring( EMT.CNT or 0))
@@ -571,8 +602,8 @@ function OnPathStart()
   if EMT.TOOL == EMT.PREVTOOL and not EMT.ZMAX then
      EMT.L2pp = EMT.L2op
      EMT.L3pp = EMT.L3op
-      EMT.R1pp = EMT.R1p
-      EMT.R2pp = EMT.R2p
+      EMT.R1pp = EMT.R1p or EMT.R1pp
+      EMT.R2pp = EMT.R2p or EMT.R2pp
   else
      EMT.L2pp = nil
      EMT.L3pp = nil
@@ -587,6 +618,9 @@ end

 ---------------------------------------------------------------------
 function OnPathEnd()
+   if EMT.OPEISDISP then
+      return
+   end
   if not EMT.ZMAX then
      EmitResetMachining()
   end
@@ -613,6 +647,9 @@ function OnPathStartAux()
   local Cmd = EgtSplitString( EMT.AUX)
   if Cmd[1] == '4' then
      EMT.TO_ZMAX = true
+      if Cmd[2] == '1' then
+         EMT.ROLL_IN = true
+      end
   end
 end

@@ -729,9 +766,12 @@ function OnRapid()
            local MyMaxZ1 = EgtGetAxisMax( 'Z1')
            -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
            local bXSpec = EgtIf( BD.RIGHT_LOAD, ( EMT.L2 > -DeltaTabY), ( EMT.L2 < -DeltaTabY))
-            EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
-            EmitMoveStartHead( 1)
-            EmitMoveWaitHead( 1)
+            -- se non è aggregato, posso preselezionare testa e andare in posizione
+            if EMT.HEAD ~= 'H13' and EMT.HEAD ~= 'H14' then
+               EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
+               EmitMoveStartHead( 1)
+               EmitMoveWaitHead( 1)
+            end
            EmitMoveWaitChars( EgtIf( bOnlyCharY, 1, 3))
            -- se necessario allargo le cabine
            if RollerParkingNeeded( EMT.HEAD, PrevR1, PrevR2, EMT.R1, EMT.R2) or
@@ -749,7 +789,15 @@ function OnRapid()
               EmitMoveDataHead( 1, { B=0, S=Speed})
               EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
               EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
-               EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
+               -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+               -- evita collisione con carro X
+               if EMT.R2 > 91 or EMT.R2 < -91 then
+                  local dBref = EgtClamp( EMT.R2, -91, 91)
+                  EmitMoveDataHead( 1, { Z=EMT.L3, B=dBref, S=Speed})
+                  EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
+               else
+                  EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
+               end
            -- caso standard
            else
               -- se bisogna scrivere tutti gli assi
@@ -757,6 +805,9 @@ function OnRapid()
                  -- se sega a catena
                  if EMT.HEAD == 'H13' then
                     EmitMoveDataHead( 1, { X=-ParkCSawX1, Z=HomeZ1, B=HomeR2, C=HomeR1, TRad=dTRad, TLen=dTLen, S=Speed})
+                  -- aggregato foratore multiplo
+                  elseif EMT.HEAD == 'H14' then
+                     EmitMoveDataHead( 1, { X=-ParkMultiDrillX1, Z=HomeZ1, B=HomeR2, C=HomeR1, TRad=dTRad, TLen=dTLen, S=Speed})
                  -- utensili standard
                  else
                     -- utensili lunghi
@@ -849,8 +900,8 @@ function OnRapid()
               EmitParkRoller( dPosT, bSplitCut)
            end
            -- vado a quota sicurezza in X per permettere rotazione assi rotanti
-            if ( not EMT.L2pp or ( EMT.L2pp and EMT.L2pp > ParkMchY2)) and ( ParkB2 ~= EMT.R2  or  ParkC2 ~= EMT.R1) then
-               EmitMoveDataHead( 2, { X=ParkMchY2, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed}) 
+            if ( not EMT.L2pp or ( EMT.L2pp and EMT.L2pp > SafeX2RotAxis)) and ( ParkB2 ~= EMT.R2  or  ParkC2 ~= EMT.R1) then
+               EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed}) 
            end
            -- scrivo solo se gli assi rotanti sono cambiati
            if EMT.HEAD == 'H22' and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
@@ -870,11 +921,12 @@ function OnRapid()
         else
            -- selezione testa (posso muovere X solo a Zmax)
            local MaxZ3 = EgtGetAxisMax( 'Z3')
+            local MyParkX3 = EgtGetAxisHomePos( 'X3')
            -- se bisogna scrivere tutti gli assi
            if WriteAllCoordsOnFirstM101 then
-               EmitMoveDataHead( 3, { X=EMT.L2, Z=MaxZ3, B=ParkB3, C=0, S=Speed})
+               EmitMoveDataHead( 3, { X=MyParkX3, Z=MaxZ3, B=ParkB3, C=ParkC3, S=Speed})
            else
-               EmitMoveDataHead( 3, { X=EMT.L2, Z=MaxZ3, S=Speed})
+               EmitMoveDataHead( 3, { X=MyParkX3, Z=MaxZ3, S=Speed})
            end
            EmitMoveStartHead( 3)
            EmitMoveWaitHead( 3)
@@ -885,6 +937,8 @@ function OnRapid()
               local dPosT = EMT.TPOS or EMT.L1op
               EmitParkRoller( dPosT, bSplitCut)
            end
+            -- eventuale preselezione successiva testa 2
+            PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
            -- eseguo movimenti
            local Speed = EMT.S
            -- se è macchina a 3 teste con gruppo truciolatore 4 assi
@@ -892,35 +946,31 @@ function OnRapid()
               EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
               EmitMoveDataHead( 3, { B=EMT.R2, C=EMT.R1, S=Speed})
               EmitMoveStartHead( 3)
-               -- eventuale preselezione successiva testa 2
-               PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
-               -- aspetto esecuzione movimento testa 3
-               EmitMoveWaitHead( 3)
            -- se gruppo lama dedicato, senza cambio utensile
            elseif EgtGetHeadId( 'H38') then
               local B3Home = EgtGetAxisHomePos( 'B3')
               local C3Home = EgtGetAxisHomePos( 'C3')
-               EmitMoveDataHead( 3, { X=SafeX3RotAxis, S=Speed})
+               EmitMoveDataHead( 3, { X=-SafeX3RotAxis, S=Speed})
               -- se non sono esattamente in home, devo ruotare in zona sicura
               if abs( C3Home - EMT.R1) > 1 or abs( B3Home - EMT.R2) > 1 then
                  EMT.L3 = min( EMT.L3, SafeZ3RotAxis)
                  EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, S=Speed})
                  EmitMoveDataHead( 3, { B=EMT.R2, C=EMT.R1, S=Speed})
-                  EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                  if ( EMT.L3 - SafeZ3RotAxis) > 100 * GEO.EPS_SMALL then
+                     EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                  end
                  EmitMoveDataHead( 3, { X=EMT.L2, S=Speed})
               end
               -- muovo in posizione finale
               EmitMoveDataHead( 3, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})
-
-               EmitMoveStartHead( 3)
-               -- eventuale preselezione successiva testa 2
-               PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
-               -- aspetto esecuzione movimento testa 3
-               EmitMoveWaitHead( 3)
-            -- errore, testa non gestita
            else
               EmtSetLastError( 1212, "HEAD not managed")
            end
+
+            EmitMoveStartHead( 3)
+            -- aspetto esecuzione movimento testa 3
+            EmitMoveWaitHead( 3)
+            -- errore, testa non gestita
         end
         -- dati aggancio a trave
         local BhData = { T=EMT.L1, SetHead=0}
@@ -974,17 +1024,18 @@ function OnRapid()
      else
         --MyOutput( string.format( 'V1Pos=%.3f V2Pos=%.3f', EMT.V1POS, EMT.V2POS))
         if not EMT.RELOAD and not EMT.ZMAX and #EMT.AUXCMD > 0 and EMT.TO_ZMAX then
+            local bGotoHome = EMT.HEAD == 'H38' and EMT.ROLL_IN
            -- caso speciale in cui bisogna solo cambiare presa aggregato lama sotto
            if EMT.R3_CHANGED then
               -- EmitZmax è fatta per essere chiamata con utensile attuale. In questo caso l'attuale è già quello con nuova rotazione
               -- Allora salvo l'attuale e imposto il vecchio solo momentanemente, per poi ripristinarlo
               local sBckTcPos = EMT.TCPOS
               EMT.TCPOS = EMT.PREVTCPOSREAL_H2
-               EmitZmax( false, false, PrevR1, PrevR2, false, false, true)
+               EmitZmax( false, false, PrevR1, PrevR2, false, bGotoHome, true)
               EMT.TCPOS = sBckTcPos
               EMT.R3_CHANGED = nil
            else
-               EmitZmax( false, false, PrevR1, PrevR2, false, false, true)
+               EmitZmax( false, false, PrevR1, PrevR2, false, bGotoHome, true)
            end
            EMT.ZMAX = true
            EMT.TO_ZMAX = nil
@@ -1060,7 +1111,15 @@ function OnRapid()
                     EmitMoveDataHead( 1, { Z=MyMaxZ1, B=0, S=Speed})
                     EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
                     EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
-                     EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
+                     -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                     -- evita collisione con carro X
+                     if EMT.R2 > 91 or EMT.R2 < -91 then
+                        local dBref = EgtClamp( EMT.R2, -91, 91)
+                        EmitMoveDataHead( 1, { Z=EMT.L3, B=dBref, S=Speed})
+                        EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
+                     else
+                        EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
+                     end
                  -- caso standard
                  else
                     -- se ero in posizione speciale, prima ruoto poi scendo
@@ -1081,16 +1140,24 @@ function OnRapid()
               -- altrimenti sega a catena
               else
                  -- se bisogna scrivere tutti gli assi
+                  local dSafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
                  if WriteAllCoordsOnFirstM101 then
-                     local dSafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
                     EmitMoveDataHead( 1, { X=-ParkCSawX1, Z=dSafeZ1, B=HomeB1, C=HomeC1, TRad=dTRad, TLen=dTLen, S=Speed})
                  end
                  -- Porto la Z alla giusta quota
-                  if EMT.L3 > HomeZ1 + 1 and abs( EMT.R2) > 89.9 then
+                  if EMT.L3 > dSafeZ1 + 1 and abs( EMT.R2) > 89.9 then
                     EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
-                     EmitMoveDataHead( 1, { Z=HomeZ1, S=Speed})
+                     EmitMoveDataHead( 1, { Z=dSafeZ1, S=Speed})
+                  end
+                  local dChSawEncumbrance = EMT.L3 + MillOffs - ( ( ChSawLen + MillOffs) * EMT.ADIR[3]) - ( EMT.TTOTLEN * EMT.TDIR[3])
+                  local dBeamQuote = DeltaTabZ + EMT.SB + 30
+                  if dChSawEncumbrance < dBeamQuote then
+                     EmitMoveDataHead( 1, { Z=dSafeZ1, B=EMT.R2, S=Speed})
+                     EmitMoveDataHead( 1, { X=EMT.L2, C=EMT.R1, S=Speed})
+                     EmitMoveDataHead( 1, { Z=EMT.L3, S=Speed})
+                  else
+                     EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
                  end
-                  EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
                  -- se motosega molto lunga, ruoto prima di muovermi in X
                  if EMT.TTOTLEN >= MinLengthLongCSaw then
                     EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
@@ -1182,20 +1249,20 @@ function OnRapid()
                  end
                  -- scrivo solo se gli assi rotanti sono cambiati
                  EmitMoveDataHead( 2, { Z=-dSafeZ2, S=Speed})
-                  if EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                     EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+                  if EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                     EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                  end
               else
                  -- scrivo solo se gli assi rotanti sono cambiati
-                  if EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                     EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+                  if EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                     EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                  end
               end
            -- se stesso utensile vado già alla X di lavoro
            else
               -- scrivo solo se gli assi rotanti sono cambiati
-               if EMT.ZMAX and EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                  EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+               if EMT.ZMAX and EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                  EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
               end
            end
            -- scrivo solo se gli assi rotanti sono cambiati
@@ -1214,6 +1281,8 @@ function OnRapid()
            EmitMoveWaitHead( 2)
         -- altrimenti testa 3
         else
+            -- eventuale preselezione successiva testa 2
+            PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
            -- selezione testa (posso muovere X solo a Zmax)
            local MyMaxZ3 = EgtGetAxisMax( 'Z3')
            local dSafeZ3 = EgtGetAxisHomePos( 'Z3')
@@ -1241,13 +1310,15 @@ function OnRapid()
               if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                  local B3Home = EgtGetAxisHomePos( 'B3')
                  local C3Home = EgtGetAxisHomePos( 'C3')
-                  EmitMoveDataHead( 3, { X=SafeX3RotAxis, S=Speed})
+                  EmitMoveDataHead( 3, { X=-SafeX3RotAxis, S=Speed})
                  -- se non sono esattamente in home, devo ruotare in zona sicura
                  if abs( C3Home - EMT.R1) > 1 or abs( B3Home - EMT.R2) > 1 then
                     EMT.L3 = min( EMT.L3, SafeZ3RotAxis)
                     EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, S=Speed})
                     EmitMoveDataHead( 3, { B=EMT.R2, C=EMT.R1, S=Speed})
-                     EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                     if ( EMT.L3 - SafeZ3RotAxis) > 100 * GEO.EPS_SMALL then
+                        EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                     end
                     EmitMoveDataHead( 3, { X=EMT.L2, S=Speed})
                  end
               end
@@ -1258,8 +1329,6 @@ function OnRapid()
            end
            
            EmitMoveStartHead( 3)
-            -- eventuale preselezione successiva testa 2
-            PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
            -- aspetto esecuzione movimento testa 3
            EmitMoveWaitHead( 3)
         end
@@ -1366,6 +1435,7 @@ function OnRapid()
         MyOutput( 'M98')
         MyOutput( 'M6 ' .. GetHeadToolCode() .. AdjustTcPos( true))
         MyOutput( 'G24' .. EMT.IPLGLSTR)
+         EMT.PLANEACTIVE = true
         -- forzo successiva emissione assi rotanti
         EMT.R1p = nil
         EMT.R2p = nil
@@ -1402,7 +1472,9 @@ function OnRapid()
      local bSplitCut = ( EMT.MCHUSERNOTES:find( 'Split', 1, true) ~= nil)
      -- porto in home la testa corrente se lavorazione successiva sopra con testa diversa oppure se punta lunga
      local nNextTopHSet = GetNextTopHSet( EMT.MCHID)
-      local bTopGoHome = ( nHSet ~= 2 and nNextTopHSet ~= 0 and nHSet ~= nNextTopHSet) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
+      -- ricavo prossimo utensile
+      local sNextTool = GetNextTool( EMT.MCHID)
+      local bTopGoHome = ( IsLastPath( EMT.PATHID) and not sNextTool and nHSet == 3)  or EMT.HEAD == 'H38' or ( nHSet ~= 2 and nNextTopHSet ~= 0 and nHSet ~= nNextTopHSet) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
      EmitZmax( true, true, EMT.R1p, EMT.R2p, bSplitCut, bTopGoHome, false)
      -- aggiorno quota finale trave dopo Zmax
      EMT.L1o = EMT.TPOS
@@ -1445,6 +1517,7 @@ function OnLinear()
      MyOutput( 'M98')
      MyOutput( 'M6 ' .. GetHeadToolCode() .. AdjustTcPos( true))
      MyOutput( 'G24' .. EMT.IPLGLSTR)
+      EMT.PLANEACTIVE = true
      -- emissione movimento
      EMT.R1p = nil
      EMT.R2p = nil
@@ -1535,6 +1608,7 @@ function OnArc()
      MyOutput( 'M98')
      MyOutput( 'M6 ' .. GetHeadToolCode() .. AdjustTcPos( true))
      MyOutput( 'G24' .. EMT.IPLGLSTR)
+      EMT.PLANEACTIVE = true
      -- emissione movimento
      EMT.R1p = nil
      EMT.R2p = nil
@@ -1597,28 +1671,6 @@ function OnArc()
   EmtUpdatePrev()
 end

---------------------------------------------------------------------
-function CalcDinamicaPinze( dH, dS, dL)
-   local MinTempoAcc = 0.6                         -- [s]
-   local MaxTempoAcc = 6.0                         -- [s]
-   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)
-   if ( TempoAcc < MinTempoAcc) then TempoAcc = MinTempoAcc end
-   if ( TempoAcc > MaxTempoAcc) then TempoAcc = MaxTempoAcc end
-   local AccMaxPinze = FMaxPinze / ( 60 * MinTempoAcc)
-   local AccPinze = FMaxPinze / ( 60 * TempoAcc)
-   local RidFeed = 100 / Massa * 100
-   if RidFeed > 100 then
-      RidFeed = 100
-   elseif RidFeed < 10 then
-      RidFeed = 10
-   end
-   return TempoAcc * 1000, MinTempoAcc * 1000, RidFeed
-end
-
 ---------------------------------------------------------------------
 function CalcForzaPinze( dH, dS, dL, dT)
   local MassaRef = 1500                              -- [Kg]
@@ -2039,7 +2091,8 @@ function PrepareUnload( sCmd, nInd)
      if Cmd[4] == 'Y2' then
          -- se non è ultima fase c'è una barra sulla pinza Y1
         local bBarOnY = ( EMT.PHASE < EgtGetPhaseCount() and not IsEnd2Phase( EMT.PHASE))
-         local MDChar = { Y2=tonumber(Cmd[5]), IniStatY1=EgtIf( bBarOnY, -1, 1), FinStatY1=EgtIf( bBarOnY, -1, 1), IniStatY2=-1, FinStatY2=1, IniStatV2=1, BeamVise=2, MovType=EgtIf( EMT.CHY_ON, 3, 2)}
+         local bManualUnl = ( Cmd[4] and Cmd[4] == 'Manual Unloading')
+         local MDChar = { Y2=tonumber(Cmd[3]), V2=EgtIf( bManualUnl, MaxV2, ParkV2), IniStatY2=1, FinStatY2=EgtIf( bManualUnl, -85, -84), BeamVise=EgtIf( bBarOnY, 1, 0), MovType=EgtIf( EMT.CHY_ON, 3, 2)}
         table.insert( EMT.MDCHAR, MDChar)
      end
   elseif Cmd[1] == '3' then
@@ -2190,6 +2243,9 @@ end

 ---------------------------------------------------------------------
 function GetV1ToCloseTPA()
+   if EMT.MCHPRECUT or EMT.MCHCUT then
+      return false
+   end
   local dMaxHeadPos = EMT.MAXMAX[1] + ( EMT.HOVM or 0) - ( EMT.X_OFF or 0)
   local dMinTailPos = EMT.MAXMIN[1] + EMT.LB + EgtIf( IsStartOrMidPhase( EMT.PHASE), 0, ( EMT.HOVM or 0)) - ( EMT.X_OFF or 0)
   --MyOutput( string.format( 'V1 MaxHeadPos=%.3f MinTailPos=%.3f BarLen=%.3f HeadOvm=%.3f V1NextPos=%.3f', dMaxHeadPos, dMinTailPos, EMT.LB, ( EMT.HOVM or 0), EMT.V1NEXTPOS))
@@ -2285,30 +2341,53 @@ function AdjustTcPos( bLen3, sTcPos, dAxR3)
   end
   if sPos == '101' then
      if not dAxR3 then dAxR3 = EMT.R3 end
-      if abs( dAxR3 - 0) < 0.1 then
-         sPos = '101'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '102'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '103'
-      elseif abs( dAxR3 - 90) < 0.1 then
-         sPos = '104'
-      else
-         EmtSetLastError( 1210, 'Chain saw orientation not allowed')
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '101'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '102'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '103'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '104'
+         else
+            EmtSetLastError( 1210, 'Tool T101 orientation not allowed')
+         end
      end
   end
   if sPos == '111' then
-      if not dAxR3 then dAxR3 = EMT.R3 end
-      if abs( dAxR3 - 0) < 0.1 then
-         sPos = '111'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '112'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '113'
-      elseif abs( dAxR3 - 90) < 0.1 then
-         sPos = '114'
-      else
-         EmtSetLastError( 1210, 'Chain saw orientation not allowed')
+      if not dAxR3 then dAxR3 = EMT.R3 or 0 end
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '111'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '112'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '113'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '114'
+         else
+            EmtSetLastError( 1210, 'Tool T111 orientation not allowed')
+         end
+      end
+   end
+   if sPos == '121' then
+      if not dAxR3 then dAxR3 = EMT.R3 or 0 end
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '121'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '122'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '123'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '124'
+         else
+            EmtSetLastError( 1210, 'Tool T121 orientation not allowed')
+         end
      end
   end
   if sPos == '201' then
@@ -2468,7 +2547,17 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome, bUsePrev
         -- salgo in Z sicurezza raddrizzando la B
         local dSafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
         EmitMoveDataHead( 1, { Z=dSafeZ1, B=dHomeB1, Fmt=1})
-         EmitMoveDataHead( 1, { X=-dHomeX1, C=dHomeC1, Fmt=1})
+         -- lascio la motosega a parcheggio. In caso di utilizzo della testa 3, la motosega viene scaricata automaticamente dalla macro.
+         EmitMoveDataHead( 1, { X=-ParkCSawX1, C=dHomeC1, Fmt=1})
+         EmitMoveStartHead( 1)
+         EmitMoveWaitHead( 1)
+      end
+      -- se ho degli aggregati e la prossima è la testa 3, scarico e prendo utensile di default
+      local nNextTopHSet = GetNextTopHSet( EMT.MCHID)
+      if IsHeadExisting( 3) and nNextTopHSet == 3 and ( EMT.TCPOS == 'T101' or EMT.TCPOS == 'T111' or EMT.TCPOS == 'T121') then
+         -- lascio la motosega a parcheggio. In caso di utilizzo della testa 3, la motosega viene scaricata automaticamente dalla macro.
+         local sDefToolToLoad = AdjustTcPos( false, DefTcPos1)
+         EmitMoveDataHead( 1, { X=-ParkX1, TPos=sDefToolToLoad, Fmt=1})
         EmitMoveStartHead( 1)
         EmitMoveWaitHead( 1)
      end
@@ -2519,9 +2608,9 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome, bUsePrev
            local dPosT = EgtIf( bEnd, EMT.L1o, EMT.TPOS or EMT.L1op)
            EmitParkRoller( dPosT, bSplitCut)
         end
-         -- se non sono esattamente in home, devo ruotare in zona sicura
+         -- se non sono esattamente in home, ruoto dove sono
         if abs( dHomeC3 - PrevR1) > 1 or abs( dHomeB3 - PrevR2) > 1 then
-            EmitMoveDataHead( 3, { X=SafeX3RotAxis, Fmt=1})
+            --EmitMoveDataHead( 3, { X=-SafeX3RotAxis, Fmt=1})
            EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, Fmt=1})
            EmitMoveDataHead( 3, { B=dHomeB3, C=dHomeC3, Fmt=1})
         end
@@ -2567,15 +2656,19 @@ end

 ---------------------------------------------------------------------
 function EmitResetMachining()
-   MyOutput( 'G27')
-   if EMT.PREFALLCUT then
-      MyOutput( 'M29')
-      EMT.PREFALLCUT = nil
+   if EMT.PLANEACTIVE then
+      MyOutput( 'G27')
+      if EMT.PREFALLCUT then
+         MyOutput( 'M29')
+         EMT.PREFALLCUT = nil
+      end
+      local sP12 = ''
+      if EMT.TOOL ~= GetNextTool( EMT.MCHID) then sP12 = EgtIf( EMT.HEAD ~= 'H21', ' P1=0'..EgtIf( EMT.DOU_TYPE, ' P2=0', ''), ' P2=0') end
+      local sP4 = EgtIf( EMT.MCHUSERNOTES:find( 'Split', 1, true), ' P4=1', '')
+      MyOutput( 'M99'..sP12..sP4)
+      -- piano non più attivo
+      EMT.PLANEACTIVE = false
   end
-   local sP12 = ''
-   if EMT.TOOL ~= GetNextTool( EMT.MCHID) then sP12 = EgtIf( EMT.HEAD ~= 'H21', ' P1=0'..EgtIf( EMT.DOU_TYPE, ' P2=0', ''), ' P2=0') end
-   local sP4 = EgtIf( EMT.MCHUSERNOTES:find( 'Split', 1, true), ' P4=1', '')
-   MyOutput( 'M99'..sP12..sP4)
 end

 ---------------------------------------------------------------------
@@ -2640,8 +2733,8 @@ function EmitParkRoller( dPosT, bSplitCut)
      local dPosY2 = dPosT + EMT.Y2DELTA
      local DiffY2 = MyParkY2 - dPosY2
      local dMoveY2 = EgtIf( DiffY2 < -0.1, dMoveV2, 0)
-      local dTryMoveY2 = max( ParkV2 - dPosT - EMT.LT - EMT.HOVM, MinY2 - dPosY2 + 10)
-      if ( dPosT + EMT.LT + EMT.HOVM < ParkV1 + ExtraParkV and dPosT + EMT.LT + EMT.HOVM > ParkV2 and dPosY2 + dTryMoveY2 > MinY2) then dMoveY2 = min( dMoveY2, dTryMoveY2) end
+      local dTryMoveY2 = max( ParkV2 - dPosT - EMT.LT - EMT.DELTA_LT - EMT.HOVM, MinY2 - dPosY2 + 10)
+      if ( dPosT + EMT.LT + EMT.DELTA_LT + EMT.HOVM < ParkV1 + ExtraParkV and dPosT + EMT.LT + EMT.DELTA_LT + EMT.HOVM > ParkV2 and dPosY2 + dTryMoveY2 > MinY2) then dMoveY2 = min( dMoveY2, dTryMoveY2) end
      --MyOutput( string.format( 'PosT=%.3f LT=%.3f PosY2=%.3f V2POS=%.3f', dPosT, EMT.LT, dPosY2, EMT.V2POS))
      MDChar.Y2 = dPosY2 + dMoveY2
      MDChar.MovType = 2
@@ -2756,35 +2849,44 @@ function PreselectNextDiffHead( nMchId, sHead)
               end
            -- altrimenti (testa 3)
            else
-               -- se preselezione testa 1
-               if nNextHSet == 1 then
-                  local nNextTc = GetTcForTopHeadTool( sNextTcPos)   -- utensile da caricare
-                  local nPrevTc = GetTcForTopHeadTool( EMT.PREVTCPOS_H1) -- utensile da depositare
-                  -- se devo lasciare o prelevare da TC1 oppure non so cosa c'è montato, non posso preselezionare
-                  if nNextTc == 1 or nPrevTc == 1 or nPrevTc == 0 then return
-                  -- TC su montante sinistro
+               -- se è macchina a 3 teste con gruppo truciolatore 4 assi
+               if EgtGetHeadId( 'H39') then
+                  -- se preselezione testa 1
+                  if nNextHSet == 1 then
+                     local nNextTc = GetTcForTopHeadTool( sNextTcPos)   -- utensile da caricare
+                     local nPrevTc = GetTcForTopHeadTool( EMT.PREVTCPOS_H1) -- utensile da depositare
+                     -- se devo lasciare o prelevare da TC1 oppure non so cosa c'è montato, non posso preselezionare
+                     if nNextTc == 1 or nPrevTc == 1 or nPrevTc == 0 then return
+                     -- TC su montante sinistro
+                     else
+                        if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
+                        if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     end
+                  -- se preselezione testa 2
                  else
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
-                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
-                  end
-               -- se preselezione testa 2
-               else
-                  -- se agregato lama speciale non preseleziono mai
-                  if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then return end
-                  -- se la Z di lavoro è più bassa del cambio utensili, verifico quota X (la nostra Y)
-                  if EMT.MAXMIN[3] < MinZ1ToChangeH2 then
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
-                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     -- se agregato lama speciale non preseleziono mai
+                     if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then return end
+                     -- se la Z di lavoro è più bassa del cambio utensili, verifico quota X (la nostra Y)
+                     if EMT.MAXMIN[3] < MinZ1ToChangeH2 then
+                        if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
+                        if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     end
                  end
+               -- se gruppo lama dedicato, senza cambio utensile non si preseleziona mai
+               elseif EgtGetHeadId( 'H38') then
+                  return
               end
            end

            -- faccio preselezione ( se sono arrivato qui, vuol dire che posso preselezionare)
            if nNextHSet == 1 then
               local dNextX
-               -- se sto lavorando con testa 3 oppure utensile lungo, la testa 1 deve restare in home
-               if nHSet == 3 or dNextTotLen < LongTool then
-                  dNextX = EgtGetAxisHomePos( 'X1')
+               -- se sto lavorando con testa 3, la testa 1 preselezionata deve restare in home
+               if nHSet == 3 then
+                  dNextX = - EgtGetAxisHomePos( 'X1')
+               -- se il prossimo utensile su testa 1 è utensile lungo, resta in home
+               elseif sNextHead == 'H11' and dNextTotLen > LongTool then
+                  dNextX = - EgtGetAxisHomePos( 'X1')
               -- altrimenti recupero quota X1 (nostro L2)
               else
                  dNextX = GetStartMachiningXaxis( nNextMchId)
@@ -2796,7 +2898,7 @@ function PreselectNextDiffHead( nMchId, sHead)
                     EmitMoveDataHead( 1, { X=dNextX, B=ParkB1, C=ParkC1, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                  else
                     local nNextTc = GetTcForTopHeadTool( sNextTcPos)
-                     EmitMoveDataHead( 1, { X=dNextX, B=ParkLongB1, C=EgtIf( nPrevTc ~= 2, ParkLongTc1C1, ParkLongTc2C1), TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
+                     EmitMoveDataHead( 1, { X=dNextX, B=ParkLongB1, C=EgtIf( nNextTc ~= 2, ParkLongTc1C1, ParkLongTc2C1), TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                  end
                  EmitMoveStartHead( 1)
               elseif sNextHead == 'H12' or sNextHead == 'H16' then
@@ -2810,9 +2912,11 @@ function PreselectNextDiffHead( nMchId, sHead)
                  EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, dNextX), B=ParkCSawB1, C=MyParkCSawC1, TPos=AdjustTcPos( false, sNextTcPos, dPosA), Fmt=2})
                  EmitMoveStartHead( 1)
               end
-            else
+            elseif nNextHSet == 2 then
               EmitMoveDataHead( 2, { B=ParkB2, C=ParkC2, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
               EmitMoveStartHead( 2)
+            else
+               ; -- non si preseleziona testa 3
            end
         end
      end
@@ -7,6 +7,66 @@ EgtEnableDebug( false)
 -- Carico libreria
 local BD = require( 'BeamData')

+---------------------------------------------------------------------
+-- *** Generic Machinings ***
+---------------------------------------------------------------------
+require( 'EmtGenMachining')
+
+---------------------------------------------------------------------
+-- *** Special GetPrevMachiningOffset ***
+---------------------------------------------------------------------
+-----------------------------------------------------------------------------------------
+function OnSpecialGetPrevMachiningOffset()
+   -- Aggiorno posizione della testa della trave a seguito di movimenti delle pinze non previsti tra le fasi
+   local function TPosUpdate()
+      local nClId = EgtGetFirstNameInGroup( EMC.CURRMCHID, 'CL') -- recupero Id del gruppo CL della lavorazione corrente
+      local nPathId = EgtGetFirstInGroup( nClId or GDB_ID.NULL) -- Id del primo gruppo nella lavorazione (P1)
+      if not nPathId then
+         EMC.ERR = 12
+         EMC.MSG = '  Error : CL group path not found'
+         return
+      end
+      local dAuxMoveCount = EgtGetInfo( nPathId, 'AS#', 'd') or 0 -- numero di movimenti ausiliari 
+      local dTRepos = nil
+      -- controlla ogni gruppo di movimenti ausiliari
+      for i = 1, dAuxMoveCount do
+         local aAuxMove = EgtGetInfo( nPathId, 'AS' .. tostring( i), 'vs') or {} -- array contenete i parametri di ogni gruppo
+         -- controlla solo i movimenti della testa trave e salva l'ultimo
+         if aAuxMove[1] == '2' or aAuxMove[1] == '3' then
+            for j = 2, #aAuxMove do
+               if aAuxMove[j] == 'T' then
+                  dTRepos = aAuxMove[j+1]
+                  break
+               end
+            end
+         end
+      end
+      return dTRepos
+   end
+
+   -- default
+   EMC.ERR = 0
+   EMC.PREVOFFSX = 0
+
+   -- se c'è cambio di fase tra le lavorazioni (quindi la precedente è l'ultima della sua fase e la corrente la prima)
+   if EMC.PREVPHASE ~= EMC.CURRPHASE then
+      -- se la fase corrente è di inizio lavorazione di nuova trave
+      if IsStartOrRestPhase( EMC.CURRPHASE) then
+         -- recupero la posizione finale della lavorazione precedente
+         local vPrevAx = EmtGetFinalAxesPos( EMC.PREVMCHID)
+         -- ricava se e quanto la trave viene spostata tra le due fasi dai movimenti ausiliari e corregge l'offset di fine fase
+         local dNewTPos = TPosUpdate()
+         -- se ci sono dei movimenti della testa trave tra le due fasi ricava il delta tra la vecchia e la nuova posizione
+         if dNewTPos then
+            EMC.PREVOFFSX = dNewTPos - vPrevAx[1]
+         -- oppure la X (L1) di questa corrisponde alla posizione iniziale della nuova trave, se ne deduce l'offset
+         else
+            EMC.PREVOFFSX = ParkV1 - vPrevAx[1]
+         end
+      end
+   end
+end
+
 ---------------------------------------------------------------------
 -- *** Special Z moves ***
 ---------------------------------------------------------------------
@@ -77,6 +137,8 @@ function OnSpecialGetMaxZ()
            EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
         elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
            EMC.MAXZ = ParkZ1 + 200
+         elseif vtTp:getZ() > 0.5 or vtT:getZ() > 0.5 then
+            EMC.MAXZ = ParkZ1 + 100
         else
            EMC.MAXZ = ParkZ1 + 1
         end
@@ -86,7 +148,7 @@ function OnSpecialGetMaxZ()
         local vMZ = {{ Tz=0.85, Ez=440}, { Tz=0.5, Ez=200}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
      else
-         local vMZ = {{ Tz=0.85, Ez=400}, { Tz=0.7, Ez=300}, { Tz=0.5, Ez=195}, { Tz=0.15, Ez=70}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
+         local vMZ = {{ Tz=0.85, Ez=400}, { Tz=0.7, Ez=300}, { Tz=0.5, Ez=195}, { Tz=0.15, Ez=60}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
      end
   elseif EMC.HEAD == 'H16' then
@@ -95,6 +157,8 @@ function OnSpecialGetMaxZ()
            EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
         elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
            EMC.MAXZ = ParkZ1 + 200
+         elseif vtTp:getZ() > 0.5 or vtT:getZ() > 0.5 then
+            EMC.MAXZ = ParkZ1 + 100
         else
            EMC.MAXZ = ParkZ1 + 1
         end
@@ -104,7 +168,7 @@ function OnSpecialGetMaxZ()
         local vMZ = {{ Tz=0.85, Ez=440}, { Tz=0.5, Ez=200}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
      else
-         local vMZ = {{ Tz=0.85, Ez=400}, { Tz=0.7, Ez=300}, { Tz=0.5, Ez=195}, { Tz=0.15, Ez=70}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
+         local vMZ = {{ Tz=0.85, Ez=400}, { Tz=0.7, Ez=300}, { Tz=0.5, Ez=195}, { Tz=0.15, Ez=60}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
      end
   elseif EMC.HEAD == 'H21' then
@@ -205,7 +269,7 @@ local SIC_V = 50                   -- sicurezza da testa
 local MIN_ENG_V = 115              -- ingombro asse Z
 local MIN_ENG_RACK_V = 161         -- ingombro asse Z con cremagliera
 local MIN_ENG_XZ2_V = 180          -- ingombro assi XZ sotto
-local MIN_Z2_FOR_ENG_XZ2_V = 270   -- quota Z2 da cui considerare ingombro assi XZ sotto
+local MIN_Z2_FOR_ENG_XZ2_V = 250   -- quota Z2 da cui considerare ingombro assi XZ sotto
 local AGG_V = MinDeltaYV           -- ingombro rulli pressori + sicurezza
 local MaxLenSmT = 1500             -- massima lunghezza pezzo scaricato con nastri verdi
 local DIST_Y1MAX_LOAD = 100        -- distanza carrello Y1 da massimo asse al carico
@@ -513,6 +577,24 @@ end

 ---------------------------------------------------------------------
 function OnPostApplyMachining()
+      -- Inizializzo codice di errore
+   EMC.ERR = 0
+   -- Verifico se ultima lavorazione della fase
+   local nNextOpeId = EgtGetNextActiveOperation( EMC.MCHID)
+   local bMchLast = ( not nNextOpeId  or  EgtGetOperationPhase( nNextOpeId) ~= EMC.PHASE)   -- Agisco sui diversi percorsi della lavorazione
+   local nPathId = EgtGetFirstInGroup( EgtGetFirstNameInGroup( EMC.MCHID, 'CL') or GDB_ID.NULL)
+   while nPathId do
+      -- recupero id del successivo
+      nPathId = EgtGetNext( nPathId)
+      -- verifico se ultimo percorso di ultima lavorazione della fase
+      local bLast = ( bMchLast and ( not nPathId))
+      -- se ultimo, elimino ritorno in home
+      if bLast then EgtRemoveOperationHome( EMC.MCHID) end
+   end
+end
+
+---------------------------------------------------------------------
+function OnSpecialApplyMachining()

   EgtOutLog( ' Lavorazione : ' .. EgtGetName( EMC.MCHID) .. ' (' .. tostring( EMC.MCHID) .. ')')

@@ -605,7 +687,7 @@ function OnPostApplyMachining()
      -- verifico se ultimo percorso di ultima lavorazione della fase
      local bLast = ( bMchLast and ( not nPathId))
      -- se ultimo, elimino ritorno in home
-      if bLast then EgtRemoveOperationHome( EMC.MCHID) end
+      -- if bLast then EgtRemoveOperationHome( EMC.MCHID) end
      -- salvo lo stato dei carrelli
      local OriTPos = EMC.TPOS
      local OriY1Delta = EMC.Y1DELTA
@@ -804,6 +886,12 @@ function SpecApplyPath( bPreSplit, bSplitting, bPreCut, bCutting, bUnload)
      if  not EMC.Y2DELTA  then
         EgtOutLog( '  Warning SPLITTING -> separazione con caduta pezzo')
         SpecOutputCNT()
+         -- non funziona ma servirebbe un controllo simile, di modo che non possa avvenire la presenza di un pezzo "FALL" più grande di LEN_VERY_SHORT_PART
+         --if EMC.LT > LEN_VERY_SHORT_PART then
+         --   EMC.ERR = 19
+         --   EMC.MSG = '  Error SPLIT : Y1 or Y2 not clamped'
+         --   return false
+         --end
         if IsEndPhase( EMC.PHASE + 1) then
            EgtSetInfo( NextDispId, 'SKIP', '1')
            local NextOpeId = EgtGetNextOperation( NextDispId) 
@@ -1105,7 +1193,7 @@ function SpecCalcCarriages( dDistFront, dDistBack, dRollFront, dRollBack, dY1Del
      -- dopo che si è calcolato il minimo e massimo dell'intervallo, verifico che in testa rimanga almeno il minimo per poter fare passaggio pinze e scaricare
      if AuxInfoMach and ( AuxInfoMach.bSplitting or AuxInfoMach.bCutting) then
         if WorkTab.dY1DeltaMaxF - WorkTab.dY1DeltaMinF > 1.5 * BD.CHAR_EXTRA_DIST and WorkTab.dY1DeltaMaxF > EMC.LT + BD.MINRAW_S + BD.CHAR_EXTRA_DIST then
-            WorkTab.dY1DeltaMinF = max( min( EMC.LT + BD.MINRAW_S, WorkTab.dY1DeltaMaxF - 1), WorkTab.dY1DeltaMinF)
+            WorkTab.dY1DeltaMinF = max( min( EMC.LT + BD.MINRAW_S, WorkTab.dY1DeltaMaxF - 1), WorkTab.dY1DeltaMinF + EMC.LT)
         end
      end

@@ -1138,7 +1226,9 @@ function SpecCalcCarriages( dDistFront, dDistBack, dRollFront, dRollBack, dY1Del
      WorkTab.dY1DeltaMaxF = min( EMC.LB - MinJoin, MaxY1 + dDistFront + dRollFront + AGG_V)
      WorkTab.dY2DeltaMinF = max( MinJoin + EMC.HCING + EMC.HOVM, EMC.LB + MinY2 - dMyDistBack - AGG_V - dRollBack)
      WorkTab.dY2DeltaMaxF = min( dDistFront, EMC.LB - MyMinOther)   --  - EMC.TCING
-      if dY1DeltaMaxSP then WorkTab.dY1DeltaMaxF = min( WorkTab.dY1DeltaMaxF, dY1DeltaMaxSP) end
+      if dY1DeltaMaxSP and dY1DeltaMaxSP > WorkTab.dY1DeltaMinF then
+         WorkTab.dY1DeltaMaxF = min( WorkTab.dY1DeltaMaxF, dY1DeltaMaxSP)
+      end
      if dY2DeltaMinUL then WorkTab.dY2DeltaMinF = max( WorkTab.dY2DeltaMinF, dY2DeltaMinUL) end
      WorkTab.dV1PosF = dRollBack
      WorkTab.bV1CloseF = false
@@ -1297,8 +1387,11 @@ function SpecCalcUnload()
      EgtOutLog( '  *[U1]', 1)
   end
   local vCmd = {}
+   -- Tipo di scarico
+   local bStdUl = ( not MaxUnloadLen or MaxUnloadLen < 1 or EMC.LB - EMC.HOVM < MaxUnloadLen + 1)
+
   -- Commento
-   table.insert( vCmd, { 0, 'Unloading'})
+   table.insert( vCmd, { 0, 'Unloading', EgtIf( bStdUl, 'Unloading', 'Manual Unloading')})
   -- posizionamento sicuro teste e rulli (non serve ?)
   --table.insert( vCmd, { 4, 0})
   -- Se pinza Y chiusa, la apro
@@ -1306,11 +1399,15 @@ function SpecCalcUnload()
      table.insert( vCmd, { 11, 0})
      EMC.CNT = nil
   end
-   -- Sposto il pezzo in posizione di scarico
-   local dFinT = EgtIf( EMC.LB < MaxLenSmT, UnloadSmT, UnloadT) - EMC.LB
-   local dFinY2 = dFinT + EMC.Y2DELTA
-   table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2})
-   EgtOutLog( '  Y2PosF=' .. EgtNumToString( dFinY2), 1)
+   -- Se non supero la lunghezza massima di scarico, sposto il pezzo in posizione di scarico
+   if bStdUl then
+      local dFinT = EgtIf( EMC.LB < MaxLenSmT, UnloadSmT, UnloadT) - EMC.LB
+      local dFinY2 = dFinT + EMC.Y2DELTA
+      table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2})
+      EgtOutLog( '  Y2PosF=' .. EgtNumToString( dFinY2), 1)
+   else
+      table.insert( vCmd, { 1, 'Y2', MaxY2, 'Manual Unloading'})
+   end
   -- apro la morsa
   table.insert( vCmd, { 12, 0})
   -- riporto il carrello in home
@@ -2439,11 +2536,11 @@ function SpecOutputCmds( vCmd, bEnd)
         EgtSetInfo( EMC.PATHID, sKey, sInfo)
      -- movimento di 1 asse
      elseif Cmd[1] == 1 then
-         local sInfo = '1,'..Cmd[2]..','..EgtNumToString( Cmd[3],3)..EgtIf( Cmd[4], ',*', '')
+         local sInfo = '1,'..Cmd[2]..','..EgtNumToString( Cmd[3],3)..EgtIf( Cmd[4], ','..tostring(Cmd[4]), '')
         EgtSetInfo( EMC.PATHID, sKey, sInfo)
      -- movimento di 2 assi
      elseif Cmd[1] == 2 then
-         local sInfo = '2,'..Cmd[2]..','..EgtNumToString( Cmd[3],3)..','..Cmd[4]..','..EgtNumToString( Cmd[5],3)..EgtIf( Cmd[6], ',*', '')
+         local sInfo = '2,'..Cmd[2]..','..EgtNumToString( Cmd[3],3)..','..Cmd[4]..','..EgtNumToString( Cmd[5],3)..EgtIf( Cmd[6], ','..tostring(Cmd[6]), '')
         EgtSetInfo( EMC.PATHID, sKey, sInfo)
      -- movimento di 3 assi
      elseif Cmd[1] == 3 then
@@ -8,10 +8,10 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)

-PP_VER = '2.6k3'
-PP_NVER = '2.6.11.3'
-MIN_MACH_VER = '2.5k1'
-MACH_NAME = 'Essetre-PF1250MAX'
+PP_VER = '3.1e1'
+PP_NVER = '3.1.5.1'
+MIN_MACH_VER = '2.7d2'
+MACH_NAME = EgtGetCurrMachineName()

 -- Carico i dati globali
 local sMachDir = EgtGetCurrMachineDir()
@@ -120,6 +120,7 @@ MinB2b = -119
 MaxB2b = 119
 ParkX2 = -100
 SafeX2 = -200
+SafeX2RotAxis = -1000
 ParkZ2 = 0
 ParkC2 = -90
 ParkB2 = -90
@@ -156,6 +157,9 @@ EmitAccClamps = true
 WriteAllCoordsOnFirstM101 = true
 ForceToCloseRollersGate = false
 Motors23KW = false
+EstimationRapidMultiplier = 1
+DistZClampToTable = 5                             -- distanza tra la tavola e il punto più basso della morsa
+ClampingCoeffMin = nil                             -- coefficiente di fissaggio, se 0 o nil non fa controllo, per il momento da inizializzare da Ts3Data

 -- Aggiornamento con dati da TechnoEssetre7
 local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-PF1250MAX.data"
@@ -237,9 +241,15 @@ if EgtExistsFile( sDataBeam) then
         if Machine.Offsets.DEFTCPOS2 then DefTcPos2 = ( 'T' .. Machine.Offsets.DEFTCPOS2) end
         if Machine.Offsets.MINPRESS then MinForzaPinze = Machine.Offsets.MINPRESS end
         if Machine.Offsets.MAXPRESS then MaxForzaPinze = Machine.Offsets.MAXPRESS end
+         if Machine.Offsets.NOULOAD then MaxUnloadLen = Machine.Offsets.NOULOAD end
+         if Machine.Offsets.MAXFEEDPINZE then MaxFeedPinze = Machine.Offsets.MAXFEEDPINZE end
+         if Machine.Offsets.MAXACC then MaxAcc = Machine.Offsets.MAXACC end
+         if Machine.Offsets.MINACC then MinAcc = Machine.Offsets.MINACC end
+         if Machine.Offsets.COEFF_STIMATEMPI and Machine.Offsets.COEFF_STIMATEMPI > 0 then EstimationRapidMultiplier = Machine.Offsets.COEFF_STIMATEMPI end
         if Machine.Offsets.CHIUDI_PINZE_2_3_SCAMBIO then ForceToCloseRollersGate = Machine.Offsets.CHIUDI_PINZE_2_3_SCAMBIO == 1 end
         if Machine.Offsets.WOOD_DENSITY then WoodDensity = Machine.Offsets.WOOD_DENSITY end
         if Machine.Offsets.MOTORS23KW then Motors23KW = Machine.Offsets.MOTORS23KW == 1 end
+         if Machine.Offsets.COEFF_CLAMP_CHECK then ClampingCoeffMin = Machine.Offsets.COEFF_CLAMP_CHECK end

         -- aggiustamenti
         MinY1 = MinV1 + MinDeltaYV
@@ -269,6 +279,7 @@ EmtGeneral {
      ExitMaxAdjust = 300,
      ExitMaxRotAdj = 0.5,
      AngDeltaMinForHome = 80,
+      LinkAxesMoveOrder = MCH_LKAMO.HEAD_BEFORE_IF_SAME_ANG,
      Special = 'Common_PF1250.mlse',
      Processor = 'Common_PF1250.mlpe'}
 -- in base alla corsa macchina, si carica la rulliera di carico/scarico appropriata
@@ -520,7 +531,7 @@ local PY1Id = EmtAxis {
      Stroke = {0, MaxHoOpen},
      Home = MaxHoOpen,
      Geo = 'PY1_AXIS/GEO',
-      Aux = 'PY1_AXIS/SOLID'}
+      Aux = {'PY1_AXIS/SOLID', 'PY1_AXIS/CLAMP_CHECK'}}
 local Y2Id = EmtAxis {
      Name = 'Y2',
      Parent = 'Base',
@@ -540,7 +551,7 @@ local PY2Id = EmtAxis {
      Stroke = {0, MaxHoOpen},
      Home = MaxHoOpen,
      Geo = 'PY2_AXIS/GEO',
-      Aux = 'PY2_AXIS/SOLID'}
+      Aux = {'PY2_AXIS/SOLID', 'PY2_AXIS/CLAMP_CHECK'}}
 -- Rulli
 local V1Id = EmtAxis {
      Name = 'V1',
@@ -610,7 +621,7 @@ EmtAxis {
      Type = MCH_AT.LINEAR,
      Dir = - X_AX(),
      Pos = Point3d(0.0,2450.0,-958.0),
-      Stroke = {-40000, 5000},
+      Stroke = {-30000, 30000},
      Home = LoadT,
      Geo = 'T_AXIS/GEO'}
 EmtTable {
@@ -920,8 +931,10 @@ local vtMove = Vector3d( 0, ( DeltaTabY - 2550.0), ( DeltaTabZ + 1258.0))
 EgtMove( EgtGetFirstNameInGroup( BaseId, 'CONVOYER'..sGeomConvoyer), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( Y1Id, 'SOLID'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( PY1Id, 'SOLID'), vtMove, GDB_RT.GLOB)
+EgtMove( EgtGetFirstNameInGroup( PY1Id, 'CLAMP_CHECK'), vtMove + Vector3d(0,0,DistZClampToTable), GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( Y2Id, 'SOLID'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( PY2Id, 'SOLID'), vtMove, GDB_RT.GLOB)
+EgtMove( EgtGetFirstNameInGroup( PY2Id, 'CLAMP_CHECK'), vtMove + Vector3d(0,0,DistZClampToTable), GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( V1Id, 'SOLID'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( V1Id, 'COLLISION'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( PV1Id, 'SOLID'), vtMove, GDB_RT.GLOB)
@@ -1237,6 +1250,38 @@ function GetCurrChainSawingVirtualAxis()
   return dPosA
 end

+---------------------------------------------------------------------
+-- Funzione per impostare la posizione del rinvio flottante
+function SetFloatPos( sHead, dPos)
+   -- recupero Id testa
+   local nHeadId = EgtGetHeadId( sHead)
+   if not nHeadId then return false end
+   -- se ci sono entità flottanti nel ToolHolder
+   local nRefId = EgtGetFirstNameInGroup( nHeadId, '_T1')
+   local vtTool = EgtFR( nRefId, GDB_ID.ROOT):getVersZ() 
+   local nObjId =  EgtGetFirstGroupInGroup( EgtGetFirstNameInGroup( nHeadId, 'T1'))
+   local FloatEntities = EgtGetInfoInGroup( nObjId, 'Float')
+   if FloatEntities and #FloatEntities > 0 then
+      -- il porta-utensile flottante non può comprimersi più di 10mm
+      if dPos > 10 then
+         local sErr = 'Floating Ring compressed more than 10mm'
+         EmtSetLastError( 1222, sErr)
+         EgtOutLog( 'Error : ' .. sErr, 1)
+      end
+      local dFloat = EgtGetInfo( FloatEntities[1], 'Float', 'd')
+      if abs( dPos - dFloat) > 10 * GEO.EPS_SMALL then
+         local vtMove = ( dPos - dFloat) * vtTool
+         -- sposto tutte le entità flottanti
+         for i = 1, #FloatEntities do
+            EgtMove( FloatEntities[i], vtMove, GDB_RT.GLOB)
+            EgtSetInfo( FloatEntities[i], 'Float', dPos)
+         end
+      end
+      return true
+   end
+   return false
+end
+
 ---------------------------------------------------------------------
 -- Funzione per resettare tutte le attivazioni della macchina
 function OnResetMachine()
@@ -1244,6 +1289,9 @@ function OnResetMachine()
   EmtUnlinkAllFixturesFromGroups()
   SetPY1Light( false)
   SetPY2Light( false)
+   --resetto eventuale flottante
+   SetFloatPos( 'H11', 0)
+   SetFloatPos( 'H21', 0)
   -- nascondo Vmill
   local nRawId = EgtGetFirstRawPart()
   while nRawId do
@@ -7,18 +7,20 @@
 [Sawing]

 [Milling]
-0=d,MaxElev,0
+0=l,MaxElev,0
 1=d,OutRaw,0
-2=d,SideElev,0
+2=l,SideElev,0
 3=d,TrimExt,0
-4=sr,VtFaceUse,0,0,0
+4=s,VtFaceUse,0,0,0
+5=s,EdgesFaceUse,0

 [Pocketing]
-0=d,MaxElev,0
+0=l,MaxElev,0
 1=b,Open,0
-2=d,OpenMinSave,0
+2=d,OpenMinSafe,0
 3=d,OpenOutRaw,0
-4=d,MaxOptSize,0
+4=l,MaxOptSize,0
+5=b,AdjustFeed,1

 [Mortising]
 0=d,MaxElev,0
@@ -30,21 +32,28 @@
 [SawFinishing]

 [GenMachining]
-0=l,LinTol,0.1
-1=l,MaxLen,2
-2=s,Type,ZigZag
-3=d,SideAng,90
-4=l,Step,10
-5=l,OffsProj,0
-6=l,LiTang,0
-7=l,LiOrth,0
-8=l,LiElev,0
-9=l,LoTang,0
-10=l,LoOrth,0
-11=l,LoElev,0
-12=b,DirFromGuide,1

 [SurfRoughing]
+0=l,MaxElev,1000
+1=b,PlaneZ,0

 [SurfFinishing]
 0=b,SkipMaxDown,1
+
+[5AxMilling]
+0=l,LinTol,0.01
+1=l,MaxLen,10
+2=s,Type,ZigZag
+3=d,SideAng,90
+4=l,Step,10
+5=d,AngIni,-90
+6=d,AngFin,90
+7=l,LiTang,0
+8=l,LiOrth,0
+9=l,LiElev,0
+10=l,LoTang,0
+11=l,LoOrth,0
+12=l,LoElev,0
+13=b,DirFromGuide,0
+14=b,SurfAvoid,0
+
@@ -27,6 +27,7 @@
 2=d,SIDESTEP
 3=d,SIDEDEPTH
 4=s,DOUBLE
+5=dr,TOOL_OVERHANG

 [MILL_NOTIP]
 0=th,TH,
@@ -34,6 +35,7 @@
 2=d,SIDESTEP
 3=d,SIDEDEPTH
 4=s,DOUBLE
+5=dr,TOOL_OVERHANG

 [MORTISE_STD]
 0=b,MORTISE
@@ -1,5 +1,132 @@
           ==== Common_PF1250 Update Log ====

+Versione 3.1e1 (12/05/2026)
+- (SIM-GEN) Corretta SIM (muoveva Y2 a MaxY2 senza aprire pinza) e GEN (non chiudeva rulliere e dava extracorsa e non generava P7=-85) di pezzi lunghi che necessitano lo scarico manuale. Ticket#2971
+
+Versione 3.1c1 
+- (SIM-GEN) Corretto calcolo rimanenza durante ParkRoller. Ticket#2832
+- (SIM) Corretto caricamento geometrie di collisioni. Modificato indice di collisione per una migliore gestione. ATT: MIN_MACH -> 3.1b2
+- (SIM-GEN) Aggiunta OnSpecialApplyMachining per calcolare i carrelli da subito
+-           Aggiungendo OnSpecialApplyMachining, ora la OnSpecialGetPrevMachiningOffset lavora correttamente. Ticket#2798
+- (SIM-GEN) Solo se dY1DeltaMaxSP > WorkTab.dY1DeltaMinF lo prende in considerazione per il valore di WorkTab.dY1DeltaMaxF Ticket#2798
+
+Versione 3.1b1 (17/02/2026)
+- (GEN) Generazione non allineata a simulazione. Ticket#2819
+
+Versione 3.1a2 (30/01/2026)
+- (SIM) Allineato approccio simulazione a generazione in caso di lavorazione in doppio verticale. Ticket#2781
+- (GEN) Simulazione non allineata a generazione. Mancava reset flag di pezzo a caduta. Ticket#2798
+
+Versione 3.1a1 (16/01/2026)
+- (SIM-GEN) Corretto movimento di approccio con sega a catena e allineati Simulazione e Generazione. Ticket#2771
+
+Versione 2.7l1 (18/12/2025)
+- (SIM-GEN) Aggiunto controllo post movimenti ausiliari dell' EMC.PREVOFFSX nella funzione OnSpecialGetPrevMachiningOffset() come su ONE-PF. Ticket#2727
+- (SIM-GEN) Cambiato delta di correzione Z per lama con inclinazione >= 81° da 70 a 60 mm. Risoluzione Ticket#2210
+- (SIM-GEN) Divisione movimento B in approccio se > 90°.
+
+Versione 2.7k5 (26/11/2025)
+- (SIM) Migliorata funzione CheckClamping, ora il controllo di warning si basa sulla somma delle lunghezze delle aree pinzate
+
+Versione 2.7k4 (25/11/2025)
+- (SIM) Migliorata funzione CheckClamping, ora la sezione rientra di 3 mm
+
+Versione 2.7k3 (21/11/2025)
+- (SIM-GEN) Corretto problema riposizionamento carrelli. Ticket#2704
+- (SIM) Aggiornata risoluzione VMillTol in funzione dello spessore lama
+
+Versione 2.7k2 (19/11/2025)
+- (SIM-GEN) Con testa H38 si va in home quando testa viene comandata a Zmassima. Ticket#2703_b
+
+Versione 2.7k1 (19/11/2025)
+- (GEN) Preselzione testa 1 spostata prima della selezione testa 3. Ticket#2513
+- (SIM-GEN) Corretto calcolo per decidere se serve aprire i rulli
+- (SIM) Aggiunto controllo Extra-Corsa testa 2 in caso di lavorazione in doppio. Ticket#2201
+- (SIM) Prima versione controllo pinzaggio su VMILL. Per attivarlo serve modifica della macchina a MLDE e NGE.
+- (GEN) Simulazione non allineata a generazione. Se testa H38 e si chiudono i rulli, si deve andare in home. Ticket#2703
+
+Versione 2.7i1 (08/09/2025)
+- (GEN) Se fase start o restart, si aggiorna la posizione in X dell'asse per calcolare il link corretto. Serve CAM5 2.7h1 (facoltativo)
+- (EST) La stima tempi considera ora le accelerazoni degli assi
+- (SIM) Corretto controllo ultimo utensile utilizzato su testa 1, prima si controllava il precedente, ma poteva essere la testa 2
+- (SIM-GEN) Se testa 3 deve salire a ZMAX, sale alla X dove si trova e non torna in home
+
+Versione 2.7h2 (21/08/2025)
+- (GEN) Se la testa rimane bassa, corretto caso di reset del piano generico a fine lavorazione
+- (GEN) Corretto movimento in Z massima dopo scarico pezzo
+
+Versione 2.7h1 (20/08/2025)
+- (GEN) Per posizione T111 e T121, se non è presente asse rotante per presa aggregato (es. se si mette una fresa normale) viene settato a zero.
+- (MLDE-SIM) Aggiunta variabile FACOLTATIVA 'EstimationRapidMultiplier' in mlde per regolare il tempo stimato di rapido su macchine vecchie. Se non presente default 1.
+
+Versione 2.7g1 (01/07/2025)
+- (GEN) Lettura parametri accelerazioni da TS3. Ticket#2052
+- (SIM-GEN) Aggiunta gestione massima lunghezza scarico
+
+Versione 2.7d2 (24/04/2025)
+- (SIM) Modifica qualità VMILL. Da ora si può impostare da impostazioni CAM5
+
+Versione 2.7d1 (01/04/2025)
+- (GEN) Aggiunta commenti HEADER e FOOTER per comunicazione con linea o altre macchine, da parte di Essetre.
+
+Versione 2.7b5 (26/02/2025)
+- (MLDE-GEN) Gestione lettura feed massima pinze da Ts3.
+
+Versione 2.7b4 (21/02/2025)
+- (SIM-GEN) Ripristinato comportamento precedente calcolo posizione dei rulli di pinzaggio fatto con 2.7b2.
+- (MLDE-SIM) Gestione aggregato flottante. Serve modifica MLDE. Ticket#2297
+
+Versione 2.7b3 (06/02/2025)
+- (SIM) Dopo aver scaricato utensile, si setta nota "HIDDEN" per dichiarare utensile non più sulla testa e non considerare le collisioni.
+
+Versione 2.7b2 (04/02/2025)
+- (SIM-GEN) Piccola modifica nel calcolo posizione dei rulli di pinzaggio.
+
+Versione 2.7b1 (03/02/2025)
+- (SIM) Corretta simulazione che non mandava testa in home in caso di utensile lungo. Generazione era già ok. Ticket#2280
+
+Versione 2.7a2 (28/01/2025)
+- (SIM-GEN) In MLSE aggiunta piccola correzione quota Z in caso di direzione Z tra 0.5 e 0.707.
+
+Versione 2.7a1 (17/01/2025)
+- (GEN) Piccola correzione posizione X in preselezione utensile
+- (GEN) Corretto primo punto X preselezione utensile. Ticket#2183 e #2250
+
+Versione 2.6l7 (19/12/2024)
+- (SIM) HOTFIX : corretto posizione Z zero alla selezione dell'utensile in caso di motosega. Ticket#2235
+
+Versione 2.6l6 (18/12/2024)
+- (MLDE-SIM-GEN) Aggiunta variabile 'SafeX2RotAxis' in sostituzione della 'ParkMchY2' che era usata impropriamente
+
+Versione 2.6l5 (17/12/2024)
+- (SIM) Corretta posizione iniziale testa 2. Ticket#2228
+
+Versione 2.6l4 (16/12/2024)
+- (SIM-GEN) In MLSE ripristinati vecchi valori indici calcolo Z massima. In alcuni casi peggioravano la situazione.
+
+Versione 2.6l3 (16/12/2024)
+- (SIM) Corretto scarico utensile se aggregato. Se non presente utensile di default, non seleziona nulla.
+- (SIM-GEN) In MLSE ritoccati indici calcolo Z massima. Ticket#2210
+
+Versione 2.6l2 (13/12/2024)
+- (SIM) Corretta chiamata calcolo asse virtuale
+
+Versione 2.6l1 (13/12/2024)
+- (SIM) Gestione caricamento utensili in caso di testa con uscita multipla.
+- (SIM) Corretto errore di collisione per errata simulazione cambio utensile da lama a motosega.
+- (SIM-GEN) Corretta gestione in caso di prima lavorazione con motosega.
+- (GEN) Non si fa preselezione della testa 3
+- (GEN) Corretta emissione coordinata rotazione testa 3 in zona sicura
+- (SIM-GEN) A fine barra, testa 3 sempre in home
+- (GEN) Controllo esistenza terzo asse ausiliario
+- (GEN) Corretto primo movimento in X quando si parte con testa 3. Ticket#2216
+- (GEN) Se su testa 1 c'è un aggregato e si utilizzerà la testa 3, si scarica aggregato e si prende utensile di default. Ticket#2222
+- (GEN) Durante utilizzo della testa 3, non si preselezionano altre teste. Ticket#2220
+- (SIM-GEN) Se lavorazione con testa dedicata lama e su testa 1 c'era aggregato, viene scaricato. Ticket#2216
+
+Versione 2.6k3 (26/11/2024) 
+- (GEN) Corretta modifica fatta in versione 2.6k2. Ticket#2183
+
 Versione 2.6k2 (25/11/2024)
 - (GEN) Se si preseleziona su testa 1 un utensile lungo, non si va alla X successiva di lavoro ma si resta in home. Infatti potrebbe toccare le paratie in caso di scambio pezzo. Ticket#2183

@@ -3,8 +3,8 @@

 local InfoCommon_STD_PP = {
   NAME = 'Common_PF1250',            -- nome script PP standard
-   VERSION = '2.6k2',                 -- versione script
-   MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
+   VERSION = '3.1e1',                 -- versione script
+   MIN_MACH_VER_PP_COMMON = '3.1b2'   -- versione minima kernel
 }

 return InfoCommon_STD_PP
Author	SHA1	Message	Date
andrea.villa	d9cf0903cc	Merge remote-tracking branch 'origin/develop'	2026-05-12 16:01:00 +02:00
andrea.villa	941adc39b4	Allineamento con common ver. 3.1e1	2026-05-12 16:00:50 +02:00
daniele.nicoli	ff38d9dead	Aggiunto Clamp di sicurezza per lettura dei parametri MinJoin da Ts3Data	2026-04-23 13:05:16 +02:00
daniele.nicoli	4eaf6c04bf	Merge remote-tracking branch 'origin/main' into develop	2026-04-23 13:03:26 +02:00
andrea.villa	4c012bc21a	Merge remote-tracking branch 'origin/develop'	2026-03-12 16:24:17 +01:00
andrea.villa	f2ee5cd0d2	Allineamento con common ver. 3.1c1	2026-03-12 16:24:04 +01:00
daniele.nicoli	a5ed84b7d3	Aggiunto info "PreviewShow" per anteprima utensile/testa nel MACH	2026-03-09 09:19:26 +01:00
daniele.nicoli	99a3f1e2a3	Aggiunti parametri letti da TS3Data.lua: MIN_JOIN_S, MIN_JOIN_L e MAX_ANGLE_DRILL_CUT	2026-03-05 15:10:39 +01:00
daniele.nicoli	770de517ec	Aggiunti tra le tipologie di foratura le AngleDrill.	2026-02-27 16:26:43 +01:00
daniele.nicoli	6a4e2d4a6d	Merge branch 'main' into develop	2026-02-27 16:20:27 +01:00
andrea.villa	7c3fcfb200	Allineamento con common ver. 3.1b1	2026-02-17 10:28:08 +01:00
andrea.villa	d12737352b	Allineamento con common ver. 3.1b1	2026-02-17 09:53:18 +01:00
andrea.villa	0b52596d95	Allineamento con common ver.3.1a2	2026-01-30 13:12:24 +01:00
andrea.villa	252b10f020	Allineamento con common ver. 3.1a1	2026-01-16 16:00:00 +01:00
andrea.villa	fe4317aaf8	- Allineamento a common ver. 2.7l1 - Aggiunto parametro MAX_ANGLE_DRILL_CUT a BeamData - Recupero nome macchina da funzione EGT	2025-12-18 12:28:33 +01:00
andrea.villa	29fb7cbb47	Corretto disegno porta utensile	2025-12-11 09:25:38 +01:00
andrea.villa	236a37221a	Merge branch 'develop'	2025-11-27 09:41:48 +01:00
andrea.villa	51d569fd71	Aggiunto nuovo ToolHolder Cambio versione per pubblicazione versione a cliente	2025-11-27 09:41:36 +01:00
daniele.nicoli	d67511bb9a	- Aggiornamento a Common 2.7k5 - nge, disegnate aree di pinzaggio - mlde, aggiunti import CLAMP_CHECK - mlde, inizializzato valore default di ClampingCoeffMin = nil - Aggiornamento versione MACH_KERNEL minima necessaria per Common 2.7k4	2025-11-26 09:53:08 +01:00
daniele.nicoli	a5cf7fb695	Aggiunta gestione CUT_SIC impostabile da TS3Data.lua	2025-11-13 12:10:14 +01:00
daniele.nicoli	f74c145826	Merge branch 'main' into develop	2025-11-13 12:08:24 +01:00
andrea.villa	91d2886cb3	Allineamento con common ver. 2.7i1	2025-09-08 10:31:33 +02:00
andrea.villa	c25e625825	Allineamento con common ver. 2.7h2	2025-08-21 17:51:00 +02:00
andrea.villa	5cdfe16858	- Allineamento con common ver. 2.7h1 - Dimensione tavola portata a 34m - Aggiunto lettura coefficiente stima tempi	2025-08-20 16:02:15 +02:00
andrea.villa	d4b5e54f6d	Lunghezza massima grezzo caricabile portata a 26000mm	2025-07-09 17:42:14 +02:00
andrea.villa	e187ac8ced	Allineamento con common ver. 2.7g1	2025-07-01 09:52:28 +02:00
andrea.villa	385b540c35	- Allineamento con common 2.7d2 - Aggiunto parametro LinkAxesMoveOrder	2025-04-24 12:51:04 +02:00
andrea.villa	52761188c0	Merge branch 'main' of https://gitlab.steamware.net/egalware-machines/essetre/Essetre-PF1250MAX	2025-04-01 10:01:43 +02:00
andrea.villa	27dd05b3c6	Allineamento con common ver. 2.7d1	2025-04-01 10:01:04 +02:00
luca.mazzoleni	e0735a224b	- in BeamData aggiunti angoli limite per nuovo automatismo - aggiornata versione	2025-03-13 10:47:59 +01:00
luca.mazzoleni	3a80013691	- modificata GetSetupInfo	2025-02-28 09:23:29 +01:00
andrea.villa	bec18b1cc3	- Allineamento con common ver. 2.7b5 - Aggiunta lettura parametro MAXFEEDPINZE	2025-02-27 09:37:13 +01:00
luca.mazzoleni	2e46fc36c7	- in BeamData GetSetupInfo modificate informazioni teste	2025-02-25 18:09:20 +01:00
andrea.villa	36e00ae91f	- Allineamento common ver. 2.7b4 - Gestione aggregato flottante	2025-02-21 09:17:32 +01:00
andrea.villa	7bc7528556	Allineamento con common ver. 2.7b2	2025-02-04 12:30:16 +01:00
andrea.villa	db65fb14ac	Allineamento con common ver. 2.7b1	2025-02-03 08:49:56 +01:00
andrea.villa	bdc919e0ec	Allineamento con common ver. 2.7a2	2025-01-28 12:45:22 +01:00
andrea.villa	3711fe72d5	Allineamento con common ver 2.7a1	2025-01-17 09:30:35 +01:00
luca.mazzoleni	02a14eec85	update version	2024-12-24 09:39:50 +01:00
luca.mazzoleni	5777faf99e	- in BeamData -> GetSetupInfo aggiunto parametro ZSafeDelta per sega a catena	2024-12-24 09:38:55 +01:00
andrea.villa	2f14c825e4	Allineamento con common ver.2.6l7	2024-12-19 10:30:01 +01:00
andrea.villa	709e433d19	Allineamento con common ver.2.6l6	2024-12-18 17:04:15 +01:00
andrea.villa	8010cf2c24	Allineamento con common ver. 2.6l5	2024-12-17 11:45:32 +01:00
andrea.villa	aa7bef4252	Allineamento con common ver.2.6l2	2024-12-13 17:46:21 +01:00
andrea.villa	7bf2ecbef5	Allineamento con common ver. 2.6l1	2024-12-13 17:11:44 +01:00
andrea.villa	1b2cbd3a5f	Allineamento con common ver.2.6k3	2024-11-26 15:59:29 +01:00