Prima versione NEW LINK

- Simulazione OK
- Generazione da controlare

Common_PF1250.mlse

@@ -1,4 +1,4 @@
--- Special Operations macchina Essetre-PF1250 by Egalware s.r.l.  2024/04/09
+-- Special Operations macchina Essetre-PF1250 by Egalware s.r.l.  2025/08/25
 -- Intestazioni
 
 require( 'EmtGenerator')
@@ -8,194 +8,435 @@ EgtEnableDebug( false)
 local BD = require( 'BeamData')
 
 ---------------------------------------------------------------------
--- *** Special Z moves ***
+-- *** Generic Machinings ***
 ---------------------------------------------------------------------
----------------------- OnSpecialGetMaxZ -----------------------------
-local function CalcExtraZ( vtTp, vtT, vMZ)
-   -- la tabella deve esistere ed essere non vuota
-   if not vMZ or #vMZ == 0 then return 0 end
-   -- componente Z di riferimento è la minima
-   local vtTz = min( vtTp:getZ(), vtT:getZ())
-   -- se oltre il massimo
-   if vtTz > vMZ[1].Tz then return vMZ[1].Ez end
-   -- interpolo
-   for i = 2, #vMZ do
-      if vtTz > vMZ[i].Tz then
-         local dCoeff = ( vtTz - vMZ[i-1].Tz) / ( vMZ[i].Tz - vMZ[i-1].Tz) 
-         return (( 1 - dCoeff) * vMZ[i-1].Ez + dCoeff * vMZ[i].Ez)
+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
-   -- sotto il minimo
-   return 0
 end
 
 ---------------------------------------------------------------------
-function OnSpecialGetMaxZ()
-   -- Inizializzazioni
-   EMC.ERR = 0
-
-   -- Gestione speciale per sega a catena
-   if EMC.HEAD == 'H13' then
-      EMC.MAXZ = EgtGetAxisHomePos( 'Z1')
-      return
+-- *** Special Link moves ***
+---------------------------------------------------------------------
+-----------------------------------------------------------------------------------------
+local function IsPrevSplit()
+   local sPrevUserNotes = ''
+   if EMC.LINKTYPE == 2 then
+      sPrevUserNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
+   elseif EMC.LINKTYPE == 3 then
+      EgtSetCurrMachining( EMC.PREVMCHID)
+      sPrevUserNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
+      EgtSetCurrMachining( EMC.NEXTMCHID)
    end
+   return ( sPrevUserNotes:find( 'Split;', 1, true) ~= nil)
+end
 
-   -- Sistemazione dati di input
-   local vtTp = Vector3d( EMC.TDIRp)
-   local bFromZmax = false
-   -- recupero il gruppo
-   local nSetHead = GetHeadSet( EMC.HEAD)
-   if vtTp:isSmall() then
-      vtTp = X_AX()
-      bFromZmax = true
-      if nSetHead == 1 then
-         EMC.R1p = ParkC1
-         EMC.R2p = ParkB1
-      elseif nSetHead == 2 then
-         EMC.R1p = ParkC2
-         EMC.R2p = ParkB2
-      elseif nSetHead == 3 then
-         EMC.R1p = ParkC3
-         EMC.R2p = ParkB3
+-----------------------------------------------------------------------------------------
+local function IsLinkSafe( vPrec, vNext)
+   local bSafeMove = true
+   local DirectionsToTest = { { Z=vPrec[3], C=vPrec[4], B=vPrec[5]}, { Z=vNext[3], C=vNext[4], B=vNext[5]}}
+
+   -- aggiungo anche il punto medio
+   table.insert( DirectionsToTest, { Z=( vNext[3] + vPrec[3]) / 2, C=( vNext[4] + vPrec[4]) / 2, B=( vNext[5] + vPrec[5]) / 2})
+
+   for t=1, #DirectionsToTest do
+      local vtToolDir = EgtGetCalcToolDirFromAngles( DirectionsToTest[t].C, DirectionsToTest[t].B)
+      -- se testa standard
+      if EMC.HEAD == 'H11' then
+         -- TODO considerare caso sotto la traversa
+         -- se sotto la traversa
+         if vtToolDir:getX() > -0.1 then
+            bSafeMove = true
+         end
+      -- se lama su aggregato
+      elseif EMC.HEAD == 'H12' then
+         -- se sotto la traversa
+         if vtToolDir:getX() < 0.342 then
+            local dLen = SawOffsZ - MillOffs
+            local dToolRadius = 275 -- leggere dall'utensile!!
+            local dNewOffZ = ( dLen * cos( DirectionsToTest[t].B) + dToolRadius * abs( sin( DirectionsToTest[t].B))) - dToolRadius
+            local dMaxZ = ParkZ1 - dNewOffZ
+            if dMaxZ < DirectionsToTest[t].Z then
+               bSafeMove = false
+               break
+            end
+         end
       end
    end
-   local vtT = Vector3d( EMC.TDIR)
-   local vtTpZm = EgtIf( bFromZmax, vtT, vtTp)
-   local bBSameSign = (( EMC.R2p < 10 and EMC.R2 < 10) or ( EMC.R2p > -10 and EMC.R2 > -10))
 
