Ripristinato vecchio metodo riposizionamento morse

- Rimosse variabili non più utilizzate

Common_FAST.NUM.mlpe

@@ -6,7 +6,7 @@ local INFO_STD_PP = require( 'Version')
 
 -- Variabili di modulo
 local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
-local MACHINE_INFO = 'PP_VER       ver.'..PP_VER
+local MACHINE_INFO = MACH_NAME..'  ver.'..PP_VER
 local TEST_USE = false
 
 ---------------------------------------------------------------------
@@ -41,13 +41,17 @@ function OnProgramStart()
    local BtlInfoId = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or EgtGetCurrMachGroup() or GDB_ID.NULL
    local nPatt = EgtGetInfo( BtlInfoId, 'PATTID', 'i') or 40
    EmtOutput( '%'..EgtNumToString( nPatt, 0)..'.0')
+
+   -- aggiungo prefisso per commentae commenti iniziali se la macchina è utilizzata per fare i test
+   local sPrefixCommentLine = '' ; if IS_TEST_MACHINE or EgtEndsWith( EgtGetCurrMachineDir(), '.TEST') then sPrefixCommentLine = '//' end
+
    if EMT.INFO then
-      EmtOutput( '('..EMT.INFO..')')
+      EmtOutput( sPrefixCommentLine..'('..EMT.INFO..')')
    else
       EmtOutput( '(Program Start)')
    end
-   EmtOutput( '('.. CSP_INFO..')')
+   EmtOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
-   EmtOutput( '('.. MACHINE_INFO..')\n')
+   EmtOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')\n')
    -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
    if TEST_USE then
       EmtOutput( 'M28')
@@ -178,7 +182,7 @@ function OnDispositionEnd()
       -- calcolo dati pinze
       local MinAccPinze = 0.3
       local MaxAccPinze = 4
-      local KgMtCubo= 550           -- densità legno in Kg / metro cubo
+      local KgMtCubo= WoodDensity or 550           -- densità legno in Kg / metro cubo
       local Massa = ( HTrave * STrave * LBarra * KgMtCubo ) / 1000000000
       local FMaxPinze = EMT.FMAXPINZE
       local ForzaAtrito = 700 / 2   -- Serve per regolare P32 (700 valore reale pistone)
@@ -615,22 +619,26 @@ function OnRapid()
          if not EMT.ZMAX and #EMT.AUXSTR > 0 then
             EmitZmax()
             EMT.ZMAX = true
+            bHeadFirst = false
          end
       end
-      if not EMT.LOAD then
-         local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '-'), '%)', '-')
-         EmtOutput( '( *** ' .. sOut .. ' *** )')
-      end
 
       -- primo posizionamento
       local MyZHome = EgtGetAxisHomePos( 'Z')
       local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
       -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if ( EMT.PREVHEAD == 'H3' or EMT.TTOTLEN > 200) and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
          local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
                                        ' B' .. EmtLenToString( EMT.R2pp, 3) .. ' C' .. EmtLenToString( EMT.R1pp, 3) .. 
                                        ' EE' .. EgtIf( bZmax, '3', '4') .. EMT.PREVsEL .. EMT.PREVsER .. EMT.PREVsET .. EMT.PREVsES
          EmtOutput( sOutPreMove)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
+      end
+
+      if not EMT.LOAD then
+         local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '-'), '%)', '-')
+         EmtOutput( '( *** ' .. sOut .. ' *** )')
       end
 
       -- ricavo i dati per la lavorazione
@@ -641,11 +649,13 @@ function OnRapid()
       local sES = ' ES'..EgtNumToString( EMT.S, 0)
 
       -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
-      if EMT.HEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if ( EMT.HEAD == 'H3' or EMT.TTOTLEN > 200) and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
          local sEEPreMove = ' EE' .. EgtIf( bZmax, '3', '4')
          local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
                                        EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
          EmtOutput( sOutPreMove)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
       end
       EmtResetPrev()
       -- se sono su pezzi alti e movimento da emettere, per sicurezza a Z massima
@@ -920,8 +930,12 @@ function OnArc()
    local sFeed = EmtGetFeed()
    -- tipo arco
    local sArc = 'G' .. EgtNumToString(EMT.MOVE,0)
-   -- emetto arco
+   -- se arco molto grande, approssimo con una retta
-   EmtOutput( sArc..sAxes..sRad..sFeed)
+   if EMT.RR > 99999 then
+      EmtOutput( "G1"..sAxes..sFeed)
+   else
+      EmtOutput( sArc..sAxes..sRad..sFeed)
+   end
 
    -- aggiorno valori come precedenti
    EmtUpdatePrev()

