Merge remote-tracking branch 'origin/develop'

- In MLSE modificato controllo direzione utensile per determinare Z massima

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')
@@ -603,6 +608,7 @@ function OnMachiningEnd()
    EMT.PREVTOOL = EMT.TOOL
    EMT.PREVHEAD = EMT.HEAD
    EMT.PREVTCPOS = EMT.TCPOS
+
    -- se taglio finale, aggiorno lunghezza barra
    if EMT.MCHCUT then
       EMT.LB = EMT.LT + ( EMT.X_OFF or 0)
@@ -614,11 +620,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
@@ -878,13 +888,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 +993,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 +1037,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 +1052,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,19 +1165,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)
-            if EMT.PREVHEAD == 'H12' or EMT.PREVHEAD == 'H22' 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)
+                  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
 
@@ -1233,13 +1262,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
 
@@ -1343,8 +1372,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
@@ -1382,7 +1411,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
@@ -1397,18 +1426,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
@@ -1749,17 +1783,13 @@ end
 
 ---------------------------------------------------------------------
 function CalcDinamicaPinze( dH, dS, dL)
-   local MinTempoAcc = 0.3                         -- [s]
-   local MaxTempoAcc = 4.0                         -- [s]
    local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
    local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
    local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
    local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
    local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
-   if ( TempoAcc < MinTempoAcc) then TempoAcc = MinTempoAcc end
-   if ( TempoAcc > MaxTempoAcc) then TempoAcc = MaxTempoAcc end
-   local AccMaxPinze = FMaxPinze / ( 60 * MinTempoAcc)
-   local AccPinze = FMaxPinze / ( 60 * TempoAcc)
+   local AccMaxPinze = EMT.MAXACC
+   local AccPinze = EgtClamp( FMaxPinze / ( 60 * TempoAcc), EMT.MINACC, EMT.MAXACC)
    local RidFeed = 100 / Massa * 100
    if RidFeed > 100 then
       RidFeed = 100
