Miglioramento gestione lama su aggregato da sotto

- Aggiunto controllo con solido di collisione per verificare di non salire oltre il massimo
- Corretta simulazione scambio testa 3 -> testa 1

Common-PF1250.TPA.mlpe

@@ -40,14 +40,17 @@ 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
-      MyOutput( '('..EMT.INFO..')')
+      MyOutput( sPrefixCommentLine..'('..EMT.INFO..')')
    else
       MyOutput( '(Program Start)')
    end
-   MyOutput( '('.. CSP_INFO..')')
-   MyOutput( '('.. MACHINE_INFO..')')
+   MyOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
+   MyOutput( 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
@@ -163,7 +166,7 @@ function OnDispositionStart()
                    ' P15='..EmtLenToString( -DeltaTabY, 2)..' P16='..EmtLenToString( DeltaTabZ - MillOffs, 2)..
                    ' P17='..EmtLenToString( Delta2TabY, 2)..' P18='..EmtLenToString( -Delta2TabZ - Mill2Offs, 2)
       -- se è in configurazione a 3 teste
-      if EgtGetHeadId( 'H31') then
+      if EgtGetHeadId( 'H31') then 
          sOut = sOut .. ' P19='..EmtLenToString( -Delta3TabY, 2)..' P20='..EmtLenToString( Delta3TabZ - Mill3Offs, 2)..
                         ' P21='..EmtLenToString( Mill3Offs, 2).. ' P22='.. EmtLenToString( -ParkInLavZ2, 2)
       else
@@ -404,10 +407,18 @@ function OnMachiningStart()
    -- se lama su aggregato testa sotto, aggiusto subito angolo scelto per asse virtuale A
    elseif EMT.HEAD == 'H22' then
       -- valore dell'asse virtuale
+      local dPrevA = dPosA
       dPosA = GetCurrSawingVirtualAxis()
       -- imposto home dell'asse C2 (A=0 -> T201, A=90 -> T204)
       local MyParkCSawC2 = GetSawCHomeFromVirtualAxis( dPosA)
       EmtModifyAxisHome( 'C2', MyParkCSawC2)
+      -- se lavorazione attuale e precedente con sega a catena con angolo A diverso, devo scaricare e ricaricare
+      if EMT.HEAD == EMT.PREVHEAD_H2 then
+         if abs( dPosA - dPrevA) > 1 then
+            EMT.TO_ZMAX = true
+            EMT.R3_CHANGED = true
+         end
+      end
    end
 
    -- gestione eventuale lavorazione in doppio
@@ -704,7 +715,12 @@ function OnRapid()
          -- se testa 1
          if nHSet == 1 then
             -- selezione testa (posso muovere X solo a Zmax)
-            local MaxZ1 = EgtGetAxisMax( 'Z1')
+            local MyMaxZ1 = EgtGetAxisMax( 'Z1')
+            -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
+            local bXSpec = EgtIf( BD.RIGHT_LOAD, ( EMT.L2 > -DeltaTabY), ( EMT.L2 < -DeltaTabY))
+            EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
+            EmitMoveStartHead( 1)
+            EmitMoveWaitHead( 1)
             EmitMoveWaitChars( EgtIf( bOnlyCharY, 1, 3))
             -- se necessario allargo le cabine
             if RollerParkingNeeded( EMT.HEAD, PrevR1, PrevR2, EMT.R1, EMT.R2) or
@@ -712,14 +728,12 @@ function OnRapid()
                local dPosT = EMT.TPOS or EMT.L1op
                EmitParkRoller( dPosT, bSplitCut)
             end
-            -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
-            local bXSpec = EgtIf( BD.RIGHT_LOAD, ( EMT.L2 > -DeltaTabY), ( EMT.L2 < -DeltaTabY))
             if ( EMT.HEAD == 'H12' or EMT.HEAD == 'H16') and ( abs( PrevR1 - EMT.R1) > 1 or abs( PrevR2 - EMT.R2) > 1) and ( abs( HomeR1 - EMT.R1) > 30.1 or abs( HomeR2 - EMT.R2) > 30.1) then
                -- se bisogna scrivere tutti gli assi
                if WriteAllCoordsOnFirstM101 then
-                  EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MaxZ1, B=ParkB1, C=ParkC1, S=Speed})
+                  EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, B=ParkB1, C=ParkC1, S=Speed})
                else
