Merge remote-tracking branch 'origin/develop'

- Post con gestione 3 testa dedicata lama

Common_PF1250.TPA.mlpe

@@ -475,18 +475,18 @@ function OnMachiningEnd()
          EmitRemark( 'PART UNLOAD')
       elseif EMT.AUXTYPE == 'P' then
          if EMT.PREROT then
-            EmitZmax( false, true, EMT.R1, EMT.R2)
+            EmitZmax( false, true, EMT.R1, EMT.R2, false, false, false)
             EMT.ZMAX = true
             EmitRemark( 'PART ROTATION')
          elseif EMT.FALL then
             if EMT.TO_ZMAX and not EMT.ZMAX then
-               EmitZmax( false, true, EMT.R1, EMT.R2)
+               EmitZmax( false, true, EMT.R1, EMT.R2, false, false, false)
                EMT.ZMAX = true
                EMT.TO_ZMAX = nil
             end
             EmitRemark( 'PART FALL')
          else
-            EmitZmax( false, true, EMT.R1, EMT.R2)
+            EmitZmax( false, true, EMT.R1, EMT.R2, false, false, false)
             EMT.ZMAX = true
             EmitRemark( 'PART SPLIT 2')
          end
@@ -590,6 +590,10 @@ function OnPathEnd()
    if not EMT.ZMAX then
       EmitResetMachining()
    end
+
+   -- salvo dati precedenti
+   EMT.L2pp = EMT.L2o
+
    EMT.AUXTYPE = nil
    EMT.UNL = nil
    EMT.PREROT = nil
@@ -949,11 +953,11 @@ function OnRapid()
                -- 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)
+               EmitZmax( false, false, PrevR1, PrevR2, false, false, true)
                EMT.TCPOS = sBckTcPos
                EMT.R3_CHANGED = nil
             else
-               EmitZmax( false, false, PrevR1, PrevR2)
+               EmitZmax( false, false, PrevR1, PrevR2, false, false, true)
             end
             EMT.ZMAX = true
             EMT.TO_ZMAX = nil
@@ -1338,7 +1342,7 @@ function OnRapid()
       -- porto in home la testa corrente se lavorazione successiva sopra con testa diversa oppure se punta lunga
       local nNextTopHSet = GetNextTopHSet( EMT.MCHID)
       local bTopGoHome = ( nHSet ~= 2 and nNextTopHSet ~= 0 and nHSet ~= nNextTopHSet) or ( nHSet == 1 and EMT.TTOTLEN > LongTool)
-      EmitZmax( true, true, EMT.R1p, EMT.R2p, bSplitCut, bTopGoHome)
+      EmitZmax( true, true, EMT.R1p, EMT.R2p, bSplitCut, bTopGoHome, false)
       -- aggiorno quota finale trave dopo Zmax
       EMT.L1o = EMT.TPOS
       EMT.ZMAX = true
@@ -2350,11 +2354,12 @@ function GetHeadToolCode()
 end
 
 ---------------------------------------------------------------------
-function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome)
+function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome, bUsePrevDelta)
    if bReset then
       EmitResetMachining()
    end
    local nSetHead = GetHeadSet( EMT.HEAD)
+   local dXPos = EgtIf( bUsePrevDelta, EMT.L2pp or EMT.L2o, EMT.L2o)
    -- se testa 1
    if nSetHead == 1 then
       -- posizioni sicure
@@ -2375,12 +2380,12 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome)
             local dZref = dHomeZ1 + GetZExtra( EMT.HEAD, PrevR2)
             dZref = min( dZref, dMaxZ1)
             local MovH = { Z = EgtIf( dZref > EMT.L3o, dZref, EMT.L3o)}
