Ottimizzato 3d macchina (non testato), aggiunto 3d CLAMP_CHECK

- Dimensione tavola portata a 34m
- Aggiunto lettura coefficiente stima tempi

Beam/BeamData.lua

@@ -12,7 +12,8 @@ local BeamData = {
    MAX_WIDTH = 1505,                        -- larghezza massima del grezzo
    MAX_HEIGHT = 605,                        -- altezza massima del grezzo
    LEN_SHORT_PART = 1200,                   -- lunghezza massima pezzo piccolo
-   MAX_RAW = 20000,                         -- massima lunghezza grezzo (deve essere minore di LenTable - RAW_OFFSET)
+   LEN_VERY_SHORT_PART = 800,               -- lunghezza massima pezzo molto corto (molto probabile lo scarico a caduta)
+   MAX_RAW = 26000,                         -- massima lunghezza grezzo (deve essere minore di LenTable - RAW_OFFSET)
    STD_RAW = 14000,                         -- lunghezza standard della barra di grezzo
    OVM_HEAD = 10,                           -- sovramateriale testa
    OVM_MID = 5.4,                           -- sovramateriale intermedio (spessore lama)
@@ -107,7 +108,13 @@ 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
+         if Machine.Offsets.CUT_SIC then BeamData.CUT_SIC = EgtClamp( Machine.Offsets.CUT_SIC, 15, 50) end
       end
       if Machine.Trave then
          BeamData.MIN_WIDTH = Machine.Trave.XMIN or BeamData.MIN_WIDTH

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')
@@ -290,6 +294,8 @@ function OnDispositionEnd()
       for i = 1, #EMT.MDCHAR do
          EmitMoveDataChars( EMT.MDCHAR[i])
          if EMT.MDCHAR[i].Y1 then EMT.CHY_ON = true end
+         if EMT.MDCHAR[i].V1 then EMT.V1POS = EMT.MDCHAR[i].V1 end
+         if EMT.MDCHAR[i].V2 then EMT.V2POS = EMT.MDCHAR[i].V2 end
       end
       if #EMT.MDCHAR > 0 then
          local nMoveType = EgtIf( EMT.CHY_ON, 3, 2)
@@ -580,8 +586,8 @@ function OnPathStart()
    if EMT.TOOL == EMT.PREVTOOL and not EMT.ZMAX then
       EMT.L2pp = EMT.L2op
       EMT.L3pp = EMT.L3op
-      EMT.R1pp = EMT.R1p
-      EMT.R2pp = EMT.R2p
+      EMT.R1pp = EMT.R1p or EMT.R1pp
+      EMT.R2pp = EMT.R2p or EMT.R2pp
    else
       EMT.L2pp = nil
       EMT.L3pp = nil
@@ -622,6 +628,9 @@ function OnPathStartAux()
    local Cmd = EgtSplitString( EMT.AUX)
    if Cmd[1] == '4' then
       EMT.TO_ZMAX = true
+      if Cmd[2] == '1' then
+         EMT.ROLL_IN = true
+      end
    end
 end
 
@@ -901,6 +910,8 @@ function OnRapid()
                local dPosT = EMT.TPOS or EMT.L1op
                EmitParkRoller( dPosT, bSplitCut)
             end
+            -- eventuale preselezione successiva testa 2
+            PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
             -- eseguo movimenti
             local Speed = EMT.S
             -- se è macchina a 3 teste con gruppo truciolatore 4 assi
@@ -908,10 +919,6 @@ function OnRapid()
                EmitMoveDataHead( 3, { Z=EMT.L3, S=Speed})
                EmitMoveDataHead( 3, { B=EMT.R2, C=EMT.R1, S=Speed})
                EmitMoveStartHead( 3)
-               -- eventuale preselezione successiva testa 2
-               PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
-               -- aspetto esecuzione movimento testa 3
-               EmitMoveWaitHead( 3)
             -- se gruppo lama dedicato, senza cambio utensile
             elseif EgtGetHeadId( 'H38') then
                local B3Home = EgtGetAxisHomePos( 'B3')
@@ -929,16 +936,14 @@ function OnRapid()
                end
                -- muovo in posizione finale
                EmitMoveDataHead( 3, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})
-
-               EmitMoveStartHead( 3)
-               -- eventuale preselezione successiva testa 2
-               PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
-               -- aspetto esecuzione movimento testa 3
-               EmitMoveWaitHead( 3)
-            -- errore, testa non gestita
             else
                EmtSetLastError( 1212, "HEAD not managed")
             end
+
+            EmitMoveStartHead( 3)
+            -- aspetto esecuzione movimento testa 3
+            EmitMoveWaitHead( 3)
+            -- errore, testa non gestita
          end
          -- dati aggancio a trave
          local BhData = { T=EMT.L1, SetHead=0}
@@ -992,17 +997,18 @@ function OnRapid()
       else
          --MyOutput( string.format( 'V1Pos=%.3f V2Pos=%.3f', EMT.V1POS, EMT.V2POS))
          if not EMT.RELOAD and not EMT.ZMAX and #EMT.AUXCMD > 0 and EMT.TO_ZMAX then
