Se tasca con motosega in faccia sopra e pezzo alto, si ruota in sicurezza

- Aggiungendo OnSpecialApplyMachining, ora la OnSpecialGetPrevMachiningOffset lavora correttamente. ATT: MIN_MACH -> 3.1b2

Common_ONE-PF.mlpe

@@ -96,6 +96,10 @@ function OnSimulStart()
    if DefTcPos2 then
       LoadFirstTool( 2, DefTcPos2)
    end
+
+   -- se presenti, nascondo i tastatori
+   DeactivateProbeTool()
+
    ExecStartHome()
    -- Se reset o home, esco
    if EMT.SIM1ST then return end
@@ -130,7 +134,8 @@ function OnSimulStart()
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'TC1'},
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'TC2'},
                      { Grp = 'Base', Sub = 'BELT', Name = 'COLLISION'},
-                     { Grp = 'X1', Sub = 'COLLISION', Name = 'STM'}}
+                     { Grp = 'X1', Sub = 'COLLISION', Name = 'STM'},
+                     { Grp = 'X1', Sub = 'COLLISION', Name = 'STM2'}}
    
    if EgtGetHeadId( 'H21') then
       table.insert( McdData, { Grp = 'X2', Sub = 'COLLISION', Name = 'STM'})
@@ -513,9 +518,11 @@ function OnSimulToolSelect( dPosA)
    EMT.TDIAM = EgtTdbGetCurrToolParam( MCH_TP.DIAM)
    EMT.TUSERNOTES = EgtTdbGetCurrToolParam( MCH_TP.USERNOTES)
    local nSetHead = GetHeadSet( EMT.HEAD)
+   local bIsFirstHead = ( nSetHead == 1 or nSetHead == 11)
+   EMT.ISPROBING = HeadIsProbe( EMT.HEAD)
    -- se ho due teste, verifico che l'altra sia dalla parte opposta
    if EgtGetHeadId( 'H21') then
-      if nSetHead == 1 then
+      if bIsFirstHead then
          EgtSetAxisPos( 'X2', MinX2)
       else
          EgtSetAxisPos( 'X1', MaxX1)
@@ -551,6 +558,75 @@ function OnSimulToolSelect( dPosA)
       -- Imposto visualizzazione
       EgtSetMode( EgtGetHeadId( EMT.HEAD) or GDB_ID.NULL, GDB_MD.STD)
    end
