Piccola correzione: Primo movimento in X per testa 2 a SafeX2 anziché a ParkX2.

- funzione 'GetCurrChainSawingVirtualAxis' spostata in MLDE

Common-PF1250.TPA.mlpe

@@ -397,7 +397,7 @@ function OnMachiningStart()
       -- valore dell'asse virtuale
       dPosA = GetCurrChainSawingVirtualAxis()
       -- imposto home dell'asse C1 (A=0 -> T101, A=90 -> T104)
-      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA)
+      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
       EmtModifyAxisHome( 'C1', MyParkCSawC1)
    -- se lama su aggregato testa sotto, aggiusto subito angolo scelto per asse virtuale A
    elseif EMT.HEAD == 'H22' then
@@ -653,6 +653,7 @@ function OnRapid()
    if EMT.MCHFIRST and not EMT.OPEISDISP then
       MyAdjustLinearAxes()
       EmtAdjustRotaryAxes()
+      local HomeZ1 = EgtGetAxisHomePos( 'Z1')
       local HomeR1 = EgtGetAxisHomePos( EgtIf( nHSet == 1, 'C1', 'C2'))
       local HomeR2 = EgtGetAxisHomePos( EgtIf( nHSet == 1, 'B1', 'B2'))
       local PrevR1 = EMT.R1p or EMT.R1pp or HomeR1
@@ -712,7 +713,7 @@ function OnRapid()
                if WriteAllCoordsOnFirstM101 then
                   -- se sega a catena
                   if EMT.HEAD == 'H13' then
-                     EmitMoveDataHead( 1, { X=-ParkCSawX1, Z=ParkCSawZ1, B=HomeR2, C=HomeR1, TRad=dTRad, TLen=dTLen, S=Speed})
+                     EmitMoveDataHead( 1, { X=-ParkCSawX1, Z=HomeZ1, B=HomeR2, C=HomeR1, TRad=dTRad, TLen=dTLen, S=Speed})
                   -- utensili standard
                   else
                      EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=EMT.L3, B=ParkB1, C=ParkC1, S=Speed})
@@ -961,14 +962,19 @@ function OnRapid()
                else
                   -- se bisogna scrivere tutti gli assi
                   if WriteAllCoordsOnFirstM101 then
-                     EmitMoveDataHead( 1, { X=-ParkCSawX1, Z=ParkCSawZ1, B=HomeB1, C=HomeC1, TRad=dTRad, TLen=dTLen, S=Speed})
+                     local dSafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
+                     EmitMoveDataHead( 1, { X=-ParkCSawX1, Z=dSafeZ1, B=HomeB1, C=HomeC1, TRad=dTRad, TLen=dTLen, S=Speed})
                   end
                   -- Porto la Z alla giusta quota
                   if EMT.L3 > HomeZ1 + 1 and abs( EMT.R2) > 89.9 then
                      EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
                      EmitMoveDataHead( 1, { Z=HomeZ1, S=Speed})
                   end
-                  EmitMoveDataHead( 1, { Z=HomeZ1, B=EMT.R2, S=Speed})
+                  EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
+                  -- se motosega molto lunga, ruoto prima di muovermi in X
+                  if EMT.TTOTLEN >= MinLengthLongCSaw then
+                     EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
+                  end
                end
             end
             EmitMoveDataHead( 1, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})
@@ -979,12 +985,11 @@ function OnRapid()
                local dB2 = EMT.R2
                if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                   local dSafeZ2 = EgtGetAxisHomePos( 'Z2')
-                  local dSafeX2 = EgtGetAxisHomePos( 'X2')
                   -- se bisogna scrivere tutti gli assi
                   if WriteAllCoordsOnFirstM101 then
-                     EmitMoveDataHead( 2, { X=dSafeX2, Z=MinZ2, B=ParkB2, C=ParkC2, TPos=EMT.DOU_TPOS, S=EMT.DOU_SPEED})
+                     EmitMoveDataHead( 2, { X=SafeX2, Z=MinZ2, B=ParkB2, C=ParkC2, TPos=EMT.DOU_TPOS, S=EMT.DOU_SPEED})
                   else
