Corretto MIN_VER

- Aggiunto parametro LinkAxesMoveOrder

Beam/BeamData.lua

@@ -68,6 +68,8 @@ local BeamData = {
    KIOTP = 2,                               -- coefficiente moltiplicativo per attacco/uscita lama tangente anzichè perpendicolare
    MAXDIAM_POCK_CORNER = 30,                -- diametro massimo utensile ammesso per tasche con angoli interni
    USE_LONGCUT = false,                     -- per i tagli longitudinali usare solo la lavorazione di lama LongCut
+   PRECUT_HEAD = true,                      -- flag abilitazione pretaglio grezzo a zero in testa
+   PRECUT_TAIL = true,                      -- flag abilitazione pretaglio grezzo a zero in coda
    ADVANCE_TAIL_CUT = true,                 -- per spostare prima del taglio di separazione il taglio di coda su pezzi corti con robabile caduta
    ADVANCE_TAIL_OFFS = 5,                    -- accorciamento taglio di coda avanzato (minimo 1)
    DOUBLE_HEAD_DOVETAIL = true,             -- flag abilitazione lavorazione mortase a coda di rondine in doppio
@@ -99,6 +101,8 @@ if EgtExistsFile( sDataBeam) then
          BeamData.DIM_STRIP_SMALL = Machine.Offsets.DIM_STRIP_SMALL or BeamData.DIM_STRIP_SMALL
          BeamData.DIM_TO_CENTER_STRIP = Machine.Offsets.DIM_TO_CENTER_STRIP or BeamData.DIM_TO_CENTER_STRIP
          BeamData.MAXDIAM_POCK_CORNER = Machine.Offsets.MAXDIAM_POCK_CORNER or BeamData.MAXDIAM_POCK_CORNER
+         if Machine.Offsets.PRECUT_HEAD_DISABLE then BeamData.PRECUT_HEAD = ( Machine.Offsets.PRECUT_HEAD_DISABLE == 0) end
+         if Machine.Offsets.PRECUT_TAIL_DISABLE then BeamData.PRECUT_TAIL = ( Machine.Offsets.PRECUT_TAIL_DISABLE == 0) end
       end
       if Machine.Trave then
          BeamData.MIN_WIDTH = Machine.Trave.XMIN or BeamData.MIN_WIDTH
@@ -232,6 +236,7 @@ local function GetSetupInfo( sHead)
       SetupInfo.bIsTopHead = true
       SetupInfo.bIsBottomHead = not SetupInfo.bIsTopHead
       SetupInfo.dMaxNegativeAngle = 0
+      SetupInfo.dZSafeDelta = 60
    -- testa 5 assi da sotto
    elseif sHead == 'H21' then
       SetupInfo.bIsBottomHead = true

Common_PF1250.TPA.mlpe

@@ -28,7 +28,7 @@ function OnStart()
    --EMT.LINEINC = 1        -- incremento numerazione linee
    --EMT.Ft = 'F'           -- token per feed
    --EMT.St = 'S'           -- token per speed
-   EMT.FMAXPINZE = 116000 -- feed massima pinze
+   EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 116000, 20000, 116000)  -- feed massima pinze
    SetToParkLine()        -- si inizia con linee da parcheggiare su stack
 end
 
@@ -51,6 +51,7 @@ function OnProgramStart()
    end
    MyOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
    MyOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')')
+   MyOutput( '(HEADER)')
 
    -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
    if TEST_USE then
@@ -102,6 +103,7 @@ function OnProgramEnd()
    EMT.FALL = nil
    EMT.RELOAD = nil
    EMT.RELOAD2 = nil
+   MyOutput( '(FOOTER)')
    -- Termino il programma
    MyOutput( 'M202')
    MyOutput( 'M02')
@@ -128,6 +130,8 @@ function OnToolData()
          dAddLen = -SawOffsZ
       elseif EMT.HEAD == 'H16' then
          dAddLen = -Saw2OffsZ
+      elseif EMT.HEAD == 'H14' then
+         dAddLen = 206 -- dimensione aggregato
       end
       local sOut = 'M992 P1=' .. EMT.TCPOS:gsub( 'T', '') .. ' P2=' .. EmtLenToString( dAddLen + EMT.TLEN, 3) .. ' P3=' .. EmtLenToString( EMT.TDIAM, 3) ..
                    ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( dAddLen + EMT.TTOTLEN, 3)
@@ -406,6 +410,13 @@ function OnMachiningStart()
       -- imposto home dell'asse C1 (A=0 -> T101, A=90 -> T104)
       local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
       EmtModifyAxisHome( 'C1', MyParkCSawC1)
+   -- aggregato foratura multipla, aggiusto subito angolo scelto per asse virtuale A
+   elseif EMT.HEAD == 'H14' then
+      -- valore dell'asse virtuale
+      dPosA = GetCurrMultiDrillVirtualAxis()
+      -- imposto home dell'asse C1 (A=0 -> T121, A=90 -> T124)
+      local MyParkMultiDrillC1 = GetMultiDrillCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
+      EmtModifyAxisHome( 'C1', MyParkMultiDrillC1)
    -- se lama su aggregato testa sotto, aggiusto subito angolo scelto per asse virtuale A
    elseif EMT.HEAD == 'H22' then
       -- valore dell'asse virtuale
@@ -729,9 +740,12 @@ function OnRapid()
             local MyMaxZ1 = EgtGetAxisMax( 'Z1')
             -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
             local bXSpec = EgtIf( BD.RIGHT_LOAD, ( EMT.L2 > -DeltaTabY), ( EMT.L2 < -DeltaTabY))
-            EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
-            EmitMoveStartHead( 1)
-            EmitMoveWaitHead( 1)
+            -- se non è aggregato, posso preselezionare testa e andare in posizione
+            if EMT.HEAD ~= 'H13' and EMT.HEAD ~= 'H14' then
+               EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
+               EmitMoveStartHead( 1)
+               EmitMoveWaitHead( 1)
+            end
             EmitMoveWaitChars( EgtIf( bOnlyCharY, 1, 3))
             -- se necessario allargo le cabine
             if RollerParkingNeeded( EMT.HEAD, PrevR1, PrevR2, EMT.R1, EMT.R2) or
@@ -757,6 +771,9 @@ function OnRapid()
                   -- se sega a catena
                   if EMT.HEAD == 'H13' then
                      EmitMoveDataHead( 1, { X=-ParkCSawX1, Z=HomeZ1, B=HomeR2, C=HomeR1, TRad=dTRad, TLen=dTLen, S=Speed})
+                  -- aggregato foratore multiplo
+                  elseif EMT.HEAD == 'H14' then
+                     EmitMoveDataHead( 1, { X=-ParkMultiDrillX1, Z=HomeZ1, B=HomeR2, C=HomeR1, TRad=dTRad, TLen=dTLen, S=Speed})
                   -- utensili standard
                   else
                      -- utensili lunghi
@@ -849,8 +866,8 @@ function OnRapid()
                EmitParkRoller( dPosT, bSplitCut)
             end
             -- vado a quota sicurezza in X per permettere rotazione assi rotanti