Common_FAST.NUM_PLUS.mlpe

@@ -6,7 +6,7 @@ local INFO_STD_PP = require( 'Version')
 
 -- Variabili di modulo
 local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
-local MACHINE_INFO = 'PP_VER       ver.'..PP_VER
+local MACHINE_INFO = MACH_NAME..'  ver.'..PP_VER
 local TEST_USE = false
 
 ---------------------------------------------------------------------
@@ -41,13 +41,17 @@ function OnProgramStart()
    local BtlInfoId = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or EgtGetCurrMachGroup() or GDB_ID.NULL
    local nPatt = EgtGetInfo( BtlInfoId, 'PATTID', 'i') or 40
    EmtOutput( '%'..EgtNumToString( nPatt, 0)..'.0')
+
+   -- aggiungo prefisso per commentae commenti iniziali se la macchina è utilizzata per fare i test
+   local sPrefixCommentLine = '' ; if IS_TEST_MACHINE or EgtEndsWith( EgtGetCurrMachineDir(), '.TEST') then sPrefixCommentLine = '//' end
+
    if EMT.INFO then
-      EmtOutput( '('..EMT.INFO..')')
+      EmtOutput( sPrefixCommentLine..'('..EMT.INFO..')')
    else
       EmtOutput( '(Program Start)')
    end
-   EmtOutput( '('.. CSP_INFO..')')
+   EmtOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
-   EmtOutput( '('.. MACHINE_INFO..')\n')
+   EmtOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')\n')
    -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
    if TEST_USE then
       EmtOutput( 'M28')
@@ -133,6 +137,14 @@ function OnToolData()
       if EMT.TDIST and abs( EMT.TDIST) < 0.1 then EMT.TDIST = nil end
       local sOut = 'L11='..EgtNumToString( EMT.SMAX, 0)..' L12='..EmtLenToString( ( EMT.TDIST or ChSawLen), 1)..' G76H9998.1N301N304'
       EmtOutput( sOut)
+   -- emissione dati rinvio
+   elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
+      local nPos = EgtIf( EMT.HEAD == 'H5', 91, 93)
+      if EMT.EXIT == 2 then nPos = nPos + 1 end
+      local sPos = 'N2' .. tostring(nPos)
+      local sOut = 'L11=' .. EmtLenToString( EMT.SMAX, 3) .. ' L12=' .. EmtLenToString( AngTr1Offs, 1)..' G76H9998.1'..sPos..sPos
+      EmtOutput( sOut)
+   -- altro non previsto
    end
 end
 
@@ -151,7 +163,7 @@ function OnDispositionStart()
                    ' EG'..EmtLenToString( SawOffs, 2)..' EI'..EmtLenToString( ParkY, 2)..' EL'..EmtLenToString( ParkV, 2)..
                    ' EM'..EmtLenToString( TurnerOffs, 2)..' EN'..EmtLenToString( -DeltaTabY, 2)..' EO'..EmtLenToString( DeltaTabZ, 2)
       if SecondSupport >= 3 then
-         sOut = sOut ..' EP'..EmtLenToString( AngTr1Len, 2) ..' EQ'..EmtLenToString( AngTr1Offs + MillOffs,2)
+         sOut = sOut ..' EP'..EmtLenToString( AngTr1Len, 2) ..' EQ'..EmtLenToString( AngTr1Offs,2)
       end
       EmtOutput( '\n' .. sOut .. '\n')
       -- carico barra
@@ -418,6 +430,10 @@ function OnMachiningStart()
    -- sistemazione speed
    if EMT.HEAD == 'H2' then
       EMT.S = EMT.S * 6
+   elseif EMT.HEAD == 'H5' and EMT.EXIT == 1 then
+      EMT.S = -EMT.S
+   elseif EMT.HEAD == 'H6' and EMT.EXIT == 1 then
+      EMT.S = -EMT.S
    end
    -- determino subito se taglio di separazione di pezzo a caduta
    EMT.PREFALLCUT = nil
@@ -644,36 +660,66 @@ function OnRapid()
             EmitZmax( EMT.TOOL ~= EMT.PREVTOOL)
             EMT.ZMAX = true
             EMT.PREVTOOL = EMT.TOOL
+            bHeadFirst = false
          end
       end
