Piccola correzione nei movimenti newlink

- Modificato movimento di discesa in Z con lama dopo cambio UT in caso di C negativa e movimento di B

Common_PF1250.mlse

@@ -1,4 +1,4 @@
--- Special Operations macchina Essetre-PF1250 by Egalware s.r.l.  2024/04/09
+-- Special Operations macchina Essetre-PF1250 by Egalware s.r.l.  2025/08/25
 -- Intestazioni
 
 require( 'EmtGenerator')
@@ -68,194 +68,342 @@ function OnSpecialGetPrevMachiningOffset()
 end
 
 ---------------------------------------------------------------------
--- *** Special Z moves ***
+-- *** Special Link moves ***
 ---------------------------------------------------------------------
----------------------- OnSpecialGetMaxZ -----------------------------
-local function CalcExtraZ( vtTp, vtT, vMZ)
-   -- la tabella deve esistere ed essere non vuota
-   if not vMZ or #vMZ == 0 then return 0 end
-   -- componente Z di riferimento è la minima
-   local vtTz = min( vtTp:getZ(), vtT:getZ())
-   -- se oltre il massimo
-   if vtTz > vMZ[1].Tz then return vMZ[1].Ez end
-   -- interpolo
-   for i = 2, #vMZ do
-      if vtTz > vMZ[i].Tz then
-         local dCoeff = ( vtTz - vMZ[i-1].Tz) / ( vMZ[i].Tz - vMZ[i-1].Tz) 
-         return (( 1 - dCoeff) * vMZ[i-1].Ez + dCoeff * vMZ[i].Ez)
-      end
+-----------------------------------------------------------------------------------------
+local function IsPrevSplit()
+   local sPrevUserNotes = ''
+   if EMC.LINKTYPE == 2 then
+      sPrevUserNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
+   elseif EMC.LINKTYPE == 3 then
+      EgtSetCurrMachining( EMC.PREVMCHID)
+      sPrevUserNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
+      EgtSetCurrMachining( EMC.NEXTMCHID)
    end
-   -- sotto il minimo
-   return 0
+   return ( sPrevUserNotes:find( 'Split;', 1, true) ~= nil)
 end
 
