- Corretta chiamata di una variabile insesistente in caso di ONE

- Allineata simulazione a generazione
- Revert delle ultime modifiche
- Cambio versione per rilascio a cliente

Common_ONE-PF.NUM.mlpe

@@ -28,8 +28,8 @@ function OnStart()
    --EMT.Ft = 'F'           -- token per feed
    --EMT.St = 'S'           -- token per speed
    EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 102000, 20000, 102000)  -- feed massima pinze
-   EMT.MAXACC = EgtClamp( MaxAcc or ( EMT.FMAXPINZE / ( 60 * 0.3)))  -- accelerazione massima pinze
-   EMT.MINACC = EgtClamp( MinAcc or ( EMT.FMAXPINZE / ( 60 * 4)))    -- accelerazione minima pinze
+   EMT.MAXACC = MaxAcc or ( EMT.FMAXPINZE / ( 60 * 0.3))  -- accelerazione massima pinze
+   EMT.MINACC = MinAcc or ( EMT.FMAXPINZE / ( 60 * 4))    -- accelerazione minima pinze
 
    -- utensili default
    EMT.PREVTCPOS_H1 = DefTcPos1
@@ -129,6 +129,11 @@ function OnToolData()
       local sOut = 'L1='..EgtNumToString( EMT.SMAX, 0)..' L2='..EmtLenToString( EMT.TDIST or ChSawLen, 1)
       sOut = sOut .. EgtIf( EMT.TCPOS == 'T111', ' G76H9998.2N411N414', ' G76H9998.2N511N514')
       EmtOutput( '('..sOut..')')