-   -- Calcolo in funzione della testa e dei parametri
+   return bSafeMove
+end
+
+-----------------------------------------------------------------------------------------
+local function GetActiveRawBBox()
+   local b3Raw = BBox3d()
+   local nRawId = EgtGetFirstRawPart()
+   while nRawId do
+      if EgtVerifyRawPartPhase( nRawId, EMC.PHASE) then
+         b3Raw = EgtGetRawPartBBox( nRawId)
+         break
+      end
+      nRawId = EgtGetNextRawPart( nRawId)
+   end
+   return b3Raw
+end
+
+-----------------------------------------------------------------------------------------
+function OnSpecialLink()
+
+   -- se fresa su testa 1
    if EMC.HEAD == 'H11' then
-      if bBSameSign and vtTp:getX() > -0.1 and vtT:getX() > -0.1 then
-         EMC.MAXZ = MaxZ1
-      else
-         local vMZ = {{ Tz=0.85, Ez=390}, { Tz=0.5, Ez=280}, { Tz=-0.01, Ez=160}}
-         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
-      end
-   elseif EMC.HEAD == 'H12' then
-      if vtTp:getX() > 0.3 and vtT:getX() > 0.3 then
-         if bBSameSign and abs( EMC.R1 - EMC.R1p) < 165 then
-            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
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- se lavorazione in doppio e altra ha collegamento diretto, si muove prima l'altra
+         local sHeadToMoveFirst = ''
+         if EMC.OTHERLINKTYPE == 3 then
+            sHeadToMoveFirst = 'HeadToMoveFirst=H2;'
          end
-      elseif bBSameSign and EMC.R1p > 29.9 and EMC.R1p < 180.1 and EMC.R1 > 29.9 and EMC.R1 < 180.1 and EMC.R2p > -10 and EMC.R2 > -10 then
-         EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
-      elseif bBSameSign and EMC.R1p > -0.1 and EMC.R1p < 180.1 and EMC.R1 > -0.1 and EMC.R1 < 180.1 and EMC.R2p > -10 and EMC.R2 > -10 then
-         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}}
-         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
-      end
-   elseif EMC.HEAD == 'H16' then
-      if vtTp:getX() > 0.3 and vtT:getX() > 0.3 then
-         if bBSameSign and abs( EMC.R1 - EMC.R1p) < 165 then
-            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
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;'..sHeadToMoveFirst)
+         -- se asse B resta girato verso home e C resta vicino alla home
+         if abs( EMC.R2 - EMC.R2p) < 90 and abs( EMC.R1 - EMC.R1p) < 5 then
+            ; -- discesa diretta
+         elseif abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, 0}, 30, 2, 2)
+            if abs( EMC.R1 - EMC.R1p) > 1 then
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, 0}, 30, 2, 2)
+            end
          end
-      elseif bBSameSign and EMC.R1p > 29.9 and EMC.R1p < 180.1 and EMC.R1 > 29.9 and EMC.R1 < 180.1 and EMC.R2p > -10 and EMC.R2 > -10 then
-         EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
-      elseif bBSameSign and EMC.R1p > -0.1 and EMC.R1p < 180.1 and EMC.R1 > -0.1 and EMC.R1 < 180.1 and EMC.R2p > -10 and EMC.R2 > -10 then
-         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)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, 0}, 30, 3, 2, 'FirstRise=1;')
+            if abs( EMC.R1 - EMC.R1p) > 1 then
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, 0}, 30, 3, 2)
+            end
+         else
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2p}, 30, 3, 2, 'FirstRise=1;')
+         end
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+
+      -- altrimenti collegamento tra due lavorazioni (3)
       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}}
-         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
+         -- recupero quota massima di collegamento
+         local vFinalAxLink = EmtGetFinalAxesPos( EMC.PREVMCHID, EMC.PREVMAIN, false)
+         local vInitAxLink = EmtGetInitialAxesPos( EMC.NEXTMCHID, EMC.NEXTMAIN, false)
+         local bSafeMove = IsLinkSafe( vFinalAxLink, vInitAxLink)
+
+         -- se gli assi rotanti non sono cambiati e il collegamento è come ultimo punto della lavorazione
+         if abs( EMC.R1 - EMC.R1p) < 1 and abs( EMC.R2 - EMC.R2p) < 1  and abs( EMC.L3p - vFinalAxLink[3]) < 1 and  abs( EMC.L3 - vInitAxLink[3]) < 1 then
+            bSafeMove = true
+         end
+
+         -- se superata quota massima ammessa
+         if not bSafeMove then
+            -- retrazione
+            EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, MaxZ1, EMC.R1p, 0}, 30, 3, 2, 'UniqueRise=1;')
+            -- approccio
+            EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, MaxZ1, EMC.R1, 0}, 30, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+         else
+            -- GESTIONE PER DOPPIO
+            -- se altra testa arriva da home, devo per forza avere un CLIMB, creo il punto
+            if EMC.OTHERLINKTYPE == 1 then
+               EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, vInitAxLink, 30, 2, 2, 'FirstClimb=1;HeadToMoveFirst=H1;')
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+            -- se altra testa deve andare in home, devo per forza avere un RISE, creo il punto
+            elseif EMC.OTHERLINKTYPE == 2 then
+               EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, vFinalAxLink, 30, 3, 2, 'UniqueRise=1;')
+            end
+         end
       end