----------------------------------------------------------------------
-function OnSpecialGetMaxZ()
-   -- Inizializzazioni
-   EMC.ERR = 0
-
-   -- Gestione speciale per sega a catena
-   if EMC.HEAD == 'H13' then
-      EMC.MAXZ = EgtGetAxisHomePos( 'Z1')
-      return
-   end
-
-   -- Sistemazione dati di input
-   local vtTp = Vector3d( EMC.TDIRp)
-   local bFromZmax = false
-   -- recupero il gruppo
-   local nSetHead = GetHeadSet( EMC.HEAD)
-   if vtTp:isSmall() then
-      vtTp = X_AX()
-      bFromZmax = true
-      if nSetHead == 1 then
-         EMC.R1p = ParkC1
-         EMC.R2p = ParkB1
-      elseif nSetHead == 2 then
-         EMC.R1p = ParkC2
-         EMC.R2p = ParkB2
-      elseif nSetHead == 3 then
-         EMC.R1p = ParkC3
-         EMC.R2p = ParkB3
-      end
-   end
-   local vtT = Vector3d( EMC.TDIR)
-   local vtTpZm = EgtIf( bFromZmax, vtT, vtTp)
-   local bBSameSign = (( EMC.R2p < 10 and EMC.R2 < 10) or ( EMC.R2p > -10 and EMC.R2 > -10))
-
-   -- Calcolo in funzione della testa e dei parametri
-   if EMC.HEAD == 'H11' then
-      if bBSameSign and vtTp:getX() > -0.1 and vtT:getX() > -0.1 then
-         EMC.MAXZ = MaxZ1
-      else
-         local vMZ = {{ Tz=0.85, Ez=390}, { Tz=0.5, Ez=280}, { Tz=-0.01, Ez=160}}
-         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
-      end
-   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 = 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
-         elseif vtTp:getZ() > 0.5 or vtT:getZ() > 0.5 then
-            EMC.MAXZ = ParkZ1 + 100
-         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 = 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)
-      else
-         local vMZ = {{ Tz=0.85, Ez=400}, { Tz=0.7, Ez=300}, { Tz=0.5, Ez=195}, { Tz=0.15, Ez=60}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
-         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
-      end
-   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 = 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
-         elseif vtTp:getZ() > 0.5 or vtT:getZ() > 0.5 then
-            EMC.MAXZ = ParkZ1 + 100
-         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 = 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)
-      else
-         local vMZ = {{ Tz=0.85, Ez=400}, { Tz=0.7, Ez=300}, { Tz=0.5, Ez=195}, { Tz=0.15, Ez=60}, { Tz=-0.01, Ez=5}, { Tz=-0.5, Ez=1}}
-         EMC.MAXZ = ParkZ1 + CalcExtraZ( vtTpZm, vtT, vMZ)
-      end
-   elseif EMC.HEAD == 'H21' then
-      if bBSameSign and vtTp:getX() > -0.1 and vtT:getX() > -0.1 then
-         EMC.MAXZ = MaxZ2
-      else
-         local vMZ = {{ Tz=0.85, Ez=390}, { Tz=0.5, Ez=280}, { Tz=-0.01, Ez=160}}
-         EMC.MAXZ = ParkZ2 + CalcExtraZ( vtTpZm, vtT, vMZ)
-      end
-   elseif EMC.HEAD == 'H38' then
-      EMC.MAXZ = SafeZ3RotAxis
+-----------------------------------------------------------------------------------------
+local function GetActiveRawBBox()
+   local b3Raw = BBox3d()
+   local nRawId = EgtGetFirstRawPart()
+   while nRawId do
+      if EgtVerifyRawPartPhase( nRawId, EMC.PHASE) then
+         b3Raw = EgtGetRawPartBBox( nRawId)
+         break
+      end
+      nRawId = EgtGetNextRawPart( nRawId)
    end
+   return b3Raw
 end
 
----------------------- OnSpecialMoveZup -----------------------------
-function OnSpecialMoveZup()
+-----------------------------------------------------------------------------------------
+local function IsLinkSafety( vtFinal, vtInit)
+   local bSafeMove = true
+   local DirectionsToTest = { {vtInit[3],vtInit[4], vtInit[5]}, {vtFinal[3],vtFinal[4], vtFinal[5]}}
 
-   --EgtOutLog( 'OnSpecialMoveZup : ' .. EMC.HEAD .. '.' .. tostring( EMC.EXIT))
+   -- aggiungo anche il punto medio
+   table.insert( DirectionsToTest, {(vtInit[3]+vtFinal[3])/2,(vtInit[4]+vtFinal[4])/2,(vtInit[5]+vtFinal[5])/2})
 
-   -- Inizializzazioni
-   EMC.ERR = 0
-   EMC.MODIF = false
-
-   -- Direzione utensile
-   local vtT = Vector3d( EMC.TDIR)
-
-   -- recupero Z1 home
-   local nHeadSet = GetHeadSet( EMC.HEAD)
-   local dZmax = EgtGetAxisHomePos( EgtIf( nHeadSet ~= 2, 'Z1', 'Z2'))
-
-
-   -- se fresa su testa1 o testa 2
-   if EMC.HEAD == 'H11' or EMC.HEAD == 'H21' or EMC.HEAD == 'H22' then
-      ;
-   -- se lama
-   elseif EMC.HEAD == 'H12' or EMC.HEAD == 'H16' then
-      -- riporto i valori tra -179 e + 180
-      local dCheckAxR1 = EMC.R1
-      if dCheckAxR1 < -180 then
-         dCheckAxR1 = dCheckAxR1 + 360
-      elseif dCheckAxR1 > 180 then
-         dCheckAxR1 = dCheckAxR1 - 360
-      end
-      -- se lama su testa1
+   for t=1, #DirectionsToTest do
+      local vtToolDir = EgtGetCalcToolDirFromAngles( DirectionsToTest[t][2], DirectionsToTest[t][3])
+      -- se lama su aggregato
       if EMC.HEAD == 'H12' then
