luca.mazzoleni
68 lines
1.8 KiB
Plaintext
68 lines
1.8 KiB
Plaintext
-- Special Operations macchina Essetre-WALL by EgalTech s.r.l. 2022/02/03
|
|
|
|
-- Intestazioni
|
|
require( 'EmtGenerator')
|
|
EgtEnableDebug( false)
|
|
|
|
EgtOutLog ( '** Essetre-WALL.mlse '..PP_VER..' **', 1)
|
|
|
|
---------------------------------------------------------------------
|
|
function OnSpecialMoveZup()
|
|
|
|
-- Inizializzazioni
|
|
EMC.MODIF = false
|
|
EMC.ERR = 1
|
|
|
|
-- Se fresa
|
|
if EMC.HEAD == 'H1' then
|
|
if EMC.L3 > -300 then
|
|
EMC.R1 = EgtGetAxisHomePos( 'C1')
|
|
EMC.R2 = EgtGetAxisHomePos( 'B1')
|
|
EMC.TDIR = EgtGetCalcToolDirFromAngles( EMC.R1, EMC.R2)
|
|
EMC.MODIF = true
|
|
end
|
|
-- se altrimenti sega a catena
|
|
elseif EMC.HEAD == 'H3' then
|
|
local L3New = EMC.L3
|
|
local R1New = EMC.R1
|
|
local R2New = EMC.R2
|
|
if EMC.L3 > -300 then
|
|
L3New = min( EMC.L3, EgtGetAxisHomePos( 'Z1'))
|
|
R1New = EgtGetAxisHomePos( 'C1')
|
|
R2New = EgtGetAxisHomePos( 'B1')
|
|
EMC.MODIF = true
|
|
end
|
|
if EMC.L2 > -1400 then
|
|
R1New = 0
|
|
EMC.MODIF = true
|
|
elseif EMC.L2 < -4700 then
|
|
R1New = 180
|
|
EMC.MODIF = true
|
|
end
|
|
if EMC.MODIF then
|
|
EMC.L3 = L3New
|
|
EMC.R1 = R1New
|
|
EMC.R2 = R2New
|
|
EMC.TDIR = EgtGetCalcToolDirFromAngles( EMC.R1, EMC.R2, EMC.R3)
|
|
end
|
|
-- se altrimenti lama
|
|
elseif EMC.HEAD == 'H2' then
|
|
if EMC.L3 > -200 then
|
|
EMC.R1 = EgtGetAxisHomePos( 'C2')
|
|
EMC.R2 = EgtGetAxisHomePos( 'B2')
|
|
EMC.TDIR = EgtGetCalcToolDirFromAngles( EMC.R1, EMC.R2)
|
|
EMC.MODIF = true
|
|
end
|
|
-- se foratore orizzontale
|
|
elseif EMC.HEAD == 'H5' then
|
|
;
|
|
-- se foratore orizzontale opposto
|
|
elseif EMC.HEAD == 'H6' then
|
|
;
|
|
-- altrimenti errore
|
|
else
|
|
error( "Unknown Head")
|
|
end
|
|
EMC.ERR = 0
|
|
end
|