+            local bGotoHome = EMT.HEAD == 'H38' and EMT.ROLL_IN
             -- caso speciale in cui bisogna solo cambiare presa aggregato lama sotto
             if EMT.R3_CHANGED then
                -- EmitZmax è fatta per essere chiamata con utensile attuale. In questo caso l'attuale è già quello con nuova rotazione
                -- Allora salvo l'attuale e imposto il vecchio solo momentanemente, per poi ripristinarlo
                local sBckTcPos = EMT.TCPOS
                EMT.TCPOS = EMT.PREVTCPOSREAL_H2
-               EmitZmax( false, false, PrevR1, PrevR2, false, false, true)
+               EmitZmax( false, false, PrevR1, PrevR2, false, bGotoHome, true)
                EMT.TCPOS = sBckTcPos
                EMT.R3_CHANGED = nil
             else
-               EmitZmax( false, false, PrevR1, PrevR2, false, false, true)
+               EmitZmax( false, false, PrevR1, PrevR2, false, bGotoHome, true)
             end
             EMT.ZMAX = true
             EMT.TO_ZMAX = nil
@@ -1232,6 +1238,8 @@ function OnRapid()
             EmitMoveWaitHead( 2)
          -- altrimenti testa 3
          else
+            -- eventuale preselezione successiva testa 2
+            PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
             -- selezione testa (posso muovere X solo a Zmax)
             local MyMaxZ3 = EgtGetAxisMax( 'Z3')
             local dSafeZ3 = EgtGetAxisHomePos( 'Z3')
@@ -1278,8 +1286,6 @@ function OnRapid()
             end
             
             EmitMoveStartHead( 3)
-            -- eventuale preselezione successiva testa 2
-            PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
             -- aspetto esecuzione movimento testa 3
             EmitMoveWaitHead( 3)
          end
@@ -1386,6 +1392,7 @@ function OnRapid()
          MyOutput( 'M98')
          MyOutput( 'M6 ' .. GetHeadToolCode() .. AdjustTcPos( true))
          MyOutput( 'G24' .. EMT.IPLGLSTR)
+         EMT.PLANEACTIVE = true
          -- forzo successiva emissione assi rotanti
          EMT.R1p = nil
          EMT.R2p = nil
@@ -1424,7 +1431,7 @@ function OnRapid()
       local nNextTopHSet = GetNextTopHSet( EMT.MCHID)
       -- 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)
+      local bTopGoHome = ( IsLastPath( EMT.PATHID) and not sNextTool and nHSet == 3)  or EMT.HEAD == 'H38' 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
@@ -1467,6 +1474,7 @@ function OnLinear()
       MyOutput( 'M98')
       MyOutput( 'M6 ' .. GetHeadToolCode() .. AdjustTcPos( true))
       MyOutput( 'G24' .. EMT.IPLGLSTR)
+      EMT.PLANEACTIVE = true
       -- emissione movimento
       EMT.R1p = nil
       EMT.R2p = nil
@@ -1557,6 +1565,7 @@ function OnArc()
       MyOutput( 'M98')
       MyOutput( 'M6 ' .. GetHeadToolCode() .. AdjustTcPos( true))
       MyOutput( 'G24' .. EMT.IPLGLSTR)
+      EMT.PLANEACTIVE = true
       -- emissione movimento
       EMT.R1p = nil
       EMT.R2p = nil
@@ -1619,28 +1628,6 @@ function OnArc()
    EmtUpdatePrev()
 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 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 RidFeed = 100 / Massa * 100
-   if RidFeed > 100 then
-      RidFeed = 100
-   elseif RidFeed < 10 then
-      RidFeed = 10
-   end
-   return TempoAcc * 1000, MinTempoAcc * 1000, RidFeed
-end
-
 ---------------------------------------------------------------------
 function CalcForzaPinze( dH, dS, dL, dT)
    local MassaRef = 1500                              -- [Kg]
@@ -2323,7 +2310,7 @@ function AdjustTcPos( bLen3, sTcPos, dAxR3)
       end
    end
    if sPos == '111' then
-      if not dAxR3 then dAxR3 = EMT.R3 end
+      if not dAxR3 then dAxR3 = EMT.R3 or 0 end
       -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
       if dAxR3 then
          if abs( dAxR3 - 0) < 0.1 then
@@ -2340,7 +2327,7 @@ function AdjustTcPos( bLen3, sTcPos, dAxR3)
       end
    end
    if sPos == '121' then
-      if not dAxR3 then dAxR3 = EMT.R3 end
+      if not dAxR3 then dAxR3 = EMT.R3 or 0 end
       -- controllo che il valore esista. Altrimenti è una testa senza asse ausiliario
       if dAxR3 then
          if abs( dAxR3 - 0) < 0.1 then
@@ -2574,9 +2561,9 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome, bUsePrev
             local dPosT = EgtIf( bEnd, EMT.L1o, EMT.TPOS or EMT.L1op)
             EmitParkRoller( dPosT, bSplitCut)
          end
-         -- se non sono esattamente in home, devo ruotare in zona sicura
+         -- se non sono esattamente in home, ruoto dove sono
          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