-      if not EMT.LOAD then
+
-         local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '-'), '%)', '-')
-         EmtOutput( '( *** ' .. sOut .. ' *** )')
-      end
       -- primo posizionamento
       local MyZHome = EgtGetAxisHomePos( 'Z')
       local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
       -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if ( EMT.PREVHEAD == 'H3' or EMT.TTOTLEN > 200) and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
          local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
                                        ' B' .. EmtLenToString( EMT.R2pp, 3) .. ' C' .. EmtLenToString( EMT.R1pp, 3) .. 
                                        ' EE' .. EgtIf( bZmax, '3', '4') .. EMT.PREVsEL .. EMT.PREVsER .. EMT.PREVsET .. EMT.PREVsES
          EmtOutput( sOutPreMove)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
+      end
+
+      if not EMT.LOAD then
+         local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '-'), '%)', '-')
+         EmtOutput( '( *** ' .. sOut .. ' *** )')
       end
 
       -- ricavo i dati per la lavorazione
       local sEE = ' EE' .. EgtIf( bZmax, '3', '4')
-      local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
+      
-      local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
+      local sEL = ' EL'
+       -- se motosega
+      if EMT.HEAD == 'H3' then
+         sEL = sEL..EmtLenToString( ( EMT.TDIST or ChSawLen), 3)
+      -- se aggregato
+      elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
+         sEL = sEL..EmtLenToString( AngTr1Offs, 3)
+      -- se testa normale  ( H1 or H2)
+      else
+         sEL = sEL..EmtLenToString( EMT.TLEN, 3)
+      end
+
+      local sER = ' ER'
+       -- se motosega
+      if EMT.HEAD == 'H3' then
+         sER = sER..EmtLenToString( EMT.TLEN, 3)
+      -- se aggregato
+      elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
+         sER = sER..EmtLenToString( EMT.TLEN + AngTr1Len, 3)
+      -- se testa normale  ( H1 or H2)
+      else
+         sER = sER..EmtLenToString( EMT.TDIAM / 2, 3)
+      end
+
       local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
       local sES = ' ES'..EgtNumToString( EMT.S, 0)
 
       -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
-      if EMT.HEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if ( EMT.HEAD == 'H3' or EMT.TTOTLEN > 200) and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
          local sEEPreMove = ' EE' .. EgtIf( bZmax, '3', '4')
          local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
                                        EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
          EmtOutput( sOutPreMove)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
       end
       EmtResetPrev()
       -- se sono su pezzi alti e movimento da emettere, per sicurezza a Z massima
@@ -797,7 +843,7 @@ function OnRapid()
          sOut = 'G112 EA'..sA..' EB'..sB..EmtGetAxis('L1')..' EY'..sY..' EV'..sV..' EF'..GetFmaxClamp()
          EmtOutput( sOut)
          -- se taglio di coda senza residuo da scaricare, emetto M175 per accelerare il carico della barra successiva
-         if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') then
+         if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') and ( IsEndPhase( EMT.PHASE+1) or IsEnd2Phase( EMT.PHASE+1)) then
             EmtOutput( '(M175)')
          end
          if not bHeadFirst then
@@ -932,6 +978,11 @@ end
 
 ---------------------------------------------------------------------
 function OnArc()
+   -- con aggregato non si possono fare archi. Deve essere tutto spezzato
+   if EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
+      EmtSetLastError( 1211, "With aggregate, the arcs must be splitted")
+   end
+
    MyBackupAxes()
    EMT.TLAST = EMT.L1
    -- non modale su archi
@@ -958,8 +1009,12 @@ function OnArc()
    local sFeed = EmtGetFeed()
    -- tipo arco
    local sArc = 'G' .. EgtNumToString(EMT.MOVE,0)
-   -- emetto arco
+   -- se arco molto grande, approssimo con una retta
-   EmtOutput( sArc..sAxes..sRad..sFeed)
+   if EMT.RR > 99999 then
+      EmtOutput( "G1"..sAxes..sFeed)
+   else
+      EmtOutput( sArc..sAxes..sRad..sFeed)
+   end
 
    -- aggiorno valori come precedenti
    EmtUpdatePrev()
@@ -969,7 +1024,7 @@ end
 function CalcDinamicaPinze( dH, dS, dL)
    local MinTempoAcc = 0.3                         -- [s]
    local MaxTempoAcc = 4.0                         -- [s]
-   local KgMtCubo= 550                             -- densità legno [Kg / metro cubo]
+   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]
@@ -1511,16 +1566,24 @@ function MyAdjustLinearAxes()
 
    if EMT.REFLOC then
       local vtE