-         -- se inclinata oltre 90 gradi e interferisce con la trave
-         if ( EMC.R2 > 87.9 and ( dCheckAxR1 < 15.0 or dCheckAxR1 > 180.0)) or ( EMC.R2 < -87.9 and ( dCheckAxR1 > -15.0 and dCheckAxR1 < 180.0)) then
-            local dZref = dZmax + min( 330 * vtT:getZ(), 0) + 260 * ( 1 - sqrt( 1- vtT:getZ() * vtT:getZ()))
-            -- se troppo in alto
-            if EMC.L3 > dZref + 1 then
-               ---- sistemo asse rotante
-               --EMC.R2 = EgtIf( ( EMC.R2 > 0), 90, -90)
-               ---- ricalcolo versore utensile
-               --EMC.TDIR = EgtGetCalcToolDirFromAngles( EMC.R1, EMC.R2)
-               ---- porto alla giusta quota
-               --EMC.L3 = dZmax
-               EMC.L3 = dZref
-               -- dichiaro modificato
-               EMC.MODIF = true
-            end
-         end
-      -- se seconda lama su testa1
-      elseif EMC.HEAD == 'H16' then
-         -- se inclinata oltre 90 gradi e interferisce con la trave
-         if ( EMC.R2 > 87.9 and ( dCheckAxR1 < 15.0 or dCheckAxR1 > 180.0)) or ( EMC.R2 < -87.9 and ( dCheckAxR1 > -15.0 and dCheckAxR1< 180.0)) then
-            local dZref = dZmax + min( 330 * vtT:getZ(), 0) + 260 * ( 1 - sqrt( 1- vtT:getZ() * vtT:getZ()))
-            -- se troppo in alto
-            if EMC.L3 > dZref + 1 then
-               ---- sistemo asse rotante
-               --EMC.R2 = EgtIf( ( EMC.R2 > 0), 90, -90)
-               ---- ricalcolo versore utensile
-               --EMC.TDIR = EgtGetCalcToolDirFromAngles( EMC.R1, EMC.R2)
-               ---- porto alla giusta quota
-               --EMC.L3 = dZmax
-               EMC.L3 = dZref
-               -- dichiaro modificato
-               EMC.MODIF = true
+         if vtToolDir:getX() < 0.342 then
+            local dLen = SawOffsZ - MillOffs
+            local dToolRadius = 275 -- leggere dall'utensile!!
+            local dDeltaMaxZ = dToolRadius - ( dToolRadius * sin( DirectionsToTest[t][3]) + dLen * cos( DirectionsToTest[t][3]))
+            local dMaxZ = ParkZ1 + dDeltaMaxZ
+            if dMaxZ < DirectionsToTest[t][1] then
+               bSafeMove = false
+               break
             end
          end
       end
-   elseif EMC.HEAD == 'H38' then
-      EMC.L3 = SafeZ3RotAxis
-      -- dichiaro modificato
-      EMC.MODIF = true
-   else
-      ; -- non si fa nulla
    end