-                     EmitMoveDataHead( 2, { X=dSafeX2, TPos=EMT.DOU_TPOS, S=EMT.DOU_SPEED})
+                     EmitMoveDataHead( 2, { X=SafeX2, TPos=EMT.DOU_TPOS, S=EMT.DOU_SPEED})
                   end
 
                   EmitMoveDataHead( 2, { Z=-dSafeZ2, TPos=EMT.DOU_TPOS, S=EMT.DOU_SPEED})
@@ -1005,10 +1010,9 @@ function OnRapid()
                local dB2 = EMT.R2
                if EMT.ZMAX then
                   local dSafeZ2 = EgtGetAxisHomePos( 'Z2')
-                  local dSafeX2 = EgtGetAxisHomePos( 'X2')
                   -- se bisogna scrivere tutti gli assi
                   if WriteAllCoordsOnFirstM101 then
-                     EmitMoveDataHead( 2, { X=dSafeX2, Z=-dSafeZ2, B=ParkB2, C=ParkC2, TPos=EMT.DOU_TPOS, S=EMT.DOU_SPEED})
+                     EmitMoveDataHead( 2, { X=SafeX2, Z=-dSafeZ2, B=ParkB2, C=ParkC2, TPos=EMT.DOU_TPOS, S=EMT.DOU_SPEED})
                   else
                      EmitMoveDataHead( 2, { Z=-dSafeZ2, TPos=EMT.DOU_TPOS, S=EMT.DOU_SPEED})
                   end
@@ -1031,12 +1035,11 @@ function OnRapid()
             local CurrB2 = PrevR2
             local CurrC2 = PrevR1
             local dSafeZ2 = EgtGetAxisHomePos( 'Z2')
-            local dSafeX2 = EgtGetAxisHomePos( 'X2')
             local Speed = EMT.S
             if EMT.ZMAX then
                -- se bisogna scrivere tutti gli assi
                if WriteAllCoordsOnFirstM101 then
-                  EmitMoveDataHead( 2, { X=dSafeX2, Z=CurrZ2, B=CurrB2, C=CurrC2, S=Speed})
+                  EmitMoveDataHead( 2, { X=SafeX2, Z=CurrZ2, B=CurrB2, C=CurrC2, S=Speed})
                end
                EmitMoveDataHead( 2, { Z=-dSafeZ2, S=Speed})
                EmitMoveDataHead( 2, { X=EMT.L2, S=Speed})
@@ -1626,7 +1629,10 @@ function PrepareMoveChar( sCmd, nInd)
    elseif Cmd[1] == '11' then
       EMT.ISY1 = CalcCharStatusN( Cmd[2])
       EMT.FSY1 = EMT.ISY1
-      EMT.BV = EgtIf( Cmd[2] ~= '0', 1, 2)
+      -- se pinza due in presa, non attivo la 1
+      if EMT.BV ~= 2 then
+         EMT.BV = EgtIf( Cmd[2] ~= '0', 1, 2)
+      end
       if #EMT.MDCHAR > 0 then EMT.MDCHAR[#EMT.MDCHAR].FinStatY1 = EMT.FSY1 end
    elseif Cmd[1] == '12' then
       EMT.ISY2 = CalcCharStatusN( Cmd[2])
@@ -2212,8 +2218,9 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome)
          EmitMoveWaitHead( 1)
       -- altrimenti sega a catena
       else
-         -- salzo in Z sicurezza raddrizzando la B
-         EmitMoveDataHead( 1, { Z=ParkCSawZ1, B=dHomeB1, Fmt=1})
+         -- salgo in Z sicurezza raddrizzando la B
+         local dSafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
+         EmitMoveDataHead( 1, { Z=dSafeZ1, B=dHomeB1, Fmt=1})
          EmitMoveDataHead( 1, { X=-dHomeX1, C=dHomeC1, Fmt=1})
          if bTopGoHome then
             -- !!! da verificare bene (come PF) !!!
@@ -2266,7 +2273,7 @@ function EmitDouZMax( nDouType)
    local dHomeC2 = EgtGetAxisHomePos( 'C2')
    -- se lavorazione in doppio in Y (prima mi allontano in Y)
    if nDouType == 2 then
