- Allineamento con common ver. 2.6e2

- Aggiunta variabile WoodDensity per gestione WOOD_DENSITY

.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

@@ -7,7 +7,7 @@ EgtOutLog( ' FAST-BeamData started', 1)
 -- Tabella per definizione modulo
 local BeamData = {
    RIGHT_LOAD = true,                       -- flag carico da destra
-   SIMUL_VIEW_DIR = 3,                      -- direzione di vista predefinita per la simulazione (1=NW, 2=SW, 3=NE, 4=SE)
+   SIMUL_VIEW_DIR = 1,                      -- direzione di vista predefinita per la simulazione (1=NW, 2=SW, 3=NE, 4=SE)
    GO_FAST = 0,                             -- flag abilitazione modalità veloce (0=no, 1=carrelli, 2=anche cambio utensili)
    ROT90 = false,                           -- flag abilitazione rotazione 90 gradi
    MIN_WIDTH = 40,                          -- larghezza minima del grezzo
@@ -54,6 +54,7 @@ local BeamData = {
    RAWCOL = { 255, 160, 32, 30},            -- colore del grezzo
    RAW_OFFSET = 2000,                       -- spostamento grezzo rimanente dopo split
    VICE_MINH = 110,                         -- altezza minima della morsa
+   VICE_MAXH = 370,                         -- altezza massima zona pinzaggio orizzontale
    OFFSET_DRILL_TENON = 0,                  -- offset fori su tenoni verso base degli stessi (0=non fare)
    USER_HOLE_DIAM = 0,                      -- diametro foro per L20
    MAX_TOOL_LEN_FOR_HOR_MACH = 311,         -- massima lunghezza utensile per poter fare forature (fresature) oltre i 10 gradi dalla verticale
@@ -68,11 +69,12 @@ local BeamData = {
    MAX_LEN_BH_FROM_BOTTOM = 195,            -- massima lunghezza lavorabile da un lato di block haus da sotto
    MAX_DIST_BH_FROM_BOTTOM = 395,           -- massima distanza tra naso mandrino e sopra della trave senza collisione
    BH_MACHINE = false,                      -- flag che indica la tipologia di macchina configurata BlockHaus
+   ANG_TRASM = false                        -- presenza rinvio angolare per lavorazioni da sotto
 }
 
 -- Aggiornamento con dati da TechnoEssetre7
 local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-Fastrl.data"
-local sData = EgtGetSourceDir().."\\Ts3Data.lua"
+local sData = EgtGetCurrMachineDir().."\\Beam\\Ts3Data.lua"
 if EgtExistsFile( sTs3Data) then
    EgtCopyFile( sTs3Data, sData)
    local sTs3DataOld = sTs3Data..'.old'

Beam/MachiningTypes.ini

@@ -6,6 +6,7 @@
 1=Drill
 2=Pocket
 3=AngleDrill
+4=Predrill
 
 [Milling]
 1=Prof

Common-FAST.NUM.mlpe

@@ -1,21 +1,12 @@
--- Processore macchina Essetre-FAST by EgalTech s.r.l.   2024/01/17
+-- Processore standard macchine FAST by EgalWare s.r.l.   2024/02/23
 -- Con controllo numerico NUM
--- 2021/04/23 DS ver 2.3d3 Se non c'è BtlInfo cerco il gruppo di lavoro corrente.
--- 2021/07/21 DS ver 2.3g5 Modifiche varie da TPA.
--- 2021/07/23 DS ver 2.3g6 Corretta gestione LOAD90.
--- 2021/07/23 DS ver 2.3g7 Completamento allineamento con TPA.
--- 2021/07/27 DS ver 2.3g8 Corretto carico senza taglio di testa per salto G79 N9.
--- 2021/07/27 DS ver 2.3g9 Nome in testa a CN (%NNNN.0) da PATTID di BtlInfo.
--- 2021/07/29 DS ver 2.3g10 Con testa H2 (lama) non si emettono assi rotanti nel corso della lavorazione.
--- 2021/08/03 DS ver 2.3h2 Nei commenti le parentesi sono sostituite con il carattere -.
--- 2021/08/05 DS ver 2.3h4 Nel rapido se non bHeadFirst ritardo anche l'emissione di G101 a dopo G112.
--- 2021/11/17 DS ver 2.3k1 Correzioni di Nicola su rotazioni verificate da GCT.
--- 2021/12/28 DS ver 2.3l2 Correzioni a G101 (ora sempre con EE ed ET).
--- 2021/12/29 DS ver 2.3l3 Altre correzioni a G101 (se già in alto EE3 e sempre ES).
--- 2023/04/19 DS ver 2.5d1 Al carico dopo rotazione su linea con EA75 messo EB110 invece di 112 (come FAST).
+
+-- carico librerie
+local INFO_STD_PP = require( 'Version')
 
 -- Variabili di modulo
-local MLE_INFO = 'Essetre-FASTrl.NUM.mlpe ver.'..PP_VER..' by EgalTech s.r.l.'
+local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
+local MACHINE_INFO = MACH_NAME..'  ver.'..PP_VER
 local TEST_USE = false
 
 ---------------------------------------------------------------------
@@ -50,12 +41,17 @@ function OnProgramStart()
    local BtlInfoId = EgtGetFirstNameInGroup( GDB_ID.ROOT, 'BtlInfo') or EgtGetCurrMachGroup() or GDB_ID.NULL
    local nPatt = EgtGetInfo( BtlInfoId, 'PATTID', 'i') or 40
    EmtOutput( '%'..EgtNumToString( nPatt, 0)..'.0')
+
+   -- 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
+
    if EMT.INFO then
-      EmtOutput( '('..EMT.INFO..')')
+      EmtOutput( sPrefixCommentLine..'('..EMT.INFO..')')
    else
       EmtOutput( '(Program Start)')
    end
-   EmtOutput( '('.. MLE_INFO..')\n')
+   EmtOutput( sPrefixCommentLine..'('.. CSP_INFO..')')
+   EmtOutput( sPrefixCommentLine..'('.. MACHINE_INFO..')\n')
    -- Se modalità test, aggiungo linee per muovere tappeto e alzare la testa (in automatico viene fatto dal main residente)
    if TEST_USE then
       EmtOutput( 'M28')
@@ -186,7 +182,7 @@ function OnDispositionEnd()
       -- calcolo dati pinze
       local MinAccPinze = 0.3
       local MaxAccPinze = 4
-      local KgMtCubo= 550           -- densità legno in Kg / metro cubo
+      local KgMtCubo= WoodDensity or 550           -- densità legno in Kg / metro cubo
       local Massa = ( HTrave * STrave * LBarra * KgMtCubo ) / 1000000000
       local FMaxPinze = EMT.FMAXPINZE
       local ForzaAtrito = 700 / 2   -- Serve per regolare P32 (700 valore reale pistone)
@@ -498,6 +494,7 @@ function OnMachiningEnd()
    EMT.AUXTYPE = nil
    EMT.U_STD = nil
    EMT.PREVTOOL = EMT.TOOL
+   EMT.PREVHEAD = EMT.HEAD
 end
 
 ---------------------------------------------------------------------
@@ -507,6 +504,11 @@ function OnPathStart()
    -- primo posizionamento sempre in globale
    EMT.REFLOC = nil
    EMT.IPLGL = false
+   
+   -- salvo precedenti rotanti
+   EMT.R1pp = EMT.R1p
+   EMT.R2pp = EMT.R2p
+
    -- reset valori precedenti (per forzare emissione di tutti gli assi del 1° movimento)
    EmtResetPrev()
    EMT.AUXCMD = {}
@@ -617,25 +619,55 @@ function OnRapid()
          if not EMT.ZMAX and #EMT.AUXSTR > 0 then
             EmitZmax()
             EMT.ZMAX = true
+            bHeadFirst = false
          end
       end
+
+      -- primo posizionamento
+      local MyZHome = EgtGetAxisHomePos( 'Z')
+      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
+      -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
+      if EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       ' B' .. EmtLenToString( EMT.R2pp, 3) .. ' C' .. EmtLenToString( EMT.R1pp, 3) .. 
+                                       ' EE' .. EgtIf( bZmax, '3', '4') .. EMT.PREVsEL .. EMT.PREVsER .. EMT.PREVsET .. EMT.PREVsES
+         EmtOutput( sOutPreMove)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
+      end
+
       if not EMT.LOAD then
          local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '-'), '%)', '-')
          EmtOutput( '( *** ' .. sOut .. ' *** )')
       end
-      -- primo posizionamento
-      EmtResetPrev()
-      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or  EMT.L3 > -1)
+
+      -- ricavo i dati per la lavorazione
       local sEE = ' EE' .. EgtIf( bZmax, '3', '4')
       local sEL = ' EL' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TLEN, ( EMT.TDIST or ChSawLen)), 3)
       local sER = ' ER' .. EmtLenToString( EgtIf( EMT.HEAD ~= 'H3', EMT.TDIAM / 2, EMT.TLEN), 3)
       local sET = GetET( EMT.HEAD, EMT.TCPOS, EMT.R3)
       local sES = ' ES'..EgtNumToString( EMT.S, 0)