-      if EMT.HEAD ~= 'H3' then
+      if EMT.HEAD == 'H1' or EMT.HEAD == 'H2' then
          local Len = EMT.TLEN + EgtIf( EMT.HEAD == 'H1', MillOffs, abs( SawOffs))
          local LenRef = MillOffs
          vtE = Vector3d( EMT.EXTR) * Len - Z_AX() * LenRef
-      else
+      elseif EMT.HEAD == 'H3' then
          local LenAux = ( EMT.TDIST or ChSawLen) + MillOffs
          local LenRef = MillOffs
          local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
          vtE = vtAux * LenAux - Z_AX() * LenRef
+      elseif  EMT.HEAD == 'H5' then
+         local LenAux = AngTr1Offs + MillOffs
+         local LenRef = MillOffs
+         local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
+         vtE = vtAux * LenAux - Z_AX() * LenRef
+      else
+         EmtSetLastError( 1211, 'Head not allowed ' .. EMT.HEAD)
       end
+
       EMT.L1 = EMT.L1 - vtE:getX()
       EMT.L2 = EMT.L2 - DeltaTabY - vtE:getY()
       EMT.L3 = EMT.L3 - DeltaTabZ - vtE:getZ()
@@ -1560,7 +1623,7 @@ function CalcInterpPlane()
    local ptS = Point3d( xS, 0, 0)
    -- calcolo per piano generico
    local vtE
-   if EMT.HEAD ~= 'H3' then
+   if EMT.HEAD == 'H1' or EMT.HEAD == 'H2' then
       vtE = Vector3d( EMT.EXTR)
    else
       vtE = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
@@ -1611,7 +1674,7 @@ end
 
 ---------------------------------------------------------------------
 function GetET( sHead, sTcPos, dAxR3)
-   if sHead == 'H1' then
+   if sHead == 'H1' or sHead == 'H5' or sHead == 'H6' then
       return ' E'..sTcPos
    elseif sHead == 'H2' then
       return ' ET42'

Common_FAST.TPA.mlpe

@@ -6,7 +6,7 @@ local INFO_STD_PP = require( 'Version')
 
 -- Variabili di modulo
 local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
-local MACHINE_INFO = 'PP_VER       ver.'..PP_VER
+local MACHINE_INFO = MACH_NAME..'  ver.'..PP_VER
 local TEST_USE = false
 
 ---------------------------------------------------------------------
@@ -38,14 +38,18 @@ end
 
 ---------------------------------------------------------------------
 function OnProgramStart()
+
+   -- aggiungo prefisso per commentae commenti iniziali se la macchina è utilizzata per fare i test
+   local sPrefixCommentLine = '' ; if IS_TEST_MACHINE or EgtEndsWith( EgtGetCurrMachineDir(), '.TEST') then sPrefixCommentLine = '//' end
+
    -- Intestazioni
    if EMT.INFO then
-      ParkLine( '('..EMT.INFO..')')
+      ParkLine( sPrefixCommentLine..'('..EMT.INFO..')')
    else
       ParkLine( '(Program Start)')
    end
-   ParkLine( '('.. CSP_INFO..')')
+   ParkLine( sPrefixCommentLine..'('.. CSP_INFO..')')
-   ParkLine( '('.. MACHINE_INFO..')')
+   ParkLine( sPrefixCommentLine..'('.. MACHINE_INFO..')')
 
    -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
    if TEST_USE then
@@ -206,19 +210,12 @@ function OnDispositionEnd()
       local HTrave = EMT.HT
       local STrave = EMT.ST
       local HOverM = EMT.HOVM
+
       -- calcolo dati pinze
-      local MinAccPinze = 0.3
+      local TempAccPinze, TempMinAccPinze, RidFeed = CalcDinamicaPinze( HTrave, STrave, LBarra)
-      local MaxAccPinze = 4
+      local TempAccPinz1, TempMinAccPinz1, RidFeed1 = CalcDinamicaPinze( HTrave, STrave, LBarra - LTrave)
-      local KgMtCubo= 550           -- densità legno in Kg / metro cubo
+      local TempAccPinz2, TempMinAccPinz2, RidFeed2 = CalcDinamicaPinze( HTrave, STrave, LTrave)
-      local Massa = ( HTrave * STrave * LBarra * KgMtCubo ) / 1000000000
+
-      local FMaxPinze = EMT.FMAXPINZE
-      local ForzaAtrito = 700 / 2   -- Serve per regolare P32 (700 valore reale pistone)
-      local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAtrito) / 1000)
-      if ( TempoAcc < MinAccPinze) then TempoAcc = MinAccPinze end
-      if ( TempoAcc > MaxAccPinze) then TempoAcc = MaxAccPinze end
-      local AccPinze = FMaxPinze / ( 60 * TempoAcc)
-      local RidFeed = 100 / Massa * 100
-      if ( RidFeed > 100) then RidFeed = 100 end
       if IdTrave >= 0 then
          local sPrt = '( *** Part '.. EgtNumToString( IdTrave, 0) ..' ***)'
          local sOut = '( SN=' .. IdTrave .. ' LBarra=' .. EmtLenToString( LBarra, 3) .. ' L='..EmtLenToString( LTrave, 3) ..