-            if ( not EMT.L2pp or ( EMT.L2pp and EMT.L2pp > ParkMchY2)) and ( ParkB2 ~= EMT.R2  or  ParkC2 ~= EMT.R1) then
-               EmitMoveDataHead( 2, { X=ParkMchY2, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed}) 
+            if ( not EMT.L2pp or ( EMT.L2pp and EMT.L2pp > SafeX2RotAxis)) and ( ParkB2 ~= EMT.R2  or  ParkC2 ~= EMT.R1) then
+               EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed}) 
             end
             -- scrivo solo se gli assi rotanti sono cambiati
             if EMT.HEAD == 'H22' and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
@@ -870,11 +887,12 @@ function OnRapid()
          else
             -- selezione testa (posso muovere X solo a Zmax)
             local MaxZ3 = EgtGetAxisMax( 'Z3')
+            local MyParkX3 = EgtGetAxisHomePos( 'X3')
             -- se bisogna scrivere tutti gli assi
             if WriteAllCoordsOnFirstM101 then
-               EmitMoveDataHead( 3, { X=EMT.L2, Z=MaxZ3, B=ParkB3, C=0, S=Speed})
+               EmitMoveDataHead( 3, { X=MyParkX3, Z=MaxZ3, B=ParkB3, C=ParkC3, S=Speed})
             else
-               EmitMoveDataHead( 3, { X=EMT.L2, Z=MaxZ3, S=Speed})
+               EmitMoveDataHead( 3, { X=MyParkX3, Z=MaxZ3, S=Speed})
             end
             EmitMoveStartHead( 3)
             EmitMoveWaitHead( 3)
@@ -900,13 +918,15 @@ function OnRapid()
             elseif EgtGetHeadId( 'H38') then
                local B3Home = EgtGetAxisHomePos( 'B3')
                local C3Home = EgtGetAxisHomePos( 'C3')
-               EmitMoveDataHead( 3, { X=SafeX3RotAxis, S=Speed})
+               EmitMoveDataHead( 3, { X=-SafeX3RotAxis, S=Speed})
                -- se non sono esattamente in home, devo ruotare in zona sicura
                if abs( C3Home - EMT.R1) > 1 or abs( B3Home - EMT.R2) > 1 then
                   EMT.L3 = min( EMT.L3, SafeZ3RotAxis)
                   EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, S=Speed})
                   EmitMoveDataHead( 3, { B=EMT.R2, C=EMT.R1, S=Speed})
-                  EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                  if ( EMT.L3 - SafeZ3RotAxis) > 100 * GEO.EPS_SMALL then
+                     EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                  end
                   EmitMoveDataHead( 3, { X=EMT.L2, S=Speed})
                end
                -- muovo in posizione finale
@@ -1182,20 +1202,20 @@ function OnRapid()
                   end
                   -- scrivo solo se gli assi rotanti sono cambiati
                   EmitMoveDataHead( 2, { Z=-dSafeZ2, S=Speed})
-                  if EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                     EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+                  if EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                     EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                   end
                else
                   -- scrivo solo se gli assi rotanti sono cambiati
-                  if EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                     EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+                  if EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                     EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                   end
                end
             -- se stesso utensile vado già alla X di lavoro
             else
                -- scrivo solo se gli assi rotanti sono cambiati
-               if EMT.ZMAX and EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                  EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+               if EMT.ZMAX and EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                  EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                end
             end
             -- scrivo solo se gli assi rotanti sono cambiati
@@ -1241,13 +1261,15 @@ function OnRapid()
                if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                   local B3Home = EgtGetAxisHomePos( 'B3')
                   local C3Home = EgtGetAxisHomePos( 'C3')
-                  EmitMoveDataHead( 3, { X=SafeX3RotAxis, S=Speed})
+                  EmitMoveDataHead( 3, { X=-SafeX3RotAxis, S=Speed})
                   -- se non sono esattamente in home, devo ruotare in zona sicura
                   if abs( C3Home - EMT.R1) > 1 or abs( B3Home - EMT.R2) > 1 then
                      EMT.L3 = min( EMT.L3, SafeZ3RotAxis)
                      EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, S=Speed})
                      EmitMoveDataHead( 3, { B=EMT.R2, C=EMT.R1, S=Speed})
-                     EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                     if ( EMT.L3 - SafeZ3RotAxis) > 100 * GEO.EPS_SMALL then
+                        EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                     end
                      EmitMoveDataHead( 3, { X=EMT.L2, S=Speed})
                   end
                end
@@ -1402,7 +1424,9 @@ function OnRapid()
       local bSplitCut = ( EMT.MCHUSERNOTES:find( 'Split', 1, true) ~= nil)
       -- porto in home la testa corrente se lavorazione successiva sopra con testa diversa oppure se punta lunga
       local nNextTopHSet = GetNextTopHSet( EMT.MCHID)
-      local bTopGoHome = ( nHSet ~= 2 and nNextTopHSet ~= 0 and nHSet ~= nNextTopHSet) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
+      -- ricavo prossimo utensile
+      local sNextTool = GetNextTool( EMT.MCHID)
+      local bTopGoHome = ( IsLastPath( EMT.PATHID) and not sNextTool and nHSet == 3) or ( nHSet ~= 2 and nNextTopHSet ~= 0 and nHSet ~= nNextTopHSet) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
       EmitZmax( true, true, EMT.R1p, EMT.R2p, bSplitCut, bTopGoHome, false)
       -- aggiorno quota finale trave dopo Zmax
       EMT.L1o = EMT.TPOS
@@ -2285,30 +2309,53 @@ function AdjustTcPos( bLen3, sTcPos, dAxR3)
    end
    if sPos == '101' then
       if not dAxR3 then dAxR3 = EMT.R3 end
-      if abs( dAxR3 - 0) < 0.1 then
-         sPos = '101'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '102'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '103'
-      elseif abs( dAxR3 - 90) < 0.1 then
-         sPos = '104'
-      else
-         EmtSetLastError( 1210, 'Chain saw orientation not allowed')
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '101'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '102'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '103'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '104'
+         else
+            EmtSetLastError( 1210, 'Tool T101 orientation not allowed')
+         end
       end
    end
    if sPos == '111' then
       if not dAxR3 then dAxR3 = EMT.R3 end
-      if abs( dAxR3 - 0) < 0.1 then
-         sPos = '111'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '112'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '113'
-      elseif abs( dAxR3 - 90) < 0.1 then
-         sPos = '114'
-      else
-         EmtSetLastError( 1210, 'Chain saw orientation not allowed')
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '111'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '112'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '113'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '114'
+         else
+            EmtSetLastError( 1210, 'Tool T111 orientation not allowed')
+         end
+      end
+   end
+   if sPos == '121' then
+      if not dAxR3 then dAxR3 = EMT.R3 end
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '121'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '122'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '123'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '124'
+         else
+            EmtSetLastError( 1210, 'Tool T121 orientation not allowed')
+         end
       end
    end
    if sPos == '201' then