@@ -2245,7 +2275,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
@@ -2709,7 +2739,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
@@ -2744,7 +2774,7 @@ function EmitZmax( bReset, bEnd, bXhome, PrevR1, PrevR2, bSplitCut, bUsePrevDelt
             local MovH = { X = -dXPos, Z = EMT.L3o, B = PrevR2, C = PrevR1}
             EmitMoveDataHead( 1, MovH)
             EmitMoveDataHead( 1, { Z=dSafeZ1, B=dSafeB1})
-            if EMT.SB > 650 and abs( EMT.R3) < 0.1 then
+            if EMT.R3 and abs( EMT.R3) < 0.1 then
                EmitMoveDataHead( 1, { Z=ParkCSawZ1})
             end
             EmitMoveDataHead( 1, { X=-dSafeX1, C=dSafeC1})
@@ -2766,7 +2796,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})
@@ -2789,7 +2819,7 @@ function EmitZmax( bReset, bEnd, bXhome, PrevR1, PrevR2, bSplitCut, bUsePrevDelt
             local MovH = { X = -dXPos, Z = EMT.L3o, B = PrevR2, C = PrevR1}
             EmitMoveDataHead( 1, MovH)
             EmitMoveDataHead( 1, { Z=dSafeZ1, B=dSafeB1})
-            if EMT.SB > 650 and abs( EMT.R3) < 0.1 then
+            if EMT.R3 and abs( EMT.R3) < 0.1 then
                EmitMoveDataHead( 1, { Z=ParkCSawZ1})
             end
             EmitMoveDataHead( 1, { X=-dSafeX1, C=dSafeC1})
@@ -2846,7 +2876,7 @@ function EmitZmax( bReset, bEnd, bXhome, PrevR1, PrevR2, bSplitCut, bUsePrevDelt
          local MovH = { X = -dXPos, Z = EMT.L3o, B = PrevR2, C = PrevR1}
          EmitMoveDataHead( 2, MovH)
          EmitMoveDataHead( 2, { Z=dSafeZ2, B=dSafeB2})
-         if EMT.SB > 650 and abs( EMT.R3) < 0.1 then
+         if EMT.R3 and abs( EMT.R3) < 0.1 then
             EmitMoveDataHead( 2, { Z=ParkCSawZ2})
          end
          EmitMoveDataHead( 2, { X=-dSafeX2, C=dSafeC2})
@@ -2948,17 +2978,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()
@@ -1009,13 +1023,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 +1113,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 +1161,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 +1174,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 +1636,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
@@ -1650,7 +1669,7 @@ function ExecMoveZmax( bMchSplit, btoXHome)
          -- altrimenti sega a catena
          else
             SimulMoveAxes( 'Z1', HomeZ, MCH_SIM_STEP.RAPID, 'B1', HomeB, MCH_SIM_STEP.COLLROT)
-            if EMT.SB > 650 and abs( EMT.R3) < 0.1 then
+            if EMT.R3 and abs( EMT.R3) < 0.1 then
                SimulMoveAxis( 'Z1', ParkCSawZ1, MCH_SIM_STEP.RAPID)
             end
             SimulMoveAxes( 'X1', HomeX, MCH_SIM_STEP.RAPID, 'C1', HomeC, MCH_SIM_STEP.COLLROT)
@@ -1661,7 +1680,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)
@@ -1675,7 +1694,7 @@ function ExecMoveZmax( bMchSplit, btoXHome)
          -- altrimenti sega a catena
          else
             SimulMoveAxes( 'Z1', HomeZ, MCH_SIM_STEP.RAPID, 'B1', HomeB, MCH_SIM_STEP.COLLROT)
-            if EMT.SB > 650 and abs( EMT.R3) < 0.1 then
+            if EMT.R3 and abs( EMT.R3) < 0.1 then
                SimulMoveAxis( 'Z1', ParkCSawZ1, MCH_SIM_STEP.RAPID)
             end
             if btoXHome then
@@ -1712,7 +1731,7 @@ function ExecMoveZmax( bMchSplit, btoXHome)
    -- altrimenti sega a catena
       else
          SimulMoveAxes( 'Z2', HomeZ, MCH_SIM_STEP.RAPID, 'B2', HomeB, MCH_SIM_STEP.COLLROT)
-         if EMT.SB > 650 and abs( EMT.R3) < 0.1 then
+         if EMT.R3 and abs( EMT.R3) < 0.1 then
             SimulMoveAxis( 'Z2', ParkCSawZ2, MCH_SIM_STEP.RAPID)
          end
          SimulMoveAxes( 'X2', HomeX, MCH_SIM_STEP.RAPID, 'C2', HomeC, MCH_SIM_STEP.COLLROT)
@@ -1842,8 +1861,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

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
@@ -1546,8 +1553,11 @@ function SpecCalcUnload()
       EgtOutLog( '  *[U1]', 1)
    end
    local vCmd = {}
+   -- Tipo di scarico
+   local bStdUl = ( not MaxUnloadLen or MaxUnloadLen < 1 or EMC.LB - EMC.HOVM < MaxUnloadLen + 1)
+
    -- Commento
-   table.insert( vCmd, { 0, 'Unloading'})
+   table.insert( vCmd, { 0, 'Unloading', EgtIf( bStdUl, 'Unloading', 'Manual Unloading')})
    -- posizionamento sicuro teste e rulli (non serve ?)
    --table.insert( vCmd, { 4, 0})
    -- Se pinza Y chiusa, la apro
@@ -1555,11 +1565,15 @@ function SpecCalcUnload()
       table.insert( vCmd, { 11, 0})
       EMC.CNT = nil
    end
-   -- Sposto il pezzo in posizione di scarico
-   local dFinT = UnloadT - EMC.LB
-   local dFinY2 = dFinT + EMC.Y2DELTA
-   table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2})
-   EgtOutLog( '  Y2PosF=' .. EgtNumToString( dFinY2), 1)
+   -- Se non supero la lunghezza massima di scarico, sposto il pezzo in posizione di scarico
+   if bStdUl then
+      local dFinT = UnloadT - EMC.LB
+      local dFinY2 = dFinT + EMC.Y2DELTA
+      table.insert( vCmd, { 2, 'T', dFinT, 'Y2', dFinY2})
+      EgtOutLog( '  Y2PosF=' .. EgtNumToString( dFinY2), 1)
+   else
+      table.insert( vCmd, { 1, 'Y2', MaxY2})
+   end
    -- apro la morsa
    table.insert( vCmd, { 12, 0})
    -- riporto il carrello in home

UpdateLog.txt

@@ -1,7 +1,62 @@
            ==== Common_ONE-PF Update Log ====
 
+Versione 2.7g1 (01/07/2025)
+- (GEN) Rimossa gestione PROBE inserita per sbaglio
+- (GEN) Corretto gestione accelerazioni
+- (SIM-GEN) Aggiunta gestione massima lunghezza scarico
+
+Versione 2.7f1 (04/06/2025)
+- (SIM) Aggiunta gestione qualità VMILL da impostazioni macchina. Tolto parametro 'CoeffVM'.
+- (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.
+
+Versione 2.6j2 (17/10/2024)
+- (SIM-GEN) Se motosega prelevata con A=0, alla fine la si porta sempre alla quota ZMAX, indipendentemente dall'altezza trave che era fissata a 650mm. Ora lo fa sempre.
+
 Versione 2.6j1 (08/10/2024)
--- (SIM-GEN) Corretto primo movimento di approccio al pezzo. Ticket#2093
+- (SIM-GEN) Corretto primo movimento di approccio al pezzo. Ticket#2093
+- (SIM-GEN) Corretto movimento in Home in caso di lama e movimento rulliera di carico. Ticket#2054
+- (GEN) In caso di movimento in Home non si fa più preselezione ma si tiene utensile vecchio. Ticket#1926
 
 Versione 2.6i2 (13/09/2024)
 - (GEN) Migliorato calcolo chiusura paratia rulli con aggiornamento lunghezza della barra in caso di ultimo taglio e grezzo residuo in coda. Ticket#2017

Version.lua

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