-                  EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MaxZ1, S=Speed})
+                  EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
                end
                EmitMoveDataHead( 1, { B=0, S=Speed})
                EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
@@ -799,12 +813,16 @@ function OnRapid()
             -- se bisogna scrivere tutti gli assi
             if WriteAllCoordsOnFirstM101 then
                if EMT.HEAD == 'H22' then
-                  EmitMoveDataHead( 2, { X=MinX2, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed})
+                  EmitMoveDataHead( 2, { X=ParkSawX2, Z=ParkZ2, B=0, C=ParkC2, S=Speed})
                else
                   EmitMoveDataHead( 2, { X=ParkX2, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed})
                end
             else
-               EmitMoveDataHead( 2, { X=ParkX2, S=Speed})
+               if EMT.HEAD == 'H22' then
+                  EmitMoveDataHead( 2, { X=ParkSawX2, S=Speed})
+               else
+                  EmitMoveDataHead( 2, { X=ParkX2, S=Speed})
+               end
             end
             EmitMoveStartHead( 2)
             EmitMoveWaitHead( 2)
@@ -815,8 +833,8 @@ function OnRapid()
                local dPosT = EMT.TPOS or EMT.L1op
                EmitParkRoller( dPosT, bSplitCut)
             end
-            EmitMoveDataHead( 2, { X=EMT.L2, Z=EMT.L3, S=Speed})
             EmitMoveDataHead( 2, { B=EMT.R2, C=EMT.R1, S=Speed})
+            EmitMoveDataHead( 2, { X=EMT.L2, Z=EMT.L3, S=Speed})
             EmitMoveStartHead( 2)
             -- eventuale preselezione successiva testa 1
             PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
@@ -903,7 +921,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
-            EmitZmax( false, false, PrevR1, PrevR2)
+            -- 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)
+               EMT.TCPOS = sBckTcPos
+               EMT.R3_CHANGED = nil
+            else
+               EmitZmax( false, false, PrevR1, PrevR2)
+            end
             EMT.ZMAX = true
             EMT.TO_ZMAX = nil
             PrevR1 = EgtGetAxisHomePos( EgtIf( nHSet == 1, 'C1', 'C2'))
@@ -1063,32 +1092,29 @@ function OnRapid()
             local CurrC2 = PrevR1
             local dSafeZ2 = EgtGetAxisHomePos( 'Z2')
             local Speed = EMT.S * EgtIf( EMT.HEAD ~= 'H22', 1, 1.65)
+            if not EMT.L2p then EMT.L2p = EgtGetAxisHomePos( 'X2') end
             -- calcolo posizione reale
             EMT.TCPOSREAL = 'T' .. AdjustTcPos( false, EMT.TCPOS, EMT.R3)
             -- se utensile cambiato (controllo il reale perchè per aggregato dipende come è stato caricato)
             if EMT.PREVTCPOSREAL_H2 ~= EMT.TCPOSREAL then