-      local sOut = 'G101' .. EmtGetAxis( 'L2') .. EmtGetAxis( 'L3') ..
-                             EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
-      if EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
-         sOut = sOut .. ' EH1'
+
+      -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
+      if EMT.HEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+         local sEEPreMove = ' EE' .. EgtIf( bZmax, '3', '4')
+         local sOutPreMove = 'G101' .. ' X' .. EmtLenToString( -SafeXRotAxes, 3) .. ' Z' .. EmtLenToString( MyZHome, 3) ..
+                                       EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+         EmtOutput( sOutPreMove)
+         EmtOutput( 'G101 ET1001')
+         EmtOutput( 'G101 ET2001')
       end
+      EmtResetPrev()
+      -- se sono su pezzi alti e movimento da emettere, per sicurezza a Z massima
+      local MyZPos = EMT.L3
+      if EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+         MyZPos = MyZHome
+      end
+      local sOut = 'G101' .. EmtGetAxis( 'L2') .. ' Z' .. EmtLenToString( MyZPos, 3) ..
+                             EmtGetAxis( 'R2') .. EmtGetAxis( 'R1') .. sEE .. sEL .. sER .. sET .. sES
+      -- faccio backup dati in caso mi servano per lavorazione successiva
+      EMT.PREVsEE = sEE ; EMT.PREVsEL = sEL ; EMT.PREVsER = sER ; EMT.PREVsET = sET ; EMT.PREVsES = sES 
+
       if EMT.LOAD or bHeadFirst then
          sOut = sOut..' L0=0'
          EmtOutput( sOut)

Common-FAST.TPA.mlpe

@@ -1,9 +1,12 @@
--- Processore macchina Essetre-FASTrl by EgalTech s.r.l.   2024/01/17
+-- Processore standard macchine FAST by EgalWare s.r.l.   2024/02/23
 -- Con controllo numerico TPA
--- 2023/04/19 DS ver 2.5d1 Al carico dopo rotazione su linea con P4=75 messo P5=110 invece di 112 (come FAST).
+
+-- carico librerie
+local INFO_STD_PP = require( 'Version')
 
 -- Variabili di modulo
-local MLE_INFO = 'Essetre-FASTrl.TPA.mlpe ver.'..PP_VER..' by EgalTech s.r.l.'
+local CSP_INFO =     INFO_STD_PP.NAME..'  ver.'..INFO_STD_PP.VERSION..' by EgalWare s.r.l.'
+local MACHINE_INFO = MACH_NAME..'  ver.'..PP_VER
 local TEST_USE = false
 
 ---------------------------------------------------------------------
@@ -35,13 +38,19 @@ 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
-      ParkLine( '('..EMT.INFO..')')
+      ParkLine( sPrefixCommentLine..'('..EMT.INFO..')')
    else
       ParkLine( '(Program Start)')
    end
-   ParkLine( '('.. MLE_INFO..')')
+   ParkLine( sPrefixCommentLine..'('.. CSP_INFO..')')
+   ParkLine( 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
       ParkLine( 'M199')
@@ -134,6 +143,13 @@ function OnToolData()
          ParkLine( 'M992 P1=113' .. sData)
          ParkLine( 'M992 P1=114' .. sData)
       end
+   -- emissione dati rinvio
+   elseif EMT.HEAD == 'H5' or EMT.HEAD == 'H6' then
+      local nPos = EgtIf( EMT.HEAD == 'H5', 91, 93)
+      if EMT.EXIT == 2 then nPos = nPos + 1 end
+      local sOut = 'M992 P1=' .. EgtNumToString( nPos, 0) .. ' P2=' .. EmtLenToString( EMT.TLEN, 3) .. ' P3=' .. EmtLenToString( EMT.TDIAM, 3) ..
+                   ' P4=' .. EmtLenToString( EMT.SMAX, 3) .. ' P5=' .. EmtLenToString( EMT.TTOTLEN, 3)
+      ParkLine( sOut)
    -- altro non previsto
    else
       EmtSetLastError( 1211, 'Head not allowed ' .. EMT.HEAD)
@@ -160,6 +176,9 @@ function OnDispositionStart()
                    ' P4='..EmtLenToString( MinV, 2)..' P5='..EmtLenToString( MaxV, 2)..' P6='..EmtLenToString( MillOffs, 2)..
                    ' P7='..EmtLenToString( SawOffs, 2)..' P8='..EmtLenToString( ParkY, 2)..' P9='..EmtLenToString( ParkV, 2)..
                    ' P10='..EmtLenToString( TurnerOffs, 2)..' P11='..EmtLenToString( -DeltaTabY, 2)..' P12='..EmtLenToString( DeltaTabZ - MillOffs, 2)
+      if SecondSupport >= 3 then
+         sOut = sOut ..' P13='..EmtLenToString( AngTr1Len, 2) ..' P14='..EmtLenToString( AngTr1Offs + MillOffs,2)
+      end
       ParkLine( sOut)
       -- carico barra
       EMT.LOAD = true
@@ -191,19 +210,12 @@ function OnDispositionEnd()
       local HTrave = EMT.HT
       local STrave = EMT.ST
       local HOverM = EMT.HOVM
+
       -- calcolo dati pinze
-      local MinAccPinze = 0.3
-      local MaxAccPinze = 4
-      local KgMtCubo= 550           -- densità legno in Kg / metro cubo
-      local Massa = ( HTrave * STrave * LBarra * KgMtCubo ) / 1000000000
-      local FMaxPinze = EMT.FMAXPINZE
-      local ForzaAtrito = 700 / 2   -- Serve per regolare P32 (700 valore reale pistone)
-      local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAtrito) / 1000)
-      if ( TempoAcc < MinAccPinze) then TempoAcc = MinAccPinze end
-      if ( TempoAcc > MaxAccPinze) then TempoAcc = MaxAccPinze end
-      local AccPinze = FMaxPinze / ( 60 * TempoAcc)
-      local RidFeed = 100 / Massa * 100
-      if ( RidFeed > 100) then RidFeed = 100 end
+      local TempAccPinze, TempMinAccPinze, RidFeed = CalcDinamicaPinze( HTrave, STrave, LBarra)
+      local TempAccPinz1, TempMinAccPinz1, RidFeed1 = CalcDinamicaPinze( HTrave, STrave, LBarra - LTrave)
+      local TempAccPinz2, TempMinAccPinz2, RidFeed2 = CalcDinamicaPinze( HTrave, STrave, LTrave)
+
       if IdTrave >= 0 then
          local sPrt = '( *** Part '.. EgtNumToString( IdTrave, 0) ..' ***)'
          local sOut = '( SN=' .. IdTrave .. ' LBarra=' .. EmtLenToString( LBarra, 3) .. ' L='..EmtLenToString( LTrave, 3) ..
@@ -232,7 +244,8 @@ function OnDispositionEnd()
       -- se carico barra
       if EMT.LOAD or EMT.RELOAD then
          sOut = 'M115 P1=' .. EmtLenToString( LBarra, 2) .. ' P2=' .. EmtLenToString( HTrave, 2) .. ' P3=' .. EmtLenToString( STrave, 2) ..
-                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( LTrave, 2)
+                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( LTrave, 2) ..
+                ' P7=' .. EgtNumToString( TempAccPinze, 2) .. ' P8=' .. EgtNumToString( TempAccPinz2, 2) .. ' P9=' .. EgtNumToString( TempAccPinz1, 2)
          if EMT.LOAD then
             ParkLine( sOut)
             SetStartValue( 1, LBarra)
@@ -246,7 +259,8 @@ function OnDispositionEnd()
       -- altrimenti recupero rimanenza
       else
          sOut = 'M115 P1=' .. EmtLenToString( LBarra, 2) .. ' P2=' .. EmtLenToString( HTrave, 2) .. ' P3=' .. EmtLenToString( STrave, 2) ..
-                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( EgtIf( IdTrave >= 0, LTrave, LBarra), 2)
+                ' P4=' .. EmtLenToString( HOverM, 2) .. ' P5=' .. tostring( nLoad90) .. ' P6=' .. EmtLenToString( EgtIf( IdTrave >= 0, LTrave, LBarra), 2) ..
+                ' P7=' .. EgtNumToString( TempAccPinze, 2) .. ' P8=' .. EgtNumToString( TempAccPinz2, 2) .. ' P9=' .. EgtNumToString( TempAccPinz1, 2)
          EmtOutput( sOut)
          EmtOutput( 'M112'..' P1='..EmtLenToString( LoadT, 3).. ' P5=1 P6='..EmtLenToString( EMT.YPOS, 3)..' P7='..EmtLenToString( ParkV, 3) ..' P9='..GetFmaxClamp())
          -- aggiorno dati aggancio carrelli alla trave
@@ -405,9 +419,13 @@ function OnMachiningStart()
    EMT.MCHNAME = EgtGetOperationName( EMT.MCHID)
    EMT.MCHTYPE = EgtGetMachiningParam( MCH_MP.TYPE)
    EMT.MCHUSERNOTES = EgtGetMachiningParam( MCH_MP.USERNOTES)
-   -- la speed della lama va moltiplicata per 6
+   -- sistemazione speed (la speed della lama va moltiplicata per 6)
    if EMT.HEAD == 'H2' then
       EMT.S = EMT.S * 6
+   elseif EMT.HEAD == 'H5' and EMT.EXIT == 1 then
+      EMT.S = -EMT.S
+   elseif EMT.HEAD == 'H6' and EMT.EXIT == 1 then
+      EMT.S = -EMT.S
    end
    -- determino subito se taglio di separazione di pezzo a caduta
    EMT.PREFALLCUT = nil