@@ -2468,7 +2515,17 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome, bUsePrev
          -- salgo in Z sicurezza raddrizzando la B
          local dSafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
          EmitMoveDataHead( 1, { Z=dSafeZ1, B=dHomeB1, Fmt=1})
-         EmitMoveDataHead( 1, { X=-dHomeX1, C=dHomeC1, Fmt=1})
+         -- lascio la motosega a parcheggio. In caso di utilizzo della testa 3, la motosega viene scaricata automaticamente dalla macro.
+         EmitMoveDataHead( 1, { X=-ParkCSawX1, C=dHomeC1, Fmt=1})
+         EmitMoveStartHead( 1)
+         EmitMoveWaitHead( 1)
+      end
+      -- se ho degli aggregati e la prossima è la testa 3, scarico e prendo utensile di default
+      local nNextTopHSet = GetNextTopHSet( EMT.MCHID)
+      if IsHeadExisting( 3) and nNextTopHSet == 3 and ( EMT.TCPOS == 'T101' or EMT.TCPOS == 'T111' or EMT.TCPOS == 'T121') then
+         -- lascio la motosega a parcheggio. In caso di utilizzo della testa 3, la motosega viene scaricata automaticamente dalla macro.
+         local sDefToolToLoad = AdjustTcPos( false, DefTcPos1)
+         EmitMoveDataHead( 1, { X=-ParkX1, TPos=sDefToolToLoad, Fmt=1})
          EmitMoveStartHead( 1)
          EmitMoveWaitHead( 1)
       end
@@ -2521,7 +2578,7 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome, bUsePrev
          end
          -- se non sono esattamente in home, devo ruotare in zona sicura
          if abs( dHomeC3 - PrevR1) > 1 or abs( dHomeB3 - PrevR2) > 1 then
-            EmitMoveDataHead( 3, { X=SafeX3RotAxis, Fmt=1})
+            EmitMoveDataHead( 3, { X=-SafeX3RotAxis, Fmt=1})
             EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, Fmt=1})
             EmitMoveDataHead( 3, { B=dHomeB3, C=dHomeC3, Fmt=1})
          end
@@ -2756,35 +2813,44 @@ function PreselectNextDiffHead( nMchId, sHead)
                end
             -- altrimenti (testa 3)
             else
-               -- se preselezione testa 1
-               if nNextHSet == 1 then
-                  local nNextTc = GetTcForTopHeadTool( sNextTcPos)   -- utensile da caricare
-                  local nPrevTc = GetTcForTopHeadTool( EMT.PREVTCPOS_H1) -- utensile da depositare
-                  -- se devo lasciare o prelevare da TC1 oppure non so cosa c'è montato, non posso preselezionare
-                  if nNextTc == 1 or nPrevTc == 1 or nPrevTc == 0 then return
-                  -- TC su montante sinistro
+               -- se è macchina a 3 teste con gruppo truciolatore 4 assi
+               if EgtGetHeadId( 'H39') then
+                  -- se preselezione testa 1
+                  if nNextHSet == 1 then
+                     local nNextTc = GetTcForTopHeadTool( sNextTcPos)   -- utensile da caricare
+                     local nPrevTc = GetTcForTopHeadTool( EMT.PREVTCPOS_H1) -- utensile da depositare
+                     -- se devo lasciare o prelevare da TC1 oppure non so cosa c'è montato, non posso preselezionare
+                     if nNextTc == 1 or nPrevTc == 1 or nPrevTc == 0 then return
+                     -- TC su montante sinistro
+                     else
+                        if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
+                        if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     end
+                  -- se preselezione testa 2
                   else
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
-                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
-                  end
-               -- se preselezione testa 2
-               else
-                  -- se agregato lama speciale non preseleziono mai
-                  if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then return end
-                  -- se la Z di lavoro è più bassa del cambio utensili, verifico quota X (la nostra Y)
-                  if EMT.MAXMIN[3] < MinZ1ToChangeH2 then
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
-                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     -- se agregato lama speciale non preseleziono mai
+                     if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then return end
+                     -- se la Z di lavoro è più bassa del cambio utensili, verifico quota X (la nostra Y)
+                     if EMT.MAXMIN[3] < MinZ1ToChangeH2 then
+                        if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
+                        if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     end
                   end
+               -- se gruppo lama dedicato, senza cambio utensile non si preseleziona mai
+               elseif EgtGetHeadId( 'H38') then
+                  return
                end
             end
 
             -- faccio preselezione ( se sono arrivato qui, vuol dire che posso preselezionare)
             if nNextHSet == 1 then
                local dNextX
-               -- se sto lavorando con testa 3 oppure utensile lungo, la testa 1 deve restare in home
-               if nHSet == 3 or dNextTotLen < LongTool then
-                  dNextX = EgtGetAxisHomePos( 'X1')
+               -- se sto lavorando con testa 3, la testa 1 preselezionata deve restare in home
+               if nHSet == 3 then
+                  dNextX = - EgtGetAxisHomePos( 'X1')
+               -- se il prossimo utensile su testa 1 è utensile lungo, resta in home
+               elseif sNextHead == 'H11' and dNextTotLen > LongTool then
+                  dNextX = - EgtGetAxisHomePos( 'X1')
                -- altrimenti recupero quota X1 (nostro L2)
                else
                   dNextX = GetStartMachiningXaxis( nNextMchId)