@@ -247,7 +244,8 @@ function OnDispositionEnd()
       -- se carico barra
       if EMT.LOAD or EMT.RELOAD then
          sOut = 'M115 P1=' .. EmtLenToString( LBarra, 2) .. ' P2=' .. EmtLenToString( HTrave, 2) .. ' P3=' .. EmtLenToString( STrave, 2) ..
-                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( LTrave, 2)
+                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( LTrave, 2) ..
+                ' P7=' .. EgtNumToString( TempAccPinze, 2) .. ' P8=' .. EgtNumToString( TempAccPinz2, 2) .. ' P9=' .. EgtNumToString( TempAccPinz1, 2)
          if EMT.LOAD then
             ParkLine( sOut)
             SetStartValue( 1, LBarra)
@@ -261,7 +259,8 @@ function OnDispositionEnd()
       -- altrimenti recupero rimanenza
       else
          sOut = 'M115 P1=' .. EmtLenToString( LBarra, 2) .. ' P2=' .. EmtLenToString( HTrave, 2) .. ' P3=' .. EmtLenToString( STrave, 2) ..
-                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( EgtIf( IdTrave >= 0, LTrave, LBarra), 2)
+                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( EgtIf( IdTrave >= 0, LTrave, LBarra), 2) ..
+                ' P7=' .. EgtNumToString( TempAccPinze, 2) .. ' P8=' .. EgtNumToString( TempAccPinz2, 2) .. ' P9=' .. EgtNumToString( TempAccPinz1, 2)
          EmtOutput( sOut)
          EmtOutput( 'M112'..' P1='..EmtLenToString( LoadT, 3).. ' P5=1 P6='..EmtLenToString( EMT.YPOS, 3)..' P7='..EmtLenToString( ParkV, 3) ..' P9='..GetFmaxClamp())
          -- aggiorno dati aggancio carrelli alla trave
@@ -641,30 +640,37 @@ function OnRapid()
       if not ( EMT.LOAD or EMT.RELOAD) then
          if not EMT.ZMAX and #EMT.AUXSTR > 0 then
             EmitZmax()
+            bHeadFirst = false
          end
       end
-      if not EMT.LOAD then
-         local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '['), '%)', ']')
-         EmtOutput( '( * ' .. sOut .. ' * )')
-      end
       -- primo posizionamento
       local MyZHome = EgtGetAxisHomePos( 'Z')
       local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or EMT.L3 > -1)
       -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
-      if EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if ( EMT.PREVHEAD == 'H3' or EMT.TTOTLEN > 200) and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
          local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, 3) .. ' P3=' .. EmtLenToString( MyZHome, 3) ..
                                  ' P4=' .. EgtNumToString( EMT.R2pp, 3) .. ' P5=' .. EgtNumToString( EMT.R1pp, 3) .. 
                                  ' P6=' .. EgtNumToString( EMT.PREVTCPOS, 3) .. ' P7=' .. EgtNumToString( EMT.PREVS, 0) ..
                                  ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
          EmtOutput( sOutPreMove)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
       end
+
+      if not EMT.LOAD then
+         local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '['), '%)', ']')
+         EmtOutput( '( * ' .. sOut .. ' * )')
+      end
+
       -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
-      if EMT.HEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+      if ( EMT.HEAD == 'H3' or EMT.TTOTLEN > 200) and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
          local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, 3) .. ' P3=' .. EmtLenToString( MyZHome, 3) ..
                                  ' P4=' .. EgtNumToString( EMT.R2, 3) .. ' P5=' .. EgtNumToString( EMT.R1, 3) .. 
                                  ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
                                  ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
          EmtOutput( sOutPreMove)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
       end
       -- resetto valori precedenti
       EmtResetPrev()