+
+   return bSafeMove
+end
+
+-----------------------------------------------------------------------------------------
+function OnSpecialLink()
+
+   -- se fresa su testa 1
+   if EMC.HEAD == 'H11' then
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, 0}, 30, 2, 2)
+            if abs( EMC.R1 - EMC.R1p) > 1 then
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, 0}, 30, 2, 2)
+            end
+         end
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, 0}, 30, 3, 2, 'FirstRise=1;')
+            if abs( EMC.R1 - EMC.R1p) > 1 then
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, 0}, 30, 3, 2)
+            end
+         else
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2p}, 30, 3, 2, 'FirstRise=1;')
+         end
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+
+      -- altrimenti collegamento tra due lavorazioni (3)
+      else
+         -- recupero quota massima di collegamento
+         local vLFiAx = EmtGetFinalAxesPos( EMC.PREVMCHID, EMC.PREVMAIN, false)
+         local vLInAx = EmtGetInitialAxesPos( EMC.NEXTMCHID, EMC.NEXTMAIN, false)
+         -- se superata quota massima ammessa
+         if max( vLFiAx[3], vLInAx[3]) > ParkZ1 + 1 then
+            -- retrazione
+            EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, MaxZ1, EMC.R1p, 0}, 30, 3, 2, 'UniqueRise=1;')
+            -- approccio
+            EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, MaxZ1, EMC.R1, 0}, 30, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+         end
+      end
+
+   -- se lama su rinvio standard o opposto di testa 1
+   elseif EMC.HEAD == 'H12' or EMC.HEAD == 'H16' then
+      -- recupero se split da note utente di lavorazione precedente
+      local bSplit = IsPrevSplit()
+
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+
+         -- se solo in zmax
+         if EMC.STARTZMAX > 0 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, 0}, 30, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, 0}, 30, 2, 2)
+         else
+            -- altrimenti discesa diretta
+            if abs( EMC.R1 - EMC.R1p) < 10 and abs( EMC.R2 - EMC.R2p) < 90 then
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+            -- se assi cambiano di molto
+            else
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, 0}, 30, 2, 2)
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, 0}, 30, 2, 2)
+            end
+         end
+
+         if abs( EMC.R2) > 75 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, ParkZ1, EMC.R1, EgtClamp( EMC.R2, -90, 90)}, 30, 2, 2)
+         end
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, 0}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+            if EMC.STARTZMAX > 0 then
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, 0}, 30, 3, 2, 'LastRise=1;')
+            else
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, 0}, 30, 3, 2)
+               EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+            end
+         else
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2p}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'UniqueRise=1;')
+         end
+
+      -- altrimenti collegamento tra due lavorazioni (3)
+      else
+         -- TODO
+         -- 1)   se il pezzo si allontana dalla testa, si muove prima il pezzo e poi la testa
+         --      se il pezzo si avvicina alla testa, prima la testa e poi il pezzo
+         -- 2)   per capire se ruotando ci passiamo, si può verificare il punto iniziale, quello finale , e un punto a metà. Se tutti non in collisione, si va diretti.
+
+
+         -- recupero quota massima di collegamento
+         local vtFinalAxLink = EmtGetFinalAxesPos( EMC.PREVMCHID, EMC.PREVMAIN, false)
+         local vtInitAxLink = EmtGetInitialAxesPos( EMC.NEXTMCHID, EMC.NEXTMAIN, false)
+         local bSafeMove = IsLinkSafety( vtFinalAxLink, vtInitAxLink)
+         -- se superata quota massima ammessa
+         if not bSafeMove then
+            -- retrazione
+            EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+            if abs( EMC.R2) > 91 then
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1p, EMC.L2p, ParkZ1, EMC.R1p, EgtClamp( EMC.R2, -90, 90)}, 30, 2, 2)
+            end
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, MaxZ1Blade, EMC.R1p, 0}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, MaxZ1Blade, EMC.R1p, 0}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'LastRise=1;')
+            -- approccio
+            EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, MaxZ1Blade, EMC.R1, 0}, 30, 2, 2, 'FirstClimb=1;')
+            if abs( EMC.R2) > 91 then
+               EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, ParkZ1, EMC.R1, EgtClamp( EMC.R2, -90, 90)}, 30, 2, 2)
+            end
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+         end
+      end
+
+   -- se sega a catena su testa 1
+   elseif EMC.HEAD == 'H13' then
+      -- recupero se split da note utente di lavorazione precedente
+      local bSplit = IsPrevSplit()
+
+       -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, EMC.R2p, EMC.R3p}, 30, 2, 2, 'FirstClimb=1;')
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, EMC.R2, EMC.R3}, 30, 2, 2)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2, EMC.R3}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2, EMC.R3p}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2, EMC.R3p}, 30, 3, 2, 'LastRise=1;')
+      -- altrimenti collegamento tra due lavorazioni (3)
+      else
+      end
+
+
+   -- se aggregato foratore multiplo su testa 1
+   elseif EMC.HEAD == 'H14' then
+
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, 0}, 30, 2, 2)
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, 0}, 30, 2, 2, 'LastClimb=1;')
+         else
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'UniqueClimb=1;')
+         end
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, 0, EMC.R3}, 30, 3, 2, 'FirstRise=1;')
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, 0, EMC.R3}, 30, 3, 2)
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2, EMC.R3}, 30, 3, 2, 'LastRise=1;')
+         else
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2, EMC.R3}, 30, 3, 2, 'UniqueRise=1;')
+         end
+      end
+
+   -- se fresa su testa 2
+   elseif EMC.HEAD == 'H21' then
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, SafeX2RotAxis, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1, EMC.R2}, 30, 2, 2)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2p}, 30, 3, 2, 'FirstRise=1;')
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, SafeX2RotAxis, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+      end
+
+   -- se lama su testa 2
+   elseif EMC.HEAD == 'H22' then
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+         EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 2, 2, 'LastClimb=1;')
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1p, EMC.R2p}, 30, 3, 2, 'FirstRise=1;')
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+      end
+
+   -- se lama su testa 3
+   elseif EMC.HEAD == 'H38' then
+      -- sicurezza aggiuntiva
+      local SAFE_DIST = 50
+      local dExtraDist = EgtTdbGetCurrToolParam( MCH_TP.TOTDIAM) / 2 + SAFE_DIST
+      -- recupero se split da note utente di lavorazione precedente
+      local bSplit = IsPrevSplit()
+      -- recupero ingombro del primo grezzo in lavoro
+      local b3Raw = GetActiveRawBBox()
+      local dMinRawX3 = b3Raw:getMin():getY() - Head3Y
+      local dMaxRawX3 = b3Raw:getMax():getY() - Head3Y
+      local dMidRawX3 = ( dMinRawX3 + dMaxRawX3) / 2
+
+      -- se inizio lavorazione con prelievo utensile
+      if EMC.LINKTYPE == 1 then
+         -- approccio
+         EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+         local dSafeX3 = EgtIf( EMC.L2 < dMidRawX3, dMinRawX3 - dExtraDist, dMaxRawX3 + dExtraDist)
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, dSafeX3, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'FirstClimb=1;')
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, dSafeX3, SafeZ3RotAxis, EMC.R1p, EMC.R2p}, 30, 2, 2)
+            -- deve muoversi anche la trave (la lama non è abbastanza alta in Z) quindi Mask = 31
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, dSafeX3, SafeZ3RotAxis, EMC.R1, EMC.R2}, 31, 2, 2, 'LastClimb=1;')
+         else
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, dSafeX3, EMC.L3p, EMC.R1p, EMC.R2p}, 30, 2, 2, 'UniqueClimb=1;')
+         end
+
+      -- se fine lavorazione con deposito utensile
+      elseif EMC.LINKTYPE == 2 then
+         -- retrazione
+         EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+         local dSafeX3 = EgtIf( EMC.L2p < dMidRawX3, dMinRawX3 - dExtraDist, dMaxRawX3 + dExtraDist)
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, dSafeX3, SafeZ3RotAxis, EMC.R1p, EMC.R2p}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+         if abs( EMC.R1 - EMC.R1p) > 1 or abs( EMC.R2 - EMC.R2p) > 1 then
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, dSafeX3, SafeZ3RotAxis, EMC.R1, EMC.R2}, 30, 3, 2)
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, dSafeX3, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2)
+         end
+         EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2, EMC.L3, EMC.R1, EMC.R2}, 30, 3, 2, 'LastRise=1;')
+
+      -- altrimenti collegamento tra due lavorazioni (3)
+      else
+         -- recupero quota massima di collegamento
+         local vLFiAx = EmtGetFinalAxesPos( EMC.PREVMCHID, EMC.PREVMAIN, false)
+         local vLInAx = EmtGetInitialAxesPos( EMC.NEXTMCHID, EMC.NEXTMAIN, false)
+         -- se superata quota massima ammessa
+         if max( vLFiAx[3], vLInAx[3]) > SafeZ3RotAxis + 1 then
+            -- retrazione
+            EmtRemoveRise( EMC.PREVMCHID, EMC.PREVMAIN)
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, SafeZ3RotAxis, EMC.R1p, EMC.R2p}, 30, 3, 2, EgtIf( bSplit, 'Split=1;', '')..'FirstRise=1;')
+            EmtAddRise( EMC.PREVMCHID, EMC.PREVMAIN, { EMC.L1p, EMC.L2p, SafeZ3RotAxis, EMC.R1p, 0}, 30, 3, 2, 'LastRise=1;')
+            -- approccio
+            EmtRemoveClimb( EMC.NEXTMCHID, EMC.NEXTMAIN)
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, SafeZ3RotAxis, EMC.R1, 0}, 30, 2, 2, 'FirstClimb=1;')
+            -- se non split deve muoversi anche la trave (la lama non è abbastanza alta in Z) quindi Mask = 31
+            EmtAddClimb( EMC.NEXTMCHID, EMC.NEXTMAIN, { EMC.L1, EMC.L2, SafeZ3RotAxis, EMC.R1, EMC.R2}, EgtIf( bSplit, 30, 31), 2, 2, 'LastClimb=1;')
+         end
+      end
+   -- testa con truciolatore su testa 3
+   elseif EMC.HEAD == 'H39' then
+      ;
+   end
+
+   EMC.ERR = 0
 end
 
 ---------------------------------------------------------------------
