Corretto emissione SPEED dopo G145 in G141 successiva

- Probe settato false per default

Beam/BeamData.lua

@@ -8,6 +8,7 @@ local BeamData = {
    RIGHT_LOAD = true,                         -- flag carico da destra
    SIMUL_VIEW_DIR = 1,                        -- direzione di vista predefinita per la simulazione (1=NW, 2=SW, 3=NE, 4=SE)
    ROT90 = false,                             -- flag abilitazione rotazione 90 gradi
+   ROT180 = true,                             -- flag abilitazione rotazione 180 gradi
    MIN_WIDTH = 50,                            -- larghezza minima del grezzo
    MIN_HEIGHT = 50,                           -- altezza minima del grezzo
    MAX_WIDTH = 400,                           -- larghezza massima del grezzo
@@ -67,6 +68,8 @@ local BeamData = {
    KIOTP = 5,                                 -- coefficiente moltiplicativo per attacco/uscita lama tangente anzichè perpendicolare
    MAXDIAM_POCK_CORNER = 31,                  -- diametro massimo utensile ammesso per tasche con angoli interni
    USE_LONGCUT = true,                        -- 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 = 10,                    -- accorciamento taglio di coda avanzato (minimo 1)
    DOUBLE_HEAD_DOVETAIL = false,              -- flag abilitazione lavorazione mortase a coda di rondine in doppio
@@ -103,6 +106,8 @@ if EgtExistsFile( sData) 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
@@ -211,30 +216,40 @@ local function GetSetupInfo( sHead)
    local SetupInfo = {}
 
    -- dati comuni
-   SetupInfo.bIsCSymmetric = true
+   SetupInfo.bIsCSymmetrical = true
    SetupInfo.dCAxisEncumbrance = 180
    SetupInfo.bToolOnAggregate = false
 
-   -- testa 5 assi da sopra
-   if sHead == 'H11' or sHead == 'H21' then
-      SetupInfo.bIsTopHead = true
-      SetupInfo.bIsBottomHead = not SetupInfo.bIsTopHead
-      SetupInfo.dMaxNegativeAngle = sin( -45)
-   -- lama su testa 5 assi da sopra
-   elseif sHead == 'H12' or sHead == 'H22' then
-      SetupInfo.bIsTopHead = true
-      SetupInfo.bIsBottomHead = not SetupInfo.bIsTopHead
-      SetupInfo.dMaxNegativeAngle = sin( -45)
+   -- testa 5 assi da sopra, dietro
+   if sHead == 'H11' then
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = { bFront = false, bBack = true}
+      SetupInfo.dMinNz = sin( -45)
+   -- testa 5 assi da sopra, davanti
+   elseif sHead == 'H21' then
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = { bFront = true, bBack = false}
+      SetupInfo.dMinNz = sin( -45)
+   -- lama su testa 5 assi da sopra, dietro
+   elseif sHead == 'H12' then
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = { bFront = false, bBack = true}
+      SetupInfo.dMinNz = sin( -45)
+   -- lama su testa 5 assi da sopra, davanti
+   elseif sHead == 'H22' then
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = { bFront = true, bBack = false}
+      SetupInfo.dMinNz = sin( -45)
    -- motosega 1
    elseif sHead == 'H13' or sHead == 'H23' then
-      SetupInfo.bIsTopHead = true
-      SetupInfo.bIsBottomHead = not SetupInfo.bIsTopHead
-      SetupInfo.dMaxNegativeAngle = 0
+      SetupInfo.HeadType = { bTop = true, bBottom = false}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.dMinNz = 0
    -- motosega 2
    elseif sHead == 'H15' then
-      SetupInfo.bIsBottomHead = true
-      SetupInfo.bIsTopHead = not SetupInfo.bIsBottomHead
-      SetupInfo.dMaxPositiveAngle = 0
+      SetupInfo.HeadType = { bTop = false, bBottom = true}
+      SetupInfo.PreferredSide = {}
+      SetupInfo.dMaxNz = 0
    end
 
    return SetupInfo

Common_ONE-PF.NUM.mlpe

@@ -27,7 +27,10 @@ function OnStart()
    --EMT.LINEINC = 1        -- incremento numerazione linee
    --EMT.Ft = 'F'           -- token per feed
    --EMT.St = 'S'           -- token per speed
-   EMT.FMAXPINZE = 102000 -- feed massima pinze
+   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
+
    -- utensili default
    EMT.PREVTCPOS_H1 = DefTcPos1
    EMT.PREVTCPOS_H2 = DefTcPos2
@@ -56,6 +59,7 @@ function OnProgramStart()
    end
    EmtOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
    EmtOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')\n')
+   EmtOutput( '(HEADER)')
    -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
    if TEST_USE then
       EmitTestProgramStart()
@@ -103,6 +107,7 @@ function OnProgramEnd()
    EMT.SPECSPLIT = nil
    EMT.RELOAD = nil
    EMT.RELOAD2 = nil
+   EmtOutput( '(FOOTER)')
    -- Se modalità test, termino il programma
    if TEST_USE then
       EmtOutput( 'M02')
@@ -440,6 +445,14 @@ function OnMachiningStart()
       local MyParkCSawC2 = GetChainSawCHomeFromVirtualAxis( dPosA)
       EmtModifyAxisHome( 'C2', MyParkCSawC2)
    end
+   -- gestione eventuale tastatura
+   local bProbing = EgtGetValInNotes( EMT.MCHUSERNOTES, 'PROBE', 'b') or EgtGetValInNotes( EMT.MCHUSERNOTES, 'START-PROBE', 'b')
+   if bProbing and Probe then
+      if VerifyToolProbeCompatibility() then
+         EMT.PROBE = true
+         EMT.EXECPROBE = true
+      end
+   end
    -- gestione eventuale lavorazione in doppio
    local nDouType = EgtGetValInNotes( EMT.MCHUSERNOTES, 'DOUBLE', 'i')
    if nDouType == 2 or nDouType == 3 then
@@ -603,6 +616,16 @@ function OnMachiningEnd()
    EMT.PREVTOOL = EMT.TOOL
    EMT.PREVHEAD = EMT.HEAD
    EMT.PREVTCPOS = EMT.TCPOS
+
+   -- se tastatura attiva, si disabilita la tastatura
+   if EMT.PROBE then
+      -- gestione eventuale tastatura
+      local bStopProbing = EgtGetValInNotes( EMT.MCHUSERNOTES, 'PROBE', 'b') or EgtGetValInNotes( EMT.MCHUSERNOTES, 'END-PROBE', 'b')
+      if bStopProbing then
+         EmtOutput( 'G145 Z-10 EF0')
+         EMT.PROBE = nil
+      end
+   end
    -- se taglio finale, aggiorno lunghezza barra
    if EMT.MCHCUT then
       EMT.LB = EMT.LT + ( EMT.X_OFF or 0)
@@ -614,11 +637,15 @@ function OnMachiningEnd()
       EMT.PREVHEAD_H1 = EMT.HEAD
       EMT.PREVTCPOS_H1 = EMT.TCPOS
       EMT.PREVHOMEX_H1 = EgtGetAxisHomePos( 'X1')
+      EMT.PREVHOMEB_H1 = EgtGetAxisHomePos( 'B1')
+      EMT.PREVHOMEC_H1 = EgtGetAxisHomePos( 'C1')
    elseif nHSet == 2 then
       EMT.PREVTOOL_H2 = EMT.TOOL
       EMT.PREVHEAD_H2 = EMT.HEAD
       EMT.PREVTCPOS_H2 = EMT.TCPOS
       EMT.PREVHOMEX_H2 = EgtGetAxisHomePos( 'X2')
+      EMT.PREVHOMEB_H2 = EgtGetAxisHomePos( 'B2')
+      EMT.PREVHOMEC_H2 = EgtGetAxisHomePos( 'C2')
    end
 
    if EMT.DOU_TYPE and not EMT.ZMAX then EMT.DOU_TO_ZMAX = true end
@@ -813,11 +840,11 @@ function OnRapid()
             EMT.L3 = EMT.L3s
          end
       end
+      local Speed = EMT.S * EgtIf( EMT.HEAD ~= 'H12' and EMT.HEAD ~= 'H22', 1, 1.65)
       -- se prima lavorazione
       if EMT.LOAD then
          EMT.V2POS = ParkV2
          -- primo posizionamento
-         local Speed = EMT.S * EgtIf( EMT.HEAD ~= 'H12' and EMT.HEAD ~= 'H22', 1, 1.65)
          local bOnlyCharY = true
          -- eventuale Movimento Pinze
          for i = 1, #EMT.AUXCMD do
@@ -878,13 +905,13 @@ function OnRapid()
                if  EMT.HEAD == 'H12'  and  EMT.L2 < -LimX1PlRotSaw  then
                   dXref = -LimX1PlRotSaw
                   EmitMoveDataHead( 1, { X=dXref, Z=MyMaxZ1, B=ParkB1, C=ParkC1, S=Speed})
-                  dZref = min( dSafeZ1 + GetZExtra( EMT.HEAD, EMT.R2), MyMaxZ1)
+                  dZref = max( EMT.L3, dSafeZ1 + GetZExtra( EMT.HEAD, EMT.R2))
                   dMoveXtoFinalPosition = true
                elseif not bMoveZbeforeX then
                   EmitMoveDataHead( 1, { X=dXref, Z=MyMaxZ1, B=ParkB1, C=ParkC1, S=Speed})
                else
                   EmitMoveDataHead( 1, { X=-LimX1PlRotSaw, Z=MyMaxZ1, B=ParkB1, C=ParkC1, S=Speed})
-                  dZref = min( dSafeZ1 + GetZExtra( EMT.HEAD, EMT.R2), MyMaxZ1)
+                  dZref = max( EMT.L3, dSafeZ1 + GetZExtra( EMT.HEAD, EMT.R2))
                   dMoveXtoFinalPosition = true
                end
    
@@ -983,8 +1010,8 @@ function OnRapid()
                   -- altrimenti caso standard
                   else
                      EmitMoveDataHead( 1, { Z=dZref, S=Speed})
-                     EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
                      EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
+                     EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
                   end
                -- altrimenti sega a catena
                else
@@ -1027,7 +1054,7 @@ function OnRapid()
                   EmitMoveWaitChars( EgtIf( bOnlyCharY, 1, 3))
                   local bMoveZbeforeX = false
                   local dZref = EMT.L3
-                  if EMT.HEAD == 'H22' and ( EgtIf( BD.RIGHT_LOAD, EMT.L2 < -LimX2RotSaw, EMT.L2 > -LimX2RotSaw) or EMT.R2 > 91) then
+                  if EMT.HEAD == 'H22' and ( EgtIf( BD.RIGHT_LOAD, EMT.L2 < -LimX1RotSaw, EMT.L2 > -LimX1RotSaw) or EMT.R2 > 91) then
                      dZref = min( dSafeZ2 + GetZExtra( EMT.HEAD, EMT.R2) - 100, MyMaxZ2)
                   end
 
@@ -1042,18 +1069,23 @@ function OnRapid()
                   end
 
                   -- caso speciale per trave alta con rotazione lama pericolosa (tolto "and EMT.SB > 379")
-                  if EMT.HEAD == 'H22' and abs( PrevR1 - EMT.R1) > 1 and ( abs( HomeC2 - EMT.R1) > 30.1 or abs( HomeB2 - EMT.R2) > 30.1) then
-                     EmitMoveDataHead( 2, { B=0, S=Speed})
-                     EmitMoveDataHead( 2, { C=EMT.R1, S=Speed})
-                     EmitMoveDataHead( 2, { Z=dZref, B=EMT.R2, S=Speed})
-                     if bMoveZbeforeX then
-                        EmitMoveDataHead( 2, { Z=EMT.L3, S=Speed})
+                  if abs( PrevR1 - EMT.R1) > 1 and ( abs( HomeC2 - EMT.R1) > 30.1 or abs( HomeB2 - EMT.R2) > 30.1) then
+                     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})
+                        if bMoveZbeforeX then
+                           EmitMoveDataHead( 2, { Z=EMT.L3, S=Speed})
+                        end
+                     -- altrimenti caso standard
+                     else
+                        EmitMoveDataHead( 2, { Z=dZref, S=Speed})
+                        EmitMoveDataHead( 2, { B=EMT.R2, S=Speed})
+                        EmitMoveDataHead( 2, { C=EMT.R1, S=Speed})
+                        if bMoveZbeforeX then
+                           EmitMoveDataHead( 2, { Z=EMT.L3, S=Speed})
+                        end
                      end
