Migliorata gestione movimenti per portare testa vicino a cambio utensile se trave alta.

- Gestione in OnRapid() di EMT.FLAG=5

Common_FAST.NUM.mlpe

@@ -3,6 +3,7 @@
 
 -- carico librerie
 local INFO_STD_PP = require( 'Version')
+local BD = require( 'BeamData')
 
 -- Variabili di modulo
 local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
@@ -602,6 +603,8 @@ end
 
 ---------------------------------------------------------------------
 function OnRapid()
+   -- recupero prossimo utensile
+   EMT.NEXTTOOL, EMT.NEXTHEAD, EMT.NEXTTCPOS = FindNextTool()
    MyBackupAxes()
    -- se primo movimento della lavorazione, gestione speciale
    if EMT.MCHFIRST and not EMT.OPEISDISP then
@@ -649,7 +652,7 @@ 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 ( bZmax and 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
@@ -833,12 +836,47 @@ function OnRapid()
       EmtAdjustRotaryAxes()
       EmitZmax()
       EMT.ZMAX = true
+      -- se pezzi alti e devo cambiare utensile su testa con CU, porto la testa vicino al cambio utensile
+      if EMT.ST > BeamHeightForFixRot  and  EMT.HEAD == 'H1' and  EMT.TOOL ~= EMT.NEXTTOOL  and  EMT.NEXTHEAD ~= 'H2' then
+         local dBAxis = 90
+         local dCAxis = EgtIf( BD.RIGHT_LOAD, 90, -90)         
+         local sEE = ' EE3'
+         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 sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+         local sES = ' ES'..EgtNumToString( EMT.S, 0)
+         local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..' B=' .. EgtNumToString( dBAxis, 3) ..
+                      ' C=' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOut)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+         sOut = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. EmtGetAxis( 'L3') ..' B=' .. EgtNumToString( dBAxis, 3) ..
+                ' C=' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOut)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+      end
    -- se altrimenti movimento in Home
    elseif EMT.FLAG == 4 then
       -- non previsto
-   -- se altrimenti rotazione a Z max
+   -- se altrimenti rotazione a Z max per lavorazione successiva
    elseif EMT.FLAG == 5 then
-      -- viene gestito all'inizio della lavorazione successiva
+      EMT.REFLOC = nil
+      EMT.IPLGL = false
+      MyAdjustLinearAxes()
+      EmtAdjustRotaryAxes()
+      EmtResetPrev()
+      -- ricavo i dati per la lavorazione
+      local sEE = ' EE3'
+      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 sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+      local sES = ' ES'..EgtNumToString( EMT.S, 0)
+      local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..
+                             EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+      EmtOutput( sOut)
+      EmtOutput( 'G101 ET1001')
+      EmtOutput( 'G101 ET2001')            
    -- altrimenti errore
    else
       EmtSetLastError( 1212, "Unknown Rapid flag")
@@ -941,6 +979,35 @@ function OnArc()
    EmtUpdatePrev()
 end
 
+---------------------------------------------------------------------
+function FindNextTool()
+   -- salvo stato iniziale
+   local CurrMachId = EgtGetCurrMachining()
+   local CurrTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
+   -- cerco lavorazione con utensile su gruppo testa indicato
+   local sTool, sHead, sTcPos
+   local OpId = EgtGetNextActiveOperation( CurrMachId or EMT.MCHID)
+   while OpId do
+      local nType = EgtGetOperationType( OpId)
+      if nType ~= MCH_OY.NONE  and  nType ~= MCH_OY.DISP then
+         if EgtSetCurrMachining( OpId) then
+            sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+            if EgtTdbSetCurrTool( sTool) then
+               sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+               sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+               break
+            end
+         end
+      end
+      OpId = EgtGetNextActiveOperation( OpId)
+   end
+   -- ripristino stato iniziale
+   EgtSetCurrMachining( CurrMachId or GDB_ID.NULL)
+   EgtTdbSetCurrTool( CurrTool or '')
+   -- restituisco risultato
+   return sTool, sHead, sTcPos
+end
+
 ---------------------------------------------------------------------
 function CalcCharStatus( sCmd, bSkipPress)
    -- aperto

Common_FAST.NUM_PLUS.mlpe

@@ -3,6 +3,7 @@
 
 -- carico librerie
 local INFO_STD_PP = require( 'Version')
+local BD = require( 'BeamData')
 
 -- Variabili di modulo
 local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
@@ -642,6 +643,8 @@ end
 
 ---------------------------------------------------------------------
 function OnRapid()
+   -- recupero prossimo utensile
+   EMT.NEXTTOOL, EMT.NEXTHEAD, EMT.NEXTTCPOS = FindNextTool()
    MyBackupAxes()
    -- se primo movimento della lavorazione, gestione speciale
    if EMT.MCHFIRST and not EMT.OPEISDISP then
