Merge remote-tracking branch 'origin/main' into develop

Merge remote-tracking branch 'origin/develop'
- In caso di motosega prelevata, si ruota in home.
2026-03-27 15:39:19 +01:00 · 2026-03-27 15:22:05 +01:00 · 2026-03-27 15:14:21 +01:00 · 2026-03-27 13:04:52 +01:00 · 2026-03-26 15:25:10 +01:00 · 2026-03-25 17:02:10 +01:00
7 changed files with 2256 additions and 548 deletions
@@ -3,9 +3,10 @@

 -- carico librerie
 local INFO_STD_PP = require( 'Version')
+local BD = require( 'BeamData')

 -- Variabili di modulo
-local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
+local CSP_INFO =     INFO_STD_PP.NAME..'_'..NumericalControl..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
 local MACHINE_INFO = MACH_NAME..'  ver.'..PP_VER
 local TEST_USE = false

@@ -26,7 +27,9 @@ function OnStart()
   --EMT.LINEINC = 1        -- incremento numerazione linee
   --EMT.Ft = 'F'           -- token per feed
   --EMT.St = 'S'           -- token per speed
-   EMT.FMAXPINZE = 154000 -- feed massima pinze
+   EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 154000, 20000, 160000)  -- feed massima pinze
+   EMT.MAXACC = MaxAcc or ( EMT.FMAXPINZE / ( 60 * 0.3))  -- accelerazione massima pinze
+   EMT.MINACC = MinAcc or ( EMT.FMAXPINZE / ( 60 * 4))    -- accelerazione minima pinze
 end

 ---------------------------------------------------------------------
@@ -41,13 +44,18 @@ function OnProgramStart()
   local BtlInfoId = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or EgtGetCurrMachGroup() or GDB_ID.NULL
   local nPatt = EgtGetInfo( BtlInfoId, 'PATTID', 'i') or 40
   EmtOutput( '%'..EgtNumToString( nPatt, 0)..'.0')
+
+   -- aggiungo prefisso per commentae commenti iniziali se la macchina è utilizzata per fare i test
+   local sPrefixCommentLine = '' ; if IS_TEST_MACHINE or EgtEndsWith( EgtGetCurrMachineDir(), '.TEST') then sPrefixCommentLine = '//' end
+
   if EMT.INFO then
-      EmtOutput( '('..EMT.INFO..')')
+      EmtOutput( sPrefixCommentLine..'('..EMT.INFO..')')
   else
      EmtOutput( '(Program Start)')
   end
-   EmtOutput( '('.. CSP_INFO..')')
-   EmtOutput( '('.. MACHINE_INFO..')\n')
+   EmtOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
+   EmtOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')\n')
+   EmtOutput( '(HEADER)')
   -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
   if TEST_USE then
      EmtOutput( 'M28')
@@ -99,6 +107,7 @@ function OnProgramEnd()
   EMT.FALL = nil
   EMT.RELOAD = nil
   EMT.RELOAD2 = nil
+   EmtOutput( '(FOOTER)')
   -- Se modalità test, termino il programma
   if TEST_USE then
      EmtOutput( 'M02')
@@ -176,16 +185,12 @@ function OnDispositionEnd()
      local STrave = EMT.ST
      local HOverM = EMT.HOVM
      -- calcolo dati pinze
-      local MinAccPinze = 0.3
-      local MaxAccPinze = 4
-      local KgMtCubo= 550           -- densità legno in Kg / metro cubo
+      local KgMtCubo= WoodDensity or 550           -- densità legno in Kg / metro cubo
      local Massa = ( HTrave * STrave * LBarra * KgMtCubo ) / 1000000000
      local FMaxPinze = EMT.FMAXPINZE
      local ForzaAtrito = 700 / 2   -- Serve per regolare P32 (700 valore reale pistone)
      local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAtrito) / 1000)
-      if ( TempoAcc < MinAccPinze) then TempoAcc = MinAccPinze end
-      if ( TempoAcc > MaxAccPinze) then TempoAcc = MaxAccPinze end
-      local AccPinze = FMaxPinze / ( 60 * TempoAcc)
+      local AccPinze = EgtClamp( FMaxPinze / ( 60 * TempoAcc), EMT.MINACC, EMT.MAXACC)
      local RidFeed = 100 / Massa * 100
      if ( RidFeed > 100) then RidFeed = 100 end
      if IdTrave >= 0 then
@@ -245,9 +250,9 @@ function OnDispositionEnd()
         EmtOutput( sOut)
      -- altrimenti recupero rimanenza   
      else
-         EmtOutput( 'G112 EC1'..' Y'..EmtLenToString( LoadT, 3).. ' EY'..EmtLenToString( EMT.YPOS, 3)..' EV'..EmtLenToString( ParkV, 3) ..' EF'..GetFmaxClamp())
+         EmtOutput( 'G112 EC1'..' Y'..EmtLenToString( EMT.TPOS, 3).. ' EY'..EmtLenToString( EMT.YPOS, 3)..' EV'..EmtLenToString( ParkV, 3) ..' EF'..GetFmaxClamp())
         -- aggiorno dati aggancio carrelli alla trave
-         EMT.YDELTA = EMT.YPOS - LoadT
+         EMT.YDELTA = EMT.YPOS - EMT.TPOS
         EMT.VDELTA = nil
      end
      -- eventuale preparazione per rotazione immediata
@@ -491,6 +496,7 @@ function OnMachiningEnd()
   EMT.U_STD = nil
   EMT.PREVTOOL = EMT.TOOL
   EMT.PREVHEAD = EMT.HEAD
+   EMT.PREVET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
 end

 ---------------------------------------------------------------------
@@ -598,9 +604,14 @@ end

 ---------------------------------------------------------------------
 function OnRapid()
+   -- recupero prossimo utensile
+   EMT.NEXTTOOL, EMT.NEXTHEAD, EMT.NEXTTCPOS = FindNextTool()
   MyBackupAxes()
   -- se primo movimento della lavorazione, gestione speciale
   if EMT.MCHFIRST and not EMT.OPEISDISP then
+      -- primo posizionamento
+      local MyZHome = EgtGetAxisHomePos( 'Z')
+      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
      -- decido se muovere prima testa o carrelli (standard prima testa)
      local bHeadFirst = true
      local sLateG101
@@ -615,18 +626,33 @@ function OnRapid()
         if not EMT.ZMAX and #EMT.AUXSTR > 0 then
            EmitZmax()
            EMT.ZMAX = true
+            bHeadFirst = false
         end
      end

-      -- primo posizionamento
-      local MyZHome = EgtGetAxisHomePos( 'Z')
-      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
+      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+
+      local bGoToHome = false
+      -- se gli assi rotanti cambiano parecchio, con motosega si va in parcheggio 
+      if EMT.PREVHEAD == 'H3' and EMT.HEAD == 'H3' and sET == EMT.PREVET and ( abs( EMT.R2pp - EMT.R2) > 25 or abs( EMT.R1pp - EMT.R1) > 25)  then
+         bGoToHome = true
+      end
+
+      -- ricavo i dati per la lavorazione
+      local sEE = ' EE' .. EgtIf( bZmax, '3', '4')
+      local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
+      local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
+      local sES = ' ES'..EgtNumToString( EMT.S, 0)
+
      -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.FLAG2 == 1 then
         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
                                       ' B' .. EmtLenToString( EMT.R2pp, 3) .. ' C' .. EmtLenToString( EMT.R1pp, 3) .. 
                                       ' EE' .. EgtIf( bZmax, '3', '4') .. EMT.PREVsEL .. EMT.PREVsER .. EMT.PREVsET .. EMT.PREVsES
         EmtOutput( sOutPreMove)
+         sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1pp, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOutPreMove)
         EmtOutput( 'G101 ET1001')
         EmtOutput( 'G101 ET2001')
      end
@@ -636,18 +662,25 @@ function OnRapid()
         EmtOutput( '( *** ' .. sOut .. ' *** )')
      end

-      -- ricavo i dati per la lavorazione
-      local sEE = ' EE' .. EgtIf( bZmax, '3', '4')
-      local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
-      local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
-      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
-      local sES = ' ES'..EgtNumToString( EMT.S, 0)
-
      -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
-      if EMT.HEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if not EMT.LOAD and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TTOTLEN > 200)) and
+         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350) or bGoToHome) and EMT.FLAG2 == 1 then
         local sEEPreMove = ' EE' .. EgtIf( bZmax, '3', '4')
-         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
-                                       EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+         local sOutPreMove
+         if EMT.HEAD == 'H3' and bGoToHome then
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1pp, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+         elseif EMT.HEAD == 'H3' and  EMT.PREVHEAD ~= 'H3' then
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+         end
+         sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( EMT.R2, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
         EmtOutput( sOutPreMove)
         EmtOutput( 'G101 ET1001')
         EmtOutput( 'G101 ET2001')
@@ -828,12 +861,47 @@ function OnRapid()
      EmtAdjustRotaryAxes()
      EmitZmax()
      EMT.ZMAX = true
+      -- se pezzi alti e devo cambiare utensile su testa con CU, porto la testa vicino al cambio utensile
+      if EMT.ST > BeamHeightForFixRot  and  EMT.HEAD == 'H1' and  EMT.TOOL ~= EMT.NEXTTOOL  and  EMT.NEXTHEAD ~= 'H2' then
+         local dBAxis = 90
+         local dCAxis = EgtIf( BD.RIGHT_LOAD, 90, -90)         
+         local sEE = ' EE3'
+         local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
+         local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
+         local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+         local sES = ' ES'..EgtNumToString( EMT.S, 0)
+         local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..' B' .. EgtNumToString( dBAxis, 3) ..
+                      ' C' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOut)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
+         sOut = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. EmtGetAxis( 'L3') ..' B' .. EgtNumToString( dBAxis, 3) ..
+                ' C' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOut)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
+      end
   -- se altrimenti movimento in Home
   elseif EMT.FLAG == 4 then
      -- non previsto
-   -- se altrimenti rotazione a Z max
+   -- se altrimenti rotazione a Z max per lavorazione successiva
   elseif EMT.FLAG == 5 then
-      -- viene gestito all'inizio della lavorazione successiva
+      EMT.REFLOC = nil
+      EMT.IPLGL = false
+      MyAdjustLinearAxes()
+      EmtAdjustRotaryAxes()
+      EmtResetPrev()
+      -- ricavo i dati per la lavorazione
+      local sEE = ' EE3'
+      local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
+      local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
+      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+      local sES = ' ES'..EgtNumToString( EMT.S, 0)
+      local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..
+                             EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+      EmtOutput( sOut)
+      EmtOutput( 'G101 ET1001')
+      EmtOutput( 'G101 ET2001')
   -- altrimenti errore
   else
      EmtSetLastError( 1212, "Unknown Rapid flag")
@@ -925,13 +993,46 @@ function OnArc()
   local sFeed = EmtGetFeed()
   -- tipo arco
   local sArc = 'G' .. EgtNumToString(EMT.MOVE,0)
-   -- emetto arco
-   EmtOutput( sArc..sAxes..sRad..sFeed)
+   -- se arco molto grande, approssimo con una retta
+   if EMT.RR > 99999 then
+      EmtOutput( "G1"..sAxes..sFeed)
+   else
+      EmtOutput( sArc..sAxes..sRad..sFeed)
+   end

   -- aggiorno valori come precedenti
   EmtUpdatePrev()
 end

+---------------------------------------------------------------------
+function FindNextTool()
+   -- salvo stato iniziale
+   local CurrMachId = EgtGetCurrMachining()
+   local CurrTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
+   -- cerco lavorazione con utensile su gruppo testa indicato
+   local sTool, sHead, sTcPos
+   local OpId = EgtGetNextActiveOperation( CurrMachId or EMT.MCHID)
+   while OpId do
+      local nType = EgtGetOperationType( OpId)
+      if nType ~= MCH_OY.NONE  and  nType ~= MCH_OY.DISP then
+         if EgtSetCurrMachining( OpId) then
+            sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+            if EgtTdbSetCurrTool( sTool) then
+               sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+               sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+               break
+            end
+         end
+      end
+      OpId = EgtGetNextActiveOperation( OpId)
+   end
+   -- ripristino stato iniziale
+   EgtSetCurrMachining( CurrMachId or GDB_ID.NULL)
+   EgtTdbSetCurrTool( CurrTool or '')
+   -- restituisco risultato
+   return sTool, sHead, sTcPos
+end
+
 ---------------------------------------------------------------------
 function CalcCharStatus( sCmd, bSkipPress)
   -- aperto
@@ -1456,10 +1557,13 @@ function MyAdjustLinearAxes()

   if EMT.REFLOC then
      local vtE
-      if EMT.HEAD ~= 'H3' then
+      -- su NUM aggregati non gestiti
+      if EMT.HEAD == 'H5' or EMT.HEAD == 'H6' or EMT.HEAD == 'H7' then
+         EmtSetLastError( 1211, "Aggregates not managed")
+      elseif EMT.HEAD ~= 'H3' then
         local Len = EMT.TLEN + EgtIf( EMT.HEAD == 'H1', MillOffs, abs( SawOffs))
         local LenRef = MillOffs
-         vtE = Vector3d( EMT.EXTR) * Len - Z_AX() * LenRef
+         vtE = Vector3d( EMT.TDIR) * Len - Z_AX() * LenRef
      else
         local LenAux = ( EMT.TDIST or ChSawLen) + MillOffs
         local LenRef = MillOffs
@@ -1571,7 +1675,7 @@ end

 ---------------------------------------------------------------------
 function GetET( sHead, sTcPos, dAxR3)
-   if sHead == 'H1' then
+   if sHead == 'H1' or sHead == 'H5' or sHead == 'H6' or sHead == 'H7' then
      return ' E'..sTcPos
   elseif sHead == 'H2' then
      return ' ET42'
@@ -3,9 +3,10 @@

 -- carico librerie
 local INFO_STD_PP = require( 'Version')
+local BD = require( 'BeamData')

 -- Variabili di modulo
-local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
+local CSP_INFO =     INFO_STD_PP.NAME..'_'..NumericalControl..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
 local MACHINE_INFO = MACH_NAME..'  ver.'..PP_VER
 local TEST_USE = false

@@ -26,7 +27,9 @@ function OnStart()
   --EMT.LINEINC = 1        -- incremento numerazione linee
   --EMT.Ft = 'F'           -- token per feed
   --EMT.St = 'S'           -- token per speed
-   EMT.FMAXPINZE = 154000 -- feed massima pinze
+   EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 154000, 20000, 160000)  -- feed massima pinze
+   EMT.MAXACC = MaxAcc or ( EMT.FMAXPINZE / ( 60 * 0.3))  -- accelerazione massima pinze
+   EMT.MINACC = MinAcc or ( EMT.FMAXPINZE / ( 60 * 4))    -- accelerazione minima pinze
 end

 ---------------------------------------------------------------------
@@ -41,13 +44,18 @@ function OnProgramStart()
   local BtlInfoId = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or EgtGetCurrMachGroup() or GDB_ID.NULL
   local nPatt = EgtGetInfo( BtlInfoId, 'PATTID', 'i') or 40
   EmtOutput( '%'..EgtNumToString( nPatt, 0)..'.0')
+
+   -- aggiungo prefisso per commentae commenti iniziali se la macchina è utilizzata per fare i test
+   local sPrefixCommentLine = '' ; if IS_TEST_MACHINE or EgtEndsWith( EgtGetCurrMachineDir(), '.TEST') then sPrefixCommentLine = '//' end
+
   if EMT.INFO then
-      EmtOutput( '('..EMT.INFO..')')
+      EmtOutput( sPrefixCommentLine..'('..EMT.INFO..')')
   else
      EmtOutput( '(Program Start)')
   end
-   EmtOutput( '('.. CSP_INFO..')')
-   EmtOutput( '('.. MACHINE_INFO..')\n')
+   EmtOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
+   EmtOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')\n')
+   EmtOutput( '(HEADER)')
   -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
   if TEST_USE then
      EmtOutput( 'M28')
@@ -103,6 +111,7 @@ function OnProgramEnd()
   EMT.FALL = nil
   EMT.RELOAD = nil
   EMT.RELOAD2 = nil
+   EmtOutput( '(FOOTER)')
   -- Se modalità test, termino il programma
   if TEST_USE then
      EmtOutput( 'M02')