-            MovH.X = -EMT.L2o ; MovH.B = EgtClamp( PrevR2, -90, 90) ;  MovH.C = PrevR1 ;
+            MovH.X = -dXPos ; MovH.B = EgtClamp( PrevR2, -90, 90) ;  MovH.C = PrevR1 ;
             EmitMoveDataHead( 1, MovH)
             if ( EMT.HEAD == 'H12' or EMT.HEAD == 'H16') and ( abs( dHomeC1 - PrevR1) > 30.1 or abs( dHomeB1 - PrevR2) > 30.1) then
                EmitMoveDataHead( 1, { Z=dMaxZ1, B=0, Fmt=1})
             end
-            if EgtIf( BD.RIGHT_LOAD, ( EMT.L2 > -DeltaTabY), ( EMT.L2 < -DeltaTabY)) then
+            if EgtIf( BD.RIGHT_LOAD, ( -dXPos > -DeltaTabY), ( -dXPos < -DeltaTabY)) then
                EmitMoveDataHead( 1, { X=-DeltaTabY, Fmt=1})
             end
             EmitMoveDataHead( 1, { C=dHomeC1, Fmt=1})
@@ -2426,8 +2431,8 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome)
       else
          EmitMoveDataHead( 2, { X=dHomeX2, Fmt=1})
       end
-      -- solo se è macchina a 3 teste, devo stare più alto
-      if EgtGetHeadId( 'H31') then
+      -- solo se è macchina a 3 teste con gruppo truciolatore 4 assi, devo stare più alto
+      if EgtGetHeadId( 'H39') then
          EmitMoveDataHead( 2, { Z=-ParkInLavZ2, Fmt=1})
       end
       EmitMoveStartHead( 2)

Common_PF1250.mlpe

@@ -106,7 +106,7 @@ function OnSimulStart()
    AddToCollisionCheck( 'X2', 'COLLISION', EMT.COLLOBJ)
    AddToCollisionCheck( 'C2', 'COLLISION', EMT.COLLOBJ)
    AddToCollisionCheck( 'B2', 'COLLISION', EMT.COLLOBJ)
-   if EgtGetHeadId('H31') then
+   if IsHeadExisting( 3) then
       AddToCollisionCheck( 'Z3', 'COLLISION', EMT.COLLOBJ)
       AddToCollisionCheck( 'C3', 'COLLISION', EMT.COLLOBJ)
       AddToCollisionCheck( 'B3', 'COLLISION', EMT.COLLOBJ)
@@ -129,7 +129,7 @@ function OnSimulStart()
                      { Grp = 'Z2', Sub = 'COLLISION', Name = 'COL2'},
                      { Grp = 'X1', Sub = 'COLLISION', Name = 'STM'}}
    
-   if EgtGetHeadId('H31') then
+   if IsHeadExisting( 3) then
       table.insert( McdData, { Grp = 'X3', Sub = 'COLLISION', Name = 'STM'})
    end
 
@@ -456,7 +456,7 @@ function OnSimulToolSelect( dPosA)
    -- se fresa o lama su testa 1, reset assi rotanti
    if nSetHead == 1 then
       -- se ho la testa 3, la mando a parcheggio
-      if EgtGetHeadId( 'H31') then
+      if IsHeadExisting( 3) then
          EgtSetAxisPos( 'X3', ParkX3)
       end
       if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' then
@@ -562,12 +562,12 @@ function OnSimulToolDeselect( dPrevA)
          local nPrevTc = GetTcForTopHeadTool( EMT.PREVTCPOS_H1)
          if EMT.PREVTTOTLEN_H1 < LongTool then
             SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
-            local dPosX = EgtIf( nPrevTc ~= 2, ParkX1, ParkTc2X1)
+            local dPosX = EgtIf( nPrevTc ~= 2, ParkTc1X1, ParkTc2X1)
             SimulMoveAxis( 'X1', dPosX, MCH_SIM_STEP.RAPID)
          else
             if nPrevTc ~= 2 then
                SimulMoveAxes( 'B1', ParkLongB1, MCH_SIM_STEP.RAPROT, 'C1', ParkLongTc1C1, MCH_SIM_STEP.RAPROT)