@@ -492,6 +510,8 @@ function OnMachiningEnd()
    EMT.AUXTYPE = nil
    EMT.U_STD = nil
    EMT.PREVTOOL = EMT.TOOL
+   EMT.PREVHEAD = EMT.HEAD
+   EMT.PREVS = EMT.S
 end
 
 ---------------------------------------------------------------------
@@ -502,6 +522,11 @@ function OnPathStart()
    -- primo posizionamento sempre in globale
    EMT.REFLOC = nil
    EMT.IPLGL = false
+
+   -- salvo precedenti rotanti
+   EMT.R1pp = EMT.R1p
+   EMT.R2pp = EMT.R2p
+
    -- reset valori precedenti (per forzare emissione di tutti gli assi del 1° movimento)
    EmtResetPrev()
    EMT.AUXCMD = {}
@@ -615,22 +640,49 @@ function OnRapid()
       if not ( EMT.LOAD or EMT.RELOAD) then
          if not EMT.ZMAX and #EMT.AUXSTR > 0 then
             EmitZmax()
+            bHeadFirst = false
          end
       end
+      -- primo posizionamento
+      local MyZHome = EgtGetAxisHomePos( 'Z')
+      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or EMT.L3 > -1)
+      -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
+      if EMT.PREVHEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+         local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, 3) .. ' P3=' .. EmtLenToString( MyZHome, 3) ..
+                                 ' P4=' .. EgtNumToString( EMT.R2pp, 3) .. ' P5=' .. EgtNumToString( EMT.R1pp, 3) .. 
+                                 ' P6=' .. EgtNumToString( EMT.PREVTCPOS, 3) .. ' P7=' .. EgtNumToString( EMT.PREVS, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+         EmtOutput( sOutPreMove)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+      end
+
       if not EMT.LOAD then
          local sOut = string.gsub( string.gsub( EMT.MCHNAME..'/'..EMT.TOOL, '%(', '['), '%)', ']')
          EmtOutput( '( * ' .. sOut .. ' * )')
       end
-      -- primo posizionamento
+
+      -- se carico motosega, ruoto in zona sicura prima di approcciare la lavorazione
+      if EMT.HEAD == 'H3' and EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+         local sOutPreMove = 'M101 P1=1' .. ' P2=' .. EmtLenToString( -SafeXRotAxes, 3) .. ' P3=' .. EmtLenToString( MyZHome, 3) ..
+                                 ' P4=' .. EgtNumToString( EMT.R2, 3) .. ' P5=' .. EgtNumToString( EMT.R1, 3) .. 
+                                 ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
+                                 ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
+         EmtOutput( sOutPreMove)
+         EmtOutput( 'M101 P1=2')
+         EmtOutput( 'M101 P1=3')
+      end
+      -- resetto valori precedenti
       EmtResetPrev()
-      local bZmax = ( #EMT.AUXSTR > 0  or  EMT.TOOL ~= EMT.PREVTOOL  or EMT.L3 > -1)
-      local sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( EMT.L2, 3) .. ' P3=' .. EmtLenToString( EMT.L3, 3) ..
+      local MyZPos = EMT.L3
+      -- se sono su pezzi alti e movimento da emettere, per sicurezza a Z massima
+      if EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+         MyZPos = MyZHome
+      end
+      local sOut = 'M101 P1=1' .. ' P2=' .. EmtLenToString( EMT.L2, 3) .. ' P3=' .. EmtLenToString( MyZPos, 3) ..
                        ' P4=' .. EgtNumToString( EMT.R2, 3) .. ' P5=' .. EgtNumToString( EMT.R1, 3) .. 
                        ' P6=' .. AdjustTcPos( false) .. ' P7=' .. EgtNumToString( EMT.S, 0) ..
                        ' P8=0' .. ' P9=0' .. ' P10=' .. EgtIf( bZmax, '3', '4')
-      if EMT.ST > BeamHeightForFixRot and EMT.FLAG2 == 1 then
-         sOut = sOut .. ' P12=1'
-      end
       if EMT.LOAD then
          ParkLine( sOut)
       else
@@ -929,6 +981,28 @@ function OnArc()
    EmtUpdatePrev()
 end
 
+---------------------------------------------------------------------
+function CalcDinamicaPinze( dH, dS, dL)
+   local MinTempoAcc = 0.3                         -- [s]
+   local MaxTempoAcc = 4.0                         -- [s]
+   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]
+   local TempoAcc = ( ( Massa * FMaxPinze) / ( 60 * ForzaAttrito) / 1000)
+   if ( TempoAcc < MinTempoAcc) then TempoAcc = MinTempoAcc end
+   if ( TempoAcc > MaxTempoAcc) then TempoAcc = MaxTempoAcc end
+   local AccMaxPinze = FMaxPinze / ( 60 * MinTempoAcc)
+   local AccPinze = FMaxPinze / ( 60 * TempoAcc)
+   local RidFeed = 100 / Massa * 100
+   if RidFeed > 100 then
+      RidFeed = 100
+   elseif RidFeed < 10 then
+      RidFeed = 10
+   end
+   return TempoAcc * 1000, MinTempoAcc * 1000, RidFeed
+end
+
 ---------------------------------------------------------------------
 function CalcCharStatus( sCmd, bSkipPress)
    -- aperto
@@ -1504,6 +1578,12 @@ function MyAdjustLinearAxes()
          local LenRef = MillOffs
          local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2, EMT.R3)
          vtE = vtAux * LenAux - Z_AX() * LenRef
+      elseif  EMT.HEAD == 'H5' then
+         local Len = EMT.TLEN + AngTr1Len
+         local LenAux = MillOffs + AngTr1Offs
+         local LenRef = MillOffs
+         local vtAux = EgtGetCalcAuxDirFromAngles( EMT.R1, EMT.R2)
+         vtE = Vector3d( EMT.EXTR) * Len + vtAux * LenAux - Z_AX() * LenRef
       else
          EmtSetLastError( 1211, 'Head not allowed ' .. EMT.HEAD)
       end
@@ -1536,6 +1616,10 @@ function AdjustToolKinematic()
       return '01'
    elseif EMT.HEAD == 'H2' then
       return '02'
+   elseif EMT.HEAD == 'H5' then
+      return EgtIf( EMT.EXIT == 1, '11', '12')
+   elseif EMT.HEAD == 'H6' then
+      return EgtIf( EMT.EXIT == 1, '21', '22')
    else
       EmtSetLastError( 1211, 'Head not allowed ' .. EMT.HEAD)
    end
@@ -1544,7 +1628,15 @@ end
 ---------------------------------------------------------------------
 function AdjustTcPos( bLen3)
    local sPos = EMT.TCPOS:gsub( 'T', '')
-   if sPos == '101' and EMT.HEAD == 'H3' then
+   if sPos == '91' then
+      if EMT.EXIT == 2 then
+         sPos = '92'
+      end
+   elseif sPos == '93' then
+      if EMT.EXIT == 2 then
+         sPos = '94'
+      end
+   elseif sPos == '101' and EMT.HEAD == 'H3' then
       if abs( EMT.R3 - 0) < 0.1 then
          sPos = '101'
       elseif abs( EMT.R3 - 270) < 0.1 then
@@ -1576,6 +1668,8 @@ function AdjustTcPos( bLen3)
          sPos = '0' .. sPos
       end
    end
+   -- salvo posizione
+   EMT.PREVTCPOS = sPos
    return sPos
 end
 

Common-FAST.mlpe

@@ -1,29 +1,25 @@
--- Processore macchina Essetre-FAST by EgalTech s.r.l.   2022/01/23
--- Funzioni generiche indipendenti dal controllo
--- 2020/09/22 DS ver 2.2i4 Distanza di sicurezza per collisioni da 2 a 4mm (inoltre allontanata flangia lama e aggiunto cilindro asse Z)
--- 2020/09/26 DS ver 2.2i5 Gestione cambio presa sega a catena tra due lavorazioni successive.
--- 2020/10/06 DS ver 2.2j1 Punta lunga da togliere basata su sua lunhezza totale e non più su T111.
--- 2021/01/08 DS ver 2.3a1 Gestione utensile di default da posizione e non da nome.
--- 2021/01/24 DS ver 2.3a2 Correzione deposito sega a catena con ripresa della stessa per angola A diverso.
--- 2021/01/31 DS ver 2.3a3 Altre correzioni per sega a catena.
--- 2021/06/28 DS ver 2.3f5 Correzioni per scarico punte lunghe con pezzi alti.
--- 2021/07/12 DS ver 2.3g2 Correzioni per verifica collisioni durante scarico utensili.
+-- Processore macchina Essetre-FAST by EgalWare s.r.l.   2024/03/09
 
 -- Intestazioni
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
+-- carico librerie
+local BD = require( 'BeamData')
+
 LONG_TOOL_MINLEN = 221
 BIG_TOOL_DIAM = 300
 
 ---------------------------------------------------------------------
 -- *** GENERATION ***
 ---------------------------------------------------------------------
-local sBaseDir = EgtGetSourceDir()
+local sBaseDir = EgtGetCurrMachineDir()
 if NumericalControl == 'NUM' then
-   dofile( sBaseDir .. 'Essetre-FASTrl.NUM.mlpe')
+   dofile( sBaseDir .. '\\Common-FAST.NUM.mlpe')
 elseif NumericalControl == 'TPA' then
