Modifiche a funzione riposizionemanto carrelli

- Cambio nome per distanza di collisione con paratie cabina

Beam/BeamData.lua

@@ -42,6 +42,7 @@ local BeamData = {
    DRILL_VZ_MIN = -0.51,                    -- componente limite in Z del versore di un foro
    DRILL_VX_MAX = 0.867,                    -- componente limite in X del versore di un foro sulle facce laterali
    DRILL_OVERLAP = 5,                       -- sovrapposizione tra due mezze forature
+   MAX_ANGLE_DRILL_CUT = 10,                -- angolo massimo tra la foratura e il taglio che la attraversa
    MILL_OVERLAP = 5,                        -- sovrapposizione tra due mezze fresature
    MAX_DIST_HTFEA = 50.0,                   -- massima distanza di feature da testa o coda per essere considerata tale
    MAX_LEN_HTFEA = 2000.0,                  -- massima lunghezza di feature di testa o coda
@@ -105,6 +106,7 @@ if EgtExistsFile( sData) then
          BeamData.MAXDIAM_POCK_CORNER = Machine.Offsets.MAXDIAM_POCK_CORNER or BeamData.MAXDIAM_POCK_CORNER
          BeamData.LONGCUT_ENDLEN = Machine.Offsets.LONGCUT_ENDLEN or BeamData.LONGCUT_ENDLEN
          BeamData.LONGCUT_MAXLEN = Machine.Offsets.LONGCUT_MAXLEN or BeamData.LONGCUT_MAXLEN
+         if Machine.Offsets.MAX_ANGLE_DRILL_CUT then BeamData.MAX_ANGLE_DRILL_CUT = EgtClamp( Machine.Offsets.MAX_ANGLE_DRILL_CUT, 1, 89) end
          BeamData.ADVANCE_TAIL_OFFS = Machine.Offsets.ADVANCE_TAIL_OFFS or BeamData.ADVANCE_TAIL_OFFS
          BeamData.LEN_VERY_SHORT_PART = Machine.Offsets.LEN_VERY_SHORT_PART or BeamData.LEN_VERY_SHORT_PART
          BeamData.LEN_SHORT_PART = Machine.Offsets.LEN_SHORT_PART or BeamData.LEN_SHORT_PART

Common_FAST.mlse

@@ -1536,9 +1536,12 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
       dTPosF = MaxV - dVDeltaF
    end
 
+   -- se il pinzaggio deve essere invertito forzo entrata nei riposizionamenti
+   -- altrimenti posizioni iniziali e finali sono coincidenti dato che la pinza non in presa viene posizionata alla distanza minima a quella in presa
+   local bInvertClamping = not EMC.PILGRIMSTEP and EMC.YDELTA ~= EMC.YDELTANEXT and EMC.VDELTA ~= EMC.VDELTANEXT
    -- verifico che le morse non sono in posizione
-   if abs( dYDeltaF - dYDeltaI) > 10 * GEO.EPS_SMALL  or  abs( dVDeltaF - dVDeltaI) > 10 * GEO.EPS_SMALL or 
-      EMC.YDELTA ~= EMC.YDELTANEXT or EMC.VDELTA ~= EMC.VDELTANEXT then
+   if ( abs( dYDeltaF - dYDeltaI) > 10 * GEO.EPS_SMALL  or  abs( dVDeltaF - dVDeltaI) > 10 * GEO.EPS_SMALL or bInvertClamping) and
+      ( EMC.YDELTA ~= EMC.YDELTANEXT or EMC.VDELTA ~= EMC.VDELTANEXT) then
       if #vCmd == 0 then
          table.insert( vCmd, { 0, 'Clamp repositioning'})
          -- risalita testa a Zmax
@@ -1610,6 +1613,18 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
          -- se spostamento verso il carico
          elseif ( dVPosI + ( dVDeltaF - dVDeltaI)) > MaxV then
             dBeamMove =  dVPosI + ( dVDeltaF - dVDeltaI) - MaxV
+         -- se è FASTCLAMPING attivo, si suddivide il movimento 
+         elseif BD.FASTCLAMPING then
+            -- se la trave si sposta dal carico verso lo scarico
+            if dTPosI - dTPosF > 0 then
+               dBeamMove = min( -( dTPosF - dTPosI), -( MyMinY - dYPosI), -( dVDeltaI - dVDeltaF))
+            else
+               dBeamMove = max( -( dTPosF - dTPosI), -( MyMinY - dYPosI))
+            end
+            dBeamMove = dBeamMove / 2
+         -- altrimenti la trave resta ferma e la pinza 1 va in presa (si limita lo scivolamento del pezzo)
+         else
+            ;
          end
 
          -- se serve un grande spostamento e si sta pinzando poco. Y trascinatore pinza poco e V si sposta per prima per recuperare
@@ -1684,6 +1699,8 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
 
          -- movimento terminato
          dTPosI, dYDeltaI, dVDeltaI = dTPosF, dYDeltaF, dVDeltaF
+         EMC.YDELTA = EMC.YDELTANEXT
+         EMC.VDELTA = EMC.VDELTANEXT
 
       -- SECONDO CASO ->  SCAMBIO DIRETTO : Y IN POSIZIONE FINALE
       -- Y può andare in posizione direttamente se :
@@ -1720,6 +1737,18 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
          -- se spostamento verso il carico
          elseif ( dYPosI + ( dYDeltaF - dYDeltaI)) > MaxY then
             dBeamMove =  -( dYPosI + ( dYDeltaF - dYDeltaI) - MaxY)
+         -- se è FASTCLAMPING attivo, si suddivide il movimento 
+         elseif BD.FASTCLAMPING then
+            -- se la trave si sposta dal carico verso lo scarico
+            if dTPosI - dTPosF > 0 then
+               dBeamMove = max( ( dTPosF - dTPosI), ( MinV - dVPosI), ( dYDeltaI - dYDeltaF))
+            else
+               dBeamMove = min( ( dTPosF - dTPosI), ( dVPosI - MaxV))
+            end
+            dBeamMove = dBeamMove / 2
+         -- altrimenti la trave resta ferma e la pinza 1 va in presa (si limita lo scivolamento del pezzo)
+         else
+            ;
          end
 
          -- se serve un grande spostamento e si sta pinzando poco. V trascinatore pinza poco e Y si sposta per prima per recuperare
@@ -1793,6 +1822,8 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
          end
          -- movimento terminato
          dTPosI, dYDeltaI, dVDeltaI = dTPosF, dYDeltaF, dVDeltaF
+         EMC.YDELTA = EMC.YDELTANEXT
+         EMC.VDELTA = EMC.VDELTANEXT
 
       -- TERZO CASO -> PASSO DEL PELLEGRINO
       -- non è possibile fare scambio diretto.
@@ -1841,6 +1872,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
          dDeltaBeam = dTPosI - dTPosF
 
          -- a questo punto entrambe le pinze sono in presa sul pezzo.
+         -- trave si muove dal carico allo scarico
          -- Il trascinatore si decide in base alla direzione di movimento trave
          -- trascino con morsa allo scarico. Obiettivo mandare Y in posizione per prima
          if dDeltaBeam > 0 then
@@ -1883,18 +1915,21 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
                -- mi serve riposizonare di nuovo, quindi richiamo funzione in modo ricorsivo
                SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF, dVDeltaF, bFixedDelta, bFixedPos)
             -- recupero una corsa massima e l'altra solo di quello che serve