+
+   -- se tastatore
+   if HeadIsProbe( EMT.HEAD) then
+      local bChanged = true
+      if bIsFirstHead then
+         -- se prossimo utensile compatibile, lo prelevo
+         if IsToolCompatibleWithProbe( EMT.PROBENEXTTOOL_H1, EMT.TOOL) then
+            ShowToolInTcPos( EMT.PREVTCPOS_H1, true)
+            EgtLoadTool( EMT.PROBENEXTHEAD_H1, 1, EMT.PROBENEXTTOOL_H1)
+            EMT.TCPOS = EMT.PROBENEXTTCPOS_H1
+            EMT.HEAD = EMT.PROBENEXTHEAD_H1
+            EMT.TOOL = EMT.PROBENEXTTOOL_H1
+         else
+            -- se vecchio utensile compatibile, tengo quello caricato
+            if IsToolCompatibleWithProbe( EMT.PREVTOOL_H1, EMT.TOOL) then
+               bChanged = false
+               EMT.TCPOS = EMT.PREVTCPOS_H1
+               EMT.TOOL = EMT.PREVTOOL_H1
+               EMT.HEAD = EMT.PREVHEAD_H1
+            -- altrimenti si seleziona utensile di default
+            else
+               ExecMoveZmax( EMT.MCHSPLIT, true)
+               EMT.TCPOS = DefTcPos1
+               EMT.TOOL = GetToolNameFromTcPos( DefTcPos1)
+               EMT.HEAD, _ = GetToolHead( EMT.TOOL)
+               ShowToolInTcPos( EMT.PREVTCPOS_H1, true)
+               EgtLoadTool( EMT.HEAD, 1, EMT.TOOL)
+            end
+         end
+         -- se cambiato utensile, si setta subito nome precedente
+         if bChanged then
+            EMT.PREVTOOL_H1 = EMT.TOOL
+            EMT.PREVHEAD_H1 = EMT.HEAD
+            EMT.PREVTCPOS_H1 = EMT.TCPOS
+         end
+      else
+         -- se prossimo utensile compatibile, lo prelevo
+         if IsToolCompatibleWithProbe( EMT.PROBENEXTTOOL_H2, EMT.TOOL) then 
+            ShowToolInTcPos( EMT.PREVTCPOS_H2, true)
+            EgtLoadTool( EMT.PROBENEXTHEAD_H2, 1, EMT.PROBENEXTTOOL_H2)
+            EMT.TCPOS = EMT.PROBENEXTTCPOS_H2
+            EMT.HEAD = EMT.PROBENEXTHEAD_H2
+            EMT.TOOL = EMT.PROBENEXTTOOL_H2
+         else
+            -- se vecchio utensile compatibile, tengo quello caricato
+            if IsToolCompatibleWithProbe( EMT.PREVTOOL_H2, EMT.TOOL) then
+               bChanged = false
+               EMT.TCPOS = EMT.PREVTCPOS_H2
+               EMT.TOOL = EMT.PREVTOOL_H2
+               EMT.HEAD = EMT.PREVHEAD_H2
+            -- altrimenti si seleziona utensile di default
+            else
+               ExecMoveZmax( EMT.MCHSPLIT, true)
+               EMT.TCPOS = DefTcPos2
+               EMT.TOOL = GetToolNameFromTcPos( DefTcPos2)
+               EMT.HEAD, _ = GetToolHead( EMT.TOOL)
+               ShowToolInTcPos( EMT.PREVTCPOS_H2, true)
+               EgtLoadTool( EMT.HEAD, 1, EMT.TOOL)
+            end
+         end
+         -- se cambiato utensile, si setta subito nome precedente
+         if bChanged then
+            EMT.PREVTOOL_H2 = EMT.TOOL
+            EMT.PREVHEAD_H2 = EMT.HEAD
+            EMT.PREVTCPOS_H2 = EMT.TCPOS
+         end
+      end
+   end
+   
    -- carico utensile, con breve pausa
    EgtPause( 100)
    EgtOutText( '')
@@ -619,10 +695,57 @@ function OnSimulToolDeselect( dPrevA)
          LoadNextTool( 2, DefTcPos2)
       end
    end
+
+   -- se presenti, nascondo i tastatori
+   DeactivateProbeTool()
+   local bSkipToolChange = false
+   -- se prossima lavorazione è tastatura, si controlla compatibilità con utensile successivo
+   if HeadIsProbe( EMT.NEXTHEAD) then
+      local idProbeMachining = EgtGetNextActiveOperation( EMT.MCHID)
+      local bFound = false
+      local nProbeHead = GetHeadSet( EMT.NEXTHEAD)
+      local idProbeNextMachining = EgtGetNextActiveOperation( idProbeMachining)
+      while not bFound do
+         if idProbeNextMachining then
+            EgtSetCurrMachining( idProbeNextMachining)
+            local sToolNameNextProbe = EgtGetMachiningParam( MCH_MP.TOOL)
+            if sToolNameNextProbe then
+               local sToolHeadNextProbe, sToolTcPosNextProbe = GetToolHead( sToolNameNextProbe)
+               local nToolHead = GetHeadSet( sToolHeadNextProbe)
+               -- se sono sulla stessa testa
+               if nToolHead == 1 and nProbeHead == 11 then
+                  EMT.PROBENEXTTOOL_H1 = sToolNameNextProbe
+                  EMT.PROBENEXTHEAD_H1 = sToolHeadNextProbe
+                  EMT.PROBENEXTTCPOS_H1 = sToolTcPosNextProbe
+                  bFound = true
+               elseif nToolHead == 2 and nProbeHead == 21 then
+                  EMT.PROBENEXTTOOL_H2 = sToolNameNextProbe
+                  EMT.PROBENEXTHEAD_H2 = sToolHeadNextProbe
+                  EMT.PROBENEXTTCPOS_H2 = sToolTcPosNextProbe
+                  bFound = true
+               end
+            end
+         else
+            break
+         end
+         idProbeNextMachining = EgtGetNextActiveOperation( idProbeNextMachining)
+      end
+      -- ripristino lavorazione corrente
+      EgtSetCurrMachining( EMT.MCHID)
+
+      if nProbeHead == 11 and not( IsToolCompatibleWithProbe( EMT.PREVTOOL_H1, EMT.TOOL)) then
+         ;
+      elseif nProbeHead == 21 and not( IsToolCompatibleWithProbe( EMT.PREVTOOL_H2, EMT.TOOL)) then
+         ; 
+      else
+         bSkipToolChange = true
+      end
+   end
+
    -- reset flag sega a catena già depositata
    EMT.CHSAW_OUT = nil
    -- se utensile non cambia e non è sega a catena, esco