@@ -768,7 +774,7 @@ function OnRapid()
             sB = '2'
          end
          -- se taglio di coda senza residuo da scaricare, emetto M175 per accelerare il carico della barra successiva
-         if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') then
+         if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') and ( IsEndPhase( EMT.PHASE+1) or IsEnd2Phase( EMT.PHASE+1)) then
             EmtOutput( 'M175')
          end
          if bHeadFirst then
@@ -975,6 +981,28 @@ function OnArc()
    EmtUpdatePrev()
 end
 
+---------------------------------------------------------------------
+function CalcDinamicaPinze( dH, dS, dL)
+   local MinTempoAcc = 0.3                         -- [s]
+   local MaxTempoAcc = 4.0                         -- [s]
+   local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
+   local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
+   local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
+   local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
+   local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
+   if ( TempoAcc < MinTempoAcc) then TempoAcc = MinTempoAcc end
+   if ( TempoAcc > MaxTempoAcc) then TempoAcc = MaxTempoAcc end
+   local AccMaxPinze = FMaxPinze / ( 60 * MinTempoAcc)
+   local AccPinze = FMaxPinze / ( 60 * TempoAcc)
+   local 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 CalcCharStatus( sCmd, bSkipPress)
    -- aperto

Common_FAST.mlpe

@@ -1,4 +1,4 @@
--- Processore macchina Essetre-FAST by EgalWare s.r.l.   2024/02/23
+-- Processore macchina Essetre-FAST by EgalWare s.r.l.   2024/03/09
 
 -- Intestazioni
 require( 'EmtGenerator')
@@ -15,11 +15,11 @@ BIG_TOOL_DIAM = 300
 ---------------------------------------------------------------------
 local sBaseDir = EgtGetCurrMachineDir()
 if NumericalControl == 'NUM' then
-   dofile( sBaseDir .. '\\Common-FAST.NUM.mlpe')
+   dofile( sBaseDir .. '\\Common_FAST.NUM.mlpe')
 elseif NumericalControl == 'TPA' then
-   dofile( sBaseDir .. '\\Common-FAST.TPA.mlpe')
+   dofile( sBaseDir .. '\\Common_FAST.TPA.mlpe')
 elseif NumericalControl == 'NUM_PLUS' then
-   dofile( sBaseDir .. '\\Common-FAST.NUM_PLUS.mlpe')
+   dofile( sBaseDir .. '\\Common_FAST.NUM_PLUS.mlpe')
 else
    EmtSetLastError( 1201, 'Numerical Control error : unkwnown type')
 end
@@ -130,7 +130,7 @@ function OnSimulStart()
       local nId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( nGrpId or GDB_ID.NULL, McdData[i].Sub) or GDB_ID.NULL, McdData[i].Name)
       if nId then
          table.insert( EMT.MCODET, nId)
-         EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' is ok', 4)
+         EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' (' .. tostring( nId) .. ') is ok', 4)
       else
          nMcdNullCnt = nMcdNullCnt + 1
          EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' is null', 4)
@@ -671,35 +671,8 @@ end
 
 ---------------------------------------------------------------------
 function OnSimulPathEnd()
-   -- se attivo VMILL, lavorazione ed è richiesto di eliminare gli sfridi
+   -- rimozione eventuali sfridi
-   if EMT.VMILL and #EMT.VMILL > 0 and not EMT.OPEISDISP and EMT.VMRS then
+   ExecRemoveScraps()
-      EgtOutLog( 'OnSimulPathEnd', 5)
-      local vMillId = EMT.VMILL[1]
-      local nPart = EgtVolZmapPartCount( vMillId)
-      if nPart > 1 then
-         -- ricerca del pezzo con massimo volume
-         local nPartMax = 0
-         local dVolMax = 0
-         for i = 1, nPart do
-            local dVol = EgtVolZmapPartVolume( vMillId, i - 1)
-            if dVol > dVolMax then
-               dVolMax = dVol
-               nPartMax = i
-            end
-         end
-         -- eliminazione di tutti i pezzi piccoli
-         for i = nPart, 1, -1 do
-            if i ~= nPartMax then
-               local b3Vmill = EgtVolZmapGetPartBBoxGlob( vMillId, i - 1, GDB_BB.STANDARD)
-               if b3Vmill:getDimX() < 1200 then
-                  EgtRemoveVolZmapPart( vMillId, i - 1)
-               end
-            end
-         end
-         -- aggiorno visualizzazione
-         EgtDraw()
-      end
-   end
 end
 
 ---------------------------------------------------------------------
