Merge branch 'Marker' into develop

- Aggiunti movimenti simulazione cambio utensile

Beam/BeamData.lua

@@ -60,7 +60,7 @@ local BeamData = {
    ADVANCE_TAIL_CUT = true,                 -- per spostare prima del taglio di separazione il taglio di coda su pezzi corti con probabile caduta
    ADVANCE_TAIL_OFFS = 5,                   -- accorciamento taglio di coda avanzato (minimo 1)
    STRATEGIES_CONFIG_FILE = 'Std2.json',
-   FASTCLAMPING = true
+   FASTCLAMPING = false
 }
 
 -- Aggiornamento con dati da B&W

Beam/BeamDataNew.lua

@@ -38,7 +38,7 @@ local BeamData = {
    VICE_MINH = 110,                         -- altezza minima della morsa
    VICE_MAXH = 370,                         -- altezza massima zona pinzaggio orizzontale
    USER_HOLE_DIAM = 0,                      -- diametro foro per L20
-   FASTCLAMPING = true
+   FASTCLAMPING = false
 }
 
 -- costanti riportate da mlde non necessarie per automatismo (sostituire con GetParameters o simile)
@@ -93,7 +93,7 @@ local function GetBlockedAxis( sHead, nToolType, sBlockedAxis)
    elseif nToolType == MCH_TY.MORTISE_STD then
       if sHead == 'H3' then
          if sBlockedAxis == 'parallel' then
-            return 'CS=90'
+            return 'CS=-90'
          elseif sBlockedAxis == 'perpendicular' then
             return 'CS=0'
          end

Beam/EbwData.lua