@@ -133,6 +142,18 @@ function OnToolData()
      if EMT.TDIST and abs( EMT.TDIST) < 0.1 then EMT.TDIST = nil end
      local sOut = 'L11='..EgtNumToString( EMT.SMAX, 0)..' L12='..EmtLenToString( ( EMT.TDIST or ChSawLen), 1)..' G76H9998.1N301N304'
      EmtOutput( sOut)
+   -- emissione dati rinvio
+   elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
+      local nPos = EgtIf( EMT.HEAD == 'H5', 91, 93)
+      if EMT.EXIT == 2 then nPos = nPos + 1 end
+      local sPos = 'N2' .. tostring(nPos)
+      local sOut = 'L11=' .. EmtLenToString( EMT.SMAX, 3) .. ' L12=' .. EmtLenToString( AngTr1Offs, 1)..' G76H9998.1'..sPos..sPos
+      EmtOutput( sOut)
+   -- emissione dati sega a catena
+   elseif EMT.HEAD == 'H7' then
+      local sOut = 'L11='..EgtNumToString( EMT.SMAX, 0)..' L12='..EmtLenToString( ( 154.5), 1)..' G76H9998.1N121N121'
+      EmtOutput( sOut)
+-- altro non previsto
   end
 end

@@ -151,7 +172,7 @@ function OnDispositionStart()
                   ' EG'..EmtLenToString( SawOffs, 2)..' EI'..EmtLenToString( ParkY, 2)..' EL'..EmtLenToString( ParkV, 2)..
                   ' EM'..EmtLenToString( TurnerOffs, 2)..' EN'..EmtLenToString( -DeltaTabY, 2)..' EO'..EmtLenToString( DeltaTabZ, 2)
      if SecondSupport >= 3 then
-         sOut = sOut ..' EP'..EmtLenToString( AngTr1Len, 2) ..' EQ'..EmtLenToString( AngTr1Offs + MillOffs,2)
+         sOut = sOut ..' EP'..EmtLenToString( AngTr1Len, 2) ..' EQ'..EmtLenToString( AngTr1Offs,2)
      end
      EmtOutput( '\n' .. sOut .. '\n')
      -- carico barra
@@ -186,9 +207,9 @@ function OnDispositionEnd()
      local BtlInfoId = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or EgtGetCurrMachGroup() or GDB_ID.NULL
      local nLoad90 = EgtGetInfo( BtlInfoId, 'LOAD90', 'i') or 0
      -- calcolo dati pinze
-      local AccPinze, AccMaxPinze, RidFeed, TempoAcc = CalcDinamicaPinze( HTrave, STrave, LBarra)
-      local AccPinz1, AccMaxPinz1, RidFeed1, TempoAcc1 = CalcDinamicaPinze( HTrave, STrave, LBarra - LTrave)
-      local AccPinz2, AccMaxPinz2, RidFeed2, TempoAcc2 = CalcDinamicaPinze( HTrave, STrave, LTrave)
+      local AccPinze, AccMaxPinze, RidFeed, TempoAcc = CalcDinamicaPinze_NUM( HTrave, STrave, LBarra)
+      local AccPinz1, AccMaxPinz1, RidFeed1, TempoAcc1 = CalcDinamicaPinze_NUM( HTrave, STrave, LBarra - LTrave)
+      local AccPinz2, AccMaxPinz2, RidFeed2, TempoAcc2 = CalcDinamicaPinze_NUM( HTrave, STrave, LTrave)
      if IdTrave >= 0 then
         local sOut = '( SN='..IdTrave..' LBarra='..EmtLenToString( LBarra, 3)..' L='..EmtLenToString( LTrave, 3)..
                      ' H='..EmtLenToString( HTrave, 3)..' S='..EmtLenToString( STrave, 3)..' Acc='..EgtNumToString( TempoAcc, 1)..
@@ -252,9 +273,9 @@ function OnDispositionEnd()
         EmtOutput( sOut)
      -- altrimenti recupero rimanenza   
      else
-         EmtOutput( 'G112 EC1'..' Y'..EmtLenToString( LoadT, 3).. ' EY'..EmtLenToString( EMT.YPOS, 3)..' EV'..EmtLenToString( ParkV, 3) ..' EF'..GetFmaxClamp())
+         EmtOutput( 'G112 EC1'..' Y'..EmtLenToString( EMT.TPOS, 3).. ' EY'..EmtLenToString( EMT.YPOS, 3)..' EV'..EmtLenToString( ParkV, 3) ..' EF'..GetFmaxClamp())
         -- aggiorno dati aggancio carrelli alla trave
-         EMT.YDELTA = EMT.YPOS - LoadT
+         EMT.YDELTA = EMT.YPOS - EMT.TPOS
         EMT.VDELTA = nil
      end
      -- eventuale preparazione per rotazione immediata
@@ -418,6 +439,10 @@ function OnMachiningStart()
   -- sistemazione speed
   if EMT.HEAD == 'H2' then
      EMT.S = EMT.S * 6
+   elseif EMT.HEAD == 'H5' and EMT.EXIT == 1 then
+      EMT.S = -EMT.S
+   elseif EMT.HEAD == 'H6' and EMT.EXIT == 1 then
+      EMT.S = -EMT.S
   end
   -- determino subito se taglio di separazione di pezzo a caduta
   EMT.PREFALLCUT = nil
@@ -472,7 +497,7 @@ function OnMachiningEnd()
   end
   for i = 1, #EMT.AUXSTR do
      local sOut = EMT.AUXSTR[i]
-      if EMT.AUXTYPE == 'S' then
+      if EMT.AUXTYPE == 'S' and sOut:find( 'G101 ') then
         sOut = sOut .. ' EH1'
      elseif EMT.AUXTYPE == 'U' and not EMT.CHY_ON and not sOut:find( 'ET') then
         sOut = sOut .. ' ET2'
@@ -519,6 +544,7 @@ function OnMachiningEnd()
   EMT.PREVTOOL = EMT.TOOL
   EMT.PREVHEAD = EMT.HEAD
   EMT.PREVR3 = EMT.R3
+   EMT.PREVET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
 end

 ---------------------------------------------------------------------
@@ -626,9 +652,14 @@ end

 ---------------------------------------------------------------------
 function OnRapid()
+   -- recupero prossimo utensile
+   EMT.NEXTTOOL, EMT.NEXTHEAD, EMT.NEXTTCPOS = FindNextTool()
   MyBackupAxes()
   -- se primo movimento della lavorazione, gestione speciale
   if EMT.MCHFIRST and not EMT.OPEISDISP then
+      -- primo posizionamento
+      local MyZHome = EgtGetAxisHomePos( 'Z')
+      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
      -- decido se muovere prima testa o carrelli (standard prima testa)
      local bHeadFirst = true
      local sLateG101
@@ -644,18 +675,56 @@ function OnRapid()
            EmitZmax( EMT.TOOL ~= EMT.PREVTOOL)
            EMT.ZMAX = true
            EMT.PREVTOOL = EMT.TOOL
+            bHeadFirst = false
         end
      end

-      -- primo posizionamento
-      local MyZHome = EgtGetAxisHomePos( 'Z')
-      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
+      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+
+      local bGoToHome = false
+      -- se gli assi rotanti cambiano parecchio, con motosega si va in parcheggio 
+      if EMT.PREVHEAD == 'H3' and EMT.HEAD == 'H3' and sET == EMT.PREVET and ( abs( EMT.R2pp - EMT.R2) > 25 or abs( EMT.R1pp - EMT.R1) > 25)  then
+         bGoToHome = true
+      end
+
+      -- ricavo i dati per la lavorazione
+      local sEE = ' EE' .. EgtIf( bZmax, '3', '4')
+      
+      local sEL = ' EL'
+       -- se motosega
+      if EMT.HEAD == 'H3' then
+         sEL = sEL..EmtLenToString( ( EMT.TDIST or ChSawLen), 3)
+      -- se aggregato
+      elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' or EMT.HEAD == 'H7' then
+         sEL = sEL..EmtLenToString( AngTr1Offs, 3)
+      -- se testa normale  ( H1 or H2)
+      else
+         sEL = sEL..EmtLenToString( EMT.TLEN, 3)
+      end
+
+      local sER = ' ER'
+       -- se motosega
+      if EMT.HEAD == 'H3' then
+         sER = sER..EmtLenToString( EMT.TLEN, 3)
+      -- se aggregato
+      elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' or EMT.HEAD == 'H7' then
+         sER = sER..EmtLenToString( EMT.TLEN + AngTr1Len, 3)
+      -- se testa normale  ( H1 or H2)
+      else
+         sER = sER..EmtLenToString( EMT.TDIAM / 2, 3)
+      end
+
+      local sES = ' ES'..EgtNumToString( EMT.S, 0)
+
      -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.FLAG2 == 1 then
         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
                                       ' B' .. EmtLenToString( EMT.R2pp, 3) .. ' C' .. EmtLenToString( EMT.R1pp, 3) .. 
                                       ' EE' .. EgtIf( bZmax, '3', '4') .. EMT.PREVsEL .. EMT.PREVsER .. EMT.PREVsET .. EMT.PREVsES
         EmtOutput( sOutPreMove)
+         sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOutPreMove)
         EmtOutput( 'G101 ET1001')
         EmtOutput( 'G101 ET2001')
      end
@@ -665,18 +734,25 @@ function OnRapid()
         EmtOutput( '( *** ' .. sOut .. ' *** )')
      end

-      -- ricavo i dati per la lavorazione
-      local sEE = ' EE' .. EgtIf( bZmax, '3', '4')
-      local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
-      local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
-      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
-      local sES = ' ES'..EgtNumToString( EMT.S, 0)
-
      -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
-      if EMT.HEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if not EMT.LOAD and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TTOTLEN > 200)) and 
+         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350) or bGoToHome) and EMT.FLAG2 == 1 then
         local sEEPreMove = ' EE' .. EgtIf( bZmax, '3', '4')
-         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
-                                       EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+         local sOutPreMove
+         if EMT.HEAD == 'H3' and bGoToHome then
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1pp, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+         elseif EMT.HEAD == 'H3' and  EMT.PREVHEAD ~= 'H3' then
+            sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( 0, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
+            EmtOutput( sOutPreMove)
+         end
+         sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EgtNumToString( EMT.R2, 3) .. ' C' .. EgtNumToString( EMT.R1, 3) .. sEE .. sEL .. sER .. sET .. sES
         EmtOutput( sOutPreMove)
         EmtOutput( 'G101 ET1001')
         EmtOutput( 'G101 ET2001')
@@ -803,7 +879,7 @@ function OnRapid()
         sOut = 'G112 EA'..sA..' EB'..sB..EmtGetAxis('L1')..' EY'..sY..' EV'..sV..' EF'..GetFmaxClamp()
         EmtOutput( sOut)
         -- se taglio di coda senza residuo da scaricare, emetto M175 per accelerare il carico della barra successiva
-         if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') then
+         if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') and ( IsEndPhase( EMT.PHASE+1) or IsEnd2Phase( EMT.PHASE+1)) then
            EmtOutput( '(M175)')
         end
         if not bHeadFirst then
@@ -867,12 +943,47 @@ function OnRapid()
      EmtAdjustRotaryAxes()
      EmitZmax( false)
      EMT.ZMAX = true
+      -- se pezzi alti e devo cambiare utensile su testa con CU, porto la testa vicino al cambio utensile
+      if EMT.ST > BeamHeightForFixRot  and  EMT.HEAD == 'H1' and  EMT.TOOL ~= EMT.NEXTTOOL  and  EMT.NEXTHEAD ~= 'H2' then
+         local dBAxis = 90
+         local dCAxis = EgtIf( BD.RIGHT_LOAD, 90, -90)         
+         local sEE = ' EE3'
+         local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
+         local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
+         local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+         local sES = ' ES'..EgtNumToString( EMT.S, 0)
+         local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..' B' .. EgtNumToString( dBAxis, 3) ..
+                      ' C' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOut)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
+         sOut = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. EmtGetAxis( 'L3') ..' B' .. EgtNumToString( dBAxis, 3) ..
+                ' C' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOut)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
+         end
   -- se altrimenti movimento in Home
   elseif EMT.FLAG == 4 then
      -- non previsto
-   -- se altrimenti rotazione a Z max
+   -- se altrimenti rotazione a Z max per lavorazione successiva
   elseif EMT.FLAG == 5 then
-      -- viene gestito all'inizio della lavorazione successiva
+      EMT.REFLOC = nil
+      EMT.IPLGL = false
+      MyAdjustLinearAxes()
+      EmtAdjustRotaryAxes()
+      EmtResetPrev()
+      -- ricavo i dati per la lavorazione
+      local sEE = ' EE3'
+      local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
+      local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
+      local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+      local sES = ' ES'..EgtNumToString( EMT.S, 0)
+      local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..
+                             EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+      EmtOutput( sOut)
+      EmtOutput( 'G101 ET1001')
+      EmtOutput( 'G101 ET2001')
   -- altrimenti errore
   else
      EmtSetLastError( 1212, "Unknown Rapid flag")
@@ -938,6 +1049,11 @@ end

 ---------------------------------------------------------------------
 function OnArc()
+   -- con aggregato non si possono fare archi. Deve essere tutto spezzato
+   if EMT.HEAD == 'H5' or EMT.HEAD == 'H6' or EMT.HEAD == 'H7' then
+      EmtSetLastError( 1211, "With aggregate, the arcs must be splitted")
+   end
+
   MyBackupAxes()
   EMT.TLAST = EMT.L1
   -- non modale su archi
@@ -964,33 +1080,44 @@ function OnArc()
   local sFeed = EmtGetFeed()
   -- tipo arco
   local sArc = 'G' .. EgtNumToString(EMT.MOVE,0)
-   -- emetto arco
-   EmtOutput( sArc..sAxes..sRad..sFeed)
+   -- se arco molto grande, approssimo con una retta
+   if EMT.RR > 99999 then
+      EmtOutput( "G1"..sAxes..sFeed)
+   else
+      EmtOutput( sArc..sAxes..sRad..sFeed)
+   end

   -- aggiorno valori come precedenti
   EmtUpdatePrev()
 end

 ---------------------------------------------------------------------
-function CalcDinamicaPinze( dH, dS, dL)
-   local MinTempoAcc = 0.3                         -- [s]
-   local MaxTempoAcc = 4.0                         -- [s]
-   local KgMtCubo= 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
+function FindNextTool()
+   -- salvo stato iniziale
+   local CurrMachId = EgtGetCurrMachining()
+   local CurrTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
+   -- cerco lavorazione con utensile su gruppo testa indicato
+   local sTool, sHead, sTcPos
+   local OpId = EgtGetNextActiveOperation( CurrMachId or EMT.MCHID)
+   while OpId do
+      local nType = EgtGetOperationType( OpId)
+      if nType ~= MCH_OY.NONE  and  nType ~= MCH_OY.DISP then
+         if EgtSetCurrMachining( OpId) then
+            sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+            if EgtTdbSetCurrTool( sTool) then
+               sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+               sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+               break
+            end
+         end
+      end
+      OpId = EgtGetNextActiveOperation( OpId)
   end
-   return AccPinze, AccMaxPinze, RidFeed, TempoAcc
+   -- ripristino stato iniziale
+   EgtSetCurrMachining( CurrMachId or GDB_ID.NULL)
+   EgtTdbSetCurrTool( CurrTool or '')
+   -- restituisco risultato
+   return sTool, sHead, sTcPos
 end

 ---------------------------------------------------------------------
@@ -1517,16 +1644,29 @@ function MyAdjustLinearAxes()

   if EMT.REFLOC then
      local vtE
-      if EMT.HEAD ~= 'H3' then
+      if EMT.HEAD == 'H1' or EMT.HEAD == 'H2' then
         local Len = EMT.TLEN + EgtIf( EMT.HEAD == 'H1', MillOffs, abs( SawOffs))
         local LenRef = MillOffs
-         vtE = Vector3d( EMT.EXTR) * Len - Z_AX() * LenRef
-      else
+         vtE = Vector3d( EMT.TDIR) * Len - Z_AX() * LenRef
+      elseif EMT.HEAD == 'H3' then
         local LenAux = ( EMT.TDIST or ChSawLen) + MillOffs
         local LenRef = MillOffs
         local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
         vtE = vtAux * LenAux - Z_AX() * LenRef