@@ -713,7 +716,7 @@ 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 ( bZmax and 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
@@ -907,12 +910,47 @@ function OnRapid()
       EmtAdjustRotaryAxes()
       EmitZmax( false)
       EMT.ZMAX = true
+      -- se pezzi alti e devo cambiare utensile su testa con CU, porto la testa vicino al cambio utensile
+      if EMT.ST > BeamHeightForFixRot  and  EMT.HEAD == 'H1' and  EMT.TOOL ~= EMT.NEXTTOOL  and  EMT.NEXTHEAD ~= 'H2' then
+         local dBAxis = 90
+         local dCAxis = EgtIf( BD.RIGHT_LOAD, 90, -90)         
+         local sEE = ' EE3'
+         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 sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+         local sES = ' ES'..EgtNumToString( EMT.S, 0)
+         local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..' B=' .. EgtNumToString( dBAxis, 3) ..
+                      ' C=' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOut)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+         sOut = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. EmtGetAxis( 'L3') ..' B=' .. EgtNumToString( dBAxis, 3) ..
+                ' C=' .. EgtNumToString( dCAxis, 3) .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOut)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+      end
    -- se altrimenti movimento in Home
    elseif EMT.FLAG == 4 then
       -- non previsto
-   -- se altrimenti rotazione a Z max
+   -- se altrimenti rotazione a Z max per lavorazione successiva
    elseif EMT.FLAG == 5 then
-      -- viene gestito all'inizio della lavorazione successiva
+      EMT.REFLOC = nil
+      EMT.IPLGL = false
+      MyAdjustLinearAxes()
+      EmtAdjustRotaryAxes()
+      EmtResetPrev()
+      -- ricavo i dati per la lavorazione
+      local sEE = ' EE3'
+      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 sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
+      local sES = ' ES'..EgtNumToString( EMT.S, 0)
+      local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..
+                             EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+      EmtOutput( sOut)
+      EmtOutput( 'G101 ET1001')
+      EmtOutput( 'G101 ET2001')
    -- altrimenti errore
    else
       EmtSetLastError( 1212, "Unknown Rapid flag")
@@ -1020,6 +1058,35 @@ function OnArc()
    EmtUpdatePrev()
 end
 
+---------------------------------------------------------------------
+function FindNextTool()
+   -- salvo stato iniziale
+   local CurrMachId = EgtGetCurrMachining()
+   local CurrTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
+   -- cerco lavorazione con utensile su gruppo testa indicato
+   local sTool, sHead, sTcPos
+   local OpId = EgtGetNextActiveOperation( CurrMachId or EMT.MCHID)
+   while OpId do
+      local nType = EgtGetOperationType( OpId)
+      if nType ~= MCH_OY.NONE  and  nType ~= MCH_OY.DISP then
+         if EgtSetCurrMachining( OpId) then
+            sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+            if EgtTdbSetCurrTool( sTool) then
+               sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+               sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+               break
+            end
+         end
+      end
+      OpId = EgtGetNextActiveOperation( OpId)
+   end
+   -- ripristino stato iniziale
+   EgtSetCurrMachining( CurrMachId or GDB_ID.NULL)
+   EgtTdbSetCurrTool( CurrTool or '')
+   -- restituisco risultato
+   return sTool, sHead, sTcPos
+end
+
 ---------------------------------------------------------------------
 function CalcDinamicaPinze( dH, dS, dL)
    local MinTempoAcc = 0.3                         -- [s]

Common_FAST.TPA.mlpe

@@ -3,6 +3,7 @@
 
 -- carico librerie
 local INFO_STD_PP = require( 'Version')
+local BD = require( 'BeamData')
 
 -- Variabili di modulo
 local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
@@ -625,6 +626,8 @@ end
 
 ---------------------------------------------------------------------
 function OnRapid()
+   -- recupero prossimo utensile
+   EMT.NEXTTOOL, EMT.NEXTHEAD, EMT.NEXTTCPOS = FindNextTool()
    MyBackupAxes()
    -- se primo movimento della lavorazione, gestione speciale
    if EMT.MCHFIRST and not EMT.OPEISDISP then
@@ -663,7 +666,7 @@ function OnRapid()
       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 ( bZmax and 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) ..
@@ -849,12 +852,42 @@ function OnRapid()
       EmtAdjustRotaryAxes()
       EmitZmax( true)
       EMT.ZMAX = true
+      -- se pezzi alti e devo cambiare utensile su testa con CU, porto la testa vicino al cambio utensile
+      if EMT.ST > BeamHeightForFixRot  and  EMT.HEAD == 'H1' and  EMT.TOOL ~= EMT.NEXTTOOL  and  EMT.NEXTHEAD ~= 'H2' then
+         local dBAxis = 90
+         local dCAxis = EgtIf( BD.RIGHT_LOAD, 90, -90)
+         local sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( EMT.L2, 3) .. ' P3=' .. EmtLenToString( EMT.L3, 3) ..
+                      ' P4=' .. EgtNumToString( dBAxis, 3) .. ' P5=' .. EgtNumToString( dCAxis, 3) .. 
+                      ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                      ' P8=0' .. ' P9=0' .. ' P10=3'
+         EmtOutput( sOut)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+         sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, 3) .. ' P3=' .. EmtLenToString( EMT.L3, 3) ..
+                      ' P4=' .. EgtNumToString( dBAxis, 3) .. ' P5=' .. EgtNumToString( dCAxis, 3) .. 
+                      ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                      ' P8=0' .. ' P9=0' .. ' P10=3'
+         EmtOutput( sOut)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+      end
    -- se altrimenti movimento in Home
    elseif EMT.FLAG == 4 then
       -- non previsto