-                  -- altrimenti caso standard
-                  else
-                     EmitMoveDataHead( 2, { Z=dZref, S=Speed})
-                     EmitMoveDataHead( 2, { B=EMT.R2, S=Speed})
-                     EmitMoveDataHead( 2, { C=EMT.R1, S=Speed})
                   end
                -- altrimenti sega a catena
                else
@@ -1150,31 +1182,33 @@ function OnRapid()
          EMT.AUXCMD = {}
          -- se necessario posizionamento in home (sono sicuramente già a Zmax)
          if EMT.TO_XHOME then
-            local nHSet = GetHeadSet( EMT.HEAD)
-            local nPrevHSet = GetHeadSet( EMT.PREVHEAD)
-
-            -- vado in parcheggio sempre con utensile precedente
-            if not HeadIsChainSaw( EMT.PREVHEAD) then
-               if nPrevHSet == 1 then
-                  local HomeX1 = EgtGetAxisHomePos( 'X1')
-                  EmitMoveDataHead( 1, { X=-EMT.PREVHOMEX_H1, Z=MaxZ1, B=ParkB1, C=ParkC1, TPos=AdjustTcPos( false, EMT.PREVTCPOS_H1)})
-                  EmitMoveStartHead( 1, 'EA1')
-                  EmitMoveWaitHead( 1)
+            -- se devo andare in home, ma lo sono già, non faccio nulla
+            if not EMT.XHOME then
+               local nHSet = GetHeadSet( EMT.HEAD)
+               local nPrevHSet = GetHeadSet( EMT.PREVHEAD)
+               -- vado in parcheggio sempre con utensile precedente
+               if not HeadIsChainSaw( EMT.PREVHEAD) then
+                  if nPrevHSet == 1 then
+                     local HomeX1 = EgtGetAxisHomePos( 'X1')
+                     EmitMoveDataHead( 1, { X=-EMT.PREVHOMEX_H1, Z=MaxZ1, B=EMT.PREVHOMEB_H1, C=EMT.PREVHOMEC_H1, TPos=AdjustTcPos( false, EMT.PREVTCPOS_H1)})
+                     EmitMoveStartHead( 1, 'EA1')
+                     EmitMoveWaitHead( 1)
+                  else
+                     local HomeX2 = EgtGetAxisHomePos( 'X2')
+                     EmitMoveDataHead( 2, { X=-EMT.PREVHOMEX_H2, Z=MaxZ2, B=EMT.PREVHOMEB_H2, C=EMT.PREVHOMEC_H2, TPos=AdjustTcPos( false, EMT.PREVTCPOS_H2)})
+                     EmitMoveStartHead( 2, 'EA1')
+                     EmitMoveWaitHead( 2)
+                  end
                else