-   elseif EMC.HEAD == 'H21' then
-      if bBSameSign and vtTp:getX() > -0.1 and vtT:getX() > -0.1 then
-         EMC.MAXZ = MaxZ2
-      else
-         local vMZ = {{ Tz=0.85, Ez=390}, { Tz=0.5, Ez=280}, { Tz=-0.01, Ez=160}}
-         EMC.MAXZ = ParkZ2 + CalcExtraZ( vtTpZm, vtT, vMZ)
-      end
-   elseif EMC.HEAD == 'H38' then
-      EMC.MAXZ = SafeZ3RotAxis
-   end
-end
 
----------------------- OnSpecialMoveZup -----------------------------
-function OnSpecialMoveZup()
-
-   --EgtOutLog( 'OnSpecialMoveZup : ' .. EMC.HEAD .. '.' .. tostring( EMC.EXIT))
-
-   -- Inizializzazioni
-   EMC.ERR = 0
-   EMC.MODIF = false
-
-   -- Direzione utensile
-   local vtT = Vector3d( EMC.TDIR)
-
-   -- recupero Z1 home
-   local nHeadSet = GetHeadSet( EMC.HEAD)
-   local dZmax = EgtGetAxisHomePos( EgtIf( nHeadSet ~= 2, 'Z1', 'Z2'))
-
-
-   -- se fresa su testa1 o testa 2
-   if EMC.HEAD == 'H11' or EMC.HEAD == 'H21' or EMC.HEAD == 'H22' then
-      ;
-   -- se lama
+   -- se lama su rinvio standard o opposto di testa 1
    elseif EMC.HEAD == 'H12' or EMC.HEAD == 'H16' then
-      -- riporto i valori tra -179 e + 180
-      local dCheckAxR1 = EMC.R1
-      if dCheckAxR1 < -180 then
-         dCheckAxR1 = dCheckAxR1 + 360
-      elseif dCheckAxR1 > 180 then
-         dCheckAxR1 = dCheckAxR1 - 360
-      end
-      -- se lama su testa1
-      if EMC.HEAD == 'H12' then
-         -- se inclinata oltre 90 gradi e interferisce con la trave
-         if ( EMC.R2 > 87.9 and ( dCheckAxR1 < 15.0 or dCheckAxR1 > 180.0)) or ( EMC.R2 < -87.9 and ( dCheckAxR1 > -15.0 and dCheckAxR1 < 180.0)) then
-            local dZref = dZmax + min( 330 * vtT:getZ(), 0) + 260 * ( 1 - sqrt( 1- vtT:getZ() * vtT:getZ()))
-            -- se troppo in alto
-            if EMC.L3 > dZref + 1 then
-               ---- sistemo asse rotante
-               --EMC.R2 = EgtIf( ( EMC.R2 > 0), 90, -90)
-               ---- ricalcolo versore utensile
-               --EMC.TDIR = EgtGetCalcToolDirFromAngles( EMC.R1, EMC.R2)
-               ---- porto alla giusta quota
-               --EMC.L3 = dZmax
-               EMC.L3 = dZref
-               -- dichiaro modificato
-               EMC.MODIF = true
-            end
+      -- recupero se split da note utente di lavorazione precedente
+      local bSplit = IsPrevSplit()
+
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2)
+         -- se asse B cambia di molto
+         if abs( 0 - EMC.R2p) > 1 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, 0}, 30, 2, 2)
          end
-      -- se seconda lama su testa1
-      elseif EMC.HEAD == 'H16' then
-         -- se inclinata oltre 90 gradi e interferisce con la trave
-         if ( EMC.R2 > 87.9 and ( dCheckAxR1 < 15.0 or dCheckAxR1 > 180.0)) or ( EMC.R2 < -87.9 and ( dCheckAxR1 > -15.0 and dCheckAxR1< 180.0)) then
-            local dZref = dZmax + min( 330 * vtT:getZ(), 0) + 260 * ( 1 - sqrt( 1- vtT:getZ() * vtT:getZ()))
-            -- se troppo in alto
-            if EMC.L3 > dZref + 1 then
-               ---- sistemo asse rotante
-               --EMC.R2 = EgtIf( ( EMC.R2 > 0), 90, -90)
-               ---- ricalcolo versore utensile
-               --EMC.TDIR = EgtGetCalcToolDirFromAngles( EMC.R1, EMC.R2)
-               ---- porto alla giusta quota
-               --EMC.L3 = dZmax
-               EMC.L3 = dZref
-               -- dichiaro modificato
-               EMC.MODIF = true
+         -- se assi cambiano di molto
+         if abs( EMC.R1 - EMC.R1p) > 10 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, 0}, 30, 2, 2)
+         end
+
+         if abs( EMC.R2) > 75 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, ParkZ1, EMC.R1, EgtClamp( EMC.R2, -90, 90)}, 30, 2, 2)
+         end
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, 0}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+            -- se assi cambiano di molto
+            if abs( EMC.R1 - EMC.R1p) > 10 then
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, 0}, 30, 3, 2)
             end
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2)
+         else
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2p}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+         end
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+
+      -- altrimenti collegamento tra due lavorazioni (3)
+      else
+         -- recupero quota massima di collegamento
+         local vFinalAxLink = EmtGetFinalAxesPos( EMC.PREVMCHID, EMC.PREVMAIN, false)
+         local vInitAxLink = EmtGetInitialAxesPos( EMC.NEXTMCHID, EMC.NEXTMAIN, false)
+         local bSafeMove = IsLinkSafe( vFinalAxLink, vInitAxLink)
+
+         -- se gli assi rotanti non sono cambiati e il collegamento è come ultimo punto della lavorazione
+         if abs( EMC.R1 - EMC.R1p) < 1 and abs( EMC.R2 - EMC.R2p) < 1  and abs( EMC.L3p - vFinalAxLink[3]) < 1 and  abs( EMC.L3 - vInitAxLink[3]) < 1 then
+            bSafeMove = true
+         end
+
+         -- se superata quota massima ammessa
+         if not bSafeMove then
+            -- retrazione
+            EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+            if abs( EMC.R2) > 91 then
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, ParkZ1, EMC.R1p, EgtClamp( EMC.R2p, -90, 90)}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, MaxZ1Blade, EMC.R1p, 0}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'LastRise=1;')
+            else
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, MaxZ1Blade, EMC.R1p, 0}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'UniqueRise=1;')
+            end
+            -- approccio
+            EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, MaxZ1Blade, EMC.R1, 0}, 30, 2, 2, 'FirstClimb=1;')
+            if abs( EMC.R2) > 91 then
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, ParkZ1, EMC.R1, EgtClamp( EMC.R2, -90, 90)}, 30, 2, 2)
+            end
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
          end
       end