@@ -2622,15 +2609,19 @@ end
 
 ---------------------------------------------------------------------
 function EmitResetMachining()
-   MyOutput( 'G27')
-   if EMT.PREFALLCUT then
-      MyOutput( 'M29')
-      EMT.PREFALLCUT = nil
+   if EMT.PLANEACTIVE then
+      MyOutput( 'G27')
+      if EMT.PREFALLCUT then
+         MyOutput( 'M29')
+         EMT.PREFALLCUT = nil
+      end
+      local sP12 = ''
+      if EMT.TOOL ~= GetNextTool( EMT.MCHID) then sP12 = EgtIf( EMT.HEAD ~= 'H21', ' P1=0'..EgtIf( EMT.DOU_TYPE, ' P2=0', ''), ' P2=0') end
+      local sP4 = EgtIf( EMT.MCHUSERNOTES:find( 'Split', 1, true), ' P4=1', '')
+      MyOutput( 'M99'..sP12..sP4)
+      -- piano non più attivo
+      EMT.PLANEACTIVE = false
    end
-   local sP12 = ''
-   if EMT.TOOL ~= GetNextTool( EMT.MCHID) then sP12 = EgtIf( EMT.HEAD ~= 'H21', ' P1=0'..EgtIf( EMT.DOU_TYPE, ' P2=0', ''), ' P2=0') end
-   local sP4 = EgtIf( EMT.MCHUSERNOTES:find( 'Split', 1, true), ' P4=1', '')
-   MyOutput( 'M99'..sP12..sP4)
 end
 
 ---------------------------------------------------------------------

Common_PF1250.mlpe

@@ -163,6 +163,29 @@ function OnSimulStart()
    end
    -- Preparo lista collisioni vuota
    EMT.COLLIDE = {}
+
+   -- si crea gruppo temporaneo appoggio controllo clamping
+   CLAMP_CHECK_GROUP = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'CLAMP_CHECK')
+   CLAMP_CHECK_INTERS = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'CLAMP_INTERS')
+
+   if CLAMP_CHECK_GROUP then
+      EgtEmptyGroup( CLAMP_CHECK_GROUP)
+   else
+      local frClampCheckGroup = Frame3d( ORIG(), GDB_FR.FRONT)
+      CLAMP_CHECK_GROUP = EgtGroup( GDB_ID.ROOT, frClampCheckGroup)
+      EgtSetName( CLAMP_CHECK_GROUP, 'CLAMP_CHECK')
+      EgtSetLevel( CLAMP_CHECK_GROUP, GDB_LV.TEMP)
+      EgtSetStatus( CLAMP_CHECK_GROUP, GDB_ST.OFF)
+   end
+   
+   if CLAMP_CHECK_INTERS then
+      EgtEmptyGroup( CLAMP_CHECK_INTERS)
+   else
+      CLAMP_CHECK_INTERS = EgtGroup( GDB_ID.ROOT)
+      EgtSetName( CLAMP_CHECK_INTERS, 'CLAMP_INTERS')
+      EgtSetLevel( CLAMP_CHECK_INTERS, GDB_LV.TEMP)
+      EgtSetStatus( CLAMP_CHECK_INTERS, GDB_ST.OFF)
+   end
 end
 
 ---------------------------------------------------------------------
@@ -224,18 +247,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)
@@ -640,7 +669,7 @@ function OnSimulToolDeselect( dPrevA)
    -- se passo da testa 1 a 3 scarico aggregato
    if nNextSetHead == 3 then
       -- deposito utensile prelevato da posizioni speciali
-      if EMT.TCPOS == 'T101' or EMT.TCPOS == 'T111' or EMT.TCPOS == 'T121' then
+      if EMT.PREVTCPOS_H1 == 'T101' or EMT.PREVTCPOS_H1 == 'T111' or EMT.PREVTCPOS_H1 == 'T121' then
          -- visualizzo utensile su TcPos
          ShowToolInTcPos( EMT.PREVTCPOS_H1, true)
          -- nascondo l'utensile sulla testa
@@ -1191,6 +1220,12 @@ function OnSimulMoveStart()
             EMT.A6n = 'Z2'
             local Z2 = -Head2Z + MillOffs + Mill2Offs + EMT.L3
             EMT.A6 = EgtClamp( Z2, MinZ2, MaxZ2)
+            -- dato che la testa 2 è slave, bisogna controllare eventuale extra-corsa da post
+            if not( EMT.MOVE == 0 and EMT.FLAG == 2) and Z2 > MaxZ2 then
+               local sErr = EMT.MCHNAME..'  ==>  Out of Stroke: Z2 : '.. EgtNumToString( dZ2-MaxZ2, 2)
+               EmtSetLastError( 1220, sErr, true)
+               EgtOutBox( sErr, 'ERROR')
+            end
             EMT.A6m = EgtIf( ( EMT.MOVE == 2 or EMT.MOVE == 3), 'Z1', nil)
             EMT.A7n = 'C2'
             EMT.A7 = EMT.R1