-                  local HomeX2 = EgtGetAxisHomePos( 'X2')
-                  EmitMoveDataHead( 2, { X=-EMT.PREVHOMEX_H2, Z=MaxZ2, B=ParkB2, C=ParkC2, TPos=AdjustTcPos( false, EMT.PREVTCPOS_H2)})
-                  EmitMoveStartHead( 2, 'EA1')
-                  EmitMoveWaitHead( 2)
-               end
-            else
-               if GetHeadTCSet( EMT.PREVHEAD, EMT.PREVTCPOS) == 'Head1_TC1' or GetHeadTCSet( EMT.PREVHEAD, EMT.PREVTCPOS) == 'Head1_TC2' then
-                  EmitMoveDataHead( 1, { X=-ParkCSawX1S, Z=MaxZ1, B=HomeR2, C=HomeR1, TPos='50'})
-                  EmitMoveStartHead( 1, 'EA1')
-                  --EmitMoveWaitHead( 1)
-               else
-                  EmitMoveDataHead( 2, { X=-ParkCSawX2S, Z=MaxZ2, B=HomeR2, C=HomeR1, TPos='50'})
-                  EmitMoveStartHead( 2, 'EA1')
-                  --EmitMoveWaitHead( 2)
+                  if GetHeadTCSet( EMT.PREVHEAD, EMT.PREVTCPOS) == 'Head1_TC1' or GetHeadTCSet( EMT.PREVHEAD, EMT.PREVTCPOS) == 'Head1_TC2' then
+                     EmitMoveDataHead( 1, { X=-ParkCSawX1S, Z=MaxZ1, B=HomeR2, C=HomeR1, TPos='50'})
+                     EmitMoveStartHead( 1, 'EA1')
+                     --EmitMoveWaitHead( 1)
+                  else
+                     EmitMoveDataHead( 2, { X=-ParkCSawX2S, Z=MaxZ2, B=HomeR2, C=HomeR1, TPos='50'})
+                     EmitMoveStartHead( 2, 'EA1')
+                     --EmitMoveWaitHead( 2)
+                  end
                end
             end
 
@@ -1220,7 +1254,6 @@ function OnRapid()
             local HomeC1 = EgtGetAxisHomePos( 'C1')
             local HomeB1 = EgtGetAxisHomePos( 'B1')
             local dTRad, dTLen = GetToolRadLen()
-            local Speed = EMT.S * EgtIf( EMT.HEAD ~= 'H12' and EMT.HEAD ~= 'H22', 1, 1.65)
             if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                -- se fresa o lama
                if not HeadIsChainSaw( EMT.HEAD) then
@@ -1245,13 +1278,13 @@ function OnRapid()
                   if  EMT.HEAD == 'H12'  and  EMT.L2 < -LimX1PlRotSaw  then
                      dXref = -LimX1PlRotSaw
                      EmitMoveDataHead( 1, { X=dXref, Z=CurrZ1, B=CurrB1, C=CurrC1, TRad=dTRad, TLen=dTLen, S=Speed})
-                     dZref = min( dSafeZ1 + GetZExtra( EMT.HEAD, EMT.R2), MyMaxZ1)
+                     dZref = max( EMT.L3, dSafeZ1 + GetZExtra( EMT.HEAD, EMT.R2))
                      dMoveXtoFinalPosition = true
-                     elseif not bMoveZbeforeX then
+                  elseif not bMoveZbeforeX then
                      EmitMoveDataHead( 1, { X=dXref, Z=CurrZ1, B=CurrB1, C=CurrC1, TRad=dTRad, TLen=dTLen, S=Speed})
                   else
                      EmitMoveDataHead( 1, { X=CurrX1, Z=CurrZ1, B=CurrB1, C=CurrC1, TRad=dTRad, TLen=dTLen, S=Speed})
-                     dZref = min( dSafeZ1 + GetZExtra( EMT.HEAD, EMT.R2), MyMaxZ1)
+                     dZref = max( EMT.L3, dSafeZ1 + GetZExtra( EMT.HEAD, EMT.R2))
                      dMoveXtoFinalPosition = true
                   end
 
@@ -1319,7 +1352,6 @@ function OnRapid()
                local HomeC1 = EgtGetAxisHomePos( 'C1')
                local HomeB1 = EgtGetAxisHomePos( 'B1')
                local dTRad, dTLen = GetToolRadLen()