+
+   -- se sega a catena su testa 1
+   elseif EMC.HEAD == 'H13' then
+      -- recupero se split da note utente di lavorazione precedente
+      local bSplit = IsPrevSplit()
+       -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2p, EMC.L3p, EMC.R1p, EMC.R2p, EMC.R3}, 30, 2, 2, 'FirstClimb=1;')
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, EMC.R2p, EMC.R3}, 30, 2, 2)
+         if abs( EMC.R3) < 0.1 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, ParkCSaw0Z1, EMC.R1, EMC.R2, EMC.R3}, 30, 2, 2)
+         else
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, EMC.R2, EMC.R3}, 30, 2, 2)
+         end
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2, EMC.R3}, 31, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2, EMC.R3p}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2, EMC.R3p}, 30, 3, 2, 'LastRise=1;')
+      -- altrimenti collegamento tra due lavorazioni (3)
+      else
+      end
+
+   -- se aggregato foratore multiplo su testa 1
+   elseif EMC.HEAD == 'H14' then
+
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, 0}, 30, 2, 2)
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, 0}, 30, 2, 2, 'LastClimb=1;')
+         else
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'UniqueClimb=1;')
+         end
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, 0, EMC.R3}, 30, 3, 2, 'FirstRise=1;')
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, 0, EMC.R3}, 30, 3, 2)
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2, EMC.R3}, 30, 3, 2, 'LastRise=1;')
+         else
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2, EMC.R3}, 30, 3, 2, 'UniqueRise=1;')
+         end
+      end
+
+   -- se fresa su testa 2
+   elseif EMC.HEAD == 'H21' then
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2p}, 30, 3, 2, 'FirstRise=1;')
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+      end
+
+   -- se lama su testa 2
+   elseif EMC.HEAD == 'H22' then
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2p}, 30, 3, 2, 'FirstRise=1;')
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, SafeX2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+      end
+
+   -- se lama su testa 3
    elseif EMC.HEAD == 'H38' then
-      EMC.L3 = SafeZ3RotAxis
-      -- dichiaro modificato
-      EMC.MODIF = true
-   else
-      ; -- non si fa nulla
+      -- sicurezza aggiuntiva
+      local SAFE_DIST = 50
+      local dExtraDist = EgtTdbGetCurrToolParam( MCH_TP.TOTDIAM) / 2 + SAFE_DIST
+      -- recupero se split da note utente di lavorazione precedente
+      local bSplit = IsPrevSplit()
+      -- recupero ingombro del primo grezzo in lavoro
+      local b3Raw = GetActiveRawBBox()
+      local dMinRawX3 = b3Raw:getMin():getY() - Head3Y
+      local dMaxRawX3 = b3Raw:getMax():getY() - Head3Y
+      local dMidRawX3 = ( dMinRawX3 + dMaxRawX3) / 2
+
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         local dSafeX3 = EgtIf( EMC.L2 < dMidRawX3, dMinRawX3 - dExtraDist, dMaxRawX3 + dExtraDist)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, dSafeX3, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, dSafeX3, SafeZ3RotAxis, EMC.R1p, EMC.R2p}, 30, 2, 2)
+            -- deve muoversi anche la trave (la lama non è abbastanza alta in Z) quindi Mask = 31
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, dSafeX3, SafeZ3RotAxis, EMC.R1, EMC.R2}, 31, 2, 2, 'LastClimb=1;')
+         else
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, dSafeX3, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'UniqueClimb=1;')
+         end
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         local dSafeX3 = EgtIf( EMC.L2p < dMidRawX3, dMinRawX3 - dExtraDist, dMaxRawX3 + dExtraDist)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, dSafeX3, SafeZ3RotAxis, EMC.R1p, EMC.R2p}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..' FirstRise=1;')
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, dSafeX3, SafeZ3RotAxis, EMC.R1, EMC.R2}, 30, 3, 2)
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, dSafeX3, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2)
+         end
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+
+      -- altrimenti collegamento tra due lavorazioni (3)
+      else
+         -- recupero quota massima di collegamento
+         local vLFiAx = EmtGetFinalAxesPos( EMC.PREVMCHID, EMC.PREVMAIN, false)
+         local vLInAx = EmtGetInitialAxesPos( EMC.NEXTMCHID, EMC.NEXTMAIN, false)
+         -- se superata quota massima ammessa
+         if max( vLFiAx[3], vLInAx[3]) > SafeZ3RotAxis + 1 then
+            -- retrazione
+            EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, SafeZ3RotAxis, EMC.R1p, EMC.R2p}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..' FirstRise=1;')
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, SafeZ3RotAxis, EMC.R1p, 0}, 30, 3, 2, 'LastRise=1;')
+            -- approccio
+            EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, SafeZ3RotAxis, EMC.R1, 0}, 30, 2, 2, 'FirstClimb=1;')
+            -- se non split deve muoversi anche la trave (la lama non è abbastanza alta in Z) quindi Mask = 31
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, SafeZ3RotAxis, EMC.R1, EMC.R2}, EgtIf( bSplit, 30, 31), 2, 2, 'LastClimb=1;')
+         end
+      end
+   -- testa con truciolatore su testa 3
+   elseif EMC.HEAD == 'H39' then
+      ;
    end