+      elseif  EMT.HEAD == 'H5'  or EMT.HEAD == 'H6' then
+         local LenAux = AngTr1Offs + MillOffs
+         local LenRef = MillOffs
+         local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
+         vtE = vtAux * LenAux - Z_AX() * LenRef
+      elseif  EMT.HEAD == 'H7' then
+         local LenAux = AngTrBHOffs + MillOffs
+         local LenRef = MillOffs
+         local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
+         vtE = vtAux * LenAux - Z_AX() * LenRef
+      else
+         EmtSetLastError( 1211, 'Head not allowed ' .. EMT.HEAD)
      end
+
      EMT.L1 = EMT.L1 - vtE:getX()
      EMT.L2 = EMT.L2 - DeltaTabY - vtE:getY()
      EMT.L3 = EMT.L3 - DeltaTabZ - vtE:getZ()
@@ -1566,7 +1706,7 @@ function CalcInterpPlane()
   local ptS = Point3d( xS, 0, 0)
   -- calcolo per piano generico
   local vtE
-   if EMT.HEAD ~= 'H3' then
+   if EMT.HEAD == 'H1' or EMT.HEAD == 'H2' then
      vtE = Vector3d( EMT.EXTR)
   else
      vtE = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
@@ -1617,7 +1757,7 @@ end

 ---------------------------------------------------------------------
 function GetET( sHead, sTcPos, dAxR3)
-   if sHead == 'H1' then
+   if sHead == 'H1' or sHead == 'H5' or sHead == 'H6' or sHead == 'H7' then
      return ' E'..sTcPos
   elseif sHead == 'H2' then
      return ' ET42'
@@ -3,9 +3,10 @@

 -- carico librerie
 local INFO_STD_PP = require( 'Version')
+local BD = require( 'BeamData')

 -- Variabili di modulo
-local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
+local CSP_INFO =     INFO_STD_PP.NAME..'_'..NumericalControl..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
 local MACHINE_INFO = MACH_NAME..'  ver.'..PP_VER
 local TEST_USE = false

@@ -20,14 +21,19 @@ function OnStart()
   EMT.USETO1 = false     -- abilitazione uso origine tavola
   EMT.MODAL = true       -- abilitazione emissione modale
   EMT.INCHES = false     -- unità di misura mm/inches
-   EMT.DECNUM = 5         -- numero di decimali dopo la virgola
+   EMT.DECNUM = 4         -- numero di decimali dopo la virgola
+   EMT.DECVERS = 6        -- numero di decimali dopo la virgola per versori
+   EMT.DECRAD = 4         -- numero di decimali dopo la virgola per raggio
+   EMT.DECMACRO = 3       -- numero di decimali dopo la virgola per macro
   EMT.NUM = false        -- abilitazione numerazione linee
-   --EMT.Nt = 'N'           -- token per la numerazione di linea
-   --EMT.LINENBR = 0        -- numero di linea
-   --EMT.LINEINC = 1        -- incremento numerazione linee
-   --EMT.Ft = 'F'           -- token per feed
-   --EMT.St = 'S'           -- token per speed
-   EMT.FMAXPINZE = 154000 -- feed massima pinze
+   --EMT.Nt = 'N'         -- token per la numerazione di linea
+   --EMT.LINENBR = 0      -- numero di linea
+   --EMT.LINEINC = 1      -- incremento numerazione linee
+   --EMT.Ft = 'F'         -- token per feed
+   --EMT.St = 'S'         -- token per speed
+   EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 154000, 20000, 160000)  -- feed massima pinze
+   EMT.MAXACC = MaxAcc or 4000    -- accelerazione massima pinze. In realtà è il tempo in millisecondi, quindi MAXACC corrisponde al tempo massimo per raggiungere la velocità desiderata
+   EMT.MINACC = MinAcc or 300     -- accelerazione minima pinze. In realtà è il tempo in millisecondi, quindi MINACC corrisponde al tempo massimo per raggiungere la velocità desiderata
 end

 ---------------------------------------------------------------------
@@ -38,14 +44,19 @@ end

 ---------------------------------------------------------------------
 function OnProgramStart()
+
+   -- aggiungo prefisso per commentae commenti iniziali se la macchina è utilizzata per fare i test
+   local sPrefixCommentLine = '' ; if IS_TEST_MACHINE or EgtEndsWith( EgtGetCurrMachineDir(), '.TEST') then sPrefixCommentLine = '//' end
+
   -- Intestazioni
   if EMT.INFO then
-      ParkLine( '('..EMT.INFO..')')
+      ParkLine( sPrefixCommentLine..'('..EMT.INFO..')')
   else
      ParkLine( '(Program Start)')
   end
-   ParkLine( '('.. CSP_INFO..')')
-   ParkLine( '('.. MACHINE_INFO..')')
+   ParkLine( sPrefixCommentLine..'('.. CSP_INFO..')')
+   ParkLine( sPrefixCommentLine..'('.. MACHINE_INFO..')')
+   ParkLine( '(HEADER)')

   -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
   if TEST_USE then
@@ -103,6 +114,7 @@ function OnProgramEnd()
   EMT.FALL = nil
   EMT.RELOAD = nil
   EMT.RELOAD2 = nil
+   EmtOutput( '(FOOTER)')
   -- Termino il programma
   EmtOutput( 'M02')
 end
@@ -111,8 +123,8 @@ end
 function OnToolData()
   -- emissione dati utensili
   if EMT.HEAD == 'H1' then
-      local sOut = 'M992 P1=' .. EMT.TCPOS:gsub( 'T', '') .. ' P2=' .. EmtLenToString( EMT.TLEN, 3) .. ' P3=' .. EmtLenToString( EMT.TDIAM, 3) ..
-                   ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( EMT.TTOTLEN, 3)
+      local sOut = 'M992 P1=' .. EMT.TCPOS:gsub( 'T', '') .. ' P2=' .. EmtLenToString( EMT.TLEN, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( EMT.TDIAM, EMT.DECMACRO) ..
+                   ' P4=' .. EmtLenToString( EMT.SMAX, EMT.DECMACRO) .. ' P5=' .. EmtLenToString( EMT.TTOTLEN, EMT.DECMACRO)
      ParkLine( sOut)
      -- cerco posizione di attrezzaggio del primo utensile di lavorazione
      if EMT.TOOL == EMT.TOOL_1  and  EMT.TLEN_1 < LONG_TOOL_MINLEN then
@@ -120,14 +132,14 @@ function OnToolData()
      end
   -- emissione dati lama
   elseif EMT.HEAD == 'H2' then
-      local sOut = 'M992 P1=' .. EMT.TCPOS:gsub( 'T', '') .. ' P2=' .. EmtLenToString( EMT.TLEN, 3) .. ' P3=' .. EmtLenToString( EMT.TDIAM, 3) ..
-                   ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( EMT.TTOTLEN, 3)
+      local sOut = 'M992 P1=' .. EMT.TCPOS:gsub( 'T', '') .. ' P2=' .. EmtLenToString( EMT.TLEN, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( EMT.TDIAM, EMT.DECMACRO) ..
+                   ' P4=' .. EmtLenToString( EMT.SMAX, EMT.DECMACRO) .. ' P5=' .. EmtLenToString( EMT.TTOTLEN, EMT.DECMACRO)
      ParkLine( sOut)
   -- emissione dati sega a catena
   elseif EMT.HEAD == 'H3' then
      if EMT.TDIST and abs( EMT.TDIST) < 0.1 then EMT.TDIST = nil end
-      local sData = ' P2=' .. EmtLenToString( ( EMT.TDIST or ChSawLen), 3) .. ' P3=' .. EmtLenToString( EMT.TLEN, 3) ..
-                    ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( ( EMT.TDIST or ChSawLen), 3)
+      local sData = ' P2=' .. EmtLenToString( ( EMT.TDIST or ChSawLen), EMT.DECMACRO) .. ' P3=' .. EmtLenToString( EMT.TLEN, EMT.DECMACRO) ..
+                    ' P4=' .. EmtLenToString( EMT.SMAX, EMT.DECMACRO) .. ' P5=' .. EmtLenToString( ( EMT.TDIST or ChSawLen), EMT.DECMACRO)
      if EMT.TCPOS == 'T101' then
         ParkLine( 'M992 P1=101' .. sData)
         ParkLine( 'M992 P1=102' .. sData)
@@ -143,10 +155,15 @@ function OnToolData()
   elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
      local nPos = EgtIf( EMT.HEAD == 'H5', 91, 93)
      if EMT.EXIT == 2 then nPos = nPos + 1 end
-      local sOut = 'M992 P1=' .. EgtNumToString( nPos, 0) .. ' P2=' .. EmtLenToString( EMT.TLEN, 3) .. ' P3=' .. EmtLenToString( EMT.TDIAM, 3) ..
-                   ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( EMT.TTOTLEN, 3)
+      local sOut = 'M992 P1=' .. EgtNumToString( nPos, 0) .. ' P2=' .. EmtLenToString( EMT.TLEN, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( EMT.TDIAM, EMT.DECMACRO) ..
+                   ' P4=' .. EmtLenToString( EMT.SMAX, EMT.DECMACRO) .. ' P5=' .. EmtLenToString( EMT.TTOTLEN, EMT.DECMACRO)
      ParkLine( sOut)
-   -- altro non previsto
+   -- emissione dati sega a catena
+   elseif EMT.HEAD == 'H7' then
+      local sOut = 'M992 P1=' .. EMT.TCPOS:gsub( 'T', '') .. ' P2=' .. EmtLenToString( EMT.TLEN, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( EMT.TDIAM, EMT.DECMACRO) ..
+                   ' P4=' .. EmtLenToString( EMT.SMAX, EMT.DECMACRO) .. ' P5=' .. EmtLenToString( EMT.TTOTLEN, EMT.DECMACRO)
+      ParkLine( sOut)
+-- altro non previsto
   else
      EmtSetLastError( 1211, 'Head not allowed ' .. EMT.HEAD)
   end
@@ -208,14 +225,14 @@ function OnDispositionEnd()
      local HOverM = EMT.HOVM

      -- calcolo dati pinze
-      local TempAccPinze, TempMinAccPinze, RidFeed = CalcDinamicaPinze( HTrave, STrave, LBarra)
-      local TempAccPinz1, TempMinAccPinz1, RidFeed1 = CalcDinamicaPinze( HTrave, STrave, LBarra - LTrave)
-      local TempAccPinz2, TempMinAccPinz2, RidFeed2 = CalcDinamicaPinze( HTrave, STrave, LTrave)
+      local TempAccPinze, TempMinAccPinze, RidFeed = CalcDinamicaPinze_TPA( HTrave, STrave, LBarra)
+      local TempAccPinz1, TempMinAccPinz1, RidFeed1 = CalcDinamicaPinze_TPA( HTrave, STrave, LBarra - LTrave)
+      local TempAccPinz2, TempMinAccPinz2, RidFeed2 = CalcDinamicaPinze_TPA( HTrave, STrave, LTrave)

      if IdTrave >= 0 then
         local sPrt = '( *** Part '.. EgtNumToString( IdTrave, 0) ..' ***)'
-         local sOut = '( SN=' .. IdTrave .. ' LBarra=' .. EmtLenToString( LBarra, 3) .. ' L='..EmtLenToString( LTrave, 3) ..
-                      ' H=' .. EmtLenToString( HTrave, 3) .. ' S=' .. EmtLenToString( STrave, 3) .. ' )'
+         local sOut = '( SN=' .. IdTrave .. ' LBarra=' .. EmtLenToString( LBarra, EMT.DECMACRO) .. ' L='..EmtLenToString( LTrave, EMT.DECMACRO) ..
+                      ' H=' .. EmtLenToString( HTrave, EMT.DECMACRO) .. ' S=' .. EmtLenToString( STrave, EMT.DECMACRO) .. ' )'
         EMT.PRODID = EgtGetInfo( BtlInfoId, 'PRODID', 'i') or 0
         EMT.PATTID = EgtGetInfo( BtlInfoId, 'PATTID', 'i') or 0
         EMT.CUTID = EgtGetInfo( EMT.IDT, 'CUTID', 'i') or 0
@@ -258,9 +275,9 @@ function OnDispositionEnd()
                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( EgtIf( IdTrave >= 0, LTrave, LBarra), 2) ..
                ' P7=' .. EgtNumToString( TempAccPinze, 2) .. ' P8=' .. EgtNumToString( TempAccPinz2, 2) .. ' P9=' .. EgtNumToString( TempAccPinz1, 2)
         EmtOutput( sOut)
-         EmtOutput( 'M112'..' P1='..EmtLenToString( LoadT, 3).. ' P5=1 P6='..EmtLenToString( EMT.YPOS, 3)..' P7='..EmtLenToString( ParkV, 3) ..' P9='..GetFmaxClamp())
+         EmtOutput( 'M112'..' P1='..EmtLenToString( EMT.TPOS, 3).. ' P5=1 P6='..EmtLenToString( EMT.YPOS, 3)..' P7='..EmtLenToString( ParkV, 3) ..' P9='..GetFmaxClamp())
         -- aggiorno dati aggancio carrelli alla trave
-         EMT.YDELTA = EMT.YPOS - LoadT
+         EMT.YDELTA = EMT.YPOS - EMT.TPOS
         EMT.VDELTA = nil
      end
      -- eventuale preparazione per rotazione immediata
@@ -621,6 +638,8 @@ end

 ---------------------------------------------------------------------
 function OnRapid()
+   -- recupero prossimo utensile
+   EMT.NEXTTOOL, EMT.NEXTHEAD, EMT.NEXTTCPOS = FindNextTool()
   MyBackupAxes()
   -- se primo movimento della lavorazione, gestione speciale
   if EMT.MCHFIRST and not EMT.OPEISDISP then
@@ -636,16 +655,29 @@ function OnRapid()
      if not ( EMT.LOAD or EMT.RELOAD) then
         if not EMT.ZMAX and #EMT.AUXSTR > 0 then
            EmitZmax()
+            bHeadFirst = false
         end
      end
+
+      local bGoToHome = false
+      -- se gli assi rotanti cambiano parecchio, con motosega si va in parcheggio 
+      if EMT.PREVHEAD == 'H3' and EMT.HEAD == 'H3' and EMT.TCPOS == EMT.PREVTCPOS and ( abs( EMT.R2pp - EMT.R2) > 25 or abs( EMT.R1pp - EMT.R1) > 25)  then
+         bGoToHome = true
+      end
+   
      -- primo posizionamento
      local MyZHome = EgtGetAxisHomePos( 'Z')
      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or EMT.L3 > -1)
      -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
-         local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, 3) .. ' P3=' .. EmtLenToString( MyZHome, 3) ..
-                                 ' P4=' .. EgtNumToString( EMT.R2pp, 3) .. ' P5=' .. EgtNumToString( EMT.R1pp, 3) .. 
-                                 ' P6=' .. EgtNumToString( EMT.PREVTCPOS, 3) .. ' P7=' .. EgtNumToString( EMT.PREVS, 0) ..
+      if not EMT.LOAD and EMT.PREVHEAD == 'H3' and EMT.FLAG2 == 1 then
+         local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( EMT.R2pp, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1pp, EMT.DECMACRO) .. 
+                                 ' P6=' .. EgtNumToString( EMT.PREVTCPOS, EMT.DECMACRO) .. ' P7=' .. EgtNumToString( EMT.PREVS, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+         EmtOutput( sOutPreMove)
+         sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( 0, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1pp, EMT.DECMACRO) .. 
+                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
         EmtOutput( sOutPreMove)
         EmtOutput( 'M101 P1=2')
@@ -658,9 +690,29 @@ function OnRapid()
      end

      -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
-      if EMT.HEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
-         local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, 3) .. ' P3=' .. EmtLenToString( MyZHome, 3) ..
-                                 ' P4=' .. EgtNumToString( EMT.R2, 3) .. ' P5=' .. EgtNumToString( EMT.R1, 3) .. 
+      if not EMT.LOAD and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TTOTLEN > 200)) and 
+         ( EMT.ST > BeamHeightForFixRot or ( EMT.HEAD == 'H1' and EMT.TTOTLEN > 350) or bGoToHome) and EMT.FLAG2 == 1 then
+         local sOutPreMove
+         if EMT.HEAD == 'H3' and bGoToHome then
+            sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( 0, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1pp, EMT.DECMACRO) .. 
+                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+            EmtOutput( sOutPreMove)
+            sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( 0, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1, EMT.DECMACRO) .. 
+                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+            EmtOutput( sOutPreMove)
+         elseif EMT.HEAD == 'H3' and  EMT.PREVHEAD ~= 'H3' then
+            sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( 0, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1, EMT.DECMACRO) .. 
+                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+            EmtOutput( sOutPreMove)
+         end
+         sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZHome, EMT.DECMACRO) ..
+                                 ' P4=' .. EgtNumToString( EMT.R2, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1, EMT.DECMACRO) .. 
                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
         EmtOutput( sOutPreMove)