@@ -779,7 +752,7 @@ function OnSimulMoveStart()
       -- con pezzi alti aggiorno gli assi rotanti prima di muovermi sopra il pezzo
       if not EMT.LOAD and EMT.MOVE == 0 and EMT.HB > BeamHeightForFixRot and EMT.FLAG2 == 1 then
          -- se motosega mi muovo a X di sicurezza per ruotare
-         if EMT.HEAD == 'H3'then
+         if EMT.HEAD == 'H3' or EMT.TOTLEN > 200 then
             SimulMoveAxes( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID, 'C', EMT.R1, MCH_SIM_STEP.COLLROT, 'B', EMT.R2, MCH_SIM_STEP.COLLROT)
          end
       end
@@ -788,8 +761,12 @@ function OnSimulMoveStart()
 end
 
 ---------------------------------------------------------------------
---function OnSimulMoveEnd()
+function OnSimulMoveEnd()
---end
+   if EMT.FLAG == 301 then 
+      -- rimozione eventuali sfridi
+      ExecRemoveScraps()
+   end
+end
 
 ---------------------------------------------------------------------
 function OnSimulCollision()
@@ -893,6 +870,39 @@ function ExecAuxCmd( sCmd)
    end
 end
 
+---------------------------------------------------------------------
+function ExecRemoveScraps()
+   -- se attivo VMILL, lavorazione ed è richiesto di eliminare gli sfridi
+   if EMT.VMILL and #EMT.VMILL > 0 and not EMT.OPEISDISP and EMT.VMRS then
+      EgtOutLog( 'OnSimulPathEnd', 5)
+      local vMillId = EMT.VMILL[1]
+      local nPart = EgtVolZmapPartCount( vMillId)
+      if nPart > 1 then
+         -- ricerca del pezzo con massimo volume
+         local nPartMax = 0
+         local dVolMax = 0
+         for i = 1, nPart do
+            local dVol = EgtVolZmapPartVolume( vMillId, i - 1)
+            if dVol > dVolMax then
+               dVolMax = dVol
+               nPartMax = i
+            end
+         end
+         -- eliminazione di tutti i pezzi piccoli
+         for i = nPart, 1, -1 do
+            if i ~= nPartMax then
+               local b3Vmill = EgtVolZmapGetPartBBoxGlob( vMillId, i - 1, GDB_BB.STANDARD)
+               if b3Vmill:getDimX() < 1200 then
+                  EgtRemoveVolZmapPart( vMillId, i - 1)
+               end
+            end
+         end
+         -- aggiorno visualizzazione
+         EgtDraw()
+      end
+   end
+end
+
 ---------------------------------------------------------------------
 function ExecUnloading()
    if EMT.VMILL and #EMT.VMILL > 0 then
@@ -913,10 +923,14 @@ function ExecUnloading()
       EgtMove( nLayId, vtMove, GDB_RT.GLOB)
       EgtSetLevel( vMillId, GDB_LV.USER)
       -- aggiungo gli spigoli
-      local nFirstId, nCount = EgtVolZmapGetEdges( vMillId, nLayId)
+      if EgtVolZmapSetShowEdges then
-      if nFirstId then
+         EgtVolZmapSetShowEdges( vMillId, true)
-         for nId = nFirstId, nFirstId + nCount - 1 do
+      else
-            EgtSetColor( nId, Color3d( 96, 96, 96))
+         local nFirstId, nCount = EgtVolZmapGetEdges( vMillId, nLayId)
+         if nFirstId then
+            for nId = nFirstId, nFirstId + nCount - 1 do
+               EgtSetColor( nId, Color3d( 96, 96, 96))
+            end
          end
       end
       -- rilascio Vmill
@@ -1510,6 +1524,12 @@ function IsStartOrRestPhase( nPhase)
    return ( sVal == 'START' or sVal == 'REST')
 end
 
+---------------------------------------------------------------------
+function IsEndPhase( nPhase)
+   local sVal = GetPhaseType( nPhase)
+   return ( sVal == 'END')
+end
+
 ---------------------------------------------------------------------
 function IsMidPhase( nPhase)
    local sVal = GetPhaseType( nPhase)

UpdateLog.txt

@@ -1,5 +1,50 @@
            ==== Common_FAST Update Log ====
 