@@ -402,7 +550,7 @@ end
 local function EmitComment( vCmd, sOut)
    EgtOutLog( ' ' .. sOut, 1)
    if Test then
-      table.insert( vCmd, { 0, sOut})  
+      table.insert( vCmd, { 0, sOut})
    end
 end
 
@@ -601,6 +749,14 @@ function OnSpecialApplyMachining()
    -- Inizializzo codice di errore
    EMC.ERR = 0
 
+   EMC.ZMAX = false
+
+   -- Verifico flag di separazione e fase di scarico
+   local sNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
+   local sPrevTool, dPrevValR3
+
+   sNotes = EgtSetValInNotes( sNotes, 'StartZmax')
+
    -- Recupero la posizione della trave e dei carrelli al termine della precedente operazione
    local nPrevOpeId = EgtGetPrevActiveOperation( EMC.MCHID)
    -- se precedente operazione non esiste, errore
@@ -659,6 +815,18 @@ function OnSpecialApplyMachining()
       EMC.V1POS = EgtIf( bAtZMax, ParkV1, EgtGetInfo( nLastPathId, 'V1POS', 'd') or ParkV1)
       EMC.V2POS = EgtIf( bAtZMax, ParkV2, EgtGetInfo( nLastPathId, 'V2POS', 'd') or ParkV2)
       EMC.CNT = SpecGetCNT( EMC.MCHID)