@@ -1221,6 +1256,12 @@ function OnSimulMoveStart()
             EMT.DOU_DRILL_END = EMT.L3p - EMT.L3
             Z2 = Z2 - 2 * EMT.DOU_DRILL_END
          end
+         -- dato che la testa 2 è slave, bisogna controllare eventuale extra-corsa da post
+         if not( EMT.MOVE == 0 and EMT.FLAG == 2) and Z2 < MinZ2 then
+            local sErr = EMT.MCHNAME..'  ==>  Out of Stroke: Z2 : '.. EgtNumToString( MinZ2-Z2, 2)
+            EmtSetLastError( 1220, sErr, true)
+            EgtOutBox( sErr, 'ERROR')
+         end
          EMT.A6 = EgtClamp( Z2, MinZ2, MaxZ2)
          EMT.A6m = nil
          EMT.A7n = 'C2'
@@ -1332,7 +1373,7 @@ function OnSimulMoveEnd()
       -- 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)
+      local bToXhome = ( IsLastPath( EMT.PATHID) and not sNextTool and nHSet == 3) or EMT.HEAD == 'H38' or ( nHSet == 1 and EMT.TTOTLEN > LongTool) 
       -- eseguo
       ExecMoveZmax( EMT.MCHSPLIT, bToXhome)
       EMT.TO_ZMAX = nil
@@ -1650,9 +1691,9 @@ function ExecMoveZmax( bMchSplit, bGoToHome)
          SimulMoveAxes( 'B3', ParkB3, MCH_SIM_STEP.COLLROT)
       elseif EgtGetHeadId( 'H38') then
          local MyMaxZ3 = EgtGetAxisMax( 'Z3')
-         -- se non sono esattamente in home, devo ruotare in zona sicura
+         -- se non sono esattamente in home, ruoto dove sono
          if abs( HomeC - CurrC) > 1 or abs( HomeB - CurrB) > 1 then
-            SimulMoveAxis( 'X3', SafeX3RotAxis, MCH_SIM_STEP.RAPID)
+            -- SimulMoveAxis( 'X3', SafeX3RotAxis, MCH_SIM_STEP.RAPID)
             SimulMoveAxis( 'Z3', SafeZ3RotAxis, MCH_SIM_STEP.RAPID)
             SimulMoveAxes( 'C3', HomeC, MCH_SIM_STEP.COLLROT, 'B3', HomeB, MCH_SIM_STEP.COLLROT)
          end
@@ -1719,16 +1760,162 @@ function ExecUnloading()
    end
 end
 