-               local Speed = EMT.S * EgtIf( EMT.HEAD ~= 'H12' and EMT.HEAD ~= 'H22', 1, 1.65)
                if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                   -- se fresa o lama
                   if not HeadIsChainSaw( EMT.HEAD) then
@@ -1355,8 +1387,8 @@ function OnRapid()
                         -- altrimenti caso standard
                      else
                         EmitMoveDataHead( 1, { Z=dZref, S=Speed})
-                        EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
                         EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
+                        EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
                      end
                   -- altrimenti sega a catena
                   else
@@ -1383,7 +1415,6 @@ function OnRapid()
                local HomeC2 = EgtGetAxisHomePos( 'C2')
                local HomeB2 = EgtGetAxisHomePos( 'B2')
                local dTRad, dTLen = GetToolRadLen()
-               local Speed = EMT.S * EgtIf( EMT.HEAD ~= 'H12' and EMT.HEAD ~= 'H22', 1, 1.65)
                if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                   -- se fresa o lama
                   if not HeadIsChainSaw( EMT.HEAD) then
@@ -1394,7 +1425,7 @@ function OnRapid()
 
                      local bMoveZbeforeX = false
                      local dZref = EMT.L3
-                     if EMT.HEAD == 'H22' and ( EgtIf( BD.RIGHT_LOAD, EMT.L2 > -LimX2RotSaw, EMT.L2 < -LimX2RotSaw) or EMT.R2 < -91) then
+                     if EMT.HEAD == 'H22' and ( EgtIf( BD.RIGHT_LOAD, EMT.L2 > -LimX2RotSaw, EMT.L2 > -LimX2RotSaw) or EMT.R2 < -91) then
                         dZref = min( dSafeZ2 + GetZExtra( EMT.HEAD, EMT.R2) - 100, MyMaxZ2)
                      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
@@ -1409,18 +1440,23 @@ function OnRapid()
                      end
 
                      -- caso speciale per trave alta con rotazione lama pericolosa (tolto "and EMT.SB > 379")
-                     if EMT.HEAD == 'H22' and abs( PrevR1 - EMT.R1) > 1 and ( abs( HomeC2 - EMT.R1) > 30.1 or abs( HomeB2 - EMT.R2) > 30.1) then
-                        EmitMoveDataHead( 2, { B=0, S=Speed})
-                        EmitMoveDataHead( 2, { C=EMT.R1, S=Speed})
-                        EmitMoveDataHead( 2, { Z=dZref, B=EMT.R2, S=Speed})
-                        if bMoveZbeforeX then
-                           EmitMoveDataHead( 2, { Z=EMT.L3, S=Speed})
+                     if abs( PrevR1 - EMT.R1) > 1 and ( abs( HomeC2 - EMT.R1) > 30.1 or abs( HomeB2 - EMT.R2) > 30.1) then
+                        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})
+                           if bMoveZbeforeX then
+                              EmitMoveDataHead( 2, { Z=EMT.L3, S=Speed})
+                           end
+                        -- altrimenti caso standard
+                        else
+                           EmitMoveDataHead( 2, { Z=dZref, S=Speed})
+                           EmitMoveDataHead( 2, { B=EMT.R2, S=Speed})
+                           EmitMoveDataHead( 2, { C=EMT.R1, S=Speed})
+                           if bMoveZbeforeX then
+                              EmitMoveDataHead( 2, { Z=EMT.L3, S=Speed})
+                           end
                         end
-                     -- altrimenti caso standard
-                     else
-                        EmitMoveDataHead( 2, { Z=dZref, S=Speed})
-                        EmitMoveDataHead( 2, { B=EMT.R2, S=Speed})
-                        EmitMoveDataHead( 2, { C=EMT.R1, S=Speed})
                      end
                   -- altrimenti sega a catena
                   else
@@ -1490,6 +1526,47 @@ function OnRapid()
          EMT.RELOAD = false
          EMT.RELOAD2 = nil
       end
+      -- TODO DA SISTEMARE
+      -- se bisogna fare tastatura
+      if EMT.EXECPROBE then
+         EMT.EXECPROBE = nil
+         local dSecDistProbe = 10   -- 10 = distanza sicurezza tastatore
+         local dLenProbe = 170      -- 170 = lunghezza tastatore
+         local dOffHeadProbe = 75   -- offset naso mandrino / centro tastatore
+         local dPivot = EgtIf( GetHeadSet( EMT.HEAD) == 1, MillOffs, Mill2Offs)
+         local vtE = Vector3d( EMT.EXTR)
+         local sFace, ProbePosX, ProbePosZ
+         if AreSameVectorApprox( vtE, Y_AX()) then
+            ProbePosX = -( EMT.TABORI1[2] + EMT.HB + dSecDistProbe + dLenProbe + MillOffs)
+            ProbePosZ = EMT.TABORI1[3] - MillOffs + ( EMT.SB / 2) + EgtIf( EMT.R2 > 0, dOffHeadProbe, -dOffHeadProbe)
+            sFace = EgtIf( BD.RIGHT_LOAD, 4, 2)
+         elseif AreSameVectorApprox( vtE, -Y_AX()) then
+            ProbePosX = -( EMT.TABORI1[2] - dSecDistProbe - dLenProbe - MillOffs)
+            ProbePosZ = EMT.TABORI1[3] - MillOffs + ( EMT.SB / 2) + EgtIf( EMT.R2 > 0, dOffHeadProbe, -dOffHeadProbe)
+            sFace = EgtIf( BD.RIGHT_LOAD, 2, 4)
+         elseif AreSameVectorApprox( vtE, Z_AX()) then
+            ProbePosX = -( EMT.TABORI1[2] + ( EMT.HB / 2) + dOffHeadProbe)
+            ProbePosZ = EMT.TABORI1[3] + EMT.SB + dSecDistProbe + dLenProbe
+            sFace = 3
+         else
+            error( "PROBING DIRECTION NOT MANAGED")
+         end
+
+         EmitMoveDataHead( GetHeadSet( EMT.HEAD), { X=ProbePosX, Z=ProbePosZ, B=EMT.R2, C=EMT.R1})
+         EmitMoveStartHead( GetHeadSet( EMT.HEAD))
+         EmitMoveWaitHead( GetHeadSet( EMT.HEAD))
+         local sProbeHead = ' ET' .. GetHeadSet( EMT.HEAD)
+         EmtOutput( 'G145 Z-20 EF'..sFace..sProbeHead)
+         -- 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
+         elseif AreSameVectorApprox( vtE, Z_AX()) then
+            ProbePosX = EMT.L2
+         end
+         EmitMoveDataHead( GetHeadSet( EMT.HEAD), { X=ProbePosX, Z=ProbePosZ, B=EMT.R2, C=EMT.R1, S=Speed})
+         EmitMoveStartHead( GetHeadSet( EMT.HEAD))
+         EmitMoveWaitHead( GetHeadSet( EMT.HEAD))
+      end
       -- se taglio di coda senza residuo da scaricare, emetto M175 per accelerare il carico della barra successiva
       if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut', 1, true) then
          EmtOutput( 'M175')