-   dofile( sBaseDir .. 'Essetre-FASTrl.TPA.mlpe')
+   dofile( sBaseDir .. '\\Common-FAST.TPA.mlpe')
+elseif NumericalControl == 'NUM_PLUS' then
+   dofile( sBaseDir .. '\\Common-FAST.NUM_PLUS.mlpe')
 else
    EmtSetLastError( 1201, 'Numerical Control error : unkwnown type')
 end
@@ -33,6 +29,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
@@ -69,6 +104,7 @@ function OnSimulStart()
    AddToCollisionCheck( 'Z', 'COLLISION', EMT.COLLOBJ)
    AddToCollisionCheck( 'B', 'COLLISION', EMT.COLLOBJ)
    AddToCollisionCheck( 'C', 'COLLISION', EMT.COLLOBJ)
+   AddToCollisionCheck( 'H5', 'COLLISION', EMT.COLLOBJ)
    AddToolToCollisionCheck( 'H2', 1, EMT.COLLOBJ)
    AddToolHolderToCollisionCheck( 'H2', 1, EMT.COLLOBJ)
    DumpCollisionCheck( EMT.COLLOBJ, 'Collision Objects :', 4)
@@ -94,7 +130,7 @@ function OnSimulStart()
       local nId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( nGrpId or GDB_ID.NULL, McdData[i].Sub) or GDB_ID.NULL, McdData[i].Name)
       if nId then
          table.insert( EMT.MCODET, nId)
-         EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' is ok', 4)
+         EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' (' .. tostring( nId) .. ') is ok', 4)
       else
          nMcdNullCnt = nMcdNullCnt + 1
          EgtOutLog( 'Element ' .. McdData[i].Grp .. '/' .. McdData[i].Sub .. '/' .. McdData[i].Name .. ' is null', 4)
@@ -467,7 +503,7 @@ function OnSimulToolSelect( dPosA)
          -- imposto il valore di A
          EgtSetAxisPos( 'A', dPosA)
          if abs( dPosA) < 0.1 then
-            EgtSetAxisPos( 'C', 180)
+            EgtSetAxisPos( 'C', EgtIf( BD.RIGHT_LOAD, 180, 0))
          end
          EgtSetAxisPos( 'B', 0)
       end
@@ -492,38 +528,45 @@ end
 function OnSimulToolDeselect()
    -- se prossimo utensile non definito, è disposizione ed esco
    if EMT.NEXTTOOL == '' then return end
-   -- se sega a catena o punta lunga, devo cambiare
-   if EMT.HEAD == 'H3' or ( EMT.HEAD == 'H1' and ( EMT.TOTLEN > LONG_TOOL_MINLEN or EMT.TOTDIAM > BIG_TOOL_DIAM)) then
+   -- se cambia uscita su rinvio non devo fare alcunché
+   if EMT.HEAD == 'H5' and EMT.NEXTHEAD == 'H5' then return end
+   -- se sega a catena o rinvio o punta lunga o utensile di grosso diametro, devo cambiare
+   if EMT.HEAD == 'H3' or EMT.HEAD == 'H5' or ( EMT.HEAD == 'H1' and ( EMT.TOTLEN > LONG_TOOL_MINLEN or EMT.TOTDIAM > BIG_TOOL_DIAM)) then
       EgtOutText( 'Tool change in progress...')
-      local RapSimStep = 4 * EMT.SIMSTEP
-      local RapSimRotStep = RapSimStep / 10
-      local CollSimRotStep = min( RapSimRotStep, 5)
       -- movimento scarico sega a catena
       if EMT.HEAD == 'H3' then
+         -- se avevo motosega, torno in zona sicura senza ruotare assi rotanti
+         if  EMT.HB > BeamHeightForFixRot then
+            SimulMoveAxis( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID)
+         end
          local dPosA = EgtGetAxisPos( 'A')
          if abs( dPosA) < 0.1 then
-            SimulMoveAxes( 'B', 0, CollSimRotStep, 'C', 180, CollSimRotStep)
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 180, 0), MCH_SIM_STEP.COLLROT)
          else
-            SimulMoveAxes( 'B', 0, CollSimRotStep, 'C', 90, CollSimRotStep)
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
          end
-         SimulMoveAxis( 'X', 0, RapSimStep)
+         SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
+      -- movimento scarico rinvio
+      elseif EMT.HEAD == 'H5' then
+         SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', -90, MCH_SIM_STEP.COLLROT)
+         SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
       -- movimento scarico punta lunga su T111
       elseif EMT.TOTLEN > LONG_TOOL_MINLEN then
          -- se su cambio utensile T111
          if EMT.TCPOS == 'T111' then
-            SimulMoveAxis( 'X', 0, RapSimStep)
-            SimulMoveAxes( 'B', 0, CollSimRotStep, 'C', 0, CollSimRotStep)
+            SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.COLLROT, 'C', 0, MCH_SIM_STEP.COLLROT)
          -- altrimenti posizioni standard rastrelliera
          else
-            SimulMoveAxis( 'X', 0, RapSimStep)
-            SimulMoveAxes( 'B', 90, CollSimRotStep, 'C', -90, CollSimRotStep)
+            SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
+            SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', -90, MCH_SIM_STEP.COLLROT)
          end
       -- movimento scarico utensile di grosso diametro (su T111)
       else
          local dPosB = EgtGetAxisPos( 'B')
          local dNewB = EgtIf( dPosB < 0, -90, 90)
-         SimulMoveAxes( 'B', dNewB, CollSimRotStep, 'C', 180, CollSimRotStep)
-         SimulMoveAxis( 'X', 0, RapSimStep)
+         SimulMoveAxes( 'B', dNewB, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 180, 0), MCH_SIM_STEP.COLLROT)
+         SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
       end
       -- breve pausa
       EgtPause( 100)
@@ -531,10 +574,10 @@ function OnSimulToolDeselect()
       EgtSetMode( EgtGetHeadId( EMT.HEAD), GDB_MD.HIDDEN)
       ShowToolInTcPos( EMT.TCPOS_1, true)
       -- movimento per carico utensile
