In parcheggio paratie/pinze, viene considerato sovramateriale di testa

- 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

@@ -6,7 +6,7 @@ local BD = require( 'BeamData')
 
 -- 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
 
@@ -40,14 +40,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
-      EmitRemark( EMT.INFO)
+      MyOutput( sPrefixCommentLine..'('..EMT.INFO..')')
    else
-      EmitRemark( 'Program Start')
+      MyOutput( '(Program Start)')
    end
-   EmitRemark( CSP_INFO)
-   EmitRemark( 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
       MyOutput( 'M199')
@@ -105,8 +109,20 @@ end
 
 ---------------------------------------------------------------------
 function OnToolData()
-   -- emissione dati utensile (esclusa sega a catena)
-   if EMT.HEAD ~= 'H13' then
+   -- emissione dati utensile
+   -- lama su aggregato da sotto
+   if EMT.HEAD == 'H22' then
+      -- recupero posizione lama
+      local dPosBase = tonumber( AdjustTcPos( false, EMT.TCPOS, 0))
+      dAddLen = SawUnderOffsZ
+      local sData = ' P2=' .. EmtLenToString( dAddLen + EMT.TLEN, 3) .. ' P3=' .. EmtLenToString( EMT.TDIAM, 3) ..
+                   ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( dAddLen + EMT.TTOTLEN, 3)
+      MyOutput( 'M992 P1='..tostring( dPosBase).. sData)
+      MyOutput( 'M992 P1='..tostring( dPosBase+1).. sData)
+      MyOutput( 'M992 P1='..tostring( dPosBase+2).. sData)
+      MyOutput( 'M992 P1='..tostring( dPosBase+3).. sData)
+   -- altri utensili tranne sega a catena
+   elseif EMT.HEAD ~= 'H13' then
       local dAddLen = 0
       if EMT.HEAD == 'H12' then
          dAddLen = -SawOffsZ
@@ -118,13 +134,15 @@ function OnToolData()
       MyOutput( sOut)
    -- emissione dati sega a catena
    else
+      -- recupero posizione motosega
+      local dPosBase = tonumber( AdjustTcPos( false, EMT.TCPOS, 0))
       if EMT.TDIST and abs( EMT.TDIST) < 0.1 then EMT.TDIST = nil end
       local sData = ' P2=' .. EmtLenToString( ( EMT.TDIST or ChSawLen), 3) .. ' P3=' .. EmtLenToString( EMT.TLEN, 3) ..
                     ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( ( EMT.TDIST or ChSawLen), 3)
-      MyOutput( 'M992 P1=101' .. sData)
-      MyOutput( 'M992 P1=102' .. sData)
-      MyOutput( 'M992 P1=103' .. sData)
-      MyOutput( 'M992 P1=104' .. sData)
+      MyOutput( 'M992 P1='..tostring( dPosBase).. sData)
+      MyOutput( 'M992 P1='..tostring( dPosBase+1).. sData)
+      MyOutput( 'M992 P1='..tostring( dPosBase+2).. sData)
+      MyOutput( 'M992 P1='..tostring( dPosBase+3).. sData)
    end
 end
 
@@ -148,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
@@ -367,20 +385,6 @@ function OnToolSelect()
       if MCH_TP.DIST then EMT.TDIST = EgtTdbGetCurrToolParam( MCH_TP.DIST) end
       if EMT.TDIST and abs( EMT.TDIST) < 0.1 then EMT.TDIST = nil end
       EMT.TUSERNOTES = EgtTdbGetCurrToolParam( MCH_TP.USERNOTES)
-         -- salvo dati utensile
-      local nSetHead = GetHeadSet( EMT.HEAD)
-      -- per gruppo testa 1
-      if nSetHead == 1 then
-         EMT.PREVTOOL_H1 = EMT.TOOL
-         EMT.PREVHEAD_H1 = EMT.HEAD
-         EMT.PREVTCPOS_H1 = EMT.TCPOS
-      -- per gruppo testa 2
-      elseif nSetHead == 2 then
-         EMT.PREVTOOL_H2 = EMT.TOOL
-         EMT.PREVHEAD_H2 = EMT.HEAD
-         EMT.PREVTCPOS_H2 = EMT.TCPOS
-      end
-
    end
 end
 
@@ -521,6 +525,22 @@ function OnMachiningEnd()
    EMT.PREVTOOL = EMT.TOOL
    if EMT.DOU_TYPE and not EMT.ZMAX then EMT.DOU_TO_ZMAX = EMT.DOU_TYPE end
    EMT.DOU_TYPE = nil
+
+   -- salvo dati utensile
+   local nSetHead = GetHeadSet( EMT.HEAD)
+   -- per gruppo testa 1
+   if nSetHead == 1 then
+      EMT.PREVTOOL_H1 = EMT.TOOL
+      EMT.PREVHEAD_H1 = EMT.HEAD
+      EMT.PREVTCPOS_H1 = EMT.TCPOS
+      --EMT.PREVTCPOSREAL_H1 = EMT.TCPOSREAL
+   -- per gruppo testa 2
+   elseif nSetHead == 2 then
+      EMT.PREVTOOL_H2 = EMT.TOOL
+      EMT.PREVHEAD_H2 = EMT.HEAD
+      EMT.PREVTCPOS_H2 = EMT.TCPOS
+      --EMT.PREVTCPOSREAL_H2 = EMT.TCPOSREAL
+   end
 end
 
 ---------------------------------------------------------------------
@@ -665,7 +685,7 @@ function OnRapid()
          EMT.V2POS = ParkV2
          -- primo posizionamento
          local Speed = EMT.S
-         if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' then Speed = 1.65 * EMT.S end
+         if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' or EMT.HEAD == 'H22' then Speed = 1.65 * EMT.S end
          local bOnlyCharY = true
          for i = 1, #EMT.AUXCMD do
             ProcessPathStartAux( EMT.AUXCMD[i], i)
@@ -687,7 +707,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
@@ -695,14 +720,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
             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
-               local bXSpec = EgtIf( BD.RIGHT_LOAD, ( EMT.L2 > -DeltaTabY), ( EMT.L2 < -DeltaTabY))
                -- 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})