-            elseif abs( dYDeltaI - dYDeltaF) > dMaxMovePilgrimStepSingleClampY then
+            elseif abs( dYDeltaI - dYDeltaF) > dMaxMovePilgrimStepSingleClampV then
+               -- suddivido il movimento su entrambe le morse
+               local dTotMove = ( dYDeltaF - dYDeltaI) / 2
                -- morsa Y arriva in posizione finale
-               dYDeltaI = dYDeltaF
-               dVPosA = MinV
-               dTPosA = dTPosI - dVPosI + MinV
+
+               dVPosA = MaxV - dTotMove
+               dTPosA = dTPosI - dVPosI + MaxV - dTotMove
                dYPosA = dYDeltaF + dTPosA
                table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
                table.insert( vCmd, { 11, CalcCharStatus( 'Y', dYDeltaF)})
                table.insert( vCmd, { 12, 0})
+               dYDeltaI = dYDeltaF
                dTPosI = dTPosA
                EMC.YDELTA = dYDeltaF
-               EMC.VDELTA = dVDeltaI
+               EMC.VDELTA = nil
                -- mi serve riposizonare di nuovo, quindi richiamo funzione in modo ricorsivo
                SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF, dVDeltaF, bFixedDelta, bFixedPos)
             -- non serve recuperare al massimo della corsa, suddivido movimento in due