@@ -1770,7 +1847,7 @@ function CalcDinamicaPinze( dH, dS, dL)
    local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
    if ( TempoAcc < MinTempoAcc) then TempoAcc = MinTempoAcc end
    if ( TempoAcc > MaxTempoAcc) then TempoAcc = MaxTempoAcc end
-   local AccMaxPinze = FMaxPinze / ( 60 * MinTempoAcc)
+   local AccMaxPinze = EMT.MAXACC or FMaxPinze / ( 60 * MinTempoAcc)
    local AccPinze = FMaxPinze / ( 60 * TempoAcc)
    local RidFeed = 100 / Massa * 100
    if RidFeed > 100 then
@@ -2257,7 +2334,7 @@ function PreparePreRotation( sCmd, nInd)
             MDChar = { Y2=ParkY2, V2=ParkV2, IniStatY2=1, FinStatY2=1, BeamVise=0}
             table.insert( EMT.MDCHAR, MDChar)
             MDChar = { [Cmd[2]]=tonumber(Cmd[3]), IniStatY1=86, FinStatY1=87, BeamVise=0}
-         elseif EMT.SPECSPLIT then
+         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
          else
@@ -2721,7 +2798,7 @@ function EmitZmax( bReset, bEnd, bXhome, PrevR1, PrevR2, bSplitCut, bUsePrevDelt
          if not HeadIsChainSaw( EMT.HEAD) then
             -- eseguo la salita a Z1max (oriento solo se assi rotanti non già a posto)
             if abs( dSafeC1 - PrevR1) > 0.1 or abs( dSafeB1 - PrevR2) > 0.1 then
-               local dZref = dSafeZ1 + GetZExtra( EMT.HEAD, PrevR2)
+               local dZref = dSafeZ1 + GetZExtra( EMT.HEAD, EgtClamp( PrevR2, -90, 90))
                if EgtIf( BD.RIGHT_LOAD, -dXPos < -LimX1RotSaw, -dXPos > -LimX1RotSaw) then
                   dZref = dZref - EgtIf( not Mortiser, 100, 370)
                end
@@ -2778,7 +2855,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) then
+               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, { C=dSafeC1})
@@ -2960,17 +3037,27 @@ function EmitParkRoller( dPosT, bSplitCut, bUsePrevDelta)
       local DiffY2 = MyParkY2 - dPosY2
       --EmtOutput( string.format( 'PosT=%.3f DiffY1=%.3f DiffY2=%.3f', dPosT, DiffY1, DiffY2))
       if bSplitCut then
+         local bYNoMove, bVNoMove
          if DiffY1 > 0.1  then
+            bYNoMove = false
             MDChar.Y1 = dPosY1 + DiffY1
          else
+            bYNoMove = true
             MDChar.Y1 = dPosY1
          end
          if DiffY2 < -0.1 then
+            bVNoMove = false
             MDChar.Y2 = dPosY2 + DiffY2
             dPosT = dPosT + DiffY2
          else
+            bVNoMove = true
             MDChar.Y2 = dPosY2
          end
+         -- se anche solo una morsa è restata in posizione, le sposto comunque entrambe di 5mm per distanziare i pezzi separati
+         if bYNoMove or bVNoMove then
+            MDChar.Y1 = MDChar.Y1 + 30
+            MDChar.Y2 = MDChar.Y2 - 30
+         end
       elseif DiffY1 > 0.1 and DiffY2 < -0.1 then
          EmtSetLastError( 1201, 'Error Collision in ParkRoller')
       elseif DiffY1 > 0.1  then

Common_ONE-PF.mlpe

@@ -24,7 +24,7 @@ end
 ---------------------------------------------------------------------
 -- *** SIMULATION ***
 ---------------------------------------------------------------------
-local COLL_SAFE_DIST = 4
+local COLL_SAFE_DIST = 3
 
 ---------------------------------------------------------------------
 function OnSimulInit()
@@ -121,7 +121,13 @@ function OnSimulStart()
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'COL2'},
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'TC1'},
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'TC2'},
-                     { Grp = 'Base', Sub = 'BELT', Name = 'COLLISION'}}
+                     { Grp = 'Base', Sub = 'BELT', Name = 'COLLISION'},
+                     { Grp = 'X1', Sub = 'COLLISION', Name = 'STM'}}
+   
+   if EgtGetHeadId( 'H21') then
+      table.insert( McdData, { Grp = 'X2', Sub = 'COLLISION', Name = 'STM'})
+   end
+
    -- gruppo CHSAW si attiva solo se progress, one con BIT mortiser o PF
    if Progress or Mortiser or EgtGetHeadId( 'H21') then
       table.insert( McdData, { Grp = 'Base', Sub = 'COLLISION', Name = 'CHSAW'})
@@ -231,18 +237,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.00
+            if EmtGetVMillStep then
+               dTol = EmtGetVMillStep( b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), 4.00)
+            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)
@@ -351,6 +363,8 @@ function OnSimulDispositionStart()
          else
             EgtOutText( 'Barra non ruotata')
          end
+         -- forzo apertura rulli in caso fossero chiusi. Altrimenti all'apertura nell OnSimulMoveStart sposterebbe anche la trave
+         ExecParkRoller( nil, nil, nil, nil, nil, nil)
       end
       -- eseguo aggancio
       local nRawId = EgtGetFirstRawPart()
@@ -765,6 +779,12 @@ function OnSimulMachiningStart()
    else
       EMT.TASKID = 0
    end
+   -- gestione eventuale tastatura
+   EMT.PROBE = nil
+   local bProbing = EgtGetValInNotes( EMT.MCHUSERNOTES, 'PROBE', 'b')
+   if bProbing then
+      EMT.PROBE = true
+   end
    -- gestione eventuale lavorazione in doppio
    local nDouType = EgtGetValInNotes( EMT.MCHUSERNOTES, 'DOUBLE', 'i')
    if nDouType == 2 then
@@ -1009,13 +1029,13 @@ function OnSimulMoveStart()
                if  EMT.HEAD == 'H12' and  -EMT.L2 < -LimX1PlRotSaw  then
                   dXref = LimX1PlRotSaw
                   SimulMoveAxis( 'X1', dXref, MCH_SIM_STEP.RAPID)