@@ -2796,7 +2862,7 @@ function PreselectNextDiffHead( nMchId, sHead)
                      EmitMoveDataHead( 1, { X=dNextX, B=ParkB1, C=ParkC1, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                   else
                      local nNextTc = GetTcForTopHeadTool( sNextTcPos)
-                     EmitMoveDataHead( 1, { X=dNextX, B=ParkLongB1, C=EgtIf( nPrevTc ~= 2, ParkLongTc1C1, ParkLongTc2C1), TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
+                     EmitMoveDataHead( 1, { X=dNextX, B=ParkLongB1, C=EgtIf( nNextTc ~= 2, ParkLongTc1C1, ParkLongTc2C1), TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                   end
                   EmitMoveStartHead( 1)
                elseif sNextHead == 'H12' or sNextHead == 'H16' then
@@ -2810,9 +2876,11 @@ function PreselectNextDiffHead( nMchId, sHead)
                   EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, dNextX), B=ParkCSawB1, C=MyParkCSawC1, TPos=AdjustTcPos( false, sNextTcPos, dPosA), Fmt=2})
                   EmitMoveStartHead( 1)
                end
-            else
+            elseif nNextHSet == 2 then
                EmitMoveDataHead( 2, { B=ParkB2, C=ParkC2, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                EmitMoveStartHead( 2)
+            else
+               ; -- non si preseleziona testa 3
             end
          end
       end

Common_PF1250.mlpe

@@ -76,10 +76,12 @@ function OnSimulStart()
    if vTcPos then
       for i = 1, #vTcPos do
          local vTools = EgtGetToolsInCurrSetupPos( vTcPos[i])
-         if vTools and vTools[1] and #(vTools[1]) > 0 then
-            EgtLoadTool( vTcPos[i], 1, vTools[1])
-            ShowToolInTcPos( vTcPos[i], true)
+         for j = 1, #( vTools or {}) do
+            if vTools[j] ~= '' then
+               EgtLoadTool( vTcPos[i], j, vTools[j])
+            end
          end
+         ShowToolInTcPos( vTcPos[i], true)
       end
    end
    -- Carico gli utensili iniziali o di default sulle due teste
@@ -222,18 +224,24 @@ 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.51
-            if dArea < CoeffVM * 0.5e6 then
-               dTol = 1.01
-            elseif dArea < CoeffVM * 1.2e6 then
-               dTol = 1.51
-            elseif dArea < CoeffVM * 2.5e6 then
-               dTol = 1.97
-            elseif dArea < CoeffVM * 5.0e6 then
-               dTol = 2.81
-            elseif dArea < CoeffVM * 10.0e6 then
-               dTol = 3.77
+            local dTol = 4.71
+            if EmtGetVMillStep then
+               dTol = EmtGetVMillStep( b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), 4.71)
+            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
             -- creo lo Zmap
             local VMillId = EgtVolZmapBox( nPartRawId, b3Raw:getMin(), b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), dTol, true, GDB_RT.GLOB)
@@ -461,6 +469,10 @@ function OnSimulToolSelect( dPosA)
       end
       if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' then
          EgtSetAxisPos( 'Z1', MaxZ1Blade)
+      elseif EMT.HEAD == 'H13' then
+         EgtSetAxisPos( 'Z1', ParkCSawZ1)
+      else
+         EgtSetAxisPos( 'Z1', MaxZ1)
       end
       EgtResetAxisPos( 'C1')
       EgtResetAxisPos( 'B1')
@@ -470,6 +482,8 @@ function OnSimulToolSelect( dPosA)
    end
    -- se sega a catena, imposto subito angolo scelto per asse virtuale A
    if EMT.HEAD == 'H13' then
+      -- se prima lavorazione con motosega, parto dalla sua posizione di parcheggio
+      EgtSetAxisPos( 'X1', ParkCSawX1)
       -- valore dell'asse virtuale
       dPosA = dPosA or GetNextChainSawingVirtualAxis( EMT.MCHID)
       -- imposto il valore di A
@@ -481,6 +495,19 @@ function OnSimulToolSelect( dPosA)
       -- Imposto visualizzazione
       EgtSetMode( EgtGetHeadId( EMT.HEAD) or GDB_ID.NULL, GDB_MD.STD)
    end
+   -- se aggregato foratura multipla, imposto subito angolo scelto per asse virtuale A
+   if EMT.HEAD == 'H14' then
+      -- valore dell'asse virtuale
+      dPosA = dPosA or GetNextMultiDrillVirtualAxis( EMT.MCHID)
+      -- imposto il valore di A
+      EgtSetAxisPos( 'A1', dPosA)
+      -- imposto home dell'asse C1 (A1=0 -> T121, A1=90 -> T124)
+      local MyParkCSawC1 = GetMultiDrillCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
+      EmtModifyAxisHome( 'C1', MyParkCSawC1)
+      EgtSetAxisPos( 'C1', MyParkCSawC1)
+      -- Imposto visualizzazione
+      EgtSetMode( EgtGetHeadId( EMT.HEAD) or GDB_ID.NULL, GDB_MD.STD)
+   end
    -- se lama su aggregato da sotto, imposto subito angolo scelto per asse virtuale A
    if EMT.HEAD == 'H22' then
       -- se c'era un altro utensile, imposto subito asse virtuale
@@ -509,8 +536,10 @@ function OnSimulToolSelect( dPosA)
    EMT.A2n = 'Y2'
    EMT.A3n = 'V1'
    EMT.A4n = 'V2'
-   -- se attivo Vmill
-   EmtSetToolForVmill( 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
@@ -526,7 +555,7 @@ end
 ---------------------------------------------------------------------
 function OnSimulToolDeselect( dPrevA)
    -- se prossimo utensile non cambia e non è sega a catena o lama su rinvio da sotto, esco
-   if ( EMT.NEXTTOOL == EMT.PREVTOOL_H1 or EMT.NEXTTOOL == EMT.PREVTOOL_H2) and EMT.NEXTHEAD ~= 'H13' and ( EMT.NEXTHEAD ~= 'H22' or not dPrevA) then return end
+   if ( EMT.NEXTTOOL == EMT.PREVTOOL_H1 or EMT.NEXTTOOL == EMT.PREVTOOL_H2) and ( EMT.NEXTHEAD ~= 'H13' or EMT.NEXTHEAD ~= 'H14') and ( EMT.NEXTHEAD ~= 'H22' or not dPrevA) then return end
    -- deposito utensile
    EgtOutText( 'Tool change in progress...')
    -- recupero il gruppo attuale e il successivo
@@ -535,8 +564,9 @@ function OnSimulToolDeselect( dPrevA)
    -- se devo deselezionare testa 3, la mando a parcheggio
    if nSetHead == 3 then
       SimulMoveAxis( 'X3', ParkX3, MCH_SIM_STEP.RAPID)
+   end
    -- per testa gruppo 2 
-   elseif nNextSetHead == 2 then
+   if nNextSetHead == 2 then
       -- deposito lama su aggregato testa sotto
       if EMT.PREVHEAD_H2 == 'H22' then
          -- simulo movimento
@@ -553,7 +583,7 @@ function OnSimulToolDeselect( dPrevA)
       -- visualizzo utensile su TcPos
       ShowToolInTcPos( EMT.PREVTCPOS_H2, true)
       -- nascondo l'utensile sulla testa
-      EgtSetStatus( EgtGetHeadId( EMT.PREVHEAD_H2 or '') or GDB_ID.NULL, GDB_ST.OFF)
+      EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H2 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
    -- se testa gruppo 1
    elseif nNextSetHead == 1 and EMT.PREVTCPOS_H1 then
       -- deposito utensile fresa
@@ -589,12 +619,23 @@ function OnSimulToolDeselect( dPrevA)
          end
          SimulMoveAxes( 'B1', ParkCSawB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
          SimulMoveAxis( 'X1', ParkCSawX1, MCH_SIM_STEP.RAPID)
+      -- deposito utensile aggregato foratore multiplo
+      elseif EMT.PREVHEAD_H1 == 'H14' then
+         -- simulo movimento
+         local ParkC1 = EgtGetAxisHomePos( 'C1')
+         if dPrevA then
+            ParkC1 = GetMultiDrillCHomeFromVirtualAxis( dPrevA)
+         end
+         -- simulo movimento
+         SimulMoveAxes( 'B1', ParkMultiDrillB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
+         SimulMoveAxis( 'X1', ParkMultiDrillX1, MCH_SIM_STEP.RAPID)
       -- deposito utensile seconda lama
       elseif EMT.PREVHEAD_H1 == 'H16' then
          -- simulo movimento
          SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
          SimulMoveAxis( 'X1', ParkTc2X1, MCH_SIM_STEP.RAPID)
       end
+
       -- breve pausa
       EgtPause( 100)
       -- visualizzo utensile su TcPos
@@ -602,14 +643,28 @@ function OnSimulToolDeselect( dPrevA)
       -- nascondo l'utensile sulla testa
       EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H1 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
    end
-   -- se passo da testa 1 a 3 o viceversa
+   -- se passo da testa 1 a 3 scarico aggregato
    if nNextSetHead == 3 then
-      -- deposito eventuale sega a catena
-      if EMT.PREVHEAD_H1 == 'H13' then
+      -- deposito utensile prelevato da posizioni speciali
+      if EMT.TCPOS == 'T101' or EMT.TCPOS == 'T111' or EMT.TCPOS == 'T121' then
          -- visualizzo utensile su TcPos
          ShowToolInTcPos( EMT.PREVTCPOS_H1, true)
          -- nascondo l'utensile sulla testa
          EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H1 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
+
+         local sTool, sTcPos, sHead
+         local vTools = EgtGetToolsInCurrSetupPos( DefTcPos1)
+         if vTools and vTools[1] then
+            sTool = vTools[1]
+            sTcPos = DefTcPos1
+            sHead = GetAdjHeadFromTcPos( 1, sTcPos)
+            -- carico l'utensile
+            EgtLoadTool( sHead, 1, sTool)
+            ShowToolInTcPos( DefTcPos1, false)
+         end
+         EMT.PREVTOOL_H1 = sTool
+         EMT.PREVHEAD_H1 = sHead
+         EMT.PREVTCPOS_H1 = DefTcPos1
       end
       SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
    end
@@ -631,6 +686,11 @@ function OnSimulToolDeselect( dPrevA)
       -- simulo movimento
       SimulMoveAxes( 'B1', ParkCSawB1, MCH_SIM_STEP.RAPROT, 'C1', EgtGetAxisHomePos( 'C1'), MCH_SIM_STEP.RAPROT)
       SimulMoveAxes( 'X1', ParkCSawX1, MCH_SIM_STEP.RAPID, 'Z1', ParkCSawZ1, MCH_SIM_STEP.RAPID)
+   -- prendo aggregato multi drill
+   elseif EMT.NEXTHEAD == 'H14' then
+      -- simulo movimento
+      SimulMoveAxes( 'B1', ParkMultiDrillB1, MCH_SIM_STEP.RAPROT, 'C1', EgtGetAxisHomePos( 'C1'), MCH_SIM_STEP.RAPROT)
+      SimulMoveAxes( 'X1', ParkMultiDrillX1, MCH_SIM_STEP.RAPID, 'Z1', ParkMultiDrillZ1, MCH_SIM_STEP.RAPID)
    -- prendo utensile seconda lama
    elseif EMT.NEXTHEAD == 'H16' then
       -- simulo movimento
@@ -654,8 +714,22 @@ end
 
 ---------------------------------------------------------------------
 function OnSimulMachiningStart()
-   -- se lavorazione attuale e precedente con sega a catena con angolo A diverso, devo scaricare e ricaricare
-   if EMT.HEAD == 'H13' and EMT.HEAD == EMT.PREVHEAD_H1 then
+   -- se lavorazione è con gruppo a forare, abilito le altre punte alla lavorazione del VMILL
+   if EMT.HEAD == 'H14' then
+      local OtherTools = EgtGetToolsInCurrSetupPos( 'T121')
+      if OtherTools and #OtherTools > 1 then
+         for i = 1, #OtherTools do
+            if OtherTools[i] ~= '' and OtherTools[i] ~= EMT.TOOL then
+               EmtAddToolForVmill( OtherTools[i], 'H14', i, EMT.VMILL)
+               -- dichiaro utensile per verifica collisioni
+               local nInd = 1011
+               AddToolToCollisionObj( OtherTools[i], 'H14', i, nInd, true)
+            end
+         end
+      end
+   end
+   -- se lavorazione attuale e precedente con sega a catena o aggregato foratore multiplo e con angolo A diverso, devo scaricare e ricaricare
+   if ( EMT.HEAD == 'H13' or EMT.HEAD == 'H14') and EMT.HEAD == EMT.PREVHEAD_H1 then
       local dPrevA = EgtGetAxisPos( 'A1')
       local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
       local dPosA = tonumber( sVal:sub( 4))
@@ -1036,8 +1110,8 @@ function OnSimulMoveStart()
                end
                SimulMoveAxis( 'Z2', Z2Home, MCH_SIM_STEP.RAPID)
                -- Porto la X alla giusta quota
-               if X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
-                  SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
+               if X2Pos > SafeX2RotAxis and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
+                  SimulMoveAxis( 'X2', SafeX2RotAxis, MCH_SIM_STEP.RAPID)
                end
             end
          else
@@ -1046,8 +1120,8 @@ function OnSimulMoveStart()
                SimulMoveAxis( 'Z2', Z2Home, MCH_SIM_STEP.RAPID)
             end
             -- Porto la X alla giusta quota
-            if EMT.ZMAX and X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
-               SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
+            if EMT.ZMAX and X2Pos > SafeX2RotAxis and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
+               SimulMoveAxis( 'X2', SafeX2RotAxis, MCH_SIM_STEP.RAPID)
             end
          end
          if EMT.HEAD == 'H22' then
@@ -1078,7 +1152,9 @@ function OnSimulMoveStart()
                   EMT.L3 = min( EMT.L3, SafeZ3RotAxis)
                   SimulMoveAxis( 'Z3', SafeZ3RotAxis, MCH_SIM_STEP.RAPID)
                   SimulMoveAxes( 'B3', EMT.R2, MCH_SIM_STEP.COLLROT, 'C3', EMT.R1, MCH_SIM_STEP.COLLROT)
-                  SimulMoveAxis( 'Z3', EMT.L3, MCH_SIM_STEP.RAPID)
+                  if ( EMT.L3 - SafeZ3RotAxis) > 100 * GEO.EPS_SMALL then
+                     SimulMoveAxis( 'Z3', EMT.L3, MCH_SIM_STEP.RAPID)
+                  end
                   SimulMoveAxis( 'X3', EMT.L2, MCH_SIM_STEP.RAPID)
                end
             end
@@ -1197,10 +1273,24 @@ function OnSimulMoveStart()
    end
    EMT.ZMAX = nil
    EMT.TO_ZMAX = nil
+
+   -- 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()
+   -- gruppo della testa
+   local nHSet = GetHeadSet( EMT.HEAD)
    -- rimozione eventuali sfridi
    if EMT.FLAG == 301 then 
       ExecRemoveScraps()
@@ -1245,16 +1335,47 @@ function OnSimulMoveEnd()
    if EMT.MOVE == 0 and EMT.FLAG == 3 then
       -- eventuale rimozione sfridi
       ExecRemoveScraps()
+      -- ricavo prossimo utensile
+      local sNextTool = GetNextTool( EMT.MCHID)
+      -- vado in home se è ultimo movimento ed è ultima lavorazione
+      local bToXhome = ( IsLastPath( EMT.PATHID) and not sNextTool and nHSet == 3) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
       -- eseguo
-      ExecMoveZmax( EMT.MCHSPLIT)
+      ExecMoveZmax( EMT.MCHSPLIT, bToXhome)
       EMT.TO_ZMAX = nil
    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
       local Class = ''
       if EMT.SIMCOBIND == 1001 or EMT.SIMCOBIND == 1011 then
          Class = 'T_'..EMT.HEAD
@@ -1415,7 +1536,9 @@ function ExecStartHome()
    EgtResetAxisPos( 'C1')
    EgtResetAxisPos( 'B1')
    -- Testa 2
-   EgtSetAxisPos( 'X2', SafeX2)
+   local _, sHead, _, _, _, _ = FindFirstToolOnHeadSet( 2)
+   local PosXStart = EgtIf( sHead == 'H22', SafeX2, ParkX2)
+   EgtSetAxisPos( 'X2', PosXStart)
    EgtSetAxisPos( 'Z2', MinZ2)
    EgtResetAxisPos( 'C2')
    EgtResetAxisPos( 'B2')
@@ -1424,12 +1547,13 @@ end
 ---------------------------------------------------------------------
 function ExecMoveHome( bNearV, bMchSplit)
    -- risalita a Zmax
-   ExecMoveZmax( bMchSplit)
-   -- se testa sotto e macchian a 3 teste e gruppo truciolatore a 4 assi
+   ExecMoveZmax( bMchSplit, true)
+   -- se testa sotto e macchina a 3 teste
    if GetHeadSet( EMT.HEAD) == 2 and IsHeadExisting( 3) then
-      if not SimulMoveAxis( 'X2', ParkX2, MCH_SIM_STEP.RAPID) then
+      if not SimulMoveAxis( 'X2', EgtIf( EMT.HEAD == 'H22', SafeX2, ParkX2), MCH_SIM_STEP.RAPID) then
          EgtOutLog( 'Error on MoveHome : X2')
       end
+      --  se gruppo truciolatore a 4 assi
       if EgtGetHeadId( 'H39') then
          if not SimulMoveAxis( 'Z2', ParkInLavZ2, MCH_SIM_STEP.RAPID) then
            EgtOutLog( 'Error on MoveHome : Z2')
@@ -1449,7 +1573,7 @@ function ExecMoveHome( bNearV, bMchSplit)
 end
 
 ---------------------------------------------------------------------
-function ExecMoveZmax( bMchSplit)
+function ExecMoveZmax( bMchSplit, bGoToHome)
    -- set della testa
    local nSetHead = GetHeadSet( EMT.HEAD)
    -- posizioni correnti degli assi testa
@@ -1489,6 +1613,9 @@ function ExecMoveZmax( bMchSplit)
             SimulMoveAxis( 'B1', HomeB, MCH_SIM_STEP.COLLROT)
          end
          SimulMoveAxis( 'Z1', MyMaxZ1, MCH_SIM_STEP.RAPID)
+         if bGoToHome then
+            SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
+         end
       -- altrimenti sega a catena
       else
          -- salgo in Z sicurezza raddrizzando la B
@@ -1536,6 +1663,9 @@ function ExecMoveZmax( bMchSplit)
             SimulMoveAxes( 'C3', HomeC, MCH_SIM_STEP.COLLROT, 'B3', HomeB, MCH_SIM_STEP.COLLROT)
          end
          SimulMoveAxis( 'Z3', MyMaxZ3, MCH_SIM_STEP.RAPID)
+         if bGoToHome then
+            SimulMoveAxis( 'X3', ParkX3, MCH_SIM_STEP.RAPID)
+         end
       else
          EmtSetLastError( 1212, "HEAD not managed")
       end
@@ -1970,11 +2100,20 @@ end
 
 ---------------------------------------------------------------------
 function ShowToolInTcPos( sTcPos, bShow)
-   -- recupero il gruppo dell'utensile
-   local TcExitId = EgtGetFirstNameInGroup( EgtGetTcPosId( sTcPos or '') 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 identificativo della posizione sul TC
+   local TcPosId = EgtGetTcPosId( sTcPos or '')
+   if not TcPosId then return end
+   -- ciclo sulle possibili uscite
+   for i = 1, 100 do
+      -- recupero il gruppo dell'utensile
+      local TcExitId = EgtGetFirstNameInGroup( TcPosId, 'T'..tostring( i))
+      if not TcExitId then break end
+      -- imposto lo stato di visualizzazione
+      EgtSetStatus( TcExitId, EgtIf( bShow, GDB_ST.ON, GDB_ST.OFF))
+   end
+   -- 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
 
 ---------------------------------------------------------------------
@@ -1983,6 +2122,10 @@ function LoadFirstTool( nHSet, sTcPosDef)
    EgtUnloadTool( EgtIf( nHSet == 1, 'H11', 'H21'), 1)
    if GetHeadSetFromTcPos( sTcPosDef) ~= nHSet then return end
    local sTool, sHead, sTcPos, sTTotLen, sTotDiam, sBlockedAxis = FindFirstToolOnHeadSet( nHSet)
+   -- se primo utensile motosega, non lo carico e visualizzo quello di default
+   if sHead == 'H13' then
+      sTool = nil
+   end
    if not sTool then
       local vTools = EgtGetToolsInCurrSetupPos( sTcPosDef)
       if vTools and vTools[1] then
@@ -2509,6 +2652,33 @@ function GetNextChainSawingVirtualAxis( MchId)
    return dPosA
 end
 
+---------------------------------------------------------------------
+function GetNextMultiDrillVirtualAxis( MchId)
+   -- recupero la lavorazione successiva
+   local NextMchId
+   if MchId then
+      NextMchId = EgtGetNextActiveOperation( MchId)
+   else
+      NextMchId = EgtGetFirstActiveOperation()
+   end
+   while NextMchId and EgtGetOperationType( NextMchId) == MCH_OY.DISP do
+      NextMchId = EgtGetNextActiveOperation( NextMchId)
+   end
+   -- verifico sia un taglio con sega a catena
+   if EgtGetOperationType( NextMchId) ~= MCH_OY.DRILLING then
+      return nil
+   end
+   -- la imposto come lavorazione corrente
+   EgtSetCurrMachining( NextMchId)
+   -- recupero il valore dell'asse virtuale bloccato A
+   local dPosA = GetCurrMultiDrillVirtualAxis()
+   -- ripristino la lavorazione corrente
+   if MchId then
+      EgtSetCurrMachining( MchId)
+   end
+   return dPosA
+end
+
 ---------------------------------------------------------------------
 function GetCurrSawingVirtualAxis()
    -- recupero il valore dell'asse virtuale bloccato A
@@ -2555,6 +2725,11 @@ function GetStartMachiningXaxis( nMchId)
    end
 end
 
+---------------------------------------------------------------------
+function IsLastPath( nPathId)
+   return not EgtGetNext( nPathId)
+end
+
 ---------------------------------------------------------------------
 function RollerParkingNeeded( sHead, dAng1p, dAng2p, dAng1, dAng2)
    if sHead == 'H11' or sHead == 'H12' or sHead == 'H13' or sHead == 'H16' then
@@ -2562,7 +2737,7 @@ function RollerParkingNeeded( sHead, dAng1p, dAng2p, dAng1, dAng2)
    elseif sHead == 'H21' or sHead == 'H22' then
       return ( abs( dAng1 - dAng1p) > 1 or ( abs( dAng2 - dAng2p) > 1 and abs( dAng1 % 180.0) > 1))
    elseif sHead == 'H38' 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)
    end
 end
 

Common_PF1250.mlse

@@ -77,6 +77,8 @@ function OnSpecialGetMaxZ()
             EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
          elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
             EMC.MAXZ = ParkZ1 + 200
+         elseif vtTp:getZ() > 0.5 or vtT:getZ() > 0.5 then
+            EMC.MAXZ = ParkZ1 + 100
          else
             EMC.MAXZ = ParkZ1 + 1
          end
@@ -95,6 +97,8 @@ function OnSpecialGetMaxZ()
             EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
          elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
             EMC.MAXZ = ParkZ1 + 200
+         elseif vtTp:getZ() > 0.5 or vtT:getZ() > 0.5 then
+            EMC.MAXZ = ParkZ1 + 100
          else
             EMC.MAXZ = ParkZ1 + 1
          end
@@ -205,7 +209,7 @@ local SIC_V = 50                   -- sicurezza da testa
 local MIN_ENG_V = 115              -- ingombro asse Z
 local MIN_ENG_RACK_V = 161         -- ingombro asse Z con cremagliera
 local MIN_ENG_XZ2_V = 180          -- ingombro assi XZ sotto
-local MIN_Z2_FOR_ENG_XZ2_V = 270   -- quota Z2 da cui considerare ingombro assi XZ sotto
+local MIN_Z2_FOR_ENG_XZ2_V = 250   -- quota Z2 da cui considerare ingombro assi XZ sotto
 local AGG_V = MinDeltaYV           -- ingombro rulli pressori + sicurezza
 local MaxLenSmT = 1500             -- massima lunghezza pezzo scaricato con nastri verdi
 local DIST_Y1MAX_LOAD = 100        -- distanza carrello Y1 da massimo asse al carico

Essetre-PF1250.mlde

@@ -30,9 +30,9 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '2.6k3'
-PP_NVER = '2.6.11.3'
-MIN_MACH_VER = '2.5k1'
+PP_VER = '2.7d2'
+PP_NVER = '2.7.4.2'
+MIN_MACH_VER = '2.7d2'
 MACH_NAME = 'Essetre-PF1250'
 
 -- Carico i dati globali
@@ -137,6 +137,7 @@ MinB2b = -119
 MaxB2b = 119
 ParkX2 = -100
 SafeX2 = -400
+SafeX2RotAxis = -1000
 ParkZ2 = 0
 ParkC2 = -90
 ParkB2 = -90
@@ -155,7 +156,6 @@ Head2Y = DeltaTabY - Delta2TabY
 Head2Z = DeltaTabZ - Delta2TabZ
 DefTcPos1 = 'T1'
 DefTcPos2 = 'T30'
-CoeffVM = 0.5
 MinForzaPinze = 400                              -- [Kgf]
 MaxForzaPinze = 1000                             -- [Kgf]
 Tc2Active = true
@@ -244,6 +244,7 @@ if EgtExistsFile( sDataBeam) then
          if Machine.Offsets.DEFTCPOS2 then DefTcPos2 = ( 'T' .. Machine.Offsets.DEFTCPOS2) end
          if Machine.Offsets.MINPRESS then MinForzaPinze = Machine.Offsets.MINPRESS end
          if Machine.Offsets.MAXPRESS then MaxForzaPinze = Machine.Offsets.MAXPRESS end
+         if Machine.Offsets.MAXFEEDPINZE then MaxFeedPinze = Machine.Offsets.MAXFEEDPINZE end
          if Machine.Offsets.CHIUDI_PINZE_2_3_SCAMBIO then ForceToCloseRollersGate = Machine.Offsets.CHIUDI_PINZE_2_3_SCAMBIO == 1 end
          if Machine.Offsets.WOOD_DENSITY then WoodDensity = Machine.Offsets.WOOD_DENSITY end
          if Machine.Offsets.MOTORS23KW then Motors23KW = Machine.Offsets.MOTORS23KW == 1 end
@@ -276,6 +277,7 @@ EmtGeneral {
       ExitMaxAdjust = 300,
       ExitMaxRotAdj = 0.5,
       AngDeltaMinForHome = 80,
+      LinkAxesMoveOrder = MCH_LKAMO.HEAD_BEFORE_IF_SAME_ANG,
       Special = 'Common_PF1250.mlse',
       Processor = 'Common_PF1250.mlpe'}
 -- in base alla corsa macchina, si carica la rulliera di carico/scarico appropriata
@@ -1125,6 +1127,37 @@ function GetPY2Light()
    return ( EgtGetInfo( PY2LightId, 'On') == '1')
 end
 
+---------------------------------------------------------------------
+-- Funzione per impostare la posizione del rinvio flottante
+function SetFloatPos( sHead, dPos)
+   -- recupero Id testa
+   local nHeadId = EgtGetHeadId( sHead)
+   if not nHeadId then return false end
+   -- se ci sono entità flottanti nel ToolHolder
+   local nRefId = EgtGetFirstNameInGroup( nHeadId, '_T1')
+   local vtTool = EgtFR( nRefId, GDB_ID.ROOT):getVersZ() 
+   local nObjId =  EgtGetFirstGroupInGroup( EgtGetFirstNameInGroup( nHeadId, 'T1'))
+   local FloatEntities = EgtGetInfoInGroup( nObjId, 'Float')
+   if FloatEntities and #FloatEntities > 0 then
+      -- il porta-utensile flottante non può comprimersi più di 10mm
+      if dPos > 10 then
+         local sErr = 'Floating Ring compressed more than 10mm'
+         EmtSetLastError( 1222, sErr)
+         EgtOutLog( 'Error : ' .. sErr, 1)
+      end
+      local dFloat = EgtGetInfo( FloatEntities[1], 'Float', 'd')
+      if abs( dPos - dFloat) > 10 * GEO.EPS_SMALL then
+         local vtMove = ( dPos - dFloat) * vtTool
+         -- sposto tutte le entità flottanti
+         for i = 1, #FloatEntities do
+            EgtMove( FloatEntities[i], vtMove, GDB_RT.GLOB)
+            EgtSetInfo( FloatEntities[i], 'Float', dPos)
+         end
+      end
+      return true
+   end
+   return false
+end
 
 ---------------------------------------------------------------------
 -- Funzione per resettare tutte le attivazioni della macchina
@@ -1133,6 +1166,9 @@ function OnResetMachine()
    EmtUnlinkAllFixturesFromGroups()
    SetPY1Light( false)
    SetPY2Light( false)
+   --resetto eventuale flottante
+   SetFloatPos( 'H11', 0)
+   SetFloatPos( 'H21', 0)
    -- nascondo Vmill
    local nRawId = EgtGetFirstRawPart()
    while nRawId do

MachNotes.ini

@@ -7,18 +7,19 @@
 [Sawing]
 
 [Milling]
-0=d,MaxElev,0
+0=l,MaxElev,0
 1=d,OutRaw,0
-2=d,SideElev,0
+2=l,SideElev,0
 3=d,TrimExt,0
-4=sr,VtFaceUse,0,0,0
+4=s,VtFaceUse,0,0,0
+5=s,EdgesFaceUse,0
 
 [Pocketing]
-0=d,MaxElev,0
+0=l,MaxElev,0
 1=b,Open,0
-2=d,OpenMinSave,0
+2=d,OpenMinSafe,0
 3=d,OpenOutRaw,0
-4=d,MaxOptSize,0
+4=l,MaxOptSize,0
 
 [Mortising]
 0=d,MaxElev,0
@@ -30,21 +31,28 @@
 [SawFinishing]
 
 [GenMachining]
-0=l,LinTol,0.1
-1=l,MaxLen,2
-2=s,Type,ZigZag
-3=d,SideAng,90
-4=l,Step,10
-5=l,OffsProj,0
-6=l,LiTang,0
-7=l,LiOrth,0
-8=l,LiElev,0
-9=l,LoTang,0
-10=l,LoOrth,0
-11=l,LoElev,0
-12=b,DirFromGuide,1
 
 [SurfRoughing]
+0=l,MaxElev,1000
+1=b,PlaneZ,0
 
 [SurfFinishing]
 0=b,SkipMaxDown,1
+
+[5AxMilling]
+0=l,LinTol,0.01
+1=l,MaxLen,10
+2=s,Type,ZigZag
+3=d,SideAng,90
+4=l,Step,10
+5=d,AngIni,-90
+6=d,AngFin,90
+7=l,LiTang,0
+8=l,LiOrth,0
+9=l,LiElev,0
+10=l,LoTang,0
+11=l,LoOrth,0
+12=l,LoElev,0
+13=b,DirFromGuide,0
+14=b,SurfAvoid,0
+

ToolNotes.ini

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

UpdateLog.txt

@@ -1,5 +1,69 @@
            ==== Common_PF1250 Update Log ====
 
+Versione 2.7d2 (24/04/2025)
+- (SIM) Modifica qualità VMILL. Da ora si può impostare da impostazioni CAM5
+
+Versione 2.7d1 (01/04/2025)
+- (GEN) Aggiunta commenti HEADER e FOOTER per comunicazione con linea o altre macchine, da parte di Essetre.
+
+Versione 2.7b5 (26/02/2025)
+- (MLDE-GEN) Gestione lettura feed massima pinze da Ts3.
+
+Versione 2.7b4 (21/02/2025)
+- (SIM-GEN) Ripristinato comportamento precedente calcolo posizione dei rulli di pinzaggio fatto con 2.7b2.
+- (MLDE-SIM) Gestione aggregato flottante. Serve modifica MLDE. Ticket#2297
+
+Versione 2.7b3 (06/02/2025)
+- (SIM) Dopo aver scaricato utensile, si setta nota "HIDDEN" per dichiarare utensile non più sulla testa e non considerare le collisioni.
+
+Versione 2.7b2 (04/02/2025)
+- (SIM-GEN) Piccola modifica nel calcolo posizione dei rulli di pinzaggio.
+
+Versione 2.7b1 (03/02/2025)
+- (SIM) Corretta simulazione che non mandava testa in home in caso di utensile lungo. Generazione era già ok. Ticket#2280
+
+Versione 2.7a2 (28/01/2025)
+- (SIM-GEN) In MLSE aggiunta piccola correzione quota Z in caso di direzione Z tra 0.5 e 0.707.
+
+Versione 2.7a1 (17/01/2025)
+- (GEN) Piccola correzione posizione X in preselezione utensile
+- (GEN) Corretto primo punto X preselezione utensile. Ticket#2183 e #2250
+
+Versione 2.6l7 (19/12/2024)
+- (SIM) HOTFIX : corretto posizione Z zero alla selezione dell'utensile in caso di motosega. Ticket#2235
+
+Versione 2.6l6 (18/12/2024)
+- (MLDE-SIM-GEN) Aggiunta variabile 'SafeX2RotAxis' in sostituzione della 'ParkMchY2' che era usata impropriamente
+
+Versione 2.6l5 (17/12/2024)
+- (SIM) Corretta posizione iniziale testa 2. Ticket#2228
+
+Versione 2.6l4 (16/12/2024)
+- (SIM-GEN) In MLSE ripristinati vecchi valori indici calcolo Z massima. In alcuni casi peggioravano la situazione.
+
+Versione 2.6l3 (16/12/2024)
+- (SIM) Corretto scarico utensile se aggregato. Se non presente utensile di default, non seleziona nulla.
+- (SIM-GEN) In MLSE ritoccati indici calcolo Z massima. Ticket#2210
+
+Versione 2.6l2 (13/12/2024)
+- (SIM) Corretta chiamata calcolo asse virtuale
+
+Versione 2.6l1 (13/12/2024)
+- (SIM) Gestione caricamento utensili in caso di testa con uscita multipla.
+- (SIM) Corretto errore di collisione per errata simulazione cambio utensile da lama a motosega.
+- (SIM-GEN) Corretta gestione in caso di prima lavorazione con motosega.
+- (GEN) Non si fa preselezione della testa 3
+- (GEN) Corretta emissione coordinata rotazione testa 3 in zona sicura
+- (SIM-GEN) A fine barra, testa 3 sempre in home
+- (GEN) Controllo esistenza terzo asse ausiliario
+- (GEN) Corretto primo movimento in X quando si parte con testa 3. Ticket#2216
+- (GEN) Se su testa 1 c'è un aggregato e si utilizzerà la testa 3, si scarica aggregato e si prende utensile di default. Ticket#2222
+- (GEN) Durante utilizzo della testa 3, non si preselezionano altre teste. Ticket#2220
+- (SIM-GEN) Se lavorazione con testa dedicata lama e su testa 1 c'era aggregato, viene scaricato. Ticket#2216
+
+Versione 2.6k3 (26/11/2024) 
+- (GEN) Corretta modifica fatta in versione 2.6k2. Ticket#2183
+
 Versione 2.6k2 (25/11/2024)
 - (GEN) Se si preseleziona su testa 1 un utensile lungo, non si va alla X successiva di lavoro ma si resta in home. Infatti potrebbe toccare le paratie in caso di scambio pezzo. Ticket#2183
 

Version.lua

@@ -3,7 +3,7 @@
 
 local InfoCommon_STD_PP = {
    NAME = 'Common_PF1250',            -- nome script PP standard
-   VERSION = '2.6k2',                 -- versione script
+   VERSION = '2.7d2',                 -- versione script
    MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
 }