+
+   EMC.ERR = 0
 end
 
 ---------------------------------------------------------------------
@@ -322,7 +563,7 @@ local function GetNextRawInOrd( nCurrRawId)
 end
 
 -----------------------------------------------------------------------
-local function EnsureZmax( bCloseV, vCmd)
+local function EnsureZmax( bCloseV, vCmd, nInd)
    -- verifico non sia già inserito nella lista dei comandi
    for i = 1, #vCmd do
       if vCmd[i][1] == 4 then
@@ -334,7 +575,11 @@ local function EnsureZmax( bCloseV, vCmd)
       end
    end
    -- posizionamento sicuro teste e rulli
-   table.insert( vCmd, { 4, EgtIf( bCloseV, 1, 0)})
+   if not nInd then
+      table.insert( vCmd, { 4, EgtIf( bCloseV, 1, 0)})
+   else
+      table.insert( vCmd, nInd, { 4, EgtIf( bCloseV, 1, 0)})
+   end
    return true
 end
 
@@ -508,6 +753,14 @@ function OnSpecialApplyDisposition()
    end
    -- eseguo scarico
    SpecSetCarrPosFromCmds( vCmd2)
+   -- determino posizione testa trave
+   local nLastEntId = EgtGetLastInGroup( EgtGetLastInGroup( EgtGetFirstNameInGroup( EgtGetPrev( EMC.DISPID), 'CL')))
+   if nLastEntId then
+      local vAxes = EmtGetAxesPos( nLastEntId)
+      if #vAxes > 0 then EMC.TPOS = vAxes[1] end
+   else
+      EMC.TPOS = EgtGetInfo( EMC.DISPID, 'TPOS', 'd')
+   end
    local vCmd3 = SpecCalcUnload()
    -- unisco ed emetto i comandi
    vCmd = EgtJoinTables( vCmd, vCmd2)
@@ -517,12 +770,45 @@ 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) .. ')')
 
    -- Inizializzo codice di errore
    EMC.ERR = 0
 
+   EMC.ZMAX = false
+   EMC.ENDZMAX = false
+
+   -- Verifico flag di separazione e fase di scarico
+   local sNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
+   local bZMaxForced = false
+   if EgtGetValInNotes( sNotes, 'StartZmax', 's') == 'FORCED' then
+      bZMaxForced = true
+   end
+   -- si cancella eventuale flag per risalita in ZMAX
+   sNotes = EgtSetValInNotes( sNotes, 'StartZmax')
+   EgtSetMachiningParam( MCH_MP.USERNOTES, sNotes)
+
+   local sPrevTool, dPrevValR3
+
    -- Recupero la posizione della trave e dei carrelli al termine della precedente operazione
    local nPrevOpeId = EgtGetPrevActiveOperation( EMC.MCHID)
    -- se precedente operazione non esiste, errore
@@ -581,6 +867,18 @@ function OnPostApplyMachining()
       EMC.V1POS = EgtIf( bAtZMax, ParkV1, EgtGetInfo( nLastPathId, 'V1POS', 'd') or ParkV1)
       EMC.V2POS = EgtIf( bAtZMax, ParkV2, EgtGetInfo( nLastPathId, 'V2POS', 'd') or ParkV2)
       EMC.CNT = SpecGetCNT( EMC.MCHID)
+      if vAxes[6] then
+         -- imposto lavorazione e utensile correnti
+         EgtSetCurrMachining( nPrevOpeId)
+         dPrevValR3 = vAxes[6]
+         local sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+         if not sTool then
+            local sTuuid = EgtGetMachiningParam( MCH_MP.TUUID)
+            sTool = EgtTdbGetToolFromUUID( sTuuid) or ''
+         end
+         sPrevTool = sTool
+         EgtSetCurrMachining( EMC.MCHID)
+      end
    end
 
    -- Verifico se ultima lavorazione della fase