-   if ( EMT.NEXTTOOL == EMT.PREVTOOL_H1 or EMT.NEXTTOOL == EMT.PREVTOOL_H2) and not HeadIsChainSaw( EMT.NEXTHEAD) then return end
+   if bSkipToolChange or ( ( EMT.NEXTTOOL == EMT.PREVTOOL_H1 or EMT.NEXTTOOL == EMT.PREVTOOL_H2) and not HeadIsChainSaw( EMT.NEXTHEAD)) then return end
    -- deposito utensile
    EgtOutText( 'Tool change in progress...')
    -- se prossimo utensile sega a catena, devo mettere in home testa 1 e depositare l'utensile sulla testa 2 o viceversa
@@ -631,7 +754,7 @@ function OnSimulToolDeselect( dPrevA)
       -- se ci sono due teste
       if EgtGetHeadId( 'H21') then
          local nSetHead = GetHeadSet( EMT.NEXTHEAD)
-         if nSetHead == 1 then
+         if nSetHead == 1 or nSetHead == 11 then
             -- porto in home testa 1
             SimulMoveAxis( 'X1', MaxX1, MCH_SIM_STEP.RAPID)
             -- deposito utensile fresa
@@ -687,7 +810,7 @@ function OnSimulToolDeselect( dPrevA)
       if nSetHead == 1 and EMT.PREVHEAD_H1 then
          local MyParkX1 = EgtIf( GetHeadTCSet( EMT.HEAD, EMT.TCPOS) == 'Head1_TC1', ParkX1, ParkFrnX1)
          SimulMoveAxis( 'X1', MyParkX1, MCH_SIM_STEP.RAPID)
-      elseif EMT.PREVHEAD_H2 then
+      elseif nSetHead == 2 and EMT.PREVHEAD_H2 then
          SimulMoveAxis( 'X2', ParkX2, MCH_SIM_STEP.RAPID)
       end
    end
@@ -718,7 +841,7 @@ function OnSimulToolDeselect( dPrevA)
          SimulMoveAxis( 'Z2', ParkCSawZ2, MCH_SIM_STEP.RAPID)
       end
    -- per prossima testa gruppo 1
-   else
+   elseif nNextSetHead == 1 then
       -- visualizzo utensile su TcPos
       ShowToolInTcPos( EMT.PREVTCPOS_H1, true)
       -- nascondo l'utensile sulla testa
@@ -851,6 +974,7 @@ function OnSimulMachiningEnd()
    EMT.DOU_TOOL = nil
    -- salvo dati utensile
    local nSetHead = GetHeadSet( EMT.HEAD)
+
    -- se non ho già tolto la sega a catena, aggiorno valori
    if not EMT.CHSAW_OUT then
    -- per gruppo testa 1
@@ -1093,13 +1217,20 @@ function OnSimulMoveStart()
                EMT.CHSAW_OUT = nil
             end
             -- se motosega configurata per lavorazioni di fianco o circa orizzontale