@@ -717,7 +740,12 @@ function OnRapid()
                      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})
+                     -- utensili lunghi
+                     if EMT.TTOTLEN > LongTool then
+                        EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=EMT.L3, B=ParkLongB1, C=ParkLongTc1C1, S=Speed})
+                     else
+                        EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=EMT.L3, B=ParkB1, C=ParkC1, S=Speed})
+                     end
                   end
                end
                if EMT.HEAD ~= 'H13' then 
@@ -776,7 +804,11 @@ function OnRapid()
             -- selezione testa (non posso muovere X)
             -- se bisogna scrivere tutti gli assi
             if WriteAllCoordsOnFirstM101 then
-               EmitMoveDataHead( 2, { X=ParkX2, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed})
+               if EMT.HEAD == 'H22' then
+                  EmitMoveDataHead( 2, { X=MinX2, Z=ParkZ2, B=ParkB2, 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})
             end
@@ -1036,16 +1068,44 @@ function OnRapid()
             local CurrB2 = PrevR2
             local CurrC2 = PrevR1
             local dSafeZ2 = EgtGetAxisHomePos( 'Z2')
-            local Speed = EMT.S
-            if EMT.ZMAX then
-               -- se bisogna scrivere tutti gli assi
-               if WriteAllCoordsOnFirstM101 then
-                  EmitMoveDataHead( 2, { X=SafeX2, Z=CurrZ2, B=CurrB2, C=CurrC2, S=Speed})
+            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
+                  -- scrivo solo se gli assi rotanti sono cambiati
+                  EmitMoveDataHead( 2, { Z=-dSafeZ2, 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
+               else
+                  -- scrivo solo se gli assi rotanti sono cambiati
+                  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
+            -- se stesso utensile vado già alla X di lavoro
+            else
+               -- scrivo solo se gli assi rotanti sono cambiati
+               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
-               EmitMoveDataHead( 2, { Z=-dSafeZ2, S=Speed})
-               EmitMoveDataHead( 2, { X=EMT.L2, S=Speed})
             end
-            EmitMoveDataHead( 2, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})
+            -- scrivo solo se gli assi rotanti sono cambiati
+            if EMT.HEAD == 'H22' and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+               EmitMoveDataHead( 2, { B=EMT.R2, C=EMT.R1, S=Speed})
+            end    
+            EmitMoveDataHead( 2, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})            
             EmitMoveStartHead( 2)
             -- eventuale preselezione successiva testa 1
             PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
@@ -1130,7 +1190,7 @@ function OnRapid()
             EMT.L2 = -EMT.L2
             -- emetto movimenti in Zero macchina
             local Speed = EMT.S
-            if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' then Speed = 1.65 * EMT.S end
+            if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' or EMT.HEAD == 'H22' then Speed = 1.65 * EMT.S end
             EmitMoveDataHead( 1, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})
             EmitMoveStartHead( 1)
             local dX2 = Delta2TabY + EMT.DOU_TLEN - ( -DeltaTabY - EMT.L2 + EMT.TLEN + EgtIf( BD.RIGHT_LOAD, -EMT.HB, EMT.HB))
@@ -1150,7 +1210,7 @@ function OnRapid()
             EMT.L2 = -EMT.L2
             -- emetto movimenti in Zero macchina
             local Speed = EMT.S
-            if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' then Speed = 1.65 * EMT.S end
+            if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' or EMT.HEAD == 'H22' then Speed = 1.65 * EMT.S end
             EmitMoveDataHead( 1, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})
             EmitMoveStartHead( 1)
             local dX2 = -Head2Y - EMT.L2
@@ -1204,9 +1264,9 @@ function OnRapid()
       EmtAdjustRotaryAxes()
       -- se Split lascio agganciata solo la pinza Y2 alla fine dei movimenti
       local bSplitCut = ( EMT.MCHUSERNOTES:find( 'Split', 1, true) ~= nil)
-      -- se lavorazione successiva sopra con testa diversa, porto in home la testa corrente
+      -- 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)
+      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)
       -- aggiorno quota finale trave dopo Zmax
       EMT.L1o = EMT.TPOS