@@ -609,7 +907,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
@@ -664,6 +962,29 @@ function OnPostApplyMachining()
       local nLastEntId = EgtGetLastInGroup( EMC.PATHID)
       local vAxes = EmtGetAxesPos( nLastEntId)
       if #vAxes > 0 then EMC.TPOS = vAxes[1] end
+      -- controllo se serve cambiare la presa
+      if vAxes[6] and dPrevValR3 then
+         local sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+         if not sTool then
+            local sTuuid = EgtGetMachiningParam( MCH_MP.TUUID)
+            sTool = EgtTdbGetToolFromUUID( sTuuid) or ''
+         end
+         -- se stesso utensile ma cambia la presa dell'aggregato
+         if sTool == sPrevTool and  abs( dPrevValR3 - vAxes[6]) > 10 * GEO.EPS_SMALL then
+            EMC.CHANGETAKE = true
+         end
+      end
+   end
+
+   -- Se richiesto movimento preliminare della testa a Zmax perchè c'è stato un riposizionamento delle pinze
+   if EMC.ZMAX or bZMaxForced then
+      sNotes = EgtSetValInNotes( sNotes, 'StartZmax', 11)
+      EgtSetMachiningParam( MCH_MP.USERNOTES, sNotes)
+   end
+
+   if EMC.CHANGETAKE then
+      sNotes = EgtSetValInNotes( sNotes, 'StartZmax', 12)
+      EgtSetMachiningParam( MCH_MP.USERNOTES, sNotes)
    end
 
 end
@@ -673,7 +994,10 @@ function SpecApplyPath( bPreSplit, bSplitting, bPreCut, bCutting, bUnload)
 
    -- Verifico se lavorazione pareti
    local bWall = ( EgtGetInfo( EgtGetCurrMachGroup() or GDB_ID.NULL, 'Wall', 'd') == 1)
-   
+   -- se il pezzo dev'essere scaricato al carico
+   local dUnloadType = EgtGetInfo( EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or GDB_ID.NULL, 'UNLOAD', 'd')
+   local bUnloadOnLoadPos = dUnloadType == 1 or dUnloadType == -1
+
    -- mi salvo info lavorazione su una lista
    local AuxInfoMach = {}
    AuxInfoMach.bPreSplit = bPreSplit
@@ -689,6 +1013,13 @@ function SpecApplyPath( bPreSplit, bSplitting, bPreCut, bCutting, bUnload)
    local b3Tot = BBox3d()
    local b3Raw = BBox3d()
    local nNextOddPhase = GetNextStartOrRestPhase( EMC.PHASE)
+   -- se esistono più grezzi toglie l'impostazione di scarico al carico e ritorna errore
+   if bUnloadOnLoadPos and ( nNextOddPhase and nNextOddPhase <= EgtGetPhaseCount()) then
+      bUnloadOnLoadPos = false
+      EMC.ERR = 22
+      EMC.MSG = ' Error : Unload on Load Position not reachable if raw part on Load Position'
+      return
+   end
    local nRawId = EgtGetFirstRawPart()
    local nCurrRawId = GDB_ID.NULL
    while nRawId do
@@ -739,6 +1070,10 @@ function SpecApplyPath( bPreSplit, bSplitting, bPreCut, bCutting, bUnload)
    elseif bPreCut  or  bCutting then
       local dDistF, dDistB, dRollF, dRollB = SpecialCalcPhaseEncumbrance( EMC.PHASE + 1)
       dDistFront = min( dDistFront, dDistF)
+      -- Se è previsto lo scarico al carico aumenta l'ingombro dell'area di lavoro
+      if bUnloadOnLoadPos then
+         dDistFront = dDistFront -( MinDeltaYV*2 + AGG_V)
+      end
       dDistBack = min( dDistBack, dDistB)
    end
 
@@ -1109,7 +1444,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
 
@@ -1142,7 +1477,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
@@ -1267,8 +1604,100 @@ function SpecCalcSplit( dLenRaw, dMaxLenLeft)
    return vCmd
 end
 