-               if EMT.ZMAX then
-                  -- se bisogna scrivere tutti gli assi
-                  if WriteAllCoordsOnFirstM101 then
-                     if EMT.HEAD == 'H22' then
-                        EmitMoveDataHead( 2, { X=MinX2, Z=-CurrZ2, B=CurrB2, C=CurrC2, S=Speed})
-                     else
-                        EmitMoveDataHead( 2, { X=SafeX2, Z=-CurrZ2, B=CurrB2, C=CurrC2, S=Speed})
-                     end
-                  end
-                  EmitMoveDataHead( 2, { Z=-dSafeZ2, S=Speed})
-                  EmitMoveDataHead( 2, { X=EMT.L2, S=Speed})
-               else
-                  -- scrivo solo se gli assi rotanti sono cambiati
-                  if EMT.HEAD == 'H22' and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                     EmitMoveDataHead( 2, { X=EMT.L2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+               -- se bisogna scrivere tutti gli assi
+               if WriteAllCoordsOnFirstM101 then
+                  if EMT.HEAD == 'H22' then
+                     EmitMoveDataHead( 2, { X=ParkSawX2, Z=-dSafeZ2, B=0, C=CurrC2, S=Speed})
+                  else
+                     EmitMoveDataHead( 2, { X=SafeX2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed})
                   end
                end
+               -- scrivo solo se gli assi rotanti sono cambiati
+               EmitMoveDataHead( 2, { Z=-dSafeZ2, S=Speed})
+               if EMT.HEAD ~= 'H22' and EMT.L2p > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                  EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+               end
             -- se stesso utensile vado già alla X di lavoro
             else
                -- scrivo solo se gli assi rotanti sono cambiati
-               if EMT.HEAD == 'H22' and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
-                  EmitMoveDataHead( 2, { X=EMT.L2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+               if EMT.L2p > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                  EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
                end
             end
             -- scrivo solo se gli assi rotanti sono cambiati
@@ -1407,7 +1433,7 @@ end
 function CalcDinamicaPinze( dH, dS, dL)
    local MinTempoAcc = 0.6                         -- [s]
    local MaxTempoAcc = 6.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]
@@ -1432,7 +1458,7 @@ function CalcForzaPinze( dH, dS, dL, dT)
    if dMinJoin < 0.9 * BD.MIN_JOIN_L then
       return MinForzaPinze
    else
-      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 Forza = Massa / MassaRef * MaxForzaPinze
       return EgtClamp( Forza, MinForzaPinze, MaxForzaPinze)
@@ -2121,12 +2147,13 @@ function AdjustTcPos( bLen3, sTcPos, dAxR3)
       if not dAxR3 then dAxR3 = EMT.R3 end
       if abs( dAxR3 - 0) < 0.1 then
          sPos = '201'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '202'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '203'
       elseif abs( dAxR3 - 90) < 0.1 then
          sPos = '204'
+      -- Lama su aggregato da sotto non può essere presa in queste posizioni per problemi di collisione durante parcheggio
+      --elseif abs( dAxR3 - 270) < 0.1 then
+      --   sPos = '202'
+      --elseif abs( dAxR3 - 180) < 0.1 then
+      --   sPos = '203'
       else
          EmtSetLastError( 1210, 'Saw orientation not allowed')
       end
@@ -2296,6 +2323,10 @@ 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
+         EmitMoveDataHead( 2, { Z=-ParkInLavZ2, Fmt=1})
+      end
       EmitMoveStartHead( 2)
       EmitMoveWaitHead( 2)
    -- altrimenti testa 3
@@ -2410,8 +2441,8 @@ function EmitParkRoller( dPosT, bSplitCut)
       local dPosY2 = dPosT + EMT.Y2DELTA
       local DiffY2 = MyParkY2 - dPosY2
       local dMoveY2 = EgtIf( DiffY2 < -0.1, dMoveV2, 0)
-      local dTryMoveY2 = ParkV2 - dPosT - EMT.LT
-      if ( dPosT + EMT.LT < ParkV1 + ExtraParkV and dPosT + EMT.LT > ParkV2 and dPosY2 + dTryMoveY2 > MinY2) then dMoveY2 = min( dMoveY2, dTryMoveY2) end
+      local dTryMoveY2 = ParkV2 - dPosT - EMT.LT - EMT.HOVM
+      if ( dPosT + EMT.LT + EMT.HOVM < ParkV1 + ExtraParkV and dPosT + EMT.LT + EMT.HOVM > ParkV2 and dPosY2 + dTryMoveY2 > MinY2) then dMoveY2 = min( dMoveY2, dTryMoveY2) end
       --MyOutput( string.format( 'PosT=%.3f LT=%.3f PosY2=%.3f V2POS=%.3f', dPosT, EMT.LT, dPosY2, EMT.V2POS))
       MDChar.Y2 = dPosY2 + dMoveY2
       MDChar.MovType = 2

Common-PF1250.mlpe

@@ -120,6 +120,7 @@ function OnSimulStart()
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'COL1'},
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'COL2'},
                      { Grp = 'Base', Sub = 'COLLISION', Name = 'CHSAW'},
+                     { Grp = 'Base', Sub = 'COLLISION', Name = 'CEIL'},
                      { Grp = 'Z2', Sub = 'COLLISION', Name = 'COL1'},
                      { Grp = 'Z2', Sub = 'COLLISION', Name = 'CHAIN'},
                      { Grp = 'Z2', Sub = 'COLLISION', Name = 'COL2'},
@@ -455,6 +456,9 @@ function OnSimulToolSelect( dPosA)
       if EgtGetHeadId( 'H31') then
          EgtSetAxisPos( 'X3', ParkX3)
       end
+      if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' then
+         EgtSetAxisPos( 'Z1', MaxZ1Blade)
+      end
       EgtResetAxisPos( 'C1')
       EgtResetAxisPos( 'B1')
    -- se testa 3 parcheggio la 1
@@ -476,12 +480,14 @@ function OnSimulToolSelect( dPosA)
    end
    -- se lama su aggregato da sotto, imposto subito angolo scelto per asse virtuale A
    if EMT.HEAD == 'H22' then
+      -- se c'era un altro utensile, imposto subito asse virtuale
+      if EMT.PREVHEAD_H2 ~= 'H22' then
+         dPosA = dPosA or GetNextSawingVirtualAxis( EMT.MCHID)      
+      end
       if dPosA then
-         -- valore dell'asse virtuale
-         dPosA = dPosA or GetNextSawingVirtualAxis( EMT.MCHID)
          -- imposto il valore di A
          EgtSetAxisPos( 'A2', dPosA)
-         -- imposto home dell'asse C1 (A2=0 -> T101, A2=90 -> T104)
+         -- imposto home dell'asse C1 (A2=0 -> T201, A2=90 -> T204)
          local MyParkSawC2 = GetSawCHomeFromVirtualAxis( dPosA)
          EmtModifyAxisHome( 'C2', MyParkSawC2)
          EgtSetAxisPos( 'C2', MyParkSawC2)
@@ -520,10 +526,14 @@ function OnSimulToolDeselect( dPrevA)
    if ( EMT.NEXTTOOL == EMT.PREVTOOL_H1 or EMT.NEXTTOOL == EMT.PREVTOOL_H2) and EMT.NEXTHEAD ~= 'H13' and ( EMT.NEXTHEAD ~= 'H22' or not dPrevA) then return end
    -- deposito utensile
    EgtOutText( 'Tool change in progress...')
-   -- recupero il gruppo
-   local nSetHead = GetHeadSet( EMT.NEXTHEAD)
+   -- recupero il gruppo attuale e il successivo
+   local nNextSetHead = GetHeadSet( EMT.NEXTHEAD)
+   local nSetHead = GetHeadSet( EMT.HEAD)
+   -- se devo deselezionare testa 3, la mando a parcheggio
+   if nSetHead == 3 then
+      SimulMoveAxis( 'X3', ParkX3, MCH_SIM_STEP.RAPID)
    -- per testa gruppo 2 
-   if nSetHead == 2 and EMT.PREVTCPOS_H2 then
+   elseif nNextSetHead == 2 then
       -- deposito lama su aggregato testa sotto
       if EMT.PREVHEAD_H2 == 'H22' then
          -- simulo movimento
@@ -542,7 +552,7 @@ function OnSimulToolDeselect( dPrevA)
       -- nascondo l'utensile sulla testa
       EgtSetStatus( EgtGetHeadId( EMT.PREVHEAD_H2 or '') or GDB_ID.NULL, GDB_ST.OFF)
    -- se testa gruppo 1
-   elseif nSetHead == 1 and EMT.PREVTCPOS_H1 then
+   elseif nNextSetHead == 1 and EMT.PREVTCPOS_H1 then
       -- deposito utensile fresa
       if EMT.PREVHEAD_H1 == 'H11' then
          -- simulo movimento
@@ -599,8 +609,6 @@ function OnSimulToolDeselect( dPrevA)
          EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H1 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
       end
       SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
-   elseif nNextSetHead == 1 then
-      SimulMoveAxis( 'X3', ParkX3, MCH_SIM_STEP.RAPID)
    end
    -- movimento per prendere nuovo utensile
    -- prendo utensile fresa
@@ -661,6 +669,10 @@ function OnSimulMachiningStart()
       local dPosA = tonumber( sVal:sub( 4)) or 0
       if abs( dPosA - dPrevA) > 1 then
          ExecParkRoller( nil, nil, nil, nil, false, bAgg)
+         -- setto i valori per la funzione ToolDesel
+         EMT.NEXTHEAD = EMT.HEAD
+         EMT.NEXTTOOL = EMT.TOOL 
+         EMT.NEXTEXIT = EMT.EXIT
          OnSimulToolDeselect( dPrevA)
          EgtSetStatus( EgtGetHeadId( EMT.HEAD), GDB_ST.ON)
          OnSimulToolSelect( dPosA)
@@ -901,6 +913,7 @@ function OnSimulMoveStart()
          local C1Home = EgtGetAxisHomePos( 'C1')
          local Z1Pos = EgtGetAxisPos( 'Z1')
          local Z1Home = EgtGetAxisHomePos( 'Z1')
+         local MyMaxZ1 = EgtGetAxisMax( 'Z1')
          -- se fresa o lama
          if EMT.HEAD ~= 'H13' then
             -- se movimento iniziale da Zmax con lama o fresa
@@ -909,7 +922,7 @@ function OnSimulMoveStart()
                -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
                if ( EMT.HEAD == 'H12' or EMT.HEAD == 'H16') and ( abs( C1Pos - EMT.R1) > 1 or abs( B1Pos - EMT.R2) > 1) and ( abs( C1Home - EMT.R1) > 30.1 or abs( B1Home - EMT.R2) > 30.1) then
                   SimulMoveAxis( 'X1', EgtIf( bXSpec, DeltaTabY, EMT.L2), MCH_SIM_STEP.RAPID)
-                  SimulMoveAxes( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID, 'B1', 0, MCH_SIM_STEP.COLLROT)
+                  SimulMoveAxes( 'Z1', MyMaxZ1, MCH_SIM_STEP.RAPID, 'B1', 0, MCH_SIM_STEP.COLLROT)
                   SimulMoveAxis( 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
                   SimulMoveAxis( 'X1', EMT.L2, MCH_SIM_STEP.RAPID)
                   SimulMoveAxes( 'Z1', EMT.L3, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
@@ -947,26 +960,34 @@ function OnSimulMoveStart()
          local C2Home = EgtGetAxisHomePos( 'C2')
          local Z2Home = EgtGetAxisHomePos( 'Z2')
          local X2Home = EgtGetAxisHomePos( 'X2')
+         local X2Pos = EgtGetAxisPos( 'X2')
+         local B2Pos = EgtGetAxisPos( 'B2')
+         local C2Pos = EgtGetAxisPos( 'C2')
          if EMT.TOOL ~= EMT.PREVTOOL_H2 then
             if EMT.ZMAX then
                -- se bisogna scrivere tutti gli assi
                if WriteAllCoordsOnFirstM101 then
                   if EMT.HEAD == 'H22' and  EMT.PREVHEAD_H2 ~= EMT.HEAD then
-                     SimulMoveAxes( 'X2', MinX2, MCH_SIM_STEP.RAPID, 'B2', B2Home, MCH_SIM_STEP.COLLROT, 'C2', C2Home, MCH_SIM_STEP.COLLROT)
+                     SimulMoveAxes( 'X2', ParkSawX2, MCH_SIM_STEP.RAPID, 'B2', 0, MCH_SIM_STEP.COLLROT, 'C2', C2Home, MCH_SIM_STEP.COLLROT)
                   else
                      SimulMoveAxes( 'X2', SafeX2, MCH_SIM_STEP.RAPID, 'B2', B2Home, MCH_SIM_STEP.COLLROT, 'C2', C2Home, MCH_SIM_STEP.COLLROT)
                   end
                end
                SimulMoveAxis( 'Z2', Z2Home, MCH_SIM_STEP.RAPID)
-               SimulMoveAxis( 'X2', EMT.L2, MCH_SIM_STEP.RAPID)
+               -- Porto la X alla giusta quota
+               if EMT.HEAD ~= 'H22' and X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
+                  SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
+               end
             else
-               if EMT.HEAD == 'H22' then
-                  SimulMoveAxis( 'X2', EMT.L2, MCH_SIM_STEP.RAPID)
+               -- Porto la X alla giusta quota
+               if X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
+                  SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
                end
             end
          else
-            if EMT.HEAD == 'H22' then
-               SimulMoveAxis( 'X2', EMT.L2, MCH_SIM_STEP.RAPID)
+            -- Porto la X alla giusta quota
+            if X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
+               SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
             end
          end
          if EMT.HEAD == 'H22' then
@@ -1022,7 +1043,7 @@ function OnSimulMoveStart()
                EmtSetLastError( 1208, sErr)
             end
             -- se appena sopra inizio, sistemo subito la quota in Z
-            if EMT.MOVE == 0 and EMT.FLAG == 1 then
+            if EMT.MOVE == 0 then
                SimulMoveAxes( 'Z2', EMT.A6, MCH_SIM_STEP.RAPID)
             end
          end
@@ -1313,6 +1334,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
+      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')
+      end
+   end
    EMT.TO_ZMAX = nil
    -- se richiesto, avvicino i rulli
    if bNearV then
@@ -1350,13 +1380,14 @@ function ExecMoveZmax( bMchSplit)
    end
    -- se testa sopra
    if nSetHead == 1 then
+      local MyMaxZ1 = EgtGetAxisMax( 'Z1')
       -- se fresa o lama
       if EMT.HEAD ~= 'H13' then
          if abs( HomeC - CurrC) > 0.1 or abs( HomeB - CurrB) > 0.1 then
             local dZref = HomeZ + GetZExtra( EMT.HEAD, CurrB)
             SimulMoveAxes( 'Z1', EgtIf( dZref > CurrZ, dZref, CurrZ), MCH_SIM_STEP.RAPID, 'B1', EgtClamp( CurrB, -90, 90), MCH_SIM_STEP.COLLROT)
             if ( EMT.HEAD == 'H12' or EMT.HEAD == 'H16') and ( abs( HomeC - CurrC) > 30.1 or abs( HomeB - CurrB) > 30.1) then
-               SimulMoveAxes( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID, 'B1', 0, MCH_SIM_STEP.COLLROT)
+               SimulMoveAxes( 'Z1', MyMaxZ1, MCH_SIM_STEP.RAPID, 'B1', 0, MCH_SIM_STEP.COLLROT)
             end
             if  ( not BD.RIGHT_LOAD and EMT.L2 > DeltaTabY) or ( BD.RIGHT_LOAD and EMT.L2 < DeltaTabY) then
                SimulMoveAxis( 'X1', DeltaTabY, MCH_SIM_STEP.RAPID)
@@ -1364,7 +1395,7 @@ function ExecMoveZmax( bMchSplit)
             SimulMoveAxis( 'C1', HomeC, MCH_SIM_STEP.COLLROT)
             SimulMoveAxis( 'B1', HomeB, MCH_SIM_STEP.COLLROT)
          end
-         SimulMoveAxis( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID)
+         SimulMoveAxis( 'Z1', MyMaxZ1, MCH_SIM_STEP.RAPID)
       -- altrimenti sega a catena
       else
          -- salgo in Z sicurezza raddrizzando la B
@@ -1394,6 +1425,10 @@ 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
+         SimulMoveAxis( 'Z2', ParkInLavZ2, MCH_SIM_STEP.RAPID)
+      end
    -- altrimenti testa 3
    else
       SimulMoveAxes( 'Z3', MaxZ3, MCH_SIM_STEP.RAPID)
@@ -1866,6 +1901,19 @@ function LoadFirstTool( nHSet, sTcPosDef)
       -- carico l'utensile
       EgtLoadTool( sHead, 1, sTool)
       ShowToolInTcPos( sTcPos, false)
+      -- salvo utensili caricati
+      if nHSet == 1 then
+         EMT.PREVTOOL_H1 = sTool
+         EMT.PREVHEAD_H1 = sHead
+         EMT.PREVTCPOS_H1 = sTcPos
+         EMT.PREVTTOTLEN_H1 = sTTotLen
+      -- per gruppo testa 2
+      elseif nHSet == 2 then
+         EMT.PREVTOOL_H2 = sTool
+         EMT.PREVHEAD_H2 = sHead
+         EMT.PREVTCPOS_H2 = sTcPos
+         EMT.PREVTTOTLEN_H2 = sTTotLen
+      end
    end
    return sTool
 end
@@ -2289,8 +2337,13 @@ function FindFirstToolOnHeadSet( nHSet)
             if EgtTdbSetCurrTool( sTest) then
                sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
                if GetHeadSet( sHead) == nHSet then
-                  sTool = sTest
                   sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+                  -- aggregato lama non si può mai preselezionare e viene sempre scaricato, quindi non sarà mai già caricato
+                  if nHSet == 2 and sTcPos == 'T201' then
+                     sTcPos = nil
+                     break
+                  end
+                  sTool = sTest
                   sTTotLen = EgtTdbGetCurrToolParam( MCH_TP.TOTLEN)
                   sBlockedAxis = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
                   break

Common-PF1250.mlse

@@ -71,14 +71,14 @@ function OnSpecialGetMaxZ()
    elseif EMC.HEAD == 'H12' then
       if vtTp:getX() > 0.3 and vtT:getX() > 0.3 then
          if bBSameSign and abs( EMC.R1 - EMC.R1p) < 165 then
-            EMC.MAXZ = MaxZ1 - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
+            EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
          elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
             EMC.MAXZ = ParkZ1 + 200
          else
             EMC.MAXZ = ParkZ1 + 1
          end
       elseif bBSameSign and EMC.R1p > 29.9 and EMC.R1p < 180.1 and EMC.R1 > 29.9 and EMC.R1 < 180.1 and EMC.R2p > -10 and EMC.R2 > -10 then
-         EMC.MAXZ = MaxZ1 - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
+         EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
       elseif bBSameSign and EMC.R1p > -0.1 and EMC.R1p < 180.1 and EMC.R1 > -0.1 and EMC.R1 < 180.1 and EMC.R2p > -10 and EMC.R2 > -10 then
          local vMZ = {{ Tz=0.85, Ez=440}, { Tz=0.5, Ez=200}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
          EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
@@ -89,14 +89,14 @@ function OnSpecialGetMaxZ()
    elseif EMC.HEAD == 'H16' then
       if vtTp:getX() > 0.3 and vtT:getX() > 0.3 then
          if bBSameSign and abs( EMC.R1 - EMC.R1p) < 165 then
-            EMC.MAXZ = MaxZ1 - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
+            EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
          elseif vtTp:getZ() > 0.707 or vtT:getZ() > 0.707 then
             EMC.MAXZ = ParkZ1 + 200
          else
             EMC.MAXZ = ParkZ1 + 1
          end
       elseif bBSameSign and EMC.R1p > 29.9 and EMC.R1p < 180.1 and EMC.R1 > 29.9 and EMC.R1 < 180.1 and EMC.R2p > -10 and EMC.R2 > -10 then
-         EMC.MAXZ = MaxZ1 - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
+         EMC.MAXZ = MaxZ1Blade - EgtIf( abs( EMC.R2) < 90.1 and abs( EMC.R2p) < 90.1, 0, 130)
       elseif bBSameSign and EMC.R1p > -0.1 and EMC.R1p < 180.1 and EMC.R1 > -0.1 and EMC.R1 < 180.1 and EMC.R2p > -10 and EMC.R2 > -10 then
          local vMZ = {{ Tz=0.85, Ez=440}, { Tz=0.5, Ez=200}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
          EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)

UpdateLog.txt

@@ -1,9 +1,32 @@
            ==== Common_PF1250 Update Log ====
 
+Versione 2.6e4 (15/05/2024)
+- (SIM-GEN) Miglioramento gestione lama su aggregato da sotto
+
+Versione 2.6e3 (09/05/2024)
+- (SIM) Corretto prelievo lama 2 (H16). Prima di visualizzare utensile, si sposta la Z alla quota massima. Prima trovava collisione in caso utensile precedente non lama (perchè era già oltre la quota massima).
+
+Versione 2.6e2 (06/05/2024)
+- (GEN) In parcheggio paratie/pinze, viene considerato sovramateriale di testa. Simulazione era corretta. Ticket#1789
+
+Versione 2.6e1 (30/04/2024)
+- (SIM-GEN) Per macchina a 3 teste, ripristinato posizionamento testa 2 tramite parametro ParkInLavZ2. La gestione era stata persa dal common.
+- (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 (23/04/2024)
+- (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
+- (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)
+- (SIM-GEN) Modificato movimenti testa sotto. Prima si muove in quota 'ParkMchY2' e poi va alla coordinata di lavoro ruotando gli assi
+- (SIM) Per lavorazioni in doppio, viene subito scritta la quota Z. La generazione era già corretta. Ticket#1377
+- (GEN) Ripristinato movimento iniziale testa sopra assieme alle pinze. Spostato comando wait dopo primo movimento testa. Ticket#1730
+- (MLDE-SIM-GEN) Aggiunto parametro MaxZ1Blade per differenziare Z massima aggregato lama e altri utensili.
+- (SIM) Aggiunto controllo con solido di collisione per verificare di non salire oltre il massimo
+- (SIM) Corretta simulazione scambio testa 3 -> testa 1
+
 Versione 2.6d1 (09/04/2024)
 - (GEN) Corretto impostazione piano G24 con testa da sotto con aggregato
 - (SIM-GEN) Corretta posizione prelievo/parcheggio se lama su aggregato da sotto
-- (MLDE-SIM-GEN) Aggiunta variabile FACOLTATIVA 'ForceToCloseRollersGate' ( che legge la variabile da TS3 'CHIUDI_RULLI_SCAMBIO') in mlde per forzare chiusura paratie rulli
+- (MLDE-SIM-GEN) Aggiunta variabile FACOLTATIVA 'ForceToCloseRollersGate' ( che legge la variabile da TS3 'CHIUDI_PINZE_2_3_SCAMBIO') in mlde per forzare chiusura paratie rulli
                  durante scambio pinze per facilitare passaggio pezzi molto storti. Se non presente chiude solo se necessario.
 - (GEN) Corretta scrittura lista utensili iniziale M992 per doppia motosega e aggregato lama sotto
 - (SIM-GEN) Corretto movimento punte lunghe

Version.lua

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