@@ -1357,7 +1417,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]
@@ -1382,7 +1442,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)
@@ -1989,7 +2049,7 @@ function MyAdjustLinearAxes()
       elseif nHSet == 2 then
          local dAddLen = 0
          if EMT.HEAD == 'H22' then
-            dAddLen = -Saw2OffsZ
+            dAddLen = SawUnderOffsZ
          end
          local Len = EMT.TLEN + dAddLen + Mill2Offs
          local LenRef = Mill2Offs
@@ -2081,7 +2141,6 @@ function AdjustTcPos( bLen3, sTcPos, dAxR3)
          EmtSetLastError( 1210, 'Saw orientation not allowed')
       end
    end
-
    return sPos
 end
 
@@ -2116,7 +2175,8 @@ function CalcInterpPlane()
    local vtX = EMT.IPLGLFR:getVersX()
    local vtY = EMT.IPLGLFR:getVersY()
    local vtZ = EMT.IPLGLFR:getVersZ()
-   if EMT.HEAD ~= 'H21' then
+   local nHSet = GetHeadSet( EMT.HEAD)
+   if nHSet ~= 2 then
       EMT.IPLGLSTR = ' X0 Y' .. EmtLenToString( xS, EMT.DECNUM) .. ' Z0' ..
                      ' A' .. EgtNumToString( -vtX:getY(), 6) .. ' B' .. EgtNumToString( vtX:getX(), 6) .. ' C' .. EgtNumToString( vtX:getZ(), 6) ..
                      ' I' .. EgtNumToString( -vtY:getY(), 6) .. ' J' .. EgtNumToString( vtY:getX(), 6) .. ' K' .. EgtNumToString( vtY:getZ(), 6) ..
@@ -2223,16 +2283,11 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome)
          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) !!!
-            EmitMoveDataHead( 1, { X=-ParkX1, TPos=50, Fmt=1})
-         end
          EmitMoveStartHead( 1)
          EmitMoveWaitHead( 1)
       end
    -- se altrimenti testa 2
    elseif nSetHead == 2 then
-
       -- posizioni sicure
       local dHomeX2 = EgtGetAxisHomePos( 'X2')
       local dHomeZ2 = EgtGetAxisHomePos( 'Z2')
@@ -2246,7 +2301,15 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome)
       -- eseguo la discesa a Z2max
       EmitMoveDataHead( 2, { Z=-dHomeZ2, Fmt=1})
       EmitMoveDataHead( 2, { B=dHomeB2, C=dHomeC2, Fmt=1})
-      EmitMoveDataHead( 2, { X=dHomeX2, Fmt=1})
+      if EMT.HEAD == 'H22' then
+         EmitMoveDataHead( 2, { X=SafeX2, Fmt=1})
+      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
@@ -2361,8 +2424,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
@@ -2438,8 +2501,8 @@ function PreselectNextDiffHead( nMchId, sHead)
                   -- se la Z di lavoro è più bassa del cambio della minima Z
                   if EMT.MAXMIN[3] < MinZ1ToChangeH2 then
                      -- verifico quota del TC
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 400) then return end
-                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + 400) then return end
+                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
+                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + 200) then return end
                   end
                -- se preselezione testa 3
                else
@@ -2458,14 +2521,14 @@ function PreselectNextDiffHead( nMchId, sHead)
                      -- altrimenti se operazione su stesso TC
                      else
                         -- TC su montante destro oppure non so cosa c'è montato
-                        if nNextTc == 1  or nPrevTc ~= 0 then
-                           if BD.RIGHT_LOAD and EMT.MAXMIN[2] < ( Delta2TabY - 400) then return end
-                           if not BD.RIGHT_LOAD and EMT.MAXMIN[2] < ( Delta2TabY - MaxHoOpen - 400) then return end
+                        if nNextTc == 1  or nPrevTc == 0 then
+                           if BD.RIGHT_LOAD and EMT.MAXMIN[2] < ( Delta2TabY - 200) then return end
+                           if not BD.RIGHT_LOAD and EMT.MAXMIN[2] < ( Delta2TabY - MaxHoOpen - 200) then return end
                         end
                         -- TC su montante sinistro oppure non so cosa c'è montato
-                        if nNextTc == 2  or nPrevTc ~= 0 then
-                           if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( Delta2TabY + MaxHoOpen + 400) then return end
-                           if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( Delta2TabY + 400) then return end
+                        if nNextTc == 2  or nPrevTc == 0 then
+                           if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( Delta2TabY + MaxHoOpen + 200) then return end
+                           if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( Delta2TabY + 200) then return end
                         end
                      end
                   end
@@ -2481,7 +2544,7 @@ function PreselectNextDiffHead( nMchId, sHead)
                   if nPrevTc == 1 then return
                   -- TC su montante sinistro
                   else
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 400) then return end
+                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
                      if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
                   end
                -- se preselezione testa 2
@@ -2490,7 +2553,7 @@ function PreselectNextDiffHead( nMchId, sHead)
                   if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then return end
                   -- se la Z di lavoro è più bassa del cambio utensili, verifico quota X (la nostra Y)
                   if EMT.MAXMIN[3] < MinZ1ToChangeH2 then
-                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 400) then return end
+                     if BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + MaxHoOpen + 200) then return end
                      if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
                   end
                end
