- Allineamento con common ver. 2.6e4

- Corretta posizione griglia sotto CU margherita nel modello 3D

.gitignore

@@ -15,3 +15,4 @@
 /Wall/PocketingData.lua
 /Wall/SawingData.lua
 /Wall/Ts3Data.lua
+.vscode/settings.json

.gitlab-ci.yml

@@ -0,0 +1,236 @@
+variables:
+ VERS_MAIN: '1.0'
+ MACH_NAME: ''
+ MACH_NAME_TEST: ''
+ NEW_REL: ''
+ NET_SHARE_X: '\\10.74.82.201\EgwTech'
+ NET_SHARE_Z: '\\10.74.82.201\Artifacts'
+ NET_SHARE_S: '\\10.74.82.201\Scambio'
+ NET_SHARE_R: '\\10.74.82.201\EgwTech'
+ NET_USERQ: 'steamw\egalware'
+ MACH_VERS: '0.0.0.0'
+ TEMP_PATH: 'C:\MachinesDeploy'
+ MACHINES_PATH_R: 'R:\EgtData\Machines'
+ DEST_MACHINES_PATH_R: 'R:\EgtData\Machines\zTestYAML'
+ SRC_PATH: ''
+ BASE_PATH: ''
+ TEST_PATH: ''
+
+#Note compilazione LUA:
+# lua54 -o bin\$FileName -s $FileName: -o = output, -s = NON include i debug symbols
+
+# helper copia script verso cartella di rete S:\ delle cartelle bin
+.ReplicaS: &ReplicaS
+   - |
+      net use S: /delete
+      SLEEP 2
+      net use S: $env:NET_SHARE_S /u:$env:NET_USERQ $SDRIVE_PASSWD
+      ROBOCOPY /MIR $env:BASE_PATH S:\LucaM\MachinesDeploy\$env:MACH_NAME\$env:MACH_VERS\ /XD "bin" /XD "$env:MACH_NAME_TEST"
+      SLEEP 2
+      net use S: /delete
+
+# helper copia script verso cartella di rete R:\
+.ReplicaR: &ReplicaR
+   - |
+      net use R: /delete
+      SLEEP 2
+      net use R: $env:NET_SHARE_R /u:$env:NET_USERQ $ZDRIVE_PASSWD
+      echo "-----------------------"
+      echo "   Copia macchina su R"
+      echo "-----------------------"
+      ROBOCOPY /MIR "$env:SRC_PATH" "$env:DEST_MACHINES_PATH_R\$env:MACH_NAME\" /XD "bin"
+      ROBOCOPY "$env:TEST_PATH" "$env:DEST_MACHINES_PATH_R\$env:MACH_NAME_TEST\" /E /XD "bin"
+      ROBOCOPY /MIR "$env:BASE_PATH" "$env:DEST_MACHINES_PATH_R\Deploy\$env:MACH_NAME\$env:MACH_VERS\" /XD "bin" /XD "$env:MACH_NAME_TEST"
+      SLEEP 2
+      net use R: /delete
+
+# helper copia script verso cartella di rete R:\ per develop
+.ReplicaR_DEV: &ReplicaR_DEV
+   - |
+      net use R: /delete
+      SLEEP 2
+      net use R: $env:NET_SHARE_R /u:$env:NET_USERQ $ZDRIVE_PASSWD
+      echo "-----------------------"
+      echo "   Copia macchina su R - DEV"
+      echo "-----------------------"
+      ROBOCOPY /MIR "$env:BASE_PATH" "$env:DEST_MACHINES_PATH_R\Deploy\$env:MACH_NAME\_DEV\$env:MACH_VERS\" /XD "bin" /XD "$env:MACH_NAME_TEST"
+      SLEEP 2
+      net use R: /delete
+
+#helper copia sorgenti da R a percorso temporaneo
+.CreateBaseFolder: &CreateBaseFolder
+   - |   
+      net use R: /delete
+      SLEEP 2
+      net use R: $env:NET_SHARE_R /u:$env:NET_USERQ $ZDRIVE_PASSWD
+      echo "-----------------------"
+      echo "   Recupero file non git da R e copia su macchina virtuale"
+      echo "-----------------------"
+      ROBOCOPY "$env:LAST_MACHINE_PATH" "$env:SRC_PATH" /E /XF "*.bat" /XF "*.yml" /XF ".gitignore" /XD ".git" /XF "UpdateLog.txt" /XD ".vscode"
+      ROBOCOPY "$env:LAST_MACHINE_PATH" "$env:SRC_PATH\bin\$env:MACH_NAME\" /E /XF "*.bat" /XF "*.yml" /XF ".gitignore" /XD ".git" /XF "UpdateLog.txt" /XD ".vscode"
+      SLEEP 2
+      net use R: /delete
+
+# helper compilazione LUA a 32 e 64 bit
+.LuaCompile: &LuaCompile
+  - |
+     Set-Alias lua54  C:\Tools\Lua32\luac54
+     echo "-----------------------"
+     echo "   Copia file su macchina virtuale"
+     echo "-----------------------"
+     ROBOCOPY . "$env:SRC_PATH" /E /XF "*.bat" /XF "*.yml" /XF ".gitignore" /XD ".git" /XF "UpdateLog.txt" /XD ".vscode"
+     ROBOCOPY . "$env:TEST_PATH" /E /XF "*.bat" /XF "*.yml" /XF ".gitignore" /XD ".git" /XF "UpdateLog.txt" /XD ".vscode"
+     Rename-Item -Path "$env:TEST_PATH\$env:MACH_NAME.mlde" -NewName "$env:MACH_NAME_TEST.mlde"
+     Rename-Item -Path "$env:TEST_PATH\$env:MACH_NAME.ini" -NewName "$env:MACH_NAME_TEST.ini"
+     ROBOCOPY . "$env:SRC_PATH\bin\$env:MACH_NAME\" /E /XF "*.bat" /XF "*.yml" /XF ".gitignore" /XD ".git" /XF "UpdateLog.txt" /XD ".vscode"
+     echo "-----------------------"
+     echo "   Compilazione file *.lua 32/64bit"
+     echo "-----------------------"
+     $FileList = Get-ChildItem("Common-*")
+     ForEach ($File in $FileList) {
+       $FileName = Split-Path $File -leaf
+       lua54 -o $env:SRC_PATH\bin\$env:MACH_NAME\$FileName -s $FileName
+       echo "lua54 -o bin\$FileName -s $FileName"
+     }
+
+# helper recupero nome macchina
+.machName-fix: &machName-fix
+   - |
+      echo "-----------------------"
+      echo "   Recupero nome macchina"
+      echo "-----------------------"
+      $fileName = dir *.mlde
+      $env:MACH_NAME = $fileName.BaseName
+      $env:MACH_NAME_TEST = $env:MACH_NAME + ".TEST"
+
+# helper calcolo versione
+.version-fix: &version-fix
+   - |
+      echo "-----------------------"
+      echo "   Calcolo versione"
+      echo "-----------------------"
+      $fPath = "$env:MACH_NAME.mlde";
+      $vLine = Select-String -path $fPath -Pattern 'PP_VER';
+      $comp = $vLine -split "=";
+      $env:MACH_VERS = $comp[1].Replace("'","").Trim()
+      # display versione
+      Write-Output $env:MACH_VERS;
+
+# helper calcolo versione se develop
+.version-fix_DEV: &version-fix_DEV
+   - |
+      echo "-----------------------"
+      echo "   Calcolo versione - DEV"
+      echo "-----------------------"
+      $commitAuthor = $CI_COMMIT_AUTHOR -split " "
+      $commitAuthor = $commitAuthor[0].Trim()
+      $env:MACH_VERS = $commitAuthor
+      # display versione
+      Write-Output $env:MACH_VERS;
+
+# helper creazione folders 
+.folder-fix: &folder-fix
+   - |
+      echo "-----------------------"
+      echo "   Creazione cartelle su macchina virtuale"
+      echo "-----------------------"
+      $env:LAST_MACHINE_PATH = "$env:MACHINES_PATH_R\$env:MACH_NAME";
+      Write-Output  $env:LAST_MACHINE_PATH;
+      $env:SRC_PATH = "$env:TEMP_PATH\$env:MACH_NAME\$env:MACH_VERS\$env:MACH_NAME";
+      $env:BASE_PATH = "$env:TEMP_PATH\$env:MACH_NAME\$env:MACH_VERS";
+      $env:TEST_PATH = "$env:TEMP_PATH\$env:MACH_NAME\$env:MACH_VERS\$env:MACH_NAME_TEST";
+      Write-Output  $env:BASE_PATH;     
+      if (Test-Path $env:BASE_PATH) { Remove-Item -Path "$env:BASE_PATH\*" -R -Force };
+      Write-Output  $env:TEST_PATH;
+
+# helper compressione e pulizia folders 
+.ZipClean: &ZipClean
+   - |
+      "  Compressione file su macchina virtuale"
+      $7zipPath = $env:ProgramFiles+"\7-Zip\7z.exe";
+      if (-not (Test-Path -Path $7zipPath -PathType Leaf)) {
+          throw "7 zip file '$7zipPath' not found"
+      }
+      Set-Alias 7zip $7zipPath
+      $Target = "$env:BASE_PATH\$env:MACH_NAME.zip"
+      cd "$env:SRC_PATH\bin\"
+      $Source = "*"
+      7zip a -tzip $Target $Source  
+      Write-Output "called ZIP $Source --> $Target"
+
+
+# helper esecuzione test 
+.RunTest: &RunTest
+   - |
+      Write-Output "Test done!"      
+
+
+stages:
+ - build
+#  - test
+#  - deploy
+
+LuaCompile:build:
+ stage: build
+ only:
+   - main
+   - master
+ tags:
+   - win
+ before_script:
+   - *machName-fix
+   - *version-fix
+   - *folder-fix
+ script:
+   - *CreateBaseFolder    
+   - *LuaCompile
+   - *ZipClean
+   - *ReplicaR
+
+LuaCompileDev:build:
+ stage: build
+ only:
+   - develop
+ tags:
+   - win
+ before_script:
+   - *machName-fix
+   - *version-fix_DEV
+   - *folder-fix
+ script:
+   - *CreateBaseFolder    
+   - *LuaCompile
+   - *ZipClean
+   - *ReplicaR_DEV
+
+# LuaCompile:test:
+#  stage: test
+#  needs: ["LuaCompile:build"]
+#  only:
+#    - main
+#    - master
+#    - develop
+#  tags:
+#    - win
+#  before_script:
+#    - *version-fix
+#    - *folder-fix
+#  script:    
+#    - *LuaCompile
+#    - *RunTest
+   
+# LuaCompile:deploy:
+#  stage: deploy
+#  needs: ["LuaCompile:test"]
+#  only:
+#    - main
+#    - master
+#  tags:
+#    - win
+#  before_script:
+#    - *version-fix
+#    - *folder-fix
+#  script:    
+#    - *LuaCompile
+#    - *ZipClean
+#    - *ReplicaR

Beam/BeamData.lua

