Allineamento con common ver. 2.7g1

- Aggiunto parametro LinkAxesMoveOrder

Beam/BeamData.lua

@@ -12,6 +12,7 @@ local BeamData = {
    MAX_WIDTH = 1505,                        -- larghezza massima del grezzo
    MAX_HEIGHT = 605,                        -- altezza massima del grezzo
    LEN_SHORT_PART = 1200,                   -- lunghezza massima pezzo piccolo
+   LEN_VERY_SHORT_PART = 800,               -- lunghezza massima pezzo molto corto (molto probabile lo scarico a caduta)
    MAX_RAW = 20000,                         -- massima lunghezza grezzo (deve essere minore di LenTable - RAW_OFFSET)
    STD_RAW = 14000,                         -- lunghezza standard della barra di grezzo
    OVM_HEAD = 10,                           -- sovramateriale testa
@@ -74,12 +75,15 @@ local BeamData = {
    DOUBLE_HEAD_DOVETAIL = true,             -- flag abilitazione lavorazione mortase a coda di rondine in doppio
    DOUBLE_HEAD_MORTISE = true,              -- flag abilitazione lavorazione mortase in doppio
    DOUBLE_HEAD_DRILLING = true,             -- flag abilitazione forature in doppio
-   USE_MULTI_DRILL = false,                  -- flag abilitazione gruppo a forare
+   USE_MULTI_DRILL = false,                 -- flag abilitazione gruppo a forare
+   PRECUT_HEAD = true,                      -- flag abilitazione pretaglio grezzo a zero in testa
+   PRECUT_TAIL = true,                      -- flag abilitazione pretaglio grezzo a zero in coda
+   MIN_HEIGHT_ADDED_CUTS = 400              -- altezza minima pezzo per effettuare tagli orizzontali aggiuntivi in testa e coda
 }
 
 ---------------------------------------------------------------------
 -- Aggiornamento con dati da TechnoEssetre7
-local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-PF1500rl.data"
+local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-PF1500MAXrl-3T.data"
 local sDataBeam = EgtGetCurrMachineDir().."\\Beam\\Ts3Data.lua"
 if EgtExistsFile( sTs3Data) then
    EgtCopyFile( sTs3Data, sDataBeam)
@@ -94,6 +98,9 @@ if EgtExistsFile( sDataBeam) then
          if Machine.Offsets.DOUBLE_HEAD_DOVETAIL then BeamData.DOUBLE_HEAD_DOVETAIL = ( Machine.Offsets.DOUBLE_HEAD_DOVETAIL == 1) end
          if Machine.Offsets.DOUBLE_HEAD_MORTISE then BeamData.DOUBLE_HEAD_MORTISE = ( Machine.Offsets.DOUBLE_HEAD_MORTISE == 1) end
          if Machine.Offsets.DOUBLE_HEAD_DRILLING then BeamData.DOUBLE_HEAD_DRILLING = ( Machine.Offsets.DOUBLE_HEAD_DRILLING == 1) end
+         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
+         if Machine.Offsets.MIN_HEIGHT_ADDED_CUTS then BeamData.MIN_HEIGHT_ADDED_CUTS = min( Machine.Offsets.MIN_HEIGHT_ADDED_CUTS, BeamData.MIN_HEIGHT_ADDED_CUTS) end
          BeamData.MINRAW_S = max( BeamData.MINRAW_S, Machine.Offsets.MINRAW_S or BeamData.MINRAW_S)
          BeamData.MINRAW_L = max( BeamData.MINRAW_L, Machine.Offsets.MINRAW_L or BeamData.MINRAW_L)
          BeamData.CUT_EXTRA = Machine.Offsets.CUT_EXTRA or BeamData.CUT_EXTRA
@@ -101,6 +108,12 @@ if EgtExistsFile( sDataBeam) then
          BeamData.DIM_STRIP_SMALL = Machine.Offsets.DIM_STRIP_SMALL or BeamData.DIM_STRIP_SMALL
          BeamData.DIM_TO_CENTER_STRIP = Machine.Offsets.DIM_TO_CENTER_STRIP or BeamData.DIM_TO_CENTER_STRIP
          BeamData.MAXDIAM_POCK_CORNER = Machine.Offsets.MAXDIAM_POCK_CORNER or BeamData.MAXDIAM_POCK_CORNER
+         BeamData.LONGCUT_ENDLEN = Machine.Offsets.LONGCUT_ENDLEN or BeamData.LONGCUT_ENDLEN
+         BeamData.LONGCUT_MAXLEN = Machine.Offsets.LONGCUT_MAXLEN or BeamData.LONGCUT_MAXLEN
+         BeamData.ADVANCE_TAIL_OFFS = Machine.Offsets.ADVANCE_TAIL_OFFS or BeamData.ADVANCE_TAIL_OFFS
+         BeamData.LEN_VERY_SHORT_PART = Machine.Offsets.LEN_VERY_SHORT_PART or BeamData.LEN_VERY_SHORT_PART
+         BeamData.LEN_SHORT_PART = Machine.Offsets.LEN_SHORT_PART or BeamData.LEN_SHORT_PART
+         BeamData.OVM_MID = Machine.Offsets.OVM_MID or BeamData.OVM_MID
       end
       if Machine.Trave then
          BeamData.MIN_WIDTH = Machine.Trave.XMIN or BeamData.MIN_WIDTH
@@ -176,7 +189,15 @@ BeamData.GetMinUnloadableRaw = GetMinUnloadableRaw
 local function GetBlockedAxis( sHead, nToolType, sBlockedAxis)
    -- lama
    if nToolType == MCH_TY.SAW_STD or nToolType == MCH_TY.SAW_FLAT then
-      return ''
+      if sHead == 'H22' then
+         if sBlockedAxis == 'parallel' then
+            return 'A2=0'
+         elseif sBlockedAxis == 'perpendicular' then
+            return 'A2=90'
+         end
+      else
+         return ''
+      end
    -- sega a catena
    elseif nToolType == MCH_TY.MORTISE_STD then
       if sHead == 'H13' then

Common_PF1250.TPA.mlpe

@@ -28,7 +28,9 @@ function OnStart()
    --EMT.LINEINC = 1        -- incremento numerazione linee
    --EMT.Ft = 'F'           -- token per feed
    --EMT.St = 'S'           -- token per speed
-   EMT.FMAXPINZE = 116000 -- feed massima pinze
+   EMT.FMAXPINZE = EgtClamp( MaxFeedPinze or 116000, 20000, 130000)  -- feed massima pinze
+   EMT.MAXACC = MaxAcc or 6000    -- accelerazione massima pinze. In realtà è il tempo in millisecondi, quindi MAXACC corrisponde al tempo massimo per raggiungere la velocità desiderata
+   EMT.MINACC = MinAcc or 600     -- accelerazione minima pinze. In realtà è il tempo in millisecondi, quindi MINACC corrisponde al tempo massimo per raggiungere la velocità desiderata
    SetToParkLine()        -- si inizia con linee da parcheggiare su stack
 end
 
@@ -51,6 +53,7 @@ function OnProgramStart()
    end
    MyOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
    MyOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')')
+   MyOutput( '(HEADER)')
 
    -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
    if TEST_USE then
@@ -102,6 +105,7 @@ function OnProgramEnd()
    EMT.FALL = nil
    EMT.RELOAD = nil
    EMT.RELOAD2 = nil
+   MyOutput( '(FOOTER)')
    -- Termino il programma
    MyOutput( 'M202')
    MyOutput( 'M02')
@@ -738,9 +742,12 @@ function OnRapid()
             local MyMaxZ1 = EgtGetAxisMax( 'Z1')
             -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
             local bXSpec = EgtIf( BD.RIGHT_LOAD, ( EMT.L2 > -DeltaTabY), ( EMT.L2 < -DeltaTabY))
-            EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
-            EmitMoveStartHead( 1)
-            EmitMoveWaitHead( 1)
+            -- se non è aggregato, posso preselezionare testa e andare in posizione
+            if EMT.HEAD ~= 'H13' and EMT.HEAD ~= 'H14' then
+               EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
+               EmitMoveStartHead( 1)
+               EmitMoveWaitHead( 1)
+            end
             EmitMoveWaitChars( EgtIf( bOnlyCharY, 1, 3))
             -- se necessario allargo le cabine
             if RollerParkingNeeded( EMT.HEAD, PrevR1, PrevR2, EMT.R1, EMT.R2) or
@@ -861,8 +868,8 @@ function OnRapid()
                EmitParkRoller( dPosT, bSplitCut)
             end
             -- vado a quota sicurezza in X per permettere rotazione assi rotanti
-            if ( not EMT.L2pp or ( EMT.L2pp and EMT.L2pp > ParkMchY2)) and ( ParkB2 ~= EMT.R2  or  ParkC2 ~= EMT.R1) then
-               EmitMoveDataHead( 2, { X=ParkMchY2, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed}) 
+            if ( not EMT.L2pp or ( EMT.L2pp and EMT.L2pp > SafeX2RotAxis)) and ( ParkB2 ~= EMT.R2  or  ParkC2 ~= EMT.R1) then
+               EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed}) 
             end
             -- scrivo solo se gli assi rotanti sono cambiati
             if EMT.HEAD == 'H22' and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