@@ -2599,8 +2662,18 @@ end
 ---------------------------------------------------------------------
 function EmitMoveDataHead( nHead, MoData)
    local sOut = 'M101'
-   if nHead == 2 then
+   local sRealTcPos
+
+   if EMT.TCPOS then
+      sRealTcPos = AdjustTcPos( false)
+   end
+      
+   if nHead == 1 then
+      sOut = 'M101'
+      EMT.PREVTCPOSREAL_H1 = 'T' .. sRealTcPos
+   elseif nHead == 2 then
       sOut = 'M102'
+      EMT.PREVTCPOSREAL_H2 = 'T' .. sRealTcPos
    elseif nHead == 3 then
       sOut = 'M103'
    end
@@ -2609,7 +2682,7 @@ function EmitMoveDataHead( nHead, MoData)
    if MoData.Z then sOut = sOut .. ' P3=' .. EmtLenToString( MoData.Z, 3) end
    if MoData.B then sOut = sOut .. ' P4=' .. EmtLenToString( MoData.B, 3) end
    if MoData.C then sOut = sOut .. ' P5=' .. EmtLenToString( MoData.C, 3) end
-   if MoData.TPos then sOut = sOut .. ' P6=' .. MoData.TPos elseif EMT.TCPOS then sOut = sOut .. ' P6=' .. AdjustTcPos( false) end
+   if MoData.TPos then sOut = sOut .. ' P6=' .. MoData.TPos elseif EMT.TCPOS then sOut = sOut .. ' P6=' .. sRealTcPos end
    if MoData.S then sOut = sOut .. ' P7=' .. EgtNumToString( MoData.S, 0) end
    if not MoData.Fmt then 
       if MoData.F then sOut = sOut .. ' P8=' .. EmtLenToString( MoData.F, 0) else sOut = sOut .. ' P8=0' end

Common-PF1250.mlpe

@@ -120,12 +120,13 @@ 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'}}
+                     { Grp = 'Z2', Sub = 'COLLISION', Name = 'COL2'},
+                     { Grp = 'X1', Sub = 'COLLISION', Name = 'STM'}}
    
    if EgtGetHeadId('H31') then
-      table.insert( McdData, { Grp = 'X1', Sub = 'COLLISION', Name = 'STM'})
       table.insert( McdData, { Grp = 'X3', Sub = 'COLLISION', Name = 'STM'})
    end
 
@@ -455,6 +456,9 @@ function OnSimulToolSelect( dPosA)
       if EgtGetHeadId( 'H31') then
          EgtSetAxisPos( 'X3', ParkX3)
       end
+      if EMT.HEAD == 'H12' then
+         EgtSetAxisPos( 'Z1', MaxZ1Blade)
+      end
       EgtResetAxisPos( 'C1')
       EgtResetAxisPos( 'B1')
    -- se testa 3 parcheggio la 1
@@ -476,16 +480,18 @@ function OnSimulToolSelect( dPosA)
    end
    -- se lama su aggregato da sotto, imposto subito angolo scelto per asse virtuale A
    if EMT.HEAD == 'H22' 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)
-      local MyParkSawC2 = GetSawCHomeFromVirtualAxis( dPosA)
-      EmtModifyAxisHome( 'C2', MyParkSawC2)
-      EgtSetAxisPos( 'C2', MyParkSawC2)
-      -- Imposto visualizzazione
-      EgtSetMode( EgtGetHeadId( EMT.HEAD) or GDB_ID.NULL, GDB_MD.STD)
+      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)
+         local MyParkSawC2 = GetSawCHomeFromVirtualAxis( dPosA)
+         EmtModifyAxisHome( 'C2', MyParkSawC2)
+         EgtSetAxisPos( 'C2', MyParkSawC2)
+         -- Imposto visualizzazione
+         EgtSetMode( EgtGetHeadId( EMT.HEAD) or GDB_ID.NULL, GDB_MD.STD)
+      end
    end
    -- carico utensile, con breve pausa
    EgtPause( 100)
@@ -514,14 +520,18 @@ end
 
 ---------------------------------------------------------------------
 function OnSimulToolDeselect( dPrevA)
-   -- se prossimo utensile non cambia e non è sega a catena, esco
-   if ( EMT.NEXTTOOL == EMT.PREVTOOL_H1 or EMT.NEXTTOOL == EMT.PREVTOOL_H2) and EMT.NEXTHEAD ~= 'H13' and EMT.NEXTHEAD ~= 'H22' then return end
+   -- se prossimo utensile non cambia e non è sega a catena o lama su rinvio da sotto, esco
+   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 and EMT.PREVTCPOS_H2 then
       -- deposito lama su aggregato testa sotto
       if EMT.PREVHEAD_H2 == 'H22' then
          -- simulo movimento
@@ -529,6 +539,7 @@ function OnSimulToolDeselect( dPrevA)
          if dPrevA then
             ParkC2 = GetSawCHomeFromVirtualAxis( dPrevA)
          end