@@ -1928,9 +1963,9 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
                   end
                   table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
                   dTPosI, dYDeltaI, dVDeltaI = dTPosF, dYDeltaF, dVDeltaF
+                  EMC.YDELTA = EMC.YDELTANEXT
+                  EMC.VDELTA = EMC.VDELTANEXT
 
-                 -- aggiorno nuova posizione della morsa allo scarico dopo riposizionamento
-                  dVDeltaI = dVDeltaF
                end
 
                -- imposto i nuovi parametri di aggancio
@@ -1989,17 +2024,19 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
                -- mi serve riposizonare di nuovo, quindi richiamo funzione in modo ricorsivo
                SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF, dVDeltaF, bFixedDelta, bFixedPos)
             -- recupero una corsa massima e l'altra solo di quello che serve
-            elseif abs( dVDeltaI - dVDeltaF) > dMaxMovePilgrimStepSingleClampV then
-               -- aggiorno nuova posizione della morsa al carico dopo riposizionamento
-               dVDeltaI = dVDeltaF
-               dYPosA = MaxY
-               dTPosA = dTPosI + ( MaxY - dYPosI)
+            elseif abs( dVDeltaI - dVDeltaF) > dMaxMovePilgrimStepSingleClampY then
+               -- suddivido il movimento su entrambe le morse
+               local dTotMove = ( dVDeltaI - dVDeltaF) / 2
+               -- morsa V arriva in posizione finale
+               dYPosA = MaxY + dTotMove
+               dTPosA = dTPosI + ( MaxY - dYPosI) + dTotMove
                dVPosA = dVDeltaF + dTPosA
                table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
                table.insert( vCmd, { 12, CalcCharStatus( 'V', dVDeltaF)})
                table.insert( vCmd, { 11, 0})
+               dVDeltaI = dVDeltaF
                dTPosI = dTPosA
-               EMC.YDELTA = dYDeltaI
+               EMC.YDELTA = nil
                EMC.VDELTA = dVDeltaF
                -- mi serve riposizonare di nuovo, quindi richiamo funzione in modo ricorsivo
                SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF, dVDeltaF, bFixedDelta, bFixedPos)
@@ -2034,9 +2071,8 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
                   end
                   table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
                   dTPosI, dYDeltaI, dVDeltaI = dTPosF, dYDeltaF, dVDeltaF
-
-                  -- aggiorno nuova posizione della morsa al carico dopo riposizionamento
-                  dYDeltaI = dYDeltaF
+                  EMC.YDELTA = EMC.YDELTANEXT
+                  EMC.VDELTA = EMC.VDELTANEXT
                end
 
                -- imposto i nuovi parametri di aggancio

Essetre-FAST.mlde

@@ -24,8 +24,8 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '3.1b2'
-PP_NVER = '3.1.2.2'
+PP_VER = '3.1c2'
+PP_NVER = '3.1.3.2'
 MIN_MACH_VER = '2.7j1'
 MACH_NAME =  EgtGetCurrMachineName()
 
@@ -46,7 +46,7 @@ end
 EgtOutLog ( '** ' .. MACH_NAME..' '..PP_VER..' ** ( '..INFO_STD_PP.NAME..': '..INFO_STD_PP.VERSION..' - MinMach: '.. MIN_MACH_VER ..') **', 1)
 
 -- Parametri macchina
-NumericalControl = 'TPA'                                      -- NUM o TPA o NUM_PLUS
+NumericalControl = 'TPA'            -- NUM o TPA o NUM_PLUS
 MinX = 0
 MaxX = 1350
 MinZ = -1350
@@ -65,7 +65,7 @@ LoadT = 1454.2
 UnloadT = -1700
 MaxOpen = 305
 MillOffs = 177.35
-DistRotCenterBToTopC = 403 -- distanza tra il centro di rotazione del mandrino B e la mensola C
+DistRotCenterBToTopC = 403          -- distanza tra il centro di rotazione del mandrino B e la mensola C
 SawOffs = -242.68
 SawBOffs = 0
 SawCOffs = 0
@@ -76,7 +76,7 @@ AngTrBHOffs = 154.5
 AngTrBHLen = 90
 TurnerOffs = 200.0
 DeltaTabY = 898.0