@@ -882,11 +889,12 @@ function OnRapid()
          else
             -- selezione testa (posso muovere X solo a Zmax)
             local MaxZ3 = EgtGetAxisMax( 'Z3')
+            local MyParkX3 = EgtGetAxisHomePos( 'X3')
             -- se bisogna scrivere tutti gli assi
             if WriteAllCoordsOnFirstM101 then
-               EmitMoveDataHead( 3, { X=EMT.L2, Z=MaxZ3, B=ParkB3, C=0, S=Speed})
+               EmitMoveDataHead( 3, { X=MyParkX3, Z=MaxZ3, B=ParkB3, C=ParkC3, S=Speed})
             else
-               EmitMoveDataHead( 3, { X=EMT.L2, Z=MaxZ3, S=Speed})
+               EmitMoveDataHead( 3, { X=MyParkX3, Z=MaxZ3, S=Speed})
             end
             EmitMoveStartHead( 3)
             EmitMoveWaitHead( 3)
@@ -912,13 +920,15 @@ function OnRapid()
             elseif EgtGetHeadId( 'H38') then
                local B3Home = EgtGetAxisHomePos( 'B3')
                local C3Home = EgtGetAxisHomePos( 'C3')
-               EmitMoveDataHead( 3, { X=SafeX3RotAxis, S=Speed})
+               EmitMoveDataHead( 3, { X=-SafeX3RotAxis, S=Speed})
                -- se non sono esattamente in home, devo ruotare in zona sicura
                if abs( C3Home - EMT.R1) > 1 or abs( B3Home - EMT.R2) > 1 then
                   EMT.L3 = min( EMT.L3, SafeZ3RotAxis)
                   EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, S=Speed})
                   EmitMoveDataHead( 3, { B=EMT.R2, C=EMT.R1, S=Speed})
-                  EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                  if ( EMT.L3 - SafeZ3RotAxis) > 100 * GEO.EPS_SMALL then
+                     EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                  end
                   EmitMoveDataHead( 3, { X=EMT.L2, S=Speed})
                end
                -- muovo in posizione finale
@@ -1194,20 +1204,20 @@ function OnRapid()
                   end
                   -- scrivo solo se gli assi rotanti sono cambiati
                   EmitMoveDataHead( 2, { Z=-dSafeZ2, S=Speed})
-                  if EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                     EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+                  if EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                     EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                   end
                else
                   -- scrivo solo se gli assi rotanti sono cambiati
-                  if EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                     EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+                  if EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                     EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                   end
                end
             -- se stesso utensile vado già alla X di lavoro
             else
                -- scrivo solo se gli assi rotanti sono cambiati
-               if EMT.ZMAX and EMT.L2pp > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                  EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+               if EMT.ZMAX and EMT.L2pp > SafeX2RotAxis and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                  EmitMoveDataHead( 2, { X=SafeX2RotAxis, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                end
             end
             -- scrivo solo se gli assi rotanti sono cambiati
@@ -1253,13 +1263,15 @@ function OnRapid()
                if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                   local B3Home = EgtGetAxisHomePos( 'B3')
                   local C3Home = EgtGetAxisHomePos( 'C3')
-                  EmitMoveDataHead( 3, { X=SafeX3RotAxis, S=Speed})
+                  EmitMoveDataHead( 3, { X=-SafeX3RotAxis, S=Speed})
                   -- se non sono esattamente in home, devo ruotare in zona sicura
                   if abs( C3Home - EMT.R1) > 1 or abs( B3Home - EMT.R2) > 1 then
                      EMT.L3 = min( EMT.L3, SafeZ3RotAxis)
                      EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, S=Speed})
                      EmitMoveDataHead( 3, { B=EMT.R2, C=EMT.R1, S=Speed})
-                     EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                     if ( EMT.L3 - SafeZ3RotAxis) > 100 * GEO.EPS_SMALL then
+                        EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
+                     end
                      EmitMoveDataHead( 3, { X=EMT.L2, S=Speed})
                   end
                end
@@ -1414,7 +1426,9 @@ function OnRapid()
       local bSplitCut = ( EMT.MCHUSERNOTES:find( 'Split', 1, true) ~= nil)
       -- porto in home la testa corrente se lavorazione successiva sopra con testa diversa oppure se punta lunga
       local nNextTopHSet = GetNextTopHSet( EMT.MCHID)
-      local bTopGoHome = ( nHSet ~= 2 and nNextTopHSet ~= 0 and nHSet ~= nNextTopHSet) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
+      -- ricavo prossimo utensile
+      local sNextTool = GetNextTool( EMT.MCHID)
+      local bTopGoHome = ( IsLastPath( EMT.PATHID) and not sNextTool and nHSet == 3) or ( nHSet ~= 2 and nNextTopHSet ~= 0 and nHSet ~= nNextTopHSet) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
       EmitZmax( true, true, EMT.R1p, EMT.R2p, bSplitCut, bTopGoHome, false)
       -- aggiorno quota finale trave dopo Zmax
       EMT.L1o = EMT.TPOS
@@ -1611,24 +1625,20 @@ end
 
 ---------------------------------------------------------------------
 function CalcDinamicaPinze( dH, dS, dL)
-   local MinTempoAcc = 0.6                         -- [s]
-   local MaxTempoAcc = 6.0                         -- [s]
-   local KgMtCubo= WoodDensity or 550             -- densità legno [Kg / metro cubo]
+   local MinTempoAcc = EMT.MINACC        -- [ms] ~600
+   local MaxTempoAcc = EMT.MAXACC        -- [ms] ~6000
+   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 TempoAcc = EgtClamp( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito), MinTempoAcc, MaxTempoAcc)
    local RidFeed = 100 / Massa * 100
    if RidFeed > 100 then
       RidFeed = 100
    elseif RidFeed < 10 then
       RidFeed = 10
    end
-   return TempoAcc * 1000, MinTempoAcc * 1000, RidFeed
+   return TempoAcc, MinTempoAcc, RidFeed
 end
 
 ---------------------------------------------------------------------
@@ -2297,44 +2307,53 @@ function AdjustTcPos( bLen3, sTcPos, dAxR3)
    end
    if sPos == '101' then
       if not dAxR3 then dAxR3 = EMT.R3 end
-      if abs( dAxR3 - 0) < 0.1 then
-         sPos = '101'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '102'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '103'
-      elseif abs( dAxR3 - 90) < 0.1 then
-         sPos = '104'
-      else
-         EmtSetLastError( 1210, 'Chain saw orientation not allowed')
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '101'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '102'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '103'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '104'
+         else
+            EmtSetLastError( 1210, 'Tool T101 orientation not allowed')
+         end
       end
    end
    if sPos == '111' then
       if not dAxR3 then dAxR3 = EMT.R3 end
-      if abs( dAxR3 - 0) < 0.1 then
-         sPos = '111'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '112'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '113'
-      elseif abs( dAxR3 - 90) < 0.1 then
-         sPos = '114'
-      else
-         EmtSetLastError( 1210, 'Chain saw orientation not allowed')
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '111'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '112'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '113'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '114'
+         else
+            EmtSetLastError( 1210, 'Tool T111 orientation not allowed')
+         end
       end
    end
    if sPos == '121' then
       if not dAxR3 then dAxR3 = EMT.R3 end
-      if abs( dAxR3 - 0) < 0.1 then
-         sPos = '121'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '122'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '123'
-      elseif abs( dAxR3 - 90) < 0.1 then
-         sPos = '124'
-      else
-         EmtSetLastError( 1210, 'MultiDrill orientation not allowed')
+      -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
+      if dAxR3 then
+         if abs( dAxR3 - 0) < 0.1 then
+            sPos = '121'
+         elseif abs( dAxR3 - 270) < 0.1 then
+            sPos = '122'
+         elseif abs( dAxR3 - 180) < 0.1 then
+            sPos = '123'
+         elseif abs( dAxR3 - 90) < 0.1 then
+            sPos = '124'
+         else
+            EmtSetLastError( 1210, 'Tool T121 orientation not allowed')
+         end
       end
    end
    if sPos == '201' then
@@ -2494,7 +2513,17 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome, bUsePrev
          -- salgo in Z sicurezza raddrizzando la B
          local dSafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
          EmitMoveDataHead( 1, { Z=dSafeZ1, B=dHomeB1, Fmt=1})