+         SimulMoveAxis( 'Z2', MinZ2, MCH_SIM_STEP.RAPID)
          SimulMoveAxis( 'X2', ParkSawX2, MCH_SIM_STEP.RAPID)
          SimulMoveAxes( 'B2', ParkSawB2, MCH_SIM_STEP.COLLROT, 'C2', ParkC2, MCH_SIM_STEP.COLLROT)
       end
@@ -539,7 +550,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
@@ -550,11 +561,11 @@ function OnSimulToolDeselect( dPrevA)
             SimulMoveAxis( 'X1', dPosX, MCH_SIM_STEP.RAPID)
          else
             if nPrevTc ~= 2 then
-               SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkLongTc1C1, MCH_SIM_STEP.RAPROT)
+               SimulMoveAxes( 'B1', ParkLongB1, MCH_SIM_STEP.RAPROT, 'C1', ParkLongTc1C1, MCH_SIM_STEP.RAPROT)
                local dPosX = ParkX1
                SimulMoveAxis( 'X1', dPosX, MCH_SIM_STEP.RAPID)
             else
-               SimulMoveAxes( 'B1', ParkB1, MCH_SIM_STEP.RAPROT, 'C1', ParkLongTc2C1, MCH_SIM_STEP.RAPROT)
+               SimulMoveAxes( 'B1', ParkLongB1, MCH_SIM_STEP.RAPROT, 'C1', ParkLongTc2C1, MCH_SIM_STEP.RAPROT)
                local dPosX = ParkTc2X1
                SimulMoveAxis( 'X1', dPosX, MCH_SIM_STEP.RAPID)
             end
@@ -596,8 +607,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
@@ -663,27 +672,6 @@ function OnSimulMachiningStart()
          OnSimulToolSelect( dPosA)
       end
    end
-   -- salvo dati utensile
-   local nSetHead = GetHeadSet( EMT.HEAD)
-   -- per gruppo testa 1
-   if nSetHead == 1 then
-      EMT.PREVTOOL_H1 = EMT.TOOL
-      EMT.PREVHEAD_H1 = EMT.HEAD
-      EMT.PREVTCPOS_H1 = EMT.TCPOS
-      EMT.PREVTTOTLEN_H1 = EMT.TTOTLEN
-   -- per gruppo testa 2
-   elseif nSetHead == 2 then
-      EMT.PREVTOOL_H2 = EMT.TOOL
-      EMT.PREVHEAD_H2 = EMT.HEAD
-      EMT.PREVTCPOS_H2 = EMT.TCPOS
-      EMT.PREVTTOTLEN_H2 = EMT.TTOTLEN
-   -- per gruppo testa 3 (resetto dati testa 1)
-   else
-      EMT.PREVTOOL_H3 = nil
-      EMT.PREVHEAD_H3 = nil
-      EMT.PREVTCPOS_H3 = nil
-      EMT.PREVTTOTLEN_H3 = nil
-   end
    -- recupero alcuni dati della lavorazione
    EMT.MCHNAME = EgtGetOperationName( EMT.MCHID)
    EMT.MCHTYPE = EgtGetMachiningParam( MCH_MP.TYPE)
@@ -744,6 +732,7 @@ function OnSimulMachiningStart()
       SimulMoveAxis( 'X2', ParkX2, MCH_SIM_STEP.RAPID)
       EMT.DOU_TO_ZMAX = nil
    end
+
    -- non ancora iniziata la lavorazione
    EMT.MCHFIRST = true
 end
@@ -761,6 +750,29 @@ function OnSimulMachiningEnd()
    if EMT.DOU_TYPE and not EMT.ZMAX then EMT.DOU_TO_ZMAX = EMT.DOU_TYPE end
    EMT.DOU_TYPE = nil
    EMT.DOU_TOOL = nil
+
+   -- salvo dati utensile
+   local nSetHead = GetHeadSet( EMT.HEAD)
+   -- per gruppo testa 1
+   if nSetHead == 1 then
+      EMT.PREVTOOL_H1 = EMT.TOOL
+      EMT.PREVHEAD_H1 = EMT.HEAD
+      EMT.PREVTCPOS_H1 = EMT.TCPOS
+      EMT.PREVTTOTLEN_H1 = EMT.TTOTLEN
+   -- per gruppo testa 2
+   elseif nSetHead == 2 then
+      EMT.PREVTOOL_H2 = EMT.TOOL
+      EMT.PREVHEAD_H2 = EMT.HEAD
+      EMT.PREVTCPOS_H2 = EMT.TCPOS
+      EMT.PREVTTOTLEN_H2 = EMT.TTOTLEN
+   -- per gruppo testa 3 (resetto dati testa 1)
+   else
+      EMT.PREVTOOL_H3 = nil
+      EMT.PREVHEAD_H3 = nil
+      EMT.PREVTCPOS_H3 = nil
+      EMT.PREVTTOTLEN_H3 = nil
+   end
+
 end
 
 ---------------------------------------------------------------------
@@ -777,7 +789,7 @@ end
 ---------------------------------------------------------------------
 function OnSimulPathEnd()
    -- rimozione sfridi
-   RemoveScraps()
+   ExecRemoveScraps()
    -- se non ci sono comandi ausiliari associati e richiesta risalita a Zmax
    if EMT.AUXTOT == 0 and EMT.TO_ZMAX then
       if EMT.MCHSPLIT and not EMT.TO_FALL then