@@ -67,9 +67,9 @@ local BeamData = {
    DH_MAX_TOP = 370,                        -- quota massima raggiungibile dalla testa da sotto dal sotto del pezzo
    KIOTP = 2,                               -- coefficiente moltiplicativo per attacco/uscita lama tangente anzichè perpendicolare
    MAXDIAM_POCK_CORNER = 30,                -- diametro massimo utensile ammesso per tasche con angoli interni
-   USE_LONGCUT = false,                     -- per i tagli longitudinali usare solo la lavorazione di lama LongCut
+   USE_LONGCUT = true,                      -- per i tagli longitudinali usare solo la lavorazione di lama LongCut
    ADVANCE_TAIL_CUT = true,                 -- per spostare prima del taglio di separazione il taglio di coda su pezzi corti con robabile caduta
-   ADVANCE_TAIL_OFFS = 5,                    -- accorciamento taglio di coda avanzato (minimo 1)
+   ADVANCE_TAIL_OFFS = 5,                   -- accorciamento taglio di coda avanzato (minimo 1)
    DOUBLE_HEAD_DOVETAIL = true,             -- flag abilitazione lavorazione mortase a coda di rondine in doppio
    DOUBLE_HEAD_MORTISE = true,              -- flag abilitazione lavorazione mortase in doppio
    DOUBLE_HEAD_DRILLING = true              -- flag abilitazione forature in doppio
@@ -78,11 +78,9 @@ local BeamData = {
 ---------------------------------------------------------------------
 -- Aggiornamento con dati da TechnoEssetre7
 local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-PF1250MAX.data"
-local sDataBeam = EgtGetSourceDir().."\\Ts3Data.lua"
-local sDataWall = EgtGetCurrMachineDir()..'\\Wall\\Ts3Data.lua'
+local sDataBeam = EgtGetCurrMachineDir().."\\Beam\\Ts3Data.lua"
 if EgtExistsFile( sTs3Data) then
    EgtCopyFile( sTs3Data, sDataBeam)
-   EgtCopyFile( sTs3Data, sDataWall)
    local sTs3DataOld = sTs3Data..'.old'
    EgtEraseFile( sTs3DataOld)
    EgtRenameFile( sTs3Data, sTs3DataOld)
@@ -101,6 +99,7 @@ if EgtExistsFile( sDataBeam) then
          BeamData.DIM_STRIP_SMALL = Machine.Offsets.DIM_STRIP_SMALL or BeamData.DIM_STRIP_SMALL
          BeamData.DIM_TO_CENTER_STRIP = Machine.Offsets.DIM_TO_CENTER_STRIP or BeamData.DIM_TO_CENTER_STRIP
          BeamData.MAXDIAM_POCK_CORNER = Machine.Offsets.MAXDIAM_POCK_CORNER or BeamData.MAXDIAM_POCK_CORNER
+         BeamData.OVM_MID = Machine.Offsets.OVM_MID or BeamData.OVM_MID
       end
       if Machine.Trave then
          BeamData.MIN_WIDTH = Machine.Trave.XMIN or BeamData.MIN_WIDTH
@@ -178,25 +177,40 @@ end
 BeamData.GetMinUnloadableRaw = GetMinUnloadableRaw
 
 ---------------------------------------------------------------------
-local function GetChainSawBlockedAxis( nInd)
-   if nInd == 1 then
-      return 'A1=90'
+local function GetBlockedAxis( sHead, nToolType, sBlockedAxis)
+   -- lama
+   if nToolType == MCH_TY.SAW_STD or nToolType == MCH_TY.SAW_FLAT then
+      if sHead == 'H22' then
+         if sBlockedAxis == 'parallel' then
+            return 'A2=0'
+         elseif sBlockedAxis == 'perpendicular' then
+            return 'A2=90'
+         end
+      else
+         return ''
+      end
+   -- sega a catena
+   elseif nToolType == MCH_TY.MORTISE_STD then
+      if sHead == 'H13' then
+         if sBlockedAxis == 'parallel' then
+            return 'A1=0'
+         elseif sBlockedAxis == 'perpendicular' then
+            return 'A1=90'
+         end
+      else
+         return ''
+      end
+   -- fresa
+   elseif nToolType == MCH_TY.MILL_STD or nToolType == MCH_TY.MILL_NOTIP then
+      return ''
+   -- punta
+   elseif nToolType == MCH_TY.DRILL_STD or nToolType == MCH_TY.DRILL_LONG then
+      return ''
    else
-      return 'A1=0'
+      return ''
    end
 end
-BeamData.GetChainSawBlockedAxis = GetChainSawBlockedAxis
-
----------------------------------------------------------------------
-local function GetSawBlockedAxis( nInd, bDownHead)
-   if nInd == 1 then
-      return EgtIf( bDownHead, 'A2=90', '')
-   else
-      return EgtIf( bDownHead, 'A2=0', '')
-   end
-end
-BeamData.GetSawBlockedAxis = GetSawBlockedAxis
-
+BeamData.GetBlockedAxis = GetBlockedAxis
 ---------------------------------------------------------------------
 
 return BeamData

Beam/MachiningTypes.ini

@@ -10,6 +10,8 @@
 2=Drill_H2
 3=Pocket
 4=Pocket_H2
+5=Predrill
+6=Predrill_H2
 
 [Milling]
 1=Prof

Common-PF1250.TPA.mlpe

@@ -1,11 +1,12 @@
--- Processore macchina Essetre-PF1250 by EgalTech s.r.l.   2023/11/21
+-- Processore macchina Essetre-PF1250 by Egalware s.r.l.   2024/01/22
 -- Con controllo numerico TPA
 
--- Variabili di modulo
-local MLE_INFO = 'Essetre-PF1250.TPA.mlpe ver.'..PP_VER..' by EgalTech s.r.l.'
+-- Carico libreria
+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
 
@@ -29,7 +30,6 @@ function OnStart()
    --EMT.St = 'S'           -- token per speed
    EMT.FMAXPINZE = 116000 -- feed massima pinze
    SetToParkLine()        -- si inizia con linee da parcheggiare su stack
-
 end
 
 ---------------------------------------------------------------------
@@ -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
 
@@ -398,15 +402,23 @@ function OnMachiningStart()
       -- valore dell'asse virtuale
       dPosA = GetCurrChainSawingVirtualAxis()
       -- imposto home dell'asse C1 (A=0 -> T101, A=90 -> T104)
-      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA)
+      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
       EmtModifyAxisHome( 'C1', MyParkCSawC1)
    -- se lama su aggregato testa sotto, aggiusto subito angolo scelto per asse virtuale A
    elseif EMT.HEAD == 'H22' then
       -- valore dell'asse virtuale
+      local dPrevA = dPosA
       dPosA = GetCurrSawingVirtualAxis()
       -- imposto home dell'asse C2 (A=0 -> T201, A=90 -> T204)
       local MyParkCSawC2 = GetSawCHomeFromVirtualAxis( dPosA)
       EmtModifyAxisHome( 'C2', MyParkCSawC2)
+      -- se lavorazione attuale e precedente con sega a catena con angolo A diverso, devo scaricare e ricaricare
+      if EMT.HEAD == EMT.PREVHEAD_H2 then
+         if abs( dPosA - dPrevA) > 1 then
+            EMT.TO_ZMAX = true
+            EMT.R3_CHANGED = true
+         end
+      end
    end
 
    -- gestione eventuale lavorazione in doppio
@@ -521,6 +533,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
 
 ---------------------------------------------------------------------
@@ -536,9 +564,11 @@ function OnPathStart()
    --MyOutput( 'CNT='.. tostring( EMT.CNT or 0))
    -- se utensile non cambiato, salvo eventuali precedenti rotanti
    if EMT.TOOL == EMT.PREVTOOL and not EMT.ZMAX then
+      EMT.L3pp = EMT.L3op
       EMT.R1pp = EMT.R1p
       EMT.R2pp = EMT.R2p
    else
+      EMT.L3pp = nil
       EMT.R1pp = nil
       EMT.R2pp = nil
    end
@@ -652,6 +682,7 @@ function OnRapid()
    if EMT.MCHFIRST and not EMT.OPEISDISP then
       MyAdjustLinearAxes()
       EmtAdjustRotaryAxes()
+      local HomeZ1 = EgtGetAxisHomePos( 'Z1')
       local HomeR1 = EgtGetAxisHomePos( EgtIf( nHSet == 1, 'C1', 'C2'))
       local HomeR2 = EgtGetAxisHomePos( EgtIf( nHSet == 1, 'B1', 'B2'))
       local PrevR1 = EMT.R1p or EMT.R1pp or HomeR1
@@ -662,7 +693,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)
@@ -684,7 +715,12 @@ function OnRapid()
          -- se testa 1
          if nHSet == 1 then
             -- selezione testa (posso muovere X solo a Zmax)
-            local MaxZ1 = EgtGetAxisMax( 'Z1')
+            local MyMaxZ1 = EgtGetAxisMax( 'Z1')
+            -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
+            local bXSpec = EgtIf( BD.RIGHT_LOAD, ( EMT.L2 > -DeltaTabY), ( EMT.L2 < -DeltaTabY))
+            EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), Z=MyMaxZ1, S=Speed})
+            EmitMoveStartHead( 1)
+            EmitMoveWaitHead( 1)
             EmitMoveWaitChars( EgtIf( bOnlyCharY, 1, 3))
             -- se necessario allargo le cabine
             if RollerParkingNeeded( EMT.HEAD, PrevR1, PrevR2, EMT.R1, EMT.R2) or
@@ -692,14 +728,12 @@ function OnRapid()
                local dPosT = EMT.TPOS or EMT.L1op
                EmitParkRoller( dPosT, bSplitCut)
             end
-            -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
             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})
@@ -710,17 +744,28 @@ function OnRapid()
                -- se bisogna scrivere tutti gli assi
                if WriteAllCoordsOnFirstM101 then
                   -- se sega a catena
-                  if EMT.HEAD == 'H15' then
-                     EmitMoveDataHead( 1, { X=ParkCSawX1, Z=ParkCSawZ1, B=HomeB1, C=EMT.R1, TRad=dTRad, TLen=dTLen, S=Speed})
+                  if EMT.HEAD == 'H13' then
+                     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
-               EmitMoveDataHead( 1, { Z=EMT.L3, S=Speed})
-               EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
-               EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
-               EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
+               if EMT.HEAD ~= 'H13' then 
+                  EmitMoveDataHead( 1, { Z=EMT.L3, S=Speed})
+                  EmitMoveDataHead( 1, { B=EMT.R2, S=Speed})
+                  EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
+                  EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
+               else
+                  EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
+                  EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
+                  EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
+               end
             end
             EmitMoveStartHead( 1)
             -- se lavorazione in doppio
@@ -767,9 +812,17 @@ 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=ParkSawX2, Z=ParkZ2, B=0, C=ParkC2, S=Speed})
+               else
+                  EmitMoveDataHead( 2, { X=ParkX2, Z=ParkZ2, B=ParkB2, C=ParkC2, S=Speed})
+               end
             else
-               EmitMoveDataHead( 2, { X=ParkX2, S=Speed})
+               if EMT.HEAD == 'H22' then
+                  EmitMoveDataHead( 2, { X=ParkSawX2, S=Speed})
+               else
+                  EmitMoveDataHead( 2, { X=ParkX2, S=Speed})
+               end
             end
             EmitMoveStartHead( 2)
             EmitMoveWaitHead( 2)
@@ -780,8 +833,8 @@ function OnRapid()
                local dPosT = EMT.TPOS or EMT.L1op
                EmitParkRoller( dPosT, bSplitCut)
             end
-            EmitMoveDataHead( 2, { X=EMT.L2, Z=EMT.L3, S=Speed})
             EmitMoveDataHead( 2, { B=EMT.R2, C=EMT.R1, S=Speed})
+            EmitMoveDataHead( 2, { X=EMT.L2, Z=EMT.L3, S=Speed})
             EmitMoveStartHead( 2)
             -- eventuale preselezione successiva testa 1
             PreselectNextDiffHead( EMT.MCHID, EMT.HEAD)
@@ -816,10 +869,6 @@ function OnRapid()
             -- aspetto esecuzione movimento testa 3
             EmitMoveWaitHead( 3)
          end
-         -- se pezzo a destra, dichiaro cabina sinistra da parcheggiare
-         if not EMT.Y1DELTA then
-            EMT.V1NEXTPOS = ParkV1
-         end
          -- dati aggancio a trave
          local BhData = { T=EMT.L1, SetHead=0}
          if EMT.Y1DELTA then
@@ -872,7 +921,18 @@ function OnRapid()
       else
          --MyOutput( string.format( 'V1Pos=%.3f V2Pos=%.3f', EMT.V1POS, EMT.V2POS))
          if not EMT.RELOAD and not EMT.ZMAX and #EMT.AUXCMD > 0 and EMT.TO_ZMAX then
-            EmitZmax( false, false, PrevR1, PrevR2)
+            -- caso speciale in cui bisogna solo cambiare presa aggregato lama sotto
+            if EMT.R3_CHANGED then 
+               -- EmitZmax è fatta per essere chiamata con utensile attuale. In questo caso l'attuale è già quello con nuova rotazione
+               -- Allora salvo l'attuale e imposto il vecchio solo momentanemente, per poi ripristinarlo
+               local sBckTcPos = EMT.TCPOS
+               EMT.TCPOS = EMT.PREVTCPOSREAL_H2
+               EmitZmax( false, false, PrevR1, PrevR2)
+               EMT.TCPOS = sBckTcPos
+               EMT.R3_CHANGED = nil
+            else
+               EmitZmax( false, false, PrevR1, PrevR2)
+            end
             EMT.ZMAX = true
             EMT.TO_ZMAX = nil
             PrevR1 = EgtGetAxisHomePos( EgtIf( nHSet == 1, 'C1', 'C2'))
@@ -899,10 +959,6 @@ function OnRapid()
             EmitMoveWaitChars( nMoveType)
          end
          EMT.MDCHAR = {}
-         -- se pezzo a destra, dichiaro cabina sinistra da parcheggiare
-         if not EMT.Y1DELTA then
-            EMT.V1NEXTPOS = ParkV1
-         end
          -- se necessario allargo le cabine
          if RollerParkingNeeded( EMT.HEAD, PrevR1, PrevR2, EMT.R1, EMT.R2) or
             EMT.V1POS < EMT.V1NEXTPOS - 1 or EMT.V2POS > EMT.V2NEXTPOS + 1 then
@@ -948,7 +1004,7 @@ function OnRapid()
                      if not WriteAllCoordsOnFirstM101 then
                         EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, EMT.L2), S=Speed})
                      end
-                     EmitMoveDataHead( 1, { B=0, S=Speed})
+                     EmitMoveDataHead( 1, { Z=MyMaxZ1, B=0, S=Speed})
                      EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
                      EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
                      EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
@@ -962,14 +1018,19 @@ function OnRapid()
                else
                   -- se bisogna scrivere tutti gli assi
                   if WriteAllCoordsOnFirstM101 then
-                     EmitMoveDataHead( 1, { X=ParkCSawX1, Z=ParkCSawZ1, B=HomeB1, C=HomeC1, TRad=dTRad, TLen=dTLen, S=Speed})
+                     local dSafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
+                     EmitMoveDataHead( 1, { X=-ParkCSawX1, Z=dSafeZ1, B=HomeB1, C=HomeC1, TRad=dTRad, TLen=dTLen, S=Speed})
                   end
                   -- Porto la Z alla giusta quota
                   if EMT.L3 > HomeZ1 + 1 and abs( EMT.R2) > 89.9 then
                      EmitMoveDataHead( 1, { X=EMT.L2, S=Speed})
                      EmitMoveDataHead( 1, { Z=HomeZ1, S=Speed})
                   end
-                  EmitMoveDataHead( 1, { Z=HomeZ1, B=EMT.R2, S=Speed})
+                  EmitMoveDataHead( 1, { Z=EMT.L3, B=EMT.R2, S=Speed})
+                  -- se motosega molto lunga, ruoto prima di muovermi in X
+                  if EMT.TTOTLEN >= MinLengthLongCSaw then
+                     EmitMoveDataHead( 1, { C=EMT.R1, S=Speed})
+                  end
                end
             end
             EmitMoveDataHead( 1, { X=EMT.L2, Z=EMT.L3, B=EMT.R2, C=EMT.R1, S=Speed})
@@ -1030,16 +1091,37 @@ function OnRapid()
             local CurrB2 = PrevR2
             local CurrC2 = PrevR1
             local dSafeZ2 = EgtGetAxisHomePos( 'Z2')
-            local Speed = EMT.S
-            if EMT.ZMAX then
+            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
                -- se bisogna scrivere tutti gli assi
                if WriteAllCoordsOnFirstM101 then
-                  EmitMoveDataHead( 2, { X=SafeX2, Z=CurrZ2, B=CurrB2, C=CurrC2, S=Speed})
+                  if EMT.HEAD == 'H22' then
+                     EmitMoveDataHead( 2, { X=ParkSawX2, Z=-dSafeZ2, B=0, C=CurrC2, S=Speed})
+                  else
+                     EmitMoveDataHead( 2, { X=SafeX2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed})
+                  end
                end
+               -- scrivo solo se gli assi rotanti sono cambiati
                EmitMoveDataHead( 2, { Z=-dSafeZ2, S=Speed})