@@ -674,8 +726,8 @@ function OnRapid()
      if EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
         MyZPos = MyZHome
      end
-      local sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( EMT.L2, 3) .. ' P3=' .. EmtLenToString( MyZPos, 3) ..
-                       ' P4=' .. EgtNumToString( EMT.R2, 3) .. ' P5=' .. EgtNumToString( EMT.R1, 3) .. 
+      local sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( EMT.L2, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( MyZPos, EMT.DECMACRO) ..
+                       ' P4=' .. EgtNumToString( EMT.R2, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1, EMT.DECMACRO) .. 
                       ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
                       ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
      if EMT.LOAD then
@@ -725,7 +777,7 @@ function OnRapid()
            sV = EmtLenToString( ParkV)
            sB = '2'
         end
-         sOut = 'M112 P1='..EmtLenToString( EMT.L1, 3)..' P3='..sA..' P4='..sB..' P5=0 P6='..sY..' P7='..sV..' P9='..GetFmaxClamp()
+         sOut = 'M112 P1='..EmtLenToString( EMT.L1, EMT.DECMACRO)..' P3='..sA..' P4='..sB..' P5=0 P6='..sY..' P7='..sV..' P9='..GetFmaxClamp()
         ParkLine( sOut)
         EMT.LOAD = false
         -- emissione prime linee speciali e linee parcheggiate
@@ -769,14 +821,14 @@ function OnRapid()
            sB = '2'
         end
         -- se taglio di coda senza residuo da scaricare, emetto M175 per accelerare il carico della barra successiva
-         if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') then
+         if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') and ( IsEndPhase( EMT.PHASE+1) or IsEnd2Phase( EMT.PHASE+1)) then
            EmtOutput( 'M175')
         end
         if bHeadFirst then
            sOut = 'M101 P1=3'
            EmtOutput( sOut)
         end
-         sOut = 'M112 P1=' .. EmtLenToString( EMT.L1, 3) ..' P3='..sA..' P4='..sB..' P6='..sY..' P7='..sV..' P9=' .. GetFmaxClamp()
+         sOut = 'M112 P1=' .. EmtLenToString( EMT.L1, EMT.DECMACRO) ..' P3='..sA..' P4='..sB..' P6='..sY..' P7='..sV..' P9=' .. GetFmaxClamp()
         EmtOutput( sOut)
         if not bHeadFirst then
            sOut = 'M101 P1=2'
@@ -844,12 +896,42 @@ function OnRapid()
      EmtAdjustRotaryAxes()
      EmitZmax( true)
      EMT.ZMAX = true
+      -- se pezzi alti e devo cambiare utensile su testa con CU, porto la testa vicino al cambio utensile
+      if EMT.ST > BeamHeightForFixRot  and  EMT.HEAD == 'H1' and  EMT.TOOL ~= EMT.NEXTTOOL  and  EMT.NEXTHEAD ~= 'H2' then
+         local dBAxis = 90
+         local dCAxis = EgtIf( BD.RIGHT_LOAD, 90, -90)
+         local sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( EMT.L2, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( EMT.L3, EMT.DECMACRO) ..
+                      ' P4=' .. EgtNumToString( dBAxis, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( dCAxis, EMT.DECMACRO) .. 
+                      ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                      ' P8=0' .. ' P9=0' .. ' P10=3'
+         EmtOutput( sOut)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+         sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( EMT.L3, EMT.DECMACRO) ..
+                      ' P4=' .. EgtNumToString( dBAxis, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( dCAxis, EMT.DECMACRO) .. 
+                      ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                      ' P8=0' .. ' P9=0' .. ' P10=3'
+         EmtOutput( sOut)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+      end
   -- se altrimenti movimento in Home
   elseif EMT.FLAG == 4 then
      -- non previsto
-   -- se altrimenti rotazione a Z max
+   -- se altrimenti rotazione a Z max per lavorazione successiva
   elseif EMT.FLAG == 5 then
-      -- viene gestito all'inizio della lavorazione successiva
+      EMT.REFLOC = nil
+      EMT.IPLGL = false
+      MyAdjustLinearAxes()
+      EmtAdjustRotaryAxes()
+      EmtResetPrev()
+      local sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( EMT.L2, EMT.DECMACRO) .. ' P3=' .. EmtLenToString( EMT.L3, EMT.DECMACRO) ..
+                   ' P4=' .. EgtNumToString( EMT.R2, EMT.DECMACRO) .. ' P5=' .. EgtNumToString( EMT.R1, EMT.DECMACRO) .. 
+                   ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                   ' P8=0' .. ' P9=0' .. ' P10=3'
+      EmtOutput( sOut)
+      EmtOutput( 'M101 P1=2')
+      EmtOutput( 'M101 P1=3')
   -- altrimenti errore
   else
      error( "Unknown Rapid flag")
@@ -964,7 +1046,7 @@ function OnArc()
   --local sCen = ' ' .. EMT.C1t .. EmtLenToString(EMT.C1,3) ..
   --             ' ' .. EMT.C2t .. EmtLenToString(EMT.C2,3)
   -- raggio
-   local sRad = ' ' .. EMT.RRt .. EmtLenToString( EMT.RR, EMT.DECNUM)
+   local sRad = ' ' .. EMT.RRt .. EmtLenToString( EMT.RR, EMT.DECRAD)
   -- aggiungo feed
   local sFeed = EmtGetFeed()
   -- tipo arco
@@ -977,25 +1059,32 @@ function OnArc()
 end

 ---------------------------------------------------------------------
-function CalcDinamicaPinze( dH, dS, dL)
-   local MinTempoAcc = 0.3                         -- [s]
-   local MaxTempoAcc = 4.0                         -- [s]
-   local KgMtCubo= 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
+function FindNextTool()
+   -- salvo stato iniziale
+   local CurrMachId = EgtGetCurrMachining()
+   local CurrTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
+   -- cerco lavorazione con utensile su gruppo testa indicato
+   local sTool, sHead, sTcPos
+   local OpId = EgtGetNextActiveOperation( CurrMachId or EMT.MCHID)
+   while OpId do
+      local nType = EgtGetOperationType( OpId)
+      if nType ~= MCH_OY.NONE  and  nType ~= MCH_OY.DISP then
+         if EgtSetCurrMachining( OpId) then
+            sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+            if EgtTdbSetCurrTool( sTool) then
+               sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+               sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+               break
+            end
+         end
+      end
+      OpId = EgtGetNextActiveOperation( OpId)
   end
-   return TempoAcc * 1000, MinTempoAcc * 1000, RidFeed
+   -- ripristino stato iniziale
+   EgtSetCurrMachining( CurrMachId or GDB_ID.NULL)
+   EgtTdbSetCurrTool( CurrTool or '')
+   -- restituisco risultato
+   return sTool, sHead, sTcPos
 end

 ---------------------------------------------------------------------
@@ -1567,18 +1656,24 @@ function MyAdjustLinearAxes()
      if EMT.HEAD == 'H1' or EMT.HEAD == 'H2' then
         local Len = EMT.TLEN + EgtIf( EMT.HEAD == 'H1', MillOffs, abs( SawOffs))
         local LenRef = MillOffs
-         vtE = Vector3d( EMT.EXTR) * Len - Z_AX() * LenRef
+         vtE = Vector3d( EMT.TDIR) * Len - Z_AX() * LenRef
      elseif EMT.HEAD == 'H3' then
         local LenAux = ( EMT.TDIST or ChSawLen) + MillOffs
         local LenRef = MillOffs
         local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
         vtE = vtAux * LenAux - Z_AX() * LenRef
-      elseif  EMT.HEAD == 'H5' then
+      elseif  EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
         local Len = EMT.TLEN + AngTr1Len
         local LenAux = MillOffs + AngTr1Offs
         local LenRef = MillOffs
         local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2)
-         vtE = Vector3d( EMT.EXTR) * Len + vtAux * LenAux - Z_AX() * LenRef
+         vtE = Vector3d( EMT.TDIR) * Len + vtAux * LenAux - Z_AX() * LenRef
+      elseif  EMT.HEAD == 'H7' then
+         local Len = EMT.TLEN + AngTrBHLen
+         local LenAux = MillOffs + AngTrBHOffs
+         local LenRef = MillOffs
+         local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2)
+         vtE = Vector3d( EMT.TDIR) * Len + vtAux * LenAux - Z_AX() * LenRef
      else
         EmtSetLastError( 1211, 'Head not allowed ' .. EMT.HEAD)
      end
@@ -1615,6 +1710,8 @@ function AdjustToolKinematic()
      return EgtIf( EMT.EXIT == 1, '11', '12')
   elseif EMT.HEAD == 'H6' then
      return EgtIf( EMT.EXIT == 1, '21', '22')
+   elseif EMT.HEAD == 'H7' then
+      return '31'
   else
      EmtSetLastError( 1211, 'Head not allowed ' .. EMT.HEAD)
   end
@@ -1687,9 +1784,9 @@ function CalcInterpPlane()
   local vtY = EMT.IPLGLFR:getVersY()
   local vtZ = EMT.IPLGLFR:getVersZ()
   EMT.IPLGLSTR = ' X0 Y' .. EmtLenToString( xS, EMT.DECNUM) .. ' Z0' ..
-                  ' A' .. EgtNumToString( - vtX:getY(), 6) .. ' B' .. EgtNumToString( vtX:getX(), 6) .. ' C' .. EgtNumToString( vtX:getZ(), 6) ..
-                  ' I' .. EgtNumToString( - vtY:getY(), 6) .. ' J' .. EgtNumToString( vtY:getX(), 6) .. ' K' .. EgtNumToString( vtY:getZ(), 6) ..
-                  ' P' .. EgtNumToString( - vtZ:getY(), 6) .. ' Q' .. EgtNumToString( vtZ:getX(), 6) .. ' R' .. EgtNumToString( vtZ:getZ(), 6)
+                  ' A' .. EgtNumToString( - vtX:getY(), EMT.DECVERS) .. ' B' .. EgtNumToString( vtX:getX(), EMT.DECVERS) .. ' C' .. EgtNumToString( vtX:getZ(), EMT.DECVERS) ..
+                  ' I' .. EgtNumToString( - vtY:getY(), EMT.DECVERS) .. ' J' .. EgtNumToString( vtY:getX(), EMT.DECVERS) .. ' K' .. EgtNumToString( vtY:getZ(), EMT.DECVERS) ..
+                  ' P' .. EgtNumToString( - vtZ:getY(), EMT.DECVERS) .. ' Q' .. EgtNumToString( vtZ:getX(), EMT.DECVERS) .. ' R' .. EgtNumToString( vtZ:getZ(), EMT.DECVERS)
   EMT.IPLGL = true
 end

@@ -1,4 +1,4 @@
-- Processore macchina Essetre-FAST by EgalWare s.r.l.   2024/02/23
+-- Processore macchina Essetre-FAST by EgalWare s.r.l.   2024/03/09

 -- Intestazioni
 require( 'EmtGenerator')
@@ -7,19 +7,16 @@ EgtEnableDebug( false)
 -- carico librerie
 local BD = require( 'BeamData')

-LONG_TOOL_MINLEN = 221
-BIG_TOOL_DIAM = 300
-
 ---------------------------------------------------------------------
 -- *** GENERATION ***
 ---------------------------------------------------------------------
 local sBaseDir = EgtGetCurrMachineDir()
 if NumericalControl == 'NUM' then
-   dofile( sBaseDir .. '\\Common-FAST.NUM.mlpe')
+   dofile( sBaseDir .. '\\Common_FAST.NUM.mlpe')
 elseif NumericalControl == 'TPA' then
-   dofile( sBaseDir .. '\\Common-FAST.TPA.mlpe')
+   dofile( sBaseDir .. '\\Common_FAST.TPA.mlpe')
 elseif NumericalControl == 'NUM_PLUS' then
-   dofile( sBaseDir .. '\\Common-FAST.NUM_PLUS.mlpe')
+   dofile( sBaseDir .. '\\Common_FAST.NUM_PLUS.mlpe')
 else
   EmtSetLastError( 1201, 'Numerical Control error : unkwnown type')
 end
@@ -82,6 +79,14 @@ function OnSimulStart()
         for j = 1, #( vTools or {}) do
            if vTools[j] ~= '' then
               EgtLoadTool( vTcPos[i], j, vTools[j])
+               -- Aggiunto controllo lunghezza lama minima * 0.9 per ricavare la tolleranza del VMILL
+               if EgtTdbSetCurrTool(vTools[j]) then -- set utensile corrente
+                  if EgtTdbGetCurrToolParam( MCH_TP.TYPE) == MCH_TY.SAW_STD or EgtTdbGetCurrToolParam( MCH_TP.TYPE) == MCH_TY.SAW_FLAT then -- controllo tipo utensile sega
+                     local dCurrSawLen = EgtTdbGetCurrToolParam( MCH_TP.LEN) * 0.9
+                     -- se non definito o minore del valore precedente aggiorna la tolleranza
+                     EMT.VMILLTOL = EgtIf( not EMT.VMILLTOL or dCurrSawLen < EMT.VMILLTOL, dCurrSawLen, EMT.VMILLTOL) 
+                  end
+               end
            end
         end
         ShowToolInTcPos( vTcPos[i], true)
@@ -105,6 +110,7 @@ function OnSimulStart()
   AddToCollisionCheck( 'B', 'COLLISION', EMT.COLLOBJ)
   AddToCollisionCheck( 'C', 'COLLISION', EMT.COLLOBJ)
   AddToCollisionCheck( 'H5', 'COLLISION', EMT.COLLOBJ)
+   AddToCollisionCheck( 'H6', 'COLLISION', EMT.COLLOBJ)
   AddToolToCollisionCheck( 'H2', 1, EMT.COLLOBJ)
   AddToolHolderToCollisionCheck( 'H2', 1, EMT.COLLOBJ)
   DumpCollisionCheck( EMT.COLLOBJ, 'Collision Objects :', 4)
@@ -117,7 +123,8 @@ function OnSimulStart()
                     { Grp = 'V', Sub = 'COLLISION', Name = 'VOL2'},
                     { Grp = 'PV', Sub = 'COLLISION', Name = 'VOL'},
                     { Grp = 'Base', Sub = 'COLLISION', Name = 'SIDE1'},
-                     { Grp = 'Base', Sub = 'COLLISION', Name = 'SIDE2'}}
+                     { Grp = 'Base', Sub = 'COLLISION', Name = 'SIDE2'},
+                     { Grp = 'C', Sub = 'COLLISION2', Name = 'C_TOP'}}
   EgtOutLog( 'MCODET Objects :', 4)
   local nMcdNullCnt = 0
   for i = 1, #McdData do
@@ -130,7 +137,7 @@ function OnSimulStart()
      local nId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( nGrpId or GDB_ID.NULL, McdData[i].Sub) or GDB_ID.NULL, McdData[i].Name)
      if nId then
         table.insert( EMT.MCODET, nId)
-         EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' is ok', 4)
+         EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' (' .. tostring( nId) .. ') is ok', 4)
      else
         nMcdNullCnt = nMcdNullCnt + 1
         EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' is null', 4)
@@ -141,6 +148,30 @@ function OnSimulStart()
   end
   -- Preparo lista collisioni vuota
   EMT.COLLIDE = {}