+---------------------------------------------------------------------
+function CheckClamping( sClampName)
+   nIndexClamp = EgtGetAxisId( sClampName)
+   local idClampPath = EgtGetFirstInGroup( EgtGetFirstNameInGroup( nIndexClamp, 'CLAMP_CHECK') or GDB_ID.NULL)
+   local b3ClampingArea = EgtGetBBoxGlob( idClampPath or GDB_ID.NULL, GDB_BB.STANDARD)
+   -- se non trovo percorso area di clamping, esco subito
+   if not idClampPath or not EMT.VMILL or not ClampingCoeffMin then
+      return
+   end
+
+   function GetCurveListFromIntersection( sPosIntersPlane, sIntersPlane, vtOffset)
+      local idCurveList = {}
+      local vtIntersPlane
+      -- piano di interpolazione 
+      if sIntersPlane == 'Y' then
+         vtIntersPlane = Y_AX()
+      elseif sIntersPlane == 'Z' then
+         vtIntersPlane = Z_AX()
+      end
+
+      for i = 1, #EMT.VMILL do
+         local b3VMill = EgtGetBBoxGlob( EMT.VMILL[i], GDB_BB.STANDARD)
+         local ptPosIntersPlane
+         if sPosIntersPlane == 'MIN' then
+            ptPosIntersPlane = b3VMill:getMin() + vtOffset
+         elseif sPosIntersPlane == 'MAX' then
+            ptPosIntersPlane = b3VMill:getMax() + vtOffset
+         end
+
+         local idLoop, nLoopCnt = EgtPlaneVolZmapInters( ptPosIntersPlane, vtIntersPlane, EMT.VMILL[i], CLAMP_CHECK_INTERS, GDB_RT.GLOB)
+         -- se c'è almeno una curva
+         if idLoop then
+            for j = 1, nLoopCnt do
+               local idLoopTemp = idLoop + j - 1
+               table.insert( idCurveList, idLoopTemp)
+            end
+         end
+      end
+      return idCurveList
+   end
+
+   function CalculateIntersectionArea( sPosIntersPlane, sIntersPlane, vtOffset)
+      -- test piano frontale
+      local idCurveList = GetCurveListFromIntersection( sPosIntersPlane, sIntersPlane, vtOffset)
+
+      -- si copia curva intersezione e curva pinza in gruppo di confronto
+      local idFlatSurf, nFlatSurfCnt = EgtSurfFlatRegion( CLAMP_CHECK_GROUP, idCurveList)
+      local idClampSurf = EgtSurfFlatRegion( CLAMP_CHECK_GROUP, idClampPath)
+      
+      if idFlatSurf then
+         local dTotalArea = 0
+         for k = 1, nFlatSurfCnt do
+            local idTempSurf = idFlatSurf + k - 1
+            EgtSurfFrIntersect( idTempSurf, idClampSurf)
+            if idTempSurf then
+               dTotalArea = dTotalArea + ceil( EgtSurfArea( idTempSurf) or 0)
+            end
+         end
+         return dTotalArea
+      end
+      return 0
+   end
+
+   -- minima area considerata per un corretto pinzaggio
+   DistZClampToTable = DistZClampToTable or 0
+   local MinJoin = BD.GetMinJoin( EMT.SB, EMT.HB, EgtIf( EMT.SPLIT, EMT.LT, EMT.LB))
+   local MinZClamping =  min( b3ClampingArea:getDimZ() + DistZClampToTable, EMT.SB) - DistZClampToTable
+   -- si moltiplica per un coefficiente minimo sotto al quale si da l'errore di pinzaggio
+   ClampingCoeffMin = EgtClamp( ClampingCoeffMin, 0.01, 1)
+   local dMinClampingAreaWarn = ( MinJoin * MinZClamping) * ClampingCoeffMin
+   local dMinClampingAreaErr = ( MinJoin * MinZClamping) * ( ClampingCoeffMin / 3)
+
+   local bError = true
+   local sWrn, sErr
+   local bWriteWarnMessage = false
+   local bWriteErrMessage = false
+   -- controllo faccia frontale
+   local dArea = CalculateIntersectionArea( 'MIN', 'Y', Vector3d( 0, 1, 0))
+   -- ERRORE: pinza troppo poco (meno di 1/3 del minimo richiesto)
+   if dArea and dArea < dMinClampingAreaErr then
+      -- solo se pinza almeno 1cm2, si prova un altro slice 5mm più all'interno, se aumenta al doppio non c'è errore (probabilmente siamo in presenza di un displuvio)
+      if dArea > 1000 then
+         local dNewArea = CalculateIntersectionArea( 'MIN', 'Y', Vector3d( 0, 5, 0))
+         if dNewArea > dArea * 2 then
+            bError = false
+         end
+      end
+      -- pinzaggio non fattibile, errore
+      if bError then
+         sErr = 'ERROR CLAMPING ' .. sClampName .. ' : '..tostring( ceil( ( dArea / dMinClampingAreaWarn) * 100))..'% ( '.. tostring( dArea/1000)..'cm2)'
+         bWriteErrMessage = true
+      end
+   end
+   -- WARNING: pinza meno del minimo richiesto
+   if dArea and dArea < dMinClampingAreaWarn and not bWriteErrMessage then
+      sWrn = 'WARNING CLAMPING ' .. sClampName .. ' : '..tostring( ceil( ( dArea / dMinClampingAreaWarn) * 100))..'% ( '.. tostring( dArea/1000)..'cm2)'
+      bWriteWarnMessage = true
+   end
+   EgtEmptyGroup( CLAMP_CHECK_GROUP)
+   EgtEmptyGroup( CLAMP_CHECK_INTERS)
+
+   -- controllo altro lato solo se non sono già in errore
+   if not bWriteErrMessage then
+      -- controllo faccia posteriore
+      dArea = CalculateIntersectionArea( 'MAX', 'Y', Vector3d( 0, -1, 0))
+      -- ERRORE: pinza troppo poco (meno di 1/3 del minimo richiesto)
+      if dArea and dArea < dMinClampingAreaErr then   
+         -- solo se pinza almeno 1cm2, si prova un altro slice 5mm più all'interno, se aumenta al doppio non c'è errore (probabilmente siamo in presenza di un displuvio)
+         if dArea > 1000 then
+            local dNewArea = CalculateIntersectionArea( 'MAX', 'Y', Vector3d( 0, -5, 0))
+            if dNewArea > dArea * 2 then
+               bError = false
+            end
+         end
+         -- pinzaggio non fattibile, errore
+         if bError then
+            sErr = 'ERROR CLAMPING ' .. sClampName .. ' : '..tostring( ceil( ( dArea / dMinClampingAreaWarn) * 100))..'% ( '.. tostring( dArea/1000)..'cm2)'
+            bWriteErrMessage = true
+         end
+      end
+      -- WARNING: pinza meno del minimo richiesto
+      if dArea and dArea < dMinClampingAreaWarn and not bWriteWarnMessage and not bWriteErrMessage then
+         sWrn = 'WARNING CLAMPING ' .. sClampName .. ' : '..tostring( ceil( ( dArea / dMinClampingAreaWarn) * 100))..'% ( '.. tostring( dArea/1000)..'cm2)'
+         bWriteWarnMessage = true
+      end
+      EgtEmptyGroup( CLAMP_CHECK_GROUP)
+      EgtEmptyGroup( CLAMP_CHECK_INTERS)
+   end
+
+   if bWriteErrMessage then
+      EmtSetLastError( 1213, sErr, EgtGetEnableUI())
+      EgtOutBox( sErr, 'CLAMPING', 'ERROR', 'OK')
+      EmtSetSimulPause()
+   elseif bWriteWarnMessage then
+      EgtOutLog( sWrn)
+      EgtOutBox( sWrn, 'CLAMPING', 'WARNING', 'OK')
+      EmtSetSimulPause()
+   end
+end
+
 ---------------------------------------------------------------------
 function ExecMovePY1( bClose)
    SimulMoveAxes( 'PY1', EgtIf( not bClose, MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
    SetPY1Light( bClose)
+   if bClose then
+      CheckClamping( 'PY1')
+   end
 end
 
 ---------------------------------------------------------------------
 function ExecMovePY2( bClose)
    SimulMoveAxes( 'PY2', EgtIf( not bClose, MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
    SetPY2Light( bClose)
+   if bClose then
+      CheckClamping( 'PY2')
+   end
 end
 
 ---------------------------------------------------------------------
@@ -2164,22 +2351,26 @@ end
 ---------------------------------------------------------------------
 --   *** ESTIMATION T&L ***
 ---------------------------------------------------------------------
-local RAPID_X_FEED =  70000    -- mm/min
-local RAPID_Y_FEED = 100000    -- mm/min
-local RAPID_Z_FEED =  32000    -- mm/min
-local RAPID_C_FEED =  15000    -- deg/min
-local RAPID_B_FEED =  15000    -- deg/min
-local RAPID_MIN_T = 0.1        -- s
-local LOAD_T = 2               -- s
-local CHAR_ONE_MOVE_T = 1      -- s
-local ROTATION_T = 40          -- s
-local SPLIT_T = 6              -- s
-local UNLOAD_T = 4             -- s
-local FALL_T = 2               -- s
+local ESTIMATION_RAPID_COEFF = EstimationRapidMultiplier or 1
+local RAPID_X_FEED =  70000 / ESTIMATION_RAPID_COEFF    -- mm/min
+local RAPID_Y_FEED = 100000 / ESTIMATION_RAPID_COEFF    -- mm/min
+local RAPID_Z_FEED =  32000 / ESTIMATION_RAPID_COEFF    -- mm/min
+local RAPID_C_FEED =  15000 / ESTIMATION_RAPID_COEFF    -- deg/min
+local RAPID_B_FEED =  15000 / ESTIMATION_RAPID_COEFF    -- deg/min
+local RAPID_MIN_T = 0.1 * ESTIMATION_RAPID_COEFF        -- s
+local LOAD_T = 2 * ESTIMATION_RAPID_COEFF               -- s
+local CHAR_ONE_MOVE_T = 1 * ESTIMATION_RAPID_COEFF      -- s
+local ROTATION_T = 40 * ESTIMATION_RAPID_COEFF          -- s
+local SPLIT_T = 6 * ESTIMATION_RAPID_COEFF              -- s
+local UNLOAD_T = 4 * ESTIMATION_RAPID_COEFF             -- s
+local FALL_T = 2 * ESTIMATION_RAPID_COEFF               -- s
 
 ---------------------------------------------------------------------
 function OnEstimStart()
    EMT.INCHES = not EgtUiUnitsAreMM()      -- unità di misura mm/inches
+   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
 end
 
 ---------------------------------------------------------------------
@@ -2265,6 +2456,15 @@ function OnEstimDispositionEnd()
    EMT.OPEISDISP = false
 end
 
+---------------------------------------------------------------------
+function OnEstimRawMoveData()
+   -- se start del pezzo
+   if IsStartOrRestPhase( EMT.PHASE) then
+      EMT.SPLIT = false
+   end
+   OnRawMoveData()
+end
+
 ---------------------------------------------------------------------
 function OnEstimToolSelect()
    -- reset indice utensile in tabella lunghezze
@@ -2321,6 +2521,12 @@ function OnEstimMachiningEnd()
       EMT.TLE_NAME = nil
       EMT.TLE_TIME = nil
    end
+
+   EMT.MCHUSERNOTES = EgtGetMachiningParam( MCH_MP.USERNOTES) or ''
+   EMT.MCHSPLIT = ( EMT.MCHUSERNOTES:find( 'Split;', 1, true) ~= nil)
+   if EMT.MCHSPLIT then
+      EMT.SPLIT = true
+   end
 end
 
 ---------------------------------------------------------------------
@@ -2446,17 +2652,20 @@ function OnEstimRapid()
    EMT.MCHEXTLEN = EMT.MCHEXTLEN + dLen
    -- calcolo tempo
    local dTime = RAPID_MIN_T
-   local dT1 = abs( dL1) / RAPID_X_FEED * 60
+   
+   local dT1 = CalcMoveTime( abs( dL1), RAPID_X_FEED, EMT.SPLIT)
    if dT1 > dTime then dTime = dT1 end
-   local dT2 = abs( dL2) / RAPID_Y_FEED * 60
+   local dT2 = CalcMoveTime( abs( dL2), EMT.FMAXPINZE, EMT.SPLIT)
    if dT2 > dTime then dTime = dT2 end
-   local dT3 = abs( dL3) / RAPID_Z_FEED * 60
+   local dT3 = CalcMoveTime( abs( dL3), RAPID_Z_FEED, EMT.SPLIT)
    if dT3 > dTime then dTime = dT3 end
    local dT4 = abs( dR1) / RAPID_C_FEED * 60
    if dT4 > dTime then dTime = dT4 end
    local dT5 = abs( dR2) / RAPID_B_FEED * 60
    if dT5 > dTime then dTime = dT5 end
+   
    EMT.MCHEXTTIME = EMT.MCHEXTTIME + dTime
+
    EgtOutLog( string.format( '  G0 Len=%.0f Rot=%.0f° Time=%.2f', dLen, abs( dR1) + abs( dR2), dTime), 5)
    -- aggiorno valori come precedenti
    EmtUpdatePrev()
@@ -2472,7 +2681,7 @@ function OnEstimLinear()
    local dLen = sqrt( dL1 * dL1 + dL2 * dL2 + dL3 * dL3)
    EMT.MCHCUTLEN = EMT.MCHCUTLEN + dLen
    -- calcolo tempo
-   local dTime = dLen / EMT.F * 60
+   local dTime = CalcMoveTime( dLen, EMT.F, EMT.SPLIT)
    EMT.MCHCUTTIME = EMT.MCHCUTTIME + dTime
    EgtOutLog( string.format( '  G1 Len=%.0f Time=%.2f', dLen, dTime), 5)
    -- aggiorno valori come precedenti
@@ -2727,9 +2936,9 @@ end
 ---------------------------------------------------------------------
 function RollerParkingNeeded( sHead, dAng1p, dAng2p, dAng1, dAng2)
    if sHead == 'H11' or sHead == 'H12' or sHead == 'H13' or sHead == 'H16' 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 and abs( dAng1) % 180.0 > 1))
    elseif sHead == 'H21' or sHead == 'H22' 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 and abs( dAng1) % 180.0 > 1))
    elseif sHead == 'H38' then
       return ( abs( dAng1 - dAng1p) > 1 or  abs( dAng2 - dAng2p) > 1)
    end