-      EmitMoveDataHead( 2, { X=dHomeX2, TPos=EMT.DOU_TPOS, Fmt=1})
+      EmitMoveDataHead( 2, { X=SafeX2, TPos=EMT.DOU_TPOS, Fmt=1})
    end
    -- scendo in Z, sistemo B e C porto X in home
    EmitMoveDataHead( 2, { Z=-dHomeZ2, TPos=EMT.DOU_TPOS, Fmt=1})
@@ -2507,7 +2514,7 @@ function PreselectNextDiffHead( nMchId, sHead)
                elseif sNextHead == 'H13' then
                   -- recupero il valore dell'asse virtuale bloccato A
                   local dPosA = GetCurrChainSawingVirtualAxis()
-                  local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA)
+                  local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
                   local bXSpec = EgtIf( BD.RIGHT_LOAD, ( dNextX > -DeltaTabY), ( dNextX < -DeltaTabY))
                   EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, dNextX), B=ParkCSawB1, C=MyParkCSawC1, TPos=AdjustTcPos( false, sNextTcPos, dPosA), Fmt=2})
                   EmitMoveStartHead( 1)

Common-PF1250.mlpe

@@ -426,7 +426,7 @@ function OnSimulToolSelect( dPosA)
       -- imposto il valore di A
       EgtSetAxisPos( 'A1', dPosA)
       -- imposto home dell'asse C1 (A1=0 -> T101, A1=90 -> T104)
-      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA)
+      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
       EmtModifyAxisHome( 'C1', MyParkCSawC1)
       EgtSetAxisPos( 'C1', MyParkCSawC1)
       -- Imposto visualizzazione
@@ -527,7 +527,7 @@ function OnSimulToolDeselect( dPrevA)
          -- simulo movimento
          local ParkC1 = EgtGetAxisHomePos( 'C1')
          if dPrevA then