-   -- se altrimenti rotazione a Z max
+   -- se altrimenti rotazione a Z max per lavorazione successiva
    elseif EMT.FLAG == 5 then
-      -- viene gestito all'inizio della lavorazione successiva
+      EMT.REFLOC = nil
+      EMT.IPLGL = false
+      MyAdjustLinearAxes()
+      EmtAdjustRotaryAxes()
+      EmtResetPrev()
+      local sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( EMT.L2, 3) .. ' P3=' .. EmtLenToString( EMT.L3, 3) ..
+                   ' P4=' .. EgtNumToString( EMT.R2, 3) .. ' P5=' .. EgtNumToString( EMT.R1, 3) .. 
+                   ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                   ' P8=0' .. ' P9=0' .. ' P10=3'
+      EmtOutput( sOut)
+      EmtOutput( 'M101 P1=2')
+      EmtOutput( 'M101 P1=3')
    -- altrimenti errore
    else
       error( "Unknown Rapid flag")
@@ -981,6 +1014,35 @@ function OnArc()
    EmtUpdatePrev()
 end
 
+---------------------------------------------------------------------
+function FindNextTool()
+   -- salvo stato iniziale
+   local CurrMachId = EgtGetCurrMachining()
+   local CurrTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
+   -- cerco lavorazione con utensile su gruppo testa indicato
+   local sTool, sHead, sTcPos
+   local OpId = EgtGetNextActiveOperation( CurrMachId or EMT.MCHID)
+   while OpId do
+      local nType = EgtGetOperationType( OpId)
+      if nType ~= MCH_OY.NONE  and  nType ~= MCH_OY.DISP then
+         if EgtSetCurrMachining( OpId) then
+            sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+            if EgtTdbSetCurrTool( sTool) then
+               sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+               sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+               break
+            end
+         end
+      end
+      OpId = EgtGetNextActiveOperation( OpId)
+   end
+   -- ripristino stato iniziale
+   EgtSetCurrMachining( CurrMachId or GDB_ID.NULL)
+   EgtTdbSetCurrTool( CurrTool or '')
+   -- restituisco risultato
+   return sTool, sHead, sTcPos
+end
+
 ---------------------------------------------------------------------
 function CalcDinamicaPinze( dH, dS, dL)
    local MinTempoAcc = 0.3                         -- [s]

Common_FAST.mlpe

@@ -662,6 +662,7 @@ function OnSimulMachiningEnd()
       EMT.FALL = false
    end
    EMT.PREVHEAD = EMT.HEAD
+   EMT.PREVTOOL = EMT.TOOL
    EMT.PREVEXIT = EMT.EXIT
 end
 
@@ -749,10 +750,12 @@ function OnSimulMoveStart()
    if EMT.MCHFIRST then
       EgtOutText( '')
       EMT.MCHFIRST = false
+      local bZmax = ( EMT.TOOL ~= EMT.PREVTOOL  or EMT.L3 > -1)
+
       -- 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 ( bZmax and 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

UpdateLog.txt

@@ -1,5 +1,25 @@
            ==== Common_FAST Update Log ====
 
+Versione 2.6i6 (25/09/2024)
+- (GEN) Migliorata gestione movimenti per portare testa vicino a cambio utensile se trave alta. Ticket#2066
+
+Versione 2.6i5 (24/09/2024)
+- (SIM-GEN) Tolto controllo su lunghezza maggiore di 200mm introdotto con 2.6i2 perchè non completamente funzionante
+- (GEN) Gestione in OnRapid() di EMT.FLAG=5 (rotazione a Z max per lavorazione successiva). Ora allineata alla simulazione
+
+Versione 2.6i4 (24/09/2024)
+- (SIM-GEN) Aggiunto ripinzaggio extra in caso servisse un grande spostamento e si sta pinzando poco.
+            L'aggiunta del ripinzaggio dipende da FASTCLAMPING (che deve essere disattiva). Viene aggiunta GAIN_RECLAMPING per decidere il guadagno in mm del ripinzaggio.
+
+Versione 2.6i3 (23/09/2024)
+- (SIM-GEN) Aggiunta nuova strategia riposizionamento morse
+- (SIM-GEN) Aggiunta lettura flag NEWCLAMPING in BeamData, per abilitare nuova strategia riposizionamento. Se false o nil, funziona con metodo vecchio.
+- (SIM-GEN) Aggiunta lettura flag FASTCLAMPING. Se false, al carico prende al massimo 1000mm, per evitare collisioni durante ciclo di lettura laser e prima lavorazione.
+
+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.
 

Version.lua

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