@@ -2746,5 +2955,38 @@ function GetCmdAxMove( Cmd, sAx)
    end
 end
 
+---------------------------------------------------------------------
+function CalcDinamicaPinze( dH, dS, dL)
+   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 = 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, MinTempoAcc, RidFeed
+end
+
+---------------------------------------------------------------------
+function CalcMoveTime( dPathLen, dFeed, bIsSplitted)
+   local dTime
+   local dFeedInSec = dFeed / 60
+   local dTempoAcc, _, _ = CalcDinamicaPinze( EMT.HB, EMT.SB, EgtIf( bIsSplitted, EMT.LT, EMT.LB))
+   dTempoAcc = dTempoAcc / 1000
+   -- se si raggiunge la velocità massima
+   if dPathLen >= dFeedInSec * dTempoAcc then
+      dTime = dTempoAcc * 2 + ( ( dPathLen - dFeedInSec * dTempoAcc) / dFeedInSec)
+   else
+      dTime = 2 * sqrt( (dPathLen * dTempoAcc) / dFeedInSec)
+   end
+   return dTime
+end
+
 ---------------------------------------------------------------------
 -- *** END GENERAL ***

Common_PF1250.mlse

@@ -7,6 +7,31 @@ EgtEnableDebug( false)
 -- Carico libreria
 local BD = require( 'BeamData')
 