+      if vAxes[6] then
+         -- imposto lavorazione e utensile correnti
+         EgtSetCurrMachining( nPrevOpeId)
+         dPrevValR3 = vAxes[6]
+         local sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+         if not sTool then
+            local sTuuid = EgtGetMachiningParam( MCH_MP.TUUID)
+            sTool = EgtTdbGetToolFromUUID( sTuuid) or ''
+         end
+         sPrevTool = sTool
+         EgtSetCurrMachining( EMC.MCHID)
+      end
    end
 
    -- Verifico se ultima lavorazione della fase
@@ -666,7 +834,7 @@ function OnSpecialApplyMachining()
    local bMchLast = ( not nNextOpeId  or  EgtGetOperationPhase( nNextOpeId) ~= EMC.PHASE)
 
    -- Verifico flag di separazione e fase di scarico
-   local sNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
+   sNotes = EgtGetMachiningParam( MCH_MP.USERNOTES)
 
    -- bPreSplit sempre a falso per obbligare a pinzare il pezzo con 1 morsa anche se iniziato il taglio che dividerà grezzo e finito (in genere per sezioni grandi con 2 tagli di lama)
    -- Tra un taglio e l'altro infatti c'e' inversione del braccio e quindi un'apertura delle rulliere. Se pinzano entrambe le pinze, potrebbero esserci problemi di collisone rulli-morse