@@ -895,6 +907,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
@@ -903,7 +916,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)
@@ -941,13 +954,38 @@ function OnSimulMoveStart()
          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
-               SimulMoveAxes( 'X2', SafeX2, MCH_SIM_STEP.RAPID, 'B2', B2Home, MCH_SIM_STEP.COLLROT, 'C2', C2Home, MCH_SIM_STEP.COLLROT)
+         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)
+                  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)
+               -- 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
+            else
+               -- 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
-            SimulMoveAxis( 'Z2', Z2Home, MCH_SIM_STEP.RAPID)
-            SimulMoveAxis( 'X2', EMT.L2, MCH_SIM_STEP.RAPID)
+         else
+            -- 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
+            SimulMoveAxes( 'B2', EMT.R2, MCH_SIM_STEP.COLLROT, 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
          end
       -- altrimenti testa 3
       else 
@@ -999,7 +1037,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
@@ -1061,10 +1099,15 @@ function OnSimulMoveStart()
       EMT.A4 = EgtIf( GetV2ToClose(), EMT.V2NEXTPOS, ParkV2)
    end
    EMT.ZMAX = nil
+   EMT.TO_ZMAX = nil
 end
 
 ---------------------------------------------------------------------
 function OnSimulMoveEnd()
+   -- rimozione eventuali sfridi
+   if EMT.FLAG == 301 then 
+      ExecRemoveScraps()
+   end
    -- se primo rapido della lavorazione
    if EMT.MCHFIRST and EMT.MOVE == 0 then
       -- se lavorazione split, dichiaro carro Y1 riagganciato
@@ -1104,7 +1147,7 @@ function OnSimulMoveEnd()
    -- se Zmax dopo fine lavorazione
    if EMT.MOVE == 0 and EMT.FLAG == 3 then
       -- eventuale rimozione sfridi
-      RemoveScraps()
+      ExecRemoveScraps()
       -- eseguo
       ExecMoveZmax( EMT.MCHSPLIT)
       EMT.TO_ZMAX = nil
@@ -1271,11 +1314,11 @@ end
 function ExecStartHome()
    -- Testa 1
    EgtResetAxisPos( 'X1')
-   EgtResetAxisPos( 'Z1')
+   EgtSetAxisPos( 'Z1', MaxZ1)
    EgtResetAxisPos( 'C1')
    EgtResetAxisPos( 'B1')
    -- Testa 2
-   EgtResetAxisPos( 'X2')
+   EgtSetAxisPos( 'X2', SafeX2)
    EgtSetAxisPos( 'Z2', MinZ2)
    EgtResetAxisPos( 'C2')
    EgtResetAxisPos( 'B2')
@@ -1285,13 +1328,16 @@ end
 function ExecMoveHome( bNearV, bMchSplit)
    -- risalita a Zmax
    ExecMoveZmax( bMchSplit)
-   EMT.TO_ZMAX = nil
-   -- se testa sotto
-   if GetHeadSet( EMT.HEAD) == 2 then
+   -- 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
       ExecOpenRoller( 1)
@@ -1328,13 +1374,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)
@@ -1342,7 +1389,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
@@ -1367,7 +1414,15 @@ function ExecMoveZmax( bMchSplit)
    elseif nSetHead == 2 then
       SimulMoveAxis( 'Z2', ParkZ2, MCH_SIM_STEP.RAPID)
       SimulMoveAxes( 'B2', ParkB2, MCH_SIM_STEP.COLLROT, 'C2', ParkC2, MCH_SIM_STEP.COLLROT)
-      SimulMoveAxis( 'X2', ParkX2, MCH_SIM_STEP.RAPID)
+      if EMT.HEAD == 'H22' then
+         SimulMoveAxis( 'X2', SafeX2, MCH_SIM_STEP.RAPID)
+      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)
@@ -1396,10 +1451,14 @@ function ExecUnloading()
       EgtMove( nLayId, vtMove, GDB_RT.GLOB)
       EgtSetLevel( vMillId, GDB_LV.USER)
       -- aggiungo gli spigoli
-      local nFirstId, nCount = EgtVolZmapGetEdges( vMillId, nLayId)
-      if nFirstId then
-         for nId = nFirstId, nFirstId + nCount - 1 do
-            EgtSetColor( nId, Color3d( 96, 96, 96))
+      if EgtVolZmapSetShowEdges then
+         EgtVolZmapSetShowEdges( vMillId, true)
+      else
+         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
@@ -1587,7 +1646,7 @@ function ExecOpenRoller( nInd)
 end
 
 ---------------------------------------------------------------------
-function RemoveScraps()
+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
       local vMillId = EMT.VMILL[1]
@@ -1618,7 +1677,6 @@ function RemoveScraps()
       end
       EMT.VMRS = false
    end
-
 end
 
 ---------------------------------------------------------------------
@@ -1827,6 +1885,13 @@ function LoadFirstTool( nHSet, sTcPosDef)
       EMC = { HEAD = sHead, TOOL = sTool, TCPOS = sTcPos, TOTLEN = sTTotLen, BLOCKEDAXIS = sBlockedAxis}
       OnSetHead()
       EMC = OrigEMC