+
+      -- si crea gruppo temporaneo appoggio controllo clamping
+   CLAMP_CHECK_GROUP = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'CLAMP_CHECK')
+   CLAMP_CHECK_INTERS = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'CLAMP_INTERS')
+
+   if CLAMP_CHECK_GROUP then
+      EgtEmptyGroup( CLAMP_CHECK_GROUP)
+   else
+      local frClampCheckGroup = Frame3d( ORIG(), GDB_FR.FRONT)
+      CLAMP_CHECK_GROUP = EgtGroup( GDB_ID.ROOT, frClampCheckGroup)
+      EgtSetName( CLAMP_CHECK_GROUP, 'CLAMP_CHECK')
+      EgtSetLevel( CLAMP_CHECK_GROUP, GDB_LV.TEMP)
+      EgtSetStatus( CLAMP_CHECK_GROUP, GDB_ST.OFF)
+   end
+   
+   if CLAMP_CHECK_INTERS then
+      EgtEmptyGroup( CLAMP_CHECK_INTERS)
+   else
+      CLAMP_CHECK_INTERS = EgtGroup( GDB_ID.ROOT)
+      EgtSetName( CLAMP_CHECK_INTERS, 'CLAMP_INTERS')
+      EgtSetLevel( CLAMP_CHECK_INTERS, GDB_LV.TEMP)
+      EgtSetStatus( CLAMP_CHECK_INTERS, GDB_ST.OFF)
+   end
+
 end

 ---------------------------------------------------------------------
@@ -152,7 +183,8 @@ function OnSimulDispositionStarting()
   EmtUnlinkAllRawPartsFromGroups()
   if EMT.PHASE > 1 then
      if IsStartOrRestPhase( EMT.PHASE) then
-         EgtSetAxisPos( 'T', LoadT)
+         local ParkT = GetParkT()
+         EgtSetAxisPos( 'T', ParkT)
      end
   end
 end
@@ -166,20 +198,20 @@ function OnSimulDispositionStart()
      -- Determino dimensioni del grezzo
      local nSolId = EgtGetFirstNameInGroup( EgtGetFirstRawPart() or GDB_ID.NULL, 'RawSolid') or GDB_ID.NULL
      local b3Sol = EgtGetBBoxGlob( nSolId, GDB_BB.STANDARD)
-      EMT.LB = 0
-      EMT.SB = 0
-      EMT.HB = 0
+      EMT.LT = 0
+      EMT.ST = 0
+      EMT.HT = 0
      if b3Sol then
-         EMT.LB = b3Sol:getDimX()
-         EMT.SB = b3Sol:getDimY()
-         EMT.HB = b3Sol:getDimZ()
+         EMT.LT = b3Sol:getDimX()
+         EMT.ST = b3Sol:getDimY()
+         EMT.HT = b3Sol:getDimZ()
      end
      -- Carico primo utensile sulla testa 1
      local sTool, nTlen = FindFirstToolOnHead( 'H1')
      if sTool  and  nTlen < LONG_TOOL_MINLEN then
         EMT.TOOL_1 = sTool
      else
-         EMT.TOOL_1 = GetDefaultToolName() 
+         EMT.TOOL_1 = GetDefaultToolName()
      end
      EgtLoadTool( 'H1', 1, EMT.TOOL_1)
      EMT.TCPOS_1 = GetToolTcPos( EMT.TOOL_1)
@@ -189,7 +221,7 @@ function OnSimulDispositionStart()
      EMT.VMILL = {}
      if not EMT.SIM1ST and EgtGetInfo( EgtGetCurrMachGroup(), 'Vm', 'b') then
         local nLastOrd = GetPhaseOrd( EgtGetPhaseCount())
-         local nPartRawId = EgtGetFirstRawPart() 
+         local nPartRawId = EgtGetFirstRawPart()
         while nPartRawId do
            -- se è lo scarto finale tagliato a pezzi, esco
            local nRawOrd = EgtGetInfo( nPartRawId, 'ORD', 'i')
@@ -211,21 +243,26 @@ function OnSimulDispositionStart()
               end
            end
            -- determino la risoluzione dello Zmap
-            local dArea = b3Raw:getDimX() * b3Raw:getDimY() + b3Raw:getDimX() * b3Raw:getDimZ() + b3Raw:getDimY() * b3Raw:getDimZ()
            local dTol = 4.71
-            if dArea < CoeffVM * 0.15e6 then
-               dTol = 0.71
-            elseif dArea < CoeffVM * 0.3e6 then
-               dTol = 1.01
-            elseif dArea < CoeffVM * 0.6e6 then
-               dTol = 1.51
-            elseif dArea < CoeffVM * 1.2e6 then
-               dTol = 1.97
-            elseif dArea < CoeffVM * 2.4e6 then
-               dTol = 2.81
-            elseif dArea < CoeffVM * 4.8e6 then
-               dTol = 3.77
+            if EmtGetVMillStep then
+               dTol = EmtGetVMillStep( b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), dTol)
+            else
+               local dArea = b3Raw:getDimX() * b3Raw:getDimY() + b3Raw:getDimX() * b3Raw:getDimZ() + b3Raw:getDimY() * b3Raw:getDimZ()
+               if dArea < 0.075e6 then
+                  dTol = 0.71
+               elseif dArea < 0.15e6 then
+                  dTol = 1.01
+               elseif dArea < 0.3e6 then
+                  dTol = 1.51
+               elseif dArea < 0.6e6 then
+                  dTol = 1.97
+               elseif dArea < 1.2e6 then
+                  dTol = 2.81
+               elseif dArea < 2.4e6 then
+                  dTol = 3.77
+               end
            end
+            dTol = min( dTol, EMT.VMILLTOL or dTol) -- imposto dTol al valore minore tra quello per volume e quello per spessore lama
            -- creo lo Zmap
            local VMillId = EgtVolZmapBox( nPartRawId, b3Raw:getMin(), b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), dTol, true, GDB_RT.GLOB)
            if VMillId then
@@ -283,18 +320,24 @@ function OnSimulDispositionStart()
      local nOrd = GetPhaseOrd( EMT.PHASE)
      local nScrapOrd = GetPhaseOrd( EgtGetPhaseCount()) + 1
      local b3Raw = BBox3d()
+      local b3Bar = BBox3d()
+      local b3Part = BBox3d()
      local nPartRawId, nScrapRawId
      local nRawId = EgtGetFirstRawPart()
      while nRawId do
         local nNextRawId = EgtGetNextRawPart( nRawId)
         if EgtVerifyRawPartPhase( nRawId, EMT.PHASE) then
            EmtLinkRawPartToGroup( nRawId, 'Tab')
+            local b3Tmp = EgtGetRawPartBBox( nRawId)
+            b3Bar:Add( b3Tmp)
            local nRawOrd = EgtGetInfo( nRawId, 'ORD', 'i')
            if nRawOrd == nOrd then
-               b3Raw = EgtGetRawPartBBox( nRawId)
+               --b3Raw = EgtGetRawPartBBox( nRawId)
+               b3Raw:Add( b3Tmp)
+               b3Part:Add( b3Tmp)
               nPartRawId = nRawId
            elseif nRawOrd == nOrd + 1 and nRawOrd == nScrapOrd then
-               local b3Tmp = EgtGetRawPartBBox( nRawId) or BBox3d()
+               --local b3Tmp = EgtGetRawPartBBox( nRawId) or BBox3d()
               b3Raw:Add( b3Tmp)
               nScrapRawId = nRawId
            end
@@ -308,6 +351,9 @@ function OnSimulDispositionStart()
      else
         EMT.SCRAP = nil
      end
+      EMT.LB = b3Bar:getDimX()
+      EMT.LR = b3Raw:getDimX()
+      EMT.LT = b3Part:getDimX()
      -- recupero CutId del pezzo in lavorazione
      EMT.CUTID = EgtGetInfo( EgtGetFirstPartInRawPart( nPartRawId or GDB_ID.NULL) or GDB_ID.NULL, 'CUTID', 'i') or 0
      EMT.YSPEC = nil
@@ -358,6 +404,8 @@ function OnSimulDispositionStart()
            EgtOutText( 'Barra non ruotata')
         end
      end
+      -- verifico posizione di carico
+      local ParkT = GetParkT()
      -- indice primo grezzo della fase
      local nOrd = GetPhaseOrd( EMT.PHASE)
      -- ricerco vettore movimento per i successivi
@@ -365,7 +413,7 @@ function OnSimulDispositionStart()
      local nRawId = EgtGetFirstRawPart()
      while nRawId do
         if EgtGetInfo( nRawId, 'ORD', 'i') == nOrd + 1 then
-            vtMove = Vector3d( - LoadT - EgtGetRawPartBBox( nRawId):getMax():getX(), 0, 0)
+            vtMove = Vector3d( - ParkT - EgtGetRawPartBBox( nRawId):getMax():getX(), 0, 0)
            break
         end   
         nRawId = EgtGetNextRawPart( nRawId)
@@ -377,6 +425,7 @@ function OnSimulDispositionStart()
         if EgtVerifyRawPartPhase( nRawId, EMT.PHASE) then
            if EgtGetInfo( nRawId, 'ORD', 'i') == nOrd then
               EmtLinkRawPartToGroup( nRawId, 'Tab')
+               b3Bar = EgtGetRawPartBBox( nRawId)
            else
               EgtMove( nRawId, vtMove, GDB_RT.GLOB)
               EgtSetStatus( nRawId, GDB_ST.OFF)
@@ -384,8 +433,12 @@ function OnSimulDispositionStart()
         end
         nRawId = nNextRawId
      end
+      EMT.LB = b3Bar:getDimX()
+
   -- altrimenti fase finale, aggancio primo grezzo alla tavola e gli altri in posizione carico al carro Y
   else
+      -- verifico posizione di carico
+      local ParkT = GetParkT()
      -- indice primo grezzo della fase
      local nOrd = GetPhaseOrd( EMT.PHASE)
      -- ricerco vettore movimento per i successivi
@@ -393,18 +446,20 @@ function OnSimulDispositionStart()
      local nRawId = EgtGetFirstRawPart()
      while nRawId do
         if EgtGetInfo( nRawId, 'ORD', 'i') == nOrd + 1 then
-            vtMove = Vector3d( - LoadT - EgtGetRawPartBBox( nRawId):getMax():getX(), 0, 0)
+            vtMove = Vector3d( - ParkT - EgtGetRawPartBBox( nRawId):getMax():getX(), 0, 0)
            break
         end   
         nRawId = EgtGetNextRawPart( nRawId)
      end
      -- eseguo
+      local b3Bar = BBox3d()
      nRawId = EgtGetFirstRawPart()
      while nRawId do
         local nNextRawId = EgtGetNextRawPart( nRawId)
         if EgtVerifyRawPartPhase( nRawId, EMT.PHASE) then
            if EgtGetInfo( nRawId, 'ORD', 'i') == nOrd then
               EmtLinkRawPartToGroup( nRawId, 'Tab')
+               b3Bar = EgtGetRawPartBBox( nRawId)
            else
               EgtMove( nRawId, vtMove, GDB_RT.GLOB)
               EmtLinkRawPartToGroup( nRawId, 'Y')
@@ -412,6 +467,7 @@ function OnSimulDispositionStart()
         end
         nRawId = nNextRawId
      end
+	  EMT.LB = b3Bar:getDimX()
   end
   -- Indicazione angolo rotazione pezzo
   EMT.ROT = EgtGetInfo( EMT.DISPID, 'ROT', 'i') or 0
@@ -443,6 +499,7 @@ function OnSimulDispositionEnd()
         EMT.POSTROT = true
      end
   end
+   EMT.SPLIT = false
   EMT.OPEISDISP = false
 end

@@ -456,8 +513,10 @@ function OnSimulToolSelect( dPosA)
   EMT.TOTDIAM = EgtTdbGetCurrToolParam( MCH_TP.TOTDIAM)
   -- se non è chiamato da altro script (non c'è parametro)
   if not dPosA then
-      -- se attivo Vmill
-      SetToolForVmill( EMT.TOOL, EMT.HEAD, EMT.EXIT, EMT.VMILL)
+      -- se utensile non flottante, abilito per Vmill
+      if not EMT.TFLOAT then
+         EmtSetToolForVmill( EMT.TOOL, EMT.HEAD, EMT.EXIT, EMT.VMILL)
+      end
      -- se attivo Collision Check
      EMT.SAFEDIST = COLL_SAFE_DIST
      if EMT.COLLOBJ then
@@ -477,8 +536,8 @@ function OnSimulToolSelect( dPosA)
      EMT.A1n = 'Y'
      EMT.A2n = 'V'
   end
-   -- carico utensile se non lama su sua testa o dummy
-   if EMT.HEAD ~= 'H2'  and  EMT.HEAD ~= 'H4' then
+   -- carico utensile se non lama
+   if EMT.HEAD ~= 'H2' then
      -- se sega a catena, imposto subito angolo scelto per asse virtuale A
      if EMT.HEAD == 'H3' then
         if not dPosA then
@@ -494,8 +553,7 @@ function OnSimulToolSelect( dPosA)
            end
            EgtSetCurrMachining( NextMchId)
            -- recupero il valore dell'asse virtuale bloccato A
-            local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
-            dPosA = tonumber( sVal:sub( 3))
+            dPosA = GetCurrChainSawingVirtualAxis()
         else
            -- imposto visualizzazione
            EgtSetMode( EgtGetHeadId( EMT.HEAD) or GDB_ID.NULL, GDB_MD.STD)
@@ -506,6 +564,17 @@ function OnSimulToolSelect( dPosA)
            EgtSetAxisPos( 'C', EgtIf( BD.RIGHT_LOAD, 180, 0))
         end
         EgtSetAxisPos( 'B', 0)
+      -- se aggregato per fresa tipo blockhaus
+      elseif EMT.HEAD == 'H7' then
+         EgtSetAxisPos( 'C', EgtIf( BD.RIGHT_LOAD, 180, 0))
+      end
+      -- se TC 1
+      if GetTCSet( EMT.TCPOS) == 1 then
+         EgtSetAxisPos( 'B', 90)
+      else
+         if EMT.HEAD ~= 'H3' then
+            EgtSetAxisPos( 'B', -90)
+         end
      end
      -- se punta lunga
      if EMT.TOTLEN > LONG_TOOL_MINLEN then
@@ -513,8 +582,7 @@ function OnSimulToolSelect( dPosA)
         if EMT.TCPOS == 'T111' then
            EgtSetAxisPos( 'B', 0)
         end
-      end
-      -- breve pausa
+      end      -- breve pausa
      EgtPause( 100)
      EgtOutText( '')
      EMT.TOOL_1 = EMT.TOOL
@@ -529,27 +597,31 @@ function OnSimulToolDeselect()
   -- se prossimo utensile non definito, è disposizione ed esco
   if EMT.NEXTTOOL == '' then return end
   -- se cambia uscita su rinvio non devo fare alcunché
-   if EMT.HEAD == 'H5' and EMT.NEXTHEAD == 'H5' then return end
+   if ( EMT.HEAD == 'H5' and EMT.NEXTHEAD == 'H5') or ( EMT.HEAD == 'H6' and EMT.NEXTHEAD == 'H6') then return end
   -- se sega a catena o rinvio o punta lunga o utensile di grosso diametro, devo cambiare
-   if EMT.HEAD == 'H3' or EMT.HEAD == 'H5' or ( EMT.HEAD == 'H1' and ( EMT.TOTLEN > LONG_TOOL_MINLEN or EMT.TOTDIAM > BIG_TOOL_DIAM)) then
+   if EMT.HEAD == 'H3' or EMT.HEAD == 'H5' or EMT.HEAD == 'H6' or EMT.HEAD == 'H7' or ( EMT.HEAD == 'H1' and ( EMT.TOTLEN > LONG_TOOL_MINLEN or EMT.TOTDIAM > BIG_TOOL_DIAM)) then
      EgtOutText( 'Tool change in progress...')
      -- movimento scarico sega a catena
      if EMT.HEAD == 'H3' then
         -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-         if  EMT.HB > BeamHeightForFixRot then
-            SimulMoveAxis( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID)
-         end
+         SimulMoveAxis( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID)
+         -- raddrizzo asse B prima di ruotare il C
+         SimulMoveAxis( 'B', 0, MCH_SIM_STEP.COLLROT)
         local dPosA = EgtGetAxisPos( 'A')
         if abs( dPosA) < 0.1 then
-            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 180, 0), MCH_SIM_STEP.COLLROT)
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, -180, 0), MCH_SIM_STEP.COLLROT)
         else
-            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, 270), MCH_SIM_STEP.COLLROT)
         end
         SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
      -- movimento scarico rinvio
-      elseif EMT.HEAD == 'H5' then
-         SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', -90, MCH_SIM_STEP.COLLROT)
+      elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
+         SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
         SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