-               EmitMoveDataHead( 2, { X=EMT.L2, S=Speed})
+               if EMT.HEAD ~= 'H22' and EMT.L2p > ParkMchY2 and ( CurrB2 ~= EMT.R2  or  CurrC2 ~= EMT.R1) then
+                  EmitMoveDataHead( 2, { X=ParkMchY2, Z=-dSafeZ2, B=CurrB2, C=CurrC2, S=Speed}) 
+               end
+            -- se stesso utensile vado già alla X di lavoro
+            else
+               -- scrivo solo se gli assi rotanti sono cambiati
+               if EMT.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
-            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)
@@ -1124,7 +1206,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))
@@ -1144,7 +1226,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
@@ -1183,7 +1265,12 @@ function OnRapid()
       local sAxes = EmtGetAxis('L1')..EmtGetAxis('L2')..EmtGetAxis('L3')..
                     EmtGetAxis('R2')..EmtGetAxis('R1')
       if #sAxes > 0 then
-         MyOutput( 'G0' .. sAxes)
+         if EmitRapidInG1 then
+            local sFeed = ' F30000'
+            MyOutput( 'G1' .. sAxes .. sFeed)
+         else
+            MyOutput( 'G0' .. sAxes)
+         end
       end
    -- se altrimenti risalita a Z max a fine lavorazione
    elseif EMT.FLAG == 3 then
@@ -1193,9 +1280,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
@@ -1241,8 +1328,15 @@ function OnLinear()
       -- emissione movimento
       EMT.R1p = nil
       EMT.R2p = nil
-      sOut = 'G0'..EmtGetAxis('L1')..EmtGetAxis('L2')..EmtGetAxis('L3')..
-                   EmtGetAxis('R2')..EmtGetAxis('R1')
+      if EmitRapidInG1 then
+         local sFeed = ' F30000'
+         sOut = 'G1'..EmtGetAxis('L1')..EmtGetAxis('L2')..EmtGetAxis('L3')..
+                      EmtGetAxis('R2')..EmtGetAxis('R1')..sFeed
+      else
+         sOut = 'G0'..EmtGetAxis('L1')..EmtGetAxis('L2')..EmtGetAxis('L3')..
+                      EmtGetAxis('R2')..EmtGetAxis('R1')
+      end
+
       MyOutput( sOut)
       -- aggiorno precedenti
       EMT.MOVE = 0
@@ -1339,7 +1433,7 @@ end
 function CalcDinamicaPinze( dH, dS, dL)
    local MinTempoAcc = 0.6                         -- [s]
    local MaxTempoAcc = 6.0                         -- [s]
-   local KgMtCubo= 550                             -- densità legno [Kg / metro cubo]
+   local KgMtCubo= WoodDensity or 550             -- densità legno [Kg / metro cubo]
    local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
    local FMaxPinze = EMT.FMAXPINZE                 -- Feed massima pinze [mm/min]
    local ForzaAttrito = 350 * 9.8 * 0.2            -- Forza chiusura pinze [Kgf] * g * Coeff_Attrito -> [N]
@@ -1364,7 +1458,7 @@ function CalcForzaPinze( dH, dS, dL, dT)
    if dMinJoin < 0.9 * BD.MIN_JOIN_L then
       return MinForzaPinze
    else
-      local KgMtCubo= 550                             -- densità legno [Kg / metro cubo]
+      local KgMtCubo= WoodDensity or 550              -- densità legno [Kg / metro cubo]
       local Massa = ( dH * dS * dL * KgMtCubo ) / 1e9 -- massa [Kg]
       local Forza = Massa / MassaRef * MaxForzaPinze
       return EgtClamp( Forza, MinForzaPinze, MaxForzaPinze)
@@ -1612,7 +1706,10 @@ function PrepareMoveChar( sCmd, nInd)
    elseif Cmd[1] == '11' then
       EMT.ISY1 = CalcCharStatusN( Cmd[2])
       EMT.FSY1 = EMT.ISY1
-      EMT.BV = EgtIf( Cmd[2] ~= '0', 1, 2)
+      -- se pinza due in presa, non attivo la 1
+      if EMT.BV ~= 2 then
+         EMT.BV = EgtIf( Cmd[2] ~= '0', 1, 2)
+      end
       if #EMT.MDCHAR > 0 then EMT.MDCHAR[#EMT.MDCHAR].FinStatY1 = EMT.FSY1 end
    elseif Cmd[1] == '12' then
       EMT.ISY2 = CalcCharStatusN( Cmd[2])
@@ -1927,7 +2024,7 @@ end
 function GetV1ToCloseTPA()
    local dMaxHeadPos = EMT.MAXMAX[1] + ( EMT.HOVM or 0) - ( EMT.X_OFF or 0)
    local dMinTailPos = EMT.MAXMIN[1] + EMT.LB + EgtIf( IsStartOrMidPhase( EMT.PHASE), 0, ( EMT.HOVM or 0)) - ( EMT.X_OFF or 0)
-   --MyOutput( string.format( 'V1 MaxHeadPos=%.3f MinTailPos=%.3f BarLen=%.3f HeadOvm=%.3f', dMaxHeadPos, dMinTailPos, EMT.LB, ( EMT.HOVM or 0)))
+   --MyOutput( string.format( 'V1 MaxHeadPos=%.3f MinTailPos=%.3f BarLen=%.3f HeadOvm=%.3f V1NextPos=%.3f', dMaxHeadPos, dMinTailPos, EMT.LB, ( EMT.HOVM or 0), EMT.V1NEXTPOS))
    return ( dMaxHeadPos <= EMT.V1NEXTPOS + RollCageMin and dMinTailPos >= EMT.V1NEXTPOS + RollCageMax)
 end
 
@@ -1968,7 +2065,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
@@ -2050,17 +2147,17 @@ function AdjustTcPos( bLen3, sTcPos, dAxR3)
       if not dAxR3 then dAxR3 = EMT.R3 end
       if abs( dAxR3 - 0) < 0.1 then
          sPos = '201'
-      elseif abs( dAxR3 - 270) < 0.1 then
-         sPos = '202'
-      elseif abs( dAxR3 - 180) < 0.1 then
-         sPos = '203'
       elseif abs( dAxR3 - 90) < 0.1 then
          sPos = '204'
+      -- Lama su aggregato da sotto non può essere presa in queste posizioni per problemi di collisione durante parcheggio
+      --elseif abs( dAxR3 - 270) < 0.1 then
+      --   sPos = '202'
+      --elseif abs( dAxR3 - 180) < 0.1 then
+      --   sPos = '203'
       else
          EmtSetLastError( 1210, 'Saw orientation not allowed')
       end
    end
-
    return sPos
 end
 
@@ -2095,7 +2192,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) ..
@@ -2198,19 +2296,15 @@ function EmitZmax( bReset, bEnd, PrevR1, PrevR2, bSplitCut, bTopGoHome)
          EmitMoveWaitHead( 1)
       -- altrimenti sega a catena
       else
-         -- salzo in Z sicurezza raddrizzando la B
-         EmitMoveDataHead( 1, { Z=ParkCSawZ1, B=dHomeB1, Fmt=1})
+         -- salgo in Z sicurezza raddrizzando la B
+         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')
@@ -2224,7 +2318,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
@@ -2339,8 +2441,8 @@ function EmitParkRoller( dPosT, bSplitCut)
       local dPosY2 = dPosT + EMT.Y2DELTA
       local DiffY2 = MyParkY2 - dPosY2
       local dMoveY2 = EgtIf( DiffY2 < -0.1, dMoveV2, 0)
-      local dTryMoveY2 = ParkV2 - dPosT - EMT.LT
-      if ( dPosT + EMT.LT < ParkV1 + ExtraParkV and dPosT + EMT.LT > ParkV2 and dPosY2 + dTryMoveY2 > MinY2) then dMoveY2 = min( dMoveY2, dTryMoveY2) end
+      local dTryMoveY2 = ParkV2 - dPosT - EMT.LT - EMT.HOVM
+      if ( dPosT + EMT.LT + EMT.HOVM < ParkV1 + ExtraParkV and dPosT + EMT.LT + EMT.HOVM > ParkV2 and dPosY2 + dTryMoveY2 > MinY2) then dMoveY2 = min( dMoveY2, dTryMoveY2) end
       --MyOutput( string.format( 'PosT=%.3f LT=%.3f PosY2=%.3f V2POS=%.3f', dPosT, EMT.LT, dPosY2, EMT.V2POS))
       MDChar.Y2 = dPosY2 + dMoveY2
       MDChar.MovType = 2
@@ -2387,27 +2489,94 @@ end
 
 ---------------------------------------------------------------------
 function PreselectNextDiffHead( nMchId, sHead)
-   -- se in uso testa 1, verifico di non scendere troppo in Z per evitare collisioni (per testa 3 non serve il controllo)
-   local nHSet = GetHeadSet( sHead)
-   if nHSet == 1 then
-      if EMT.MAXMIN[3] < MinZ1ToChangeH2 then return end
-   end
-   -- recupero lavorazione successiva
+   -- recupero lavorazione successiva, se non esiste esco subito
    local nNextMchId = EgtGetNextActiveOperation( nMchId)
    while nNextMchId do
       if EgtGetOperationType( nNextMchId) ~= MCH_OY.DISP then break end
       nNextMchId = EgtGetNextActiveOperation( nNextMchId)
    end
    if not nNextMchId then return end
-   -- se esiste ed appartiene a gruppo diverso
+
+   -- se esiste lavorazione successiva
    if EgtSetCurrMachining( nNextMchId) then
       local sNextTool = EgtGetMachiningParam( MCH_MP.TOOL)
       if EgtTdbSetCurrTool( sNextTool) then
+         local nHSet = GetHeadSet( sHead)
          local sNextHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
          local nNextHSet = GetHeadSet( sNextHead)
-         if nNextHSet ~= nHSet and nNextHSet ~= 3 and ( nHSet ~= 3 or nNextHSet ~= 1) then
+         -- se utensile su altra testa
+         if nNextHSet ~= nHSet then
             local sNextTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
             local dNextTotLen = EgtTdbGetCurrToolParam( MCH_TP.TOTLEN)
+
+            -- se sto lavorando con testa 1
+            if nHSet == 1 then
+               -- se preselezione testa 2
+               if nNextHSet == 2 then
+                  -- se agregato lama speciale non preseleziono mai
+                  if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then return end
+                  -- 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 + 200) then return end
+                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( DeltaTabY + 200) then return end
+                  end
+               -- se preselezione testa 3
+               else
+                  ; -- non devo fare nulla
+               end
+            -- se sto lavorando con testa 2
+            elseif nHSet == 2 then
+               -- se preselezione testa 1
+               if nNextHSet == 1 then
+                  -- se sopra Z oltre la faccia sotto della trave, controllo il cambio utensile
+                  if EMT.MAXMIN[3] > Delta2TabZ then
+                     local nNextTc = GetTcForTopHeadTool( sNextTcPos)   -- utensile da caricare
+                     local nPrevTc = GetTcForTopHeadTool( EMT.PREVTCPOS_H1) -- utensile da depositare
+                     -- se deposito e carico da diversi TC non faccio preselezione
+                     if nNextTc ~= nPrevTc and nPrevTc ~= 0 then return
+                     -- 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 - 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 + 200) then return end
+                           if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > ( Delta2TabY + 200) then return end
+                        end
+                     end
+                  end
+               -- se preselezione testa 3
+               else
+                  ; -- non devo fare nulla
+               end
+            -- altrimenti (testa 3)
+            else
+               -- se preselezione testa 1
+               if nNextHSet == 1 then
+                  -- TC su montante destro
+                  if nPrevTc == 1 then return
+                  -- TC su montante sinistro
+                  else
+                     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
+               else
+                  -- se agregato lama speciale non preseleziono mai
+                  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 + 200) then return end
+                     if not BD.RIGHT_LOAD and EMT.MAXMAX[2] > DeltaTabY then return end
+                  end
+               end
+            end
+
+            -- faccio preselezione ( se sono arrivato qui, vuol dire che posso preselezionare)
             if nNextHSet == 1 then
                -- Recupero quota X1 (nostro L2)
                local dNextX = GetStartMachiningXaxis( nNextMchId)