+      if sBlockedAxis then
+         local dPosA = tonumber( sBlockedAxis:sub( 4) or '') or 0
+         if dPosA ~= 0 then
+            -- imposto il valore di A
+            EgtSetAxisPos( EgtIf( nHSet == 1 , 'A1', 'A2'), dPosA)
+         end
+      end
       -- carico l'utensile
       EgtLoadTool( sHead, 1, sTool)
       ShowToolInTcPos( sTcPos, false)

Common-PF1250.mlse

@@ -1,4 +1,4 @@
--- Special Operations macchina Essetre-PF1250 by Egalware s.r.l.  2024/01/22
+-- Special Operations macchina Essetre-PF1250 by Egalware s.r.l.  2024/04/09
 -- Intestazioni
 
 require( 'EmtGenerator')
@@ -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)
@@ -888,10 +888,14 @@ function SpecialCalcMachiningEncumbrance( nMchId, bPreCut)
       EgtSetAxisPos( 'B3', vAxMid[5])
       b3Enc = EgtGetBBoxGlob( EgtGetAxisId( 'C3'), GDB_BB.ONLY_VISIBLE)
    end
+
+   -- Forzo la distanza di sicurezza da utensile
+   local nSecRollerDist = EgtGetValInNotes( EgtTdbGetCurrToolParam( MCH_TP.USERNOTES), 'SECDIST', 'i') or SIC_V
+
    local dMinFrontEng = EgtIf( nSetHead ~= 2, MIN_ENG_RACK_V, EgtIf( vAxMax[3] < MIN_Z2_FOR_ENG_XZ2_V, MIN_ENG_V, MIN_ENG_XZ2_V))
-   local dRollFront = max( b3Enc:getMax():getX(), dMinFrontEng) + SIC_V
+   local dRollFront = max( b3Enc:getMax():getX(), dMinFrontEng) + nSecRollerDist
    local dMinBackEng = EgtIf( nSetHead ~= 2, MIN_ENG_V, EgtIf( vAxMax[3] < MIN_Z2_FOR_ENG_XZ2_V, MIN_ENG_V, MIN_ENG_XZ2_V))
-   local dRollBack = max( -b3Enc:getMin():getX(), dMinBackEng) + SIC_V
+   local dRollBack = max( -b3Enc:getMin():getX(), dMinBackEng) + nSecRollerDist
    EgtOutLog( '  RollFront = ' .. EgtNumToString( dRollFront, 1) .. ' RollBack = ' .. EgtNumToString( dRollBack, 1), 3)
    -- Calcolo della posizione della Punta Utensile rispetto allo Zero Macchina
    local ptTip
@@ -1280,21 +1284,30 @@ end
 
 ---------------------------------------------------------------------
 local function ChangedTool( nMchId)
-   local bChanged = false
+   local nChanged = 0
    -- Salvo lavorazione e utensile correnti, per ripristinarli alla fine
    local nOrigMchId = EgtGetCurrMachining()
    local sOrigTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
+   local sOrigBlockedAx = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
    -- Recupero l'utensile della lavorazione precedente
    local nPrevMchId = EgtGetPrevActiveOperation( nMchId or GDB_ID.NULL)
    if nPrevMchId and EgtGetOperationType( nPrevMchId) ~= MCH_OY.DISP then
       EgtSetCurrMachining( nPrevMchId)
       local sTool = EgtGetMachiningParam( MCH_MP.TOOL)
-      bChanged = ( sTool ~= sOrigTool)
+      nChanged = EgtIf( sTool ~= sOrigTool, 1 , 0)
+      local sBlockedAx = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
+      -- se stesso utensile, ma modo caricamento diverso, è come se fosse un cambio utensile. Vale solo se aggregato su lama da sotto.
+      if sTool == sOrigTool then 
+         local sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+         if sHead == 'H22' and sOrigBlockedAx ~= sBlockedAx then
+            nChanged = 2
+         end
+      end
    end
    -- Ripristino lavorazione e utensile correnti
    if nOrigMchId then EgtSetCurrMachining( nOrigMchId) end
    if sOrigTool then EgtTdbSetCurrTool( sOrigTool) end
-   return bChanged
+   return nChanged
 end
 
 --------------------------------------------------------------------------------------------------------
@@ -1303,9 +1316,9 @@ end
 function SpecAdjustCarriages( WorkTab)
 
    --EgtOutLog( '   --->>> CNT=' .. EgtIf( EMC.CNT, '1', '_'))
-
+   local bChangedTool = ChangedTool( EMC.MCHID)
    -- Aggiorno la posizione dei rulli per eventuale cambio utensile
-   if ChangedTool( EMC.MCHID) then
+   if bChangedTool ~= 0 then
       WorkTab.dV1PosI = ParkV1
       WorkTab.dV2PosI = ParkV2
    end
@@ -1314,15 +1327,24 @@ function SpecAdjustCarriages( WorkTab)
    if WorkTab.dY1DeltaI then
       local dY1DeltaLim = MinJoin + WorkTab.dV1PosI - WorkTab.dV2PosI + 2 * AGG_V + EMC.HCING + EMC.HOVM + EgtIf( EMC.CNT == 1, AggLoad, 0)
       if WorkTab.dY1DeltaI <= dY1DeltaLim or ( WorkTab.dY1DeltaMaxF and WorkTab.dY1DeltaMaxF <= dY1DeltaLim)  then