@@ -742,8 +910,30 @@ function OnSpecialApplyMachining()
       local nLastEntId = EgtGetLastInGroup( EMC.PATHID)
       local vAxes = EmtGetAxesPos( nLastEntId)
       if #vAxes > 0 then EMC.TPOS = vAxes[1] end
+      -- controllo se serve cambiare la presa
+      if vAxes[6] and dPrevValR3 then
+         local sTool = EgtGetMachiningParam( MCH_MP.TOOL)
+         if not sTool then
+            local sTuuid = EgtGetMachiningParam( MCH_MP.TUUID)
+            sTool = EgtTdbGetToolFromUUID( sTuuid) or ''
+         end
+         -- se stesso utensile ma cambia la presa dell'aggregato
+         if sTool == sPrevTool and  abs( dPrevValR3 - vAxes[6]) > 10 * GEO.EPS_SMALL then
+            EMC.CHANGETAKE = true
+         end
+      end
    end
 
+   -- Se richiesto movimento preliminare della testa a Zmax perchè c'è stato un riposizionamento delle pinze
+   if EMC.ZMAX then
+      sNotes = EgtSetValInNotes( sNotes, 'StartZmax', 11)
+      EgtSetMachiningParam( MCH_MP.USERNOTES, sNotes)
+   end
+
+   if EMC.CHANGETAKE then
+      sNotes = EgtSetValInNotes( sNotes, 'StartZmax', 12)
+      EgtSetMachiningParam( MCH_MP.USERNOTES, sNotes)
+   end
 end
 
 ---------------------------------------------------------------------
@@ -886,12 +1076,6 @@ function SpecApplyPath( bPreSplit, bSplitting, bPreCut, bCutting, bUnload)
       if  not EMC.Y2DELTA  then
          EgtOutLog( '  Warning SPLITTING -> separazione con caduta pezzo')
          SpecOutputCNT()
-         -- non funziona ma servirebbe un controllo simile, di modo che non possa avvenire la presenza di un pezzo "FALL" più grande di LEN_VERY_SHORT_PART
-         --if EMC.LT > LEN_VERY_SHORT_PART then
-         --   EMC.ERR = 19
-         --   EMC.MSG = '  Error SPLIT : Y1 or Y2 not clamped'
-         --   return false
-         --end
          if IsEndPhase( EMC.PHASE + 1) then
             EgtSetInfo( NextDispId, 'SKIP', '1')
             local NextOpeId = EgtGetNextOperation( NextDispId) 
@@ -2172,6 +2356,7 @@ function SpecAdjustCarrA( WorkTab)
       -- eseguo eventuale posizionamento sicuro di teste e rulli
       if WorkTab.bCloseV then
          EnsureZmax( true, vCmd)
+         EMC.ZMAX = true
          MyMinY1V1 = EgtIf( EMC.CNT == 1, MinY1 + AggLoad, MinY1)
          MaxY2V2 = MaxY2
       end
@@ -2277,6 +2462,7 @@ function SpecAdjustCarrB1( WorkTab)
    -- ------------------------------------------
    if WorkTab.bCloseV then
       EnsureZmax( true, vCmd)
+      EMC.ZMAX = true
       MyMinY1V1 = EgtIf( EMC.CNT == 1, MinY1 + AggLoad, MinY1)
       MaxY2V2 = MaxY2
    end
@@ -2348,6 +2534,7 @@ function SpecAdjustCarrB2( WorkTab)
    -- eseguo eventuale posizionamento sicuro di teste e rulli
    if WorkTab.bCloseV then
       EnsureZmax( true, vCmd)
+      EMC.ZMAX = true
       MyMinY1V1 = EgtIf( EMC.CNT == 1, MinY1 + AggLoad, MinY1)
       MaxY2V2 = MaxY2
    end