+Versione 2.6i2 (16/09/2024)
+- (SIM-GEN) Se utensili più lunghi di 200mm, si ruota in home e poi si approccia il pezzo.  Ticket#2038
+- (SIM-GEN) Aumentata distanza ingombro da 650mm a 660mm. In casi di utensile abbastanza lungo poteva andare in colisione. Ticket#2041
+
+Versione 2.6i1 (02/09/2024)
+- (MLDE-SIM-GEN) Rinominato file da "Common-" a "Common_" per uniformità con i file common delle altre macchine. Serve modifica a MLDE macchina.
+
+Versione 2.6g1 (03/07/2024)
+- (GEN) Corretto chiamata macro precarico in caso di taglio finale, ma con ribaltamento successivo. Ora si chiama solo se la fase successiva è una "END". Ticket#1881
+- (GEN) Per controllo NUM, se arco maggiore di 99999mm, si approssima con una retta. Ticket#1888
+
+Versione 2.6e3 (06/05/2024)
+- (MLDE-SIM-GEN) Gestione facoltativa parametri MIN_JOIN_xx settabili in Ts3. Ticket#1794
+
+Versione 2.6e2 (06/05/2024)
+- (SIM-GEN) Modificata tolleranza calcolo ingombri lavorazioni per posizionamento pinze. Ticket#1790
+
+Versione 2.6e1 (30/04/2024)
+- (MLDE-GEN) Gestione facoltativa parametro WOOD_DENSITY settabile in Ts3. In MLDE, mettere il valore di WOOD_DENSITY nella nostra variabile 'WoodDensity'.
+
+Versione 2.6d2 (18/04/2024)
+- (SIM-GEN) In MLSE, quando c'è una rotazione, viene settato EMT.CNT=1 per considerare i 50mm di compensazione laser.
+- (SIM) Nel file di log dove c'è stampa gruppi di collisione, viene scritto anche ID del gruppo
+
+Versione 2.6d1 (15/04/2024)
+- (GEN) Aggiunta gestione aggregato doppia uscita per controllo NUM_PLUS
+- (GEN) Con aggregato con si possono fare archi, se OnArc con aggregato, dà errore.
+- (GEN) Chiamando la macchina con un nome che termini con '.TEST' si abilita come macchina per test interni, equivalente a settare 'IS_TEST_MACHINE' (che comunque rimane)
+
+Versione 2.6c8 (28/03/2024)
+- (MLSE) Possibilità di lavorazione da X- tra le pinze, se abilitata da flag (User.ENABLE_TOOL_BETWEEN_VICES == 1).
+- (MLDE-GEN) Aggiunto parametro 'IS_TEST_MACHINE' FACOLTATIVO. Se non esiste o 'false' è macchina standard, se 'true' è una macchina utilizzata per i test Egalware interni
+
+Versione 2.6c7 (12/03/2024)
+- (SIM) Miglioramento visualizzazione spigoli VMILL alla fine della simulazione. Funzione: EgtVolZmapSetShowEdges. N.B.= serve CAM5 2.6c2 NON OBBLIGATORIO
+- (GEN) Corretto problema di movimento pinze assieme a discesa asse Z (Ticket #1710)
+
+Versione 2.6c6 (04/03/2024)
+- (MLDE-GEN) Aggiunta variabile 'MACH_NAME' in MLDE con nome macchina
+
+Versione 2.6c5 (29/02/2024)
+- (GEN) Aggiunto comando di wait fine M101/G101 in caso di movimento in zona sicurezza per motosega
+- (GEN) Gestione accelerazioni pinze in M115 ( solo per TPA)
+- (SIM) Gestione rimozione VMILL per tagli a cubetti a zig-zag
+
 Versione 2.6c4 (27/02/2024)
 - (MLDE-SIM-GEN) Con pezzi molto alti '> BeamHeightForFixRot', aggiunto parametro 'SafeXRotAxes' per ruotare motosega in zona sicura lontano dal pezzo
 - (SIM) Nelle funzioni movimentaizone assi, utilizzate costanti 'MCH_SIM_STEP'

Version.lua

@@ -1,9 +1,9 @@
--- Version.lua by EgalWare s.r.l. 2024/02/23
+-- Version.lua by EgalWare s.r.l. 2024/03/28
 -- Gestione della versione dei file comuni post-processori macchine FAST e FASTrl di Essetre
 
 local InfoCommon_STD_PP = {
-   NAME = 'Common-FAST',            -- nome script PP standard
+   NAME = 'Common_FAST',            -- nome script PP standard
-   VERSION = '2.6c4',                 -- versione script
+   VERSION = '2.6i2',                 -- versione script
    MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
 }