+      -- movimento scarico aggregato BlockHaus
+      elseif EMT.HEAD == 'H7' then
+         SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
+         SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
      -- movimento scarico punta lunga su T111
      elseif EMT.TOTLEN > LONG_TOOL_MINLEN then
         -- se su cambio utensile T111
@@ -559,7 +631,11 @@ function OnSimulToolDeselect()
         -- altrimenti posizioni standard rastrelliera
         else
            SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
-            SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', -90, MCH_SIM_STEP.COLLROT)
+            if GetTCSet( EMT.TCPOS) == 1 then
+               SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
+            else
+               SimulMoveAxes( 'B', -90, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
+            end
         end
      -- movimento scarico utensile di grosso diametro (su T111)
      else
@@ -573,24 +649,40 @@ function OnSimulToolDeselect()
      -- nascondo utensile su testa e lo visualizzo su TcPos
      EgtSetMode( EgtGetHeadId( EMT.HEAD), GDB_MD.HIDDEN)
      ShowToolInTcPos( EMT.TCPOS_1, true)
+
      -- movimento per carico utensile
-      if EMT.NEXTHEAD ~= 'H3' and EMT.NEXTHEAD ~= 'H5' then
-         SimulMoveAxes( 'B', 90, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
+      if EMT.NEXTHEAD ~= 'H3' and EMT.NEXTHEAD ~= 'H5' and EMT.NEXTHEAD ~= 'H6' then
+         SimulMoveAxes( 'B', EgtIf( GetTCSet( EMT.TCPOS) == 1, 90, -90), MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
      else
-         SimulMoveAxes( 'B', 0, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
+         if EMT.NEXTHEAD == 'H3' then
+            local dPosA = EgtGetAxisPos( 'A')
+            if abs( dPosA) < 0.1 then
+               SimulMoveAxes( 'B', 0, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, 270), MCH_SIM_STEP.RAPROT)
+            else
+               SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, -180, 0), MCH_SIM_STEP.COLLROT)
+            end
+         else
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
+         end
      end
      -- se segue lama, carico utensile di default
      if EMT.NEXTHEAD == 'H2' then
         local sDefTool = GetDefaultToolName()
-         EgtLoadTool( 'H1', 1, sDefTool)
         EMT.TOOL_1 = sDefTool
         EMT.TCPOS_1 = GetToolTcPos( EMT.TOOL_1)
+         -- se TC 1
+         if GetTCSet( EMT.TCPOS_1) == 1 then
+            EgtSetAxisPos( 'B', 90)
+         else
+            EgtSetAxisPos( 'B', -90)
+         end
+         EgtLoadTool( 'H1', 1, sDefTool)
         -- lo nascondo sul portautensili
         ShowToolInTcPos( EMT.TCPOS_1, false)
      end
      EgtOutText( '')
-   -- deposito utensile se prossimo non lama su sua testa o dummy
-   elseif EMT.NEXTHEAD ~= 'H2'  and  EMT.NEXTHEAD ~= 'H4' then
+   -- deposito utensile se prossimo non lama su sua testa
+   elseif EMT.NEXTHEAD ~= 'H2' then
      if EMT.NEXTTOOL ~= EMT.TOOL_1 then
         EgtOutText( 'Tool change in progress...')
         -- simulo movimento
@@ -600,7 +692,7 @@ function OnSimulToolDeselect()
         EgtPause( 100)
         ShowToolInTcPos( EMT.TCPOS_1, true)
         -- se segue sega a catena
-         if EMT.NEXTHEAD == 'H3' or EMT.NEXTHEAD == 'H5' then
+         if EMT.NEXTHEAD == 'H3' or EMT.NEXTHEAD == 'H5' or EMT.NEXTHEAD == 'H6' then
            -- se non lama, nascondo l'utensile corrente
            if EMT.HEAD ~= 'H2' then
               EgtSetStatus( EgtGetHeadId( EMT.HEAD), GDB_ST.OFF)
@@ -628,8 +720,7 @@ function OnSimulMachiningStart()
   -- se lavorazione attuale e precedente con sega a catena con angolo A diverso, devo scaricare e ricaricare
   if EMT.HEAD == 'H3' and EMT.HEAD == EMT.PREVHEAD then
      local dPrevA = EgtGetAxisPos( 'A')
-      local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
-      local dPosA = tonumber( sVal:sub( 3))
+      local dPosA = GetCurrChainSawingVirtualAxis()
      if abs( dPosA - dPrevA) > 1 then
         OnSimulToolDeselect()
         EgtSetStatus( EgtGetHeadId( EMT.HEAD), GDB_ST.ON)
@@ -661,7 +752,9 @@ function OnSimulMachiningEnd()
      EMT.UNLOADING = false
      EMT.FALL = false
   end
+   EMT.SPLIT = nil
   EMT.PREVHEAD = EMT.HEAD
+   EMT.PREVTOOL = EMT.TOOL
   EMT.PREVEXIT = EMT.EXIT
 end

@@ -747,31 +840,84 @@ function OnSimulMoveStart()
   VerifyVStroke( EMT.A2)
   -- se inizio lavorazione
   if EMT.MCHFIRST then
+
+      local bGoToHome = false
+      -- se gli assi rotanti cambiano parecchio, con motosega si va in parcheggio 
+      if EMT.PREVHEAD == 'H3' and EMT.HEAD == 'H3' and EMT.TOOL == EMT.PREVTOOL and abs( EMT.R3p - EMT.R3) < 100 * GEO.EPS_SMALL and ( abs( EMT.R2p - EMT.R2) > 25 or abs( EMT.R1p - EMT.R1) > 25)  then
+         bGoToHome = true
+      end
+
      EgtOutText( '')
      EMT.MCHFIRST = false
+      local bZmax = ( EMT.TOOL ~= EMT.PREVTOOL  or EMT.L3 > -1)
      -- con pezzi alti aggiorno gli assi rotanti prima di muovermi sopra il pezzo
-      if not EMT.LOAD and EMT.MOVE == 0 and EMT.HB > BeamHeightForFixRot and EMT.FLAG2 == 1 then
-         -- se motosega mi muovo a X di sicurezza per ruotare
-         if EMT.HEAD == 'H3'then
+      if not EMT.LOAD and EMT.MOVE == 0 and ( EMT.HEAD == 'H3' or ( bZmax and EMT.TOTLEN > 200)) and 
+         ( EMT.HT > BeamHeightForFixRot  or ( EMT.HEAD == 'H1' and EMT.TOTLEN > 350) or bGoToHome) and EMT.FLAG2 == 1 then
+         -- se motosega mi muovo a X di sicurezza per ruotare, prima si raddrizza B e poi C in posizione
+         if EMT.HEAD == 'H3' or bGoToHome then
+            SimulMoveAxis( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID)
+            SimulMoveAxis( 'B', 0, MCH_SIM_STEP.COLLROT)
+            SimulMoveAxis( 'C', EMT.R1, MCH_SIM_STEP.COLLROT)
+            SimulMoveAxis( 'B', EMT.R2, MCH_SIM_STEP.COLLROT)
+         elseif ( bZmax and EMT.TOTLEN > 200) then
            SimulMoveAxes( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID, 'C', EMT.R1, MCH_SIM_STEP.COLLROT, 'B', EMT.R2, MCH_SIM_STEP.COLLROT)
         end
      end
      EMT.POSTROT = nil
   end
+   -- se aggregato flottante su inizio attacco va compresso
+   if EMT.TFLOAT and not EMT.TFLOAT_CMP and EMT.MOVE == 1 and EgtGetName( EMT.MOVEID) == 'LI' then
+      -- recupero lunghezza 
+      local dOffsL = - EgtGetMachiningParam( MCH_MP.OFFSL)
+      -- imposto compressione della parte flottante
+      SetFloatPos( EMT.HEAD, dOffsL)
+      -- imposto dati utensile in posizione compressa
+      EmtSetToolForVmill( EMT.TOOL, EMT.HEAD, EMT.EXIT, EMT.VMILL, 2, -dOffsL)
+      -- dichiaro che è compresso (assegnando Id entità di movimento)
+      EMT.TFLOAT_CMP = EMT.MOVEID
+   end
 end

 ---------------------------------------------------------------------
 function OnSimulMoveEnd()
+   -- se termine di passata con lama
   if EMT.FLAG == 301 then 
      -- rimozione eventuali sfridi
      ExecRemoveScraps()
   end
+   -- se utensile flottante e movimento di compressione
+   if EMT.TFLOAT and EMT.MOVEID == EMT.TFLOAT_CMP then
+      -- verifico ci sia stata collisione tra ghiera flottante (portautensile e pezzo)
+      if not EMT.TFLOAT_TH_COMPR_COLL then
+         local sErr = 'CUTID='..tostring( EMT.CUTID)..'; TASKID='..tostring( EMT.TASKID)..'; Mach='..EMT.MCHNAME..'; Floating Ring not compressed on approach'
+         EmtSetLastError( 1222, sErr)
+         EgtOutLog( 'Error : ' .. sErr, 1)
+      else
+         EgtOutLog( 'Floating Ring compressed on approach (MOVEID='..EgtNumToString( EMT.MOVEID)..')', 1)
+      end
+      EMT.TFLOAT_TH_COMPR_COLL = nil
+   end
+   -- se aggregato flottante su fine uscita va rilasciato
+   if EMT.TFLOAT and EMT.TFLOAT_CMP and EMT.MOVE == 1 and EgtGetName( EMT.MOVEID) == 'LO' and EgtGetName( EgtGetNext( EMT.MOVEID) or GDB_ID.NULL) ~= 'LO' then
+      -- reset compressione della parte flottante
+      SetFloatPos( EMT.HEAD, 0)
+      -- dichiaro che è rilasciato
+      EMT.TFLOAT_CMP = nil
+   end
 end

 ---------------------------------------------------------------------
 function OnSimulCollision()
   -- se prima collisione della lavorazione, la segnalo
   if EMT.MCHNAME ~= EMT.LAST_MCHNAME_COLLIDE then
+      -- speciale per utensile flottante (suo holder contro il grezzo)
+      if EMT.TFLOAT and EMT.TFLOAT_CMP and EMT.SIMCOBIND == 1002 and EMT.SIMVMID == EMT.VMILL[1] then
+         if EMT.MOVEID == EMT.TFLOAT_CMP then
+            EMT.TFLOAT_TH_COMPR_COLL = true
+         end
+         return
+      end
+      -- standard
      local Class = ''
      if EMT.SIMCOBIND == 1001 then
         Class = 'T_H1'
@@ -795,6 +941,8 @@ function ExecAuxCmd( sCmd)
   if Cmd[1] == '0' then
      if Cmd[2] == 'Unloading' then
         EMT.UNLOADING = true
+      elseif Cmd[2] == 'Split' then
+         EMT.SPLIT = true
      elseif  Cmd[2] == 'Fall' then
         EMT.FALL = true
      end
@@ -836,19 +984,9 @@ function ExecAuxCmd( sCmd)
         end
      end
   elseif Cmd[1] == '11' then
-      local dPY = MaxOpen
-      if Cmd[2] ~= '0' then
-         dPY = EgtIf( EMT.ROT == -1, EMT.HB, EMT.SB)
-      end
-      SimulMoveAxis( 'PY', dPY, MCH_SIM_STEP.RAPID)
-      SetPYLight( Cmd[2] ~= '0')
+      ExecMovePY( Cmd[2] ~= '0')
   elseif Cmd[1] == '12' then
-      local dPV = MaxOpen
-      if Cmd[2] ~= '0' then
-         dPV = EgtIf( EMT.ROT == -1, EMT.HB, EMT.SB)
-      end
-      SimulMoveAxis( 'PV', dPV, MCH_SIM_STEP.RAPID)
-      SetPVLight( Cmd[2] ~= '0')
+      ExecMovePV( Cmd[2] ~= '0')
   elseif Cmd[1] == '21' then
      local nYDelta = tonumber( Cmd[2])
      local nVDelta = tonumber( Cmd[3])
@@ -892,7 +1030,7 @@ function ExecRemoveScraps()
         for i = nPart, 1, -1 do
            if i ~= nPartMax then
               local b3Vmill = EgtVolZmapGetPartBBoxGlob( vMillId, i - 1, GDB_BB.STANDARD)
-               if b3Vmill:getDimX() < 1200 then
+               if b3Vmill:getDimX() < 1250 then
                  EgtRemoveVolZmapPart( vMillId, i - 1)
               end
            end
@@ -912,21 +1050,25 @@ function ExecUnloading()
      -- li sposto per lasciare spazio al nuovo pezzo
      local nId = EgtGetFirstInGroup( nVmGrpId)
      while nId do
-         EgtMove( nId, Vector3d( 0, EgtIf( BD.RIGHT_LOAD, ( EMT.SB + 50.0), -( EMT.SB + 50.0)), 0), GDB_RT.GLOB)
+         EgtMove( nId, Vector3d( 0, EgtIf( BD.RIGHT_LOAD, ( EMT.ST + 50.0), -( EMT.ST + 50.0)), 0), GDB_RT.GLOB)
         nId = EgtGetNext( nId)
      end
      -- creo un nuovo layer e vi inserisco il nuovo pezzo
      local nLayId = EgtGroup( nVmGrpId, EgtGetGlobFrame( vMillId))
      EgtRelocate( vMillId, nLayId)
      local vtMove = Vector3d( 0, EgtIf( BD.RIGHT_LOAD, 450, -450), 0)
-      if EMT.FALL then vtMove = Vector3d( -500, 0, EgtIf( BD.RIGHT_LOAD, 750, -750)) end
+      if EMT.FALL then vtMove = Vector3d( 0, EgtIf( BD.RIGHT_LOAD, 500, -500), -750) end
      EgtMove( nLayId, vtMove, GDB_RT.GLOB)
      EgtSetLevel( vMillId, GDB_LV.USER)
      -- aggiungo gli spigoli
-      local nFirstId, nCount = EgtVolZmapGetEdges( vMillId, nLayId)
-      if nFirstId then
-         for nId = nFirstId, nFirstId + nCount - 1 do
-            EgtSetColor( nId, Color3d( 96, 96, 96))
+      if EgtVolZmapSetShowEdges then
+         EgtVolZmapSetShowEdges( vMillId, true)
+      else
+         local nFirstId, nCount = EgtVolZmapGetEdges( vMillId, nLayId)
+         if nFirstId then
+            for nId = nFirstId, nFirstId + nCount - 1 do
+               EgtSetColor( nId, Color3d( 96, 96, 96))
+            end
         end
      end
      -- rilascio Vmill
@@ -953,6 +1095,176 @@ function ExecUnloading()
   end
 end

+---------------------------------------------------------------------
+function CheckClamping( sClampName)
+
+   local nClampId = EgtGetAxisId( sClampName) or GDB_ID.NULL
+   local nClampPathId = EgtGetFirstInGroup( EgtGetFirstNameInGroup( nClampId, 'CLAMP_CHECK') or GDB_ID.NULL)
+   local b3ClampingArea = EgtGetBBoxGlob( nClampPathId or GDB_ID.NULL, GDB_BB.STANDARD)
+   -- se non trovo percorso area di clamping, esco subito
+   if not nClampPathId or not EMT.VMILL or not ClampingCoeffMin then
+      return
+   end
+
+   local function GetCurveListFromIntersection( sPosIntersPlane, sIntersPlane, dDepth)
+      local vCurveListId = {}
+      local vtIntersPlane
+      -- piano di interpolazione 
+      if sIntersPlane == 'X' then
+         vtIntersPlane = X_AX()
+      elseif sIntersPlane == 'Y' then
+         vtIntersPlane = Y_AX()
+      elseif sIntersPlane == 'Z' then
+         vtIntersPlane = Z_AX()
+      end
+
+      for i = 1, #EMT.VMILL do
+         local b3VMill = EgtGetBBoxGlob( EMT.VMILL[i], GDB_BB.EXACT)
+         local ptPosIntersPlane
+         if sPosIntersPlane == 'MIN' then
+            ptPosIntersPlane = b3VMill:getMin() + dDepth * vtIntersPlane
+         elseif sPosIntersPlane == 'MAX' then
+            ptPosIntersPlane = b3VMill:getMax() - dDepth * vtIntersPlane
+         end
+         local nLoopId, nLoopCnt = EgtPlaneVolZmapInters( ptPosIntersPlane, vtIntersPlane, EMT.VMILL[i], CLAMP_CHECK_INTERS, GDB_RT.GLOB)
+         vCurveListId = EgtTableAdd( vCurveListId, nLoopId, nLoopCnt)
+      end
+
+      return vCurveListId
+   end
+
+   local function CalculateIntersectionArea( sPosIntersPlane, sIntersPlane, dDepth)
+      -- test piano frontale
+      local vCurveListId = GetCurveListFromIntersection( sPosIntersPlane, sIntersPlane, dDepth)
+      -- si copia curva intersezione e curva pinza in gruppo di confronto
+      local nFlatSurfId, nFlatSurfCnt = EgtSurfFlatRegion( CLAMP_CHECK_GROUP, vCurveListId)
+      local vFlatSurfId = EgtTableFill( nFlatSurfId, nFlatSurfCnt) or {}
+      local nClampSurfId = EgtSurfFlatRegion( CLAMP_CHECK_GROUP, nClampPathId)
+
+      local dTotalArea = 0
+      local dTotalXLenght = 0
+      for i = 1, #vFlatSurfId do
+         local nTempSurfId = vFlatSurfId[i]
+         EgtSurfFrIntersect( nTempSurfId, nClampSurfId)
+         if nTempSurfId then
+            dTotalArea = dTotalArea + ceil( EgtSurfArea( nTempSurfId) or 0)
+            local b3BoxIntersectionBox = EgtGetBBoxGlob( nTempSurfId, GDB_BB.STANDARD)
+            if b3BoxIntersectionBox then
+               dTotalXLenght = dTotalXLenght + ceil( b3BoxIntersectionBox:getDimX()) -- somma lunghezze (x) delle aree pinzate
+            end
+         end
+      end
+      return dTotalArea, dTotalXLenght
+   end
+
+   -- minima area considerata per un corretto pinzaggio
+   DistZClampToTable = DistZClampToTable or 0
+   --local MinJoin = BD.GetMinJoin( EMT.ST, EMT.HT, EgtIf( EMT.SPLIT, EMT.LT, EMT.LB))
+   UpdateMinJoinDeltaTol( EMT.ST, EMT.HT, EgtIf( EMT.SPLIT, EMT.LT, EMT.LB))
+   local MinZClamping =  min( b3ClampingArea:getDimZ() + DistZClampToTable, EMT.HT) - DistZClampToTable
+   local dMinClamping = ( MinJoin * MinZClamping)
+   -- si moltiplica per un coefficiente minimo sotto al quale si da l'errore di pinzaggio
+   ClampingCoeffMin = EgtClamp( ClampingCoeffMin, 0.01, 1)
+   if MinZClamping > 116 then
+      dMinClamping = MinJoin * 116 + ( pow( MinJoin, 2) / 2)
+      if MinJoin > 280 then
+         dMinClamping = MinJoin * 116 + ( pow( 280, 2) / 2) + ( pow( MinJoin - 280, 2))
+      end
+   end
+   
+   local dMinClampingAreaWarn = dMinClamping * ClampingCoeffMin
+   local dMinClampingAreaErr = dMinClamping * ( ClampingCoeffMin / 3)
+
+   local bError = true
+   local sWrn, sErr
+   local bWriteWarnMessage = false
+   local bWriteErrMessage = false
+   -- controllo faccia frontale
+   local dArea, dXClampedLenght = CalculateIntersectionArea( 'MIN', 'Y', 3)
+   -- ERRORE: pinza troppo poco (meno di 1/3 del minimo richiesto)
+   if dArea and dArea < dMinClampingAreaErr then
+      -- solo se pinza almeno 1cm2, e la somma della lunghezza pinzata è maggiore della lunghezza minima pinzabile da Warning e non errore
+      if dXClampedLenght >= MinJoin * ClampingCoeffMin and dArea > 1000 then 
+         bError = false
+      end
+      -- pinzaggio non fattibile, errore
+      if bError then
+         sErr = 'ERROR CLAMPING ' .. sClampName .. ' : '..tostring( ceil( ( dArea / dMinClampingAreaWarn) * 100))..'% ( '.. tostring( dArea/1000)..'cm2)'
+         bWriteErrMessage = true
+      end
+   end
+   -- WARNING: pinza meno del minimo richiesto
+   if dArea and dArea < dMinClampingAreaWarn and not bWriteErrMessage then
+      sWrn = 'WARNING CLAMPING ' .. sClampName .. ' : '..tostring( ceil( ( dArea / dMinClampingAreaWarn) * 100))..'% ( '.. tostring( dArea/1000)..'cm2)'
+      bWriteWarnMessage = true
+   end
+   EgtEmptyGroup( CLAMP_CHECK_GROUP)
+   EgtEmptyGroup( CLAMP_CHECK_INTERS)
+
+   -- controllo altro lato solo se non sono già in errore
+   if not bWriteErrMessage then
+      -- controllo faccia posteriore
+      dArea, dXClampedLenght = CalculateIntersectionArea( 'MAX', 'Y', 3)
+      -- ERRORE: pinza troppo poco (meno di 1/3 del minimo richiesto)
+      if dArea and dArea < dMinClampingAreaErr then   
+         -- solo se pinza almeno 1cm2, e la somma della lunghezza pinzata è maggiore della lunghezza minima pinzabile da Warning e non errore
+         if dXClampedLenght >= MinJoin * ClampingCoeffMin and dArea > 1000 then 
+            bError = false
+         end
+         -- pinzaggio non fattibile, errore
+         if bError then
+            sErr = 'ERROR CLAMPING ' .. sClampName .. ' : '..tostring( ceil( ( dArea / dMinClampingAreaWarn) * 100))..'% ( '.. tostring( dArea/1000)..'cm2)'
+            bWriteErrMessage = true
+         end
+      end
+      -- WARNING: pinza meno del minimo richiesto
+      if dArea and dArea < dMinClampingAreaWarn and not bWriteWarnMessage and not bWriteErrMessage then
+         sWrn = 'WARNING CLAMPING ' .. sClampName .. ' : '..tostring( ceil( ( dArea / dMinClampingAreaWarn) * 100))..'% ( '.. tostring( dArea/1000)..'cm2)'
+         bWriteWarnMessage = true
+      end
+      EgtEmptyGroup( CLAMP_CHECK_GROUP)
+      EgtEmptyGroup( CLAMP_CHECK_INTERS)
+   end
+
+   if bWriteErrMessage then
+      EmtSetLastError( 1213, sErr, EgtGetEnableUI())
+      EgtOutBox( sErr, 'CLAMPING', 'ERROR', 'OK')
+      EmtSetSimulPause()
+   elseif bWriteWarnMessage then
+      EgtOutLog( sWrn)
+      EgtOutBox( sWrn, 'CLAMPING', 'WARNING', 'OK')
+      EmtSetSimulPause()
+   end
+end
+
+---------------------------------------------------------------------
+function ExecMovePY( bClose)
+   --SimulMoveAxes( 'PY', EgtIf( not bClose, MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
+   local dPY = MaxOpen
+   if bClose then
+      dPY = EgtIf( EMT.ROT == -1, EMT.HT, EMT.ST)
+   end
+   SimulMoveAxis( 'PY', dPY, MCH_SIM_STEP.RAPID)
+   SetPYLight( bClose)
+   if bClose then
+      CheckClamping( 'PY')
+   end
+end
+
+---------------------------------------------------------------------
+function ExecMovePV( bClose)
+   --EgtIf( not bClose, MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
+   local dPV = MaxOpen
+   if bClose then
+      dPV = EgtIf( EMT.ROT == -1, EMT.HT, EMT.ST)
+   end
+   SimulMoveAxis( 'PV', dPV, MCH_SIM_STEP.RAPID)
+   SetPVLight( bClose)
+   if bClose then
+      CheckClamping( 'PV')
+   end
+end
+
 ---------------------------------------------------------------------
 function VerifyYSlide( sName1, dVal1, sName2, dVal2)
   -- Se movimento trave agganciata con carrello Y
@@ -1109,22 +1421,35 @@ end
 ---------------------------------------------------------------------
 --   *** ESTIMATION T&L ***
 ---------------------------------------------------------------------
-local RAPID_X_FEED =  75000    -- mm/min
-local RAPID_Y_FEED = 100000    -- mm/min
-local RAPID_Z_FEED =  50000    -- mm/min
-local RAPID_C_FEED =  15000    -- deg/min
-local RAPID_B_FEED =  15000    -- deg/min
-local RAPID_MIN_T = 0.1        -- s
-local LOAD_T = 2               -- s
-local CHAR_ONE_MOVE_T = 1      -- s
-local ROTATION_T = 40          -- s
-local SPLIT_T = 6              -- s
-local UNLOAD_T = 4             -- s
-local FALL_T = 2               -- s
+local ESTIMATION_RAPID_COEFF = EstimationRapidMultiplier or 1
+local RAPID_X_FEED =  100000 / ESTIMATION_RAPID_COEFF   -- mm/min
+local RAPID_Y_FEED = 100000 / ESTIMATION_RAPID_COEFF    -- mm/min
+local RAPID_Z_FEED =  100000 / ESTIMATION_RAPID_COEFF   -- mm/min
+local RAPID_C_FEED =  12000 / ESTIMATION_RAPID_COEFF    -- deg/min
+local RAPID_B_FEED =  12000 / ESTIMATION_RAPID_COEFF    -- deg/min
+local RAPID_MIN_T = 0.1 * ESTIMATION_RAPID_COEFF       -- s
+local LOAD_T = 2  * ESTIMATION_RAPID_COEFF              -- s
+local CHAR_ONE_MOVE_T = 1  * ESTIMATION_RAPID_COEFF     -- s
+local ROTATION_T = 40  * ESTIMATION_RAPID_COEFF         -- s
+local SPLIT_T = 6  * ESTIMATION_RAPID_COEFF             -- s
+local UNLOAD_T = 4  * ESTIMATION_RAPID_COEFF            -- s
+local FALL_T = 2  * ESTIMATION_RAPID_COEFF              -- s

 ---------------------------------------------------------------------
 function OnEstimStart()
   EMT.INCHES = not EgtUiUnitsAreMM()      -- unità di misura mm/inches
+
+   -- TPA
+   if NumericalControl == 'TPA' then
+      EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 154000, 20000, 160000)  -- feed massima pinze
+      EMT.MAXACC = MaxAcc or 4000    -- accelerazione massima pinze. In realtà è il tempo in millisecondi, quindi MAXACC corrisponde al tempo massimo per raggiungere la velocità desiderata
+      EMT.MINACC = MinAcc or 300     -- accelerazione minima pinze. In realtà è il tempo in millisecondi, quindi MINACC corrisponde al tempo massimo per raggiungere la velocità desiderata
+   -- NUM_PLUS e NUM
+   else
+      EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 154000, 20000, 160000)  -- feed massima pinze
+      EMT.MAXACC = MaxAcc or ( EMT.FMAXPINZE / ( 60 * 0.3))  -- accelerazione massima pinze
+      EMT.MINACC = MinAcc or ( EMT.FMAXPINZE / ( 60 * 4))    -- accelerazione minima pinze
+   end
 end

 ---------------------------------------------------------------------
@@ -1210,6 +1535,15 @@ function OnEstimDispositionEnd()
   EMT.OPEISDISP = false
 end

+---------------------------------------------------------------------
+function OnEstimRawMoveData()
+   -- se start del pezzo
+   if IsStartOrRestPhase( EMT.PHASE) then
+      EMT.SPLIT = false
+   end
+   OnRawMoveData()
+end
+
 ---------------------------------------------------------------------
 function OnEstimToolSelect()
   -- reset indice utensile in tabella lunghezze
@@ -1266,6 +1600,12 @@ function OnEstimMachiningEnd()
      EMT.TLE_NAME = nil
      EMT.TLE_TIME = nil
   end
+
+   EMT.MCHUSERNOTES = EgtGetMachiningParam( MCH_MP.USERNOTES) or ''
+   EMT.MCHSPLIT = ( EMT.MCHUSERNOTES:find( 'Split;', 1, true) ~= nil)
+   if EMT.MCHSPLIT then
+      EMT.SPLIT = true
+   end
 end

 ---------------------------------------------------------------------
@@ -1396,15 +1736,15 @@ function OnEstimRapid()
   EMT.MCHEXTLEN = EMT.MCHEXTLEN + dLen
   -- calcolo tempo
   local dTime = RAPID_MIN_T
-   local dT1 = abs( dL1) / RAPID_X_FEED * 60
+   local dT1 = CalcMoveTime( abs( dL1), EMT.FMAXPINZE, EMT.SPLIT)
   if dT1 > dTime then dTime = dT1 end
-   local dT2 = abs( dL2) / RAPID_Y_FEED * 60
+   local dT2 = abs( dL2) / ( RAPID_X_FEED / 60) -- CalcMoveTime( abs( dL2), RAPID_X_FEED, EMT.SPLIT)
   if dT2 > dTime then dTime = dT2 end
-   local dT3 = abs( dL3) / RAPID_Z_FEED * 60
+   local dT3 = abs( dL3) / ( RAPID_Z_FEED * 60) -- CalcMoveTime( abs( dL3), RAPID_Z_FEED, EMT.SPLIT)
   if dT3 > dTime then dTime = dT3 end
-   local dT4 = abs( dR1) / RAPID_C_FEED * 60
+   local dT4 = abs( dR1) / ( RAPID_C_FEED / 60)
   if dT4 > dTime then dTime = dT4 end
-   local dT5 = abs( dR2) / RAPID_B_FEED * 60
+   local dT5 = abs( dR2) / ( RAPID_B_FEED / 60)
   if dT5 > dTime then dTime = dT5 end
   EMT.MCHEXTTIME = EMT.MCHEXTTIME + dTime
   EgtOutLog( string.format( '  G0 Len=%.0f Rot=%.0f° Time=%.2f', dLen, abs( dR1) + abs( dR2), dTime), 5)
@@ -1422,7 +1762,7 @@ function OnEstimLinear()
   local dLen = sqrt( dL1 * dL1 + dL2 * dL2 + dL3 * dL3)
   EMT.MCHCUTLEN = EMT.MCHCUTLEN + dLen
   -- calcolo tempo
-   local dTime = dLen / EMT.F * 60
+   local dTime = dLen / ( EMT.F / 60) -- CalcMoveTime( dLen, EMT.F, EMT.SPLIT)
   EMT.MCHCUTTIME = EMT.MCHCUTTIME + dTime
   EgtOutLog( string.format( '  G1 Len=%.0f Time=%.2f', dLen, dTime), 5)
   -- aggiorno valori come precedenti
@@ -1520,6 +1860,12 @@ function IsStartOrRestPhase( nPhase)
   return ( sVal == 'START' or sVal == 'REST')
 end

+---------------------------------------------------------------------
+function IsEndPhase( nPhase)
+   local sVal = GetPhaseType( nPhase)
+   return ( sVal == 'END')
+end
+
 ---------------------------------------------------------------------
 function IsMidPhase( nPhase)
   local sVal = GetPhaseType( nPhase)
@@ -1553,6 +1899,88 @@ function GetPhaseRot( nPhase)
   return ( EgtGetInfo( EgtGetPhaseDisposition( nPhase) or GDB_ID.NULL, 'ROT', 'i') or 0)
 end

+---------------------------------------------------------------------
+function GetParkT()
+   local dTmp = EgtGetInfo( EMT.DISPID, 'TPOS', 'd') or EgtGetInfo( EMT.DISPID, 'TPARK', 'd')
+   if dTmp then
+      return dTmp
+   else
+      return LoadT
+   end
+end
+
+---------------------------------------------------------------------
+function GetCurrChainSawingVirtualAxis()
+   -- recupero il valore dell'asse virtuale bloccato A
+   local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS) or 'A=0'
+   local dPosA = tonumber( sVal:sub( 3)) or 0
+   return dPosA
+end
+
+---------------------------------------------------------------------
+function CalcDinamicaPinze_TPA( dH, dS, dL)
+   local MinTempoAcc = EMT.MINACC        -- [ms] ~300
+   local MaxTempoAcc = EMT.MAXACC        -- [ms] ~4000
+   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
+   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
+   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
+   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
+   local TempoAcc = EgtClamp( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito), MinTempoAcc, MaxTempoAcc)
+   local RidFeed = 100 / Massa * 100
+   if RidFeed > 100 then
+      RidFeed = 100
+   elseif RidFeed < 10 then
+      RidFeed = 10
+   end
+   return TempoAcc, MinTempoAcc, RidFeed
+end
+
+---------------------------------------------------------------------
+function CalcDinamicaPinze_NUM( dH, dS, dL)
+   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
+   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
+   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
+   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
+   local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
+   local AccMaxPinze = EMT.MAXACC
+   local AccPinze = EgtClamp( FMaxPinze / ( 60 * TempoAcc), EMT.MINACC, EMT.MAXACC)
+   local RidFeed = 100 / Massa * 100
+   if RidFeed > 100 then
+      RidFeed = 100
+   elseif RidFeed < 10 then
+      RidFeed = 10
+   end
+   return AccPinze, AccMaxPinze, RidFeed, TempoAcc
+end
+
+---------------------------------------------------------------------
+function CalcMoveTime( dPathLen, dFeed, bIsSplitted)
+   local dTime
+   local dFeedInSec = dFeed / 60
+
+   if NumericalControl == 'TPA' then
+      local dTempoAcc, _, _ = CalcDinamicaPinze_TPA( EMT.HT, EMT.ST, EgtIf( bIsSplitted, EMT.LT, EMT.LB))
+      dTempoAcc = dTempoAcc / 1000
+      -- se si raggiunge la velocità massima
+      if dPathLen >= dFeedInSec * dTempoAcc then
+         dTime = dTempoAcc * 2 + ( ( dPathLen - dFeedInSec * dTempoAcc) / dFeedInSec)
+      else
+         dTime = 2 * sqrt( (dPathLen * dTempoAcc) / dFeedInSec)
+      end
+   else
+      local dAcc, _, _, _ = CalcDinamicaPinze_NUM( EMT.HT, EMT.ST, EgtIf( bIsSplitted, EMT.LT, EMT.LB))
+      -- Caso 1: dFeed raggiunta
+      if dPathLen >= ( dFeedInSec ^ 2) / dAcc then
+         dTime = ( dFeedInSec / dAcc) + ( dPathLen / dFeedInSec)
+      -- Caso 2: dFeed non raggiunta
+      else
+         dTime = 2 * sqrt( dPathLen / dAcc)
+      end
+   end
+
+   return dTime
+end
+
 ---------------------------------------------------------------------
 -- *** END GENERAL ***
 ---------------------------------------------------------------------