-         bCloseV = true 
+         bCloseV = true
       end
    end
    if WorkTab.dY2DeltaI then
       local dY2DeltaLim = MinJoin + WorkTab.dV1PosI - WorkTab.dV2PosI + 2 * AGG_V
       if EMC.LB - WorkTab.dY2DeltaI <= dY2DeltaLim or ( WorkTab.dY2DeltaMinF and EMC.LB - WorkTab.dY2DeltaMinF <= dY2DeltaLim)  then  
-         bCloseV = true  
+         bCloseV = true
       end
    end
+   -- se ho cambiato modo di prendere utensile, forzo chiusura
+   if bChangedTool == 2 then
+      bCloseV = true
+   end
+   -- se i pezzi del cliente sono molto storti, si forza la chiusura per evitare che vada a sbattere. Se parametro non presente, si chiude solo se necessario
+   if ForceToCloseRollersGate then
+      bCloseV = true
+   end
+
    WorkTab.bCloseV = bCloseV
 
    -- |POSIZIONO Y1| **[A]**
@@ -1835,7 +1857,7 @@ local function PosY1Y2B( TabI, vCmd)
          end 
       end
       nCnt = nCnt + 1
-      if nCnt > 5 then return end
+      if nCnt > 10 then return end
    until ( not bXW)
       -- chiusura/parcheggio dei trascinatori in funzioni chiamanti
    local dY1Delta = TabI.dY1PosI - TabI.dTPosI
@@ -1899,7 +1921,6 @@ local function PosY2Y1A( TabI, vCmd)
             MaxDispl( TabI, vCmd, 'M1') 
          end 
       end
-      
    until ( not bXW)
       -- chiusura/parcheggio dei trascinatori in funzioni chiamanti
    local dY1Delta = TabI.dY1PosI - TabI.dTPosI
@@ -1974,7 +1995,7 @@ local function PosY2Y1B( TabI, vCmd)
          end 
       end
       nCnt = nCnt + 1
-      if nCnt > 5 then return end
+      if nCnt > 10 then return end
    until ( not bXW)
    -- la chiusura delle morse è fatta sopra
    local dY1Delta = TabI.dY1PosI - TabI.dTPosI

UpdateLog.txt

@@ -1,10 +1,58 @@
            ==== Common_PF1250 Update Log ====
 
+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_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
+- (GEN) Corretto adeguamento speed per aggregato lama da sotto con coefficiente moltiplicativo
+- (SIM-GEN) Aumentato numero riposizionamenti possibili a 10 ( per pezzi molto lunghi non bastava il valore precedente: 5)
+- (GEN) Corretto posizionamento assi in home se primo utensile punta lunga
+
+Versione 2.6c5 (26/03/2024)
+- (SIM) Corretto primo movimento in rapido della lavorazione per testa sotto. Ora allineata a generazione
+- (SIM-GEN) Aggiunta gestione parametro "SECDIST". Distanza di sicurezza tra paratia con rulli e utensile/testa. Parametro da inserire nelle note utensile
+- (MLDE-SIM) Modificate collisioni traversa. Ora non comprende carro X1, il quale ha il proprio oggetto di collisione
+
+Versione 2.6c4 (14/03/2024)
+- (SIM) Miglioramento visualizzazione spigoli VMILL alla fine della simulazione. Funzione: EgtVolZmapSetShowEdges. N.B.= serve CAM5 2.6c2 NON OBBLIGATORIO
+- (GEN) Modifica controlli a preselezione utensile. Margine ridotto da 400m a 200mm.
+- (GEN) Corretto controllo preselezione testa H1 quando H2 in lavoro
+
+Versione 2.6c3 (12/03/2024)
+- (SIM-GEN) Migliorata gestione movimenti con lama su aggregato su testa sotto
+
+Versione 2.6c2 (04/03/2024)
+- (GEN) I commenti iniziali si scrivono in modo standard, per poterli commentare nella macchina di test
+- (MLDE-GEN) Aggiunta variabile 'MACH_NAME' in MLDE con nome macchina
+
+Versione 2.6c1 (29/02/2024)
+- (SIM) Gestione rimozione VMILL per tagli a cubetti Zig-Zag
+
 Versione 2.6b4 (23/02/2024)
 - (MLDE-SIM-GEN) EgtAddToPackagePath spostato in mlde
 
 Versione 2.6b3 (20/02/2024)
-- (SIM) Aggiunta funzioni "OnSimulInit" e "OnSimulExit" per orientare vista corretta in caso di macchina con carico destro. N.B.= serve CAM5 2.6b4
+- (SIM) Aggiunta funzioni "OnSimulInit" e "OnSimulExit" per orientare vista corretta in caso di macchina con carico destro. N.B.= serve CAM5 2.6b4 NON OBBLIGATORIO
 - (SIM-GEN) "BeamData" caricato come libreria con 'require' anziché come file con 'dofile'
 
 Versione 2.6b2 (15/02/2024)

Version.lua

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