+---------------------------------------------------------------------
+-- Scarica il pezzo in zona di carico
+function SpecCalcUnloadOnLoadPos()
+   local vCmdPre = {}
+   EgtOutLog( ' *[UL]', 1)
+   if not EMC.Y1DELTA and not EMC.Y2DELTA then
+      EMC.ERR = 21
+      EMC.MSG = '  Error : Y1 and Y2 not clamped for unloading'
+      return {}
+   end
+   -- Se pinza Y2 chiusa, devo effettuare uno scambio
+   local dY1DeltaMaxSP = MaxY1 - UnloadOnLoadTPos - TurnerOffs - 10 * GEO.EPS_SMALL
+   if EMC.Y2DELTA or EMC.Y1DELTA > dY1DeltaMaxSP then
+      -- imposto quote aggancio per avere solo pinza Y
+      local dDistFront = 0
+      local dDistBack = EMC.LB - MinOther - EMC.HOVM + 10 * GEO.EPS_SMALL
+      -- dico che le paratie sono chiuse perchè poi se ho dei movimenti, verranno chiuse, quindi parto considerandole già chiuse
+      EMC.V1POS = 0
+      EMC.V2POS = 0
+      -- effettuo scambio
+      vCmdPre = SpecCalcCarriages( dDistFront, dDistBack, 0, 0, dY1DeltaMaxSP)
+      -- recupero nuova posizione carrelli
+      SpecSetCarrPosFromCmds( vCmdPre)
+      EgtOutLog( '  [UL1]', 1)
+   end
+   -- porto il pezzo alla zona di rotazione con il carro Y1
+   local vCmd = {}
+   -- Commento
+   table.insert( vCmd, { 0, 'Unload-On-Load'})
+   -- posizionamento sicuro teste e rulli
+   if #vCmdPre > 0 then
+      EnsureZmax( true, vCmdPre, 2)
+   else
+      EnsureZmax( true, vCmd)
+   end
+   -- Se pinza V chiusa, la apro
+   if EMC.Y2DELTA then
+      table.insert( vCmd, { 12, 0})
+   end
+   -- riporto la trave al carico
+   local dRotT = UnloadOnLoadTPos + TurnerOffs
+   local dY1Move = dRotT + EMC.Y1DELTA
+   if dY1Move > MaxY1 then
+      local dRotTStep, dY1MoveStep = dRotT - dY1Move + MaxY1, MaxY1
+      if MinBeamLenUnloadInLine and EMC.LB >= MinBeamLenUnloadInLine then
+         table.insert( vCmd, { 2, 'Y1', dY1MoveStep, 'T', dRotTStep, 'BrakeBeam'})
+         -- apro la morsa
+         table.insert( vCmd, { 11, 0})
+         -- riporto il carrello in fondo alla trave
+         dY1MoveStep = dRotTStep + ( EMC.HCING or 0)
+         dY1Move = dY1MoveStep + dY1Move - MaxY1
+         table.insert( vCmd, { 1, 'Y1', dY1MoveStep, 'UnBrakeBeam'})
+         -- chiudo la morsa
+         table.insert( vCmd, { 11, 1})
+      end
+   end
+   table.insert( vCmd, { 2, 'Y1', dY1Move, 'T', dRotT, 'BrakeBeam'})
+   -- apro la morsa
+   table.insert( vCmd, { 11, 0})
+   EMC.CNT = nil
+   -- riporto il carrello in home
+   table.insert( vCmd, { 1, 'Y1', ParkY1, 'UnBrakeBeam'})
+
+   -- eventuale unione tabelle
+   if #vCmdPre > 0 then
+      vCmd = EgtJoinTables( vCmdPre, vCmd)
+   end
+
+   return vCmd
+end
+
 ---------------------------------------------------------------------
 function SpecCalcUnload()
+   -- In caso di condizioni rispettate richiama lo scarico al carico e ritorna
+   local nNextPathId
+   local nNextMchId
+   local nNextDispId
+   if EMC.PATHID then nNextPathId = EgtGetNextActiveOperation( EMC.PATHID) end
+   if EMC.MCHID then nNextMchId = EgtGetNextActiveOperation( EMC.MCHID) end
+   if EMC.DISPID then nNextDispId = EgtGetNextActiveOperation( EMC.DISPID) end
+   -- se il pezzo dev'essere scaricato al carico
+   local dUnloadType = EgtGetInfo( EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or GDB_ID.NULL, 'UNLOAD', 'd')
+   local bUnloadOnLoadPos = dUnloadType == 1 or dUnloadType == -1
+   if bUnloadOnLoadPos then
+      -- è l'ultimo path, è l'ultima lavorazione, non ci sono altre disposizioni e non c'è rimanenza
+      if not nNextPathId and not nNextMchId and not nNextDispId and not IsStartOrRestPhase(EMC.PHASE) then
+         local vCmd = SpecCalcUnloadOnLoadPos()
+         return vCmd
+      else
+         EMC.ERR = 21
+         EMC.MSG = ' Error : Unload on Load Position not reachable if raw part on Load Position'
+         return {}
+      end
+   end
    local vCmdPre = {}
    EgtOutLog( '  *[U]', 1)
    if not EMC.Y1DELTA and not EMC.Y2DELTA then
@@ -1317,15 +1746,39 @@ function SpecCalcUnload()
    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})
+      local dBeamTailY2 = dFinY2 + ( EMC.LB - EMC.Y2DELTA) - ( EMC.TCING or 0)
+      -- Se scarico in linea scrivo una nota in più per l'attivazione del piano ferma pezzo (M125)
+      if MinBeamLenUnloadInLine and EMC.LB >= MinBeamLenUnloadInLine then
+         table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2, 'BrakeBeam'})
+      else
+         table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2})
+      end
       EgtOutLog( '  Y2PosF=' .. EgtNumToString( dFinY2), 1)