-               local dPosX = ParkX1
+               local dPosX = ParkTc1X1
                SimulMoveAxis( 'X1', dPosX, MCH_SIM_STEP.RAPID)
             else
                SimulMoveAxes( 'B1', ParkLongB1, MCH_SIM_STEP.RAPROT, 'C1', ParkLongTc2C1, MCH_SIM_STEP.RAPROT)
@@ -579,7 +579,7 @@ function OnSimulToolDeselect( dPrevA)
       elseif EMT.PREVHEAD_H1 == 'H12' then
          -- simulo movimento
          SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
-         SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
+         SimulMoveAxis( 'X1', ParkTc1X1, MCH_SIM_STEP.RAPID)
       -- deposito utensile sega a catena
       elseif EMT.PREVHEAD_H1 == 'H13' then
          -- simulo movimento
@@ -618,14 +618,14 @@ function OnSimulToolDeselect( dPrevA)
    if EMT.NEXTHEAD == 'H11' then
       -- simulo movimento
       SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
-      local dPosX = EgtIf( GetTcForTopHeadTool( EMT.NEXTTCPOS) ~= 2, ParkX1, ParkTc2X1)
+      local dPosX = EgtIf( GetTcForTopHeadTool( EMT.NEXTTCPOS) ~= 2, ParkTc1X1, ParkTc2X1)
       SimulMoveAxis( 'X1', dPosX, MCH_SIM_STEP.RAPID)
       SimulMoveAxis( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID)
    -- prendo utensile lama
    elseif EMT.NEXTHEAD == 'H12' then
       -- simulo movimento
       SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
-      SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
+      SimulMoveAxis( 'X1', ParkTc1X1, MCH_SIM_STEP.RAPID)
    -- prendo utensile sega a catena
    elseif EMT.NEXTHEAD == 'H13' then
       -- simulo movimento
@@ -744,11 +744,19 @@ function OnSimulMachiningStart()
          AddToolToCollisionObj( EMT.PREVTOOL_H2, EMT.PREVHEAD_H2, nPrevExit_H2, nInd_H2, true)
          AddToolHolderToCollisionObj( EMT.PREVTOOL_H2, EMT.PREVHEAD_H2, nPrevExit_H2, nInd_H2 + 1)
       end
-      if nSetHead ~= 3 and EgtGetHeadId( 'H31') then
+      if nSetHead ~= 3 and IsHeadExisting( 3) then
          local nPrevExit_H3 = 1
          local nInd_H3 = 1001
-         AddToolToCollisionObj( nil, 'H31', nPrevExit_H3, 1001)
-         AddToolHolderToCollisionObj( nil, 'H31', nPrevExit_H3, 1002)
+         local sHeadName
+         if EgtGetHeadId( 'H39') then
+            sHeadName = 'H39'
+         elseif EgtGetHeadId( 'H38') then
+            sHeadName = 'H38'
+         else
+            sHeadName = 'H31'
+         end
+         AddToolToCollisionObj( nil, sHeadName, nPrevExit_H3, 1001)
+         AddToolHolderToCollisionObj( nil, sHeadName, nPrevExit_H3, 1002)
       end
    end
    -- se precedente in doppio ma ora solo testa 1 e non in sicurezza
@@ -800,12 +808,12 @@ function OnSimulMachiningEnd()
       EMT.PREVTCPOS_H2 = EMT.TCPOS
       EMT.PREVTTOTLEN_H2 = EMT.TTOTLEN
       EMT.PREVTCPOSREAL_H2 = EMT.TCPOSREAL
-   -- per gruppo testa 3 (resetto dati testa 1)
+   -- per gruppo testa 3 
    else
-      EMT.PREVTOOL_H3 = nil
-      EMT.PREVHEAD_H3 = nil
-      EMT.PREVTCPOS_H3 = nil
-      EMT.PREVTTOTLEN_H3 = nil
+      EMT.PREVTOOL_H3 = EMT.TOOL
+      EMT.PREVHEAD_H3 = EMT.HEAD
+      EMT.PREVTCPOS_H3 = EMT.TCPOS
+      EMT.PREVTTOTLEN_H3 = EMT.TTOTLEN
    end
 
 end