@@ -16,7 +16,7 @@ local Offsets = {
    MAX_X2=-62,
    PARK_X2=-500,
    BEAM_LOAD=1800.0,
-   BEAM_UNLOAD=-2060,
+   BEAM_UNLOAD=-2150,
    TURN_OFFS=0,
    MILL_PIVOT=-211.00,
    TAB_OFFSET_Y=0,

Compile.bat

@@ -10,7 +10,7 @@ REM chiedo all'utente la versione da assegnare alla macchina da compilare
 set /p "machineVersion=Inserisci versione: "
 
 REM variabili per costruire i percorsi delle cartelle
-set "machineName=Saomad-KAIROS"
+set "machineName=Saomad-KAIROS-MK2"
 set "deployFolder=C:\MachinesDeploy"
 set "machinePath=%deployFolder%\%machineName%\"
 set "fullPathSource=%deployFolder%\%machineName%\%machineVersion%\%machineName%"
@@ -25,9 +25,9 @@ REM copio i sorgenti nel percorso temporaneo per i compilati
 ROBOCOPY . %fullPathSource%\bin\%machineName%\ /E /XF "Compile.bat" /XF ".gitignore" /XD ".git" /XF "UpdateLog.txt"
 
 REM copio i file compilati nel percorso temporaneo per i compilati
-\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Saomad-KAIROS.mlpe     		 	          -s Saomad-KAIROS.mlpe
-\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Saomad-KAIROS.mlse                        -s Saomad-KAIROS.mlse
-\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Saomad-KAIROS.SIEMENS.mlpe                -s Saomad-KAIROS.SIEMENS.mlpe
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Saomad-KAIROS-MK2.mlpe     		 	          -s Saomad-KAIROS-MK2.mlpe
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Saomad-KAIROS-MK2.mlse                        -s Saomad-KAIROS-MK2.mlse
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Saomad-KAIROS-MK2.SIEMENS.mlpe                -s Saomad-KAIROS-MK2.SIEMENS.mlpe
 
 REM comprimo i file compilati in uno zip pronto per essere distribuito
 tar.exe acvf %fullPathZip%\%machineName%.zip -C %fullPathSource%\bin\ %machineName%\*.*

Saomad-KAIROS-MK2.SIEMENS.mlpe

@@ -2,7 +2,7 @@
 -- Con controllo numerico Siemens
 
 -- Variabili di modulo
-local MLE_INFO = 'Saomad-KAIROS.SIEMENS.mlpe ver.'..PP_VER..' by EgalWare s.r.l.'
+local MLE_INFO = 'Saomad-KAIROS-MK2.SIEMENS.mlpe ver.'..PP_VER..' by EgalWare s.r.l.'
 local TEST_USE = false
 
 ---------------------------------------------------------------------
@@ -99,7 +99,6 @@ function OnToolData()
    local tToolType = { [256] = 'DRILL', [257] = 'DRILL_L', [512] = 'SAW', [513] = 'SAW_F', [1024] = 'MILL', [1025] = 'MILL_NT',
                        [1026] = 'POLISHING', [2048] = 'CHAINSAW', [4096] = 'CHISEL'}
    -- emissione dati utensile
-   --local sOut = ';'..EMT.TCPOS..' L='..EmtLenToString( EMT.TLEN, 3)..' D='..EmtLenToString( EMT.TDIAM, 3)..' A='..EgtIf( EMT.TUSED, '1', '0')..' '..( tToolType[EMT.TTYPE] or 'NONE')
    local sOut = ';'..EMT.TCPOS..' L='..EmtLenToString( EMT.TLEN, 3)..' D='..EmtLenToString( EMT.TDIAM, 3)..' A='..EgtIf( EMT.TUSED, '1', '0')..' '..EMT.TOOL
    MyEmtOutput( sOut)
 end
@@ -174,7 +173,7 @@ function OnDispositionEnd()
       end
       -- Inizio produzione trave
       if IdTrave >= 0 then
-         local BtlInfoId = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or EgtGetCurrMachGroup() or GDB_ID.NULL
+         local BtlInfoId = EgtGetCurrMachGroup() or EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or GDB_ID.NULL
          EMT.PRODID = EgtGetInfo( BtlInfoId, 'PRODID', 'i') or 0
          EMT.PATTID = EgtGetInfo( BtlInfoId, 'PATTID', 'i') or 0
          EMT.CUTID = EgtGetInfo( EMT.IDT, 'CUTID', 'i') or 0
@@ -359,40 +358,44 @@ function OnMachiningEnd()
    --for i = 1, #EMT.AUXCMD do
    --   MyEmtOutput( '( ' .. EMT.AUXCMD[i] .. ' )')
    --end
+
+   -- sincronizzazione e reset piano
+   MyEmtOutput( 'STOPRE')
+   MyEmtOutput( 'TRANS')
+
    EMT.AUXCMD = {}
    if #EMT.AUXSTR > 0 then
       if EMT.AUXTYPE == 'S' then
          -- EmitSpeedOff()
          MyEmtOutput( ';PART SPLIT')
       elseif EMT.AUXTYPE == 'U' then
-         if not EMT.ZMAX then
-            EmitZmax()
-            EMT.ZMAX = true
-         end
+         --if not EMT.ZMAX then
+         --   EmitZmax()
+         --   EMT.ZMAX = true
+         --end
          if IsLastMachining( EMT.MCHID) then
             -- EmitSpeedOff()
          end
          MyEmtOutput( ';PART UNLOAD')
-         MyEmtOutput( 'STOPRE')
-         MyEmtOutput( 'TRANS')
+
       elseif EMT.AUXTYPE == 'P' then
          if EMT.PREROT then
-            if not EMT.ZMAX then
-               EmitZmax()
-               EMT.ZMAX = true
-            end
+            --if not EMT.ZMAX then
+            --   EmitZmax()
+            --   EMT.ZMAX = true
+            --end
             MyEmtOutput( ';PART ROTATION')
          elseif EMT.FALL then
-            if not EMT.ZMAX then
-               EmitZmax()
-               EMT.ZMAX = true
-            end
+            --if not EMT.ZMAX then
+            --   EmitZmax()
+            --   EMT.ZMAX = true
+            --end
             MyEmtOutput( ';FALL')
          else
-            if not EMT.ZMAX then
-               EmitZmax()
-               EMT.ZMAX = true
-            end
+            --if not EMT.ZMAX then
+            --   EmitZmax()
+            --   EMT.ZMAX = true
+            --end
             MyEmtOutput( ';SPLIT 2')
          end
       end
@@ -430,6 +433,7 @@ function OnMachiningEnd()
    EMT.AUXTYPE = nil
    EMT.U_STD = nil
    EMT.PREVTOOL = EMT.TOOL
+   EMT.PREVHEAD = EMT.HEAD
    EMT.PREVR3 = EMT.R3
 end
 
@@ -541,13 +545,6 @@ function OnRapid()
    MyBackupAxes()
    -- se primo movimento della lavorazione, gestione speciale
    if EMT.MCHFIRST and not EMT.OPEISDISP then
-      -- decido se muovere prima testa o carrelli (standard prima testa)
-      local bHeadFirst = true
-      local sLateG101
-      if not ( EMT.LOAD or EMT.RELOAD) and not EMT.ZMAX then
-         local DeltaT = EMT.L1 - EMT.TLAST
-         if ( DeltaT < -GEO.EPS_SMALL and EMT.X2DELTA) or ( DeltaT > GEO.EPS_SMALL and EMT.X1DELTA) then bHeadFirst = false end
-      end
       -- sistemo movimenti
       MyAdjustLinearAxes()
       EmtAdjustRotaryAxes()
@@ -563,10 +560,10 @@ function OnRapid()
          SetStartValue( 2, EMT.WIDTHPART)
          SetStartValue( 3, EMT.HEIGHTPART)
          SetStartValue( 4, dPress)
-         SetStartValue( 5, dX1LoadPos)
-         SetStartValue( 6, EmtLenToString( ParkX1 + EMT.X1DELTA + 500, 3))  -- posizione per portare trave più vicino all'area di lavoro, ma con 500mm di sicurezza
-         SetStartValue( 7, dAcc)
-         SetStartValue( 8, dFeed)
+         SetStartValue( 5, dFeed)
+         SetStartValue( 6, dAcc)
+         SetStartValue( 7, dX1LoadPos)
+         SetStartValue( 8, EmtLenToString( ParkX1 + EMT.X1DELTA + 500, 3))  -- posizione per portare trave più vicino all'area di lavoro, ma con 500mm di sicurezza
 
          -- ora che ci sono tutti i dati, si scrivono info precarico e linee parcheggiate
          EmitStartValues()
@@ -583,97 +580,77 @@ function OnRapid()
          end
          EMT.AUXSTR = {}
          -- supporti in posizione intermedia
-         local sOut = 'SUPPORT(1,1)'
-         MyEmtOutput( sOut)
+         -- local sOut = 'SUPPORT(1,1)'
+         -- MyEmtOutput( sOut)
          -- prima lavorazione
-         sOut = EMT.MCHNAME..'/'..EMT.TOOL
-         MyEmtOutput( '; *** ' .. sOut .. ' ***')
+         local sOut = EMT.MCHNAME..'/'..EMT.TOOL
+         MyEmtOutput( '\n; *** ' .. sOut .. ' ***')
       -- altri casi
       else
          if not EMT.RELOAD and not EMT.ZMAX and #EMT.AUXSTR > 0 then
-            EmitZmax()
-            EMT.ZMAX = true
+            --EmitZmax()
+            --EMT.ZMAX = true
             EMT.PREVTOOL = EMT.TOOL
          end
+
+         -- se si spostano i carrelli, si chiude lavorazione precedente
          if bMoveChar then
-            local bStoPre
             if EMT.CHAN2 then
                -- MyEmtOutput( 'WAIT_CHAN(2)')
                MyEmtOutput( 'STOPRE')
-               bStoPre = true
                EMT.CHAN2 = nil
             end
             if EMT.TRAILON then
                MyEmtOutput( 'TRAILOF(X2,X1)')
-               MyEmtOutput( 'STOPRE')
-               MyEmtOutput( 'TRANS')
-               bStoPre = true
                EMT.TRAILON = nil
             end
-            if not bStoPre then MyEmtOutput( 'STOPRE') end
-            MyEmtOutput( '')
+         end
+
+         local sOut = EMT.MCHNAME..'/'..EMT.TOOL
+         MyEmtOutput( '\n; *** ' .. sOut .. ' ***')
+
+         -- se ci sono movimenti carrelli
+         EMT.AUXCMD = {}
+         if EMT.AUXSTR and #EMT.AUXSTR > 0 then
             EMT.NSTEP = EMT.NSTEP + 10
             local sStep = EgtNumToString( EMT.NSTEP, 0)
             MyEmtOutput( '_STEP='..sStep)
+            for i = 1, #EMT.AUXSTR do
+               MyEmtOutput( EMT.AUXSTR[i])
+            end
+            MyEmtOutput( '_N'..sStep..':STOPRE')
          end
-         local sOut = EMT.MCHNAME..'/'..EMT.TOOL
-         MyEmtOutput( '; *** ' .. sOut .. ' ***')
-         -- movimento carrelli
-         EMT.AUXCMD = {}
-         for i = 1, #EMT.AUXSTR do
-            MyEmtOutput( EMT.AUXSTR[i])
-         end
+
          EMT.AUXSTR = {}
          EMT.POSTROT = false
          EMT.RELOAD = false
          EMT.RELOAD2 = nil
          EMT.CHAN2 = bMoveChar
+
       end
-      -- se utensile appena selezionato, lo devo dichiarare
-      if EMT.TSELECT then
-         EMT.TSELECT = nil
-         if bMoveChar then
-            local sStep = EgtNumToString( EMT.NSTEP, 0)
-            MyEmtOutput( '_N'..sStep..':STOPRE')
-         end
-         local sOut = 'PRE_WORK(1,1,' .. EMT.TOOLSEL .. ','..EgtNumToString( EMT.S, 0) ..',,,,)'
-         MyEmtOutput( sOut)
-         EMT.SPEED_ON = true
-      -- eventuali emissioni per ripartenza successiva al carico
-      elseif bMoveChar then
-         local sStep1 = EgtNumToString( EMT.NSTEP + 1, 0)
+
+      -- gestione ripartenza
+      EMT.NSTEP = EMT.NSTEP + 10
+      local sStep = EgtNumToString( EMT.NSTEP, 0)
+      MyEmtOutput( '_STEP='..sStep)
+      local sStep1 = EgtNumToString( EMT.NSTEP + 1, 0)
+      if not EMT.LOAD then
          MyEmtOutput( 'GOTOF '..'_N'..sStep1)
-         local sStep = EgtNumToString( EMT.NSTEP, 0)
-         MyEmtOutput( '_N'..sStep..':STOPRE')
+      end
+
+      sStep = EgtNumToString( EMT.NSTEP, 0)
+      MyEmtOutput( '; se ripartenza')
+      MyEmtOutput( '_N'..sStep..':STOPRE')
+      -- se è il marcatore, non si scrive la PRE_WORK e si spegne mandrino se è acceso
+      if EMT.HEAD == 'H4' then
+         EmitSpeedOff()
+      else
          local sOut = 'PRE_WORK(1,1,' .. EMT.TOOLSEL .. ','..EgtNumToString( EMT.S, 0) ..',,,,)'
-         MyEmtOutput( sOut)
          EMT.SPEED_ON = true
-         MyEmtOutput( '_N'..sStep1..':STOPRE')
+         MyEmtOutput( sOut)
       end
       -- eventuale avvio mandrino (se non già avviato)
-      EmitSpeedOn( EMT.S)
-      -- primo posizionamento testa rispetto a 0M
-      EmtResetPrev()
-      local sOut
-      if EMT.ZMAX then
-         sOut = 'SUPA G0 D0 Z'..EgtNumToString( ParkZ, 3)
-      else
-         -- sOut = 'SUPA G0 D0' .. EmtGetAxis( 'L3')
-      end
-      MyEmtOutput( sOut)
-      -- sega a catena da gestire
-      if EMT.HEAD == 'H3' then
-         MyEmtOutput( '!!! Chainsaw start movements to be calculated !!!')
-         EgtOutLog( 'ERROR : CHAINSAW START MOVEMENTS TO BE CALCULATED !!!')
-      end
-      -- movimento YAC con interpolazione approssimata tramite F opportune per ogni asse
-      local dFeedY, dFeedA, dFeedC = CalcFeedYAC( EMT.L2opp - EMT.L2, EMT.R2pp - EMT.R2, EMT.R1pp - EMT.R1)
-      --sOut = '_POSIZ_YAC('..EgtNumToString( EMT.L2, 3)..','..EgtNumToString( EMT.R2, 3)..','..EgtNumToString( EMT.R1, 3)..','.. EgtNumToString( FmaxY, 0)..',,)'
-      sOut = 'TRANS'
-      MyEmtOutput( sOut)
-
-      sOut = 'G1 Y=' .. EgtNumToString( EMT.L2, 3)..' A1='..EgtNumToString( EMT.R2, 3)..' C1='..EgtNumToString( EMT.R1, 3) .. ' F' .. EgtNumToString( FmaxY, 3)
-      MyEmtOutput( sOut)
+      -- EmitSpeedOn( EMT.S)
 
       -- si ripete macro di carico con opzione di precarico eseguito
       if EMT.LOAD then
@@ -681,66 +658,136 @@ function OnRapid()
          EMT.PRELOADCMD = nil
       end
 
-      EMT.LOAD = false
-
-      -- se ho lanciato split in modo asincrono, dopo POSIZ_YAC devo attendere
-      if EMT.WAIT_SPLIT then
-         sOut = 'WAITP(X1)'
-         MyEmtOutput( sOut)
-         EMT.WAIT_SPLIT = nil
-      end
-
-      -- se necessario, attesa fine movimenti carrelli e presa assi relativi
-      if bMoveChar then
-         sOut = 'WAIT_CHAN(2)'
-         MyEmtOutput( sOut)
-         EMT.CHAN2 = nil
-
-         if EMT.X1DELTA and EMT.X2DELTA then
-            MyEmtOutput( 'GET(X1,X2)')
-            MyEmtOutput( 'STOPRE')
-            MyEmtOutput( 'TRAILON(X2,X1)')
-            EMT.TRAILON = true
-         elseif EMT.X1DELTA then
-            MyEmtOutput( 'GET(X1)')
-         elseif EMT.X2DELTA then
-            MyEmtOutput( 'GET(X2)')
-         end
-      end
-      -- assegnazione assi geometrici (GEOAX)
-      MyEmtOutput( 'TRANS')
-      if EMT.X1DELTA then
-         sOut = 'GEOAX(1,X1,2,Y1,3,Z1)'
-      else
-         sOut = 'GEOAX(1,X2,2,Y1,3,Z1)'
-      end
+      sOut = 'G1 Y=' .. EgtNumToString( EMT.L2, 3)..' A1='..EgtNumToString( EMT.R2, 3)..' C1='..EgtNumToString( EMT.R1, 3) .. ' F' .. EgtNumToString( FmaxY, 3)
       MyEmtOutput( sOut)
 
-      -- dopo aver spostato i carrelli, lancio precarico
-      -- se taglio di coda senza residuo da scaricare, emetto macro per accelerare il carico della barra successiva
-      if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') and not EMT.PRELOAD then
-         EMT.PRELOAD = true
-         sOut = '_POSIZ_T(4,,,,,,,,,)'  -- Lancio macro per carico anticipato: i valori sono presi dal plc (passati dall'interfaccia)
-         MyEmtOutput( sOut)
+      if EMT.LOAD then
+         MyEmtOutput( 'WAIT_CHAN(2)')
+         EMT.CHAN2 = nil
       end
 
-      MyEmtOutput( 'G90 G17')
-      -- primo posizionamento carrello rispetto a 0M
-      if EMT.X1DELTA then
-         local dPosX1 = EMT.L1 + EMT.X1DELTA
-         sOut = 'G1 X' .. EmtLenToString( dPosX1, 3) .. ' F' .. GetClampFeed( EMT.LENGTHBEAM)
-         MyEmtOutput( sOut)
+      if EMT.X1DELTA and EMT.X2DELTA then
+         MyEmtOutput( 'GET(X1,X2)')
+         MyEmtOutput( 'STOPRE')
+         MyEmtOutput( 'TRAILON(X2,X1)')
+         EMT.TRAILON = true
+      elseif EMT.X1DELTA then
+         MyEmtOutput( 'GET(X1)')
       elseif EMT.X2DELTA then
-         local dPosX2 = EMT.L1 + EMT.X2DELTA
-         sOut = 'G1 X' .. EmtLenToString( dPosX2, 3) .. ' F' .. GetClampFeed( EMT.LENGTHBEAM)
-         MyEmtOutput( sOut)
-      else
-         EmtSetLastError( 1213, "Part to machine without charriots")
+         MyEmtOutput( 'GET(X2)')
       end
-      if EMT.ZMAX and EMT.L3 < ParkZ - 10 then
-         sOut = 'SUPA G0 D0' .. EmtGetAxis( 'L3')
-         MyEmtOutput( sOut)
+
+      -- se stato pinza attiva non coerente con master, si riscrivono gli assi
+      if EMT.X1DELTA  then
+         MyEmtOutput( 'GEOAX(1,X1,2,Y1,3,Z1)')
+         MyEmtOutput( 'G90 G17')
+      elseif EMT.X2DELTA then
+         MyEmtOutput( 'GEOAX(1,X2,2,Y1,3,Z1)')
+         MyEmtOutput( 'G90 G17')
       end
+
+      if not EMT.LOAD then
+         local sStep2 = EgtNumToString( EMT.NSTEP + 2, 0)
+         MyEmtOutput( 'GOTOF '..'_N'..sStep2)
+         MyEmtOutput( '; ciclo standard')
+         MyEmtOutput( '_N'..sStep1..':STOPRE')
+         
+         -- se è il marcatore, non si scrive la PRE_WORK e si spegne mandrino se è acceso
+         if EMT.HEAD == 'H4' then
+            EmitSpeedOff()
+         else
+            if EMT.TSELECT then
+               local sOut = 'PRE_WORK(1,1,' .. EMT.TOOLSEL .. ','..EgtNumToString( EMT.S, 0) ..',,,,)'
+               EMT.SPEED_ON = true
+               MyEmtOutput( sOut)
+            end
+         end
+
+
+         if bMoveChar then
+            sOut = 'G1 Y=' .. EgtNumToString( EMT.L2, 3)..' A1='..EgtNumToString( EMT.R2, 3)..' C1='..EgtNumToString( EMT.R1, 3) .. ' F' .. EgtNumToString( FmaxY, 3)
+            MyEmtOutput( sOut)
+            MyEmtOutput( 'WAIT_CHAN(2)')
+
+            -- dopo aver spostato i carrelli, lancio precarico
+            -- se taglio di coda senza residuo da scaricare, emetto macro per accelerare il carico della barra successiva
+            if EMT.MCHUSERNOTES and EMT.MCHUSERNOTES:find( 'Cut') and not EMT.PRELOAD then
+               EMT.PRELOAD = true
+               MyEmtOutput( '_POSIZ_T(4,,,,,,,,,)')  -- Lancio macro per carico anticipato: i valori sono presi dal plc (passati dall'interfaccia)
+            end
+
+            EMT.CHAN2 = nil
+            if EMT.X1DELTA and EMT.X2DELTA then
+               MyEmtOutput( 'GET(X1,X2)')
+               MyEmtOutput( 'STOPRE')
+               MyEmtOutput( 'TRAILON(X2,X1)')
+               EMT.TRAILON = true
+            elseif EMT.X1DELTA then
+               MyEmtOutput( 'GET(X1)')
+            elseif EMT.X2DELTA then
+               MyEmtOutput( 'GET(X2)')
+            end
+            -- se stato pinza attiva non coerente con master, si riscrivono gli assi
+            if EMT.X1DELTA or EMT.X2DELTA then
+               if EMT.X1DELTA and not EMT.X1MASTER then
+                  EMT.X1MASTER = true
+                  MyEmtOutput( 'GEOAX(1,X1,2,Y1,3,Z1)')
+                  MyEmtOutput( 'G90 G17')
+               elseif EMT.X2DELTA and ( EMT.X1MASTER and not EMT.X1DELTA) then
+                  EMT.X1MASTER = false
+                  MyEmtOutput( 'GEOAX(1,X2,2,Y1,3,Z1)')
+                  MyEmtOutput( 'G90 G17')
+               end
+            end
+            -- primo posizionamento carrello rispetto a 0M
+            if EMT.X1DELTA then
+               local dPosX1 = EMT.L1 + EMT.X1DELTA
+               sOut = 'G1 X' .. EmtLenToString( dPosX1, 3) .. ' F' .. GetClampFeed( EMT.LENGTHBEAM)
+               MyEmtOutput( sOut)
+            elseif EMT.X2DELTA then
+               local dPosX2 = EMT.L1 + EMT.X2DELTA
+               sOut = 'G1 X' .. EmtLenToString( dPosX2, 3) .. ' F' .. GetClampFeed( EMT.LENGTHBEAM)
+               MyEmtOutput( sOut)
+            else
+               EmtSetLastError( 1213, "Part to machine without charriots")
+            end
+         else
+            -- movimento di tutti gli assi assieme
+            if EMT.X1DELTA then
+               local dPosX1 = EMT.L1 + EMT.X1DELTA
+               sOut = 'G1 X=' .. EmtLenToString( dPosX1, 3) .. ' Y=' .. EgtNumToString( EMT.L2, 3)..
+                        ' A1='..EgtNumToString( EMT.R2, 3).. ' C1='..EgtNumToString( EMT.R1, 3).. ' F' .. GetClampFeed( EMT.LENGTHBEAM)
+               MyEmtOutput( sOut)
+            elseif EMT.X2DELTA then
+               local dPosX2 = EMT.L1 + EMT.X2DELTA
+               sOut = 'G1 X' .. EmtLenToString( dPosX2, 3) .. ' Y=' .. EgtNumToString( EMT.L2, 3)..
+                        ' A1='..EgtNumToString( EMT.R2, 3).. ' C1='..EgtNumToString( EMT.R1, 3).. ' F' .. GetClampFeed( EMT.LENGTHBEAM)
+               MyEmtOutput( sOut)
+            else
+               EmtSetLastError( 1213, "Part to machine without charriots")
+            end
+
+            -- se ho lanciato split in modo asincrono, dopo POSIZ_YAC devo attendere
+            if EMT.WAIT_SPLIT then
+               MyEmtOutput( 'WAITP(X1)')
+               EMT.WAIT_SPLIT = nil
+            end
+         end
+
+         MyEmtOutput( '_N'..sStep2..':STOPRE')
+      end
+
+
+      -- primo posizionamento testa rispetto a 0M
+      EmtResetPrev()
+      -- sega a catena da gestire
+      if EMT.HEAD == 'H3' then
+         MyEmtOutput( '!!! Chainsaw start movements to be calculated !!!')
+         EgtOutLog( 'ERROR : CHAINSAW START MOVEMENTS TO BE CALCULATED !!!')
+      end
+
+      EMT.LOAD = false
+
       -- se taglio di separazione prima di scarico a caduta, emissione stop tappeto scarico trucioli
       if EMT.PREFALLCUT then
          MyEmtOutput( ';M29')
@@ -749,6 +796,7 @@ function OnRapid()
       EMT.REFLOC = 0
       EMT.MCHFIRST = false
       EMT.ZMAX = false
+      EMT.TSELECT = false
 
       -- se alto in Z (non serve l'avvicinamento finale)
       if EMT.FLAG == 2 then
@@ -760,7 +808,6 @@ function OnRapid()
       else
          MyRestoreAxes()
       end
-
    end
    -- se standard
    if EMT.FLAG == 0 or EMT.FLAG == 1 or EMT.FLAG == 2 then
@@ -784,7 +831,7 @@ function OnRapid()
       EMT.IPLGL = false
       MyAdjustLinearAxes()
       EmtAdjustRotaryAxes()
-      EmitZmax()
+      EmitZmax( EMT.L3)
       EMT.ZMAX = true
    -- se altrimenti movimento in Home
    elseif EMT.FLAG == 4 then
@@ -939,21 +986,6 @@ function CalcCharStatus( sCmd, bSkipPress)
    end
 end
 
----------------------------------------------------------------------
-function CalcFeedYAC( dDeltaY, dDeltaA, dDeltaC)
-   local dTY = abs( dDeltaY) / FmaxY
-   local dTA = abs( dDeltaA) / FmaxA
-   local dTC = abs( dDeltaC) / FmaxC
-   local dT = max( dTY, dTA, dTC)
-   local dFeedY = FmaxY
-   if dTY > 0.001 then dFeedY = FmaxY * dTY / dT end
-   local dFeedA = FmaxA
-   if dTA > 0.001 then dFeedA = FmaxA * dTA / dT end
-   local dFeedC = FmaxC
-   if dTC > 0.001 then dFeedC = FmaxC * dTC / dT end
-   return dFeedY, dFeedA, dFeedC
-end
-
 ---------------------------------------------------------------------
 function PrepareLoad( sCmd, bStart)
    local Cmd = EgtSplitString( sCmd)
@@ -1063,7 +1095,7 @@ function PrepareMoveChar( sCmd)
       if Cmd[2] == '0' and EMT.X1CLAMP then
          EMT.X1CLAMP = nil
          table.insert( CLAMP_POS, 'GRIPPER("AP1",,)')
-      elseif not EMT.X1CLAMP and Cmd[2] ~= '0' then
+      elseif ( not EMT.X1CLAMP or not EMT.X1DELTA) and Cmd[2] ~= '0' then
          EMT.X1CLAMP = true
          local sVertClamp = EgtIf( Cmd[2] == '2', '1', '0')
          table.insert( CLAMP_POS, 'GRIPPER("CH1",'.. sVertClamp ..',2.5)')
@@ -1072,7 +1104,7 @@ function PrepareMoveChar( sCmd)
       if Cmd[2] == '0' and EMT.X2CLAMP then
          EMT.X2CLAMP = nil
          table.insert( CLAMP_POS, 'GRIPPER("AP2",,)')
-      elseif not EMT.X2CLAMP and Cmd[2] ~= '0' then
+      elseif ( not EMT.X2CLAMP or not EMT.X2DELTA) and Cmd[2] ~= '0' then
          EMT.X2CLAMP = true
          local sVertClamp = EgtIf( Cmd[2] == '2', '1', '0')
          table.insert( CLAMP_POS, 'GRIPPER("CH2",'.. sVertClamp ..',2.5)')
@@ -1090,130 +1122,161 @@ function PrepareMoveChar( sCmd)
          EMT.X1DELTA = nil
          EMT.X2DELTA = dX2Delta
       end
-      table.insert( ALL_CLAMP_POS, CLAMP_POS)
-      CLAMP_POS = {}
-      local nFunz = 77
-      local nVertClamp = 0
-      local dPress = 2.5
-      local dFeed = GetClampFeed( EMT.LENGTHPART)
-      local dAcc = 4
-      local nOpt = #ALL_CLAMP_POS * 100
-      local sOut = string.format( '_POSIZ_T(%d,,,,,%d,,,,,,)', nFunz, nOpt)
-      table.insert( EMT.AUXSTR, sOut)
+      -- se ci sono movimenti, si scrive macro
+      if #CLAMP_POS > 0 then
+         table.insert( ALL_CLAMP_POS, CLAMP_POS)
+         CLAMP_POS = {}
+         local nFunz = 77
+         local nVertClamp = 0
+         local dPress = 2.5
+         local dFeed = GetClampFeed( EMT.LENGTHPART)
+         local dAcc = 4
+         local nOpt = #ALL_CLAMP_POS * 100
+         local sOut = string.format( '_POSIZ_T(%d,,,,,%d,,,,,,)', nFunz, nOpt)
+         table.insert( EMT.AUXSTR, sOut)
+      end
    end
 end
 
 ---------------------------------------------------------------------
 function PrepareResidue( sCmd)
    local Cmd = EgtSplitString( sCmd)
-   if Cmd[1] == '0' then
-      -- se non è scarico
-      if Cmd[2] ~= 'Unloading' then
-         -- se inizio
-         if EMT.AUXIND <= 2 then
-            -- reset stato
-            EMT.MCIND = 0
-            EMT.X1STAT = 0
-            EMT.X2STAT = 0
-            EMT.MCX1 = {}
-            EMT.MCX2 = {}
+   -- se terminato posizionamenti e si deve scaricare
+   if EMT.UNL then
+      if Cmd[1] == '0' then
+      elseif Cmd[1] == '1' then
+         if Cmd[2] ~= 'Z' then
+            EMT.NSTEP = EMT.NSTEP + 10
+            local sStep = EgtNumToString( EMT.NSTEP, 0)
+            local sOut = '_STEP='..sStep
+            table.insert( EMT.AUXSTR, sOut)
+            local sX2Pos =  Cmd[3]
+            sOut = string.format( 'G1 X=%s F=%d', sX2Pos, EMT.FMAXPINZE)
+            table.insert( EMT.AUXSTR, sOut)
+            sOut = '_POSIZ_T(5,,,,,2,,,,)'  -- attiva spintore scarico pezzo restanto su processo 1
+            table.insert( EMT.AUXSTR, sOut)
+            sOut = '_N'..sStep..':STOPRE\n'
+            table.insert( EMT.AUXSTR, sOut)
          end
-      else
-         EMT.UNL = true
-      end
-   elseif Cmd[1] == '1' then
-      if Cmd[2] ~= 'Z' then
-         EMT.MCIND = EMT.MCIND + 1
-         if Cmd[2] == 'X1' then
-            EMT.MCX1[EMT.MCIND] = tonumber( Cmd[3])
-            EMT.MCX2[EMT.MCIND] = 0
-         elseif Cmd[2] == 'X2' then
-            EMT.MCX1[EMT.MCIND] = 0
-            EMT.MCX2[EMT.MCIND] = tonumber( Cmd[3])
-         end
-      end
-   elseif Cmd[1] == '2' then
-      EMT.MCIND = EMT.MCIND + 1
-      for i = 2, 4, 2 do
-         if Cmd[i] == 'X1' then
-            EMT.MCX1[EMT.MCIND] = tonumber( Cmd[i+1])
-         elseif Cmd[i] == 'X2' then
-            EMT.MCX2[EMT.MCIND] = tonumber( Cmd[i+1])
-         end
-      end
-      if not EMT.MCX1[EMT.MCIND] then EMT.MCX1[EMT.MCIND] = 0 end
-      if not EMT.MCX2[EMT.MCIND] then EMT.MCX2[EMT.MCIND] = 0 end
-   elseif Cmd[1] == '3' then
-      EMT.MCIND = EMT.MCIND + 1
-      for i = 2, 6, 2 do
-         if Cmd[i] == 'X1' then
-            EMT.MCX1[EMT.MCIND] = tonumber( Cmd[i+1])
-         elseif Cmd[i] == 'X2' then
-            EMT.MCX2[EMT.MCIND] = tonumber( Cmd[i+1])
-         end
-      end
-   elseif Cmd[1] == '11' then
-      EMT.X1STAT = tonumber( Cmd[2])
-      if Cmd[2] == 0 then
-         EMT.X1CLAMP = nil
-      else
-         EMT.X1CLAMP = true
-      end
-   elseif Cmd[1] == '12' then
-      if Cmd[2] == 0 then
-         EMT.X2CLAMP = nil
-      else
-         EMT.X2CLAMP = true
-      end
-      EMT.X2STAT = tonumber( Cmd[2])
-      if EMT.UNL and EMT.X2STAT == 0 then
-         -- local sWait = 'WAIT_CHAN(2)'
-         -- table.insert( EMT.AUXSTR, sWait)
-         local sSync = 'STOPRE'
-         table.insert( EMT.AUXSTR, sSync)
-         local nFunz = 6
-         local nVertClamp = 0
-         local dPress = 2.5
-         local dFeed = GetClampFeed( EMT.LENGTHPART)
-         local dAcc = 4
-         local nOpt = 0
-         local sRef1 = EMT.MCX2[#EMT.MCX2]
-         local sRef2 = EmtLenToString( ParkX2 - ( EMT.LENGTHBEAM - EMT.X2DELTA), 3)
-         local sOut = string.format( '_POSIZ_T(%d,%d,%.1f,%.1f,%.1f,%d,%s,%s,,)', nFunz, nVertClamp, dPress, dFeed, dAcc, nOpt, sRef1, sRef2)
+      elseif Cmd[1] == '2' then
+         EMT.NSTEP = EMT.NSTEP + 10
+         local sStep = EgtNumToString( EMT.NSTEP, 0)
+         local sOut = '_STEP='..sStep
          table.insert( EMT.AUXSTR, sOut)
-      end
-   elseif Cmd[1] == '21' then
-      local dX1Delta = tonumber( Cmd[2])
-      local dX2Delta = tonumber( Cmd[3])
-      if dX1Delta > 0 and dX2Delta > 0 then
-         EMT.X1DELTA = dX1Delta
-         EMT.X2DELTA = dX2Delta
-      elseif dX1Delta > 0 then
-         EMT.X1DELTA = dX1Delta
-         EMT.X2DELTA = nil
-      elseif dX2Delta > 0 then
-         EMT.X1DELTA = nil
-         EMT.X2DELTA = dX2Delta
-      end
-      if EMT.AUXIND > 1 then
-         local sInfo = string.format( ';X1->X2 D2=%.1f', EMT.LENGTHBEAM - EMT.X2DELTA)
-         table.insert( EMT.AUXSTR, sInfo)
-         local sWait = 'WAIT_CHAN(2)'
-         table.insert( EMT.AUXSTR, sWait)
-         local sSync = 'STOPRE'
-         table.insert( EMT.AUXSTR, sSync)
-         local nFunz = 31
-         local nVertClamp = 0
-         local dPress = 2.5
-         local dFeed = GetClampFeed( EMT.LENGTHBEAM)
-         local dAcc = 4
-         local nOpt = EgtIf( EMT.MCIND >= 3, 2, 1)
-         local sRef1 = EmtLenToString( EMT.MCX1[1], 3)
-         local sRef2 = EmtLenToString( EMT.MCX2[1], 3)
-         local sRef3 = EmtLenToString( EMT.MCX1[2], 3)
-         local sRef4 = EmtLenToString( EgtIf( EMT.MCX2[2] == 0, EMT.MCX2[1], EMT.MCX2[2]), 3)
-         local sOut = string.format( '_POSIZ_T(%d,%d,%.1f,%.1f,%.1f,%d,%s,%s,%s,%s)', nFunz, nVertClamp, dPress, dFeed, dAcc, nOpt, sRef1, sRef2, sRef3, sRef4)
+         local sX2Pos = Cmd[5]
+         sOut = string.format( 'G1 X=%s F=%d', sX2Pos, EMT.FMAXPINZE)
          table.insert( EMT.AUXSTR, sOut)
+         sOut = '_N'..sStep..':STOPRE\n'
+         table.insert( EMT.AUXSTR, sOut)
+      elseif Cmd[1] == '3' then
+         -- non gestito
+      elseif Cmd[1] == '11' then
+         -- non gestito
+      elseif Cmd[1] == '12' then
+         EMT.NSTEP = EMT.NSTEP + 10
+         local sStep = EgtNumToString( EMT.NSTEP, 0)
+         local sOut = '_STEP='..sStep
+         table.insert( EMT.AUXSTR, sOut)
+         sOut = '_POSIZ_T(5,,,,,1,,,,)'  -- apre pinza 2 restando su processo 1
+         table.insert( EMT.AUXSTR, sOut)
+         sOut = '_N'..sStep..':STOPRE\n'
+         table.insert( EMT.AUXSTR, sOut)
+      elseif Cmd[1] == '21' then
+         -- non interessa
+      end
+   else
+      if Cmd[1] == '0' then
+         -- se è scarico
+         if Cmd[2] == 'Unloading' then
+            EMT.UNL = true
+            -- Lancio macro per carico anticipato: i valori sono presi dal plc (passati dall'interfaccia)
+            local sOut = '_POSIZ_T(4,,,,,,,,,)'
+            table.insert( EMT.AUXSTR, sOut)
+         end
+      elseif Cmd[1] == '1' then
+         if Cmd[2] ~= 'Z' then
+            local dFeed1 = EgtIf( EMT.X1CLAMP, GetClampFeed( EMT.LENGTHPART), EMT.FMAXPINZE)
+            local dFeed2 = EgtIf( EMT.X2CLAMP, GetClampFeed( EMT.LENGTHPART), EMT.FMAXPINZE)
+            local dX1Pos = GetValInString( sCmd, 'X1')
+            local dX2Pos = GetValInString( sCmd, 'X2')
+            table.insert( CLAMP_POS, '###_ADD_STEP_###')
+            if dX1Pos and dX2Pos then
+               table.insert( CLAMP_POS, string.format( 'POS[X1]=%.3f POS[X2]=%.3f FA[X1]=%d FA[X2]=%d', dX1Pos, dX2Pos, dFeed1, dFeed2))
+            elseif dX1Pos then
+               table.insert( CLAMP_POS, string.format( 'G1 X1=%.3f F=%d', dX1Pos, dFeed1))
+            elseif dX2Pos then
+               table.insert( CLAMP_POS, string.format( 'G1 X2=%.3f F=%d', dX2Pos, dFeed2))
+            end
+         end
+      elseif Cmd[1] == '2' then
+         local dFeed1 = EgtIf( EMT.X1CLAMP, GetClampFeed( EMT.LENGTHPART), EMT.FMAXPINZE)
+         local dFeed2 = EgtIf( EMT.X2CLAMP, GetClampFeed( EMT.LENGTHPART), EMT.FMAXPINZE)
+         local dX1Pos = GetValInString( sCmd, 'X1')
+         local dX2Pos = GetValInString( sCmd, 'X2')
+         table.insert( CLAMP_POS, '###_ADD_STEP_###')
+         if dX1Pos and dX2Pos then
+            table.insert( CLAMP_POS, string.format( 'POS[X1]=%.3f POS[X2]=%.3f FA[X1]=%d FA[X2]=%d', dX1Pos, dX2Pos, dFeed1, dFeed2))
+         elseif dX1Pos then
+            table.insert( CLAMP_POS, string.format( 'G1 X1=%.3f F=%d', dX1Pos, dFeed1))
+         elseif dX2Pos then
+            table.insert( CLAMP_POS, string.format( 'G1 X2=%.3f F=%d', dX2Pos, dFeed2))
+         end
+      elseif Cmd[1] == '3' then
+         local dFeed1 = EgtIf( EMT.X1CLAMP, GetClampFeed( EMT.LENGTHPART), EMT.FMAXPINZE)
+         local dFeed2 = EgtIf( EMT.X2CLAMP, GetClampFeed( EMT.LENGTHPART), EMT.FMAXPINZE)
+         local dX1Pos = GetValInString( sCmd, 'X1')
+         local dX2Pos = GetValInString( sCmd, 'X2')
+         table.insert( CLAMP_POS, '###_ADD_STEP_###')
+         table.insert( CLAMP_POS, string.format( 'POS[X1]=%.3f POS[X2]=%.3f FA[X1]=%d FA[X2]=%d', dX1Pos, dX2Pos, dFeed1, dFeed2))
+      elseif Cmd[1] == '11' then
+         if Cmd[2] == '0' and EMT.X1CLAMP then
+            EMT.X1CLAMP = nil
+            table.insert( CLAMP_POS, 'GRIPPER("AP1",,)')
+         elseif not EMT.X1CLAMP and Cmd[2] ~= '0' then
+            EMT.X1CLAMP = true
+            local sVertClamp = EgtIf( Cmd[2] == '2', '1', '0')
+            table.insert( CLAMP_POS, 'GRIPPER("CH1",'.. sVertClamp ..',2.5)')
+         end
+      elseif Cmd[1] == '12' then
+         if Cmd[2] == '0' and EMT.X2CLAMP then
+            EMT.X2CLAMP = nil
+            table.insert( CLAMP_POS, 'GRIPPER("AP2",,)')
+         elseif not EMT.X2CLAMP and Cmd[2] ~= '0' then
+            EMT.X2CLAMP = true
+            local sVertClamp = EgtIf( Cmd[2] == '2', '1', '0')
+            table.insert( CLAMP_POS, 'GRIPPER("CH2",'.. sVertClamp ..',2.5)')
+         end
+      elseif Cmd[1] == '21' then
+         local dX1Delta = tonumber( Cmd[2])
+         local dX2Delta = tonumber( Cmd[3])
+         if dX1Delta > 0 and dX2Delta > 0 then
+            EMT.X1DELTA = dX1Delta
+            EMT.X2DELTA = dX2Delta
+         elseif dX1Delta > 0 then
+            EMT.X1DELTA = dX1Delta
+            EMT.X2DELTA = nil
+         elseif dX2Delta > 0 then
+            EMT.X1DELTA = nil
+            EMT.X2DELTA = dX2Delta
+         end
+         -- se ci sono movimenti, si scrive macro
+         if #CLAMP_POS > 0 then
+            table.insert( ALL_CLAMP_POS, CLAMP_POS)
+            CLAMP_POS = {}
+            EMT.NSTEP = EMT.NSTEP + 10
+            local sStep = EgtNumToString( EMT.NSTEP, 0)
+            table.insert( EMT.AUXSTR, '_STEP='..sStep)
+            local nFunz = 77
+            local nVertClamp = 0
+            local dPress = 2.5
+            local dFeed = GetClampFeed( EMT.LENGTHPART)
+            local dAcc = 4
+            local nOpt = #ALL_CLAMP_POS * 100
+            local sOut = string.format( '_POSIZ_T(%d,,,,,%d,,,,,,)', nFunz, nOpt)
+            table.insert( EMT.AUXSTR, sOut)
+            sOut = '_N'..sStep..':STOPRE\n'
+            table.insert( EMT.AUXSTR, sOut)
+         end
       end
    end
 end
@@ -1276,12 +1339,28 @@ function PrepareUnload( sCmd)
             local sStep = EgtNumToString( EMT.NSTEP, 0)
             local sOut = '_STEP='..sStep
             table.insert( EMT.AUXSTR, sOut)
+            sOut = '_N'..sStep..':STOPRE'
+            table.insert( EMT.AUXSTR, sOut)
             local sX2Pos =  Cmd[3]
-            sOut = string.format( 'G1 X=%s F=%d', sX2Pos, EMT.FMAXPINZE)
+            sOut = string.format( 'POS[X2]=%s FA[X2]=%d', sX2Pos, EMT.FMAXPINZE)
             table.insert( EMT.AUXSTR, sOut)
-            sOut = '_POSIZ_T(5,,,,,2,,,,)'  -- attiva spintore scarico pezzo restanto su processo 1
+            sOut = '_POSIZ_T(5,,,,,3,,,,)\n'  -- discesa blocco pezzo
             table.insert( EMT.AUXSTR, sOut)
-            sOut = '_N'..sStep..':STOPRE\n'
+            EMT.NSTEP = EMT.NSTEP + 10
+            sStep = EgtNumToString( EMT.NSTEP, 0)
+            sOut = '_STEP='..sStep
+            table.insert( EMT.AUXSTR, sOut)
+            sOut = '_N'..sStep..':STOPRE'
+            table.insert( EMT.AUXSTR, sOut)
+            sOut = '_POSIZ_T(5,,,,,4,,,,)\n'  -- pistone scarico avanti per spingere pezzo
+            table.insert( EMT.AUXSTR, sOut)
+            EMT.NSTEP = EMT.NSTEP + 10
+            sStep = EgtNumToString( EMT.NSTEP, 0)
+            sOut = '_STEP='..sStep
+            table.insert( EMT.AUXSTR, sOut)
+            sOut = '_N'..sStep..':STOPRE'
+            table.insert( EMT.AUXSTR, sOut)
+            sOut = '_POSIZ_T(5,,,,,5,,,,)\n'  -- pistone scarico indietro
             table.insert( EMT.AUXSTR, sOut)
          end
       elseif Cmd[1] == '2' then
@@ -1289,10 +1368,10 @@ function PrepareUnload( sCmd)
          local sStep = EgtNumToString( EMT.NSTEP, 0)
          local sOut = '_STEP='..sStep
          table.insert( EMT.AUXSTR, sOut)
-         local sX2Pos = Cmd[5]
-         sOut = string.format( 'G1 X=%s F=%d', sX2Pos, EMT.FMAXPINZE)
+         sOut = '_N'..sStep..':STOPRE'
          table.insert( EMT.AUXSTR, sOut)
-         sOut = '_N'..sStep..':STOPRE\n'
+         local sX2Pos = Cmd[5]
+         sOut = string.format( 'POS[X2]=%s FA[X2]=%d\n', sX2Pos, EMT.FMAXPINZE)
          table.insert( EMT.AUXSTR, sOut)
       elseif Cmd[1] == '3' then
          -- non gestito
@@ -1303,9 +1382,17 @@ function PrepareUnload( sCmd)
          local sStep = EgtNumToString( EMT.NSTEP, 0)
          local sOut = '_STEP='..sStep
          table.insert( EMT.AUXSTR, sOut)
-         sOut = '_POSIZ_T(5,,,,,1,,,,)'  -- apre pinza 2 restando su processo 1
+         sOut = '_N'..sStep..':STOPRE'
          table.insert( EMT.AUXSTR, sOut)
-         sOut = '_N'..sStep..':STOPRE\n'
+         sOut = '_POSIZ_T(5,,,,,1,,,,)\n'  -- apre pinza 2
+         table.insert( EMT.AUXSTR, sOut)
+         EMT.NSTEP = EMT.NSTEP + 10
+         sStep = EgtNumToString( EMT.NSTEP, 0)
+         sOut = '_STEP='..sStep
+         table.insert( EMT.AUXSTR, sOut)
+         sOut = '_N'..sStep..':STOPRE'
+         table.insert( EMT.AUXSTR, sOut)
+         sOut = '_POSIZ_T(5,,,,,2,,,,)\n'  -- solleva il blocca-pezzo
          table.insert( EMT.AUXSTR, sOut)
       elseif Cmd[1] == '21' then
          -- non interessa
@@ -1624,13 +1711,13 @@ function CalcInterpPlane()
    local dAngO2 = EmtGetAngO2( EMT.IPLGLFR:getVersZ(), EMT.IPLGLFR:getVersX(), dAngV, dAngO)
    local sXout, sYout, sZout
    if EMT.X1DELTA then
-      sXout = ' X='..EmtLenToString( xS + EMT.X1DELTA)..'+OFS_T5_X1[0]'
-      sYout = ' Y=OFS_T5_X1[1]'
-      sZout = ' Z=OFS_T5_X1[2]'
+      sXout = ' X='..EmtLenToString( xS + EMT.X1DELTA)..'+OFS_TS1_X1[0]'
+      sYout = ' Y=OFS_TS1_X1[1]'
+      sZout = ' Z=OFS_TS1_X1[2]'
    elseif EMT.X2DELTA then
-      sXout = ' X='..EmtLenToString( xS + EMT.X2DELTA)..'+OFS_T5_X2[0]'
-      sYout = ' Y=OFS_T5_X2[1]'
-      sZout = ' Z=OFS_T5_X2[2]'
+      sXout = ' X='..EmtLenToString( xS + EMT.X2DELTA)..'+OFS_TS1_X2[0]'
+      sYout = ' Y=OFS_TS1_X2[1]'
+      sZout = ' Z=OFS_TS1_X2[2]'
    else
       EmtSetLastError( 1214, "Part to machine without charriots")
    end
@@ -1659,8 +1746,8 @@ function VerifyEmitRotation()
 end
 
 ---------------------------------------------------------------------
-function EmitZmax()
-   local sOut = 'SUPA G0 D0 Z'..EgtNumToString( ParkZ, 3)
+function EmitZmax( dPosZ)
+   local sOut = 'SUPA G0 D0 Z'..EgtNumToString( dPosZ, 3)
    MyEmtOutput( sOut)
 end
 
@@ -1710,7 +1797,7 @@ function CreateClampingFile()
          local nReposNumber = i * 100
          local nReposNumber2 = (i + 1) * 100
          nfile:write( '\nIF ((_STEP3>=' .. EgtNumToString( nReposNumber) ..') AND (_STEP3<'.. EgtNumToString( nReposNumber2)  .. '))\n')
-         nfile:write( '  IF _STEP3<>' .. EgtNumToString( nReposNumber) ..' GOTOF JUMP3\n')
+         nfile:write( '  IF _STEP3<>' .. EgtNumToString( nReposNumber) ..'\n    G4F2\n    GOTOF JUMP3\n  ENDIF\n')
          local nInternalStep = 0
          for j = 1, #ALL_CLAMP_POS[i] do
             -- comando speciale per aggiungere etichetta per ripartenza

Saomad-KAIROS-MK2.ini

@@ -3,8 +3,8 @@
 Material=Beam
 NCType=5   ; 1=Tpa, 2=Num Flexium, 3=Num Axium APServer, 4=Num Axium PCToolkit, 5=Siemens_Sharp7
 Flow=2
-IsoFileDir=\\192.168.214.253\iso
-Ip=192.168.214.1
+IsoFileDir=\\192.168.0.253\iso
+Ip=192.168.0.1
 Rack=0
 Slot=1
 Debug=2
@@ -47,6 +47,15 @@ Debug=2
 29=PLC_Messages5,302:26.0:2,c,plc
 30=PLC_Messages6,302:28.0:2,c,plc
 31=W_Carico,301:8.0:2,c,plc
+32=NextPartL,301:10.0:2,c,plc
+33=NextPartW,301:12.0:2,c,plc
+34=NextPartH,301:14.0:2,c,plc
+35=NextPartPressX1,301:16.0:4,c,plc
+36=NextPartFeed,301:20.0:4,c,plc
+37=NextPartAcc,301:24.0:4,c,plc
+38=NextPartRef1,301:28.0:4,c,plc
+39=NextPartRef2,301:32.0:4,c,plc
+40=Stop_Working,301:1.7:1,c,plc
 
 [Languages]
 Enable=0
@@ -102,6 +111,8 @@ H1=6608
 H2=6615
 ; Chainsaw
 H3=6616
+; Marker
+H4=6631
 ; Angular transmission
 H5=6603
 

Saomad-KAIROS-MK2.mlde

@@ -9,7 +9,7 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '3.1c1_DEV15'
+PP_VER = '3.1e1_DEV5'
 MIN_MACH_VER = '3.1c1'
 
 EgtOutLog ( '** Saomad-KAIROS '..PP_VER..' (MinMach '.. MIN_MACH_VER ..') **', 1)
@@ -19,7 +19,7 @@ NumericalControl = 'SIEMENS'
 ChainSaw = false
 MinY = -823
 MaxY = 520
-ParkY = 400
+ParkY = -125
 FmaxY = 45000
 MinZ = -298
 MaxZ = 915
@@ -30,6 +30,8 @@ MaxA = 120
 MinSawA = -101
 MaxSawA = 101
 ParkA = 0
+TakePosTC_R = -90
+TakePosTC_L = 90
 FmaxA = 10440
 MinC = -240
 MaxC = 240
@@ -78,6 +80,7 @@ MinJoinLL = 400
 -- variabili per pinzaggio
 CLAMP_MAXDIST_2CLAMP = 3000 -- massima distanza tra ingombro lavorazione e pinza quando il pezzo è staffato con entrtambe le pinze (lavorazioni centrali)
 CLAMP_MAXDIST_1CLAMP = 500  -- massima distanza tra ingombro lavorazione e pinza quando il pezzo è staffato con una sola pinza (lavorazioni testa-coda)
+ENABLE_MARKER = true
 
 -- Aggiornamento con dati da B&W
 local sData = EgtGetCurrMachineDir().."\\Beam\\EbwData.lua"
@@ -129,16 +132,16 @@ MinOther = abs( MinX1) + abs( MaxX2) + MinJoin
 DeltaTol = 210
 
 EmtGeneral {
-      File='Saomad-KAIROS.nge',
+      File='Saomad-KAIROS-MK2.nge',
       Offset = Vector3d( 0.0, -835, -779.06),
       AxisMaxAdjust = 30,
       AxisMaxRotAdj = 0.5,
       ExitMaxAdjust = 30,
       ExitMaxRotAdj = 0.5,
-      AngDeltaMinForHome = 165,
+      --AngDeltaMinForHome = 165,
       NewLinkMgr = 1,
-      Special = 'Saomad-KAIROS.mlse',
-      Processor = 'Saomad-KAIROS.mlpe'}
+      Special = 'Saomad-KAIROS-MK2.mlse',
+      Processor = 'Saomad-KAIROS-MK2.mlpe'}
 local BaseId = EmtBase {
       Name = 'Base',
       Geo='BASE/GEO',
@@ -186,7 +189,7 @@ local AId = EmtAxis {
       Stroke = {MinA, MaxA},
       Home = ParkA,
       Geo = 'A_AXIS/GEO',
-      Aux = {'A_AXIS/SOLID', 'A_AXIS/COLLISION'}}
+      Aux = EgtIf( ENABLE_MARKER, {'A_AXIS/SOLID', 'A_AXIS/COLLISION','A_AXIS/MARKER', 'A_AXIS/MARKER_COLL'}, {'A_AXIS/SOLID', 'A_AXIS/COLLISION'})}
 -- Frese
 local H1Id = EmtHead {
       Name = 'H1',
@@ -199,6 +202,20 @@ local H1Id = EmtHead {
       Rot1W = 2,
       OthColl = {'A/SOLID', 'C/SOLID'},
       Geo = 'H1_HEAD/GEO'}
+-- Marker
+if ENABLE_MARKER then
+   local H4Id = EmtHead {
+         Name = 'H4',
+         Parent = 'A',
+         HSet = 'H4',
+         Type = MCH_HT.STD,
+         Pos = Point3d( -95, -75.25, 348.5),
+         TDir = Y_AX(),
+         ADir = X_AX(),
+         Rot1W = 2,
+         OthColl = {'A/SOLID', 'C/SOLID'},
+         Geo = 'H4_HEAD/GEO'}
+end
 --EgtSetInfo( H1Id, 'ZMAXONROT', '1,60')
 -- Sega a catena
 EmtAxis {
@@ -442,8 +459,8 @@ function OnSetHead()
       local dDist = EgtIf( EMC.DIST and abs( EMC.DIST) > 1, EMC.DIST, ChSawLen)
       EmtModifyExitPosition( EMC.HEAD, EMC.EXIT, Point3d( 0, 0, -dDist))
       -- recupero valore asse CS bloccato
-      local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
-      local dPosCS = tonumber( sVal:sub( 4) or '')
+      local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS) or ''
+      local dPosCS = tonumber( sVal:sub( 4)) or 0
       EmtModifyAxisHome( 'C', GetChainSawCHomeFromVirtualAxis( dPosCS))
       -- limiti asse A
       EmtModifyAxisStroke( 'A', { -91, 91})

Saomad-KAIROS-MK2.mlpe

@@ -15,7 +15,7 @@ CLAMP_POS = {}
 ---------------------------------------------------------------------
 local sBaseDir = EgtGetCurrMachineDir()
 if NumericalControl == 'SIEMENS' then
-   dofile( sBaseDir .. '\\Saomad-KAIROS.SIEMENS.mlpe')
+   dofile( sBaseDir .. '\\Saomad-KAIROS-MK2.SIEMENS.mlpe')
 else
    EmtSetLastError( 1201, 'Numerical Control error : unkwnown type')
 end
@@ -66,6 +66,9 @@ function OnSimulStart()
    EMT.COLLOBJ = {}
    AddToCollisionCheck( 'Z', 'COLLISION', EMT.COLLOBJ)
    AddToCollisionCheck( 'A', 'COLLISION', EMT.COLLOBJ)
+   if ENABLE_MARKER then
+      AddToCollisionCheck( 'A', 'MARKER_COLL', EMT.COLLOBJ)
+   end
    AddToCollisionCheck( 'C', 'COLLISION', EMT.COLLOBJ)
    DumpCollisionCheck( EMT.COLLOBJ, 'Collision Objects :', 4)
    -- Preparo lista solidi macchina con cui possono collidere gli oggetti sopra riportati (in aggiunta a VMill)
@@ -463,8 +466,13 @@ function OnSimulToolSelect( dPosCS)
          for i, Coll in ipairs( EMT.COLLOBJ) do
             EmtAddCollisionObjEx( i, Coll.Fr, Coll.Ty, Coll.Mv, Coll.P1, Coll.P2, Coll.P3)
          end
-         AddToolToCollisionObj( EMT.TOOL, EMT.HEAD, EMT.EXIT, 1001)
-         AddToolHolderToCollisionObj( EMT.TOOL, EMT.HEAD, EMT.EXIT, 1002)
+         if EMT.HEAD ~= 'H4' then
+            AddToolToCollisionObj( EMT.TOOL, EMT.HEAD, EMT.EXIT, 1001)
+            AddToolHolderToCollisionObj( EMT.TOOL, EMT.HEAD, EMT.EXIT, 1002)
+         else
+            AddToolToCollisionObj( nil, 'H1', 1, 1001)
+            AddToolHolderToCollisionObj( nil, 'H1', 1, 1002)
+         end
       end
       -- dichiaro assi ausiliari da visualizzare
       EMT.AuxAxes = 2
@@ -504,12 +512,16 @@ function OnSimulToolSelect( dPosCS)
    EMT.TCPOS_1 = EMT.TCPOS
    -- lo nascondo sul portautensili
    ShowToolInTcPos( EMT.TCPOS, false)
+   -- movimento di uscita dal porta utensile
+   if EMT.HEAD == 'H1' or EMT.HEAD == 'H2' then
+      SimulMoveAxes( 'Y', ParkY, MCH_SIM_STEP.RAPID, 'A', ParkA, MCH_SIM_STEP.RAPROT, 'C', ParkC, MCH_SIM_STEP.RAPROT)
+   end
 end
 
 ---------------------------------------------------------------------
 function OnSimulToolDeselect()
    -- se prossimo utensile non definito, è disposizione ed esco
-   if EMT.NEXTTOOL == '' then return end
+   if EMT.NEXTTOOL == '' or EMT.HEAD == 'H4' or EMT.NEXTHEAD == 'H4' then return end
    -- se sega a catena o punta lunga o utensile di grosso diametro, devo cambiare
    if EMT.HEAD == 'H3' or ( EMT.HEAD == 'H1' and ( EMT.TOTLEN > LONG_TOOL_MINLEN or EMT.TOTDIAM > BIG_TOOL_DIAM)) then
       EgtOutText( 'Tool change in progress...')
@@ -522,30 +534,39 @@ function OnSimulToolDeselect()
          else
             SimulMoveAxes( 'A', ParkA, MCH_SIM_STEP.COLLROT, 'C', GetChainSawCHomeFromVirtualAxis( dPosCS), MCH_SIM_STEP.COLLROT)
          end
-         SimulMoveAxis( 'Y', ParkY, MCH_SIM_STEP.RAPID)
+      elseif EMT.HEAD == 'H2' then
+         SimulMoveAxes( 'A', TakePosTC_R, MCH_SIM_STEP.COLLROT, 'C', ParkC, MCH_SIM_STEP.COLLROT)
+      elseif EMT.HEAD == 'H1' then
+         SimulMoveAxes( 'A', TakePosTC_L, MCH_SIM_STEP.COLLROT, 'C', ParkC, MCH_SIM_STEP.COLLROT)
       end
+      SimulMoveAxis( 'Y', MinY, MCH_SIM_STEP.RAPID)
       -- breve pausa
       EgtPause( 100)
       -- nascondo utensile su testa e lo visualizzo su TcPos
       EgtSetMode( EgtGetHeadId( EMT.HEAD), GDB_MD.HIDDEN)
       ShowToolInTcPos( EMT.TCPOS_1, true)
       -- movimento per carico utensile
-      SimulMoveAxes( 'A', ParkA, MCH_SIM_STEP.RAPROT, 'C', ParkC, MCH_SIM_STEP.RAPROT)
+      --SimulMoveAxes( 'Y', ParkY, MCH_SIM_STEP.RAPID, 'A', ParkA, MCH_SIM_STEP.RAPROT, 'C', ParkC, MCH_SIM_STEP.RAPROT)
       EgtOutText( '')
    -- deposito utensile
    else
       if EMT.NEXTTOOL ~= EMT.TOOL_1 then
          EgtOutText( 'Tool change in progress...')
          -- simulo movimento
-         SimulMoveAxes( 'A', ParkA, MCH_SIM_STEP.COLLROT, 'C', ParkC, MCH_SIM_STEP.COLLROT)
-         SimulMoveAxis( 'Y', ParkY, MCH_SIM_STEP.RAPID)
+         if EMT.HEAD == 'H2' then
+            SimulMoveAxes( 'A', TakePosTC_R, MCH_SIM_STEP.COLLROT, 'C', ParkC, MCH_SIM_STEP.COLLROT)
+         elseif EMT.HEAD == 'H1' then
+            SimulMoveAxes( 'A', TakePosTC_L, MCH_SIM_STEP.COLLROT, 'C', ParkC, MCH_SIM_STEP.COLLROT)
+         end
+         SimulMoveAxis( 'Y', MinY, MCH_SIM_STEP.RAPID)
          -- breve pausa
          EgtPause( 100)
+         -- nascondo utensile su testa e lo visualizzo su TcPos
+         EgtSetMode( EgtGetHeadId( EMT.HEAD), GDB_MD.HIDDEN)
          ShowToolInTcPos( EMT.TCPOS_1, true)
-          -- nascondo l'utensile corrente
-          EgtSetStatus( EgtGetHeadId( EMT.HEAD), GDB_ST.OFF)
-          -- eseguo movimento opportuno
-          SimulMoveAxes( 'A', ParkA, MCH_SIM_STEP.RAPROT, 'C', ParkC, MCH_SIM_STEP.RAPROT)
+         EgtOutText( '')
+         -- eseguo movimento opportuno
+         --SimulMoveAxes( 'A', ParkA, MCH_SIM_STEP.RAPROT, 'C', ParkC, MCH_SIM_STEP.RAPROT)
       else
          EMT.TOOL_1 = nil
          EMT.TCPOS_1 = nil
@@ -1665,8 +1686,11 @@ function IsLastMachining( nMchId)
    local nOpeId = EgtGetNextActiveOperation( nMchId)
    while nOpeId do
       local nType = EgtGetOperationType( nOpeId)
+      -- se c'è una lavorazione
       if nType ~= MCH_OY.NONE  and  nType ~= MCH_OY.DISP then
          return false
+      elseif nType == MCH_OY.DISP and IsRestPhase( EMT.PHASE + 1) then
+         return false
       end
       nOpeId = EgtGetNextActiveOperation( nOpeId)
    end

Saomad-KAIROS-MK2.mlse

@@ -28,9 +28,48 @@ function OnSpecialLink()
       elseif EMC.LINKTYPE == 2 then
       -- altrimenti collegamento tra due lavorazioni (3)
       else
+         local nClId = EgtGetFirstNameInGroup( EMC.NEXTMCHID, 'CL')   -- recupero Id del gruppo CL della lavorazione corrente
+         local nPathId = EgtGetFirstInGroup( nClId or GDB_ID.NULL)    -- Id del primo gruppo nella lavorazione (P1)
+         local dAuxMoveCount = EgtGetInfo( nPathId, 'AS#', 'd') or 0  -- numero di movimenti ausiliari
+         -- se ci sono stati movimenti di pinze vado a una quota sicura
+         if dAuxMoveCount > 3 then
+            -- recupero quota massima di collegamento
+            local dZSecRotAx = 500
+            -- retrazione
+            EmtRemoveRise( EMC.PREVMCHID)
+            EmtAddRise( EMC.PREVMCHID, { EMC.L1p, EMC.L2p, dZSecRotAx, EMC.R1p, EMC.R2p}, 30, 3, 2, 'UniqueRise=1;')
+            -- approccio
+            EmtRemoveClimb( EMC.NEXTMCHID)
+            EmtAddClimb( EMC.NEXTMCHID, { EMC.L1, EMC.L2, dZSecRotAx, EMC.R1, EMC.R2}, 31, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+         end
       end
    -- se motosega
    elseif EMC.HEAD == 'H3' then
+   -- se marcatore
+   elseif EMC.HEAD == 'H4' then
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+      -- altrimenti collegamento tra due lavorazioni (3)
+      else
+         local nClId = EgtGetFirstNameInGroup( EMC.NEXTMCHID, 'CL')   -- recupero Id del gruppo CL della lavorazione corrente
+         local nPathId = EgtGetFirstInGroup( nClId or GDB_ID.NULL)    -- Id del primo gruppo nella lavorazione (P1)
+         local dAuxMoveCount = EgtGetInfo( nPathId, 'AS#', 'd') or 0  -- numero di movimenti ausiliari
+         -- se ci sono stati movimenti di pinze vado a una quota sicura
+         if dAuxMoveCount > 3 then
+            -- recupero quota massima di collegamento
+            local dZSecRotAx = 500
+            -- retrazione
+            EmtRemoveRise( EMC.PREVMCHID)
+            EmtAddRise( EMC.PREVMCHID, { EMC.L1p, EMC.L2p, dZSecRotAx, EMC.R1p, EMC.R2p}, 30, 3, 2, 'UniqueRise=1;')
+            -- approccio
+            EmtRemoveClimb( EMC.NEXTMCHID)
+            EmtAddClimb( EMC.NEXTMCHID, { EMC.L1, EMC.L2, dZSecRotAx, EMC.R1, EMC.R2}, 31, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+         end
+      end
    end
    EMC.ERR = 0
 end
@@ -943,6 +982,8 @@ function GetMachiningEncumbrance( nMchId, bPreCut)
    end
    local vtArm = vtAux
    -- Recupero dei dati dell'utensile
+   local sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
+   EMC.HEAD = sHead
    local nToolType = EgtTdbGetCurrToolParam( MCH_TP.TYPE)
    local bSaw = ( nToolType == MCH_TY.SAW_STD or nToolType == MCH_TY.SAW_FLAT)
    local bChain = ( nToolType == MCH_TY.MORTISE_STD)
@@ -1119,7 +1160,9 @@ function SpecCalcEncumbrance( vtTool, vtArm, vtAux, ptMin, ptMax, bSaw, bChain,
    -- Ingombro a sinistra
    local dDistBack = EMC.LENGTHBEAM + ptMin:getX() + LoadT
    local dHeadBack = 350
-   if bSaw then
+   if EMC.HEAD == 'H4' then
+      dHeadBack = 50
+   elseif bSaw then
       if vtTool:getX() > 0 and abs( vtTool:getY()) < 0.088 and abs( vtTool:getZ()) < 0.088 then
          dHeadBack = 50 + 0.5 * dTDiam * sqrt( 1 - vtTool:getX() * vtTool:getX())
       elseif abs( vtTool:getZ()) < 0.26 and abs( vtTool:getX()) < 0.35 then
@@ -1213,7 +1256,9 @@ function SpecCalcEncumbrance( vtTool, vtArm, vtAux, ptMin, ptMax, bSaw, bChain,
    -- Ingombro a destra
    local dDistFront = - ptMax:getX() - LoadT
    local dHeadFront = 350
-   if bSaw then
+   if EMC.HEAD == 'H4' then
+      dHeadFront = 450
+   elseif bSaw then
       if vtTool:getX() < 0 and abs( vtTool:getY()) < 0.088 and abs( vtTool:getZ()) < 0.088 then
          dHeadFront = 50 + 0.5 * dTDiam * sqrt( 1 - vtTool:getX() * vtTool:getX())
       elseif abs( vtTool:getZ()) < 0.26 and abs( vtTool:getX()) < 0.35 then
@@ -1568,7 +1613,7 @@ function SpecCalcUnload()
       EMC.X1DELTANEXT = nil
       EMC.X2DELTANEXT = dX2LastPos
       -- effettuo scambio
-      vCmdPre = GetCarriagesRepositioningCmd( vCmdPre, EMC.TPOS, EMC.X1DELTA, nil, nil, nil, dX2LastPos)
+      vCmdPre = GetCarriagesRepositioningCmd( vCmdPre, EMC.TPOS, EMC.X1DELTA, dX2CurrPos, nil, nil, dX2LastPos)
       if EMC.ERR ~= 0 then
          return {}
       end
@@ -1582,7 +1627,7 @@ function SpecCalcUnload()
    -- Commento
    table.insert( vCmd, { 0, 'Unloading', EgtIf( bStdUl, 'Unloading', 'Manual Unloading')})
    -- risalita testa a Zmax
-   vCmd = AddZmaxMove( vCmd)
+   -- vCmd = AddZmaxMove( vCmd)
    -- Se pinza X1 chiusa, la apro
    if EMC.X1DELTA then
       table.insert( vCmd, { 11, 0})
@@ -1704,7 +1749,7 @@ function GetCarriagesRepositioningCmd( vCmd, dTPosI, dX1DeltaI, dX2DeltaI, dTPos
       if #vCmd == 0 then
          table.insert( vCmd, { 0, 'Clamp repositioning'})
          -- risalita testa a Zmax
-         vCmd = AddZmaxMove( vCmd)
+        -- vCmd = AddZmaxMove( vCmd)
       end
 
       -- si ribadisce il pinzaggio
@@ -1895,7 +1940,7 @@ function GetCarriagesRepositioningCmd( vCmd, dTPosI, dX1DeltaI, dX2DeltaI, dTPos
             if dTPosI - dTPosF > 0 then
                dBeamMove = max( ( dTPosF - dTPosI), ( MinX2 - dX2PosI), ( dX1DeltaI - dX1DeltaF))
             else
-               dBeamMove = min( ( dTPosF - dTPosI), ( dX2PosI - MaxX2))
+               dBeamMove = min( ( dTPosF - dTPosI), ( MaxX2 - dX2PosI))
             end
             dBeamMove = dBeamMove / 2
          -- altrimenti la trave resta ferma e la pinza 1 va in presa (si limita lo scivolamento del pezzo)
@@ -2069,10 +2114,10 @@ function GetCarriagesRepositioningCmd( vCmd, dTPosI, dX1DeltaI, dX2DeltaI, dTPos
             -- recupero una corsa massima e l'altra solo di quello che serve
             elseif abs( dX1DeltaI - dX1DeltaF) > dMaxMovePilgrimStepSingleClampX2 then
                -- suddivido il movimento su entrambe le morse
-               local dTotMove = ( dX1DeltaF - dX1DeltaI) / 2
+               local dTotMove = ( ( dX1DeltaF + dX2DeltaF) / 2 + ( dX1DeltaI + dX2DeltaI) / 2) / 2
                -- morsa X1 arriva in posizione finale
-               dX2PosA = MaxX2 - dTotMove
-               dTPosA = dTPosI - dX2PosI + MaxX2 - dTotMove
+               dX2PosA = EgtClamp( MaxX2 - dTotMove, MaxX2, MinX2)
+               dTPosA = dTPosI - dX2PosI + dX2PosA
                dX1PosA = dX1DeltaF + dTPosA
                table.insert( vCmd, { 3, 'X1', dX1PosA , 'T', dTPosA, 'X2', dX2PosA})
                table.insert( vCmd, { 11, CalcCharStatus( 'X1', dX1DeltaF)})
@@ -2176,10 +2221,10 @@ function GetCarriagesRepositioningCmd( vCmd, dTPosI, dX1DeltaI, dX2DeltaI, dTPos
             -- recupero una corsa massima e l'altra solo di quello che serve
          elseif abs( dX2DeltaI - dX2DeltaF) > dMaxMovePilgrimStepSingleClampX1 then
                -- suddivido il movimento su entrambe le morse
-               local dTotMove = ( dX2DeltaI - dX2DeltaF) / 2
+               local dTotMove = ( ( dX1DeltaF + dX2DeltaF) / 2 + ( dX1DeltaI + dX2DeltaI) / 2) / 2
                -- morsa X2 arriva in posizione finale
-               dX1PosA = MaxX1 + dTotMove
-               dTPosA = dTPosI + ( MaxX1 - dX1PosI) + dTotMove
+               dX1PosA = EgtClamp( MaxX1 + dTotMove, MinX1, MaxX1)
+               dTPosA = dTPosI - dX1PosI + dX1PosA
                dX2PosA = dX2DeltaF + dTPosA
                table.insert( vCmd, { 3, 'X1', dX1PosA , 'T', dTPosA, 'X2', dX2PosA})
                table.insert( vCmd, { 12, CalcCharStatus( 'X2', dX2DeltaF)})
@@ -2223,7 +2268,6 @@ function GetCarriagesRepositioningCmd( vCmd, dTPosI, dX1DeltaI, dX2DeltaI, dTPos
                   dTPosI, dX1DeltaI, dX2DeltaI = dTPosF, dX1DeltaF, dX2DeltaF
                   EMC.X1DELTA = EMC.X1DELTANEXT
                   EMC.X2DELTA = EMC.X2DELTANEXT
-
                end
 
                -- imposto i nuovi parametri di aggancio

Scripts/SetUp.lua

@@ -39,7 +39,8 @@ local PositionTable={{Pos = "Pos1",  TcPos = "T101",  Head = "H1", Group = "G1"}
                      {Pos = "Pos10", TcPos = "T110", Head = "H1", Group = "G1"},
                      {Pos = "Pos11", TcPos = "T111", Head = "H1", Group = "G1"},
                      {Pos = "Pos12", TcPos = "T201", Head = "H1", Group = "G2"},
-                     {Pos = "Pos13", TcPos = "T202", Head = "H3", Group = "G3"}}
+                     {Pos = "Pos13", TcPos = "T202", Head = "H3", Group = "G3"},
+                     {Pos = "Pos14", TcPos = "T301", Head = "H4", Group = "G4"}}
 if EgtGetHeadId( 'H3') then
    PositionTable[13].Head = 'H3'
 end