-                  dZref = Z1Home + GetZExtra( EMT.HEAD, EMT.R2)
+                  dZref = max( EMT.L3, Z1Home + GetZExtra( EMT.HEAD, EMT.R2))
                   dMoveXtoFinalPosition = true
                elseif not bMoveZbeforeX then
                   SimulMoveAxis( 'X1', dXref, MCH_SIM_STEP.RAPID)
                else
                   SimulMoveAxis( 'X1', LimX1PlRotSaw, MCH_SIM_STEP.RAPID)
-                  dZref = Z1Home + GetZExtra( EMT.HEAD, EMT.R2)
+                  dZref = max( EMT.L3, Z1Home + GetZExtra( EMT.HEAD, EMT.R2))
                   dMoveXtoFinalPosition = true
                end
 
@@ -1099,8 +1119,8 @@ function OnSimulMoveStart()
                   -- caso standard
                   else
                      SimulMoveAxis( 'Z1', dZref, MCH_SIM_STEP.RAPID)
-                     SimulMoveAxis( 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
                      SimulMoveAxis( 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxis( 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
                   end
                end
             -- altrimenti sega a catena (H13 o H15)
@@ -1147,9 +1167,9 @@ function OnSimulMoveStart()
                   --EgtOutBox( 'Flag 2,1', 'Info Rapid')
                   local bMoveZbeforeX = false
                   local dZref = EMT.L3
-                  if EMT.HEAD == 'H22' and ( EgtIf( BD.RIGHT_LOAD, EMT.L2 < -LimX2RotSaw, EMT.L2 > -LimX2RotSaw) or EMT.R2 > 91) then
+                  if EMT.HEAD == 'H22' and ( EgtIf( BD.RIGHT_LOAD, -EMT.L2 < -LimX1RotSaw, -EMT.L2 > -LimX1RotSaw) or EMT.R2 > 91) then
                      dZref = Z2Home + GetZExtra( EMT.HEAD, EMT.R2) - 100
-                  end                  
+                  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
                   if EMT.L3 > dZref then
                      bMoveZbeforeX = true
@@ -1160,18 +1180,23 @@ function OnSimulMoveStart()
                      SimulMoveAxis( 'X2', LimX2RotSaw, MCH_SIM_STEP.RAPID)
                   end
                   -- caso speciale per trave alta con rotazione lama pericolosa (tolto "and EMT.SB > 379")
-                  if EMT.HEAD == 'H22' and abs( C2Pos - EMT.R1) > 1 and ( abs( C2Home - EMT.R1) > 30.1 or abs(B2Home - EMT.R2) > 30.1) 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)
-                     if bMoveZbeforeX then
-                        SimulMoveAxis( 'Z2', EMT.L3, MCH_SIM_STEP.RAPID)
+                  if abs( C2Pos - EMT.R1) > 1 and ( abs( C2Home - EMT.R1) > 30.1 or abs( B2Home - EMT.R2) > 30.1) then
+                     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)
+                        if bMoveZbeforeX then
+                           SimulMoveAxis( 'Z2', EMT.L3, MCH_SIM_STEP.RAPID)
+                        end
+                     -- caso standard
+                     else
+                        SimulMoveAxis( 'Z2', dZref, MCH_SIM_STEP.RAPID)
+                        SimulMoveAxis( 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
+                        SimulMoveAxis( 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
+                        if bMoveZbeforeX then
+                           SimulMoveAxis( 'Z2', EMT.L3, MCH_SIM_STEP.RAPID)
+                        end
                      end
-                  -- caso standard
-                  else
-                     SimulMoveAxis( 'Z2', dZref, MCH_SIM_STEP.RAPID)
-                     SimulMoveAxis( 'B2', EMT.R2, MCH_SIM_STEP.COLLROT)
-                     SimulMoveAxis( 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
                   end
                end
             -- altrimenti sega a catena
@@ -1617,7 +1642,7 @@ function ExecMoveZmax( bMchSplit, btoXHome)
       if GetHeadTCSet( EMT.HEAD, EMT.TCPOS) == 'Head1_TC1' then
          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)
+               local dZref = HomeZ + GetZExtra( EMT.HEAD, EgtClamp( CurrB, -90, 90))
                if EgtIf( BD.RIGHT_LOAD, -CurrX < -LimX1RotSaw, -CurrX > -LimX1RotSaw) then
                   dZref = dZref - EgtIf( not Mortiser, 100, 370)
                end
@@ -1661,7 +1686,7 @@ function ExecMoveZmax( bMchSplit, btoXHome)
             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) then
+               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
                SimulMoveAxis( 'C1', HomeC, MCH_SIM_STEP.COLLROT)
@@ -1842,8 +1867,20 @@ function ExecParkRoller( PosY1, PosY2, PosV1, PosV2, bSpliCut, bAgg)
       local DiffY2 = MyParkY2 - PosY2
       -- se appena eseguito taglio di separazione
       if bSpliCut then
+         local dAddMove
+         -- se entrambe le morse si spostano vado in posizione calcolata
+         if DiffY1 > 0.1 and DiffY2 < -0.1 then
+            dAddMove = 0
+         -- se almeno una è rimasta ferma in posizione, allontano comunque di 30mm ulteriori
+         else
+            dAddMove = 30
+         end
          local MoveY1 = max( DiffY1, 0.0)
          local MoveY2 = min( DiffY2, 0.0)
+
+         MoveY1 = MoveY1 + dAddMove
+         MoveY2 = MoveY2 - dAddMove
+
          -- aggancio i pezzi rimanenti all'asse Y1
          LinkRemainingPartsToY1()
          -- eseguo i movimenti
@@ -2251,6 +2288,15 @@ function LoadNextTool( nHSet, sTcPosDef, bFirst)
    return sTool
 end
 
+---------------------------------------------------------------------
+function VerifyToolProbeCompatibility()
+   local bToolIsCompatible = false
+   if EMT.TTOTLEN < 160 and EMT.TTOTDIAM < 80 then
+      bToolIsCompatible = true
+   end
+   return bToolIsCompatible
+end
+
 ---------------------------------------------------------------------
 --   *** ESTIMATION T&L ***
 ---------------------------------------------------------------------

Common_ONE-PF.mlse

@@ -73,7 +73,7 @@ function OnSpecialGetMaxZ()
          EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
       end
    elseif EMC.HEAD == 'H12' and sHead_TC == 'Head1_TC1' then
-      if vtTp:getX() > 0.3 and vtT:getX() > 0.3 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)
          elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
@@ -95,7 +95,7 @@ function OnSpecialGetMaxZ()
          EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
       end
    elseif EMC.HEAD == 'H12' and sHead_TC == 'Head1_TC2' then
-      if vtTp:getX() > 0.3 and vtT:getX() > 0.3 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)
          elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