+   -- emissione dati aggregato BlockHaus
+   elseif EMT.HEAD == 'H17' then
+      sPos = EgtIf( #EMT.TCPOS == 2, EMT.TCPOS:gsub( 'T', 'N30'), EMT.TCPOS:gsub( 'T', 'N3'))
+      local sOut = 'L1='..EgtNumToString( EMT.SMAX, 0)..' L2='..EmtLenToString( ( AngTrBHOffs), 1)..' G76H9998.2'..sPos..sPos
+      EmtOutput( '('..sOut..')')
    -- emissione dati utensile (esclusa sega a catena)
    else
       -- output info
@@ -142,7 +147,6 @@ function OnToolData()
       if EMT.TCPOS == 'T201' then
          sPos = 'N411'
       else
-
          sPos = EgtIf( #EMT.TCPOS == 2, EMT.TCPOS:gsub( 'T', 'N30'), EMT.TCPOS:gsub( 'T', 'N3'))
       end
       local sOut = 'L1='..EgtNumToString( EMT.SMAX, 0)..' L2='..EmtLenToString( dAddLen + EMT.TTOTLEN, 1)..' G76H9998.2'..sPos..sPos
@@ -310,8 +314,12 @@ function OnDispositionEnd()
    else
       if #EMT.MDCHAR > 0 then
          MyOutputNoNum( '(PART UNLOAD)')
+         -- movimento intermedio di apertura pinza-rulli per evitare di trovare delle collisioni
+         EmitParkRoller( EMT.TPOS, false, false)
          for i = 1, #EMT.MDCHAR do
             EmitMoveDataChars( EMT.MDCHAR[i])
+            if EMT.MDCHAR[i].V1 then EMT.V1POS = EMT.MDCHAR[i].V1 end
+            if EMT.MDCHAR[i].V2 then EMT.V2POS = EMT.MDCHAR[i].V2 end
          end
          EmitMoveStartChars( 2)
          -- se dopo c'è scarico spezzone devo mettere attesa termine esecuzione
@@ -327,7 +335,8 @@ function OnDispositionEnd()
          end
       elseif EMT.SPECUNLOADING then
          EmtOutput( '(PART SPEC UNLOADING)')
-         EmitBeamHeadData( { T=EMT.L1, Pz5=2})
+         local dAbsHeadPos = EMT.L1pp or EMT.L1
+         EmitBeamHeadData( { T=dAbsHeadPos, Pz5=2})
          EMT.SPECUNLOADING = nil
          EMT.W2DELTA = nil
          -- emissione conclusione pezzo precedente
@@ -608,6 +617,7 @@ function OnMachiningEnd()
    EMT.PREVTOOL = EMT.TOOL
    EMT.PREVHEAD = EMT.HEAD
    EMT.PREVTCPOS = EMT.TCPOS
+
    -- se taglio finale, aggiorno lunghezza barra
    if EMT.MCHCUT then
       EMT.LB = EMT.LT + ( EMT.X_OFF or 0)
@@ -672,9 +682,9 @@ function OnPathStart()
    if EMT.TOOL == EMT.PREVTOOL and not EMT.ZMAX then
       EMT.L1pp = EMT.L1op
       EMT.L2pp = EMT.L2op
-      EMT.L3pp = EMT.L3op
-      EMT.R1pp = EMT.R1p
-      EMT.R2pp = EMT.R2p
+      EMT.L3pp = EMT.L3op or EMT.L3pp
+      EMT.R1pp = EMT.R1p or EMT.R1pp
+      EMT.R2pp = EMT.R2p or EMT.R2pp
    else
       EMT.L1pp = nil
       EMT.L2pp = nil
@@ -901,7 +911,16 @@ function OnRapid()
                if EMT.HEAD == 'H12' and abs( PrevR1 - EMT.R1) > 1 and ( abs( HomeC1 - EMT.R1) > 30.1 or abs( HomeB1 - EMT.R2) > 30.1) then
                   EmitMoveDataHead( 1, { B=0, S=Speed})
                   EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
-                  EmitMoveDataHead( 1, { Z=dZref, B=EMT.R2, S=Speed})
+                  -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                  -- evita collisione con carro X
+                  if EMT.R2 > 91 or EMT.R2 < -91 then
+                     local dBref = EgtClamp( EMT.R2, -91, 91)
+                     EmitMoveDataHead( 1, { Z=dZref, B=dBref, S=Speed})
+                     EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
+                  else
+                     EmitMoveDataHead( 1, { Z=dZref, B=EMT.R2, S=Speed})
+                  end
+
                   if bMoveZbeforeX then
                      EmitMoveDataHead( 1, { Z=EMT.L3, S=Speed})
                   end
@@ -962,7 +981,7 @@ function OnRapid()
                local dTRad, dTLen = GetToolRadLen()
                -- se fresa o lama
                if not HeadIsChainSaw( EMT.HEAD) then
-                  EmitMoveDataHead( 1, { X=-ParkX2, Z=MyMaxZ1, B=HomeB1, C=HomeC1, TRad=dTRad, TLen=dTLen, S=Speed})
+                  EmitMoveDataHead( 1, { X=-ParkFrnX1, Z=MyMaxZ1, B=HomeB1, C=HomeC1, TRad=dTRad, TLen=dTLen, S=Speed})
                   EmitMoveStartHead( 1)
                   EmitMoveWaitHead( 1)
                   EmitMoveWaitChars( EgtIf( bOnlyCharY, 1, 3))
@@ -985,7 +1004,15 @@ function OnRapid()
                   if EMT.HEAD == 'H12' and abs( PrevR1 - EMT.R1) > 1 and ( abs( HomeC1 - EMT.R1) > 30.1 or abs( HomeB1 - EMT.R2) > 30.1) then
                      EmitMoveDataHead( 1, { B=0, S=Speed})
                      EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
-                     EmitMoveDataHead( 1, { Z=dZref, B=EMT.R2, S=Speed})
+                     -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                     -- evita collisione con carro X
+                     if EMT.R2 > 91 or EMT.R2 < -91 then
+                        local dBref = EgtClamp( EMT.R2, -91, 91)
+                        EmitMoveDataHead( 1, { Z=dZref, B=dBref, S=Speed})
+                        EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
+                     else
+                        EmitMoveDataHead( 1, { Z=dZref, B=EMT.R2, S=Speed})
+                     end
                      if bMoveZbeforeX then
                         EmitMoveDataHead( 1, { Z=EMT.L3, S=Speed})
                      end
@@ -1055,7 +1082,15 @@ function OnRapid()
                      if EMT.HEAD == 'H22' then
                         EmitMoveDataHead( 2, { B=0, S=Speed})
                         EmitMoveDataHead( 2, { C=EMT.R1, S=Speed})
-                        EmitMoveDataHead( 2, { Z=dZref, B=EMT.R2, S=Speed})
+                        -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                        -- evita collisione con carro X
+                        if EMT.R2 > 91 or EMT.R2 < -91 then
+                           local dBref = EgtClamp( EMT.R2, -91, 91)
+                           EmitMoveDataHead( 2, { Z=dZref, B=dBref, S=Speed})
+                           EmitMoveDataHead( 2, { B=EMT.R2, S=Speed})
+                        else
+                           EmitMoveDataHead( 2, { Z=dZref, B=EMT.R2, S=Speed})
+                        end
                         if bMoveZbeforeX then
                            EmitMoveDataHead( 2, { Z=EMT.L3, S=Speed})
                         end
@@ -1141,7 +1176,7 @@ function OnRapid()
       else
          --EmtOutput( string.format( 'V1Pos=%.3f V2Pos=%.3f', EMT.V1POS, EMT.V2POS))
          local bToPresel = true
-         if not EMT.RELOAD and not EMT.ZMAX and #EMT.AUXCMD > 0 and EMT.TO_ZMAX then
+         if not EMT.ZMAX and #EMT.AUXCMD > 0 and EMT.TO_ZMAX then
             -- allontanamento o eventuale preselezione successiva testa differente
             if not EMT.DOU_TYPE then
                PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
@@ -1275,7 +1310,15 @@ function OnRapid()
                   if EMT.HEAD == 'H12' and abs( PrevR1 - EMT.R1) > 1 and ( abs( HomeC1 - EMT.R1) > 30.1 or abs( HomeB1 - EMT.R2) > 30.1) then
                      EmitMoveDataHead( 1, { B=0, S=Speed})
                      EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
-                     EmitMoveDataHead( 1, { Z=dZref, B=EMT.R2, S=Speed})
+                     -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                     -- evita collisione con carro X
+                     if EMT.R2 > 91 or EMT.R2 < -91 then
+                        local dBref = EgtClamp( EMT.R2, -91, 91)
+                        EmitMoveDataHead( 1, { Z=dZref, B=dBref, S=Speed})
+                        EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
+                     else
+                        EmitMoveDataHead( 1, { Z=dZref, B=EMT.R2, S=Speed})
+                     end
                      if bMoveZbeforeX then
                         EmitMoveDataHead( 1, { Z=EMT.L3, S=Speed})
                      end
@@ -1364,7 +1407,15 @@ function OnRapid()
                      if EMT.HEAD == 'H12' and abs( PrevR1 - EMT.R1) > 1 and ( abs( HomeC1 - EMT.R1) > 30.1 or abs( HomeB1 - EMT.R2) > 30.1) then
                         EmitMoveDataHead( 1, { B=0, S=Speed})
                         EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
-                        EmitMoveDataHead( 1, { Z=dZref, B=EMT.R2, S=Speed})
+                        -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                        -- evita collisione con carro X
+                        if EMT.R2 > 91 or EMT.R2 < -91 then
+                           local dBref = EgtClamp( EMT.R2, -91, 91)
+                           EmitMoveDataHead( 1, { Z=dZref, B=dBref, S=Speed})
+                           EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
+                        else
+                           EmitMoveDataHead( 1, { Z=dZref, B=EMT.R2, S=Speed})
+                        end
                         if bMoveZbeforeX then
                            EmitMoveDataHead( 1, { Z=EMT.L3, S=Speed})
                         end
@@ -1429,7 +1480,15 @@ function OnRapid()
                         if EMT.HEAD == 'H22' then
                            EmitMoveDataHead( 2, { B=0, S=Speed})
                            EmitMoveDataHead( 2, { C=EMT.R1, S=Speed})
-                           EmitMoveDataHead( 2, { Z=dZref, B=EMT.R2, S=Speed})
+                           -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                           -- evita collisione con carro X
+                           if EMT.R2 > 91 or EMT.R2 < -91 then
+                              local dBref = EgtClamp( EMT.R2, -91, 91)
+                              EmitMoveDataHead( 2, { Z=dZref, B=dBref, S=Speed})
+                              EmitMoveDataHead( 2, { B=EMT.R2, S=Speed})
+                           else
+                              EmitMoveDataHead( 2, { Z=dZref, B=EMT.R2, S=Speed})
+                           end
                            if bMoveZbeforeX then
                               EmitMoveDataHead( 2, { Z=EMT.L3, S=Speed})
                            end
@@ -1517,6 +1576,7 @@ function OnRapid()
       end
       EMT.REFLOC = 0
       EMT.MCHFIRST = false
+      EMT.PLANEACTIVE = true
       EMT.ZMAX = false
    -- se standard
    elseif EMT.FLAG == 0 or EMT.FLAG == 1 or EMT.FLAG == 2 then
@@ -1546,6 +1606,7 @@ function OnRapid()
             EmtOutput( 'M175')
          end
          EMT.MCHFIRST = false
+         EMT.PLANEACTIVE = true
       end
       -- se necessario, impostazione riferimento locale
       if EMT.REFLOC == 0 then
@@ -1602,7 +1663,7 @@ function OnRapid()
       MyAdjustLinearAxes()
       EmtAdjustRotaryAxes()
       -- se Split o Presplit lascio agganciata solo la pinza Y2 alla fine dei movimenti
-      local sNextTool = GetNextTool( EMT.MCHID)
+      local sNextTool = GetNextTool( EMT.MCHID, true)
       -- vado in home se è ultimo movimento ed è ultima lavorazione, se sono con motosega e devo cambiare utensile, oppure se ho la lama
       local bToXhome = ( IsLastPath( EMT.PATHID) and not sNextTool) or ( EMT.HEAD == 'H23' and EMT.TOOL ~= sNextTool) or ( EMT.HEAD == 'H13' and EMT.TOOL ~= sNextTool) or 
                        ( EMT.HEAD == 'H12' and EMT.TOOL ~= sNextTool ) or ( EMT.HEAD == 'H22' and EMT.TOOL ~= sNextTool) or EMT.MCHSPLIT
@@ -1613,6 +1674,7 @@ function OnRapid()
       -- aggiorno quota finale trave dopo Zmax
       EMT.L1o = EMT.TPOS
       EMT.ZMAX = true
+      ToolPreSelectionSingleHead( EMT.MCHID)
    -- se altrimenti movimento in Home
    elseif EMT.FLAG == 4 then
       -- non previsto
@@ -1650,6 +1712,7 @@ function OnLinear()
       EMT.L3p = nil
       local sDouFlag = EgtIf( EMT.DOU_TYPE, ' EE1', '')
       EmtOutput( 'G142'..EmtGetAxis('L1')..EmtGetAxis('L2')..EmtGetAxis('L3')..EMT.IPLGLSTR..EgtIf( nHSet~=2, ' EU1', ' EU2')..sDouFlag..' EF'..GetFmaxClamp())
+      EMT.PLANEACTIVE = true
       -- emissione movimento
       local sOut = 'G0'..EmtGetAxis('L1')..EmtGetAxis('L2')..EmtGetAxis('L3')..
                    EmtGetAxis('R2')..EmtGetAxis('R1')
@@ -1733,6 +1796,7 @@ function OnArc()
       EMT.L3p = nil
       local sDouFlag = EgtIf( EMT.DOU_TYPE, ' EE1', '')
       EmtOutput( 'G142'..EmtGetAxis('L1')..EmtGetAxis('L2')..EmtGetAxis('L3')..EMT.IPLGLSTR..EgtIf( nHSet~=2, ' EU1', ' EU2')..sDouFlag..' EF'..GetFmaxClamp())
+      EMT.PLANEACTIVE = true
       -- emissione movimento
       local sOut = 'G0'..EmtGetAxis('L1')..EmtGetAxis('L2')..EmtGetAxis('L3')..
                    EmtGetAxis('R2')..EmtGetAxis('R1')
@@ -1780,28 +1844,6 @@ function OnArc()
    EmtUpdatePrev()
 end
 
----------------------------------------------------------------------
-function CalcDinamicaPinze( dH, dS, dL)
-   local MinTempoAcc = 0.3                         -- [s]
-   local MaxTempoAcc = 4.0                         -- [s]
-   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
-   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
-   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
-   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
-   local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
-   if ( TempoAcc < MinTempoAcc) then TempoAcc = MinTempoAcc end
-   if ( TempoAcc > MaxTempoAcc) then TempoAcc = MaxTempoAcc end
-   local AccMaxPinze = EMT.MAXACC or FMaxPinze / ( 60 * MinTempoAcc)
-   local AccPinze = FMaxPinze / ( 60 * TempoAcc)
-   local RidFeed = 100 / Massa * 100
-   if RidFeed > 100 then
-      RidFeed = 100
-   elseif RidFeed < 10 then
-      RidFeed = 10
-   end
-   return AccPinze, AccMaxPinze, RidFeed
-end
-
 ---------------------------------------------------------------------
 function CalcCharStatusN( sCmd)
    -- aperto
@@ -2280,7 +2322,7 @@ function PreparePreRotation( sCmd, nInd)
             MDChar = { [Cmd[2]]=tonumber(Cmd[3]), IniStatY1=86, FinStatY1=87, BeamVise=0}
          elseif EMT.SPECSPLIT or EMT.SPLITROT then
             MDChar = { [Cmd[2]]=tonumber(Cmd[3]), V1=ParkV1, IniStatY1=EMT.ISY1, FinStatY1=EMT.FSY1, IniStatY2=EMT.ISY2, FinStatY2=EMT.FSY2, IniStatV1=3, BeamVise=EMT.BV}
-            EMT.V1POS = MDChar.V1
+            EMT.V1NEXTPOS = MDChar.V1
          else
             MDChar = { [Cmd[2]]=tonumber(Cmd[3]), IniStatY1=EMT.ISY1, FinStatY1=EMT.FSY1, IniStatY2=EMT.ISY2, FinStatY2=EMT.FSY2, BeamVise=EMT.BV}
          end
@@ -2418,6 +2460,9 @@ end
 
 ---------------------------------------------------------------------
 function GetV1ToCloseNum( UseCurrV1)
+   if EMT.MCHPRECUT or EMT.MCHCUT then
+      return false
+   end
    --EmtOutput( string.format( 'L1m=%.3f L1M=%.3f', EMT.MAXMIN[1], EMT.MAXMAX[1]))
    --EmtOutput( string.format( 'LB=%.3f LT=%.3f', EMT.LB, EMT.LT))
    local dV1Pos
@@ -2510,10 +2555,15 @@ function MyAdjustLinearAxes()
          local Len = ( EMT.TDIST or ChSawLen) + Mill2Offs
          local LenRef = Mill2Offs
          vtE = Vector3d( EMT.ADIR) * Len - Z_AX() * LenRef
+      elseif EMT.HEAD == 'H17' 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 defined ' .. ( EMT.HEAD or ''))
       end
-      if EMT.HEAD == 'H11' or EMT.HEAD == 'H12' or EMT.HEAD == 'H13' or EMT.HEAD == 'H15' then
+      if EMT.HEAD == 'H11' or EMT.HEAD == 'H12' or EMT.HEAD == 'H13' or EMT.HEAD == 'H15' or sHead == 'H17' then
          EMT.L1 = EMT.L1 - vtE:getX()
          EMT.L2 = EMT.L2 - DeltaTabY - vtE:getY()
          EMT.L3 = EMT.L3 - DeltaTabZ - vtE:getZ()
@@ -2626,6 +2676,9 @@ function GetToolRadLen()
    -- se sega a catena
    elseif HeadIsChainSaw( EMT.HEAD) then
       return EMT.TLEN, ( EMT.TDIST or ChSawLen)
+   -- se aggregato BlockHaus
+   elseif EMT.HEAD == 'H17' then
+      return EMT.TDIAM / 2, AngTrBHOffs
    end
 end
 
@@ -2647,7 +2700,7 @@ function CalcInterpPlane()
    local _, dAngV, dAngO = SphericalFromVector( vtE)
    local dAngO2 = EmtGetAngO2( EMT.IPLGLFR:getVersZ(), EMT.IPLGLFR:getVersX(), dAngV, dAngO)
    dAngO = dAngO + 90
-   while dAngO >= 360 do
+   while dAngO + 100 * GEO.EPS_SMALL > 360 do
       dAngO = dAngO - 360
    end   
    EMT.IPLGLSTR = ' EX0 EY'..EmtLenToString( xS)..' EZ0'..
@@ -2799,9 +2852,7 @@ function EmitZmax( bReset, bEnd, bXhome, PrevR1, PrevR2, bSplitCut, bUsePrevDelt
                local MovH = { Z = EgtIf( dZref > EMT.L3o, dZref, EMT.L3o)}
                MovH.X = -dXPos ; MovH.B = EgtClamp( PrevR2, -90, 90) ; MovH.C = PrevR1 ;
                EmitMoveDataHead( 1, MovH)
-               if EMT.HEAD == 'H12' and ( abs( dSafeC1 - PrevR1) > 30.1 or abs( dSafeB1 - PrevR2) > 30.1) or not( bProgress) then
-                  EmitMoveDataHead( 1, { Z=dMaxZ1, B=0})
-               end
+               EmitMoveDataHead( 1, { Z=dMaxZ1, B=0})
                EmitMoveDataHead( 1, { C=dSafeC1})
                EmitMoveDataHead( 1, { B=dSafeB1})
                EmitMoveDataHead( 1, { Z=dMaxZ1})
@@ -2821,6 +2872,24 @@ function EmitZmax( bReset, bEnd, bXhome, PrevR1, PrevR2, bSplitCut, bUsePrevDelt
             -- ribadisco movimento perchè in G141 si aspetta sempre tutti i valori
             local MovH = { X = -dXPos, Z = EMT.L3o, B = PrevR2, C = PrevR1}
             EmitMoveDataHead( 1, MovH)
+            -- controlla che l'ingombro della sega a catena non possa collidere durante il suo riposizionamento
+            local dChSawEncumbrance = sqrt( pow( EMT.TTOTLEN, 2) + pow( ChSawLen + MillOffs, 2))
+            if EMT.ADIR and EMT.TDIR then
+               -- direzione versore sega a catena X- (copre anche eventuali inclinazioni in Y)
+               if EMT.TDIR[1] <= 0 then
+                  -- ingombro massimo di quota Z (senza pivot) + ingombro massimo sega + altezza pezzo + altezza sicurezza
+                  local dEncumbranceTot = EMT.L3o + MillOffs - dChSawEncumbrance - EMT.SB - 30
+                  -- nuova quota Z intermedia
+                  local dZUp = EMT.L3o + ( DeltaTabZ - dEncumbranceTot)
+                  -- se la nuova quota è minore della quota di parcheggio
+                  if dZUp <= ParkCSawZ1 then
+                     -- se B è oltre il punto di massimo ingombro (con l'inclinazione attuale non ha il massimo ingombro)
+                     if asin( EMT.TDIR[3] / 1) > asin( EgtTdbGetCurrToolParam( MCH_TP.TOTLEN) / dChSawEncumbrance) and ( dEncumbranceTot < DeltaTabZ) then
+                        EmitMoveDataHead( 1, { Z=dZUp})
+                     end
+                  end
+               end
+            end
             EmitMoveDataHead( 1, { Z=dSafeZ1, B=dSafeB1})
             if EMT.R3 and abs( EMT.R3) < 0.1 then
                EmitMoveDataHead( 1, { Z=ParkCSawZ1})
@@ -2878,6 +2947,24 @@ function EmitZmax( bReset, bEnd, bXhome, PrevR1, PrevR2, bSplitCut, bUsePrevDelt
          -- ribadisco movimento perchè in G141 si aspetta sempre tutti i valori
          local MovH = { X = -dXPos, Z = EMT.L3o, B = PrevR2, C = PrevR1}
          EmitMoveDataHead( 2, MovH)
+         -- controlla che l'ingombro della sega a catena non possa collidere durante il suo riposizionamento
+         local dChSawEncumbrance = sqrt( pow( EMT.TTOTLEN, 2) + pow( ChSawLen + Mill2Offs, 2))
+            if EMT.ADIR and EMT.TDIR then
+               -- direzione versore sega a catena X- (copre anche eventuali inclinazioni in Y)
+               if EMT.TDIR[1] <= 0 then
+                  -- ingombro massimo di quota Z (senza pivot) + ingombro massimo sega + altezza pezzo + altezza sicurezza
+                  local dEncumbranceTot = EMT.L3o + Mill2Offs - dChSawEncumbrance - EMT.SB - 30
+                  -- nuova quota Z intermedia
+                  local dZUp = EMT.L3o + ( DeltaTabZ - dEncumbranceTot)
+                  -- se la nuova quota è minore della quota di parcheggio
+                  if dZUp <= ParkCSawZ2 then
+                     -- se B è oltre il punto di massimo ingombro (con l'inclinazione attuale non ha il massimo ingombro)
+                     if asin( EMT.TDIR[3] / 1) > asin( EgtTdbGetCurrToolParam( MCH_TP.TOTLEN) / dChSawEncumbrance) and ( dEncumbranceTot < DeltaTabZ) then
+                        EmitMoveDataHead( 2, { Z=dZUp})
+                     end
+                  end
+               end
+            end
          EmitMoveDataHead( 2, { Z=dSafeZ2, B=dSafeB2})
          if EMT.R3 and abs( EMT.R3) < 0.1 then
             EmitMoveDataHead( 2, { Z=ParkCSawZ2})
@@ -2952,14 +3039,19 @@ end
 
 ---------------------------------------------------------------------
 function EmitResetMachining()
-   if ( EMT.TOOL ~= GetNextTool( EMT.MCHID) and IsLastPath( EMT.PATHID)) or GetSpecUnloading( EMT.PATHID) or GetFall( EMT.PATHID) then
-      -- se da MLDE parametro non settato, o settato a true, scrivo il comando arresto mandrino
-      if WriteM05Command == nil or WriteM05Command then
+   if EMT.PLANEACTIVE then
+      -- se non sono a Z massima e operatore deve entrare in cabina spango sempre
+      if not EMT.ZMAX and ( GetSpecUnloading( EMT.PATHID) or GetFall( EMT.PATHID)) then
+         EmtOutput( 'M05')
+      -- altrimenti spegnimento dipende da parametro
+      elseif ( EMT.TOOL ~= GetNextTool( EMT.MCHID, false) and IsLastPath( EMT.PATHID)) or GetSpecUnloading( EMT.PATHID) or GetFall( EMT.PATHID) then
          EmtOutput( 'M05')
       end
+      local sOut = 'G157 EA1'
+      EmtOutput( sOut)
+      -- piano non più attivo
+      EMT.PLANEACTIVE = false
    end
-   local sOut = 'G157 EA1'
-   EmtOutput( sOut)
 end
 
 ---------------------------------------------------------------------
@@ -3064,6 +3156,57 @@ function EmitParkRoller( dPosT, bSplitCut, bUsePrevDelta)
    EMT.TPOS = dPosT
 end
 
+---------------------------------------------------------------------
+-- Se la lavorazione segue una disposizione ha un utensile diverso da quello attuale lo cambia durante la disposizione
+function ToolPreSelectionSingleHead( nMchId)
+   -- Se non sono nell'ultima lavorazione della fase o se è una macchina a doppia testa ritorna senza fare nulla
+   local bIsPhaseEnd = ( EgtGetNextActiveOperation( nMchId) and EgtGetInfo( EgtGetNextActiveOperation( nMchId), 'TYPE') == 'END')
+   if not bIsPhaseEnd or EgtGetHeadId( 'H21') then
+      return
+   end
+   -- nome utensile
+   local sToolChange
+   local sToolChangePos
+   local sToolChangeHead
+   -- recupero lavorazione successiva e se contiene un utensile diverso salva utensile e posizione utensile
+   local nNextMchId = EgtGetNextActiveOperation( nMchId)
+   while nNextMchId do
+      if EgtGetOperationType( nNextMchId) ~= MCH_OY.DISP then
+         if EgtSetCurrMachining( nNextMchId) then
+            local sNextTool = EgtGetMachiningParam( MCH_MP.TOOL)
+            if EgtTdbSetCurrTool( sNextTool) then
+               if EMT.TOOL ~= sNextTool then
+                  local sNextHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+                  if not HeadIsChainSaw( sNextHead) then
+                     sToolChange = sNextTool
+                     sToolChangePos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+                     sToolChangeHead = sNextHead
+                  end
+               end
+               break
+            end
+         end
+      end
+      nNextMchId = EgtGetNextActiveOperation( nNextMchId)
+   end
+   -- ripristino stato corrente
+   EgtSetCurrMachining( EMT.MCHID)
+   EgtTdbSetCurrTool( EMT.TOOL)
+   -- controlla se l'operazione successiva e quella ancora dopo esistono e sono disposizioni
+   local bNextOpIsDisp = ( EgtGetNextActiveOperation( nMchId)
+                     and ( EgtGetOperationType( EgtGetNextActiveOperation( nMchId)) == MCH_OY.DISP) 
+                     and ( EgtGetNextActiveOperation( EgtGetNextActiveOperation( nMchId)))
+                     and ( EgtGetOperationType( EgtGetNextActiveOperation( EgtGetNextActiveOperation( nMchId))) == MCH_OY.DISP))
+   -- emetto preselezione utensile
+   if bIsPhaseEnd and bNextOpIsDisp then
+      if ( EMT.TOOL and sToolChangePos and sToolChange and sToolChangeHead) and EMT.TOOL ~= sToolChangePos and not HeadIsChainSaw( sToolChangeHead) then
+         local MyParkX1 = EgtIf( GetHeadTCSet( sToolChangeHead, sToolChangePos) == 'Head1_TC2', ParkFrnX1, ParkX1)
+         EmitMoveDataHead( 1, { X=-MyParkX1, Z=MaxZ1, B=ParkB1, C=ParkC1, TPos=AdjustTcPos( false, sToolChangePos)})
+         EmitMoveStartHead( 1)
+      end
+   end
+end
+
 ---------------------------------------------------------------------
 function PreselectNextDiffHead( nMchId, sHead)
    -- se non ho due teste, esco subito
@@ -3110,7 +3253,7 @@ function PreselectNextDiffHead( nMchId, sHead)
                EmitMoveStartHead( 1)
                EmitMoveWaitHead( 1)
             end
-            -- Emetto preselezione (non ammessa per sega a catena H13 e H23)
+            -- Emetto preselezione (non ammessa per sega a catena H13 e H23 e aggregato BlockHaus H17)
             if sNextHead == 'H11' then
                EmitMoveDataHead( 1, { X=-ParkX1, Z=MaxZ1, B=ParkB1, C=ParkC1, TPos=AdjustTcPos( false, sNextTcPos)})
                EmitMoveStartHead( 1)
@@ -3189,7 +3332,7 @@ function EmitTestProgramStart()
    EmtOutput( 'M12 $START PER SVINCOLO TESTE')
    EmtOutput( '(SVINCOLO TESTA 1)')
    EmitMoveDataHead( 1, {Z=ParkZ1-100, TPos=0})
-   if Progress then
+   if Progress or SecondToolChanger then
       EmtOutput( 'IF E80001<=10 THEN')
       EmitMoveDataHead( 1, {C=ParkC1, TPos=0})
       EmitMoveDataHead( 1, {Z=-150, B=ParkB1, TPos=0})

Common_ONE-PF.mlpe

@@ -79,6 +79,14 @@ function OnSimulStart()
          if vTools and vTools[1] and #(vTools[1]) > 0 then
             EgtLoadTool( vTcPos[i], 1, vTools[1])
             ShowToolInTcPos( vTcPos[i], true)
+            -- Aggiunto controllo lunghezza lama minima * 0.9 per ricavare la tolleranza del VMILL
+            if EgtTdbSetCurrTool(vTools[1]) 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
    end
@@ -129,7 +137,7 @@ function OnSimulStart()
    end
 
    -- gruppo CHSAW si attiva solo se progress, one con BIT mortiser o PF
-   if Progress or Mortiser or EgtGetHeadId( 'H21') then
+   if Progress or Mortiser or EgtGetHeadId( 'H21') or SecondToolChanger then
       table.insert( McdData, { Grp = 'Base', Sub = 'COLLISION', Name = 'CHSAW'})
    end
    -- gruppo MORTISER si attiva solo se PF con BIT mortiser attivo
@@ -237,9 +245,9 @@ function OnSimulDispositionStart()
                end
             end
             -- determino la risoluzione dello Zmap
-            local dTol = 4.00
+            local dTol = 4.71
             if EmtGetVMillStep then
-               dTol = EmtGetVMillStep( b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), 4.00)
+               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
@@ -256,6 +264,7 @@ function OnSimulDispositionStart()
                   dTol = 3.77
                end
             end
+            dTol = min( dTol, EMT.VMILLTOL or dTol) -- imposto dTol al valore minore tra quello per volume e quello per spessore lama
             -- creo lo Zmap
             local VMillId = EgtVolZmapBox( nPartRawId, b3Raw:getMin(), b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), dTol, true, GDB_RT.GLOB)
             if VMillId then
@@ -472,6 +481,7 @@ function OnSimulDispositionEnd()
       EMT.UNLOADING = false
       EMT.FALL = false
       EMT.TO_FALL = false
+      EMT.Y2DELTA = nil
    end
    -- se disposizione intermedia
    if IsMidPhase( EMT.PHASE) or IsEnd2Phase( EMT.PHASE) then
@@ -513,10 +523,8 @@ function OnSimulToolSelect( dPosA)
    end
    -- se sega a catena, imposto subito angolo scelto per asse virtuale A
    if HeadIsChainSaw( EMT.HEAD) then
-      -- se non Progress, apro le paratie
-      if not Progress then
-         ExecParkRoller( nil, nil, nil, nil, false, IsStartPhase( EMT.PHASE))
-      end
+      -- apro le paratie
+      ExecParkRoller( nil, nil, nil, nil, false, IsStartPhase( EMT.PHASE))
       -- valore dell'asse virtuale
       dPosA = dPosA or GetNextChainSawingVirtualAxis( EMT.MCHID)
       -- imposto il valore di A
@@ -648,7 +656,7 @@ function OnSimulToolDeselect( dPrevA)
                SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
                SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
             -- deposito utensile lama
-            elseif EMT.PREVHEAD_H1 == 'H12' then
+            elseif EMT.PREVHEAD_H1 == 'H12' or EMT.PREVHEAD_H1 == 'H17' then
                -- simulo movimento
                SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
                SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
@@ -716,12 +724,12 @@ function OnSimulToolDeselect( dPrevA)
       -- nascondo l'utensile sulla testa
       EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H1 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
       -- prendo utensile fresa o lama
-      if EMT.NEXTHEAD == 'H11' or EMT.NEXTHEAD == 'H12' then
+      if EMT.NEXTHEAD == 'H11' or EMT.NEXTHEAD == 'H12' or EMT.NEXTHEAD == 'H17' then
          local MyParkX1 = EgtIf( GetHeadTCSet( EMT.NEXTHEAD, EMT.NEXTTCPOS) == 'Head1_TC1', ParkX1, ParkFrnX1)
          local MyParkB1 = ParkB1
          local MyParkC1 = ParkC1
          -- se ho due teste oppure è progress, significa che ho CU verticale
-         if EgtGetHeadId('H21') or bProgress then
+         if EgtGetHeadId('H21') or Progress or SecondToolChanger then
             MyParkB1 = EgtIf( GetHeadTCSet( EMT.NEXTHEAD, EMT.NEXTTCPOS) == 'Head1_TC1', ParkB1, ParkFrnB1)
             MyParkC1 = EgtIf( GetHeadTCSet( EMT.NEXTHEAD, EMT.NEXTTCPOS) == 'Head1_TC1', ParkC1, ParkFrnC1)
          -- altrimenti su one CU speciale motosega-utensile lungo
@@ -772,6 +780,7 @@ function OnSimulMachiningStart()
    EMT.VMRS = ( EMT.MCHTYPE ~= MCH_MY.DRILLING and not EMT.MCHUSERNOTES:find( 'VMRS=0;', 1, true))
    EMT.MCHSPLIT = ( EMT.MCHUSERNOTES:find( 'Split;', 1, true) ~= nil)
    EMT.MCHPRECUT = ( EMT.MCHUSERNOTES:find( 'Precut;', 1, true) ~= nil)
+   EMT.MCHCUT = ( EMT.MCHUSERNOTES:find( 'Cut;', 1, true) ~= nil)
    -- recupero TASKID della feature lavorata
    local vId = EgtGetMachiningGeometry()
    if vId and #vId > 0 and #vId[1] > 0 then
@@ -965,7 +974,12 @@ function OnSimulMoveStart()
    -- pinza 5
    if EMT.W2DELTA then
       EMT.A5n = 'W'
-      EMT.A5m = 'T'
+      local dPosQW = EgtGetAxisPos( 'QW') or 0
+      if dPosQW < 1 then
+         EMT.A5m = nil
+      else
+         EMT.A5m = 'T'
+      end
       EMT.A5 = EMT.L1 + EMT.W2DELTA - EMT.A4
       VerifyWStroke( EMT.A5)
    end
@@ -1037,7 +1051,15 @@ function OnSimulMoveStart()
                if EMT.HEAD == 'H12' and abs( C1Pos - EMT.R1) > 1 and ( abs( C1Home - EMT.R1) > 30.1 or abs(B1Home - EMT.R2) > 30.1) then
                   SimulMoveAxis( 'B1', 0, MCH_SIM_STEP.COLLROT)
                   SimulMoveAxis( 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
-                  SimulMoveAxes( 'Z1', dZref, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                  -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                  -- evita collisione con carro X
+                  if EMT.R2 > 91 or EMT.R2 < -91 then
+                     local dBref = EgtClamp( EMT.R2, -91, 91)
+                     SimulMoveAxes( 'Z1', dZref, MCH_SIM_STEP.RAPID, 'B1', dBref, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxis( 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                  else
+                     SimulMoveAxes( 'Z1', dZref, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                  end
                   if bMoveZbeforeX then
                      SimulMoveAxis( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID)
                   end
@@ -1053,9 +1075,9 @@ function OnSimulMoveStart()
             end
          -- altrimenti sega a catena
          else
+            local dPosA = GetCurrChainSawingVirtualAxis()
             -- se anche precedente con sega a catena ma depositata, devo riprenderla
             if EMT.CHSAW_OUT then
-               local dPosA = GetCurrChainSawingVirtualAxis()
                EgtSetMode( EgtGetHeadId( EMT.HEAD), GDB_MD.HIDDEN)
                OnSimulToolDeselect()
                EgtLoadTool( EMT.HEAD, 1, EMT.TOOL)
@@ -1084,13 +1106,13 @@ function OnSimulMoveStart()
       else
          if GetHeadTCSet( EMT.HEAD, EMT.TCPOS) == 'Head1_TC2' then
             -- se movimento iniziale da Zmax con lama o fresa
-            if EMT.HEAD == 'H11' or EMT.HEAD == 'H12' then
+            if EMT.HEAD == 'H11' or EMT.HEAD == 'H12' or EMT.HEAD == 'H17' then
                if EMT.ZMAX or EMT.FLAG == 1 or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                   --EgtOutBox( 'Flag 2,1', 'Info Rapid')
                   local bMoveZbeforeX = false
 
                   local dZref = EMT.L3
-                  if EMT.HEAD == 'H12' and ( -EMT.L2 < -LimX1RotSaw or EMT.R2 > 91) then
+                  if EMT.HEAD == 'H12' and ( EgtIf( BD.RIGHT_LOAD, -EMT.L2 < -LimX1RotSaw, -EMT.L2 > -LimX1RotSaw) or EMT.R2 > 91) then
                      dZref = Z1Home + GetZExtra( EMT.HEAD, EMT.R2) - 100
                   end
                   -- se la quota di lavoro è più in alta della posizione a ZHOME della testa, prima si va alla Z di lavoro e poi si approccia il pezzo
@@ -1106,7 +1128,15 @@ function OnSimulMoveStart()
                   if EMT.HEAD == 'H12' and abs( C1Pos - EMT.R1) > 1 and ( abs( C1Home - EMT.R1) > 30.1 or abs(B1Home - EMT.R2) > 30.1) then
                      SimulMoveAxis( 'B1', 0, MCH_SIM_STEP.COLLROT)
                      SimulMoveAxis( 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
-                     SimulMoveAxes( 'Z1', dZref, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                     -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                     -- evita collisione con carro X
+                     if EMT.R2 > 91 or EMT.R2 < -91 then
+                        local dBref = EgtClamp( EMT.R2, -91, 91)
+                        SimulMoveAxes( 'Z1', dZref, MCH_SIM_STEP.RAPID, 'B1', dBref, MCH_SIM_STEP.COLLROT)
+                        SimulMoveAxis( 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                     else
+                        SimulMoveAxes( 'Z1', dZref, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                     end
                      if bMoveZbeforeX then
                         SimulMoveAxis( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID)
                      end
@@ -1119,9 +1149,9 @@ function OnSimulMoveStart()
                end
             -- altrimenti sega a catena (H13 o H15)
             else
+               local dPosA = GetCurrChainSawingVirtualAxis()
                -- se anche precedente con sega a catena ma depositata, devo riprenderla
                if EMT.CHSAW_OUT then
-                  local dPosA = GetCurrChainSawingVirtualAxis()
                   EgtSetMode( EgtGetHeadId( EMT.HEAD), GDB_MD.HIDDEN)
                   OnSimulToolDeselect()
                   EgtLoadTool( EMT.HEAD, 1, EMT.TOOL)
@@ -1178,7 +1208,15 @@ function OnSimulMoveStart()
                      if EMT.HEAD == 'H22' then
                         SimulMoveAxis( 'B2', 0, MCH_SIM_STEP.COLLROT)
                         SimulMoveAxis( 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
-                        SimulMoveAxes( 'Z2', dZref, MCH_SIM_STEP.RAPID, 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
+                        -- se movimento di B > di 90°, spezza il movimento in 2 arrivando alla quota Z con B+-90 e poi muove l'ultimo segmento
+                        -- evita collisione con carro X
+                        if EMT.R2 > 91 or EMT.R2 < -91 then
+                           local dBref = EgtClamp( EMT.R2, -91, 91)
+                           SimulMoveAxes( 'Z2', dZref, MCH_SIM_STEP.RAPID, 'B2', dBref, MCH_SIM_STEP.COLLROT)
+                           SimulMoveAxis( 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
+                        else
+                           SimulMoveAxes( 'Z2', dZref, MCH_SIM_STEP.RAPID, 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
+                        end
                         if bMoveZbeforeX then
                            SimulMoveAxis( 'Z2', EMT.L3, MCH_SIM_STEP.RAPID)
                         end
@@ -1195,9 +1233,9 @@ function OnSimulMoveStart()
                end
             -- altrimenti sega a catena
             else
+               local dPosA = GetCurrChainSawingVirtualAxis()
                -- se anche precedente con sega a catena ma depositata, devo riprenderla
                if EMT.CHSAW_OUT then
-                  local dPosA = GetCurrChainSawingVirtualAxis()
                   EgtSetMode( EgtGetHeadId( EMT.HEAD), GDB_MD.HIDDEN)
                   OnSimulToolDeselect()
                   EgtLoadTool( EMT.HEAD, 1, EMT.TOOL)
@@ -1343,7 +1381,7 @@ function OnSimulMoveEnd()
       -- eventuale rimozione sfridi
       ExecRemoveScraps()
       -- se Split o Presplit lascio agganciata solo la pinza Y2 alla fine dei movimenti
-      local sNextTool = GetNextTool( EMT.MCHID)
+      local sNextTool = GetNextTool( EMT.MCHID, true)
       -- vado in home se è ultimo movimento ed è ultima lavorazione, se sono con motosega e devo cambiare utensile, oppure se ho la lama
       local bToXhome = ( IsLastPath( EMT.PATHID) and not sNextTool) or ( EMT.HEAD == 'H23' and EMT.TOOL ~= sNextTool) or ( EMT.HEAD == 'H13' and EMT.TOOL ~= sNextTool) or
                        ( EMT.HEAD == 'H12' and EMT.TOOL ~= sNextTool ) or ( EMT.HEAD == 'H22' and EMT.TOOL ~= sNextTool) or EMT.MCHSPLIT
@@ -1477,7 +1515,7 @@ function ExecAuxCmd( sCmd, bPathStart)
       ExecMoveHome( Cmd[2] == '1', EgtIf( bPathStart, false, EMT.MCHSPLIT))
    elseif Cmd[1] == '11' then
       local bClose = Cmd[2] ~= '0'
-      if bPathStart and EMT.MCHSPLIT and not EMT.FALL and GetPY2Light() then bClose = false end
+      if bPathStart and EMT.MCHSPLIT and not ( EMT.FALL or EMT.TO_FALL) and GetPY2Light() then bClose = false end
       ExecMovePY1( bClose)
    elseif Cmd[1] == '12' then
       ExecMovePY2( Cmd[2] ~= '0')
@@ -1595,7 +1633,15 @@ function ExecMoveHome( bNearV, bMchSplit)
          EMT.CHSAW_OUT = true
       end
       -- porto le teste in home
-      SimulMoveAxes( 'X1', ParkX1, MCH_SIM_STEP.RAPID, 'X2', ParkX2, MCH_SIM_STEP.RAPID)
+      if EgtGetHeadId( 'H21') then
+         SimulMoveAxes( 'X1', ParkX1, MCH_SIM_STEP.RAPID, 'X2', ParkX2, MCH_SIM_STEP.RAPID)
+      else
+         if GetHeadTCSet( EMT.HEAD, EMT.TCPOS) == 'Head1_TC1' then
+            SimulMoveAxes( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
+         else
+            SimulMoveAxes( 'X1', ParkFrnX1, MCH_SIM_STEP.RAPID)
+         end
+      end
       -- sistemo i rulli
       ExecOpenRoller( 1)
       ExecOpenRoller( 2)
@@ -1675,24 +1721,40 @@ function ExecMoveZmax( bMchSplit, btoXHome)
             SimulMoveAxes( 'X1', HomeX, MCH_SIM_STEP.RAPID, 'C1', HomeC, MCH_SIM_STEP.COLLROT)
          end
       else
-         -- se sega a catena
+         -- se fresa o lama
          if not HeadIsChainSaw( EMT.HEAD) then
             if abs( HomeC - CurrC) > 0.1 or abs( HomeB - CurrB) > 0.1 then
                local dZref = HomeZ + GetZExtra( EMT.HEAD, CurrB)
                SimulMoveAxes( 'Z1', EgtIf( dZref > CurrZ, dZref, CurrZ), MCH_SIM_STEP.RAPID, 'B1', EgtClamp( CurrB, -90, 90), MCH_SIM_STEP.COLLROT)
-               if EMT.HEAD == 'H12' and ( abs( HomeC - CurrC) > 30.1 or abs( HomeB - CurrB) > 30.1) or not( bProgress) then
-                  SimulMoveAxes( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID, 'B1', 0, MCH_SIM_STEP.COLLROT)
-               end
+               SimulMoveAxes( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID, 'B1', 0, MCH_SIM_STEP.COLLROT)
                SimulMoveAxis( 'C1', HomeC, MCH_SIM_STEP.COLLROT)
                SimulMoveAxis( 'B1', HomeB, MCH_SIM_STEP.COLLROT)
             end
             SimulMoveAxis( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID)
             if btoXHome then
                EMT.XHOME = true
-               SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
+               SimulMoveAxis( 'X1', HomeX, MCH_SIM_STEP.RAPID)
             end
          -- altrimenti sega a catena
          else
+            -- controlla che l'ingombro della sega a catena non possa collidere durante il suo riposizionamento
+            local dChSawEncumbrance = sqrt( pow( EgtTdbGetCurrToolParam( MCH_TP.TOTLEN), 2) + pow( ChSawLen + MillOffs, 2))
+            if EMT.ADIR and EMT.TDIR then
+            -- direzione versore sega a catena X- (copre anche eventuali inclinazioni in Y)
+               if EMT.TDIR[1] <= 0 then
+                  -- ingombro massimo di quota Z (senza pivot) + ingombro massimo sega + altezza pezzo + altezza sicurezza
+                  local dEncumbranceTot = EMT.L3p + MillOffs - dChSawEncumbrance - EMT.SB - 30
+                  -- nuova quota Z intermedia
+                  local dZUp = EMT.L3p + ( DeltaTabZ - dEncumbranceTot)
+                  -- se la nuova quota è minore della quota di parcheggio
+                  if dZUp <= ParkCSawZ1 then
+                     -- se B è oltre il punto di massimo ingombro (con l'inclinazione attuale non ha il massimo ingombro)
+                     if asin( EMT.TDIR[3] / 1) > asin( EgtTdbGetCurrToolParam( MCH_TP.TOTLEN) / dChSawEncumbrance) and ( dEncumbranceTot < DeltaTabZ) then
+                        SimulMoveAxis( 'Z1', dZUp, MCH_SIM_STEP.RAPID)
+                     end
+                  end
+               end
+            end
             SimulMoveAxes( 'Z1', HomeZ, MCH_SIM_STEP.RAPID, 'B1', HomeB, MCH_SIM_STEP.COLLROT)
             if EMT.R3 and abs( EMT.R3) < 0.1 then
                SimulMoveAxis( 'Z1', ParkCSawZ1, MCH_SIM_STEP.RAPID)
@@ -1700,6 +1762,8 @@ function ExecMoveZmax( bMchSplit, btoXHome)
             if btoXHome then
                EgtUnloadTool( EMT.HEAD, 1)
                ShowToolInTcPos( EMT.TCPOS, true)
+               -- nascondo l'utensile sulla testa
+               EgtSetMode( EgtGetHeadId( EMT.HEAD or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
                EMT.PREVTOOL_H1 = nil
                EMT.PREVHEAD_H1 = nil
                EMT.PREVTCPOS_H1 = nil
@@ -1728,13 +1792,31 @@ function ExecMoveZmax( bMchSplit, btoXHome)
             EMT.XHOME = true
             SimulMoveAxis( 'X2', ParkX2, MCH_SIM_STEP.RAPID)
          end
-   -- altrimenti sega a catena
+      -- altrimenti sega a catena
       else
+         -- controlla che l'ingombro della sega a catena non possa collidere durante il suo riposizionamento
+         local dChSawEncumbrance = sqrt( pow( EgtTdbGetCurrToolParam( MCH_TP.TOTLEN), 2) + pow( ChSawLen + Mill2Offs, 2))
+         if EMT.ADIR and EMT.TDIR then
+            -- direzione versore sega a catena X- (copre anche eventuali inclinazioni in Y)
+            if EMT.TDIR[1] <= 0 then
+               -- ingombro massimo di quota Z (senza pivot) + ingombro massimo sega + altezza pezzo + altezza sicurezza
+               local dEncumbranceTot = EMT.L3p + Mill2Offs - dChSawEncumbrance - EMT.SB - 30
+               -- nuova quota Z intermedia
+               local dZUp = EMT.L3p + ( DeltaTabZ - dEncumbranceTot)
+               -- se la nuova quota è minore della quota di parcheggio
+               if dZUp <= ParkCSawZ2 then
+                  -- se B è oltre il punto di massimo ingombro (con l'inclinazione attuale non ha il massimo ingombro)
+                  if asin( EMT.TDIR[3] / 1) > asin( EgtTdbGetCurrToolParam( MCH_TP.TOTLEN) / dChSawEncumbrance) and ( dEncumbranceTot < DeltaTabZ) then
+                     SimulMoveAxis( 'Z2', dZUp, MCH_SIM_STEP.RAPID)
+                  end
+               end
+            end
+         end
          SimulMoveAxes( 'Z2', HomeZ, MCH_SIM_STEP.RAPID, 'B2', HomeB, MCH_SIM_STEP.COLLROT)
          if EMT.R3 and abs( EMT.R3) < 0.1 then
             SimulMoveAxis( 'Z2', ParkCSawZ2, MCH_SIM_STEP.RAPID)
          end
-         SimulMoveAxes( 'X2', HomeX, MCH_SIM_STEP.RAPID, 'C2', HomeC, MCH_SIM_STEP.COLLROT)
+         SimulMoveAxes( 'X2', ParkCSawX2, MCH_SIM_STEP.RAPID, 'C2', HomeC, MCH_SIM_STEP.COLLROT)
       end
    end
    EMT.ZMAX = true
@@ -1809,16 +1891,163 @@ function ExecUnloading()
    end
 end
 
+---------------------------------------------------------------------
+function CheckClamping( sClampName)
+   nIndexClamp = EgtGetAxisId( sClampName)
+   local idClampPath = EgtGetFirstInGroup( EgtGetFirstNameInGroup( nIndexClamp, 'CLAMP_CHECK') or GDB_ID.NULL)
+   local b3ClampingArea = EgtGetBBoxGlob( idClampPath or GDB_ID.NULL, GDB_BB.STANDARD)
+   -- se non trovo percorso area di clamping, esco subito
+   if not idClampPath or not EMT.VMILL or not ClampingCoeffMin then
+      return
+   end
+
+   local function GetCurveListFromIntersection( sPosIntersPlane, sIntersPlane, dDepth)
+      local idCurveList = {}
+      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 idLoop, nLoopCnt = EgtPlaneVolZmapInters( ptPosIntersPlane, vtIntersPlane, EMT.VMILL[i], CLAMP_CHECK_INTERS, GDB_RT.GLOB)
+         -- se c'è almeno una curva
+         if idLoop then
+            for j = 1, nLoopCnt do
+               local idLoopTemp = idLoop + j - 1
+               table.insert( idCurveList, idLoopTemp)
+            end
+         end
+      end
+      return idCurveList
+   end
+
+   local function CalculateIntersectionArea( sPosIntersPlane, sIntersPlane, dDepth)
+      -- test piano frontale
+      local idCurveList = GetCurveListFromIntersection( sPosIntersPlane, sIntersPlane, dDepth)
+
+      -- si copia curva intersezione e curva pinza in gruppo di confronto
+      local idFlatSurf, nFlatSurfCnt = EgtSurfFlatRegion( CLAMP_CHECK_GROUP, idCurveList)
+      local idClampSurf = EgtSurfFlatRegion( CLAMP_CHECK_GROUP, idClampPath)
+
+      if idFlatSurf then
+         local dTotalArea = 0
+         local dTotalXLenght = 0
+         for k = 1, nFlatSurfCnt do
+            local idTempSurf = idFlatSurf + k - 1
+            EgtSurfFrIntersect( idTempSurf, idClampSurf)
+            if idTempSurf then
+               dTotalArea = dTotalArea + ceil( EgtSurfArea( idTempSurf) or 0)
+               local b3BoxIntersectionBox = EgtGetBBoxGlob( idTempSurf, GDB_BB.STANDARD)
+               if b3BoxIntersectionBox then
+                  dTotalXLenght = dTotalXLenght + ceil( b3BoxIntersectionBox:getDimX()) -- somma lunghezze (x) delle aree pinzate
+               end
+            end
+         end
+         return dTotalArea, dTotalXLenght
+      end
+      return 0
+   end
+
+   -- minima area considerata per un corretto pinzaggio
+   DistZClampToTable = DistZClampToTable or 0
+   local MinJoin = BD.GetMinJoin( EMT.HB, EMT.SB, EgtIf( EMT.SPLIT, EMT.LT, EMT.LB))
+   local MinZClamping =  min( b3ClampingArea:getDimZ() + DistZClampToTable, EMT.SB) - DistZClampToTable
+   -- si moltiplica per un coefficiente minimo sotto al quale si da l'errore di pinzaggio
+   ClampingCoeffMin = EgtClamp( ClampingCoeffMin, 0.01, 1)
+   local dMinClampingAreaWarn = ( MinJoin * MinZClamping) * ClampingCoeffMin
+   local dMinClampingAreaErr = ( MinJoin * MinZClamping) * ( 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 = 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 ExecMovePY1( bClose)
    SimulMoveAxis( 'PY1', EgtIf( not bClose, MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
    SetPY1Light( bClose)
+   if bClose then
+      CheckClamping( 'PY1')
+   end
 end
 
 ---------------------------------------------------------------------
 function ExecMovePY2( bClose)
    SimulMoveAxis( 'PY2', EgtIf( not bClose, MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
    SetPY2Light( bClose)
+   if bClose then
+      CheckClamping( 'PY2')
+   end
 end
 
 ---------------------------------------------------------------------
@@ -2206,6 +2435,9 @@ end
 
 ---------------------------------------------------------------------
 function GetV1ToClose()
+   if EMT.MCHPRECUT or EMT.MCHCUT then
+      return false
+   end
    --EgtOutLog( string.format( 'L1m=%.3f L1M=%.3f V2NP=%.3f LB=%.3f', EMT.MAXMIN[1], EMT.MAXMAX[1], EMT.V2NEXTPOS, EMT.LB))
    --EgtOutLog( string.format( 'LB=%.3f LT=%.3f', EMT.LB, EMT.LT or 0))
    return ( EMT.MAXMAX[1] <= EMT.V1NEXTPOS + RollCageMin and EMT.MAXMIN[1] + EMT.LB >= EMT.V1NEXTPOS + RollCageMax)
@@ -2220,11 +2452,17 @@ end
 
 ---------------------------------------------------------------------
 function ShowToolInTcPos( sTcPos, bShow)
+   -- recupero identificativo della posizione sul TC
+   local TcPosId = EgtGetTcPosId( sTcPos or '')
+   if not TcPosId then return end
    -- recupero il gruppo dell'utensile
-   local TcExitId = EgtGetFirstNameInGroup( EgtGetTcPosId( sTcPos or '') or GDB_ID.NULL, 'T1')
+   local TcExitId = EgtGetFirstNameInGroup( TcPosId or GDB_ID.NULL, 'T1')
    if not TcExitId then return end
    -- imposto lo stato di visualizzazione
    EgtSetStatus( TcExitId, EgtIf( bShow, GDB_ST.ON, GDB_ST.OFF))
+   -- recupero eventuale gruppo ausiliario da visualizzare/nascondere
+   local TcHSId = EgtGetFirstNameInGroup( TcPosId, sTcPos .. '_HS')
+   if TcHSId then EgtSetStatus( TcHSId, EgtIf( bShow, GDB_ST.ON, GDB_ST.OFF)) end
 end
 
 ---------------------------------------------------------------------
@@ -2245,7 +2483,7 @@ function LoadNextTool( nHSet, sTcPosDef, bFirst)
       if vTools and vTools[1] and #(vTools[1]) > 0 then
          sTool = vTools[1]
          sTcPos = sTcPosDef
-         if Progress then
+         if Progress or SecondToolChanger then
             sHead = EgtIf( sTcPos == 'T11', 'H12', 'H11')
          elseif nHSet == 1 then
             sHead = EgtIf( sTcPos == 'T1', 'H12', 'H11')
@@ -2302,6 +2540,9 @@ local FALL_T = 2 * ESTIMATION_RAPID_COEFF              -- s
 ---------------------------------------------------------------------
 function OnEstimStart()
    EMT.INCHES = not EgtUiUnitsAreMM()      -- unità di misura mm/inches
+   EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 102000, 20000, 102000)  -- 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
 
 ---------------------------------------------------------------------
@@ -2387,6 +2628,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
@@ -2443,6 +2693,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
 
 ---------------------------------------------------------------------
@@ -2568,11 +2824,11 @@ 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), RAPID_X_FEED, EMT.SPLIT)
    if dT1 > dTime then dTime = dT1 end
-   local dT2 = abs( dL2) / RAPID_Y_FEED * 60
+   local dT2 = CalcMoveTime( abs( dL2), EMT.FMAXPINZE, EMT.SPLIT)
    if dT2 > dTime then dTime = dT2 end
-   local dT3 = abs( dL3) / RAPID_Z_FEED * 60
+   local dT3 = CalcMoveTime( abs( dL3), RAPID_Z_FEED, EMT.SPLIT)
    if dT3 > dTime then dTime = dT3 end
    local dT4 = abs( dR1) / RAPID_C_FEED * 60
    if dT4 > dTime then dTime = dT4 end
@@ -2594,7 +2850,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 = 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
@@ -2815,7 +3071,7 @@ function GetNextChainSawingVirtualAxis( MchId)
 end
 
 ---------------------------------------------------------------------
-function GetNextTool( nMchId)
+function GetNextTool( nMchId, bResetOnStart)
    -- inizializzo prossimo utensile
    local sNextTool
    -- recupero lavorazione successiva
@@ -2823,7 +3079,7 @@ function GetNextTool( nMchId)
    while nNextMchId do
       -- se la prossima lavorazione è lo start di un altro pezzo, faccio finta che cambia utensile in modo che vada in parcheggio con utensili speciali
       if EgtGetOperationType( nNextMchId) == MCH_OY.DISP then
-         if IsStartOrRestPhase( EMT.PHASE+1) then
+         if IsStartOrRestPhase( EMT.PHASE+1) and bResetOnStart then
             return nil
          end
       else
@@ -2848,10 +3104,10 @@ end
 
 ---------------------------------------------------------------------
 function RollerParkingNeeded( sHead, dAng1p, dAng2p, dAng1, dAng2)
-   if sHead == 'H11' or sHead == 'H12'  or HeadIsChainSaw( sHead) then
-      return ( abs( dAng1 - dAng1p) > 1 or ( abs( dAng2 - dAng2p) > 1 and abs( dAng1 % 180.0) > 1))
+   if sHead == 'H11' or sHead == 'H12'  or sHead == 'H17' or HeadIsChainSaw( sHead) then
+      return ( abs( dAng1 - dAng1p) > 1 or ( abs( dAng2 - dAng2p) > 1 and abs( dAng1) % 180.0 > 1))
    elseif sHead == 'H21' or sHead == 'H22' or HeadIsChainSaw( sHead) then
-      return ( abs( dAng1 - dAng1p) > 1 or ( abs( dAng2 - dAng2p) > 1 and abs( dAng1 % 180.0) > 1))
+      return ( abs( dAng1 - dAng1p) > 1 or ( abs( dAng2 - dAng2p) > 1 and abs( dAng1) % 180.0 > 1))
    end
 end
 
@@ -2866,5 +3122,40 @@ function GetCmdAxMove( Cmd, sAx)
    end
 end
 
+---------------------------------------------------------------------
+function CalcDinamicaPinze( dH, dS, dL)
+   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
+   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
+   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
+   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
+   local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
+   local AccMaxPinze = EMT.MAXACC
+   local AccPinze = EgtClamp( FMaxPinze / ( 60 * TempoAcc), EMT.MINACC, EMT.MAXACC)
+   local RidFeed = 100 / Massa * 100
+   if RidFeed > 100 then
+      RidFeed = 100
+   elseif RidFeed < 10 then
+      RidFeed = 10
+   end
+   return AccPinze, AccMaxPinze, RidFeed
+end
+
+---------------------------------------------------------------------
+function CalcMoveTime( dPathLen, dFeed, bIsSplitted)
+   local dTime
+   local dFeedInSec = dFeed / 60
+   local dAcc, _, _ = CalcDinamicaPinze( EMT.HB, EMT.SB, 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
+
+   return dTime
+end
+
 ---------------------------------------------------------------------
 -- *** END GENERAL ***

Common_ONE-PF.mlse

@@ -7,6 +7,65 @@ EgtEnableDebug( false)
 -- Carico libreria
 local BD = require( 'BeamData')
 
+---------------------------------------------------------------------
+-- *** Generic Machinings ***
+---------------------------------------------------------------------
+require( 'EmtGenMachining')
+
+---------------------------------------------------------------------
+-- *** Special GetPrevMachiningOffset ***
+---------------------------------------------------------------------
+-----------------------------------------------------------------------------------------
+function OnSpecialGetPrevMachiningOffset()
+   -- Aggiorno posizione della testa della trave a seguito di movimenti delle pinze non previsti tra le fasi
+   local function TPosUpdate()
+      local nClId = EgtGetFirstNameInGroup( EMC.CURRMCHID, 'CL') -- recupero Id del gruppo CL della lavorazione corrente
+      local nPathId = EgtGetFirstInGroup( nClId or GDB_ID.NULL) -- Id del primo gruppo nella lavorazione (P1)
+      if not nPathId then
+         EMC.ERR = 12
+         EMC.MSG = '  Error : CL group path not found'
+         return
+      end
+      local dAuxMoveCount = EgtGetInfo( nPathId, 'AS#', 'd') or 0 -- numero di movimenti ausiliari 
+      local dTRepos = nil
+      -- controlla ogni gruppo di movimenti ausiliari
+      for i = 1, dAuxMoveCount do
+         local aAuxMove = EgtGetInfo( nPathId, 'AS' .. tostring( i), 'vs') or {} -- array contenete i parametri di ogni gruppo
+         -- controlla solo i movimenti della testa trave e salva l'ultimo
+         if aAuxMove[1] == '2' or aAuxMove[1] == '3' then
+            for j = 2, #aAuxMove do
+               if aAuxMove[j] == 'T' then
+                  dTRepos = aAuxMove[j+1]
+                  break
+               end
+            end
+         end
+      end
+      return dTRepos
+   end
+
+   -- default
+   EMC.ERR = 0
+   EMC.PREVOFFSX = 0
+   -- se c'è cambio di fase tra le lavorazioni (quindi la precedente è l'ultima della sua fase e la corrente la prima)
+   if EMC.PREVPHASE ~= EMC.CURRPHASE then
+      -- se la fase corrente è di inizio lavorazione di nuova trave
+      if IsStartOrRestPhase( EMC.CURRPHASE) then
+         -- recupero la posizione finale della lavorazione precedente
+         local vPrevAx = EmtGetFinalAxesPos( EMC.PREVMCHID)
+         -- ricava se e quanto la trave viene spostata tra le due fasi dai movimenti ausiliari e corregge l'offset di fine fase
+         local dNewTPos = TPosUpdate()
+         -- se ci sono dei movimenti della testa trave tra le due fasi ricava il delta tra la vecchia e la nuova posizione
+         if dNewTPos then
+            EMC.PREVOFFSX = dNewTPos - vPrevAx[1]
+         -- oppure la X (L1) di questa corrisponde alla posizione iniziale della nuova trave, se ne deduce l'offset
+         else
+            EMC.PREVOFFSX = ParkV1 - vPrevAx[1]
+         end
+      end
+   end
+end
+
 ---------------------- OnSpecialGetMaxZ -----------------------------
 ---------------------------------------------------------------------
 local function CalcExtraZ( vtTp, vtT, vMZ)
@@ -72,7 +131,7 @@ function OnSpecialGetMaxZ()
          local vMZ = {{ Tz=0.85, Ez=390}, { Tz=0.5, Ez=280}, { Tz=-0.01, Ez=160}, { Tz=-0.5, Ez=1}, { Tz=-0.61, Ez=1}}
          EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
       end
-   elseif EMC.HEAD == 'H12' and sHead_TC == 'Head1_TC1' then
+   elseif ( EMC.HEAD == 'H12' or EMC.HEAD == 'H17') and sHead_TC == 'Head1_TC1' then
       if vtTp:getX() > 0.4 and vtT:getX() > 0.4 then
          if bBSameSign and abs( EMC.R1 - EMC.R1p) < 165 then
             EMC.MAXZ = MaxZ1 - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
@@ -173,7 +232,7 @@ function OnSpecialMoveZup()
    if EMC.HEAD == 'H11' or EMC.HEAD == 'H21' then
       ;
    -- se lama posizionata su CU prossimo a testa 1
-   elseif EMC.HEAD == 'H12' and sHead_TC == 'Head1_TC1' then
+   elseif ( EMC.HEAD == 'H12' or EMC.HEAD == 'H17') and sHead_TC == 'Head1_TC1' then
       -- se inclinata oltre 90 gradi e interferisce con la trave
       if ( EMC.R2 > 87.9 and ( EMC.R1 < 15.0 or EMC.R1 > 180.0)) or ( EMC.R2 < -87.9 and ( EMC.R1 > -15.0 and EMC.R1 < 180.0)) then
          local dZref = dZmax + min( 330 * vtT:getZ(), 0) + 260 * ( 1 - sqrt( 1- vtT:getZ() * vtT:getZ()))
@@ -223,7 +282,7 @@ local MIN_BACK_ENG_V = 115       -- ingombro asse Z a sinistra
 local AGG_V = MinDeltaYV         -- ingombro rulli pressori + sicurezza
 local MIN_CLAMP_5 = 150          -- minima presa con la pinza speciale (pinza 5)
 local SIC_CLAMP_5 = 50           -- sicurezza testa da pinza speciale
-local MAX_BACK_CLAMP_5 = 320     -- massima sporgenza posteriore del pezzo da pinza speciale
+local MAX_BACK_CLAMP_5 = EgtClamp( MaxBackClamp5 or 320, 200, 380)   -- massima sporgenza posteriore del pezzo da pinza speciale
 
 ----------------------- Variabili -----------------------------------
 local Test = false
@@ -1553,8 +1612,11 @@ function SpecCalcUnload()
       EgtOutLog( '  *[U1]', 1)
    end
    local vCmd = {}
+   -- Tipo di scarico
+   local bStdUl = ( not MaxUnloadLen or MaxUnloadLen < 1 or EMC.LB - EMC.HOVM < MaxUnloadLen + 1)
+
    -- Commento
-   table.insert( vCmd, { 0, 'Unloading'})
+   table.insert( vCmd, { 0, 'Unloading', EgtIf( bStdUl, 'Unloading', 'Manual Unloading')})
    -- posizionamento sicuro teste e rulli (non serve ?)
    --table.insert( vCmd, { 4, 0})
    -- Se pinza Y chiusa, la apro
@@ -1562,11 +1624,15 @@ function SpecCalcUnload()
       table.insert( vCmd, { 11, 0})
       EMC.CNT = nil
    end
-   -- Sposto il pezzo in posizione di scarico
-   local dFinT = UnloadT - EMC.LB
-   local dFinY2 = dFinT + EMC.Y2DELTA
-   table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2})
-   EgtOutLog( '  Y2PosF=' .. EgtNumToString( dFinY2), 1)
+   -- Se non supero la lunghezza massima di scarico, sposto il pezzo in posizione di scarico
+   if bStdUl then
+      local dFinT = UnloadT - EMC.LB
+      local dFinY2 = dFinT + EMC.Y2DELTA
+      table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2})
+      EgtOutLog( '  Y2PosF=' .. EgtNumToString( dFinY2), 1)
+   else
+      table.insert( vCmd, { 1, 'Y2', MaxY2})
+   end
    -- apro la morsa
    table.insert( vCmd, { 12, 0})
    -- riporto il carrello in home

UpdateLog.txt

@@ -1,4 +1,71 @@
            ==== Common_ONE-PF Update Log ====
+Versione 3.1c1 (04/03/2026)
+- (GEN) Corretta chiamata di una variabile insesistente in caso di ONE
+- (SIM) Allineata simulazione a generazione
+
+Versione 3.1b1 (20/02/2026)
+- (GEN) Aggiunta funzione ToolPreSelection() per la preselezione utensile. Ticket#2789
+- (GEN) Funzione rinominata in ToolPreSelectionSingleHead(), ora utilizza funzione in MLDE per capire se è motosega
+
+Versione 3.1a1 (16/01/2026)
+- (SIM-GEN) Aggiunto controllo che evita collisioni durante lo svincolo in Z della sega a catena nelle funzioni ExecMoveZMax() e EmitZMax(). Ticket#2767
+- (SIM-GEN) Piccola correzione modifiche fatte in precedenza
+
+Versione 2.7l1 (18/12/2025)
+- (SIM-GEN) Aggiunto controllo post movimenti ausiliari dell' EMC.PREVOFFSX nella funzione OnSpecialGetPrevMachiningOffset(). Ticket#2727
+- (SIM-GEN) Divisione movimento B in approccio se > 90°. Ticket#2754
+- (SIM) Aggiunta funzione CheckClamping
+
+Versione 2.7k3 (28/11/2025)
+- (GEN) Prima di andare allo scarico, si aggiunge movimento intermedio dove si aspetta che rulli scarico siano arrivati in posizione. Ticket#2716
+
+Versione 2.7k2 (20/11/2025)
+- (SIM) Aggiornata risoluzione VMillTol in funzione dello spessore lama
+
+Versione 2.7k1 (05/11/2025)
+- (SIM-GEN) Corretto calcolo per decidere se serve aprire i rulli
+- (GEN) Aggiunta tolleranza in creazione piano di lavoro inclinato
+- (SIM) Allo scarico si resetta Y2DELTA. Ticket#2687
+
+Versione 2.7j3 (23/10/2025)
+- (SIM) Corretta posizione parcheggio in caso di testa 1 su magazzino 2. Ticket#2660
+
+Versione 2.7j2 (21/10/2025)
+- (GEN) Se SPLIT con pinza 5, corretto salvataggio posizione pinza 2. Ticket#2654
+
+Versione 2.7j1 (08/10/2025)
+- (GEN) Salvataggio posizione Z su lavorazione precedente, sbagliava in caso di separazione. Ticket#2637
+
+Versione 2.7i1 (10/09/2025)
+- (SIM-GEN) Piccole correzioni per gestire secondo TC su ONE. Ticket#2563
+- (SIM-GEN) Gestione aggregato BH completato. Ticket#2482
+- (EST) Stima tempi considerando accelerazioni
+- (SIM-GEN) Se fase start o restart, si aggiorna la posizione in X dell'asse per calcolare il link corretto
+- (GEN) Piccola correzione risalita ZMAX dopo RELOAD del pezzo. Generazione allineata a simulazione.
+
+Versione 2.7h2 (28/08/2025)
+- (GEN) Migliorata gestione spegnimento utensile e disattivazione piano
+- (SIM-GEN) Corretto nome variabile e altre piccole modifiche per Progress
+
+Versione 2.7h1 (20/08/2025)
+- (SIM-GEN) Non si chiudono i rulli se tagli o pretagli di testa e coda
+- (SIM) Corretto movimento pinza 5 in caso di riposizionamento pinza 1
+- (GEN) Corretta quota assoluta posizione testa trave in caso di pinza 5 e testa rimasta bassa
+- (GEN) Se ultima lavorazione pezzo precedente ha stesso utensile della prima lavorazione pezzo successivo, la speed resta accesa
+
+Versione 2.7g4 (23/07/2025)
+- (SIM-GEN) Aggiunto parametro configurabile da TS3 per massima sporgenza trave in coda per pinza 5. Ticket#2538
+
+Versione 2.7g3 (22/07/2025)
+- (SIM) Corretto lettura angolo di presa della motosega
+
+Versione 2.7g2 (08/07/2025)
+ - (SIM) Corretto movimento a parcheggio sega a catena. Ticket#2517
+
+Versione 2.7g1 (01/07/2025)
+- (GEN) Rimossa gestione PROBE inserita per sbaglio
+- (GEN) Corretto gestione accelerazioni
+- (SIM-GEN) Aggiunta gestione massima lunghezza scarico
 
 Versione 2.7f1 (04/06/2025)
 - (SIM) Aggiunta gestione qualità VMILL da impostazioni macchina. Tolto parametro 'CoeffVM'.

Version.lua

@@ -3,7 +3,7 @@
 
 local InfoCommon_STD_PP = {
    NAME = 'Common_ONE-PF',            -- nome script PP standard
-   VERSION = '2.7f1',                 -- versione script
+   VERSION = '3.1c1',                 -- versione script
    MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
 }