-         EmitMoveDataHead( 1, { X=-dHomeX1, C=dHomeC1, Fmt=1})
+         -- lascio la motosega a parcheggio. In caso di utilizzo della testa 3, la motosega viene scaricata automaticamente dalla macro.
+         EmitMoveDataHead( 1, { X=-ParkCSawX1, C=dHomeC1, Fmt=1})
+         EmitMoveStartHead( 1)
+         EmitMoveWaitHead( 1)
+      end
+      -- se ho degli aggregati e la prossima è la testa 3, scarico e prendo utensile di default
+      local nNextTopHSet = GetNextTopHSet( EMT.MCHID)
+      if IsHeadExisting( 3) and nNextTopHSet == 3 and ( EMT.TCPOS == 'T101' or EMT.TCPOS == 'T111' or EMT.TCPOS == 'T121') then
+         -- lascio la motosega a parcheggio. In caso di utilizzo della testa 3, la motosega viene scaricata automaticamente dalla macro.
+         local sDefToolToLoad = AdjustTcPos( false, DefTcPos1)
+         EmitMoveDataHead( 1, { X=-ParkX1, TPos=sDefToolToLoad, Fmt=1})
          EmitMoveStartHead( 1)
          EmitMoveWaitHead( 1)
       end
@@ -2547,7 +2576,7 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome, bUsePrev
          end
          -- se non sono esattamente in home, devo ruotare in zona sicura
          if abs( dHomeC3 - PrevR1) > 1 or abs( dHomeB3 - PrevR2) > 1 then
-            EmitMoveDataHead( 3, { X=SafeX3RotAxis, Fmt=1})
+            EmitMoveDataHead( 3, { X=-SafeX3RotAxis, Fmt=1})
             EmitMoveDataHead( 3, { Z=SafeZ3RotAxis, Fmt=1})
             EmitMoveDataHead( 3, { B=dHomeB3, C=dHomeC3, Fmt=1})
          end
@@ -2782,35 +2811,44 @@ function PreselectNextDiffHead( nMchId, sHead)
                end
             -- altrimenti (testa 3)
             else
-               -- se preselezione testa 1
-               if nNextHSet == 1 then
-                  local nNextTc = GetTcForTopHeadTool( sNextTcPos)   -- utensile da caricare
-                  local nPrevTc = GetTcForTopHeadTool( EMT.PREVTCPOS_H1) -- utensile da depositare
-                  -- se devo lasciare o prelevare da TC1 oppure non so cosa c'è montato, non posso preselezionare
-                  if nNextTc == 1 or nPrevTc == 1 or nPrevTc == 0 then return
-                  -- TC su montante sinistro
+               -- se è macchina a 3 teste con gruppo truciolatore 4 assi
+               if EgtGetHeadId( 'H39') then
+                  -- se preselezione testa 1
+                  if nNextHSet == 1 then
+                     local nNextTc = GetTcForTopHeadTool( sNextTcPos)   -- utensile da caricare
+                     local nPrevTc = GetTcForTopHeadTool( EMT.PREVTCPOS_H1) -- utensile da depositare
+                     -- se devo lasciare o prelevare da TC1 oppure non so cosa c'è montato, non posso preselezionare
+                     if nNextTc == 1 or nPrevTc == 1 or nPrevTc == 0 then return
+                     -- TC su montante sinistro
+                     else
+                        if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
+                        if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     end
+                  -- se preselezione testa 2
                   else
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
-                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
-                  end
-               -- se preselezione testa 2
-               else
-                  -- se agregato lama speciale non preseleziono mai
-                  if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then return end
-                  -- se la Z di lavoro è più bassa del cambio utensili, verifico quota X (la nostra Y)
-                  if EMT.MAXMIN[3] < MinZ1ToChangeH2 then
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
-                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     -- se agregato lama speciale non preseleziono mai
+                     if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then return end
+                     -- se la Z di lavoro è più bassa del cambio utensili, verifico quota X (la nostra Y)
+                     if EMT.MAXMIN[3] < MinZ1ToChangeH2 then
+                        if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
+                        if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                     end
                   end
+               -- se gruppo lama dedicato, senza cambio utensile non si preseleziona mai
+               elseif EgtGetHeadId( 'H38') then
+                  return
                end
             end
 
             -- faccio preselezione ( se sono arrivato qui, vuol dire che posso preselezionare)
             if nNextHSet == 1 then
                local dNextX
-               -- se sto lavorando con testa 3, la testa 1 deve restare in home
+               -- se sto lavorando con testa 3, la testa 1 preselezionata deve restare in home
                if nHSet == 3 then
-                  dNextX = EgtGetAxisHomePos( 'X1')
+                  dNextX = - EgtGetAxisHomePos( 'X1')
+               -- se il prossimo utensile su testa 1 è utensile lungo, resta in home
+               elseif sNextHead == 'H11' and dNextTotLen > LongTool then
+                  dNextX = - EgtGetAxisHomePos( 'X1')
                -- altrimenti recupero quota X1 (nostro L2)
                else
                   dNextX = GetStartMachiningXaxis( nNextMchId)