@@ -124,7 +124,7 @@ function OnSpecialGetMaxZ()
          EMC.MAXZ = ParkZ2 + CalcExtraZ( vtTpZm, vtT, vMZ)
       end
    elseif EMC.HEAD == 'H22' then
-      if vtTp:getX() > 0.3 and vtT:getX() > 0.3 then
+      if vtTp:getX() > 0.4 and vtT:getX() > 0.4 then
          if bBSameSign and abs( EMC.R1 - EMC.R1p) < 165 then
             EMC.MAXZ = MaxZ2 - 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
@@ -1423,7 +1423,14 @@ function SpecCalcSplit( dLenRaw, dMaxLenLeft)
    local vCmd = {}
    EgtOutLog( '  *[S]', 1)
    local bSplit = ( EMC.Y2DELTA ~= nil or EMC.W2DELTA ~= nil)
-   local ParkT = EgtIf( bSplit and dMaxLenLeft > ParkV1 - 50, LoadT, ParkV1)
+   local ParkT = ParkV1
+   if bSplit then
+      if dMaxLenLeft + 100 > LoadT then
+         ParkT = dMaxLenLeft + 300
+      elseif dMaxLenLeft + 100 > ParkV1 then
+         ParkT = LoadT
+      end
+   end
    local sType = EgtIf( EMC.Y2DELTA, 'Split', EgtIf( EMC.W2DELTA, 'SpecSplit', 'Fall'))
    table.insert( vCmd, { 0, sType})
    if not bSplit then EnsureZmax( false, vCmd) end

Essetre-PFrl.mlde

@@ -44,10 +44,10 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '2.6j3'
-PP_NVER = '2.6.10.3'
+PP_VER = '2.7f1_DEV9'
+PP_NVER = '2.7.6.1'
 MIN_MACH_VER = '2.5k1'
-MACH_NAME = 'Essetre-PFrl'
+MACH_NAME = string.match( EgtGetCurrMachineDir(), "[^\\]+$")  -- si ricava il nome della macchina dal direttorio
 
 -- Carico i dati globali
 local sMachDir = EgtGetCurrMachineDir()
@@ -172,9 +172,12 @@ DefTcPos1 = 'T3'
 DefTcPos2 = 'T13'
 SecondSaw = false
 AutomaticRotation = true
+OptimizedLoadBeam = true
 AutoRotMinLen = 0
 CoeffVM = 0.5
+EstimationRapidMultiplier = 1
 ForceToCloseRollersGate = false
+Probe = nil
 
 -- Aggiornamento con dati da TechnoEssetre7
 local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-PFrl.data"
@@ -258,8 +261,13 @@ if EgtExistsFile( sData) then
          if Machine.Offsets.SAW2OFFSZ then Saw2OffsZ = Machine.Offsets.SAW2OFFSZ end
          if Machine.Offsets.DEFTCPOS1 then DefTcPos1 = ( 'T' .. Machine.Offsets.DEFTCPOS1) end
          if Machine.Offsets.DEFTCPOS2 then DefTcPos2 = ( 'T' .. Machine.Offsets.DEFTCPOS2) end
+         if Machine.Offsets.COEFF_STIMATEMPI and Machine.Offsets.COEFF_STIMATEMPI > 0 then EstimationRapidMultiplier = Machine.Offsets.COEFF_STIMATEMPI end
+         if Machine.Offsets.MAXFEEDPINZE then MaxFeedPinze = Machine.Offsets.MAXFEEDPINZE end
+         if Machine.Offsets.MAXACC then MaxAcc = Machine.Offsets.MAXACC end
+         if Machine.Offsets.MINACC then MinAcc = Machine.Offsets.MINACC 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.PROBE then Probe = Machine.Offsets.PROBE end  -- Tastatore su entrembe le teste. 1 = solo testa 1, 2 = solo testa 2, 3 = entrambe le teste
          -- aggiustamenti
          MinY1 = MinV1 + MinDeltaYV
          MaxY1 = MaxMchY1