@@ -2417,7 +2586,7 @@ function PreselectNextDiffHead( nMchId, sHead)
                      EmitMoveDataHead( 1, { X=dNextX, B=ParkB1, C=ParkC1, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                   else
                      local nNextTc = GetTcForTopHeadTool( sNextTcPos)
-                     EmitMoveDataHead( 1, { X=dNextX, B=ParkLongB1, C=EgtIf( nTc ~= 2, ParkLongTc1C1, ParkLongTc2C1), TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
+                     EmitMoveDataHead( 1, { X=dNextX, B=ParkLongB1, C=EgtIf( nPrevTc ~= 2, ParkLongTc1C1, ParkLongTc2C1), TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                   end
                   EmitMoveStartHead( 1)
                elseif sNextHead == 'H12' or sNextHead == 'H16' then
@@ -2426,19 +2595,13 @@ function PreselectNextDiffHead( nMchId, sHead)
                elseif sNextHead == 'H13' then
                   -- recupero il valore dell'asse virtuale bloccato A
                   local dPosA = GetCurrChainSawingVirtualAxis()
-                  local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA)
+                  local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
                   local bXSpec = EgtIf( BD.RIGHT_LOAD, ( dNextX > -DeltaTabY), ( dNextX < -DeltaTabY))
                   EmitMoveDataHead( 1, { X=EgtIf( bXSpec, -DeltaTabY, dNextX), B=ParkCSawB1, C=MyParkCSawC1, TPos=AdjustTcPos( false, sNextTcPos, dPosA), Fmt=2})
                   EmitMoveStartHead( 1)
                end
             else
-               -- non si può preselezionare lama su aggregato da sotto
-               -- Se è già montata, non preseleziono altro utensile fino all'effettiva lavorazione altro utensile
-               if sNextHead == 'H22' or EMT.PREVHEAD_H2 == 'H22' then
-                  return
-               else
-                  EmitMoveDataHead( 2, { B=ParkB2, C=ParkC2, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
-               end
+               EmitMoveDataHead( 2, { B=ParkB2, C=ParkC2, TPos=AdjustTcPos( false, sNextTcPos), Fmt=2})
                EmitMoveStartHead( 2)
             end
          end
@@ -2516,8 +2679,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
@@ -2526,7 +2699,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

@@ -1,4 +1,4 @@
--- Processore standard macchine tipo PF1250 by EgalWare s.r.l.   2023/12/14
+-- Processore standard macchine tipo PF1250 by EgalWare s.r.l.   2024/01/22
 
 -- Funzioni generiche indipendenti dal controllo
 
@@ -6,14 +6,17 @@
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
+-- Carico libreria
+local BD = require( 'BeamData')
+
 ---------------------------------------------------------------------
 -- *** GENERATION ***
 ---------------------------------------------------------------------
-local sBaseDir = EgtGetSourceDir()
+local sBaseDir = EgtGetCurrMachineDir()
 if NumericalControl == 'NUM' then
    error( 'Numerical Control error : NUM not yet managed')
 elseif NumericalControl == 'TPA' then
-   dofile( sBaseDir .. 'Common-PF1250.TPA.mlpe')
+   dofile( sBaseDir .. '\\Common-PF1250.TPA.mlpe')
 else
    error( 'Numerical Control error : unkwnown type')
 end
@@ -23,6 +26,45 @@ end
 ---------------------------------------------------------------------
 local COLL_SAFE_DIST = 3
 
+---------------------------------------------------------------------
+function OnSimulInit()
+   -- se macchina con carico destro, imposto offset direzioni di vista standard
+   if BD.RIGHT_LOAD then
+      local nOrigViewOffs = EgtGetViewOrizzOffsStep()
+      local dOrigViewAngV, dOrigViewAngH = EgtGetGenericView()
+      if nOrigViewOffs ~= 2 then
+         EgtSetViewOrizzOffsStep( 2)
+         if dOrigViewAngV < 0.1 then
+            EgtSetView( SCE_VD.TOP, false)
+         elseif dOrigViewAngV > 179.9 then
+            EgtSetView( SCE_VD.BOTTOM, false)
+         else
+            local dViewAngH = dOrigViewAngH + EgtIf( dOrigViewAngH > 180, 2 * 90, 0)
+            EgtSetGenericView( dOrigViewAngV, dViewAngH, false)
+         end
+      end
+   end
+end
+
+---------------------------------------------------------------------
+function OnSimulExit()
+   -- se macchina con carico destro, annullo offset direzioni di vista standard
+   if BD.RIGHT_LOAD then
+      local nOrigViewOffs = EgtGetViewOrizzOffsStep()
+      local dOrigViewAngV, dOrigViewAngH = EgtGetGenericView()
+      if nOrigViewOffs == 2 then
+         EgtSetViewOrizzOffsStep( 0)
+         if dOrigViewAngV < 0.1 then
+            EgtSetView( SCE_VD.TOP, false)
+         elseif dOrigViewAngV > 179.9 then
+            EgtSetView( SCE_VD.BOTTOM, false)
+         else
+            EgtSetGenericView( dOrigViewAngV, dOrigViewAngH - 2 * 90, false)
+         end
+      end
+   end
+end
+
 ---------------------------------------------------------------------
 function OnSimulStart()
    -- controllo versione programma
@@ -78,9 +120,15 @@ 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 = 'X3', Sub = 'COLLISION', Name = 'STM'})
+   end
 
    -- inserisco gruppi opzionali
    if SecondChain then table.insert( McdData, { Grp = 'Base', Sub = 'COLLISION', Name = 'CHSAW2'}) end
@@ -259,8 +307,8 @@ function OnSimulDispositionStart()
          EMT.SCRAP = nil
       end
       EMT.LB = b3Bar:getDimX()
-      EMT.LT = b3Raw:getDimX()
-      EMT.LP = b3Part:getDimX()
+      EMT.LR = b3Raw:getDimX()
+      EMT.LT = b3Part:getDimX()
       EMT.CUTID = EgtGetInfo( EgtGetFirstPartInRawPart( nPartRawId or GDB_ID.NULL) or GDB_ID.NULL, 'CUTID', 'i') or 0
       EMT.Y1SPEC = nil
       -- se vero inizio, assegno solidi per verifica collisione
@@ -408,6 +456,9 @@ function OnSimulToolSelect( dPosA)
       if EgtGetHeadId( 'H31') then
          EgtSetAxisPos( 'X3', ParkX3)
       end
+      if EMT.HEAD == 'H12' or EMT.HEAD == 'H16' then
+         EgtSetAxisPos( 'Z1', MaxZ1Blade)
+      end
       EgtResetAxisPos( 'C1')
       EgtResetAxisPos( 'B1')
    -- se testa 3 parcheggio la 1
@@ -421,7 +472,7 @@ function OnSimulToolSelect( dPosA)
       -- imposto il valore di A
       EgtSetAxisPos( 'A1', dPosA)
       -- imposto home dell'asse C1 (A1=0 -> T101, A1=90 -> T104)
-      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA)
+      local MyParkCSawC1 = GetChainSawCHomeFromVirtualAxis( dPosA, EMT.TTOTLEN)
       EmtModifyAxisHome( 'C1', MyParkCSawC1)
       EgtSetAxisPos( 'C1', MyParkCSawC1)
       -- Imposto visualizzazione
@@ -429,16 +480,20 @@ 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)
+      -- se c'era un altro utensile, imposto subito asse virtuale
+      if EMT.PREVHEAD_H2 ~= 'H22' then
+         dPosA = dPosA or GetNextSawingVirtualAxis( EMT.MCHID)      
+      end
+      if dPosA then
+         -- imposto il valore di A
+         EgtSetAxisPos( 'A2', dPosA)
+         -- imposto home dell'asse C1 (A2=0 -> T201, A2=90 -> T204)
+         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)
@@ -467,14 +522,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 then
+   elseif nNextSetHead == 2 then
       -- deposito lama su aggregato testa sotto
       if EMT.PREVHEAD_H2 == 'H22' then
          -- simulo movimento
@@ -482,6 +541,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
@@ -492,7 +552,7 @@ function OnSimulToolDeselect( dPrevA)
       -- nascondo l'utensile sulla testa
       EgtSetStatus( EgtGetHeadId( EMT.PREVHEAD_H2 or '') or GDB_ID.NULL, GDB_ST.OFF)
    -- se testa gruppo 1
-   else
+   elseif nNextSetHead == 1 and EMT.PREVTCPOS_H1 then
       -- deposito utensile fresa
       if EMT.PREVHEAD_H1 == 'H11' then
          -- simulo movimento
@@ -503,11 +563,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
@@ -522,7 +582,7 @@ function OnSimulToolDeselect( dPrevA)
          -- simulo movimento
          local ParkC1 = EgtGetAxisHomePos( 'C1')
          if dPrevA then
-            ParkC1 = GetChainSawCHomeFromVirtualAxis( dPrevA)
+            ParkC1 = GetChainSawCHomeFromVirtualAxis( dPrevA, EMT.TTOTLEN)
          end
          SimulMoveAxes( 'B1', ParkCSawB1, MCH_SIM_STEP.RAPROT, 'C1', ParkC1, MCH_SIM_STEP.RAPROT)
          SimulMoveAxis( 'X1', ParkCSawX1, MCH_SIM_STEP.RAPID)
@@ -549,8 +609,6 @@ function OnSimulToolDeselect( dPrevA)
          EgtSetMode( EgtGetHeadId( EMT.PREVHEAD_H1 or '') or GDB_ID.NULL, GDB_MD.HIDDEN)
       end
       SimulMoveAxis( 'X1', ParkX1, MCH_SIM_STEP.RAPID)
-   elseif nNextSetHead == 1 then
-      SimulMoveAxis( 'X3', ParkX3, MCH_SIM_STEP.RAPID)
    end
    -- movimento per prendere nuovo utensile
    -- prendo utensile fresa
@@ -611,32 +669,15 @@ function OnSimulMachiningStart()
       local dPosA = tonumber( sVal:sub( 4)) or 0
       if abs( dPosA - dPrevA) > 1 then
          ExecParkRoller( nil, nil, nil, nil, false, bAgg)
+         -- setto i valori per la funzione ToolDesel
+         EMT.NEXTHEAD = EMT.HEAD
+         EMT.NEXTTOOL = EMT.TOOL 
+         EMT.NEXTEXIT = EMT.EXIT
          OnSimulToolDeselect( dPrevA)
          EgtSetStatus( EgtGetHeadId( EMT.HEAD), GDB_ST.ON)
          OnSimulToolSelect( dPosA)
       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)
@@ -697,6 +738,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
@@ -714,6 +756,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
 
 ---------------------------------------------------------------------
@@ -730,13 +795,13 @@ 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
          EMT.SPLIT_Y1DELTA = EMT.Y1DELTA
          EMT.Y1DELTA = nil
-         SetPY1Light( false)
+         ExecMovePY1( false)
       end
       ExecMoveZmax( EMT.MCHSPLIT)
       EMT.TO_ZMAX = nil
@@ -746,19 +811,19 @@ end
 ---------------------------------------------------------------------
 function OnSimulPathStartAux()
    -- eseguo il comando
-   ExecAuxCmd( EMT.AUX)
+   ExecAuxCmd( EMT.AUX, true)
    -- se ultimo comando e lavorazione di split, sgancio il carro Y1
    if EMT.AUXIND == EMT.AUXTOT and EMT.MCHSPLIT and not EMT.TO_FALL then
       EMT.SPLIT_Y1DELTA = EMT.Y1DELTA
       EMT.Y1DELTA = nil
-      SetPY1Light( false)
+      ExecMovePY1( false)
    end
 end
 
 ---------------------------------------------------------------------
 function OnSimulPathEndAux()
    -- eseguo il comando
-   ExecAuxCmd( EMT.AUX)
+   ExecAuxCmd( EMT.AUX, false)
    -- se ultimo comando e richiesta risalita a Zmax
    if EMT.AUXIND == EMT.AUXTOT and EMT.TO_ZMAX then
       ExecMoveZmax( EMT.MCHSPLIT)
@@ -848,6 +913,7 @@ function OnSimulMoveStart()
          local C1Home = EgtGetAxisHomePos( 'C1')
          local Z1Pos = EgtGetAxisPos( 'Z1')
          local Z1Home = EgtGetAxisHomePos( 'Z1')
+         local MyMaxZ1 = EgtGetAxisMax( 'Z1')
          -- se fresa o lama
          if EMT.HEAD ~= 'H13' then
             -- se movimento iniziale da Zmax con lama o fresa
@@ -856,7 +922,7 @@ function OnSimulMoveStart()
                -- in caso di rotazione della lama lontano dalla posizione di home degli assi rotanti
                if ( EMT.HEAD == 'H12' or EMT.HEAD == 'H16') and ( abs( C1Pos - EMT.R1) > 1 or abs( B1Pos - EMT.R2) > 1) and ( abs( C1Home - EMT.R1) > 30.1 or abs( B1Home - EMT.R2) > 30.1) then
                   SimulMoveAxis( 'X1', EgtIf( bXSpec, DeltaTabY, EMT.L2), MCH_SIM_STEP.RAPID)
-                  SimulMoveAxis( '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)
@@ -882,6 +948,10 @@ function OnSimulMoveStart()
             -- se movimento iniziale da Zmax
             if EMT.ZMAX or ( EMT.FLAG == 2 and EMT.FLAG2 == 1) then
                SimulMoveAxes( 'Z1', Z1Home, MCH_SIM_STEP.RAPID, 'B1', EMT.R2, MCH_SIM_STEP.COLLROT)
+               -- se motosega molto lunga, ruoto prima di muovermi in X
+               if EMT.TTOTLEN >= MinLengthLongCSaw then
+                  SimulMoveAxis( 'C1', EMT.R1, MCH_SIM_STEP.COLLROT)
+               end
             end
          end
       -- se altrimenti testa 2
@@ -889,13 +959,39 @@ function OnSimulMoveStart()
          local B2Home = EgtGetAxisHomePos( 'B2')
          local C2Home = EgtGetAxisHomePos( 'C2')
          local Z2Home = EgtGetAxisHomePos( 'Z2')
-         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 X2Home = EgtGetAxisHomePos( 'X2')
+         local X2Pos = EgtGetAxisPos( 'X2')
+         local B2Pos = EgtGetAxisPos( 'B2')
+         local C2Pos = EgtGetAxisPos( 'C2')
+         if EMT.TOOL ~= EMT.PREVTOOL_H2 then
+            if EMT.ZMAX then
+               -- se bisogna scrivere tutti gli assi
+               if WriteAllCoordsOnFirstM101 then
+                  if EMT.HEAD == 'H22' and  EMT.PREVHEAD_H2 ~= EMT.HEAD then
+                     SimulMoveAxes( 'X2', ParkSawX2, MCH_SIM_STEP.RAPID, 'B2', 0, MCH_SIM_STEP.COLLROT, 'C2', C2Home, MCH_SIM_STEP.COLLROT)
+                  else
+                     SimulMoveAxes( 'X2', SafeX2, MCH_SIM_STEP.RAPID, 'B2', B2Home, MCH_SIM_STEP.COLLROT, 'C2', C2Home, MCH_SIM_STEP.COLLROT)
+                  end
+               end
+               SimulMoveAxis( 'Z2', Z2Home, MCH_SIM_STEP.RAPID)
+               -- Porto la X alla giusta quota
+               if EMT.HEAD ~= 'H22' and X2Pos > ParkMchY2 and ( B2Pos ~= EMT.R2  or  C2Pos ~= EMT.R1) then
+                  SimulMoveAxis( 'X2', ParkMchY2, MCH_SIM_STEP.RAPID)
+               end
+            else
+               -- 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 
@@ -947,7 +1043,7 @@ function OnSimulMoveStart()
                EmtSetLastError( 1208, sErr)
             end
             -- se appena sopra inizio, sistemo subito la quota in Z
-            if EMT.MOVE == 0 and EMT.FLAG == 1 then
+            if EMT.MOVE == 0 then
                SimulMoveAxes( 'Z2', EMT.A6, MCH_SIM_STEP.RAPID)
             end
          end
@@ -1009,16 +1105,21 @@ 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
       if EMT.SPLIT_Y1DELTA then
          EMT.SPLIT_Y1DELTA = nil
-         SetPY1Light( true)
+         ExecMovePY1( true)
       end
       -- chiusura o apertura rulli V1
       if GetV1ToClose() then
@@ -1052,7 +1153,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
@@ -1081,7 +1182,7 @@ function OnSimulCollision()
 end
 
 ---------------------------------------------------------------------
-function ExecAuxCmd( sCmd)
+function ExecAuxCmd( sCmd, bPathStart)
    -- analizzo il comando
    local Cmd = EgtSplitString( sCmd)
    if Cmd[1] == '0' then
@@ -1094,29 +1195,31 @@ function ExecAuxCmd( sCmd)
       end
       EgtOutText( Cmd[2])
    elseif Cmd[1] == '1' then
-      if EMT.SPLIT then ExecOpenRoller( 1) end
-      if EMT.UNLOADING or EMT.TO_FALL then ExecOpenRoller( 2) end
-      local sV1, MoveV1, sV2, MoveV2 = CalcMoveV1V2ForAuxCmd( Cmd)
-      local bOk, bOk1, bOk2, bOk3 = SimulMoveAxes( Cmd[2], tonumber( Cmd[3]), MCH_SIM_STEP.RAPID,
-                                                   sV1, MoveV1, MCH_SIM_STEP.RAPID,
-                                                   sV2, MoveV2, MCH_SIM_STEP.RAPID)
-      if not bOk then
-         if not bOk1 then
-            if VerifyY1Y2Stroke( Cmd[2], tonumber( Cmd[3])) == nil then 
-               EgtOutLog( 'Error on ExecAuxCmd : ' .. sCmd)
+      if Cmd[2] ~= 'Z' then
+         ExecOpenRoller( 1)
+         ExecOpenRoller( 2)
+         local sV1, MoveV1, sV2, MoveV2 = CalcMoveV1V2ForAuxCmd( Cmd)
+         local bOk, bOk1, bOk2, bOk3 = SimulMoveAxes( Cmd[2], tonumber( Cmd[3]), MCH_SIM_STEP.RAPID,
+                                                      sV1, MoveV1, MCH_SIM_STEP.RAPID,
+                                                      sV2, MoveV2, MCH_SIM_STEP.RAPID)
+         if not bOk then
+            if not bOk1 then
+               if VerifyY1Y2Stroke( Cmd[2], tonumber( Cmd[3])) == nil then 
+                  EgtOutLog( 'Error on ExecAuxCmd : ' .. sCmd)
+               end
+            elseif not bOk2 then
+               VerifyV1V2Stroke( sV1, MoveV1)
+            elseif not bOk3 then
+               VerifyV1V2Stroke( sV2, MoveV2)
             end
-         elseif not bOk2 then
-            VerifyV1V2Stroke( sV1, MoveV1)
-         elseif not bOk3 then
-            VerifyV1V2Stroke( sV2, MoveV2)
          end
       end
    elseif Cmd[1] == '2' then
       -- Verifico movimento carrello con trave agganciata
       VerifyOneChariotSlide( Cmd[2], Cmd[3], Cmd[4], Cmd[5])
       -- Eseguo i movimenti necessari
-      if EMT.SPLIT then ExecOpenRoller( 1) end
-      if EMT.UNLOADING or EMT.TO_FALL then ExecOpenRoller( 2) end
+      ExecOpenRoller( 1)
+      ExecOpenRoller( 2)
       local sV1, MoveV1, sV2, MoveV2 = CalcMoveV1V2ForAuxCmd( Cmd)
       local bOk, bOk1, bOk2, bOk3, bOk4 =  SimulMoveAxes( Cmd[2], tonumber( Cmd[3]), MCH_SIM_STEP.RAPID,
                                                           Cmd[4], tonumber( Cmd[5]), MCH_SIM_STEP.RAPID,
@@ -1138,8 +1241,8 @@ function ExecAuxCmd( sCmd)
       -- Verifico movimento carrelli con trave agganciata
       VerifyTwoChariotsSlide( Cmd[2], Cmd[3], Cmd[4], Cmd[5], Cmd[6], Cmd[7])
       -- Eseguo i movimenti necessari
-      if EMT.SPLIT then ExecOpenRoller( 1) end
-      if EMT.UNLOADING or EMT.TO_FALL then ExecOpenRoller( 2) end
+      ExecOpenRoller( 1)
+      ExecOpenRoller( 2)
       local sV1, MoveV1, sV2, MoveV2 = CalcMoveV1V2ForAuxCmd( Cmd)
       local bOk, bOk1, bOk2, bOk3, bOk4, bOk5 = SimulMoveAxes( Cmd[2], tonumber( Cmd[3]), MCH_SIM_STEP.RAPID,
                                                                Cmd[4], tonumber( Cmd[5]), MCH_SIM_STEP.RAPID,
@@ -1159,13 +1262,13 @@ function ExecAuxCmd( sCmd)
          end
       end
    elseif Cmd[1] == '4' then
-      ExecMoveHome( Cmd[2] == '1', EMT.MCHSPLIT)
+      ExecMoveHome( Cmd[2] == '1', EgtIf( bPathStart, false, EMT.MCHSPLIT))
    elseif Cmd[1] == '11' then
-      SimulMoveAxes( 'PY1', EgtIf( Cmd[2] == '0', MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
-      SetPY1Light( Cmd[2] ~= '0')
+      local bClose = Cmd[2] ~= '0'
+      if bPathStart and EMT.MCHSPLIT and not EMT.FALL and GetPY2Light() then bClose = false end
+      ExecMovePY1( bClose)
    elseif Cmd[1] == '12' then
-      SimulMoveAxes( 'PY2', EgtIf( Cmd[2] == '0', MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
-      SetPY2Light( Cmd[2] ~= '0')
+      ExecMovePY2( Cmd[2] ~= '0')
    elseif Cmd[1] == '21' then
       local nY1Delta = tonumber( Cmd[2])
       local nY2Delta = tonumber( Cmd[3])
@@ -1221,7 +1324,7 @@ function ExecStartHome()
    EgtResetAxisPos( 'C1')
    EgtResetAxisPos( 'B1')
    -- Testa 2
-   EgtResetAxisPos( 'X2')
+   EgtSetAxisPos( 'X2', SafeX2)
    EgtSetAxisPos( 'Z2', MinZ2)
    EgtResetAxisPos( 'C2')
    EgtResetAxisPos( 'B2')
@@ -1231,12 +1334,16 @@ end
 function ExecMoveHome( bNearV, bMchSplit)
    -- risalita a Zmax
    ExecMoveZmax( bMchSplit)
-   -- 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)
@@ -1273,13 +1380,14 @@ function ExecMoveZmax( bMchSplit)
    end
    -- se testa sopra
    if nSetHead == 1 then
+      local MyMaxZ1 = EgtGetAxisMax( 'Z1')
       -- se fresa o lama
       if EMT.HEAD ~= 'H13' then
          if abs( HomeC - CurrC) > 0.1 or abs( HomeB - CurrB) > 0.1 then
             local dZref = HomeZ + GetZExtra( EMT.HEAD, CurrB)
             SimulMoveAxes( 'Z1', EgtIf( dZref > CurrZ, dZref, CurrZ), MCH_SIM_STEP.RAPID, 'B1', EgtClamp( CurrB, -90, 90), MCH_SIM_STEP.COLLROT)
             if ( EMT.HEAD == 'H12' or EMT.HEAD == 'H16') and ( abs( HomeC - CurrC) > 30.1 or abs( HomeB - CurrB) > 30.1) then
-               SimulMoveAxes( 'Z1', MaxZ1, MCH_SIM_STEP.RAPID, 'B1', 0, MCH_SIM_STEP.COLLROT)
+               SimulMoveAxes( 'Z1', MyMaxZ1, MCH_SIM_STEP.RAPID, 'B1', 0, MCH_SIM_STEP.COLLROT)
             end
             if  ( not BD.RIGHT_LOAD and EMT.L2 > DeltaTabY) or ( BD.RIGHT_LOAD and EMT.L2 < DeltaTabY) then
                SimulMoveAxis( 'X1', DeltaTabY, MCH_SIM_STEP.RAPID)
@@ -1287,11 +1395,12 @@ 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
-         -- salzo in Z sicurezza raddrizzando la B
-         SimulMoveAxes( 'Z1', ParkCSawZ1, MCH_SIM_STEP.RAPID, 'B1', HomeB, MCH_SIM_STEP.COLLROT)
+         -- salgo in Z sicurezza raddrizzando la B
+         local SafeZ1 = EgtIf( EMT.TTOTLEN < MinLengthLongCSaw, ParkCSawZ1, ParkLongCSawZ1)
+         SimulMoveAxes( 'Z1', SafeZ1, MCH_SIM_STEP.RAPID, 'B1', HomeB, MCH_SIM_STEP.COLLROT)
          SimulMoveAxes( 'X1', HomeX, MCH_SIM_STEP.RAPID, 'C1', HomeC, MCH_SIM_STEP.COLLROT)
       end
       -- se lavorazione in doppio
@@ -1311,7 +1420,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)
@@ -1340,10 +1457,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
@@ -1368,6 +1489,18 @@ function ExecUnloading()
    end
 end
 
+---------------------------------------------------------------------
+function ExecMovePY1( bClose)
+   SimulMoveAxes( 'PY1', EgtIf( not bClose, MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
+   SetPY1Light( bClose)
+end
+
+---------------------------------------------------------------------
+function ExecMovePY2( bClose)
+   SimulMoveAxes( 'PY2', EgtIf( not bClose, MaxHoOpen, EMT.HB), MCH_SIM_STEP.RAPID)
+   SetPY2Light( bClose)
+end
+
 ---------------------------------------------------------------------
 local function LinkRemainingPartsToY1()
    local nCurrOrd = GetPhaseOrd( EMT.PHASE)
@@ -1397,6 +1530,9 @@ function ExecParkRoller( PosY1, PosY2, PosV1, PosV2, bSpliCut, bAgg)
    -- Parcheggi pinze
    local MyParkY1 = ParkY1 + EgtIf( bAgg, AggLoad, 0)
    local MyParkY2 = ParkY2
+   -- Apro i rulli, se necessario
+   if abs( ParkV1 - PosV1) > 0.1 then ExecOpenRoller( 1) end
+   if abs( ParkV2 - PosV2) > 0.1 then ExecOpenRoller( 2) end
    -- Eseguo spostamenti
    if EMT.Y1DELTA and EMT.Y2DELTA then
       local DiffY1 = MyParkY1 - PosY1
@@ -1450,7 +1586,7 @@ function ExecParkRoller( PosY1, PosY2, PosV1, PosV2, bSpliCut, bAgg)
       local MoveV1 = ParkV1 - PosV1
       local DiffY1 = MyParkY1 - PosY1
       local MoveY1 = EgtIf( DiffY1 > 0.1, MoveV1, 0)
-      local TryMoveY1 = ParkV1 - PosT - EgtIf( bSpliCut or EMT.FALL, EMT.LP, 0)
+      local TryMoveY1 = ParkV1 - PosT - EgtIf( bSpliCut or EMT.FALL, EMT.LT, 0)
       if ( PosT > ParkV2 - ExtraParkV and PosT < ParkV1 and PosY1 + TryMoveY1 < MaxY1) then MoveY1 = max( MoveY1, TryMoveY1) end
       -- se appena eseguito taglio di separazione
       if bSpliCut then
@@ -1480,8 +1616,8 @@ function ExecParkRoller( PosY1, PosY2, PosV1, PosV2, bSpliCut, bAgg)
       local MoveV2 = ParkV2 - PosV2
       local DiffY2 = MyParkY2 - PosY2
       local MoveY2 = EgtIf( DiffY2 < -0.1, MoveV2, 0)
-      local TryMoveY2 = ParkV2 - PosT - EMT.LP
-      if ( PosT + EMT.LP < ParkV1 + ExtraParkV and PosT + EMT.LP > ParkV2 and PosY2 + TryMoveY2 > MinY2) then MoveY2 = min( MoveY2, TryMoveY2) end
+      local TryMoveY2 = ParkV2 - PosT - EMT.LT
+      if ( PosT + EMT.LT < ParkV1 + ExtraParkV and PosT + EMT.LT > ParkV2 and PosY2 + TryMoveY2 > MinY2) then MoveY2 = min( MoveY2, TryMoveY2) end
       if not SimulMoveAxes( 'T',  PosT + MoveY2, MCH_SIM_STEP.RAPID,
                             'V1', ParkV1, MCH_SIM_STEP.RAPID,
                             'V2', ParkV2, MCH_SIM_STEP.RAPID,
@@ -1516,14 +1652,14 @@ 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]
       local nPart = EgtVolZmapPartCount( vMillId)
       if nPart > 1 then
          -- ricerca del pezzo con massimo volume
-         local dTCenX = -EgtGetAxisPos( 'T') - EMT.LP / 2
+         local dTCenX = -EgtGetAxisPos( 'T') - EMT.LT / 2
          local nPartMax = 0
          local dVolMax = 0
          for i = 1, nPart do
@@ -1547,7 +1683,6 @@ function RemoveScraps()
       end
       EMT.VMRS = false
    end
-
 end
 
 ---------------------------------------------------------------------
@@ -1716,14 +1851,14 @@ end
 ---------------------------------------------------------------------
 function GetV1ToClose()
    --EgtOutLog( string.format( 'L1m=%.3f L1M=%.3f V2NP=%.3f LB=%.3f', EMT.MAXMIN[1], EMT.MAXMAX[1], EMT.V2NEXTPOS, EMT.LB))
-   --EgtOutLog( string.format( 'LB=%.3f LT=%.3f', EMT.LB, EMT.LP or 0))
+   --EgtOutLog( string.format( 'LB=%.3f LT=%.3f', EMT.LB, EMT.LT or 0))
    return ( EMT.MAXMAX[1] <= EMT.V1NEXTPOS + RollCageMin and EMT.MAXMIN[1] + EMT.LB >= EMT.V1NEXTPOS + RollCageMax)
 end
 
 ---------------------------------------------------------------------
 function GetV2ToClose()
    --EgtOutLog( string.format( 'L1m=%.3f L1M=%.3f V2NP=%.3f LB=%.3f', EMT.MAXMIN[1], EMT.MAXMAX[1], EMT.V2NEXTPOS, EMT.LB))
-   --EgtOutLog( string.format( 'LB=%.3f LT=%.3f', EMT.LB, EMT.LP or 0))
+   --EgtOutLog( string.format( 'LB=%.3f LT=%.3f', EMT.LB, EMT.LT or 0))
    return ( EMT.MAXMAX[1] <= EMT.V2NEXTPOS - RollCageMax and EMT.MAXMIN[1] + EMT.LB >= EMT.V2NEXTPOS - RollCageMin)
 end
 
@@ -1741,7 +1876,7 @@ function LoadFirstTool( nHSet, sTcPosDef)
    if nHSet ~= 1 and nHSet ~= 2 then return end
    EgtUnloadTool( EgtIf( nHSet == 1, 'H11', 'H21'), 1)
    if GetHeadSetFromTcPos( sTcPosDef) ~= nHSet then return end
-   local sTool, sHead, sTcPos = FindFirstToolOnHeadSet( nHSet)
+   local sTool, sHead, sTcPos, sTTotLen, sBlockedAxis = FindFirstToolOnHeadSet( nHSet)
    if not sTool then
       local vTools = EgtGetToolsInCurrSetupPos( sTcPosDef)
       if vTools and vTools[1] then
@@ -1753,12 +1888,32 @@ function LoadFirstTool( nHSet, sTcPosDef)
    if sTool then
       -- imposto correttamente i dati di testa
       local OrigEMC = EMC
-      EMC = { HEAD = sHead, TOOL = sTool, TCPOS = sTcPos, TOTLEN = 0}
+      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)
+      -- salvo utensili caricati
+      if nHSet == 1 then
+         EMT.PREVTOOL_H1 = sTool
+         EMT.PREVHEAD_H1 = sHead
+         EMT.PREVTCPOS_H1 = sTcPos
+         EMT.PREVTTOTLEN_H1 = sTTotLen
+      -- per gruppo testa 2
+      elseif nHSet == 2 then
+         EMT.PREVTOOL_H2 = sTool
+         EMT.PREVHEAD_H2 = sHead
+         EMT.PREVTCPOS_H2 = sTcPos
+         EMT.PREVTTOTLEN_H2 = sTTotLen
+      end
    end
    return sTool
 end
@@ -2172,7 +2327,7 @@ function FindFirstToolOnHeadSet( nHSet)
    local CurrMachId = EgtGetCurrMachining()
    local CurrTool = EgtTdbGetCurrToolParam( MCH_TP.NAME)
    -- cerco lavorazione con utensile su gruppo testa indicato
-   local sTool, sHead, sTcPos
+   local sTool, sHead, sTcPos, sTTotLen, sBlockedAxis
    local OpId = EgtGetFirstActiveOperation()
    while OpId do
       local nType = EgtGetOperationType( OpId)
@@ -2182,8 +2337,15 @@ function FindFirstToolOnHeadSet( nHSet)
             if EgtTdbSetCurrTool( sTest) then
                sHead = EgtTdbGetCurrToolParam( MCH_TP.HEAD)
                if GetHeadSet( sHead) == nHSet then
-                  sTool = sTest
                   sTcPos = EgtTdbGetCurrToolParam( MCH_TP.TCPOS)
+                  -- aggregato lama non si può mai preselezionare e viene sempre scaricato, quindi non sarà mai già caricato
+                  if nHSet == 2 and sTcPos == 'T201' then
+                     sTcPos = nil
+                     break
+                  end
+                  sTool = sTest
+                  sTTotLen = EgtTdbGetCurrToolParam( MCH_TP.TOTLEN)
+                  sBlockedAxis = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
                   break
                end
             end
@@ -2195,7 +2357,7 @@ function FindFirstToolOnHeadSet( nHSet)
    EgtSetCurrMachining( CurrMachId or GDB_ID.NULL)
    EgtTdbSetCurrTool( CurrTool or '')
    -- restituisco risultato
-   return sTool, sHead, sTcPos
+   return sTool, sHead, sTcPos, sTTotLen, sBlockedAxis
 end
 
 ---------------------------------------------------------------------
@@ -2213,14 +2375,6 @@ function GetToolTcPos( sTool)
    return sTcPos
 end
 
----------------------------------------------------------------------
-function GetCurrChainSawingVirtualAxis()
-   -- recupero il valore dell'asse virtuale bloccato A
-   local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS) or 'A1=0'
-   local dPosA = tonumber( sVal:sub( 4)) or 0
-   return dPosA
-end
-
 ---------------------------------------------------------------------
 function GetNextChainSawingVirtualAxis( MchId)
    -- recupero la lavorazione successiva

Common-PF1250.mlse

@@ -1,12 +1,11 @@
--- Special Operations macchina Essetre-PF1250 by EgalTech s.r.l.  2023/11/21
+-- Special Operations macchina Essetre-PF1250 by Egalware s.r.l.  2024/04/09
 -- Intestazioni
 
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
--- Carico i dati globali
-local sBaseDir = EgtGetSourceDir()
-BD = dofile( sBaseDir .. 'Beam\\BeamData.lua')
+-- Carico libreria
+local BD = require( 'BeamData')
 
 ---------------------------------------------------------------------
 -- *** Special Z moves ***
@@ -72,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)
@@ -90,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)
@@ -254,33 +253,9 @@ local function GetNextStartOrRestPhase( nPhase)
 end
 
 ---------------------------------------------------------------------
-function GetPhaseRot( nPhase)
-   return ( EgtGetInfo( EgtGetPhaseDisposition( nPhase) or GDB_ID.NULL, 'ROT', 'i') or 0)
-end
-
----------------------------------------------------------------------
-local function IsLastMachiningBeforeRotation( nMchId)
-   -- se ultima fase, ritorno risultato negativo
-   if EMC.PHASE == EgtGetPhaseCount() then
-      return false
-   end
-   -- recupero la successiva operazione attiva
-   local nNextOperId = EgtGetNextActiveOperation( nMchId)
-   -- se non esiste o non è una disposizione, ritorno risultato negativo
-   if not nNextOperId or EgtGetOperationType( nNextOperId) ~= MCH_OY.DISP then
-      return false
-   end
-   -- recupero le rotazioni della fase corrente e della prossima fase
-   local nRot = GetPhaseRot( EMC.PHASE)
-   local nNextRot = GetPhaseRot( EMC.PHASE + 1)
-   -- ritorno se sono diverse
-   return ( nRot ~= nNextRot)
-end
-
----------------------------------------------------------------------
-local function IsFirstMachiningAfterRotation( nMchId)
-   -- se prima fase, ritorno risultato negativo
-   if EMC.PHASE == 1 then
+local function IsFirstMachiningOfStart( nMchId)
+   -- se non è fase inizio di pezzo, ritorno risultato negativo
+   if not IsStartOrRestPhase( EMC.PHASE) then
       return false
    end
    -- recupero la precedente operazione attiva
@@ -289,11 +264,8 @@ local function IsFirstMachiningAfterRotation( nMchId)
    if not nPrevOperId or EgtGetOperationType( nPrevOperId) ~= MCH_OY.DISP then
       return false
    end
-   -- recupero le rotazioni della fase corrente e della fase precedente
-   local nRot = GetPhaseRot( EMC.PHASE)
-   local nPrevRot = GetPhaseRot( EMC.PHASE - 1)
-   -- ritorno se sono diverse
-   return ( nRot ~= nPrevRot)
+   -- è la prima
+   return true
 end
 
 ---------------------------------------------------------------------
@@ -545,7 +517,7 @@ function OnPostApplyMachining()
       return
    -- se precedente operazione è disposizione
    elseif  EgtGetOperationType( nPrevOpeId) == MCH_OY.DISP then
-      if EMC.PHASE == 1 or ( IsMidPhase( EMC.PHASE) and IsFirstMachiningAfterRotation( EMC.MCHID)) then
+      if EMC.PHASE == 1 then
          -- posizioni home
          EMC.TPOS = nil
          EMC.Y1DELTA = nil
@@ -712,6 +684,7 @@ function SpecApplyPath( bPreSplit, bSplitting, bPreCut, bCutting, bUnload)
    EMC.SB = b3Tot:getDimY()
    EMC.HB = b3Tot:getDimZ()
    EMC.LT = b3Raw:getDimX()
+   EgtOutLog( '  BarLen='..EgtNumToString( EMC.LB, 1), 3)
 
    -- Aggiorno limiti di presa
    UpdateMinJoin()
@@ -766,7 +739,6 @@ function SpecApplyPath( bPreSplit, bSplitting, bPreCut, bCutting, bUnload)
    -- Se inizio o appena dopo rotazione, eseguo il carico
    if not EMC.TPOS then
       local dPosT = LoadT
-      if IsFirstMachiningAfterRotation( EMC.MCHID) then dPosT = dPosT + TurnerOffs end
       local vCmd = SpecCalcLoad( dPosT, dDistFront, max( dDistBack, MinJoin, EMC.LB - ( MaxY1 - MinY1) + 6))
       EMC.LOAD = true
       local vCmd2 = SpecCalcCarriages( dDistFront, dDistBack, dRollFront, dRollBack, dY1DeltaMaxSP, dY2DeltaMinUL, nChar)
@@ -916,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
@@ -1105,8 +1081,8 @@ function SpecCalcCarriages( dDistFront, dDistBack, dRollFront, dRollBack, dY1Del
          return {}
       end
 
-      -- al carico si deve ignorare l'ingombro delle lavorazioni di testa per il pinzaggio
-      if EMC.LOAD then EMC.HCING = 0 end
+      -- al carico o con prima lavorazione di un pezzo si deve ignorare l'ingombro delle lavorazioni di testa per il pinzaggio
+      if EMC.LOAD or IsFirstMachiningOfStart( EMC.MCHID) then EMC.HCING = 0 end
 
       return SpecAdjustCarriages( WorkTab)
 
@@ -1308,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
 
 --------------------------------------------------------------------------------------------------------
@@ -1331,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
@@ -1342,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]**
@@ -1863,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
@@ -1927,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
@@ -2002,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
@@ -2170,8 +2163,8 @@ function SpecAdjustCarrB1( WorkTab)
    if not SpecTestSomeMoveInCmds( vCmd) then
       table.insert( vCmd, { 3, 'Y1', dY1PosI, 'Y2', dY2PosI, 'T', WorkTab.dTPosI, EMC.CNT})
    end
-   table.insert( vCmd, { 11, 1})   -- chiudo Y1
    table.insert( vCmd, { 12, 1})   -- Chiudo Y2
+   table.insert( vCmd, { 11, 1})   -- chiudo Y1
    -- imposto i nuovi parametri di aggancio
    table.insert( vCmd, { 21, dY1DeltaF, dY2DeltaF})
    EgtOutLog( '  Y1DeltaF=' .. EgtNumToString( dY1DeltaF) .. ' Y2DeltaF=' .. EgtNumToString( dY2DeltaF), 1)
@@ -2242,8 +2235,8 @@ function SpecAdjustCarrB2( WorkTab)
    if not SpecTestSomeMoveInCmds( vCmd) then
       table.insert( vCmd, { 3, 'Y1', dY1PosI, 'Y2', dY2PosI, 'T', WorkTab.dTPosI, EMC.CNT})
    end
-   table.insert( vCmd, { 11, 1})   -- chiudo Y1
    table.insert( vCmd, { 12, 1})   -- Chiudo Y2
+   table.insert( vCmd, { 11, 1})   -- chiudo Y1
    -- imposto i nuovi parametri di aggancio
    table.insert( vCmd, { 21, dY1DeltaF, dY2DeltaF})
    EgtOutLog( '  Y1DeltaF=' .. EgtNumToString( dY1DeltaF) .. '  Y2DeltaF=' .. EgtNumToString( dY2DeltaF), 1)
@@ -2303,7 +2296,7 @@ function SpecAdjustCarrC( WorkTab)
          WorkTab.dY1DeltaMaxF = EMC.LB - ( MinJoin + MyTCING)
          -- se Y1 deve accentrarsi 
          if WorkTab.dY1DeltaI > WorkTab.dY1DeltaMaxF then
-            WorkTab.dY1DeltaMinF = EMC.LB - 2 * MinJoin + MyTCING
+            WorkTab.dY1DeltaMinF = EMC.LB - 2 * MinJoin - MyTCING
          end
       end
       -- posizioni obiettivo dei carrelli al centro dei rispettivi intervalli di validità

Compile.bat

@@ -0,0 +1,36 @@
+
+REM Compilazione degli script macchina Egaltech                         2024.02.22
+REM Per togliere info di debug aggiungere flag -s prima del nome del file di input
+
+REM Compilazione 32 bit e copia file da non compilare
+
+@echo off
+
+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=Essetre-PF1250MAX"
+set "deployFolder=C:\MachinesDeploy"
+set "machinePath=%deployFolder%\%machineName%\"
+set "fullPathSource=%deployFolder%\%machineName%\%machineVersion%\%machineName%"
+set "fullPathZip=%deployFolder%\%machineName%\%machineVersion%"
+
+REM elimino eventuale cartella esistente
+rmdir /s /Q %fullPathZip%
+
+REM copio i sorgenti nel percorso di destinazione
+ROBOCOPY . %fullPathSource%\ /E /XF "Compile.bat" /XF ".gitignore" /XD ".git" /XF "UpdateLog.txt"
+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" /XD ".vscode"
+
+REM copio i file compilati nel percorso temporaneo per i compilati
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Common-PF1250.mlpe    		 	           -s Common-PF1250.mlpe
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Common-PF1250.mlse                       -s Common-PF1250.mlse
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Common-PF1250.TPA.mlpe                   -s Common-PF1250.TPA.mlpe
+
+REM comprimo i file compilati in uno zip pronto per essere distribuito
+tar.exe acvf %fullPathZip%\%machineName%.zip -C %fullPathSource%\bin\ %machineName%\*.*
+
+REM elimino il percorso temporaneo
+rmdir /s /Q %fullPathSource%\bin\

Essetre-PF1250MAX.mlde

@@ -1,4 +1,4 @@
--- Descrizione macchina Essetre-PF1250MAX by EgalWare s.r.l.   2023/12/07
+-- Descrizione macchina Essetre-PF1250MAX by EgalWare s.r.l.   2024/03/28
 -- 2023/12/07 ver 2.5l1 Prima versione. Derivata da PF1250 ver 2.5l4
 -- 2023/12/15 ver 2.5l2 Corretti vari offset in simulazione
 -- 2023/12/18 ver 2.5l3 Ultimata gestione aggregato lama da sotto
@@ -12,22 +12,64 @@
 --                      Costanti MinForzaPinze e MaxForzaPinze portati in mlde/Ts3data (erano hardcoded - Common)
 --                      Aggiunto variabile 'WriteAllCoordsOnFirstM101' e allineamento con 2.6a1 common
 -- 2023/12/20 ver 2.6a2 Allineamento con Common-PF1250 v.2.6a2
+-- 2024/01/22 ver 2.6a3 Migliorata preselezione utensile
+--                      Rimosse funzioni ribaltamento pezzo
+--                      Allineamento con Common-PF1250 v.2.6a3
+--                      In BeamData aggiunta la funzione GetBlockedAxis che sostituisce le altre (GetChainSawBlockedAxis e GetSawBlockedAxis)
+-- 2024/01/25 ver 2.6a4 Allineamento con Common 2.6a4
+-- 2024/02/09 ver 2.6b1 Corretto errore in definizione testa H22
+--                      In BeamData migliorata funzione GetBlockedAxis
+-- 2024/02/12 ver 2.6b2 Allineamento con common 2.6b2
+-- 2024/02/20 ver 2.6b3 Allineamento con common 2.6b3
+-- 2024/02/26 ver 2.6b4 Allineamento con common ver. 2.6b4; in mlde aggiunte chiamate EgtAddToPackagePath
+-- 2024/02/29 ver 2.6c1 Allineamento con common ver. 2.6c1
+-- 2024/03/04 ver 2.6c2 Modificato log con nome macchina
+--                      Allineamento con common ver. 2.6c2
+-- 2024/03/05 ver 2.6c3 Corretto portautensile Standard_LC_108.
+-- 2024/03/12 ver 2.6c4 Allineamento con common ver. 2.6c3
+-- 2024/03/14 ver 2.6c5 Allineamento con common ver. 2.6c4
+--                      Aggiunto nuovo tipo di lavorazione: Predrill
+-- 2024/03/14 ver 2.6c6 Predrill: aggiunta lavorazione tipo 'Predrill_H2' per testa sotto
+-- 2024/03/26 ver 2.6c7 Aggiunto variabile 'ParkLongB1' posizione parcheggio per punte lunghe
+--                      Modificate collisioni traversa. Ora non comprende carro X1 che ha il proprio
+--                      Allineamento con common ver. 2.6c5
+-- 2024/03/26 ver 2.6c8 Aggiunta lettura nuovi parametri offset per lama su aggregato testa sotto
+-- 2024/03/28 ver 2.6c9 Correzioni per pezzi lunghi fino a 30 metri.
+-- 2024/04/12 ver 2.6d1 Allineamento con common ver. 2.6d1
+--                      Aggiunto parametro ForceToCloseRollersGate
+-- 2024/04/23 ver 2.6d2 Allineamento con common ver. 2.6d2
+--                      Aggiunta variabile MaxZ1Blade e relativa gestione
+--                      Aggiunto solido collisione in NGE
+-- 2024/04/24 ver 2.6d3 Aggiunta simulazione macchina tipo "corsa corta" e "corsa lunga"
+-- 2024/04/24 ver 2.6d4 In simulazione aggiunti solidi griglie vicino TC margherita con relativo controllo collisione
+-- 2024/04/30 ver 2.6e1 Allineamento con common ver. 2.6e1
+--                      Aggiunta variabile WoodDensity per gestione WOOD_DENSITY
+-- 2024/05/06 ver 2.6e2 Allineamento con common ver. 2.6e2
+-- 2024/05/15 ver 2.6e4 Allineamento con common ver. 2.6e4
+--                      Corretta posizione griglia sotto CU margherita nel modello 3D
+
 
 -- Intestazioni
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '2.6a2'
+PP_VER = '2.6e4'
 MIN_MACH_VER = '2.5k1'
+MACH_NAME = 'Essetre-PF1250MAX'
 
-local sBaseDir = EgtGetSourceDir()
-INFO_STD_PP = dofile( sBaseDir .. 'Version.lua')
+-- Carico i dati globali
+local sMachDir = EgtGetCurrMachineDir()
+-- Elimino direttori altre macchine e imposto direttorio macchina corrente per ricerca librerie
+EgtRemoveBaseMachineDirFromPackagePath()
+EgtAddToPackagePath( sMachDir .. '\\Beam\\?.lua')
+EgtAddToPackagePath( sMachDir .. '\\?.lua')
+INFO_STD_PP = require( 'Version')
 -- prendo la versione kernel minima necessaria piu' nuova tra macchina e script comuni
 if INFO_STD_PP.MIN_MACH_VER_PP_COMMON > MIN_MACH_VER then
    MIN_MACH_VER = INFO_STD_PP.MIN_MACH_VER_PP_COMMON
 end
 
-EgtOutLog ( '** Essetre-PF1250MAX '..PP_VER..' (MinMach '.. MIN_MACH_VER ..') **', 1)
+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
@@ -81,7 +123,8 @@ SawB2Offs = 0
 MinX1 = 0
 MaxX1 = 3300
 MinZ1 = -1850
-MaxZ1 = -100
+MaxZ1 = -50
+MaxZ1Blade = -100
 MinC1 = -275
 MaxC1 = 275
 MinB1 = -127
@@ -99,9 +142,14 @@ ParkCSaw0Z1 = -400
 ParkCSawC1 = -90
 ParkCSaw0C1 = 0
 ParkCSawB1 = 0
-LongTool = 400
+MinLengthLongCSaw = 580      -- gestione speciale per motosega molto lunga. Lunghezza al di sopra della quale è considerata motosega lunga
+ParkLongCSawZ1 = -50         -- gestione speciale per motosega molto lunga. Parcheggio asse Z
+ParkLongCSawC1 = 0           -- gestione speciale per motosega molto lunga. Parcheggio asse C
+ParkLongCSawB1 = -90         -- gestione speciale per motosega molto lunga. Parcheggio asse B
+LongTool = 390
 ParkLongTc1C1 = 0
 ParkLongTc2C1 = -180
+ParkLongB1 = 0
 MinZ1ToChangeH2 = -1400
 MinX2 = -2760
 MaxX2 = 0
@@ -114,7 +162,7 @@ MaxB2 = 127
 MinB2b = -119
 MaxB2b = 119
 ParkX2 = -100
-SafeX2 = -400
+SafeX2 = -200
 ParkZ2 = 0
 ParkC2 = -90
 ParkB2 = -90
@@ -131,7 +179,7 @@ DeltaTabY = 2550
 DeltaTabZ = -1428 + MillOffs                   -- per TPA : -1128.0 + MillOffs    -- per NUM : -1258
 DeltaRulliTraveZ = -1203
 DimTabY = 1400
-DimTabX = 24000
+DimTabX = 34000
 Delta2TabY = -1185.9
 Delta2TabZ = 693 - Mill2Offs                   -- per TPA : 378.0 - Mill2Offs      -- per NUM : 223
 Head2X = 0
@@ -149,11 +197,12 @@ TcSpecialTools = true                            -- magarzzino per utensili spec
 TcAggreBladeUnder = true                         -- lama su aggregato per testa da sotto
 EmitAccClamps = true
 WriteAllCoordsOnFirstM101 = true
+ForceToCloseRollersGate = false
 
 -- Aggiornamento con dati da TechnoEssetre7
 local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-PF1250MAX.data"
-local sDataBeam = EgtGetSourceDir().."\\Beam\\Ts3Data.lua"
-local sDataWall = EgtGetSourceDir().."\\Wall\\Ts3Data.lua"
+local sDataBeam = sMachDir.."\\Beam\\Ts3Data.lua"
+local sDataWall = sMachDir.."\\Wall\\Ts3Data.lua"
 if EgtExistsFile( sTs3Data) then
    EgtCopyFile( sTs3Data, sDataBeam)
    EgtCopyFile( sTs3Data, sDataWall)
@@ -171,6 +220,7 @@ if EgtExistsFile( sDataBeam) then
          if Machine.Offsets.PARK_X1 then ParkX1 = Machine.Offsets.PARK_X1 end
          if Machine.Offsets.Z1_NEG then MinZ1 = Machine.Offsets.Z1_NEG end
          if Machine.Offsets.Z1_POS then MaxZ1 = min( MaxZ1, Machine.Offsets.Z1_POS) end
+         if Machine.Offsets.Z1_POS_LAMA then MaxZ1Blade = min( MaxZ1Blade, Machine.Offsets.Z1_POS_LAMA) end
          if Machine.Offsets.PARK_Z1 then ParkZ1 = Machine.Offsets.PARK_Z1 end
          if Machine.Offsets.C1_NEG then MinC1 = Machine.Offsets.C1_NEG end
          if Machine.Offsets.C1_POS then MaxC1 = Machine.Offsets.C1_POS end
@@ -209,6 +259,8 @@ if EgtExistsFile( sDataBeam) then
          if Machine.Offsets.OFFSETBLAMAT1 then SawB1Offs= Machine.Offsets.OFFSETBLAMAT1 end
          if Machine.Offsets.OFFSETCLAMAT2 then Saw2C1Offs= Machine.Offsets.OFFSETCLAMAT2 end
          if Machine.Offsets.OFFSETBLAMAT2 then Saw2B1Offs= Machine.Offsets.OFFSETBLAMAT2 end
+         if Machine.Offsets.OFFSETCLAMAUNDER then SawUnderC2Offs= Machine.Offsets.OFFSETCLAMAUNDER end
+         if Machine.Offsets.OFFSETBLAMAUNDER then SawUnderB2Offs= Machine.Offsets.OFFSETBLAMAUNDER end
          if Machine.Offsets.OFFSETXT1 then DeltaTabY = -Machine.Offsets.OFFSETXT1 end
          if Machine.Offsets.OFFSETZT1 then DeltaTabZ = Machine.Offsets.OFFSETZT1 + MillOffs end
          if Machine.Offsets.OFFSETXT2 then Delta2TabY = Machine.Offsets.OFFSETXT2 end
@@ -219,10 +271,15 @@ if EgtExistsFile( sDataBeam) then
          if Machine.Offsets.SAWOFFSZ then SawOffsZ = Machine.Offsets.SAWOFFSZ end
          if Machine.Offsets.SAW2OFFSX then Saw2OffsX = Machine.Offsets.SAW2OFFSX end
          if Machine.Offsets.SAW2OFFSZ then Saw2OffsZ = Machine.Offsets.SAW2OFFSZ end
+         if Machine.Offsets.SAWUNDEROFFSY then SawUnderOffsY = Machine.Offsets.SAWUNDEROFFSY end
+         if Machine.Offsets.SAWUNDEROFFSZ then SawUnderOffsZ = Machine.Offsets.SAWUNDEROFFSZ end
          if Machine.Offsets.DEFTCPOS1 then DefTcPos1 = ( 'T' .. Machine.Offsets.DEFTCPOS1) end
          if Machine.Offsets.DEFTCPOS2 then DefTcPos2 = ( 'T' .. Machine.Offsets.DEFTCPOS2) end
          if Machine.Offsets.MINPRESS then MinForzaPinze = Machine.Offsets.MINPRESS end
          if Machine.Offsets.MAXPRESS then MaxForzaPinze = Machine.Offsets.MAXPRESS end
+         if Machine.Offsets.CHIUDI_PINZE_2_3_SCAMBIO then ForceToCloseRollersGate = Machine.Offsets.CHIUDI_PINZE_2_3_SCAMBIO == 1 end
+         if Machine.Offsets.WOOD_DENSITY then WoodDensity = Machine.Offsets.WOOD_DENSITY end
+
          -- aggiustamenti
          MinY1 = MinV1 + MinDeltaYV
          MaxY1 = MaxMchY1
@@ -233,6 +290,7 @@ if EgtExistsFile( sDataBeam) then
          ParkV2 = MinV2
          ParkY2 = ParkV2 - MinDeltaYV
          UnloadSmT = UnloadT - 300
+         MaxZ1Blade = min( MaxZ1Blade, MaxZ1)
          Head2Y = DeltaTabY - Delta2TabY
          Head2Z = DeltaTabZ - Delta2TabZ
          ParkCSawZ1 = min( ParkCSawZ1, MaxZ1)
@@ -251,7 +309,9 @@ EmtGeneral {
       AngDeltaMinForHome = 80,
       Special = 'Common-PF1250.mlse',
       Processor = 'Common-PF1250.mlpe'}
-local sBaseAux = {'BASE/SOLID', 'BASE/CONVOYER', 'BASE/COLLISION', 'BASE/TC1', 'BASE/TCR', 'BASE/TC3'}
+-- in base alla corsa macchina, si carica la rulliera di carico/scarico appropriata
+local sGeomConvoyer = EgtIf( MaxY1 > 6500, '_8M', '_5M')
+local sBaseAux = {'BASE/SOLID', 'BASE/CONVOYER'..sGeomConvoyer, 'BASE/COLLISION', 'BASE/TC1', 'BASE/TCR', 'BASE/TC3'}
 if Tc2Active then table.insert( sBaseAux, 5, 'BASE/TC2') end
 if TcSpecialTools then table.insert( sBaseAux, 'BASE/TC4') end
 if SecondChain then table.insert( sBaseAux, 'BASE/TC5') end
@@ -271,7 +331,7 @@ local X1Id = EmtAxis {
       Home = ParkX1,
       Invert = true,
       Geo = 'X1_AXIS/GEO',
-      Aux = 'X1_AXIS/SOLID'}
+      Aux = {'X1_AXIS/SOLID', 'X1_AXIS/COLLISION'}}
 --  *** Testa 1 ***
 EmtAxis {
       Name = 'Z1',
@@ -474,8 +534,8 @@ if TcAggreBladeUnder then
          Rot2Stroke = { MinB2b, MaxB2b},
          OthColl = {'B2/SOLID', 'C2/SOLID'},
          Geo = 'H22_HEAD/GEO'}
-   EgtSetInfo( H21Id, 'ABOVE', '0')
-   EgtSetInfo( H21Id, 'ZHOMEDOWN', '1')
+   EgtSetInfo( H22Id, 'ABOVE', '0')
+   EgtSetInfo( H22Id, 'ZHOMEDOWN', '1')
 end
 --  *** Carrelli ***
 -- Morse
@@ -588,7 +648,7 @@ EmtAxis {
       Type = MCH_AT.LINEAR,
       Dir = - X_AX(),
       Pos = Point3d(0.0,2450.0,-958.0),
-      Stroke = {-20000, 20000},
+      Stroke = {-40000, 5000},
       Home = LoadT,
       Geo = 'T_AXIS/GEO'}
 EmtTable {
@@ -891,8 +951,9 @@ if SecondChain then EgtMove( EgtGetFirstNameInGroup( BaseId, 'TC5') or GDB_ID.NU
 EgtMove( EgtGetFirstNameInGroup( BaseId, 'TCR') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB)
 if TcSpecialTools then EgtMove( EgtGetFirstNameInGroup( BaseId, 'TCS') or GDB_ID.NULL, vtMovB, GDB_RT.GLOB) end
 EgtMove( EgtGetFirstNameInGroup( X1Id, 'SOLID'), vtMovB, GDB_RT.GLOB)
+EgtMove( EgtGetFirstNameInGroup( X1Id, 'COLLISION'), vtMovB, GDB_RT.GLOB)
 local vtMove = Vector3d( 0, ( DeltaTabY - 2550.0), ( DeltaTabZ + 1258.0))
-EgtMove( EgtGetFirstNameInGroup( BaseId, 'CONVOYER'), vtMove, GDB_RT.GLOB)
+EgtMove( EgtGetFirstNameInGroup( BaseId, 'CONVOYER'..sGeomConvoyer), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( Y1Id, 'SOLID'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( PY1Id, 'SOLID'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( Y2Id, 'SOLID'), vtMove, GDB_RT.GLOB)
@@ -905,6 +966,8 @@ EgtMove( EgtGetFirstNameInGroup( V2Id, 'SOLID'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( V2Id, 'COLLISION'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( PV2Id, 'SOLID'), vtMove, GDB_RT.GLOB)
 EgtMove( EgtGetFirstNameInGroup( QV2Id, 'SOLID'), vtMove, GDB_RT.GLOB)
+local vtMoveColl = Vector3d( 0, 0, MaxZ1Blade)
+EgtMove( EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( BaseId, 'COLLISION'), 'CEIL'), vtMoveColl, GDB_RT.GLOB)
 
 -- Assegno identificativi alle spie delle morse
 PY1LightId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( Y1Id, 'SOLID') or GDB_ID.NULL, 'Light')
@@ -925,6 +988,7 @@ function OnSetHead()
       else
          EmtModifyAxisHome( 'X1', ParkTc2X1)
       end
+      EmtModifyAxisStroke( 'Z1', {MinZ1, MaxZ1})
       if EMC.TOTLEN < LongTool then
          EmtModifyAxisHome( 'Z1', ParkZ1)
          EmtModifyAxisStroke( 'C1', {MinC1, MaxC1})
@@ -939,13 +1003,14 @@ function OnSetHead()
             EmtModifyAxisStroke( 'C1', { ParkLongTc2C1 - 20, ParkLongTc2C1 + 20})
             EmtModifyAxisHome( 'C1', ParkLongTc2C1)
          end
-         EmtModifyAxisHome( 'B1', ParkB1)
+         EmtModifyAxisHome( 'B1', ParkLongB1)
       end
       EmtModifyAxisDirection( 'B1', X_AX())
    -- se testa H12 (lama)
    elseif EMC.HEAD == 'H12' then
       EmtModifyAxisHome( 'X1', ParkX1)
       EmtModifyAxisHome( 'Z1', ParkZ1)
+      EmtModifyAxisStroke( 'Z1', {MinZ1, MaxZ1Blade})
       EmtModifyAxisStroke( 'C1', {MinC1, MaxC1})
       EmtModifyAxisHome( 'C1', ParkC1)
       EmtModifyAxisHome( 'B1', ParkB1)
@@ -955,11 +1020,11 @@ function OnSetHead()
       -- aggiustamenti per distanza
       local dDist = EgtIf( EMC.DIST and abs( EMC.DIST) > 1, EMC.DIST, ChSawLen)
       EmtModifyExitPosition( EMC.HEAD, EMC.EXIT or 1, Point3d( 0, 0, -dDist))
-      -- recupero valore asse A1 bloccato
-      local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
-      local CSawPosA = tonumber( sVal:sub( 4) or '')
+      -- recupero il valore dell'asse virtuale bloccato A
+      local CSawPosA = GetCurrChainSawingVirtualAxis()
       EmtModifyAxisHome( 'X1', ParkCSawX1)
       EmtModifyAxisHome( 'Z1', GetChainSawZHomeFromVirtualAxis( CSawPosA))
+      EmtModifyAxisStroke( 'Z1', {MinZ1, MaxZ1})
       EmtModifyAxisStroke( 'C1', {MinC1, MaxC1})
       EmtModifyAxisHome( 'C1', GetChainSawCHomeFromVirtualAxis( CSawPosA))
       EmtModifyAxisHome( 'B1', ParkCSawB1)
@@ -968,6 +1033,7 @@ function OnSetHead()
    elseif EMC.HEAD == 'H16' then
       EmtModifyAxisHome( 'X1', ParkTc2X1)
       EmtModifyAxisHome( 'Z1', ParkZ1)
+      EmtModifyAxisStroke( 'Z1', {MinZ1, MaxZ1Blade})
       EmtModifyAxisStroke( 'C1', {MinC1, MaxC1})
       EmtModifyAxisHome( 'C1', ParkC1)
       EmtModifyAxisHome( 'B1', ParkB1)
@@ -979,7 +1045,7 @@ function OnSetHead()
    -- se testa H22 (lama su aggregato sotto)
    elseif EMC.HEAD == 'H22' then
       -- recupero valore asse A2 bloccato
-      local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS)
+      local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS) or 'A2=0'
       local SawUnderPosA2 = tonumber( sVal:sub( 4) or '') or 0
       EmtModifyAxisHome( 'C2', GetSawCHomeFromVirtualAxis( SawUnderPosA2))
       EmtModifyAxisDirection( 'B2', Vector3d( cos( SawUnderC2Offs), -sin( SawUnderC2Offs), 0))
@@ -1180,6 +1246,13 @@ function GetPY2Light()
    return ( EgtGetInfo( PY2LightId, 'On') == '1')
 end
 
+---------------------------------------------------------------------
+function GetCurrChainSawingVirtualAxis()
+   -- recupero il valore dell'asse virtuale bloccato A
+   local sVal = EgtGetMachiningParam( MCH_MP.BLOCKEDAXIS) or 'A1=0'
+   local dPosA = tonumber( sVal:sub( 4)) or 0
+   return dPosA
+end
 
 ---------------------------------------------------------------------
 -- Funzione per resettare tutte le attivazioni della macchina

UpdateLog.txt

@@ -1,12 +1,98 @@
            ==== Common_PF1250 Update Log ====
 
+Versione 2.6e4 (15/05/2024)
+- (SIM-GEN) Miglioramento gestione lama su aggregato da sotto
+
+Versione 2.6e3 (09/05/2024)
+- (SIM) Corretto prelievo lama 2 (H16). Prima di visualizzare utensile, si sposta la Z alla quota massima. Prima trovava collisione in caso utensile precedente non lama (perchè era già oltre la quota massima).
+
+Versione 2.6e2 (06/05/2024)
+- (GEN) In parcheggio paratie/pinze, viene considerato sovramateriale di testa. Simulazione era corretta. Ticket#1789
+
+Versione 2.6e1 (30/04/2024)
+- (SIM-GEN) Per macchina a 3 teste, ripristinato posizionamento testa 2 tramite parametro ParkInLavZ2. La gestione era stata persa dal common.
+- (MLDE-GEN) Gestione facoltativa parametro WOOD_DENSITY settabile in Ts3. In MLDE, mettere il valore di WOOD_DENSITY nella nostra variabile 'WoodDensity'.
+
+Versione 2.6d2 (23/04/2024)
+- (MLDE-GEN) Aggiunto parametro 'IS_TEST_MACHINE' FACOLTATIVO. Se non esiste o 'false' è macchina standard, se 'true' è una macchina utilizzata per i test Egalware interni
+- (GEN) Chiamando la macchina con un nome che termini con '.TEST' si abilita come macchina per test interni, equivalente a settare 'IS_TEST_MACHINE' (che comunque rimane)
+- (SIM-GEN) Modificato movimenti testa sotto. Prima si muove in quota 'ParkMchY2' e poi va alla coordinata di lavoro ruotando gli assi
+- (SIM) Per lavorazioni in doppio, viene subito scritta la quota Z. La generazione era già corretta. Ticket#1377
+- (GEN) Ripristinato movimento iniziale testa sopra assieme alle pinze. Spostato comando wait dopo primo movimento testa. Ticket#1730
+- (MLDE-SIM-GEN) Aggiunto parametro MaxZ1Blade per differenziare Z massima aggregato lama e altri utensili.
+- (SIM) Aggiunto controllo con solido di collisione per verificare di non salire oltre il massimo
+- (SIM) Corretta simulazione scambio testa 3 -> testa 1
+
+Versione 2.6d1 (09/04/2024)
+- (GEN) Corretto impostazione piano G24 con testa da sotto con aggregato
+- (SIM-GEN) Corretta posizione prelievo/parcheggio se lama su aggregato da sotto
+- (MLDE-SIM-GEN) Aggiunta variabile FACOLTATIVA 'ForceToCloseRollersGate' ( che legge la variabile da TS3 'CHIUDI_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 NON OBBLIGATORIO
+- (SIM-GEN) "BeamData" caricato come libreria con 'require' anziché come file con 'dofile'
+
+Versione 2.6b2 (15/02/2024)
+- (SIM-GEN) Primo movimento in X per testa 2 a SafeX2 anziché a ParkX2
+
+Versione 2.6b1 (07/02/2024)
+- (MLDE-SIM-GEN) Inserito parametro 'MinLengthLongCSaw' per gestione motosega molto lunga
+- (MLDE) funzione 'GetCurrChainSawingVirtualAxis' spostata in MLDE
+
+Versione 2.6a5 (31/01/2024)
+- (SIM) Migliorata simulazione apertura/chiusura morse in caso di separazione
+- (SIM-GEN) Migliorata gestione movimenti con motosega e adeguato simulazione
+- (GEN) Corretta scrittura assi in caso di 'WriteAllCoordsOnFirstM101' per testa 2
+- (SIM-GEN) Caricamento BeamData come local
+
+Versione 2.6a4 (25/01/2024)
+- (SIM-GEN) Corretto movimento in caso di cambio assi rotanti tra due lavorazioni
+- (GEN) Corretta emissione coordinate assi in caso di 'WriteAllCoordsOnFirstM101'
+
+Versione 2.6a3 (22/01/2024)
+- (SIM-GEN) Correzione gestione apertura/chiusura rulli sul fine barra (#1630) e in generale
+- (GEN) Modificato flag 'EmitRapidInG0' in 'EmitRapidInG1' per decidere se scrivere G1 anziché G0. Se flag a nil, scrive i rapidi in G0
+- (SIM) Correzione movimenti pinze prima di separazione
+
+Versione 2.6a2 (19/01/2024)
+- (GEN) Corretta inversione coordinata X per Lama su aggregato da sotto
+- (SIM) Se modalità 'WriteAllCoordsOnFirstM101', oltre alla X si scive quota di parcheggio assi B2 e C2 come in generazione
+- (SIM-GEN) Tolta gestione rotazione pezzo (di derivazione PF), in macchina non è previsto ribaltamento
+- (GEN) Migliorata gestione preselezione utensile
+- (MLDE-GEN) Aggiunto flag 'EmitRapidInG0' per decidere se scrivere G0 anziché G1. Se flag a nil, scrive i rapidi in G1
+
 Versione 2.6a1 (09/01/2024)
 - Prima versione post-proc comune tra macchine PF1250 e PF1500
 - (SIM-GEN) Corretto movimento testa 2 in ToolDesel e movimento controllo collisione
 - (GEN) Tolta testa H14 per utensili speciali. Si utilizza H11 per frese standard
 - (MLDE-GEN) Costanti 'MinForzaPinze' e 'MaxForzaPinze' portati in mlde/Ts3data (erano hardcoded)
-- (MLDE-SIM-GEN) Aggiunto parametro 'WriteAllCoordsOnFirstM101' per decidere se stampare tutti gli assi sulla prima M101
-
-Versione 2.6a2 (09/01/2024)
-- (GEN) Corretta inversione coordinata X per Lama su aggregato da sotto
-- (SIM) Se modalità 'WriteAllCoordsOnFirstM101', oltre alla X si scive quota di parcheggio assi B2 e C2 come in generazione
+- (MLDE-SIM-GEN) Aggiunto parametro 'WriteAllCoordsOnFirstM101' per decidere se stampare tutti gli assi sulla prima M101

Version.lua

@@ -1,9 +1,9 @@
--- Version.lua by EgalWare s.r.l. 2023/11/28
+-- Version.lua by EgalWare s.r.l. 2024/01/22
 -- Gestione della versione dei file comuni post-processori macchine PF1250 e PF1500 di Essetre
 
 local InfoCommon_STD_PP = {
    NAME = 'Common_PF1250',            -- nome script PP standard
-   VERSION = '2.6a2',                 -- versione script
+   VERSION = '2.6e4',                 -- versione script
    MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
 }
 

Wall/WallData.lua

@@ -37,7 +37,7 @@ local WallData = {
 
 -- Aggiornamento con dati da TechnoEssetre7
 local sTs3Data = EgtGetStringFromIni( 'Wall', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-PF1250.data"
-local sData = EgtGetSourceDir().."\\Ts3Data.lua"
+local sData = EgtGetCurrMachineDir().."\\Wall\\Ts3Data.lua"
 if EgtExistsFile( sTs3Data) then
    EgtCopyFile( sTs3Data, sData)
    local sTs3DataOld = sTs3Data..'.old'