Piccola correzione controllo collisione

Common-PF1250.TPA.mlpe

@@ -846,7 +846,11 @@ function OnRapid()
             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})     
+            if EMT.ZMAX then
+               EmitMoveDataHead( 2, { X=EMT.L2, B=EMT.R2, C=EMT.R1, S=Speed})            
+            else
+               EmitMoveDataHead( 2, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})            
+            end    
             EmitMoveStartHead( 2)
             -- eventuale preselezione successiva testa 1
             PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
@@ -1150,7 +1154,11 @@ function OnRapid()
             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})            
+            if EMT.ZMAX then
+               EmitMoveDataHead( 2, { X=EMT.L2, B=EMT.R2, C=EMT.R1, S=Speed})            
+            else
+               EmitMoveDataHead( 2, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})            
+            end
             EmitMoveStartHead( 2)
             -- eventuale preselezione successiva testa 1
             PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)

Common-PF1250.mlpe

@@ -449,7 +449,7 @@ function OnSimulToolSelect( dPosA)
    EMT.TTOTLEN = EgtTdbGetCurrToolParam( MCH_TP.TOTLEN)
    EMT.TUSERNOTES = EgtTdbGetCurrToolParam( MCH_TP.USERNOTES)
    -- recupero il gruppo
-   local nSetHead = GetHeadSet( EMT.NEXTHEAD)
+   local nSetHead = GetHeadSet( EMT.HEAD)
    -- se fresa o lama su testa 1, reset assi rotanti
    if nSetHead == 1 then
       -- se ho la testa 3, la mando a parcheggio
@@ -514,6 +514,26 @@ function OnSimulToolSelect( dPosA)
       local nInd = EgtIf( nSetHead ~= 2, 1001, 1011)
       AddToolToCollisionObj( EMT.TOOL, EMT.HEAD, EMT.EXIT, nInd, true)
       AddToolHolderToCollisionObj( EMT.TOOL, EMT.HEAD, EMT.EXIT, nInd + 1)
+
+      if nSetHead ~= 1 and ( EMT.PREVTOOL_H1 and EMT.PREVHEAD_H1) then
+         local nPrevExit_H1 = 1
+         local nInd_H1 = 1001
+         AddToolToCollisionObj( EMT.PREVTOOL_H1, EMT.PREVHEAD_H1, nPrevExit_H1, nInd_H1, false)
+         AddToolHolderToCollisionObj( EMT.PREVTOOL_H1, EMT.PREVHEAD_H1, nPrevExit_H1, nInd_H1 + 1)
+      end
+      if nSetHead ~= 2 and ( EMT.PREVTOOL_H2 and EMT.PREVHEAD_H2) then
+         local nPrevExit_H2 = 1
+         local nInd_H2 = 1011
+         AddToolToCollisionObj( EMT.PREVTOOL_H2, EMT.PREVHEAD_H2, nPrevExit_H2, nInd_H2, false)
+         AddToolHolderToCollisionObj( EMT.PREVTOOL_H2, EMT.PREVHEAD_H2, nPrevExit_H2, nInd_H2 + 1)
+      end
+      if nSetHead ~= 3 and EgtGetHeadId( 'H31') then
+         local nPrevExit_H3 = 1
+         local nInd_H3 = 1001
+         AddToolToCollisionObj( nil, 'H31', nPrevExit_H3, 1001)
+         AddToolHolderToCollisionObj( nil, 'H31', nPrevExit_H3, 1002)
+      end
+
       for i, Coll in ipairs( EMT.COLLOBJ or {}) do
          EmtAddCollisionObjEx( i, Coll.Fr, Coll.Ty, Coll.Mv, Coll.P1, Coll.P2, Coll.P3)
       end
@@ -996,11 +1016,6 @@ function OnSimulMoveStart()
                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 EMT.ZMAX and X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
-                  SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
-               end
             end
          else
             -- Porto la X alla giusta quota