@@ -2822,7 +2860,7 @@ function PreselectNextDiffHead( nMchId, sHead)
                      EmitMoveDataHead( 1, { X=dNextX, B=ParkB1, C=ParkC1, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                   else
                      local nNextTc = GetTcForTopHeadTool( sNextTcPos)
-                     EmitMoveDataHead( 1, { X=dNextX, B=ParkLongB1, C=EgtIf( nPrevTc ~= 2, ParkLongTc1C1, ParkLongTc2C1), TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
+                     EmitMoveDataHead( 1, { X=dNextX, B=ParkLongB1, C=EgtIf( nNextTc ~= 2, ParkLongTc1C1, ParkLongTc2C1), TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                   end
                   EmitMoveStartHead( 1)
                elseif sNextHead == 'H12' or sNextHead == 'H16' then
@@ -2836,9 +2874,11 @@ function PreselectNextDiffHead( nMchId, sHead)
                   EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, dNextX), B=ParkCSawB1, C=MyParkCSawC1, TPos=AdjustTcPos( false, sNextTcPos, dPosA), Fmt=2})
                   EmitMoveStartHead( 1)
                end
-            else
+            elseif nNextHSet == 2 then
                EmitMoveDataHead( 2, { B=ParkB2, C=ParkC2, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                EmitMoveStartHead( 2)
+            else
+               ; -- non si preseleziona testa 3
             end
          end
       end

Common_PF1250.mlpe

@@ -224,18 +224,24 @@ function OnSimulDispositionStart()
                end
             end
             -- determino la risoluzione dello Zmap
-            local dArea = b3Raw:getDimX() * b3Raw:getDimY() + b3Raw:getDimX() * b3Raw:getDimZ() + b3Raw:getDimY() * b3Raw:getDimZ()
-            local dTol = 4.51
-            if dArea < CoeffVM * 0.5e6 then
-               dTol = 1.01
-            elseif dArea < CoeffVM * 1.2e6 then
-               dTol = 1.51
-            elseif dArea < CoeffVM * 2.5e6 then
-               dTol = 1.97
-            elseif dArea < CoeffVM * 5.0e6 then
-               dTol = 2.81
-            elseif dArea < CoeffVM * 10.0e6 then
-               dTol = 3.77
+            local dTol = 4.71
+            if EmtGetVMillStep then
+               dTol = EmtGetVMillStep( b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), 4.71)
+            else
+               local dArea = b3Raw:getDimX() * b3Raw:getDimY() + b3Raw:getDimX() * b3Raw:getDimZ() + b3Raw:getDimY() * b3Raw:getDimZ()
+               if dArea < 0.075e6 then
+                  dTol = 0.71
+               elseif dArea < 0.15e6 then
+                  dTol = 1.01
+               elseif dArea < 0.3e6 then
+                  dTol = 1.51
+               elseif dArea < 0.6e6 then
+                  dTol = 1.97
+               elseif dArea < 1.2e6 then
+                  dTol = 2.81
+               elseif dArea < 2.4e6 then
+                  dTol = 3.77
+               end
             end
             -- creo lo Zmap
             local VMillId = EgtVolZmapBox( nPartRawId, b3Raw:getMin(), b3Raw:getDimX(), b3Raw:getDimY(), b3Raw:getDimZ(), dTol, true, GDB_RT.GLOB)
@@ -463,6 +469,8 @@ function OnSimulToolSelect( dPosA)
       end
       if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' then
          EgtSetAxisPos( 'Z1', MaxZ1Blade)
+      elseif EMT.HEAD == 'H13' then
+         EgtSetAxisPos( 'Z1', ParkCSawZ1)
       else
          EgtSetAxisPos( 'Z1', MaxZ1)
       end
@@ -474,6 +482,8 @@ function OnSimulToolSelect( dPosA)
    end
    -- se sega a catena, imposto subito angolo scelto per asse virtuale A
    if EMT.HEAD == 'H13' then
+      -- se prima lavorazione con motosega, parto dalla sua posizione di parcheggio
+      EgtSetAxisPos( 'X1', ParkCSawX1)
       -- valore dell'asse virtuale
       dPosA = dPosA or GetNextChainSawingVirtualAxis( EMT.MCHID)
       -- imposto il valore di A
@@ -526,8 +536,10 @@ function OnSimulToolSelect( dPosA)
    EMT.A2n = 'Y2'
    EMT.A3n = 'V1'
    EMT.A4n = 'V2'
-   -- se attivo Vmill
-   EmtSetToolForVmill( EMT.TOOL, EMT.HEAD, EMT.EXIT, EMT.VMILL)
+   -- se utensile non flottante, abilito per Vmill
+   if not EMT.TFLOAT then
+      EmtSetToolForVmill( EMT.TOOL, EMT.HEAD, EMT.EXIT, EMT.VMILL)
+   end
    -- se attivo Collision Check
    EMT.SAFEDIST = COLL_SAFE_DIST
    if EMT.COLLOBJ then
@@ -552,8 +564,9 @@ function OnSimulToolDeselect( dPrevA)
    -- se devo deselezionare testa 3, la mando a parcheggio
    if nSetHead == 3 then
       SimulMoveAxis( 'X3', ParkX3, MCH_SIM_STEP.RAPID)
+   end
    -- per testa gruppo 2 
-   elseif nNextSetHead == 2 then
+   if nNextSetHead == 2 then
       -- deposito lama su aggregato testa sotto
       if EMT.PREVHEAD_H2 == 'H22' then
          -- simulo movimento
@@ -570,7 +583,7 @@ function OnSimulToolDeselect( dPrevA)
       -- visualizzo utensile su TcPos
       ShowToolInTcPos( EMT.PREVTCPOS_H2, true)
       -- nascondo l'utensile sulla testa
-      EgtSetStatus( EgtGetHeadId( EMT.PREVHEAD_H2 or '') or GDB_ID.NULL, GDB_ST.OFF)
+      EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H2 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
    -- se testa gruppo 1
    elseif nNextSetHead == 1 and EMT.PREVTCPOS_H1 then
       -- deposito utensile fresa
@@ -630,14 +643,28 @@ function OnSimulToolDeselect( dPrevA)
       -- nascondo l'utensile sulla testa
       EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H1 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
    end
-   -- se passo da testa 1 a 3 o viceversa
+   -- se passo da testa 1 a 3 scarico aggregato
    if nNextSetHead == 3 then
-      -- deposito eventuale sega a catena
-      if EMT.PREVHEAD_H1 == 'H13' then
+      -- deposito utensile prelevato da posizioni speciali
+      if EMT.TCPOS == 'T101' or EMT.TCPOS == 'T111' or EMT.TCPOS == 'T121' then
          -- visualizzo utensile su TcPos
          ShowToolInTcPos( EMT.PREVTCPOS_H1, true)
          -- nascondo l'utensile sulla testa
          EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H1 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
+
+         local sTool, sTcPos, sHead
+         local vTools = EgtGetToolsInCurrSetupPos( DefTcPos1)
+         if vTools and vTools[1] then
+            sTool = vTools[1]
+            sTcPos = DefTcPos1
+            sHead = GetAdjHeadFromTcPos( 1, sTcPos)
+            -- carico l'utensile
+            EgtLoadTool( sHead, 1, sTool)
+            ShowToolInTcPos( DefTcPos1, false)
+         end
+         EMT.PREVTOOL_H1 = sTool
+         EMT.PREVHEAD_H1 = sHead
+         EMT.PREVTCPOS_H1 = DefTcPos1
       end
       SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
    end
@@ -659,7 +686,7 @@ function OnSimulToolDeselect( dPrevA)
       -- simulo movimento
       SimulMoveAxes( 'B1', ParkCSawB1, MCH_SIM_STEP.RAPROT, 'C1', EgtGetAxisHomePos( 'C1'), MCH_SIM_STEP.RAPROT)
       SimulMoveAxes( 'X1', ParkCSawX1, MCH_SIM_STEP.RAPID, 'Z1', ParkCSawZ1, MCH_SIM_STEP.RAPID)
-   -- prendo utensile sega a catena
+   -- prendo aggregato multi drill
    elseif EMT.NEXTHEAD == 'H14' then
       -- simulo movimento
       SimulMoveAxes( 'B1', ParkMultiDrillB1, MCH_SIM_STEP.RAPROT, 'C1', EgtGetAxisHomePos( 'C1'), MCH_SIM_STEP.RAPROT)
@@ -1083,8 +1110,8 @@ function OnSimulMoveStart()
                end
                SimulMoveAxis( 'Z2', Z2Home, MCH_SIM_STEP.RAPID)
                -- Porto la X alla giusta quota
-               if X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
-                  SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
+               if X2Pos > SafeX2RotAxis and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
+                  SimulMoveAxis( 'X2', SafeX2RotAxis, MCH_SIM_STEP.RAPID)
                end
             end
          else
@@ -1093,8 +1120,8 @@ function OnSimulMoveStart()
                SimulMoveAxis( 'Z2', Z2Home, MCH_SIM_STEP.RAPID)
             end
             -- Porto la X alla giusta quota
-            if EMT.ZMAX and X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
-               SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
+            if EMT.ZMAX and X2Pos > SafeX2RotAxis and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
+               SimulMoveAxis( 'X2', SafeX2RotAxis, MCH_SIM_STEP.RAPID)
             end
          end
          if EMT.HEAD == 'H22' then
@@ -1125,7 +1152,9 @@ function OnSimulMoveStart()
                   EMT.L3 = min( EMT.L3, SafeZ3RotAxis)
                   SimulMoveAxis( 'Z3', SafeZ3RotAxis, MCH_SIM_STEP.RAPID)
                   SimulMoveAxes( 'B3', EMT.R2, MCH_SIM_STEP.COLLROT, 'C3', EMT.R1, MCH_SIM_STEP.COLLROT)
-                  SimulMoveAxis( 'Z3', EMT.L3, MCH_SIM_STEP.RAPID)
+                  if ( EMT.L3 - SafeZ3RotAxis) > 100 * GEO.EPS_SMALL then
+                     SimulMoveAxis( 'Z3', EMT.L3, MCH_SIM_STEP.RAPID)
+                  end
                   SimulMoveAxis( 'X3', EMT.L2, MCH_SIM_STEP.RAPID)
                end
             end
@@ -1244,10 +1273,24 @@ function OnSimulMoveStart()
    end
    EMT.ZMAX = nil
    EMT.TO_ZMAX = nil
+
+   -- se aggregato flottante su inizio attacco va compresso
+   if EMT.TFLOAT and not EMT.TFLOAT_CMP and EMT.MOVE == 1 and EgtGetName( EMT.MOVEID) == 'LI' then
+      -- recupero lunghezza 
+      local dOffsL = - EgtGetMachiningParam( MCH_MP.OFFSL)
+      -- imposto compressione della parte flottante
+      SetFloatPos( EMT.HEAD, dOffsL)
+      -- imposto dati utensile in posizione compressa
+      EmtSetToolForVmill( EMT.TOOL, EMT.HEAD, EMT.EXIT, EMT.VMILL, 2, -dOffsL)
+      -- dichiaro che è compresso (assegnando Id entità di movimento)
+      EMT.TFLOAT_CMP = EMT.MOVEID
+   end
 end
 
 ---------------------------------------------------------------------
 function OnSimulMoveEnd()
+   -- gruppo della testa
+   local nHSet = GetHeadSet( EMT.HEAD)
    -- rimozione eventuali sfridi
    if EMT.FLAG == 301 then 
       ExecRemoveScraps()
@@ -1292,16 +1335,47 @@ function OnSimulMoveEnd()
    if EMT.MOVE == 0 and EMT.FLAG == 3 then
       -- eventuale rimozione sfridi
       ExecRemoveScraps()
+      -- ricavo prossimo utensile
+      local sNextTool = GetNextTool( EMT.MCHID)
+      -- vado in home se è ultimo movimento ed è ultima lavorazione
+      local bToXhome = ( IsLastPath( EMT.PATHID) and not sNextTool and nHSet == 3) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
       -- eseguo
-      ExecMoveZmax( EMT.MCHSPLIT)
+      ExecMoveZmax( EMT.MCHSPLIT, bToXhome)
       EMT.TO_ZMAX = nil
    end
+
+   -- se utensile flottante e movimento di compressione
+   if EMT.TFLOAT and EMT.MOVEID == EMT.TFLOAT_CMP then
+      -- verifico ci sia stata collisione tra ghiera flottante (portautensile e pezzo)
+      if not EMT.TFLOAT_TH_COMPR_COLL then
+         local sErr = 'CUTID='..tostring( EMT.CUTID)..'; TASKID='..tostring( EMT.TASKID)..'; Mach='..EMT.MCHNAME..'; Floating Ring not compressed on approach'
+         EmtSetLastError( 1222, sErr)
+         EgtOutLog( 'Error : ' .. sErr, 1)
+      else
+         EgtOutLog( 'Floating Ring compressed on approach (MOVEID='..EgtNumToString( EMT.MOVEID)..')', 1)
+      end
+      EMT.TFLOAT_TH_COMPR_COLL = nil
+   end
+   -- se aggregato flottante su fine uscita va rilasciato
+   if EMT.TFLOAT and EMT.TFLOAT_CMP and EMT.MOVE == 1 and EgtGetName( EMT.MOVEID) == 'LO' and EgtGetName( EgtGetNext( EMT.MOVEID) or GDB_ID.NULL) ~= 'LO' then
+      -- reset compressione della parte flottante
+      SetFloatPos( EMT.HEAD, 0)
+      -- dichiaro che è rilasciato
+      EMT.TFLOAT_CMP = nil
+   end   
 end
 
 ---------------------------------------------------------------------
 function OnSimulCollision()
    -- se prima collisione della lavorazione, la segnalo
    if EMT.MCHNAME ~= EMT.LAST_MCHNAME_COLLIDE then
+      -- speciale per utensile flottante (suo holder contro il grezzo)
+      if EMT.TFLOAT and EMT.TFLOAT_CMP and EMT.SIMCOBIND == 1002 and EMT.SIMVMID == EMT.VMILL[1] then
+         if EMT.MOVEID == EMT.TFLOAT_CMP then
+            EMT.TFLOAT_TH_COMPR_COLL = true
+         end
+         return
+      end
       local Class = ''
       if EMT.SIMCOBIND == 1001 or EMT.SIMCOBIND == 1011 then
          Class = 'T_'..EMT.HEAD
@@ -1462,7 +1536,9 @@ function ExecStartHome()
    EgtResetAxisPos( 'C1')
    EgtResetAxisPos( 'B1')
    -- Testa 2
-   EgtSetAxisPos( 'X2', SafeX2)
+   local _, sHead, _, _, _, _ = FindFirstToolOnHeadSet( 2)
+   local PosXStart = EgtIf( sHead == 'H22', SafeX2, ParkX2)
+   EgtSetAxisPos( 'X2', PosXStart)
    EgtSetAxisPos( 'Z2', MinZ2)
    EgtResetAxisPos( 'C2')
    EgtResetAxisPos( 'B2')
@@ -1471,12 +1547,13 @@ end
 ---------------------------------------------------------------------
 function ExecMoveHome( bNearV, bMchSplit)
    -- risalita a Zmax
-   ExecMoveZmax( bMchSplit)
-   -- se testa sotto e macchian a 3 teste e gruppo truciolatore a 4 assi
+   ExecMoveZmax( bMchSplit, true)
+   -- se testa sotto e macchina a 3 teste
    if GetHeadSet( EMT.HEAD) == 2 and IsHeadExisting( 3) then
-      if not SimulMoveAxis( 'X2', ParkX2, MCH_SIM_STEP.RAPID) then
+      if not SimulMoveAxis( 'X2', EgtIf( EMT.HEAD == 'H22', SafeX2, ParkX2), MCH_SIM_STEP.RAPID) then
          EgtOutLog( 'Error on MoveHome : X2')
       end
+      --  se gruppo truciolatore a 4 assi
       if EgtGetHeadId( 'H39') then
          if not SimulMoveAxis( 'Z2', ParkInLavZ2, MCH_SIM_STEP.RAPID) then
            EgtOutLog( 'Error on MoveHome : Z2')
@@ -1496,7 +1573,7 @@ function ExecMoveHome( bNearV, bMchSplit)
 end
 
 ---------------------------------------------------------------------
-function ExecMoveZmax( bMchSplit)
+function ExecMoveZmax( bMchSplit, bGoToHome)
    -- set della testa
    local nSetHead = GetHeadSet( EMT.HEAD)
    -- posizioni correnti degli assi testa
@@ -1536,6 +1613,9 @@ function ExecMoveZmax( bMchSplit)
             SimulMoveAxis( 'B1', HomeB, MCH_SIM_STEP.COLLROT)
          end
          SimulMoveAxis( 'Z1', MyMaxZ1, MCH_SIM_STEP.RAPID)
+         if bGoToHome then
+            SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
+         end
       -- altrimenti sega a catena
       else
          -- salgo in Z sicurezza raddrizzando la B
@@ -1583,6 +1663,9 @@ function ExecMoveZmax( bMchSplit)
             SimulMoveAxes( 'C3', HomeC, MCH_SIM_STEP.COLLROT, 'B3', HomeB, MCH_SIM_STEP.COLLROT)
          end
          SimulMoveAxis( 'Z3', MyMaxZ3, MCH_SIM_STEP.RAPID)
+         if bGoToHome then
+            SimulMoveAxis( 'X3', ParkX3, MCH_SIM_STEP.RAPID)
+         end
       else
          EmtSetLastError( 1212, "HEAD not managed")
       end
@@ -2039,6 +2122,10 @@ function LoadFirstTool( nHSet, sTcPosDef)
    EgtUnloadTool( EgtIf( nHSet == 1, 'H11', 'H21'), 1)
    if GetHeadSetFromTcPos( sTcPosDef) ~= nHSet then return end
    local sTool, sHead, sTcPos, sTTotLen, sTotDiam, sBlockedAxis = FindFirstToolOnHeadSet( nHSet)
+   -- se primo utensile motosega, non lo carico e visualizzo quello di default
+   if sHead == 'H13' then
+      sTool = nil
+   end
    if not sTool then
       local vTools = EgtGetToolsInCurrSetupPos( sTcPosDef)
       if vTools and vTools[1] then
@@ -2557,7 +2644,7 @@ function GetNextChainSawingVirtualAxis( MchId)
    -- la imposto come lavorazione corrente
    EgtSetCurrMachining( NextMchId)
    -- recupero il valore dell'asse virtuale bloccato A
-   local dPosA = GetCurrMultiDrillVirtualAxis()
+   local dPosA = GetCurrChainSawingVirtualAxis()
    -- ripristino la lavorazione corrente
    if MchId then
       EgtSetCurrMachining( MchId)
@@ -2584,7 +2671,7 @@ function GetNextMultiDrillVirtualAxis( MchId)
    -- la imposto come lavorazione corrente
    EgtSetCurrMachining( NextMchId)
    -- recupero il valore dell'asse virtuale bloccato A
-   local dPosA = GetCurrChainSawingVirtualAxis()
+   local dPosA = GetCurrMultiDrillVirtualAxis()
    -- ripristino la lavorazione corrente
    if MchId then
       EgtSetCurrMachining( MchId)
@@ -2638,6 +2725,11 @@ function GetStartMachiningXaxis( nMchId)
    end
 end
 
+---------------------------------------------------------------------
+function IsLastPath( nPathId)
+   return not EgtGetNext( nPathId)
+end
+
 ---------------------------------------------------------------------
 function RollerParkingNeeded( sHead, dAng1p, dAng2p, dAng1, dAng2)
    if sHead == 'H11' or sHead == 'H12' or sHead == 'H13' or sHead == 'H16' then
@@ -2645,7 +2737,7 @@ function RollerParkingNeeded( sHead, dAng1p, dAng2p, dAng1, dAng2)
    elseif sHead == 'H21' or sHead == 'H22' then
       return ( abs( dAng1 - dAng1p) > 1 or ( abs( dAng2 - dAng2p) > 1 and abs( dAng1 % 180.0) > 1))
    elseif sHead == 'H38' then
-      return ( abs( dAng1 - dAng1p) > 1 or ( abs( dAng2 - dAng2p) > 1 and abs( dAng1 % 180.0) > 1))
+      return ( abs( dAng1 - dAng1p) > 1 or  abs( dAng2 - dAng2p) > 1)
    end
 end
 

Common_PF1250.mlse

@@ -77,6 +77,8 @@ function OnSpecialGetMaxZ()
             EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
          elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
             EMC.MAXZ = ParkZ1 + 200
+         elseif vtTp:getZ() > 0.5 or vtT:getZ() > 0.5 then
+            EMC.MAXZ = ParkZ1 + 100
          else
             EMC.MAXZ = ParkZ1 + 1
          end
@@ -95,6 +97,8 @@ function OnSpecialGetMaxZ()
             EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
          elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
             EMC.MAXZ = ParkZ1 + 200
+         elseif vtTp:getZ() > 0.5 or vtT:getZ() > 0.5 then
+            EMC.MAXZ = ParkZ1 + 100
          else
             EMC.MAXZ = ParkZ1 + 1
          end
@@ -205,7 +209,7 @@ local SIC_V = 50                   -- sicurezza da testa
 local MIN_ENG_V = 115              -- ingombro asse Z
 local MIN_ENG_RACK_V = 161         -- ingombro asse Z con cremagliera
 local MIN_ENG_XZ2_V = 180          -- ingombro assi XZ sotto
-local MIN_Z2_FOR_ENG_XZ2_V = 270   -- quota Z2 da cui considerare ingombro assi XZ sotto
+local MIN_Z2_FOR_ENG_XZ2_V = 250   -- quota Z2 da cui considerare ingombro assi XZ sotto
 local AGG_V = MinDeltaYV           -- ingombro rulli pressori + sicurezza
 local MaxLenSmT = 1500             -- massima lunghezza pezzo scaricato con nastri verdi
 local DIST_Y1MAX_LOAD = 100        -- distanza carrello Y1 da massimo asse al carico
@@ -1297,8 +1301,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
@@ -1306,11 +1313,15 @@ function SpecCalcUnload()
       table.insert( vCmd, { 11, 0})
       EMC.CNT = nil
    end
-   -- Sposto il pezzo in posizione di scarico
-   local dFinT = EgtIf( EMC.LB < MaxLenSmT, UnloadSmT, 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 = EgtIf( EMC.LB < MaxLenSmT, UnloadSmT, 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

Essetre-PF1500MAXrl-3T.ini

@@ -25,6 +25,8 @@ H21.1=Standard.nge
 H21.1:MILL_NOTIP=MillNoTip.nge
 H21.1:SAW_STD=SawH2Std.nge
 H21.1:SAW_FLAT=SawH2Flat.nge
+H22.1=Saw.nge
+H38.1=SawH3Std.nge
 
 [Machinings]
 Drilling=1

Essetre-PF1500MAXrl-3T.mlde

@@ -5,10 +5,10 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '2.6k2_DEV3'
-PP_NVER = '2.6.11.2'
-MIN_MACH_VER = '2.5k1'
-MACH_NAME = 'Essetre-PF1500MAXrl-3T'
+PP_VER = '2.7g1'
+PP_NVER = '2.7.7.1'
+MIN_MACH_VER = '2.7d2'
+MACH_NAME = string.match( EgtGetCurrMachineDir(), "[^\\]+$")  -- si ricava il nome della macchina dal direttorio
 
 -- Carico i dati globali
 local sMachDir = EgtGetCurrMachineDir()
@@ -69,13 +69,15 @@ SawUnderOffsY = -111
 SawUnderOffsZ = 150.25
 SawUnderC2Offs = 0
 SawUnderB2Offs = 0
+SawC3Offs = 0
+SawB3Offs = 0
 ChSawLen = 91.0
 Mill2Offs = 170.0
 SawC2Offs = 0
 SawB2Offs = 0
 Mill3Offs = 163.0
 MinX1 = 0
-MaxX1 = 4750
+MaxX1 = 4850
 MinZ1 = -1850
 MaxZ1 = 0
 MaxZ1Blade = -100
@@ -91,7 +93,7 @@ ParkTc1X1 = 800
 ParkZ1 = -525
 ParkC1 = -90
 ParkB1 = -90
-ParkCSawX1 = 1700
+ParkCSawX1 = 2500
 ParkCSawZ1 = -100
 ParkCSaw0Z1 = -400
 ParkCSawC1 = -90
@@ -116,19 +118,19 @@ ParkMultiDrill0C1 = -90       -- posizione parcheggio asse C per aggregato forat
 ParkMultiDrillB1 = 0          -- posizione parcheggio asse B per aggregato forature multiplo
 ParkMultiDrillZ1 = 0          -- posizione parcheggio asse Z per aggregato forature multiplo
 MinZ3 = -1550
-MaxZ3 = 0
+MaxZ3 = -200
 MinX3 = 0
 MaxX3 = 4000
 MinC3 = -181
 MaxC3 = 181
-MinB3 = 0
-MaxB3 = 180
+MinB3 = -91
+MaxB3 = 91
 ParkX3 = 0
-ParkZ3 = 0
-ParkC3 = 0
-ParkB3 = 0
-SafeX3RotAxis = 1300
-SafeZ3RotAxis = -600
+ParkZ3 = -200
+ParkC3 = -90
+ParkB3 = -75
+SafeX3RotAxis = 1600
+SafeZ3RotAxis = -655
 MinX2 = -3060
 MaxX2 = 0
 MinZ2 = 0
@@ -141,6 +143,7 @@ MinB2b = -119
 MaxB2b = 119
 ParkX2 = -100
 SafeX2 = -400
+SafeX2RotAxis = -1000
 ParkZ2 = 0
 ParkInLavZ2 = 200
 ParkC2 = -90
@@ -162,8 +165,8 @@ DimTabX = 30000
 Delta2TabY = -2907.4
 Delta2TabZ = 693.0 - Mill2Offs                                -- per TPA : 543.0 - Mill2Offs      -- per NUM : 373.0
 Delta3TabY = 2065.5
-Delta3TabZ = -1430.25
-Head3X = -163
+Delta3TabZ = -1430 + Mill3Offs
+Head3X = 0
 Head3Y = DeltaTabY - Delta3TabY
 Head3Z = DeltaTabZ - Delta3TabZ
 Head2X = 0
@@ -179,7 +182,7 @@ FirstSaw = false
 SecondSaw = true
 SecondChain = true                               -- magazzino seconda sega a catena
 TcSpecialTools = true                            -- magazzino per utensili speciali. In genere truciolatore
-DrillingAggregate = true                         -- aggregato foratura multipla dipende dal magazzino utensili speciali. Viene montato li
+DrillingAggregate = false                         -- aggregato foratura multipla dipende dal magazzino utensili speciali. Viene montato li
 TcAggreBladeUnder = true                         -- lama su aggregato per testa da sotto
 EmitAccClamps = true
 WriteAllCoordsOnFirstM101 = true
@@ -246,9 +249,9 @@ if EgtExistsFile( sDataBeam) then
          if Machine.Offsets.PARK_Y2 then ParkMchY2 = Machine.Offsets.PARK_Y2 end
          if Machine.Offsets.MIN_V2 then MinV2 = Machine.Offsets.MIN_V2 end
          if Machine.Offsets.MAX_V2 then MaxV2 = Machine.Offsets.MAX_V2 end
+         if Machine.Offsets.MIN_DELTAVY then MinDeltaYV = Machine.Offsets.MIN_DELTAVY + 0.1 end
          if Machine.Offsets.DIST_FTZERO then LoadT = Machine.Offsets.DIST_FTZERO end
          if Machine.Offsets.DELTA_CARICZERO then TurnerOffs = Machine.Offsets.DELTA_CARICZERO end
-         if Machine.Offsets.MIN_DELTAVY then MinDeltaYV = Machine.Offsets.MIN_DELTAVY + 0.1 end
          if Machine.Offsets.DIST_UNLOAD then UnloadT = Machine.Offsets.DIST_UNLOAD end
          if Machine.Offsets.PIVOT_T1 then MillOffs = Machine.Offsets.PIVOT_T1 end
          if Machine.Offsets.PIVOT_T2 then Mill2Offs = Machine.Offsets.PIVOT_T2 end
@@ -259,6 +262,8 @@ if EgtExistsFile( sDataBeam) then
          if Machine.Offsets.OFFSETBLAMAT2 then Saw2B1Offs= Machine.Offsets.OFFSETBLAMAT2 end
          if Machine.Offsets.OFFSETCLAMAUNDER then SawUnderC2Offs= Machine.Offsets.OFFSETCLAMAUNDER end
          if Machine.Offsets.OFFSETBLAMAUNDER then SawUnderB2Offs= Machine.Offsets.OFFSETBLAMAUNDER end
+         if Machine.Offsets.OFFSETCLAMAT3 then SawC3Offs= Machine.Offsets.OFFSETCLAMAT3 end
+         if Machine.Offsets.OFFSETBLAMAT3 then SawB3Offs= Machine.Offsets.OFFSETBLAMAT3 end
          if Machine.Offsets.OFFSETXT1 then DeltaTabY = -Machine.Offsets.OFFSETXT1 end
          if Machine.Offsets.OFFSETZT1 then DeltaTabZ = Machine.Offsets.OFFSETZT1 + MillOffs end
          if Machine.Offsets.OFFSETXT2 then Delta2TabY = Machine.Offsets.OFFSETXT2 end
@@ -277,6 +282,10 @@ if EgtExistsFile( sDataBeam) then
          if Machine.Offsets.DEFTCPOS2 then DefTcPos2 = ( 'T' .. Machine.Offsets.DEFTCPOS2) end
          if Machine.Offsets.MINPRESS then MinForzaPinze = Machine.Offsets.MINPRESS end
          if Machine.Offsets.MAXPRESS then MaxForzaPinze = Machine.Offsets.MAXPRESS end
+         if Machine.Offsets.NOULOAD then MaxUnloadLen = Machine.Offsets.NOULOAD 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.MOTORS23KW then Motors23KW = Machine.Offsets.MOTORS23KW == 1 end
@@ -318,6 +327,7 @@ EmtGeneral {
       ExitMaxAdjust = 300,
       ExitMaxRotAdj = 0.5,
       AngDeltaMinForHome = 80,
+      LinkAxesMoveOrder = MCH_LKAMO.HEAD_BEFORE_IF_SAME_ANG,
       Special = 'Common_PF1250.mlse',
       Processor = 'Common_PF1250.mlpe'}
 -- in base alla corsa macchina, si carica la rulliera di carico/scarico appropriata
@@ -475,7 +485,7 @@ if DrillingAggregate then
          OthColl = {'B1/SOLID', 'C1/SOLID'},
          Geo = 'H14_HEAD/GEO',
          Aux = {'H14_HEAD/SOLID', 'H14_HEAD/COLLISION'}}
-   end
+end
 
 --  *** Testa 3 ***
 local X3Id = EmtAxis {
@@ -507,9 +517,9 @@ local C3Id = EmtAxis {
       Token = 'C',
       Type = MCH_AT.ROTARY,
       Dir = Z_AX(),
-      Pos = Point3d( Head3X+163, Head3Y, 503.0),
+      Pos = Point3d( Head3X, Head3Y, 503.0),
       Stroke = {MinC3, MaxC3},
-      Home = 0,
+      Home = ParkC3,
       Geo = 'C3_AXIS/GEO',
       Aux = {'C3_AXIS/SOLID', 'C3_AXIS/COLLISION'}}
 local B3Id = EmtAxis {
@@ -517,15 +527,15 @@ local B3Id = EmtAxis {
       Parent = 'C3',
       Token = 'B',
       Type = MCH_AT.ROTARY,
-      Dir = -Y_AX(),
-      Pos = Point3d( 0, -163, Head3Z),
+      Dir = X_AX(),
+      Pos = Point3d( -163.5, Head3Y, Head3Z+Mill3Offs),
       Stroke = {MinB3, MaxB3},
       Home = ParkB3,
       Geo = 'B3_AXIS/GEO',
       Aux = {'B3_AXIS/SOLID', 'B3_AXIS/COLLISION'}}
 local vtMoveX3 = Vector3d( 0, Head3Y, 0)
 EgtMove( EgtGetFirstNameInGroup( X3Id, 'SOLID'), vtMoveX3, GDB_RT.GLOB)
-local vtMoveZ3 = Vector3d( 0, Head3Y, Head3Z -109.25)
+local vtMoveZ3 = Vector3d( Head3X, Head3Y, Head3Z + 54)
 EgtMove( EgtGetFirstNameInGroup( Z3Id, 'SOLID'), vtMoveZ3, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( Z3Id, 'COLLISION'), vtMoveZ3, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( C3Id, 'SOLID'), vtMoveZ3, GDB_RT.GLOB)
@@ -539,8 +549,8 @@ local H31Id = EmtHead {
       HSet = 'H38',
       Type = MCH_HT.STD,
       Pos = Point3d( Head3X, Head3Y, Head3Z),
-      TDir = X_AX(),
-      ADir = -Y_AX(),
+      TDir = Vector3d( 0, sin( SawB3Offs), cos( SawB3Offs)),
+      ADir = X_AX(),
       Rot1W = 0.2,
       Rot2Stroke = {MinB3, MaxB3},
       OthColl = {'B3/SOLID', 'C3/SOLID'},
@@ -765,7 +775,7 @@ EmtTable {
       Geo = 'TABLE/GEO',
       Aux = 'TABLE/SOLID'}
 -- *** ToolChanger ***
-local ptTc1 = Point3d( 150, 501, -221)
+local ptTc1 = Point3d( 150, 501, -271 + ( DeltaTabZ - DeltaRulliTraveZ + 55))
 local vtDt1 = Vector3d( 0, 0, - 102.5)
 EmtTcPos {
       Name = 'T1',
@@ -860,7 +870,7 @@ EmtTcPos {
       Geo = 'BASE/T13'}
 
 if Tc2Active then
-   local ptTc2 = Point3d( 150, 5168.75, -221)
+   local ptTc2 = Point3d( 150, 5168.75, -271 + ( DeltaTabZ - DeltaRulliTraveZ + 55))
    local vtDt2 = Vector3d( 0, 0, - 102.5)
    EmtTcPos {
          Name = 'T21',
@@ -933,15 +943,40 @@ if Tc2Active then
          ADir = X_AX(),
          Geo = 'BASE/T30'}
 end
-local ptTc3 = Point3d( 600, 1181, -150.8)
-EmtTcPos {
-      Name = 'T101',
-      Parent = 'Base',
-      Pos = ptTc3,
-      TDir = -X_AX(),
-      ADir = Z_AX(),
-      Geo = 'BASE/T101'}
-local ptTc4 = Point3d( 750, 1561, -150.8)
+if DrillingAggregate then
+   local ptTc3 = Point3d( 600, 1181, -321)
+   EmtTcPos {
+         Name = 'T101',
+         Parent = 'Base',
+         Type = MCH_HT.MULTI,
+         ExitNbr = 6,
+         Pos1 = ptTc3 + Vector3d( 0, 0, 0),
+         TDir1 = Z_AX(),
+         Pos2 = ptTc3 + Vector3d( -40, 0, 0),
+         TDir2 = Z_AX(),
+         Pos3 = ptTc3 + Vector3d( -80, 0, 0),
+         TDir3 = Z_AX(),
+         Pos4 = ptTc3 + Vector3d( 40, 0, 0),
+         TDir4 = Z_AX(),
+         Pos5 = ptTc3 + Vector3d( 80, 0, 0),
+         TDir5 = Z_AX(),
+         Pos6 = ptTc3 + Vector3d( 120, 0, 0),
+         TDir6 = Z_AX(),
+         ADir = X_AX(),
+         Geo = 'BASE/T101_MULTIDRILL',
+         Aux = 'BASE/T101_HS_MULTIDRILL'}
+else
+   local ptTc3 = Point3d( 600, 1181, -180.8)
+   EmtTcPos {
+         Name = 'T101',
+         Parent = 'Base',
+         Pos = ptTc3,
+         TDir = -X_AX(),
+         ADir = Z_AX(),
+         Geo = 'BASE/T101'}
+end
+
+local ptTc4 = Point3d( 750, 1561, -180.8)
 EmtTcPos {
       Name = 'T111',
       Parent = 'Base',
@@ -949,28 +984,15 @@ EmtTcPos {
       TDir = -X_AX(),
       ADir = Z_AX(),
       Geo = 'BASE/T111'}
-local ptTc5 = Point3d( 750, 1961, -321)
+local ptTc5 = Point3d( 750, 1961, -110.8)
 EmtTcPos {
       Name = 'T121',
       Parent = 'Base',
-      Type = MCH_HT.MULTI,
-      ExitNbr = 6,
-      Pos1 = ptTc5 + Vector3d( 0, 0, 0),
-      TDir1 = Z_AX(),
-      Pos2 = ptTc5 + Vector3d( -40, 0, 0),
-      TDir2 = Z_AX(),
-      Pos3 = ptTc5 + Vector3d( -80, 0, 0),
-      TDir3 = Z_AX(),
-      Pos4 = ptTc5 + Vector3d( 40, 0, 0),
-      TDir4 = Z_AX(),
-      Pos5 = ptTc5 + Vector3d( 80, 0, 0),
-      TDir5 = Z_AX(),
-      Pos6 = ptTc5 + Vector3d( 120, 0, 0),
-      TDir6 = Z_AX(),
+      Pos = ptTc5,
+      TDir = Z_AX(),
       ADir = X_AX(),
-      Geo = 'BASE/T121',
-      Aux = 'BASE/T121_HS'}
-local ptTcS = Point3d( -1, 519.75, -1675 + ( DeltaTabZ - DeltaRulliTraveZ + 55))
+      Geo = 'BASE/T121'}
+local ptTcS = Point3d( -1, 620.75, -1825.25 + ( DeltaTabZ - DeltaRulliTraveZ + 55))
 EmtTcPos {
    Name = 'T201',
    Parent = 'Base',
@@ -1068,8 +1090,9 @@ EgtMove( EgtGetFirstNameInGroup( BaseId, 'TC3') or GDB_ID.NULL, vtMovB, GDB_RT.G
 if TcSpecialTools then EgtMove( EgtGetFirstNameInGroup( BaseId, 'TC4') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB) end
 if SecondChain then EgtMove( EgtGetFirstNameInGroup( BaseId, 'TC5') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB) end
 EgtMove( EgtGetFirstNameInGroup( BaseId, 'TCR') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB)
-if TcSpecialTools then EgtMove( EgtGetFirstNameInGroup( BaseId, 'TCS') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB) end
+if TcAggreBladeUnder then EgtMove( EgtGetFirstNameInGroup( BaseId, 'TCS') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB) end
 if TcSpecialTools then EgtMove( EgtGetFirstNameInGroup( BaseId, 'T121') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB) end
+if DrillingAggregate then EgtMove( EgtGetFirstNameInGroup( BaseId, 'T101') 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( Z1Id, 'SOLID'), vtOffset23KW, GDB_RT.GLOB)
@@ -1113,7 +1136,7 @@ function OnSetHead()
          EmtModifyAxisHome( 'X1', ParkTc2X1)
       end
       EmtModifyAxisStroke( 'Z1', {MinZ1, MaxZ1})
-      if EMC.TOTLEN < LongTool then
+      if EMC.TOTLEN and EMC.TOTLEN < LongTool then
          EmtModifyAxisHome( 'Z1', ParkZ1)
          EmtModifyAxisStroke( 'C1', {MinC1, MaxC1})
          EmtModifyAxisHome( 'C1', ParkC1)
@@ -1184,7 +1207,8 @@ function OnSetHead()
          EmtModifyAxisStroke( 'B2', {MinB2, MaxB2})
       end
    elseif EMC.HEAD == 'H38' then
-      ;
+      EmtModifyAxisDirection( 'B3', Vector3d( cos( SawC3Offs), -sin( SawC3Offs), 0))
+
    end
 end
 
@@ -1268,12 +1292,8 @@ function GetAdjHeadFromTcPos( nHeadSet, sTcPos)
       if SecondSaw and sTcPos == 'T21' then
          return 'H16'
       -- utensili speciali
-      elseif TcSpecialTools and sTcPos == 'T121' then
-         if DrillingAggregate then
-            return 'H14'
-         else
-            return 'H11'
-         end
+      elseif DrillingAggregate and sTcPos == 'T101' then
+         return 'H14'
       -- motoseghe
       elseif sTcPos == 'T101' or sTcPos == 'T111' then
          return 'H13'
@@ -1298,7 +1318,7 @@ end
 ---------------------------------------------------------------------
 -- Funzione che riconosce testa per sega a catena
 function HeadIsChainSaw( sHead)
-   return ( sHead == 'H13' or sHead == 'H15')
+   return ( sHead == 'H13')
 end
 
 ---------------------------------------------------------------------
@@ -1483,6 +1503,37 @@ function GetPY2Light()
    return ( EgtGetInfo( PY2LightId, 'On') == '1')
 end
 
+---------------------------------------------------------------------
+-- Funzione per impostare la posizione del rinvio flottante
+function SetFloatPos( sHead, dPos)
+   -- recupero Id testa
+   local nHeadId = EgtGetHeadId( sHead)
+   if not nHeadId then return false end
+   -- se ci sono entità flottanti nel ToolHolder
+   local nRefId = EgtGetFirstNameInGroup( nHeadId, '_T1')
+   local vtTool = EgtFR( nRefId, GDB_ID.ROOT):getVersZ() 
+   local nObjId =  EgtGetFirstGroupInGroup( EgtGetFirstNameInGroup( nHeadId, 'T1'))
+   local FloatEntities = EgtGetInfoInGroup( nObjId, 'Float')
+   if FloatEntities and #FloatEntities > 0 then
+      -- il porta-utensile flottante non può comprimersi più di 10mm
+      if dPos > 10 then
+         local sErr = 'Floating Ring compressed more than 10mm'
+         EmtSetLastError( 1222, sErr)
+         EgtOutLog( 'Error : ' .. sErr, 1)
+      end
+      local dFloat = EgtGetInfo( FloatEntities[1], 'Float', 'd')
+      if abs( dPos - dFloat) > 10 * GEO.EPS_SMALL then
+         local vtMove = ( dPos - dFloat) * vtTool
+         -- sposto tutte le entità flottanti
+         for i = 1, #FloatEntities do
+            EgtMove( FloatEntities[i], vtMove, GDB_RT.GLOB)
+            EgtSetInfo( FloatEntities[i], 'Float', dPos)
+         end
+      end
+      return true
+   end
+   return false
+end
 
 ---------------------------------------------------------------------
 -- Funzione per resettare tutte le attivazioni della macchina
@@ -1491,6 +1542,9 @@ function OnResetMachine()
    EmtUnlinkAllFixturesFromGroups()
    SetPY1Light( false)
    SetPY2Light( false)
+   --resetto eventuale flottante
+   SetFloatPos( 'H11', 0)
+   SetFloatPos( 'H21', 0)
    -- nascondo Vmill
    local nRawId = EgtGetFirstRawPart()
    while nRawId do

MachNotes.ini

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

Scripts/SetUp.lua

@@ -91,9 +91,49 @@ elseif bTc2Active and SecondSaw and SecondChain and TcSpecialTools and TcAggreBl
                     {Pos = "Pos11",  TcPos = "T11", Head = "H11", Group = "G1"},
                     {Pos = "Pos12",  TcPos = "T12", Head = "H11", Group = "G1"},
                     {Pos = "Pos13",  TcPos = "T13", Head = "H11", Group = "G1"},
-                    {Pos = "Pos14", TcPos = "T101", Head = "H13", Group = "G2"},  -- motosega
-                    {Pos = "Pos15", TcPos = "T111", Head = "H13", Group = "G2"},  -- motosega 2
-                    {Pos = "Pos16", TcPos = "T121", Head = "H14", Group = "G2"},  -- utensile speciale
+                    {Pos = "Pos14", TcPos = "T101", Head = "H14", Group = "G2"},  -- utensile speciale
+                    {Pos = "Pos15", TcPos = "T111", Head = "H13", Group = "G2"},  -- motosega
+                    {Pos = "Pos16", TcPos = "T121", Head = "H11", Group = "G2"},  -- truciolatore
+                    {Pos = "Pos17", TcPos = "T21", Head = "H16", Group = "G3"},   -- TC 2
+                    {Pos = "Pos18", TcPos = "T22", Head = "H11", Group = "G3"},
+                    {Pos = "Pos19", TcPos = "T23", Head = "H11", Group = "G3"},
+                    {Pos = "Pos20", TcPos = "T24", Head = "H11", Group = "G3"},
+                    {Pos = "Pos21", TcPos = "T25", Head = "H11", Group = "G3"},
+                    {Pos = "Pos22", TcPos = "T26", Head = "H11", Group = "G3"},
+                    {Pos = "Pos23", TcPos = "T27", Head = "H11", Group = "G3"},
+                    {Pos = "Pos24", TcPos = "T28", Head = "H11", Group = "G3"},
+                    {Pos = "Pos25", TcPos = "T29", Head = "H11", Group = "G3"},
+                    {Pos = "Pos26", TcPos = "T30", Head = "H11", Group = "G3"},
+                    {Pos = "Pos27", TcPos = "T201", Head = "H22", Group = "G4"},  -- lama con aggregatop da sotto
+                    {Pos = "Pos28", TcPos = "T220", Head = "H21", Group = "G4"},  -- TC margherita
+                    {Pos = "Pos29", TcPos = "T221", Head = "H21", Group = "G4"},
+                    {Pos = "Pos30", TcPos = "T222", Head = "H21", Group = "G4"},
+                    {Pos = "Pos31", TcPos = "T223", Head = "H21", Group = "G4"},
+                    {Pos = "Pos32", TcPos = "T224", Head = "H21", Group = "G4"},
+                    {Pos = "Pos33", TcPos = "T225", Head = "H21", Group = "G4"},
+                    {Pos = "Pos34", TcPos = "T226", Head = "H21", Group = "G4"},
+                    {Pos = "Pos35", TcPos = "T227", Head = "H21", Group = "G4"},
+                    {Pos = "Pos36", TcPos = "T228", Head = "H21", Group = "G4"},
+                    {Pos = "Pos37", TcPos = "T229", Head = "H21", Group = "G4"},
+                    {Pos = "Pos38", TcPos = "T230", Head = "H21", Group = "G4"},
+                    {Pos = "Pos39", TcPos = "T301", Head = "H38", Group = "G5"}}
+elseif bTc2Active and SecondSaw and SecondChain and TcSpecialTools and TcAggreBladeUnder then
+   PositionTable = {{Pos = "Pos1",  TcPos = "T1",  Head = "H11", Group = "G1"},  -- TC 1
+                    {Pos = "Pos2",  TcPos = "T2",  Head = "H11", Group = "G1"},
+                    {Pos = "Pos3",  TcPos = "T3",  Head = "H11", Group = "G1"},
+                    {Pos = "Pos4",  TcPos = "T4",  Head = "H11", Group = "G1"},
+                    {Pos = "Pos5",  TcPos = "T5",  Head = "H11", Group = "G1"},
+                    {Pos = "Pos6",  TcPos = "T6",  Head = "H11", Group = "G1"},
+                    {Pos = "Pos7",  TcPos = "T7",  Head = "H11", Group = "G1"},
+                    {Pos = "Pos8",  TcPos = "T8",  Head = "H11", Group = "G1"},
+                    {Pos = "Pos9",  TcPos = "T9",  Head = "H11", Group = "G1"},
+                    {Pos = "Pos10",  TcPos = "T10", Head = "H11", Group = "G1"},
+                    {Pos = "Pos11",  TcPos = "T11", Head = "H11", Group = "G1"},
+                    {Pos = "Pos12",  TcPos = "T12", Head = "H11", Group = "G1"},
+                    {Pos = "Pos13",  TcPos = "T13", Head = "H11", Group = "G1"},
+                    {Pos = "Pos14", TcPos = "T101", Head = "H13", Group = "G2"},  -- utensile speciale
+                    {Pos = "Pos15", TcPos = "T111", Head = "H13", Group = "G2"},  -- motosega
+                    {Pos = "Pos16", TcPos = "T121", Head = "H11", Group = "G2"},  -- truciolatore
                     {Pos = "Pos17", TcPos = "T21", Head = "H16", Group = "G3"},   -- TC 2
                     {Pos = "Pos18", TcPos = "T22", Head = "H11", Group = "G3"},
                     {Pos = "Pos19", TcPos = "T23", Head = "H11", Group = "G3"},

ToolNotes.ini

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

UpdateLog.txt

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

Version.lua

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