+---------------------------------------------------------------------
+-- *** Generic Machinings ***
+---------------------------------------------------------------------
+require( 'EmtGenMachining')
+
+---------------------------------------------------------------------
+-- *** Special GetPrevMachiningOffset ***
+---------------------------------------------------------------------
+-----------------------------------------------------------------------------------------
+function OnSpecialGetPrevMachiningOffset()
+   -- default
+   EMC.ERR = 0
+   EMC.PREVOFFSX = 0
+   -- se c'è cambio di fase tra le lavorazioni (quindi la precedente è l'ultima della sua fase e la corrente la prima)
+   if EMC.PREVPHASE ~= EMC.CURRPHASE then
+      -- se la fase corrente è di inizio lavorazione di nuova trave
+      if IsStartOrRestPhase( EMC.CURRPHASE) then
+         -- recupero la posizione finale della lavorazione precedente
+         local vPrevAx = EmtGetFinalAxesPos( EMC.PREVMCHID)
+         -- la X (L1) di questa corrisponde alla posizione iniziale della nuova trave, se ne deduce l'offset
+         EMC.PREVOFFSX = ParkV1 - vPrevAx[1]
+      end
+   end
+end
+
 ---------------------------------------------------------------------
 -- *** Special Z moves ***
 ---------------------------------------------------------------------
@@ -1301,8 +1326,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
@@ -1310,11 +1338,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.mlde

@@ -5,10 +5,10 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '2.7b4'
-PP_NVER = '2.7.2.4'
-MIN_MACH_VER = '2.5k1'
-MACH_NAME = 'Essetre-PF1500MAXrl-3T'
+PP_VER = '2.7k2'
+PP_NVER = '2.7.11.2'
+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()
@@ -161,7 +161,7 @@ DeltaTabY = 2065.5
 DeltaTabZ = -1491.0 + MillOffs                                -- per TPA : -1228.0 + MillOffs    -- per NUM : -1058.0
 DeltaRulliTraveZ = -1266
 DimTabY = 1600