-      if EMT.NEXTHEAD ~= 'H3' then
-         SimulMoveAxes( 'B', 90, RapSimRotStep, 'C', 90, RapSimRotStep)
+      if EMT.NEXTHEAD ~= 'H3' and EMT.NEXTHEAD ~= 'H5' then
+         SimulMoveAxes( 'B', 90, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
       else
-         SimulMoveAxes( 'B', 0, RapSimRotStep, 'C', 90, RapSimRotStep)
+         SimulMoveAxes( 'B', 0, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
       end
       -- se segue lama, carico utensile di default
       if EMT.NEXTHEAD == 'H2' then
@@ -550,23 +593,20 @@ function OnSimulToolDeselect()
    elseif EMT.NEXTHEAD ~= 'H2'  and  EMT.NEXTHEAD ~= 'H4' then
       if EMT.NEXTTOOL ~= EMT.TOOL_1 then
          EgtOutText( 'Tool change in progress...')
-         local RapSimStep = 4 * EMT.SIMSTEP
-         local RapSimRotStep = RapSimStep / 10
-         local CollSimRotStep = min( RapSimRotStep, 10)
          -- simulo movimento
-         SimulMoveAxes( 'B', 90, CollSimRotStep, 'C', 90, CollSimRotStep)
-         SimulMoveAxis( 'X', 0, RapSimStep)
+         SimulMoveAxes( 'B', 90, MCH_SIM_STEP.COLLROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.COLLROT)
+         SimulMoveAxis( 'X', 0, MCH_SIM_STEP.RAPID)
          -- breve pausa
          EgtPause( 100)
          ShowToolInTcPos( EMT.TCPOS_1, true)
          -- se segue sega a catena
-         if EMT.NEXTHEAD == 'H3' then
+         if EMT.NEXTHEAD == 'H3' or EMT.NEXTHEAD == 'H5' then
             -- se non lama, nascondo l'utensile corrente
             if EMT.HEAD ~= 'H2' then
                EgtSetStatus( EgtGetHeadId( EMT.HEAD), GDB_ST.OFF)
             end
             -- eseguo movimento opportuno
-            SimulMoveAxes( 'B', 0, RapSimRotStep, 'C', 90, RapSimRotStep)
+            SimulMoveAxes( 'B', 0, MCH_SIM_STEP.RAPROT, 'C', EgtIf( BD.RIGHT_LOAD, 90, -90), MCH_SIM_STEP.RAPROT)
          -- se altrimenti lama su cambio utensile
          elseif EMT.NEXTHEAD == 'H1' and SpecialBH and EMT.NEXTTCPOS == 'T111' then
             -- se non lama, nascondo l'utensile corrente
@@ -574,7 +614,7 @@ function OnSimulToolDeselect()
                EgtSetStatus( EgtGetHeadId( EMT.HEAD), GDB_ST.OFF)
             end
             -- eseguo movimento opportuno
-            SimulMoveAxes( 'B', -90, RapSimRotStep, 'C', 0, RapSimRotStep)
+            SimulMoveAxes( 'B', -90, MCH_SIM_STEP.RAPROT, 'C', 0, MCH_SIM_STEP.RAPROT)
          end
       else
          EMT.TOOL_1 = nil
@@ -631,35 +671,8 @@ end
 
 ---------------------------------------------------------------------
 function OnSimulPathEnd()
-   -- 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
-      EgtOutLog( 'OnSimulPathEnd', 5)
-      local vMillId = EMT.VMILL[1]
-      local nPart = EgtVolZmapPartCount( vMillId)
-      if nPart > 1 then
-         -- ricerca del pezzo con massimo volume
-         local nPartMax = 0
-         local dVolMax = 0
-         for i = 1, nPart do
-            local dVol = EgtVolZmapPartVolume( vMillId, i - 1)
-            if dVol > dVolMax then
-               dVolMax = dVol
-               nPartMax = i
-            end
-         end
-         -- eliminazione di tutti i pezzi piccoli
-         for i = nPart, 1, -1 do
-            if i ~= nPartMax then
-               local b3Vmill = EgtVolZmapGetPartBBoxGlob( vMillId, i - 1, GDB_BB.STANDARD)
-               if b3Vmill:getDimX() < 1200 then
-                  EgtRemoveVolZmapPart( vMillId, i - 1)
-               end
-            end
-         end
-         -- aggiorno visualizzazione
-         EgtDraw()
-      end
-   end
+   -- rimozione eventuali sfridi
+   ExecRemoveScraps()
 end
 
 ---------------------------------------------------------------------
@@ -737,17 +750,23 @@ function OnSimulMoveStart()
       EgtOutText( '')
       EMT.MCHFIRST = false
       -- con pezzi alti aggiorno gli assi rotanti prima di muovermi sopra il pezzo
-      if not EMT.LOAD and EMT.MOVE == 0 and EMT.HB > BeamHeightForFixRot then
-         local RapSimStep = 4 * EMT.SIMSTEP
-         SimulMoveAxes( 'C', EMT.R1, RapSimStep/10, 'B', EMT.R2, RapSimStep/10)
+      if not EMT.LOAD and EMT.MOVE == 0 and EMT.HB > BeamHeightForFixRot and EMT.FLAG2 == 1 then
+         -- se motosega mi muovo a X di sicurezza per ruotare
+         if EMT.HEAD == 'H3'then
+            SimulMoveAxes( 'X', SafeXRotAxes, MCH_SIM_STEP.RAPID, 'C', EMT.R1, MCH_SIM_STEP.COLLROT, 'B', EMT.R2, MCH_SIM_STEP.COLLROT)
+         end
       end
       EMT.POSTROT = nil
    end
 end
 
 ---------------------------------------------------------------------
---function OnSimulMoveEnd()
---end
+function OnSimulMoveEnd()
+   if EMT.FLAG == 301 then 
+      -- rimozione eventuali sfridi
+      ExecRemoveScraps()
+   end
+end
 
 ---------------------------------------------------------------------
 function OnSimulCollision()
@@ -772,7 +791,6 @@ end
 
 ---------------------------------------------------------------------
 function ExecAuxCmd( sCmd)
-   local RapSimStep = 4 * EMT.SIMSTEP
    local Cmd = EgtSplitString( sCmd)
    if Cmd[1] == '0' then
       if Cmd[2] == 'Unloading' then
@@ -782,7 +800,7 @@ function ExecAuxCmd( sCmd)
       end
       EgtOutText( EgtIf( Cmd[3], Cmd[3], Cmd[2]))
    elseif Cmd[1] == '1' then
-      if not SimulMoveAxis( Cmd[2], tonumber( Cmd[3]), RapSimStep) then
+      if not SimulMoveAxis( Cmd[2], tonumber( Cmd[3]), MCH_SIM_STEP.RAPID) then
          if VerifyYVStroke( Cmd[2], tonumber( Cmd[3])) == nil then 
             EgtOutLog( 'Error on ExecAuxCmd : ' .. sCmd)
          end
@@ -796,8 +814,8 @@ function ExecAuxCmd( sCmd)
       -- Verifico movimento carrello con trave agganciata
       VerifyOneChariotSlide( Cmd[2], Cmd[3], Cmd[4], Cmd[5])
       -- Eseguo il movimento
-      local _, bOk, bOk2 = SimulMoveAxes( Cmd[2], tonumber( Cmd[3]), RapSimStep,
-                                          Cmd[4], tonumber( Cmd[5]), RapSimStep)
+      local _, bOk, bOk2 = SimulMoveAxes( Cmd[2], tonumber( Cmd[3]), MCH_SIM_STEP.RAPID,
+                                          Cmd[4], tonumber( Cmd[5]), MCH_SIM_STEP.RAPID)
       if not ( bOk and bOk2) then
          local nI = EgtIf( not bOk, 2, 4)
          if VerifyYVStroke( Cmd[nI], tonumber( Cmd[nI+1])) == nil then 
@@ -808,9 +826,9 @@ function ExecAuxCmd( sCmd)
       -- Verifico movimento carrelli con trave agganciata
       VerifyTwoChariotsSlide( Cmd[2], Cmd[3], Cmd[4], Cmd[5], Cmd[6], Cmd[7])
       -- Eseguo il movimento
-      local _, bOk, bOk2, bOk3 = SimulMoveAxes( Cmd[2], tonumber( Cmd[3]), RapSimStep,
-                                                Cmd[4], tonumber( Cmd[5]), RapSimStep,
-                                                Cmd[6], tonumber( Cmd[7]), RapSimStep)
+      local _, bOk, bOk2, bOk3 = SimulMoveAxes( Cmd[2], tonumber( Cmd[3]), MCH_SIM_STEP.RAPID,
+                                                Cmd[4], tonumber( Cmd[5]), MCH_SIM_STEP.RAPID,
+                                                Cmd[6], tonumber( Cmd[7]), MCH_SIM_STEP.RAPID)
       if not ( bOk and bOk2 and bOk3) then
          local nI = EgtIf( not bOk, 2, EgtIf( not bOk2, 4, 6))
          if VerifyYVStroke( Cmd[nI], tonumber( Cmd[nI+1])) == nil then 
@@ -822,14 +840,14 @@ function ExecAuxCmd( sCmd)
       if Cmd[2] ~= '0' then
          dPY = EgtIf( EMT.ROT == -1, EMT.HB, EMT.SB)
       end
-      SimulMoveAxis( 'PY', dPY, RapSimStep)
+      SimulMoveAxis( 'PY', dPY, MCH_SIM_STEP.RAPID)
       SetPYLight( Cmd[2] ~= '0')
    elseif Cmd[1] == '12' then
       local dPV = MaxOpen
       if Cmd[2] ~= '0' then
          dPV = EgtIf( EMT.ROT == -1, EMT.HB, EMT.SB)
       end
-      SimulMoveAxis( 'PV', dPV, RapSimStep)
+      SimulMoveAxis( 'PV', dPV, MCH_SIM_STEP.RAPID)
       SetPVLight( Cmd[2] ~= '0')
    elseif Cmd[1] == '21' then
       local nYDelta = tonumber( Cmd[2])
@@ -852,6 +870,39 @@ function ExecAuxCmd( sCmd)
    end
 end
 
+---------------------------------------------------------------------
+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
+      EgtOutLog( 'OnSimulPathEnd', 5)
+      local vMillId = EMT.VMILL[1]
+      local nPart = EgtVolZmapPartCount( vMillId)
+      if nPart > 1 then
+         -- ricerca del pezzo con massimo volume
+         local nPartMax = 0
+         local dVolMax = 0
+         for i = 1, nPart do
+            local dVol = EgtVolZmapPartVolume( vMillId, i - 1)
+            if dVol > dVolMax then
+               dVolMax = dVol
+               nPartMax = i
+            end
+         end
+         -- eliminazione di tutti i pezzi piccoli
+         for i = nPart, 1, -1 do
+            if i ~= nPartMax then
+               local b3Vmill = EgtVolZmapGetPartBBoxGlob( vMillId, i - 1, GDB_BB.STANDARD)
+               if b3Vmill:getDimX() < 1200 then
+                  EgtRemoveVolZmapPart( vMillId, i - 1)
+               end
+            end
+         end
+         -- aggiorno visualizzazione
+         EgtDraw()
+      end
+   end
+end
+
 ---------------------------------------------------------------------
 function ExecUnloading()
    if EMT.VMILL and #EMT.VMILL > 0 then
@@ -861,21 +912,25 @@ function ExecUnloading()
       -- li sposto per lasciare spazio al nuovo pezzo
       local nId = EgtGetFirstInGroup( nVmGrpId)
       while nId do
-         EgtMove( nId, Vector3d( 0, ( EMT.SB + 50.0), 0), GDB_RT.GLOB)
+         EgtMove( nId, Vector3d( 0, EgtIf( BD.RIGHT_LOAD, ( EMT.SB + 50.0), -( EMT.SB + 50.0)), 0), GDB_RT.GLOB)
          nId = EgtGetNext( nId)
       end
       -- creo un nuovo layer e vi inserisco il nuovo pezzo
       local nLayId = EgtGroup( nVmGrpId, EgtGetGlobFrame( vMillId))
       EgtRelocate( vMillId, nLayId)
-      local vtMove = Vector3d( 0, 450, 0)
-      if EMT.FALL then vtMove = Vector3d( -500, 0, 750) end
+      local vtMove = Vector3d( 0, EgtIf( BD.RIGHT_LOAD, 450, -450), 0)
+      if EMT.FALL then vtMove = Vector3d( -500, 0, EgtIf( BD.RIGHT_LOAD, 750, -750)) end
       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

Common-FAST.mlse

@@ -1,36 +1,29 @@
--- Special Operations macchina Essetre-FAST by EgalTech s.r.l.  2023/01/10
--- 2020/05/15 DS ver.2.2e1 Correzione a SpecAdjustCarrC3 per bFixedDelta.
--- 2020/05/16 DS ver 2.2e2 Aggiunta gestione rotazione 90deg.
--- 2020/05/21 DS ver 2.2e3 Aggiunto a SpecAdjustCarrC3 parametro bFixedPos (per lavorazioni Split e Cut precedute da Pre).
--- 2020/05/26 DS ver 2.2e4 Nuova gestione dei pezzi a caduta.
--- 2020/05/27 DS ver 2.2e5 Corretto blocco pinza V su presplit e precut.
--- 2020/05/28 DS ver 2.2e7 Correzione per mancanza EMC.HOVM allo scarico.
--- 2020/06/18 DS ver 2.2f3 Aumento ingombro fresatura opposta a cerrello per evitare extracorsa.
--- 2020/07/02 DS ver 2.2g1 Correzione quota di presa al carico per casi senza tagli in testa e lavorazioni solo in coda.
--- 2020/09/03 DS ver 2.2i1 Correzione in Load dopo rotazione deve tener conto dell'ingombro delle lavorazioni in coda.
--- 2020/09/09 DS ver 2.2i2 Nel calcolo pinzaggi ora si tiene conto anche della larghezza della sezione della barra.
--- 2020/09/25 DS ver 2.2i5 Migliorato calcolo ingombro lama con testa opposta al carrello.
--- 2020/09/29 DS ver 2.2i6 Migliorato calcolo ingombro fresa su tagli longitudinali di fianco.
--- 2020/10/13 DS ver 2.2j2 Aggiunta gestione sezione molto piccola (Very Small) per presa minima. Corretta gestione ingombri con fori a 30 deg.
--- 2020/12/09 DS ver 2.2l1 Migliorato calcolo ingombro con lama verticale inclinata di +/-45deg rispetto a X.
--- 2021/01/24 DS ver 2.3a2 Migliorato controllo assi rotanti definiti con sega a catena per SpecialCalcMachiningEncumbrance.
--- 2021/02/02 DS ver 2.3b1 Migliorato calcolo ingombro tagli di lama quasi verticale angolata.
--- 2021/02/17 DS ver 2.3b2 Corretta B3Ys-xs1 per accentrare V e T bisogna sottrarre dExtraY che è negativo e non sommare.
--- 2021/04/02 DS ver 2.3d1 Corretto calcolo ingombro con lama per non andare in extracorsa con le pinze quando lavorazione vicino a Y0.
--- 2021/06/01 DS ver 2.3f1 Aggiunta segnalazione pezzo scaricato a caduta.
--- 2021/06/25 DS ver 2.3f5 Corretta segnalazione tipo di scarico del pezzo.
--- 2023/01/10 SM ver 2.5a1 Affinato calcolo ingombro lavorazione con fresa quasi verticale.
+-- Special Operations macchina Essetre-FAST by EgalWare s.r.l.  2024/03/28
 
 -- Intestazioni
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
--- Carico i dati globali
-local sBaseDir = EgtGetSourceDir()
-local BD = dofile( sBaseDir .. 'Beam\\BeamData.lua')
+-- carico librerie
+local BD = require( 'BeamData')
 
-EgtOutLog ( '** Essetre-FAST '..PP_VER..' **', 1)
+---------------------- OnSpecialMoveZup -----------------------------
+---------------------------------------------------------------------
+function OnSpecialMoveZup()
+   --EgtOutLog( 'OnSpecialMoveZup : ' .. EMC.HEAD .. '.' .. tostring( EMC.EXIT))
+   
+   -- Inizializzazioni
+   EMC.ERR = 0
+   EMC.MODIF = false
+   
+   -- se sega a catena
+   if EMC.HEAD == 'H3' then
 
+   end
+
+end
+
+---------- OnSpecialApplyDisposition & OnPostApplyMachining ---------
 ----------------------- Costanti ------------------------------------
 local DELTA_TOL_V = 110
 local DELTA_TOL_S = 210
@@ -452,6 +445,7 @@ function OnPostApplyMachining()
          EMC.YDELTA = nil
          EMC.VDELTA = nil
          EMC.HCING_IGNORE = true
+         EMC.CNT = 1
       elseif IsStartOrRestPhase( EMC.PHASE) then
          -- carico le posizioni
          local dPosT = EgtGetInfo( nPrevOpeId, 'TPOS', 'd')
@@ -468,6 +462,7 @@ function OnPostApplyMachining()
             EMC.VDELTA = nil
          end
          EMC.HCING_IGNORE = true
+         EMC.CNT = nil
       else
          -- aggiornamento posizioni (da lavorazione precedente a disposizione)
          local nPrev2OpeId = EgtGetPrevActiveOperation( nPrevOpeId)
@@ -485,8 +480,8 @@ function OnPostApplyMachining()
          if #vAxes > 0 then EMC.TPOS = vAxes[1] end
          EMC.YDELTA = EgtGetInfo( nLastPathId, 'YDELTA', 'd')
          EMC.VDELTA = EgtGetInfo( nLastPathId, 'VDELTA', 'd')
+         EMC.CNT = nil
       end
-      EMC.CNT = nil
    -- altrimenti precedente operazione è lavorazione
    else
       -- aggiornamento posizioni
@@ -800,8 +795,10 @@ function SpecialCalcMachiningEncumbrance( nMchId, bPreCut)
    local nToolType = EgtTdbGetCurrToolParam( MCH_TP.TYPE)
    local bSaw = ( nToolType == MCH_TY.SAW_STD or nToolType == MCH_TY.SAW_FLAT)
    local bChain = ( nToolType == MCH_TY.MORTISE_STD)
+   local bAngTrasm = ( sHead == 'H5' or sHead == 'H6')
    local dTLen = EgtTdbGetCurrToolParam( MCH_TP.LEN)
    local dTDiam = EgtTdbGetCurrToolParam( MCH_TP.DIAM)
+   local dThLen = EgtTdbGetCurrToolThLength()
    -- Se sega a catena, devo correggere il versore Aux per farlo coincidere con la direzione del braccio C
    if bChain then
       if abs( vAxes[6] or 0) < 1 then
@@ -810,8 +807,14 @@ function SpecialCalcMachiningEncumbrance( nMchId, bPreCut)
          vtAux = vtTool ^ vtAux
       end
    end
+   -- Se rinvio da sotto, devo correggere il versore Aux per farlo coincidere con la direzione del braccio C
+   if bAngTrasm then
+      local nExit = EgtTdbGetCurrToolParam( MCH_TP.EXIT)
+      vtAux = vtTool ^ vtAux
+      if nExit == 2 then vtAux = -vtAux end
+   end
    -- Calcolo limiti derivanti dalla lavorazione
-   local dDistFront, dDistBack = SpecCalcEncumbrance( vtTool, vtAux, ptMin, ptMax, bSaw, bChain, dTLen, dTDiam)
+   local dDistFront, dDistBack = SpecCalcEncumbrance( vtTool, vtAux, ptMin, ptMax, bSaw, bChain, dTLen, dTDiam, dThLen)
    return dDistFront, dDistBack
 end
 
@@ -870,7 +873,7 @@ function GetFinalCutPmax( nMchId)
 end
 
 ---------------------------------------------------------------------
-function SpecCalcEncumbrance( vtTool, vtArm, ptMin, ptMax, bSaw, bChain, dTLen, dTDiam)
+function SpecCalcEncumbrance( vtTool, vtArm, ptMin, ptMax, bSaw, bChain, dTLen, dTDiam, dThLen)
    -- Quota in Z dal punto di inclinazione dei carrelli
    local dCompZ = sqrt( 1 - vtTool:getZ() * vtTool:getZ())
    local dZup = ptMin:getZ() - 0.5 * dCompZ * dTDiam - ( EMC.ZMIN + 130)
@@ -905,7 +908,7 @@ function SpecCalcEncumbrance( vtTool, vtArm, ptMin, ptMax, bSaw, bChain, dTLen,
       elseif abs( vtTool:getZ()) < 0.93 then
          if vtTool:getX() > 0 and abs( vtTool:getY()) < 0.2 and ptMax:getZ() > EMC.ZMIN + BD.VICE_MINH then
             dHeadBack = 180
-         elseif vtTool:getX() > -0.05 then
+         elseif vtTool:getX() > -0.06 then
             dHeadBack = 50 + 0.5 * dTDiam * sqrt( 1 - vtTool:getX() * vtTool:getX())
          elseif vtTool:getX() > -0.3 then
             dHeadBack = 250
@@ -963,7 +966,8 @@ function SpecCalcEncumbrance( vtTool, vtArm, ptMin, ptMax, bSaw, bChain, dTLen,
          dHeadBack = EgtIf( EMC.CNT == 1, 180, 130)
       end
       -- per interferenza con triangolo di rinforzo sulla pinza Y
-      if vtTool:getZ() < 0.25 and vtTool:getX() < 0.10 and vtTool:getY() < 0 and vtArm:getX() < -0.707 then
+      if ( vtTool:getZ() < 0.25 and vtTool:getX() < 0.10 and vtTool:getY() > 0 and vtArm:getX() < -0.707 and not BD.RIGHT_LOAD) or 
+         ( vtTool:getZ() < 0.25 and vtTool:getX() < 0.10 and vtTool:getY() < 0 and vtArm:getX() < -0.707 and BD.RIGHT_LOAD)then
          dHeadBack = dHeadBack + 90
       end
    end
@@ -995,7 +999,7 @@ function SpecCalcEncumbrance( vtTool, vtArm, ptMin, ptMax, bSaw, bChain, dTLen,
       elseif abs( vtTool:getZ()) < 0.93 then
          if vtTool:getX() < 0 and abs( vtTool:getY()) < 0.2 and ptMax:getZ() > EMC.ZMIN + BD.VICE_MINH then
             dHeadFront = 180
-         elseif vtTool:getX() < 0.05 then
+         elseif vtTool:getX() < 0.06 then
             dHeadFront = 50 + 0.5 * dTDiam * sqrt( 1 - vtTool:getX() * vtTool:getX())
          elseif vtTool:getX() < 0.3 then
             dHeadFront = 250
@@ -1054,8 +1058,13 @@ function SpecCalcEncumbrance( vtTool, vtArm, ptMin, ptMax, bSaw, bChain, dTLen,
          (( vtTool:getY() > 0 and ptHeadMin:getY() > 80) or ( vtTool:getY() < 0 and ptHeadMax:getY() < -EMC.SB - 80)) then
          dHeadFront = 130
       end
+      -- per forature di coda abbastanza lontane dai bordi pezzo in Y
+      if BD.ENABLE_TOOL_BETWEEN_VICES and not bChain and vtTool:getX() < -0.999 and ptHeadMax:getY() + dTDiam / 2 < -15 and ptHeadMin:getY() - dTDiam / 2 > -EMC.SB + 15 then
+         dHeadFront = - ( dTLen - dThLen - 15)
+      end
       -- per interferenza con triangolo di rinforzo sulla pinza V
-      if vtTool:getZ() < 0.25 and vtTool:getX() > -0.10 and vtTool:getY() < 0 and vtArm:getX() > 0.707 then
+      if ( vtTool:getZ() < 0.25 and vtTool:getX() > -0.10 and vtTool:getY() > 0 and vtArm:getX() > 0.707 and not BD.RIGHT_LOAD) or
+         ( vtTool:getZ() < 0.25 and vtTool:getX() > -0.10 and vtTool:getY() < 0 and vtArm:getX() > 0.707 and BD.RIGHT_LOAD) then
          dHeadFront = dHeadFront + 90
       end
    end
@@ -2549,7 +2558,7 @@ function SpecAdjustCarrB2( dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF, dVDelta
          dYDeltaA  = dYPosA - dTPosA 
          dVDeltaA  = dVPosA - dTPosA 
          -- aggiorno la verifica di spostamento significativo
-         bYDeltaS = ( dYDeltaF < dYDeltaA - dYDeltaTol  or  dYDeltaF > dYDeltaA + DELTA_SIC)
+         bYDeltaS = ( dYDeltaF < dYDeltaA - dYDeltaTol or  dYDeltaF > dYDeltaA + DELTA_SIC)
          bVDeltaS = ( dVDeltaF > dVDeltaA + dVDeltaTol  or  dVDeltaF < dVDeltaA - DELTA_SIC)
          -- aggiorno ExtraV residuo
          dExtraV = dExtraV - dCorsaYTr - dCorsaVr

Compile.bat

@@ -0,0 +1,38 @@
+
+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-FASTrl"
+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"
+
+REM copio i file compilati nel percorso temporaneo per i compilati
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Common-FAST.mlpe     		 	          -s Common-FAST.mlpe
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Common-FAST.mlse                        -s Common-FAST.mlse
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Common-FAST.NUM.mlpe                    -s Common-FAST.NUM.mlpe
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Common-FAST.NUM_PLUS.mlpe               -s Common-FAST.NUM_PLUS.mlpe
+\EgtProg\Dll32\luac54 -o %fullPathSource%\bin\%machineName%\Common-FAST.TPA.mlpe                    -s Common-FAST.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-FASTrl.mlde

@@ -9,12 +9,45 @@
 -- 2024/01/17 Ver.2.6a1 DS Aggiunta gestione BlockHouse come in FAST.
 -- 2024/02/09 Ver 2.6b1 LM In BeamData aggiunta funzione GetBlockedAxis che sostituisce la GetChainSawBlockedAxis.
 -- 2024/02/22 Ver 2.6b2 LM In mlse corretto calcolo pinzaggio quando testa vicina.
+-- 2024/02/23 ver 2.6c1 Rimossa chiamata funzione EgtGetSourceDir
+--                      Prima versione post common
+--                      Allineamento con common ver. 2.6c3
+-- 2024/02/23 ver 2.6c2 Aggiornamento BeamData per visualizzazione in simulazione
+-- 2024/02/27 ver 2.6c3 Allineamento con common ver. 2.6c4. Aggiunto parametro 'SafeXRotAxes' per rotazione motosega con pezzi alti
+--                      Parametro 'SecondSupport' gestito come intero
+-- 2024/02/29 ver 2.6c4 Allineamento con common ver. 2.6c4
+-- 2024/03/04 ver 2.6c5 Modificato log con nome macchina
+--                      Allineamento con common ver. 2.6c6
+-- 2024/03/12 ver 2.6c6 Allineamento con common ver. 2.6c7
+--                      Migliorie alla geometria macchina e suo caricamento
+-- 2024/03/28 ver 2.6d1 Allineamento con common ver. 2.6c8
+-- 2024/03/28 ver 2.6d2 Allineamento con common ver. 2.6d2
+-- 2024/04/30 ver 2.6e1 Allineamento con common ver. 2.6e1
+--                      Aggiunta variabile WoodDensity per gestione WOOD_DENSITY
+-- 2024/05/06 AV ver 2.6e2 Allineamento con common ver. 2.6e2
 
 require( 'EmtGenerator')
 EgtEnableDebug( false)
 
-PP_VER = '2.6b2'
+PP_VER = '2.6e2'
 MIN_MACH_VER = '2.5k1'
+MACH_NAME = 'Essetre-FASTrl'
+
+-- 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')
+local BD = require( 'BeamData')
+local 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 ( '** ' .. MACH_NAME..' '..PP_VER..' ** ( '..INFO_STD_PP.NAME..': '..INFO_STD_PP.VERSION..' - MinMach: '.. MIN_MACH_VER ..') **', 1)
 
 -- Parametri macchina
 NumericalControl = 'TPA'                                      -- NUM o TPA
@@ -40,6 +73,8 @@ SawOffs = -242.68
 SawBOffs = 0
 SawCOffs = 0
 ChSawLen = 90.0
+AngTr1Offs = 170
+AngTr1Len = 150
 TurnerOffs = 200.0
 DeltaTabY = -898.0
 DeltaTabZ = -1017.8 + MillOffs                 -- per TPA : -1013.3 + MillOffs    -- per NUM : -838.4
@@ -50,24 +85,22 @@ StartRotation = true
 AutomaticRotation = true
 AutoRotMinLen = 2600
 DefTcPos = 'T2'
-SecondSupport = false
+SecondSupport = 0
 SpecialBH = false
 MaxUnloadLen = 0
 BeamHeightForFixRot = 9999                     -- per abilitare assegnare 500
 CoeffVM = 0.5
+NewTopC = true
+SafeXRotAxes = -150
 
--- Aggiornamento con dati da BeamData.lua
-local sBeamData = EgtGetSourceDir().."\\Beam\\BeamData.lua"
-if EgtExistsFile( sBeamData) then
-   local BD = dofile( sBeamData)
-   if BD then
-      BeamHeightForFixRot = BD.MAX_HEIGHT_ROT_B_ABOVE or BeamHeightForFixRot
-   end
+-- leggo e aggiorno con parametri da BeamData
+if BD then
+   BeamHeightForFixRot = BD.MAX_HEIGHT_ROT_B_ABOVE or BeamHeightForFixRot
 end
 
 -- Aggiornamento con dati da TechnoEssetre7
 local sTs3Data = EgtGetStringFromIni( 'Beam', 'DATA_DIR', "C:\\TechnoEssetre7\\EgtData", EgtGetIniFile()).."\\Essetre-Fastrl.data"
-local sData = EgtGetSourceDir().."\\Beam\\Ts3Data.lua"
+local sData = sMachDir .. "\\Beam\\Ts3Data.lua"
 if EgtExistsFile( sTs3Data) then
    EgtCopyFile( sTs3Data, sData)
    local sTs3DataOld = sTs3Data..'.old'
@@ -97,19 +130,25 @@ if EgtExistsFile( sData) then
          if Machine.Offsets.YSCARICO then UnloadT = - Machine.Offsets.YSCARICO end
          if Machine.Offsets.PIVOTFRESA then MillOffs = - Machine.Offsets.PIVOTFRESA end
          if Machine.Offsets.PIVOTLAMA then SawOffs = - Machine.Offsets.PIVOTLAMA end
-         if Machine.Offsets.OFFSETBLAMA then SawBOffs= Machine.Offsets.OFFSETBLAMA end
-         if Machine.Offsets.OFFSETCLAMA then SawCOffs= Machine.Offsets.OFFSETCLAMA end
+         if Machine.Offsets.OFFSETBLAMA then SawBOffs = Machine.Offsets.OFFSETBLAMA end
+         if Machine.Offsets.OFFSETCLAMA then SawCOffs = Machine.Offsets.OFFSETCLAMA end
+         if Machine.Offsets.OFFSETZ_RINV_1 then AngTr1Offs = Machine.Offsets.OFFSETZ_RINV_1 - EgtIf( NumericalControl == 'TPA', MillOffs, 0) end
+         AngTr1Len = Machine.Offsets.OFFSETX_RINV_1 or AngTr1Len
+         --if Machine.Offsets.OFFSETZ_RINV_2 then AngTr2Offs = Machine.Offsets.OFFSETZ_RINV_2 - EgtIf( NumericalControl == 'TPA', MillOffs, 0) end
+         --AngTr2Len = Machine.Offsets.OFFSETX_RINV_2 or AngTr2Len
          TurnerOffs = Machine.Offsets.OFFSETRIB or TurnerOffs
-         if Machine.Offsets.OFFSETX then DeltaTabY = -Machine.Offsets.OFFSETX end
+         if Machine.Offsets.OFFSETX then DeltaTabY = - Machine.Offsets.OFFSETX end
          if Machine.Offsets.OFFSETZ then DeltaTabZ = Machine.Offsets.OFFSETZ + EgtIf( NumericalControl == 'TPA', MillOffs, 0) end
-         if Machine.Offsets.SECSUP then SecondSupport = ( Machine.Offsets.SECSUP == 1) end
+         if Machine.Offsets.SECSUP then SecondSupport = Machine.Offsets.SECSUP end
          if Machine.Offsets.BLOCKHAUS then SpecialBH = ( Machine.Offsets.BLOCKHAUS == 1) end
+         if Machine.Offsets.RIB_AUTO then AutomaticRotation = ( Machine.Offsets.RIB_AUTO == 1) end
          if Machine.Offsets.NOULOAD then MaxUnloadLen = Machine.Offsets.NOULOAD end
          if Machine.Offsets.DEFTCPOS then DefTcPos = ( 'T' .. Machine.Offsets.DEFTCPOS) end
+         if Machine.Offsets.WOOD_DENSITY then WoodDensity = Machine.Offsets.WOOD_DENSITY end
       end
    end
 end
-if SpecialBH then SecondSupport = false end
+if SpecialBH then SecondSupport = 0 end
 
 EmtGeneral {
       File='Essetre-FASTrl.nge',
@@ -119,8 +158,8 @@ EmtGeneral {
       ExitMaxAdjust = 30,
       ExitMaxRotAdj = 0.5,
       AngDeltaMinForHome = 165,
-      Special = 'Essetre-FASTrl.mlse',
-      Processor = 'Essetre-FASTrl.mlpe'}
+      Special = 'Common-FAST.mlse',
+      Processor = 'Common-FAST.mlpe'}
 local BaseId = EmtBase {
       Name = 'Base',
       Geo='BASE/GEO',
@@ -146,7 +185,7 @@ EmtAxis {
       Home = MaxZ,
       Geo = 'Z_AXIS/GEO',
       Aux = {'Z_AXIS/SOLID', 'Z_AXIS/COLLISION'}}
-EmtAxis {
+local CId = EmtAxis {
       Name = 'C',
       Parent = 'Z',
       Type = MCH_AT.ROTARY,
@@ -156,6 +195,24 @@ EmtAxis {
       Home = 0,
       Geo = 'C_AXIS/GEO',
       Aux = {'C_AXIS/SOLID', 'C_AXIS/COLLISION'}}
+if NewTopC then
+   local vtMove = Vector3d( 65,0,0)
+   local SolidArmId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( CId, 'SOLID'), 'ARM')
+   if EgtSurfTmMoveFacet then
+      EgtSurfTmMoveFacet( SolidArmId, 11, vtMove, GDB_RT.GLOB)
+   else
+      EgtSurfTmMoveVertex( SolidArmId, 23, EgtSurfTmGetVertex( SolidArmId, 23, GDB_RT.GLOB) + vtMove, GDB_RT.GLOB)
+      EgtSurfTmMoveVertex( SolidArmId, 25, EgtSurfTmGetVertex( SolidArmId, 25, GDB_RT.GLOB) + vtMove, GDB_RT.GLOB)
+      EgtSurfTmMoveVertex( SolidArmId, 35, EgtSurfTmGetVertex( SolidArmId, 35, GDB_RT.GLOB) + vtMove, GDB_RT.GLOB)
+      EgtSurfTmMoveVertex( SolidArmId, 36, EgtSurfTmGetVertex( SolidArmId, 36, GDB_RT.GLOB) + vtMove, GDB_RT.GLOB)
+   end
+   local CollTopId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( CId, 'COLLISION'), 'TOP')
+   EgtMove( CollTopId, vtMove, GDB_RT.GLOB)
+   EgtSetName( CollTopId, 'BOX')
+else
+   local CollTopId = EgtGetFirstNameInGroup( EgtGetFirstNameInGroup( CId, 'COLLISION'), 'TOP')
+   EgtSetName( CollTopId, 'BOX')
+end
 EmtAxis {
       Name = 'B',
       Parent = 'C',
@@ -378,7 +435,7 @@ else
          ADir = Z_AX(),
          Geo = 'BASE/T101S'}
 end
-if SecondSupport then
+if SecondSupport == 1 then
    EmtTcPos {
          Name = 'T111',
          Parent = 'Base',

UpdateLog.txt

@@ -0,0 +1,50 @@
+           ==== Common_FAST Update Log ====
+
+Versione 2.6e2 (06/05/2024)
+- (SIM-GEN) Modificata tolleranza calcolo ingombri lavorazioni per posizionamento pinze. Ticket#1790
+
+Versione 2.6e1 (30/04/2024)
+- (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 (18/04/2024)
+- (SIM-GEN) In MLSE, quando c'è una rotazione, viene settato EMT.CNT=1 per considerare i 50mm di compensazione laser.
+- (SIM) Nel file di log dove c'è stampa gruppi di collisione, viene scritto anche ID del gruppo
+
+Versione 2.6d1 (15/04/2024)
+- (GEN) Aggiunta gestione aggregato doppia uscita per controllo NUM_PLUS
+- (GEN) Con aggregato con si possono fare archi, se OnArc con aggregato, dà errore.
+- (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)
+
+Versione 2.6c8 (28/03/2024)
+- (MLSE) Possibilità di lavorazione da X- tra le pinze, se abilitata da flag (User.ENABLE_TOOL_BETWEEN_VICES == 1).
+- (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
+
+Versione 2.6c7 (12/03/2024)
+- (SIM) Miglioramento visualizzazione spigoli VMILL alla fine della simulazione. Funzione: EgtVolZmapSetShowEdges. N.B.= serve CAM5 2.6c2 NON OBBLIGATORIO
+- (GEN) Corretto problema di movimento pinze assieme a discesa asse Z (Ticket #1710)
+
+Versione 2.6c6 (04/03/2024)
+- (MLDE-GEN) Aggiunta variabile 'MACH_NAME' in MLDE con nome macchina
+
+Versione 2.6c5 (29/02/2024)
+- (GEN) Aggiunto comando di wait fine M101/G101 in caso di movimento in zona sicurezza per motosega
+- (GEN) Gestione accelerazioni pinze in M115 ( solo per TPA)
+- (SIM) Gestione rimozione VMILL per tagli a cubetti a zig-zag
+
+Versione 2.6c4 (27/02/2024)
+- (MLDE-SIM-GEN) Con pezzi molto alti '> BeamHeightForFixRot', aggiunto parametro 'SafeXRotAxes' per ruotare motosega in zona sicura lontano dal pezzo
+- (SIM) Nelle funzioni movimentaizone assi, utilizzate costanti 'MCH_SIM_STEP'
+
+Versione 2.6c3 (23/02/2024)
+- (SIM) Corretta lettura parametro RIGHT_LOAD 
+- (SIM-GEN) Rimossa chiamata funzione EgtGetSourceDir rimasta in MLPE
+
+Versione 2.6c2 (23/02/2024)
+- (SIM-GEN) Rimossa chiamata funzione EgtGetSourceDir
+
+Versione 2.6c1 (23/02/2024)
+- (SIM-GEN) Prima versione post-proc comune FAST e FASTrl
+- (SIM-GEN) "BeamData" caricato come libreria con 'require' anziché come file con 'dofile'
+- (SIM) Aggiunta funzioni "OnSimulInit" e "OnSimulExit" per orientare vista corretta in caso di macchina con carico destro. N.B.= serve CAM5 2.6b4
+- (SIM-GEN) In BeamData aggiunto flag per direzione carico RIGHT_LOAD
+- (SIM-GEN) Aggiornamento 'Compile.bat' con nuovi nomi file

Version.lua

@@ -0,0 +1,10 @@
+-- Version.lua by EgalWare s.r.l. 2024/03/28
+-- Gestione della versione dei file comuni post-processori macchine FAST e FASTrl di Essetre
+
+local InfoCommon_STD_PP = {
+   NAME = 'Common-FAST',            -- nome script PP standard
+   VERSION = '2.6e2',                 -- versione script
+   MIN_MACH_VER_PP_COMMON = '2.5k1'   -- versione minima kernel
+}
+
+return InfoCommon_STD_PP