-            if dPosA == 0  or  abs( EMT.R2) < 10 then
+            if abs( dPosA) < 0.1  or abs( EMT.R2) < 10 then
                SimulMoveAxes( 'X1', EMT.L2, MCH_SIM_STEP.RAPID, 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
                SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
             -- se circa verticale
             else
-               SimulMoveAxes( 'X1', EMT.L2, MCH_SIM_STEP.RAPID, 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
-               SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+               -- se arrivo da ZMAX e il pezzo è abbastanza alto, si ruota fuori
+               if EMT.ZMAX and EMT.SB > MaxVeOpen / 2 then
+                  SimulMoveAxes( 'X1', LimX1RotSaw, MCH_SIM_STEP.RAPID, 'C1', 90, MCH_SIM_STEP.COLLROT)
+                  SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                  SimulMoveAxes( 'X1', EMT.L2, MCH_SIM_STEP.RAPID, 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
+               else
+                  SimulMoveAxes( 'X1', EMT.L2, MCH_SIM_STEP.RAPID, 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
+                  SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+               end
             end
          end
       -- altrimenti testa 2
@@ -1112,7 +1243,7 @@ function OnSimulMoveStart()
                   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
@@ -1167,13 +1298,20 @@ function OnSimulMoveStart()
                   EMT.CHSAW_OUT = nil
                end
                -- se motosega configurata per lavorazioni di fianco o circa orizzontale
-               if dPosA == 0  or  abs( EMT.R2) < 10 then
+               if abs( dPosA) < 0.1  or  abs( EMT.R2) < 10 then
                   SimulMoveAxes( 'X1', EMT.L2, MCH_SIM_STEP.RAPID, 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
                   SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
                -- se circa verticale
                else
-                  SimulMoveAxes( 'X1', EMT.L2, MCH_SIM_STEP.RAPID, 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
-                  SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                  -- se arrivo da ZMAX e il pezzo è abbastanza alto, si ruota fuori
+                  if EMT.ZMAX and EMT.SB > MaxVeOpen / 2 then
+                     SimulMoveAxes( 'X1', LimX1RotSaw, MCH_SIM_STEP.RAPID, 'C1', 90, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxes( 'X1', EMT.L2, MCH_SIM_STEP.RAPID, 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
+                  else
+                     SimulMoveAxes( 'X1', EMT.L2, MCH_SIM_STEP.RAPID, 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+                  end
                end
             end
          else
@@ -1251,13 +1389,20 @@ function OnSimulMoveStart()
                   EMT.CHSAW_OUT = nil
                end
                -- se motosega configurata per lavorazioni di fianco o circa orizzontale
-               if dPosA == 0  or  abs( EMT.R2) < 10 then
+               if abs( dPosA) < 0.1  or  abs( EMT.R2) < 10 then
                   SimulMoveAxes( 'X2', EMT.L2, MCH_SIM_STEP.RAPID, 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
                   SimulMoveAxes( 'Z2', EMT.L3, MCH_SIM_STEP.RAPID, 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
                -- se circa verticale
                else
-                  SimulMoveAxes( 'X2', EMT.L2, MCH_SIM_STEP.RAPID, 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
-                  SimulMoveAxes( 'Z2', EMT.L3, MCH_SIM_STEP.RAPID, 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
+                  -- se arrivo da ZMAX e il pezzo è abbastanza alto, si ruota fuori
+                  if EMT.ZMAX and EMT.SB > MaxVeOpen / 2 then
+                     SimulMoveAxes( 'X2', LimX1RotSaw, MCH_SIM_STEP.RAPID, 'C2', 90, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxes( 'Z2', EMT.L3, MCH_SIM_STEP.RAPID, 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxes( 'X2', EMT.L2, MCH_SIM_STEP.RAPID, 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
+                  else
+                     SimulMoveAxes( 'X2', EMT.L2, MCH_SIM_STEP.RAPID, 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxes( 'Z2', EMT.L3, MCH_SIM_STEP.RAPID, 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
+                  end
                end
             end
          end
@@ -1657,16 +1802,50 @@ function ExecMoveZmax( bMchSplit, btoXHome)
    -- set della testa
    local nSetHead = GetHeadSet( EMT.HEAD)
    if nSetHead == 0 then return end
+   local bIsFirstHead = ( nSetHead == 1 or nSetHead == 11)
+
+   if EMT.ISPROBING then
+      -- se lavorazione successiva con stessa testa non si va a Z massima
+      local sToolNameNextProbe
+      local idProbeNextMachining = EgtGetNextActiveOperation( EMT.MCHID)
+      if idProbeNextMachining then
+         EgtSetCurrMachining( idProbeNextMachining)
+         sToolNameNextProbe = EgtGetMachiningParam( MCH_MP.TOOL)
+         EgtSetCurrMachining( EMT.MCHID)
+      end
+      local bMoveToZMax = true
+      if sToolNameNextProbe and bIsFirstHead and EMT.PREVTOOL_H1 == sToolNameNextProbe then
+         bMoveToZMax = false
+      elseif sToolNameNextProbe and not bIsFirstHead and EMT.PREVTOOL_H2 == sToolNameNextProbe then
+         bMoveToZMax = false
+      end
+      -- se non serve alzarsi
+      if not bMoveToZMax then
+         local vtE = Vector3d( EMT.EXTR)
+         local ProbePosZ
+         -- ci si riporta in posizione fuori ingombro pezzo
+         if AreSameVectorApprox( vtE, Y_AX()) or AreSameVectorApprox( vtE, -Y_AX()) then
+            ProbePosZ = EMT.TABORI1[3] + EMT.SB
+            if nSetHead == 1 then
+               SimulMoveAxis( 'Z1', ProbePosZ, MCH_SIM_STEP.RAPID)
+            else
+               SimulMoveAxis( 'Z2', ProbePosZ, MCH_SIM_STEP.RAPID)
+            end
+         end
+         return
+      end
+   end
+
    -- posizioni correnti degli assi testa
-   local CurrX = EgtGetAxisPos( EgtIf( nSetHead == 1, 'X1', 'X2'))
-   local CurrZ = EgtGetAxisPos( EgtIf( nSetHead == 1, 'Z1', 'Z2'))
-   local CurrC = EgtGetAxisPos( EgtIf( nSetHead == 1, 'C1', 'C2'))
-   local CurrB = EgtGetAxisPos( EgtIf( nSetHead == 1, 'B1', 'B2'))
+   local CurrX = EgtGetAxisPos( EgtIf( bIsFirstHead, 'X1', 'X2'))
+   local CurrZ = EgtGetAxisPos( EgtIf( bIsFirstHead, 'Z1', 'Z2'))
+   local CurrC = EgtGetAxisPos( EgtIf( bIsFirstHead, 'C1', 'C2'))
+   local CurrB = EgtGetAxisPos( EgtIf( bIsFirstHead, 'B1', 'B2'))
    -- posizioni home degli assi testa
-   local HomeX = EgtGetAxisHomePos( EgtIf( nSetHead == 1, 'X1', 'X2'))
-   local HomeZ = EgtGetAxisHomePos( EgtIf( nSetHead == 1, 'Z1', 'Z2'))
-   local HomeC = EgtGetAxisHomePos( EgtIf( nSetHead == 1, 'C1', 'C2'))
-   local HomeB = EgtGetAxisHomePos( EgtIf( nSetHead == 1, 'B1', 'B2'))
+   local HomeX = EgtGetAxisHomePos( EgtIf( bIsFirstHead, 'X1', 'X2'))
+   local HomeZ = EgtGetAxisHomePos( EgtIf( bIsFirstHead, 'Z1', 'Z2'))
+   local HomeC = EgtGetAxisHomePos( EgtIf( bIsFirstHead, 'C1', 'C2'))
+   local HomeB = EgtGetAxisHomePos( EgtIf( bIsFirstHead, 'B1', 'B2'))
    -- verifico se necessario ruotare la testa
    local bRot = ( abs( HomeC - CurrC) > 1 or abs( HomeB - CurrB) > 1)
    -- se necessario ruotare la testa, allargo i carrelli
@@ -1677,7 +1856,7 @@ function ExecMoveZmax( bMchSplit, btoXHome)
       ExecParkRoller( nil, nil, nil, nil, bMchSplit, bAgg)
    end
    -- se testa 1
-   if nSetHead == 1 then
+   if bIsFirstHead then
       -- se fresa o lama
       if GetHeadTCSet( EMT.HEAD, EMT.TCPOS) == 'Head1_TC1' then
          if not HeadIsChainSaw( EMT.HEAD) then
@@ -1714,6 +1893,11 @@ function ExecMoveZmax( bMchSplit, btoXHome)
             end
          -- altrimenti sega a catena
          else
+            -- se configurazione per lavorare dall'alto e il pezzo è abbastanza alto, si ruota fuori
+            if EMT.SB > MaxVeOpen / 2 and abs( EMT.R3) > 0.1 and abs( EMT.R2) > 70 then
+               SimulMoveAxes( 'X1', LimX1RotSaw, MCH_SIM_STEP.RAPID, 'C1', 90, MCH_SIM_STEP.COLLROT)
+            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)
@@ -1737,6 +1921,28 @@ function ExecMoveZmax( bMchSplit, btoXHome)
             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
+            -- se configurazione per lavorare dall'alto e il pezzo è abbastanza alto, si ruota fuori
+            if EMT.SB > MaxVeOpen / 2 and abs( EMT.R3) > 0.1 and abs( EMT.R2) > 70 then
+                  SimulMoveAxes( 'X1', LimX1RotSaw, MCH_SIM_STEP.RAPID, 'C1', 90, MCH_SIM_STEP.COLLROT)
+            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)
@@ -1746,9 +1952,6 @@ function ExecMoveZmax( bMchSplit, btoXHome)
                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
                EMT.CHSAW_OUT = true
                EMT.XHOME = true
             end
@@ -1776,6 +1979,28 @@ function ExecMoveZmax( bMchSplit, btoXHome)
          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 + 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
+         -- se configurazione per lavorare dall'alto e il pezzo è abbastanza alto, si ruota fuori
+         if EMT.SB > MaxVeOpen / 2 and abs( EMT.R3) > 0.1 and abs( EMT.R2) > 70 then
+               SimulMoveAxes( 'X2', LimX2RotSaw, MCH_SIM_STEP.RAPID, 'C2', 90, MCH_SIM_STEP.COLLROT)
+         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)
@@ -2484,6 +2709,14 @@ function LoadNextTool( nHSet, sTcPosDef, bFirst)
    return sTool
 end
 
+---------------------------------------------------------------------
+function DeactivateProbeTool()
+   if Probe then
+      EgtSetMode( EgtGetHeadId( 'H19') or GDB_ID.NULL, GDB_MD.HIDDEN)
+      EgtSetMode( EgtGetHeadId( 'H29') or GDB_ID.NULL, GDB_MD.HIDDEN)
+   end
+end
+
 ---------------------------------------------------------------------
 --   *** ESTIMATION T&L ***
 ---------------------------------------------------------------------
@@ -2908,7 +3141,7 @@ function GetHeadSetFromTcPos( sTcPos)
    local TCPOS_2A = {}
    local TCPOS_2B = {}
    if EgtGetHeadId( 'H21') then
-      TCPOS_1A = { 'T1', 'T3', 'T4', 'T5', 'T6', 'T7', 'T8', 'T9', 'T10'}
+      TCPOS_1A = { 'T1', 'T3', 'T4', 'T5', 'T6', 'T7', 'T8', 'T9', 'T10', '501'}
       TCPOS_1B = { 'T101'}
       TCPOS_2A = { 'T11', 'T12', 'T13', 'T14', 'T15', 'T16', 'T17', 'T18', 'T19', 'T20'}
       TCPOS_2B = { 'T111'}
@@ -2916,7 +3149,7 @@ function GetHeadSetFromTcPos( sTcPos)
       TCPOS_1A = { 'T1', 'T2', 'T3', 'T4', 'T5', 'T6', 'T7', 'T8', 'T9', 'T10'}
       TCPOS_1B = { 'T101', 'T201'}
       TCPOS_1C = { 'T301'}
-      TCPOS_2A = { 'T11', 'T12', 'T13', 'T14', 'T15', 'T16', 'T17', 'T18', 'T19', 'T20'}
+      TCPOS_2A = { 'T11', 'T12', 'T13', 'T14', 'T15', 'T16', 'T17', 'T18', 'T19', 'T20', '502'}
    end
    for _, sVal in ipairs( TCPOS_1A) do
       if sVal == sTcPos then return 1, 1 end

Common_ONE-PF.mlse

@@ -4,6 +4,12 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
+---------------------------------------------------------------------
+-- *** Generic Machinings ***
+---------------------------------------------------------------------
+require( 'EmtGenMachining')
+---------------------------------------------------------------------
+
 -- Carico libreria
 local BD = require( 'BeamData')
 
@@ -267,6 +273,13 @@ function OnSpecialMoveZup()
             EMC.MODIF = true
          end
       end
+   elseif HeadIsChainSaw( EMC.HEAD) then
+      EMC.TTOTLEN = EgtTdbGetCurrToolParam( MCH_TP.TOTLEN)
+      if EMC.TDIR[3] < -0.15 and EMC.L3 > - EMC.TTOTLEN then
+         EMC.L3 = EMC.TTOTLEN * EMC.TDIR[3]
+         -- dichiaro modificato
+         EMC.MODIF = true
+      end
    end
 end
 
@@ -713,14 +726,72 @@ end
 
 ---------------------------------------------------------------------
 function OnPostApplyMachining()
+   -- Inizializzo codice di errore
+   EMC.ERR = 0
+   -- Verifico se ultima lavorazione della fase
+   local nNextOpeId = EgtGetNextActiveOperation( EMC.MCHID)
+   local bMchLast = ( not nNextOpeId  or  EgtGetOperationPhase( nNextOpeId) ~= EMC.PHASE)   -- Agisco sui diversi percorsi della lavorazione
+   local nPathId = EgtGetFirstInGroup( EgtGetFirstNameInGroup( EMC.MCHID, 'CL') or GDB_ID.NULL)
+   while nPathId do
+      -- recupero id del successivo
+      nPathId = EgtGetNext( nPathId)
+      -- verifico se ultimo percorso di ultima lavorazione della fase
+      local bLast = ( bMchLast and ( not nPathId))
+      -- se ultimo, elimino ritorno in home
+      if bLast then EgtRemoveOperationHome( EMC.MCHID) end
+   end
+end
+
+---------------------------------------------------------------------
+function OnSpecialApplyMachining()
 
    EgtOutLog( ' Lavorazione : ' .. EgtGetName( EMC.MCHID), 1)
 
    -- Inizializzo codice di errore
    EMC.ERR = 0
+   
+   -- Recupero la precedente operazione
+   local nPrevOpeId = EgtGetPrevActiveOperation( EMC.MCHID)
+
+   -- Se esiste lavorazione precedente ed è una tastatura
+   if nPrevOpeId and EgtGetOperationType( nPrevOpeId) == MCH_OY.PROBING then
+      -- se stessa testa e montato già utensile corretto
+      -- recupero valori assi alla fine della lavorazione precedente e all'inizio della corrente
+      local vPrevAxes = EmtGetFinalAxesPos( nPrevOpeId, true)
+      local vCurrAxes = EmtGetInitialAxesPos( EMC.MCHID, true)
+      -- info lavorazione precedente
+      EgtSetCurrMachining( nPrevOpeId)
+      local sPrevTool = EgtGetMachiningParam( MCH_MP.TOOL)
+      local sPrevHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+      local nSetHead = GetHeadSet( sPrevHead)
+      local bPrevIsFirstHead = ( nSetHead == 1 or nSetHead == 11)
+      -- info lavorazione corrente
+      EgtSetCurrMachining( EMC.MCHID)
+      local sCurrTool = EgtGetMachiningParam( MCH_MP.TOOL)
+      local sCurrHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+      nSetHead = GetHeadSet( sCurrHead)
+      local bCurrIsFirstHead = ( nSetHead == 1 or nSetHead == 11)
+
+      -- se utensile corrente è compatibile (significa che è già stato precaricato) se stessa testa e con stessa configurazioen assi rotanti, annullo risalita
+      if IsToolCompatibleWithProbe( sCurrTool, sPrevTool) and bPrevIsFirstHead == bCurrIsFirstHead and abs( vCurrAxes[4] - vPrevAxes[4]) < 1 and abs( vCurrAxes[5] - vPrevAxes[5]) < 1 then
+         -- in lavorazione precedente elimino eventuale retrazione a Zmax
+         EmtRemoveRise( nPrevOpeId)
+         -- in lavorazione corrente elimino eventuale approccio da Zmax
+         EmtRemoveClimb( EMC.MCHID)
+         -- prendo sempre la Z massima tra le due
+         local vClimbPoint
+         if vCurrAxes[3] - 1.0 < vPrevAxes[3] then
+            vClimbPoint = vCurrAxes
+            vCurrAxes[3] = vPrevAxes[3]
+         elseif vPrevAxes[3] - 1.0 < vCurrAxes[3] then
+            vClimbPoint = vPrevAxes
+            vPrevAxes[3] = vCurrAxes[3]
+         end
+         EmtAddClimb( EMC.MCHID, vClimbPoint, 4, 1, 0)
+      end
+   end
 
    -- Recupero la posizione della trave e dei carrelli al termine della precedente operazione
-   local nPrevOpeId = EgtGetPrevActiveOperation( EMC.MCHID)
    -- se precedente operazione non esiste, errore
    if not nPrevOpeId then
       EMC.ERR = 1
@@ -820,7 +891,7 @@ function OnPostApplyMachining()
       -- verifico se ultimo percorso di ultima lavorazione della fase
       local bLast = ( bMchLast and ( not nPathId))
       -- se ultimo, elimino ritorno in home
-      if bLast then EgtRemoveOperationHome( EMC.MCHID) end
+      -- if bLast then EgtRemoveOperationHome( EMC.MCHID) end
       -- salvo lo stato dei carrelli
       local OriTPos = EMC.TPOS
       local OriY1Delta = EMC.Y1DELTA
@@ -878,7 +949,6 @@ function OnPostApplyMachining()
       local vAxes = EmtGetAxesPos( nLastEntId)
       if #vAxes > 0 then EMC.TPOS = vAxes[1] end
    end
-
 end
 
 ---------------------------------------------------------------------
@@ -1156,6 +1226,17 @@ function SpecialCalcMachiningEncumbrance( nMchId, bPreCut)
    end
    -- Recupero testa
    local sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+   local sToolName = EgtTdbGetCurrToolParam( MCH_TP.NAME)
+   local nSetHead = GetHeadSet( sHead)
+   local bIsFirstHead = ( nSetHead == 1 or nSetHead == 11)
+
+   -- se lavorazione di tastatura, si considera montato utensile di default
+   if HeadIsProbe( sHead) then
+      local sOtherToolName = GetToolNameFromTcPos( EgtIf( bIsFirstHead, DefTcPos1, DefTcPos2))
+      local sOtherHeadTool, _ = GetToolHead( sOtherToolName)
+      EgtLoadTool( sOtherHeadTool, 1, sOtherToolName)
+   end
+
    -- Recupero valore assi macchina
    local nSecId = EgtGetNext( EgtGetFirstInGroup( nPathId))
    local vAxes = EmtGetAxesPos( nSecId)
@@ -1166,8 +1247,8 @@ function SpecialCalcMachiningEncumbrance( nMchId, bPreCut)
    end
    -- Calcolo dell'ingombro della testa rispetto allo Zero Macchina
    local b3Enc
-   
-   if sHead ~= 'H21' and sHead ~= 'H22' and sHead ~= 'H23' then
+
+   if bIsFirstHead then
       EgtSetAxisPos( 'C1', vAxes[4])
       EgtSetAxisPos( 'B1', vAxes[5])
       if sHead == 'H13' or sHead == 'H15' then
@@ -1201,6 +1282,7 @@ function SpecialCalcMachiningEncumbrance( nMchId, bPreCut)
    local dDistFront = - ptMax:getX() - LoadT - dHeadFront
    local dDistBack = ptMin:getX() + LoadT + EMC.LB - dHeadBack
    EgtOutLog( '  DistFront = ' .. EgtNumToString( dDistFront, 1) .. ' DistBack = ' .. EgtNumToString( dDistBack, 1), 3)
+
    return dDistFront, dDistBack, dRollFront, dRollBack
 end
 

UpdateLog.txt

@@ -1,9 +1,40 @@
            ==== Common_ONE-PF Update Log ====
 
+Versione 3.1f5 (26/06/2026)
+- (SIM-GEN) Se tasca con motosega in faccia sopra e pezzo alto, si ruota in sicurezza.
+
+Versione 3.1f4 (17/06/2026)
+- (MLDE-GEN) Corretta preselezione in caso di testa in lavoro troppo vicina a quella che sta preselezionando. Da aggiungere in MLDE parametri 'Limit_T1_Presel_T2' e 'Limit_T2_Presel_T1'
+
+Versione 3.1f3 (08/06/2026)
+- (GEN) M77 viene ora eseguita, prima era commentata.
+
+Versione 3.1f2 (05/06/2026)
+- (MLDE-GEN) Aggiunti parametri di limite asse X per decidere se fare preselezione su altra testa. Serve modifica MLDE
+
+Versione 3.1f1 (03/06/2026)
+- (NGE-MLDE-GEN-SIM) Versione unificata con predisposizione per gestione tastatori. Serve modificare anche la macchina, per ora gestione completa solo su PFrl.
+
+Versione 3.1c2 (17/03/2026)
+- (SIM-GEN) Aggiunta OnSpecialApplyMachining per calcolare i carrelli da subito
+-           Aggiungendo OnSpecialApplyMachining, ora la OnSpecialGetPrevMachiningOffset lavora correttamente. ATT: MIN_MACH -> 3.1b2
+
+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
+- (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

Version.lua

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