@@ -1022,6 +1030,10 @@ function OnSimulMoveStart()
                end
             end
          else
+            -- solo se è macchina a 3 teste con gruppo truciolatore 4 assi, devo andare prima in Z0
+            if EgtGetHeadId( 'H39') then
+               SimulMoveAxis( 'Z2', Z2Home, MCH_SIM_STEP.RAPID)
+            end
             -- Porto la X alla giusta quota
             if EMT.ZMAX and X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
                SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
@@ -1375,13 +1387,15 @@ end
 function ExecMoveHome( bNearV, bMchSplit)
    -- risalita a Zmax
    ExecMoveZmax( bMchSplit)
-   -- se testa sotto e macchian a 3 teste
-   if GetHeadSet( EMT.HEAD) == 2 and EgtGetHeadId( 'H31') then
+   -- se testa sotto e macchian a 3 teste e gruppo truciolatore a 4 assi
+   if GetHeadSet( EMT.HEAD) == 2 and IsHeadExisting( 3) then
       if not SimulMoveAxis( 'X2', ParkX2, MCH_SIM_STEP.RAPID) then
          EgtOutLog( 'Error on MoveHome : X2')
       end
-      if not SimulMoveAxis( 'Z2', ParkInLavZ2, MCH_SIM_STEP.RAPID) then
-         EgtOutLog( 'Error on MoveHome : X2')
+      if EgtGetHeadId( 'H39') then
+         if not SimulMoveAxis( 'Z2', ParkInLavZ2, MCH_SIM_STEP.RAPID) then
+           EgtOutLog( 'Error on MoveHome : Z2')
+         end
       end
    end
    EMT.TO_ZMAX = nil
@@ -1466,8 +1480,8 @@ function ExecMoveZmax( bMchSplit)
       else
          SimulMoveAxis( 'X2', ParkX2, MCH_SIM_STEP.RAPID)
       end
-      -- solo se è macchina a 3 teste, devo stare più alto
-      if EgtGetHeadId( 'H31') then
+      -- solo se è macchina a 3 teste con gruppo truciolatore 4 assi, devo stare più alto
+      if EgtGetHeadId( 'H39') then
          SimulMoveAxis( 'Z2', ParkInLavZ2, MCH_SIM_STEP.RAPID)
       end
    -- altrimenti testa 3

Common_PF1250.mlse

@@ -895,7 +895,7 @@ function SpecialCalcMachiningEncumbrance( nMchId, bPreCut)
          EgtSetAxisPos( 'A2', vAxMid[6])
       end
       b3Enc = EgtGetBBoxGlob( EgtGetAxisId( 'C2'), GDB_BB.ONLY_VISIBLE)
-   else         -- 'H31'
+   else         -- testa 3
       EgtSetAxisPos( 'C3', vAxMid[4])
       EgtSetAxisPos( 'B3', vAxMid[5])
       b3Enc = EgtGetBBoxGlob( EgtGetAxisId( 'C3'), GDB_BB.ONLY_VISIBLE)

UpdateLog.txt

@@ -1,5 +1,10 @@
            ==== Common_PF1250 Update Log ====
 
+Versione 2.6j2 (23/10/2024)
+- (MLDE-SIM) Aggiunto parametro ParkTc1X1 in MLDE per simulazione quota parcheggio Testa 1 su TC1.
+- (SIM-GEN) Per movimento a ZMAX si considera utensile attuale o precedente
+- (SIM-GEN) Prima versione con gestione testa 3 dedicata lama
+
 Versione 2.6j1 (01/10/2024)
 - (GEN) Migliorato calcolo chiusura paratia rulli con aggiornamento lunghezza della barra in caso di ultimo taglio e grezzo residuo in coda. Ticket#2017
 - (NGE-SIM) Aggiunta gestione solidi collisione per TC verticali e TC rotante sotto

Version.lua

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