-DimTabX = 30000
+DimTabX = 34000
 Delta2TabY = -2907.4
 Delta2TabZ = 693.0 - Mill2Offs                                -- per TPA : 543.0 - Mill2Offs      -- per NUM : 373.0
 Delta3TabY = 2065.5
@@ -174,7 +174,6 @@ Head2Y = DeltaTabY - Delta2TabY
 Head2Z = DeltaTabZ - Delta2TabZ
 DefTcPos1 = 'T1'
 DefTcPos2 = 'T220'
-CoeffVM = 0.5
 MinForzaPinze = 400                              -- [Kgf]
 MaxForzaPinze = 1000                             -- [Kgf]
 Tc2Active = true
@@ -182,12 +181,13 @@ 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
 ForceToCloseRollersGate = false
 Motors23KW = true
+EstimationRapidMultiplier = 1
 
 -- Aggiornamento con dati da TechnoEssetre7
 local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-PF1500MAXrl-3T.data"
@@ -249,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
@@ -282,6 +282,11 @@ 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.COEFF_STIMATEMPI and Machine.Offsets.COEFF_STIMATEMPI > 0 then EstimationRapidMultiplier = Machine.Offsets.COEFF_STIMATEMPI 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
@@ -323,6 +328,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
@@ -480,7 +486,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 {
@@ -938,28 +944,40 @@ if Tc2Active then
          ADir = X_AX(),
          Geo = 'BASE/T30'}
 end
-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',
-      Aux = 'BASE/T101_HS'}
-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',
@@ -967,7 +985,7 @@ EmtTcPos {
       TDir = -X_AX(),
       ADir = Z_AX(),
       Geo = 'BASE/T111'}
-local ptTc5 = Point3d( 750, 1961, -150.8)
+local ptTc5 = Point3d( 750, 1961, -110.8)
 EmtTcPos {
       Name = 'T121',
       Parent = 'Base',
@@ -1073,8 +1091,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)
@@ -1274,12 +1293,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'
@@ -1304,7 +1319,7 @@ end
 ---------------------------------------------------------------------
 -- Funzione che riconosce testa per sega a catena
 function HeadIsChainSaw( sHead)
-   return ( sHead == 'H13' or sHead == 'H15')
+   return ( sHead == 'H13')
 end
 
 ---------------------------------------------------------------------

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

@@ -117,6 +117,46 @@ elseif bTc2Active and SecondSaw and SecondChain and TcSpecialTools and TcAggreBl
                     {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"},
+                    {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"}}
 end
 
 local UsePositionHead = true

UpdateLog.txt

@@ -1,5 +1,42 @@
            ==== Common_PF1250 Update Log ====
 
+Versione 2.7k2 (19/11/2025)
+- (SIM-GEN) Con testa H38 si va in home quando testa viene comandata a Zmassima. Ticket#2703_b
+
+Versione 2.7k1 (19/11/2025)
+- (GEN) Preselzione testa 1 spostata prima della selezione testa 3. Ticket#2513
+- (SIM-GEN) Corretto calcolo per decidere se serve aprire i rulli
+- (SIM) Aggiunto controllo Extra-Corsa testa 2 in caso di lavorazione in doppio. Ticket#2201
+- (SIM) Prima versione controllo pinzaggio su VMILL. Per attivarlo serve modifica della macchina a MLDE e NGE.
+- (GEN) Simulazione non allineata a generazione. Se testa H38 e si chiudono i rulli, si deve andare in home. Ticket#2703
+
+Versione 2.7i1 (08/09/2025)
+- (GEN) Se fase start o restart, si aggiorna la posizione in X dell'asse per calcolare il link corretto. Serve CAM5 2.7h1 (facoltativo)
+- (EST) La stima tempi considera ora le accelerazoni degli assi
+- (SIM) Corretto controllo ultimo utensile utilizzato su testa 1, prima si controllava il precedente, ma poteva essere la testa 2
+- (SIM-GEN) Se testa 3 deve salire a ZMAX, sale alla X dove si trova e non torna in home
+
+Versione 2.7h2 (21/08/2025)
+- (GEN) Se la testa rimane bassa, corretto caso di reset del piano generico a fine lavorazione
+- (GEN) Corretto movimento in Z massima dopo scarico pezzo
+
+Versione 2.7h1 (20/08/2025)
+- (GEN) Per posizione T111 e T121, se non è presente asse rotante per presa aggregato (es. se si mette una fresa normale) viene settato a zero.
+- (MLDE-SIM) Aggiunta variabile FACOLTATIVA 'EstimationRapidMultiplier' in mlde per regolare il tempo stimato di rapido su macchine vecchie. Se non presente default 1.
+
+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
@@ -11,7 +48,7 @@ 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 simulazioen che non mandava testa in home in caso di utensile lungo. Generazione era già ok. Ticket#2280
+- (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.

Version.lua

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