@@ -307,7 +315,7 @@ local X1Id = EmtAxis {
       Home = ParkX1,
       Invert = true,
       Geo = 'X1_AXIS/GEO',
-      Aux = 'X1_AXIS/SOLID'}
+      Aux = {'X1_AXIS/SOLID', 'X1_AXIS/COLLISION'}}
 --  *** Testa 1 ***
 EmtAxis {
       Name = 'Z1',
@@ -331,6 +339,13 @@ EmtAxis {
       Home = ParkC1,
       Geo = 'C1_AXIS/GEO',
       Aux = {'C1_AXIS/SOLID', 'C1_AXIS/COLLISION'}}
+-- se tastatore presente
+local sBAxisAuxGeom
+if Probe == 1 or Probe == 3 then
+   sBAxisAuxGeom = {'B1_AXIS/SOLID', 'B1_AXIS/COLLISION', 'PROBE_B1/SOLID_PROBE', 'PROBE_B1/COLLISION_PROBE'}
+else
+   sBAxisAuxGeom = {'B1_AXIS/SOLID', 'B1_AXIS/COLLISION'}
+end
 EmtAxis {
       Name = 'B1',
       Parent = 'C1',
@@ -341,7 +356,7 @@ EmtAxis {
       Stroke = {MinB1, MaxB1},
       Home = ParkB1,
       Geo = 'B1_AXIS/GEO',
-      Aux = {'B1_AXIS/SOLID', 'B1_AXIS/COLLISION'}}
+      Aux = sBAxisAuxGeom }
 -- Frese
 local H11Id = EmtHead {
       Name = 'H11',
@@ -407,7 +422,7 @@ local X2Id = EmtAxis {
       Home = ParkX2,
       Invert = true,
       Geo = 'X2_AXIS/GEO',
-      Aux = 'X2_AXIS/SOLID'}
+      Aux = {'X2_AXIS/SOLID', 'X2_AXIS/COLLISION'}}
 local Z2Id = EmtAxis {
       Name = 'Z2',
       Parent = 'X2',
@@ -430,6 +445,12 @@ local C2Id = EmtAxis {
       Home = ParkC2,
       Geo = 'C2_AXIS/GEO',
       Aux = {'C2_AXIS/SOLID', 'C2_AXIS/COLLISION'}}
+-- se presente tastatore
+if Probe == 2 or Probe == 3 then
+   sBAxisAuxGeom = {'B2_AXIS/SOLID', 'B2_AXIS/COLLISION', 'PROBE_B2/SOLID_PROBE', 'PROBE_B2/COLLISION_PROBE'}
+else
+   sBAxisAuxGeom = {'B2_AXIS/SOLID', 'B2_AXIS/COLLISION'}
+end
 local B2Id = EmtAxis {
       Name = 'B2',
       Parent = 'C2',
@@ -440,9 +461,10 @@ local B2Id = EmtAxis {
       Stroke = {MinB2, MaxB2},
       Home = ParkB2,
       Geo = 'B2_AXIS/GEO',
-      Aux = {'B2_AXIS/SOLID', 'B2_AXIS/COLLISION'}}
+      Aux = sBAxisAuxGeom}
 local vtMove2 = Vector3d( 0, Head2Y, Head2Z)
 EgtMove( EgtGetFirstNameInGroup( X2Id, 'SOLID'), vtMove2, GDB_RT.GLOB)
+EgtMove( EgtGetFirstNameInGroup( X2Id, 'COLLISION'), vtMove2, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( Z2Id, 'SOLID'), vtMove2, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( Z2Id, 'COLLISION'), vtMove2, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( C2Id, 'SOLID'), vtMove2, GDB_RT.GLOB)
@@ -800,7 +822,9 @@ if Mortiser then
    EgtMove( EgtGetFirstNameInGroup( BaseId, 'TC4') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB)
 end
 EgtMove( EgtGetFirstNameInGroup( X1Id, 'SOLID'), vtMovB, GDB_RT.GLOB)
+EgtMove( EgtGetFirstNameInGroup( X1Id, 'COLLISION'), vtMovB, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( X2Id, 'SOLID'), vtMovB, GDB_RT.GLOB)
+EgtMove( EgtGetFirstNameInGroup( X2Id, 'COLLISION'), vtMovB, GDB_RT.GLOB)
 local vtMovC = Vector3d( 0, 0, ( DeltaTabZ + DeltaRulliTappetoZ + 1495))      -- -( -1010 - 485)
 EgtMove( EgtGetFirstNameInGroup( BaseId, 'BELT'), vtMovC, GDB_RT.GLOB)
 local vtMove = Vector3d( 0, ( DeltaTabY - 1170.0), ( DeltaTabZ + 1010.0))
@@ -972,7 +996,7 @@ function GetZExtra( sHead, dAngV)
       elseif abs( dAngV) < 60.1 then
          return 200
       elseif abs( dAngV) < 90.1 then
-         return 10
+         return 1
       else
          return 0
       end
@@ -984,7 +1008,9 @@ function GetZExtra( sHead, dAngV)
       elseif abs( dAngV) < 60.1 then
          return 200
       elseif abs( dAngV) < 90.1 then
-         return 10
+         return 1
+      elseif abs( dAngV) < 120 then
+         return -100
       else
          return 0
       end

MachNotes.ini

@@ -7,18 +7,22 @@
 [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
+6=b,PROBE,0
+7=b,START-PROBE,0
+8=b,END-PROBE,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 +34,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
+

UpdateLog.txt

@@ -1,5 +1,48 @@
            ==== Common_ONE-PF Update Log ====
 
+Versione 2.7f1 (04/06/2025)
+- (SIM) Aggiunta gestione qualità VMILL da impostazioni macchina. Tolto parametro 'CoeffVM'.
+- (GEN) Prima versione gestione tastatore
+- (GEN) Aggiunti parametri FMAXPINZE, MAXACC, MINACC configurabili da TS3. Ticket#2052
+
+Versione 2.7e1 (28/05/2025)
+- (SIM-GEN) Alla separazione si spostano i carrelli di 30mm aprendo il taglio. Ticket#2259,Ticket#2328
+
+Versione 2.7d1 (16/04/2025)
+- (SIM) Distanza di collisione portata a 3mm, qualità VMILL ridotta a 4mm. Ticket#2395
+
+Versione 2.7c3 (25/03/2025)
+- (GEN) Corretto movimento approccio alla lavorazione se utensile lama montata su magazzino 2. Ticket#2361
+
+Versione 2.7c2 (12/03/2025)
+- (SIM-GEN) Migliorato calcolo posizione barra dopo split. Tiene in considerazione ingombro lavorazioni pezzo. Ticket#2321
+- (GEN) Aggiunta commenti HEADER e FOOTER per comunicazione con linea o altre macchine, da parte di Essetre.
+- (SIm-GEN) Migliorato movimento approccio al pezzo con lama. Allineamento simulazione-generazione che facevano due movimenti leggermente diversi. Ticket#2335
+
+Versione 2.7c1 (05/03/2025)
+- (GEN) Corretto movimento in home utensile precedente. Ticket#2324
+
+Versione 2.7b1 (07/02/2025)
+- (SIM-GEN) In caso di Progress, alla deselezione utensile testa 1 su TC2 si fa movimento Z raddrizzando asse B. Ticket#2247
+- (SIM-GEN) Estensione soluzione Ticket#2206. Ora si aprono di 5mm extra anche se solo una morsa resta in posizione. Ticket#2259
+- (SIM) Migliorato controllo collisioni con traversa. Ora si considera asse X. Serve modifica NGE! Ticket#2257
+
+Versione 2.7a2 (15/01/2024)
+- (SIM-GEN) In caso di testa 1 su TC2 (ONE), si ruota prima la C e poi la B. Ticket#2247
+
+Versione 2.7a1 (07/01/2024)
+- (GEN) In separazione, quando si porta indietro il restante, si aprono le paratie rulli subito. Ticket#2214
+- (SIM-GEN) Se entrambe le morse sono restate in posizione, le sposto comunque di 5mm per distanziare i pezzi separati. Ticket#2206
+
+Versione 2.6l2 (09/12/2024)
+- (SIM-GEN) Corretto problema introdotto in 2.6l1 per risolvere #2198. Ticket#2203
+- (SIM-GEN) In MLSE modificato controllo direzione utensile per determinare Z massima. Ticket#2204
+
+Versione 2.6l1 (02/12/2024)
+- (SIM) Dopo scarico pezzo per ribaltamento, si aprono sempre i rulli. Ticket#2192
+- (SIM-GEN) Nei movimenti si ricalcola la Z solo se la quota di lavoro è più in alta della posizione a ZHOME della testa. Ticket#2198
+- (GEN) Se bisogna andare in home, ma la testa lo è già, non si scrive nulla
+
 Versione 2.6j3 (21/10/2024)
 - (GEN) Se richiesto movimento in home, si scrive sempre parcheggio in home dell'utensile precedente. Prima si scriveva solo per lama.
 

Version.lua

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