@@ -1,5 +1,188 @@
           ==== Common_FAST Update Log ====

+Versione 3.1c1 (27/03/2026)
+- (SIM-GEN) FASTCLAMPING = true  : si suddivide il movimento metà tirando e metà spingendo con altra pinza. Così si aumenta la velocità.
+-           FASTCLAMPING = false : una pinza resta ferma e si fa il movimento tutto con una pinza. Così si limita lo scivolamento del pezzo.
+- (GEN) In caso di motosega prelevata, si ruota in home.  Ticket#2866
+
+Versione 3.1a2 (26/01/2026)
+- (GEN) Nella G101 il parametro EE era sempre a 4 perchè la variabile veniva settata dopo. Ticket#2796
+
+Versione 3.1a1 (08/01/2026)
+- (SIM) Ottimizzata scrittura funzione ClampCheck post aggiornamento dll
+- (SIM) Corretto problema della funzione OnSimulDispositionStart in caso di fase finale.
+- (MLDE-SIM-GEN) Variabile DeltaTol deve essere spostata in MLDE
+
+Versione 2.7l3 (22/12/2025)
+- (SIM) Eliminata MinJoin, utilizzata al suo posto funzione già esistente UpdateMinJoin nell'mlde
+- (SIM) Modificata formula calcolo Area minima
+
+Versione 2.7l2 (18/12/2025)
+- (SIM) Aggiunta funzione CheckClamping
+
+Versione 2.7l1 (10/12/2025)
+- (SIM) Aggiornata risoluzione VMillTol in funzione dello spessore lama
+- (EST) Modifiche a calcolo stima tempi, da verificare.
+- (SIM) Corretto movimento in simulazione che non rispettava movimento generato.
+- (GEN) Con controllo NUM/NUM_PLUS nella scrittura della coordinata tolto il simbolo '='
+- (SIM) Aggiunto controllo C in base a carico Dx o Sx durante il cambio utensile
+
+Versione 2.7k1 (10/11/2025)
+- (GEN) Corretto set variabili info utensile prima del movimento in home in caso di pezzi alti per NUM/NUM_PLUS.
+
+Versione 2.7j2 (08/10/2025)
+- (SIM-GEN) Quando si scarica motosega, si raddrizza prima l'asse B e poi si muove il C. Ora sempre e non solo se pezzo alto.
+
+Versione 2.7j1 (06/10/2025)
+- (SIM-GEN) Quando si scarica motosega, si raddrizza prima l'asse B e poi si muove il C.
+- (MLDE-SIM) Controllo collisione tra utensile e TOP testa C. Serve CAM5 2.7j1
+
+Versione 2.7i3 (23/09/2025)
+- (MLDE-ALL) Spostate costanti dimensioni utensili in MLDE.
+
+Versione 2.7i2 (17/09/2025)
+- (EST) Stima tempi considerando accelerazioni
+- (SIM) Prelievo e deposito motosega con gli angoli comunicati da Essetre
+
+Versione 2.7i1 (08/09/2025)
+- (SIM-GEN) Se lavorazione precedente e successiva con motosega e si cambiano assi rotanti, vado in parcheggio per ruotare. Ticket#1844
+- (SIM-GEN) Per NEWCLAMPING, corretto un caso di riposizionemento allo scarico dove la pinza V poteva andare in posizione direttamente, ma cercava di fare passo pellegrino. Ticket#2572
+
+Versione 2.7g1 (01/07/2025)
+- (GEN) Aggiunti parametri FMAXPINZE, MAXACC, MINACC configurabili da TS3. Ticket#2052
+
+Versione 2.7f3 (26/06/2025)
+- (SIM-GEN) Aggiunti 10mm di sicurezza in caso di primo pinzaggio per stare oltre tolleranza riqualifica laser di 50mm. Ticket#2504
+
+Versione 2.7f2 (19/06/2025)
+- (GEN) Se in separazione il pezzo è andato più lontano della posizione standard, viene riletta. Ticket#2498
+
+Versione 2.7f1 (18/06/2025)
+- (SIM-GEN) Se utensile più lungo di 350mm, si va in posizione sicurezza come per la motosega. Ticket#2438
+
+Versione 2.7e1 (26/05/2025)
+- (SIM) Aumentata dimensione massima per la quale si rimuove uno scarto dal VMILL. Ticket#1438
+- (SIM) In simulazione, corretto selezione utensile per punte lunghe. Ticket#2438
+
+Versione 2.7d1 (14/04/2025)
+- (GEN) Corretto movimento iniziale in caso di motosega, si controlla solo se non è il carico. Ticket#2385
+
+Versione 2.7c1 (26/03/2025)
+- (GEN) All'inizio del codice ISO si scrive nel commento anche il controllo numerico utilizzato per la generazione.
+- (GEN) Aggiunta commenti HEADER e FOOTER per comunicazione con linea o altre macchine, da parte di Essetre.
+- (GEN) In MyAdjustLinearAxes si utilizza TDIR per calcolarsi gli offset per compatibilità con lavorazioni a 5 assi.
+
+Versione 2.7b1 (20/02/2025)
+- (SIM-GEN) Aggiunta possibilità di settare HCING/TCING nelle note di ogni singola lavorazione per gestire parte non pinzabile del pezzo. Funziona solo con nuovo pinzaggio.
+- (SIM-GEN) Piccola correzione calcolo posizione carrelli con nuova strategia di pinzaggio.
+- (SIM-GEN) Caricamento libreria EmtGenMachining. Si fa una require con PCALL perchè la libreria è opzionale e non è detto che ci sia. In installazione CAM5 dalla 2.7a1
+- (GEN) Per controllo TPA, modifica al numero di decimali.
+- (SIM) Aggiunta gestione per ToolHolder flottante
+
+Versione 2.7a3 (08/01/2025)
+- (GEN) Dopo separazione, in NUM_PLUS, si srive EH1 solo se macro G101, perchè altrimenti non è prevista. Ticket#2239
+
+Versione 2.7a2 (08/01/2025)
+- (MLDE-SIM) Aggiunta gestione FACOLTATIVA 'EstimationRapidMultiplier' in MLDE per regolare il tempo stimato. Se non presente in MLDE, default 1.
+- (SIM) Aggiunta gestione qualità VMILL da impostazioni macchina
+
+Versione 2.7a1 (07/01/2025)
+- (MLDE-SIM-GEN) Nuovo aggregato 90° (H7) per fresa tipo BlockHaus. Ticket#2142
+- (SIM-GEN) Aumentati limiti massimi di pinzaggio minimo
+
+Versione 2.6l1 (02/12/2024)
+- (SIM) Corretto movimento VMILL durante scarico pezzo piccolo a caduta
+- (SIM-GEN) Per decidere posizione parcheggio barra dopo separazione, si considera lunghezza coda del pezzo in lavoro per evitare collisioni. Ticket#2168
+
+Versione 2.6k1 (11/11/2024)
+- (GEN) Aggiunta gestione aggregato a T per NUM
+- (SIM) Tolta gestione testa dummy H4
+- (SIM-GEN) Aggiustato parametro in calcolo ingombro lavorazione. Ticket#2163
+
+Versione 2.6j10 (25/10/2024)
+- (SIM-GEN) Miglioria 2.6j9. Si ribadisce pinza in presa sempre, all'inizio, in base a quella attiva
+
+Versione 2.6j9 (22/10/2024)
+- (SIM-GEN) Miglioria 2.6j6. Oltre al passo pellegrino si ribadisce anche quando è scambio diretto
+
+Versione 2.6j8 (21/10/2024)
+- (SIM-GEN) Corretto problema tolleranza aggiunto con versione 2.6j7 
+
+Versione 2.6j7 (18/10/2024)
+- (SIM-GEN) In nuova disposizione carrelli, aggiunta tolleranza di 100 EPS quando si calcola minimo posizionamento
+
+Versione 2.6j6 (17/10/2024)
+- (GEN) Si ribadisce che la pinza era in presa, prima di cominciare con lo scambio del passo del pellegrino. Ticket#2121
+
+Versione 2.6j5 (17/10/2024)
+- (SIM-GEN) Piccola correzione nuovo riposizionamento. Nel taglio dello scarto finale riposizionava nel vuoto. Ticket#2115
+
+Versione 2.6j4 (15/10/2024)
+- (SIM-GEN) Piccola correzione nuovo riposizionamento. Non considerava i 50mm di tolleranza su primo pinzaggio dopo ribaltamento
+- (SIM-GEN) Gestione attivazione pressore verticale in nuovo riposizionamento
+
+Versione 2.6j3 (11/10/2024)
+- (GEN) Corretta scrittura macro start/attesa movimenti per NUM. Veniva scritto codice per TPA.
+
+Versione 2.6j2 (03/10/2024)
+- (SIM-GEN) Piccola correzione calcolo posizione carrello durante riposizionamento, nuova gestione
+
+Versione 2.6j1 (01/10/2024)
+- (SIM-GEN) Sistemato calcolo in nuova disposzione carrelli
+
+Versione 2.6i6 (25/09/2024)
+- (GEN) Migliorata gestione movimenti per portare testa vicino a cambio utensile se trave alta. Ticket#2066
+
+Versione 2.6i5 (24/09/2024)
+- (SIM-GEN) Tolto controllo su lunghezza maggiore di 200mm introdotto con 2.6i2 perchè non completamente funzionante
+- (GEN) Gestione in OnRapid() di EMT.FLAG=5 (rotazione a Z max per lavorazione successiva). Ora allineata alla simulazione
+
+Versione 2.6i4 (24/09/2024)
+- (SIM-GEN) Aggiunto ripinzaggio extra in caso servisse un grande spostamento e si sta pinzando poco.
+            L'aggiunta del ripinzaggio dipende da FASTCLAMPING (che deve essere disattiva). Viene aggiunta GAIN_RECLAMPING per decidere il guadagno in mm del ripinzaggio.
+
+Versione 2.6i3 (23/09/2024)
+- (SIM-GEN) Aggiunta nuova strategia riposizionamento morse
+- (SIM-GEN) Aggiunta lettura flag NEWCLAMPING in BeamData, per abilitare nuova strategia riposizionamento. Se false o nil, funziona con metodo vecchio.
+- (SIM-GEN) Aggiunta lettura flag FASTCLAMPING. Se false, al carico prende al massimo 1000mm, per evitare collisioni durante ciclo di lettura laser e prima lavorazione.
+
+Versione 2.6i2 (16/09/2024)
+- (SIM-GEN) Se utensili più lunghi di 200mm, si ruota in home e poi si approccia il pezzo.  Ticket#2038
+- (SIM-GEN) Aumentata distanza ingombro da 650mm a 660mm. In casi di utensile abbastanza lungo poteva andare in colisione. Ticket#2041
+
+Versione 2.6i1 (02/09/2024)
+- (MLDE-SIM-GEN) Rinominato file da "Common-" a "Common_" per uniformità con i file common delle altre macchine. Serve modifica a MLDE macchina.
+
+Versione 2.6g1 (03/07/2024)
+- (GEN) Corretto chiamata macro precarico in caso di taglio finale, ma con ribaltamento successivo. Ora si chiama solo se la fase successiva è una "END". Ticket#1881
+- (GEN) Per controllo NUM, se arco maggiore di 99999mm, si approssima con una retta. Ticket#1888
+
+Versione 2.6e3 (06/05/2024)
+- (MLDE-SIM-GEN) Gestione facoltativa parametri MIN_JOIN_xx settabili in Ts3. Ticket#1794
+
+Versione 2.6e2 (06/05/2024)
+- (SIM-GEN) Modificata tolleranza calcolo ingombri lavorazioni per posizionamento pinze. Ticket#1790
+
+Versione 2.6e1 (30/04/2024)
+- (MLDE-GEN) Gestione facoltativa parametro WOOD_DENSITY settabile in Ts3. In MLDE, mettere il valore di WOOD_DENSITY nella nostra variabile 'WoodDensity'.
+
+Versione 2.6d2 (18/04/2024)
+- (SIM-GEN) In MLSE, quando c'è una rotazione, viene settato EMT.CNT=1 per considerare i 50mm di compensazione laser.
+- (SIM) Nel file di log dove c'è stampa gruppi di collisione, viene scritto anche ID del gruppo
+
+Versione 2.6d1 (15/04/2024)
+- (GEN) Aggiunta gestione aggregato doppia uscita per controllo NUM_PLUS
+- (GEN) Con aggregato con si possono fare archi, se OnArc con aggregato, dà errore.
+- (GEN) Chiamando la macchina con un nome che termini con '.TEST' si abilita come macchina per test interni, equivalente a settare 'IS_TEST_MACHINE' (che comunque rimane)
+
+Versione 2.6c8 (28/03/2024)
+- (MLSE) Possibilità di lavorazione da X- tra le pinze, se abilitata da flag (User.ENABLE_TOOL_BETWEEN_VICES == 1).
+- (MLDE-GEN) Aggiunto parametro 'IS_TEST_MACHINE' FACOLTATIVO. Se non esiste o 'false' è macchina standard, se 'true' è una macchina utilizzata per i test Egalware interni
+
+Versione 2.6c7 (12/03/2024)
+- (SIM) Miglioramento visualizzazione spigoli VMILL alla fine della simulazione. Funzione: EgtVolZmapSetShowEdges. N.B.= serve CAM5 2.6c2 NON OBBLIGATORIO
+- (GEN) Corretto problema di movimento pinze assieme a discesa asse Z (Ticket #1710)
+
 Versione 2.6c6 (04/03/2024)
 - (MLDE-GEN) Aggiunta variabile 'MACH_NAME' in MLDE con nome macchina

@@ -1,9 +1,9 @@
-- Version.lua by EgalWare s.r.l. 2024/02/23
+-- Version.lua by EgalWare s.r.l. 2024/03/28
 -- Gestione della versione dei file comuni post-processori macchine FAST e FASTrl di Essetre

 local InfoCommon_STD_PP = {
-   NAME = 'Common-FAST',            -- nome script PP standard
-   VERSION = '2.6c6',                 -- versione script
+   NAME = 'Common_FAST',            -- nome script PP standard
+   VERSION = '3.1c1',                 -- versione script
   MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
 }