@@ -1011,6 +1026,10 @@ function OnSimulMoveStart()
          if EMT.HEAD == 'H22' then
             SimulMoveAxes( 'B2', EMT.R2, MCH_SIM_STEP.COLLROT, 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
          end
+         -- se ero a ZMAX, mi sposto in posizione a Z home. Ultimo movimento muove in Z
+         if EMT.ZMAX then
+            SimulMoveAxes( 'X2', EMT.L2, MCH_SIM_STEP.RAPID, 'B2', EMT.R2, MCH_SIM_STEP.COLLROT, 'C2', EMT.R1, MCH_SIM_STEP.COLLROT)
+         end
       -- altrimenti testa 3
       else 
          ; -- non devo fare alcunchè di speciale
@@ -1283,7 +1302,7 @@ function ExecAuxCmd( sCmd, bPathStart)
       ExecMoveHome( Cmd[2] == '1', EgtIf( bPathStart, false, EMT.MCHSPLIT))
    elseif Cmd[1] == '11' then
       local bClose = Cmd[2] ~= '0'
-      if bPathStart and EMT.MCHSPLIT and not EMT.FALL and GetPY2Light() then bClose = false end
+      if bPathStart and EMT.MCHSPLIT and not ( EMT.FALL or EMT.TO_FALL) and GetPY2Light() then bClose = false end
       ExecMovePY1( bClose)
    elseif Cmd[1] == '12' then
       ExecMovePY2( Cmd[2] ~= '0')

Common-PF1250.mlse

@@ -991,7 +991,11 @@ function SpecCalcLoad( dPosT, dDistFront, dDistBack)
    local dNewY1min = max( EMC.LB - dDistBack, MinOther + AggLoad + EMC.HCING + EMC.HOVM)
    local dNewY1max = min( ( MaxY1 - MinY1) - 5, EMC.LB - MinJoin)
    if dNewY1min > dNewY1max then return nil end
-   local dNewY1Delta = EgtClamp( BD.CHAR_LOAD_DIST or 3000, 0.75 * dNewY1min + 0.25 * dNewY1max, 0.25 * dNewY1min + 0.75 * dNewY1max)
+    -- minimo posizionamento pinza 1 per permettere scarico del restante
+   local dMinLengthRestToUnload = abs( MinY1) + abs( MinV1) + abs( MaxV2) + abs( MaxY2) + MinJoin + AggLoad + EMC.LT + 10
+   -- calcolo posizionamento con i coefficienti, ma verifico che sia tra il minimo e il massimo pinzabile
+   local dNewY1DeltaMax = EgtClamp( 0.25 * dNewY1min + 0.75 * dNewY1max, dMinLengthRestToUnload, dNewY1max)
+   local dNewY1Delta = EgtClamp( BD.CHAR_LOAD_DIST or 3000, 0.75 * dNewY1min + 0.25 * dNewY1max, dNewY1DeltaMax)
    local dNewY2Delta = nil
    local dNewY1 = dPosT + dNewY1Delta
    local vCmd = {}
@@ -1069,11 +1073,21 @@ function SpecCalcCarriages( dDistFront, dDistBack, dRollFront, dRollBack, dY1Del
       WorkTab.dY1DeltaMaxF = min( EMC.LB - MinJoin, MaxY1 + dDistFront + dRollFront + AGG_V)
       WorkTab.dY2DeltaMinF = nil
       WorkTab.dY2DeltaMaxF = nil
+      if dY1DeltaMaxSP then WorkTab.dY1DeltaMaxF = min( WorkTab.dY1DeltaMaxF, dY1DeltaMaxSP) end
       WorkTab.dV1PosF = dRollBack
       WorkTab.bV1CloseF = false
       WorkTab.dV2PosF = -dRollFront
       WorkTab.bV2CloseF = false
 
+      -- aggiuntivo per non avere problemi con pezzi a caduta
+      if WorkTab.dY1DeltaMaxF - WorkTab.dY1DeltaMinF > 5 * BD.CHAR_EXTRA_DIST then
+         WorkTab.dY1DeltaMinF = WorkTab.dY1DeltaMinF + 4 * BD.CHAR_EXTRA_DIST
+      elseif WorkTab.dY1DeltaMaxF - WorkTab.dY1DeltaMinF > 2.5 * BD.CHAR_EXTRA_DIST then
+         WorkTab.dY1DeltaMinF = WorkTab.dY1DeltaMinF + 2 * BD.CHAR_EXTRA_DIST
+      elseif WorkTab.dY1DeltaMaxF - WorkTab.dY1DeltaMinF > 1.5 * BD.CHAR_EXTRA_DIST then
+         WorkTab.dY1DeltaMinF = WorkTab.dY1DeltaMinF + BD.CHAR_EXTRA_DIST
+      end
+
       -- verifico validità intervallo ammesso per Y1
       if WorkTab.dY1DeltaMinF > WorkTab.dY1DeltaMaxF + 10 * GEO.EPS_SMALL then
          EMC.ERR = 18
@@ -1110,6 +1124,15 @@ function SpecCalcCarriages( dDistFront, dDistBack, dRollFront, dRollBack, dY1Del
       WorkTab.dV2PosF = -dRollFront
       WorkTab.bV2CloseF = false
 
+      -- aggiuntivo per minimizzare scambi carrelli
+      if WorkTab.dY1DeltaMaxF - WorkTab.dY1DeltaMinF > 5 * BD.CHAR_EXTRA_DIST then
+         WorkTab.dY1DeltaMinF = WorkTab.dY1DeltaMinF + 4 * BD.CHAR_EXTRA_DIST
+      elseif WorkTab.dY1DeltaMaxF - WorkTab.dY1DeltaMinF > 2.5 * BD.CHAR_EXTRA_DIST then
+         WorkTab.dY1DeltaMinF = WorkTab.dY1DeltaMinF + 2 * BD.CHAR_EXTRA_DIST
+      elseif WorkTab.dY1DeltaMaxF - WorkTab.dY1DeltaMinF > 1.5 * BD.CHAR_EXTRA_DIST then
+         WorkTab.dY1DeltaMinF = WorkTab.dY1DeltaMinF + BD.CHAR_EXTRA_DIST
+      end
+
       -- verifico validità intervallo ammesso per Y1
       if WorkTab.dY1DeltaMinF > WorkTab.dY1DeltaMaxF + 10 * GEO.EPS_SMALL then
          EMC.ERR = 18
@@ -1988,7 +2011,7 @@ local function PosY2Y1B( TabI, vCmd)
          if TabI.dY2PosI > MinY2 and
             TabI.dY2PosI > TabI.dTPosI + MinJoin + EMC.HOVM + EMC.HCING - 10 * GEO.EPS_SMALL then
          -- allontanamento morse, trascinamento trave con Y2
-            MaxDispl( TabI, vCmd, 'M2')  
+            MaxDispl( TabI, vCmd, 'M2')
          else 
          -- accentramento morse, trascinamento trave con Y1
             MaxDispl( TabI, vCmd, 'M3')

UpdateLog.txt

@@ -1,5 +1,15 @@
            ==== Common_PF1250 Update Log ====
 
+Versione 2.6g3 (22/07/2024)
+- (SIM) Si aggiunge al controllo collisioni anche Tool e ToolHolder della testa non utilizzata. Ticket#1937
+- (SIM-GEN) In caso di grezzo piuttosto piccolo, concesso pinzaggio fino al massimo possibile, oltre al calcolo con coefficienti. Ticket#1942
+
+Versione 2.6g2 (12/07/2024)
+- (SIM-GEN) Corretto movimento testa sotto che andava in collisione tra una lavorazione e la successiva se tra le due c'era un riposizionamento pinze. Ticket#1925
+
+Versione 2.6g1 (08/07/2024)
+- (SIM-GEN) Corretto movimento che pinzava nel vuoto durante riposizionamento. Ticket#1836
+
 Versione 2.6f2 (06/06/2024)
 - (GEN) Quando si va a ZMAX, si azzerano tutte le coordinate ".pp". Scriveva una Z bassa quando era a Z massima. Ticket#1839
 

Version.lua

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