@@ -2418,6 +2605,7 @@ function SpecAdjustCarrC( WorkTab)
       -- eseguo eventuale posizionamento sicuro di teste e rulli
       if WorkTab.bCloseV then
          EnsureZmax( true, vCmd)
+         EMC.ZMAX = true
          MyMinY1V1 = EgtIf( EMC.CNT == 1, MinY1 + AggLoad, MinY1)
          MaxY2V2 = MaxY2
       end

Essetre-PF1250.ini

@@ -35,6 +35,7 @@ Mortising=1
 Chiseling=0
 SawRoughing=0
 SawFinishing=0
+DrillingDoubleNT=1
 
 [Machining]
 InitScript=InitMach.lua
@@ -65,4 +66,3 @@ WinPlace=0,514,138,628,810
 [VMill]
 Enable=1
 Save=0
-

Essetre-PF1250.mlde

@@ -28,7 +28,7 @@
 
 -- Intestazioni
 require( 'EmtGenerator')
-EgtEnableDebug( false)
+EgtEnableDebug( true)
 
 PP_VER = '3.1c1'
 PP_NVER = '3.1.3.1'
@@ -96,8 +96,9 @@ SawB2Offs = 0
 MinX1 = 0
 MaxX1 = 3300
 MinZ1 = -1550
-MaxZ1 = 0
+MaxZ1 = -50
 MaxZ1Blade = -100
+MaxZ1LongTool = -200
 MinC1 = -275
 MaxC1 = 275
 MinB1 = -127
@@ -289,6 +290,7 @@ EmtGeneral {
       ExitMaxRotAdj = 0.5,
       AngDeltaMinForHome = 80,
       LinkAxesMoveOrder = MCH_LKAMO.HEAD_BEFORE_IF_SAME_ANG,
+      NewLinkMgr = 1,
       Special = 'Common_PF1250.mlse',
       Processor = 'Common_PF1250.mlpe'}
 -- in base alla corsa macchina, si carica la rulliera di carico/scarico appropriata
@@ -861,12 +863,12 @@ function OnSetHead()
       end
       EmtModifyAxisStroke( 'Z1', {MinZ1, MaxZ1})
       if EMC.TOTLEN < LongTool then
-         EmtModifyAxisHome( 'Z1', ParkZ1)
+         EmtModifyAxisHome( 'Z1', MaxZ1)
          EmtModifyAxisStroke( 'C1', {MinC1, MaxC1})
          EmtModifyAxisHome( 'C1', ParkC1)
          EmtModifyAxisHome( 'B1', ParkB1)
       else
-         EmtModifyAxisHome( 'Z1', MaxZ1)
+         EmtModifyAxisHome( 'Z1', MaxZ1LongTool)
          if nTc ~= 2 then
             EmtModifyAxisStroke( 'C1', { ParkLongTc1C1 - 20, ParkLongTc1C1 + 20})
             EmtModifyAxisHome( 'C1', ParkLongTc1C1)
@@ -880,7 +882,7 @@ function OnSetHead()
    -- se testa H12 (lama)
    elseif EMC.HEAD == 'H12' then
       EmtModifyAxisHome( 'X1', ParkX1)
-      EmtModifyAxisHome( 'Z1', ParkZ1)
+      EmtModifyAxisHome( 'Z1', MaxZ1Blade)
       EmtModifyAxisStroke( 'Z1', {MinZ1, MaxZ1Blade})
       EmtModifyAxisStroke( 'C1', {MinC1, MaxC1})
       EmtModifyAxisHome( 'C1', ParkC1)
@@ -907,7 +909,7 @@ function OnSetHead()
    -- se testa H16 ( seconda lama)
    elseif EMC.HEAD == 'H16' then
       EmtModifyAxisHome( 'X1', ParkTc2X1)
-      EmtModifyAxisHome( 'Z1', ParkZ1)
+      EmtModifyAxisHome( 'Z1', MaxZ1Blade)
       EmtModifyAxisStroke( 'Z1', {MinZ1, MaxZ1Blade})
       EmtModifyAxisStroke( 'C1', {MinC1, MaxC1})
       EmtModifyAxisHome( 'C1', ParkC1)