+      -- Se scarico in "linea"
+      if MinBeamLenUnloadInLine and EMC.LB >= MinBeamLenUnloadInLine then
+         -- apro la morsa
+         table.insert( vCmd, { 12, 0})
+         local dY2MoveMax = MinY2
+         if dBeamTailY2 >= ( dY2MoveMax + ( EMC.TCING or 0)) then
+            local dTMove = dY2MoveMax - EMC.LB + ( EMC.TCING or 0)
+            -- riporto il carrello in fondo alla trave
+            table.insert( vCmd, { 1, 'Y2', dBeamTailY2, 'UnBrakeBeam'})
+            -- chiudo la morsa
+            table.insert( vCmd, { 12, 1})
+            -- finisco scarico trave
+            table.insert( vCmd, { 2, 'T', dTMove, 'Y2', dY2MoveMax})
+            EgtOutLog( '  Y2PosF=' .. EgtNumToString( dY2MoveMax), 1)
+         end
+      end
    else
-      table.insert( vCmd, { 1, 'Y2', MaxY2})
+      local dFinT = min( MaxY2 - EMC.Y2DELTA, max( UnloadT - MaxUnloadLen, MinY2 - EMC.Y2DELTA))
+      local dFinY2 = dFinT + EMC.Y2DELTA
+      table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2})
    end
    -- apro la morsa
    table.insert( vCmd, { 12, 0})
    -- riporto il carrello in home
-   table.insert( vCmd, { 1, 'Y2', ParkY2})
+   table.insert( vCmd, { 1, 'Y2', ParkY2, 'NoWaitUnload'})
 
    -- eventuale unione tabelle
    if #vCmdPre > 0 then
@@ -2447,14 +2900,17 @@ function SpecOutputCmds( vCmd, bEnd)
       -- commento
       if Cmd[1] == 0 then
          local sInfo = '0,'..Cmd[2]
+         if Cmd[3] then
+            sInfo = sInfo..','..Cmd[3]
+         end
          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
@@ -2465,6 +2921,14 @@ function SpecOutputCmds( vCmd, bEnd)
       elseif Cmd[1] == 4 then
          local sInfo = '4,'..EgtNumToString( Cmd[2],0)
          EgtSetInfo( EMC.PATHID, sKey, sInfo)
+         -- se chiusura rulli
+         if Cmd[2] == 1 then
+            if bEnd then
+               EMC.ENDZMAX = true
+            else
+               EMC.ZMAX = true
+            end
+         end
       -- apertura/chiusura morsa Y
       elseif Cmd[1] == 11 then
          local sInfo = '11,'..EgtNumToString( Cmd[2],0)
@@ -2527,8 +2991,26 @@ function SpecOutputCmds( vCmd, bEnd)
          EgtSetInfo( NextDispId, 'V1POS', EMC.V1POS)
          EgtSetInfo( NextDispId, 'V2POS', EMC.V2POS)
       end
+      -- se bisogna andare a ZMAX alla fine, si setta il parametro sulla lavorazione successiva in modo che la corrente vada in home 
+      if EMC.ENDZMAX and EMC.MCHID then
+         -- recupero lavorazione successiva
+         local nNextMchId = EgtGetNextActiveOperation( EMC.MCHID, true)
+         while nNextMchId do
+            if EgtGetOperationType( nNextMchId) ~= MCH_OY.DISP then
+               if EgtSetCurrMachining( nNextMchId) then
+                  -- Verifico flag di separazione e fase di scarico
+                  local sNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
+                  -- si cancella eventuale flag per risalita in ZMAX
+                  sNotes = EgtSetValInNotes( sNotes, 'StartZmax', 'FORCED')
+                  EgtSetMachiningParam( MCH_MP.USERNOTES, sNotes)
+                  EgtSetCurrMachining( EMC.MCHID)
+                  break
+               end
+            end
+            nNextMchId = EgtGetNextActiveOperation( nNextMchId, true)
+         end
+      end
    end
-
 end
 
 ---------------------------------------------------------------------

UpdateLog.txt

@@ -1,5 +1,74 @@
            ==== Common_PF1250 Update Log ====
 
+Versione 3.1-- (--/--/2026)
+- (ALL) Prima versione NEW LINK. Serve attivazione in MLDE
+
+Versione 3.1g1 (15/07/2026)
+- (GEN) Se prima lavorazione con punta lunga sbagliava movimenti approccio.
+
+Versione 3.1f2 (24/06/2026)
+- (SIM-GEN) UnloadOnLoad - se posizione di scarico non raggiungibile lo scarica dove può. Ticket#3041
+- (SIM-GEN) SpecCalcCarriages - se dY1DeltaMaxSP < dY1DeltaMinF non lo considera. Ticket#3041
+
+Versione 3.1f1 (05/06/2026)
+- (GEN) In caso di ultimo movimento come scarico rimanenza, porta V2 in posizione di parcheggio. Ticket#3006
+- (SIM-GEN) Gestione nuova macchina 3T_5Ax
+- (SIM-GEN) Gestione scarico al carico da parametro pezzo
+
+Versione 3.1e2 (15/05/2026)
+- (SIM-GEN) Corretta gestione scarico manuale ( errore in versione 3.1e1)
+
+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

Version.lua

@@ -3,8 +3,8 @@
 
 local InfoCommon_STD_PP = {
    NAME = 'Common_PF1250',            -- nome script PP standard
-   VERSION = '2.7h2',                 -- versione script
-   MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
+   VERSION = '3.1--',                 -- versione script
+   MIN_MACH_VER_PP_COMMON = '3.1b2'   -- versione minima kernel
 }
 
 return InfoCommon_STD_PP