-DeltaTabZ = -1017.8 + MillOffs                 -- per TPA : -1013.3 + MillOffs    -- per NUM : -838.4
+DeltaTabZ = -1017.8 + MillOffs      -- per TPA : -1013.3 + MillOffs    -- per NUM : -838.4
 DimTabY = 400
 DimTabX = 34000
 LenToPress = 900
@@ -87,19 +87,21 @@ DefTcPos = 'T2'
 SecondSupport = 0
 SpecialBH = false
 MaxUnloadLen = 0
-BeamHeightForFixRot = 9999                     -- per abilitare assegnare 500
+BeamHeightForFixRot = 9999          -- per abilitare assegnare 500
 NewTopC = true
 SafeXRotAxes = 150
 AggreBlockHaus = false
 SecondToolChanger = false
 EstimationRapidMultiplier = 1
-DistZClampToTable = 5                             -- distanza tra la tavola e il punto più basso della morsa
-ClampingCoeffMin = nil                             -- coefficiente di fissaggio, se 0 o nil non fa controllo, per il momento da inizializzare da Ts3Data
+DistZClampToTable = 5               -- distanza tra la tavola e il punto più basso della morsa
+ClampingCoeffMin = nil              -- coefficiente di fissaggio, se 0 o nil non fa controllo, per il momento da inizializzare da Ts3Data
 MinJoinVV = 75
 MinJoinSS = 100
 MinJoinLS = 290
 MinJoinSL = 100
 MinJoinLL = 400
+DistHeadToCabinUnload = nil         -- distanza tra la paratia al carico e la testa macchina (Y) in valore assoluto
+DistHeadToCabinLoad = nil           -- distanza tra la paratia allo scarico e la testa macchina (Y) in valore assoluto
 
 -- costanti dimensioni utensili
 LONG_TOOL_MINLEN = 218.5
@@ -181,6 +183,8 @@ if EgtExistsFile( sData) then
          if Machine.Offsets.COEFF_CLAMP_CHECK then ClampingCoeffMin = Machine.Offsets.COEFF_CLAMP_CHECK end
          if Machine.Offsets.DIST_ROT_CENTER_B_TO_TOP_C then DistRotCenterBToTopC = EgtClamp( Machine.Offsets.DIST_ROT_CENTER_B_TO_TOP_C, 395, 410) end
          if Machine.Offsets.LONG_TOOL_MINLEN then LONG_TOOL_MINLEN = EgtClamp( Machine.Offsets.LONG_TOOL_MINLEN, 216, 226.1) end
+         if Machine.Offsets.DIST_HEAD_TO_CABIN_UNLOAD then DistHeadToCabinUnload = Machine.Offsets.DIST_HEAD_TO_CABIN_UNLOAD end
+         if Machine.Offsets.DIST_HEAD_TO_CABIN_LOAD then DistHeadToCabinLoad = Machine.Offsets.DIST_HEAD_TO_CABIN_LOAD end
       end
    end
 end
@@ -208,7 +212,19 @@ local BaseId = EmtBase {
       Name = 'Base',
       Geo='BASE/GEO',
       Aux = sBaseAux}
-
+-- Sposta la faccia interna alla cabina dei solidi di collisione se sono impostati nel TS3Data, valori positivi
+if DistHeadToCabinLoad then
+   local nSide1Id = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( BaseId, 'COLLISION'), 'SIDE1')
+   local b3Collision = EgtGetBBox( nSide1Id, GDB_BB.STANDARD)
+   local vtMove = Vector3d( -abs( DistHeadToCabinLoad) - b3Collision:getMax()[1], 0, 0)
+   EgtSurfTmMoveFacet( nSide1Id, 3, vtMove, GDB_RT.GLOB)
+end
+if DistHeadToCabinUnload then
+   local nSide2Id = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( BaseId, 'COLLISION'), 'SIDE2')
+   local b3Collision = EgtGetBBox( nSide2Id, GDB_BB.STANDARD)
+   local vtMove = Vector3d( abs( DistHeadToCabinUnload) - b3Collision:getMin()[1], 0, 0)
+   EgtSurfTmMoveFacet( nSide2Id, 3, vtMove, GDB_RT.GLOB)
+end
 local XId = EmtAxis {
       Name = 'X',
       Parent = 'Base',

MachNotes.ini

@@ -20,6 +20,7 @@
 2=d,OpenMinSafe,0
 3=d,OpenOutRaw,0
 4=l,MaxOptSize,0
+5=b,AdjustFeed,1
 
 [Mortising]
 0=l,MaxElev,0