-            ParkC1 = GetChainSawCHomeFromVirtualAxis( dPrevA)
+            ParkC1 = GetChainSawCHomeFromVirtualAxis( dPrevA, EMT.TTOTLEN)
          end
          SimulMoveAxes( 'B1', ParkCSawB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
          SimulMoveAxis( 'X1', ParkCSawX1, MCH_SIM_STEP.RAPID)
@@ -887,7 +887,10 @@ function OnSimulMoveStart()
             -- se movimento iniziale da Zmax
             if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                SimulMoveAxes( 'Z1', Z1Home, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
-               SimulMoveAxis( 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
+               -- se motosega molto lunga, ruoto prima di muovermi in X
+               if EMT.TTOTLEN >= MinLengthLongCSaw then
+                  SimulMoveAxis( 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
+               end
             end
          end
       -- se altrimenti testa 2
@@ -895,6 +898,7 @@ function OnSimulMoveStart()
          local B2Home = EgtGetAxisHomePos( 'B2')
          local C2Home = EgtGetAxisHomePos( 'C2')
          local Z2Home = EgtGetAxisHomePos( 'Z2')
+         local X2Home = EgtGetAxisHomePos( 'X2')
          if EMT.ZMAX then
             -- se bisogna scrivere tutti gli assi
             if WriteAllCoordsOnFirstM101 then
@@ -1225,7 +1229,7 @@ end
 function ExecStartHome()
    -- Testa 1
    EgtResetAxisPos( 'X1')
-   EgtSetAxisPos( 'Z1', MaxZ1)
+   EgtResetAxisPos( 'Z1')
    EgtResetAxisPos( 'C1')
    EgtResetAxisPos( 'B1')
    -- Testa 2
@@ -1299,8 +1303,9 @@ function ExecMoveZmax( bMchSplit)
          SimulMoveAxis( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID)
       -- altrimenti sega a catena
       else
-         -- salzo in Z sicurezza raddrizzando la B
-         SimulMoveAxes( 'Z1', ParkCSawZ1, MCH_SIM_STEP.RAPID, 'B1', HomeB, MCH_SIM_STEP.COLLROT)
+         -- salgo in Z sicurezza raddrizzando la B
+         local SafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
+         SimulMoveAxes( 'Z1', SafeZ1, MCH_SIM_STEP.RAPID, 'B1', HomeB, MCH_SIM_STEP.COLLROT)
          SimulMoveAxes( 'X1', HomeX, MCH_SIM_STEP.RAPID, 'C1', HomeC, MCH_SIM_STEP.COLLROT)
       end
       -- se lavorazione in doppio
@@ -1765,7 +1770,7 @@ function LoadFirstTool( nHSet, sTcPosDef)
    if nHSet ~= 1 and nHSet ~= 2 then return end
    EgtUnloadTool( EgtIf( nHSet == 1, 'H11', 'H21'), 1)
    if GetHeadSetFromTcPos( sTcPosDef) ~= nHSet then return end
-   local sTool, sHead, sTcPos = FindFirstToolOnHeadSet( nHSet)
+   local sTool, sHead, sTcPos, sTTotLen, sBlockedAxis = FindFirstToolOnHeadSet( nHSet)
    if not sTool then
       local vTools = EgtGetToolsInCurrSetupPos( sTcPosDef)
       if vTools and vTools[1] then
@@ -1777,7 +1782,7 @@ function LoadFirstTool( nHSet, sTcPosDef)
    if sTool then
       -- imposto correttamente i dati di testa
       local OrigEMC = EMC
-      EMC = { HEAD = sHead, TOOL = sTool, TCPOS = sTcPos, TOTLEN = 0}
+      EMC = { HEAD = sHead, TOOL = sTool, TCPOS = sTcPos, TOTLEN = sTTotLen, BLOCKEDAXIS = sBlockedAxis}
       OnSetHead()
       EMC = OrigEMC
       -- carico l'utensile
@@ -2196,7 +2201,7 @@ function FindFirstToolOnHeadSet( nHSet)
    local CurrMachId = EgtGetCurrMachining()
    local CurrTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
    -- cerco lavorazione con utensile su gruppo testa indicato
-   local sTool, sHead, sTcPos
+   local sTool, sHead, sTcPos, sTTotLen, sBlockedAxis
    local OpId = EgtGetFirstActiveOperation()
    while OpId do
       local nType = EgtGetOperationType( OpId)
@@ -2208,6 +2213,8 @@ function FindFirstToolOnHeadSet( nHSet)
                if GetHeadSet( sHead) == nHSet then
                   sTool = sTest
                   sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+                  sTTotLen = EgtTdbGetCurrToolParam( MCH_TP.TOTLEN)
+                  sBlockedAxis = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
                   break
                end
             end
@@ -2219,7 +2226,7 @@ function FindFirstToolOnHeadSet( nHSet)
    EgtSetCurrMachining( CurrMachId or GDB_ID.NULL)
    EgtTdbSetCurrTool( CurrTool or '')
    -- restituisco risultato
-   return sTool, sHead, sTcPos
+   return sTool, sHead, sTcPos, sTTotLen, sBlockedAxis
 end
 
 ---------------------------------------------------------------------
@@ -2237,14 +2244,6 @@ function GetToolTcPos( sTool)
    return sTcPos
 end
 
----------------------------------------------------------------------
-function GetCurrChainSawingVirtualAxis()
-   -- recupero il valore dell'asse virtuale bloccato A
-   local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS) or 'A1=0'
-   local dPosA = tonumber( sVal:sub( 4)) or 0
-   return dPosA
-end
-
 ---------------------------------------------------------------------
 function GetNextChainSawingVirtualAxis( MchId)
    -- recupero la lavorazione successiva

UpdateLog.txt

@@ -28,3 +28,10 @@ Versione 2.6a5 (31/01/2024)
 - (SIM-GEN) Migliorata gestione movimenti con motosega e adeguato simulazione
 - (GEN) Corretta scrittura assi in caso di 'WriteAllCoordsOnFirstM101' per testa 2
 - (ALL) Caricamento BeamData come local
+
+Versione 2.6b1 (07/02/2024)
+- (MLDE-SIM-GEN) Inserito parametro 'MinLengthLongCSaw' per gestione motosega molto lunga
+- (MLDE) funzione 'GetCurrChainSawingVirtualAxis' spostata in MLDE
+
+Versione 2.6b2 (15/02/2024)
+- (SIM-GEN) Primo movimento in X per testa 2 a SafeX2 anziché a ParkX2

Version.lua

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