|
|
|
@@ -1214,6 +1214,9 @@ function SpecCalcCarriages( dDistFront, dDistBack, bFixedDelta, bFixedPos)
|
|
|
|
|
end
|
|
|
|
|
local dDistBackEff = min( dDistBack, EMC.LB - MyMinOther - EMC.HCING - EMC.HOVM)
|
|
|
|
|
|
|
|
|
|
-- se primo scambio
|
|
|
|
|
local MyMinY = EgtIf( EMC.CNT == 1, MinY + AGG_LOAD, MinY)
|
|
|
|
|
|
|
|
|
|
EgtOutLog( ' Dist/Min : Back=' .. EgtNumToString( dDistBackEff, 1) .. '/' .. EgtNumToString( MinBackJoin, 1) ..
|
|
|
|
|
' Front=' .. EgtNumToString( dDistFrontEff, 1) .. '/' .. EgtNumToString( MinFrontJoin, 1) ..
|
|
|
|
|
' Fixed : Delta=' .. EgtIf( bFixedDelta, 'T', 'F') .. ' Pos=' .. EgtIf( bFixedPos, 'T', 'F'), 3)
|
|
|
|
@@ -1233,7 +1236,7 @@ function SpecCalcCarriages( dDistFront, dDistBack, bFixedDelta, bFixedPos)
|
|
|
|
|
if dDistFrontEff < MinFrontJoin and dDistBackEff > MinBackJoin - GEO.EPS_SMALL then
|
|
|
|
|
-- se Y non era in presa, mi ricalcolo la posizione
|
|
|
|
|
if not dYDelta then
|
|
|
|
|
dYDelta = dVDelta + ( MinY - MaxV)
|
|
|
|
|
dYDelta = dVDelta + ( MyMinY - MaxV)
|
|
|
|
|
end
|
|
|
|
|
dNewYDelta = EMC.LB - dDistBackEff
|
|
|
|
|
-- verifico se posso lasciare la morsa in posizione
|
|
|
|
@@ -1250,11 +1253,11 @@ function SpecCalcCarriages( dDistFront, dDistBack, bFixedDelta, bFixedPos)
|
|
|
|
|
elseif dDistBackEff > MinBackJoin - GEO.EPS_SMALL and dDistFrontEff > MinFrontJoin - GEO.EPS_SMALL then
|
|
|
|
|
-- se Y non era in presa, mi ricalcolo la posizione
|
|
|
|
|
if not dYDelta then
|
|
|
|
|
dYDelta = dVDelta + ( MinY - MaxV)
|
|
|
|
|
dYDelta = dVDelta + ( MyMinY - MaxV)
|
|
|
|
|
end
|
|
|
|
|
-- se V non era in presa, mi ricalcolo la posizione
|
|
|
|
|
if not dVDelta then
|
|
|
|
|
dVDelta = dYDelta - ( MinY - MaxV)
|
|
|
|
|
dVDelta = dYDelta - ( MyMinY - MaxV)
|
|
|
|
|
end
|
|
|
|
|
|
|
|
|
|
dNewYDelta = EMC.LB - dDistBackEff
|
|
|
|
@@ -1284,12 +1287,17 @@ function SpecCalcCarriages( dDistFront, dDistBack, bFixedDelta, bFixedPos)
|
|
|
|
|
elseif dDistBackEff < MinBackJoin and dDistFrontEff > MinFrontJoin - GEO.EPS_SMALL then
|
|
|
|
|
-- se V non era in presa, mi ricalcolo la posizione
|
|
|
|
|
if not dVDelta then
|
|
|
|
|
dVDelta = dYDelta - ( MinY - MaxV)
|
|
|
|
|
dVDelta = dYDelta - ( MyMinY - MaxV)
|
|
|
|
|
end
|
|
|
|
|
dNewVDelta = dDistFrontEff
|
|
|
|
|
-- verifico se posso lasciare la morsa in posizione
|
|
|
|
|
local dVDeltaTol = GetDeltaTol( dNewVDelta, EMC.TCING, EMC.HCING, EMC.HOVM, 'V', bFixedDelta)
|
|
|
|
|
local bVDeltaS = ( dNewVDelta > dVDelta + dVDeltaTol or dNewVDelta < dVDelta - DELTA_SIC)
|
|
|
|
|
local bVDeltaS
|
|
|
|
|
if EMC.YDELTA == nil and EMC.YDELTANEXT == nil then
|
|
|
|
|
bVDeltaS = (( dNewVDelta > dVDelta + dVDeltaTol and not bFixedPos) or dNewVDelta < dVDelta - DELTA_SIC)
|
|
|
|
|
else
|
|
|
|
|
bVDeltaS = ( dNewVDelta > dVDelta + dVDeltaTol or dNewVDelta < dVDelta - DELTA_SIC)
|
|
|
|
|
end
|
|
|
|
|
-- reimposto i delta finali in caso di spostamenti richiesti significativi, tenuto conto delle tolleranze
|
|
|
|
|
if bVDeltaS then
|
|
|
|
|
dNewVDelta = dNewVDelta - dVDeltaTol/2
|
|
|
|
@@ -1489,6 +1497,17 @@ function SpecCalcPreRot()
|
|
|
|
|
return vCmd
|
|
|
|
|
end
|
|
|
|
|
|
|
|
|
|
---------------------------------------------------------------------
|
|
|
|
|
local function CalcCharStatus( sType, dDelta)
|
|
|
|
|
-- se per carrello Y
|
|
|
|
|
if sType == 'Y' then
|
|
|
|
|
return EgtIf( EMC.LB - dDelta < LenToPress, 1, 2)
|
|
|
|
|
-- altrimenti per carrello V
|
|
|
|
|
else
|
|
|
|
|
return EgtIf( dDelta < LenToPress, 1, 2)
|
|
|
|
|
end
|
|
|
|
|
end
|
|
|
|
|
|
|
|
|
|
---------------------------------------------------------------------
|
|
|
|
|
function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF, dVDeltaF, bFixedDelta, bFixedPos)
|
|
|
|
|
local dYPosA, dVPosA, dTPosA
|
|
|
|
@@ -1556,9 +1575,10 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
-- * deve effettivamente spostarsi
|
|
|
|
|
-- * non si arriva da gestione passo del pellegrino
|
|
|
|
|
-- * se riesce a raggiungere la posizione con le corse a disposizione per come sono posizionate le morse attualmente
|
|
|
|
|
if ( dYDeltaI - dVDeltaF) >= MyMinY - MaxV and abs( dVDeltaF - dVDeltaI) > 10 * GEO.EPS_SMALL and not EMC.PILGRIMSTEP and
|
|
|
|
|
if ( dYDeltaI - dVDeltaF) + 10 * GEO.EPS_SMALL >= MyMinY - MaxV and abs( dVDeltaF - dVDeltaI) > 10 * GEO.EPS_SMALL and not EMC.PILGRIMSTEP and
|
|
|
|
|
( dVDeltaF - dVDeltaI > MinV - dVPosI + MyMinY - dYPosI) then
|
|
|
|
|
table.insert( vCmd, { 0, 'Direct-V-Y'})
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
-- se l'altra morsa non era in presa, vado a pinzare il pezzo
|
|
|
|
|
if not EMC.YDELTA then
|
|
|
|
|
dYPosA = MyMinY
|
|
|
|
@@ -1615,7 +1635,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dTPosI = dTPosA
|
|
|
|
|
|
|
|
|
|
-- blocco la morsa
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
table.insert( vCmd, { 12, CalcCharStatus( 'V', dVDeltaF)})
|
|
|
|
|
|
|
|
|
|
-- imposto i nuovi parametri di aggancio
|
|
|
|
|
if EMC.YDELTANEXT and EMC.VDELTANEXT then
|
|
|
|
@@ -1626,7 +1646,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dYPosA = dTPosF + dYDeltaF
|
|
|
|
|
dVPosA = dTPosF + dVDeltaF
|
|
|
|
|
table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
table.insert( vCmd, { 11, CalcCharStatus( 'Y', dYDeltaF)})
|
|
|
|
|
-- la morsa al carico è adesso in posizione
|
|
|
|
|
dYDeltaI = dYDeltaF
|
|
|
|
|
end
|
|
|
|
@@ -1638,7 +1658,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dTPosA = -( dYPosA + dVDeltaF)
|
|
|
|
|
dVPosA = dTPosA + dVDeltaF
|
|
|
|
|
table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
table.insert( vCmd, { 11, CalcCharStatus( 'Y', dYDeltaF)})
|
|
|
|
|
-- la morsa al carico è adesso in posizione
|
|
|
|
|
dYDeltaI = dYDeltaF
|
|
|
|
|
end
|
|
|
|
@@ -1661,9 +1681,10 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
-- * deve effettivamente spostarsi
|
|
|
|
|
-- * non si arriva da gestione passo del pellegrino
|
|
|
|
|
-- * se riesce a raggiungere la posizione con le corse a disposizione per come sono posizionate le morse attualmente
|
|
|
|
|
elseif ( dYDeltaF - dVDeltaI) >= MyMinY - MaxV and abs( dYDeltaF - dYDeltaI) > 10 * GEO.EPS_SMALL and not EMC.PILGRIMSTEP and
|
|
|
|
|
elseif ( dYDeltaF - dVDeltaI) + 10 * GEO.EPS_SMALL >= MyMinY - MaxV and abs( dYDeltaF - dYDeltaI) > 10 * GEO.EPS_SMALL and not EMC.PILGRIMSTEP and
|
|
|
|
|
( dYDeltaF - dYDeltaI < MaxY - dYPosI + MaxV - dVPosI) then
|
|
|
|
|
table.insert( vCmd, { 0, 'Direct-Y-V'})
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
-- se l'altra morsa non era in presa, vado a pinzare il pezzo
|
|
|
|
|
if not EMC.VDELTA then
|
|
|
|
|
dVPosA = MaxV
|
|
|
|
@@ -1723,7 +1744,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dTPosI = dTPosA
|
|
|
|
|
|
|
|
|
|
-- blocco la morsa
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
table.insert( vCmd, { 11, CalcCharStatus( 'Y', dYDeltaF)})
|
|
|
|
|
|
|
|
|
|
-- imposto i nuovi parametri di aggancio
|
|
|
|
|
if EMC.YDELTANEXT and EMC.VDELTANEXT then
|
|
|
|
@@ -1733,7 +1754,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dYPosA = dTPosF + dYDeltaF
|
|
|
|
|
dVPosA = dTPosF + dVDeltaF
|
|
|
|
|
table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
table.insert( vCmd, { 12, CalcCharStatus( 'V', dVDeltaF)})
|
|
|
|
|
-- la morsa al carico è adesso in posizione
|
|
|
|
|
dVDeltaI = dVDeltaF
|
|
|
|
|
end
|
|
|
|
@@ -1745,7 +1766,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dTPosA = dVPosA - dVDeltaF
|
|
|
|
|
dYPosA = dTPosA + dYDeltaF
|
|
|
|
|
table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
table.insert( vCmd, { 12, CalcCharStatus( 'V', dVDeltaF)})
|
|
|
|
|
-- la morsa al carico è adesso in posizione
|
|
|
|
|
dVDeltaI = dVDeltaF
|
|
|
|
|
end
|
|
|
|
@@ -1772,6 +1793,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
-- compatto al centro
|
|
|
|
|
if not EMC.YDELTA then
|
|
|
|
|
table.insert( vCmd, { 0, 'Compact Y'})
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
table.insert( vCmd, { 11, 0})
|
|
|
|
|
dTPosA = MaxV - dVDeltaI
|
|
|
|
|
dVPosA = MaxV
|
|
|
|
@@ -1784,6 +1806,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
end
|
|
|
|
|
if not EMC.VDELTA then
|
|
|
|
|
table.insert( vCmd, { 0, 'Compact V'})
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
table.insert( vCmd, { 12, 0})
|
|
|
|
|
dTPosA = MyMinY - dYDeltaI
|
|
|
|
|
dVPosA = MaxV
|
|
|
|
@@ -1858,7 +1881,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dTPosA = dTPosI - dVPosI + MinV
|
|
|
|
|
dYPosA = dYDeltaF + dTPosA
|
|
|
|
|
table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
table.insert( vCmd, { 11, CalcCharStatus( 'Y', dYDeltaF)})
|
|
|
|
|
table.insert( vCmd, { 12, 0})
|
|
|
|
|
dTPosI = dTPosA
|
|
|
|
|
EMC.YDELTA = dYDeltaF
|
|
|
|
@@ -1875,7 +1898,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dVPosA = dTPosI + dVDeltaI - dTotMove
|
|
|
|
|
dTPosA = dTPosI - dTotMove
|
|
|
|
|
table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
table.insert( vCmd, { 11, CalcCharStatus( 'Y', dYDeltaF)})
|
|
|
|
|
table.insert( vCmd, { 12, 0})
|
|
|
|
|
|
|
|
|
|
-- aggiorno nuova posizione della morsa al carico dopo riposizionamento
|
|
|
|
@@ -1903,12 +1926,12 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
|
|
|
|
|
-- imposto i nuovi parametri di aggancio
|
|
|
|
|
if EMC.YDELTANEXT and EMC.VDELTANEXT then
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
table.insert( vCmd, { 12, CalcCharStatus( 'V', dVDeltaF)})
|
|
|
|
|
table.insert( vCmd, { 21, dYDeltaF, dVDeltaF})
|
|
|
|
|
elseif EMC.YDELTANEXT then
|
|
|
|
|
table.insert( vCmd, { 21, dYDeltaF, 0})
|
|
|
|
|
else
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
table.insert( vCmd, { 12, CalcCharStatus( 'V', dVDeltaF)})
|
|
|
|
|
table.insert( vCmd, { 11, 0})
|
|
|
|
|
-- sposto il carrello Y in parcheggio
|
|
|
|
|
table.insert( vCmd, { 1, 'Y', ParkY})
|
|
|
|
@@ -1964,7 +1987,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dTPosA = dTPosI + ( MaxY - dYPosI)
|
|
|
|
|
dVPosA = dVDeltaF + dTPosA
|
|
|
|
|
table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
table.insert( vCmd, { 12, CalcCharStatus( 'V', dVDeltaF)})
|
|
|
|
|
table.insert( vCmd, { 11, 0})
|
|
|
|
|
dTPosI = dTPosA
|
|
|
|
|
EMC.YDELTA = dYDeltaI
|
|
|
|
@@ -1981,7 +2004,7 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dVPosA = dTPosI + dVDeltaI - dTotMove
|
|
|
|
|
dTPosA = dTPosI + dTotMove
|
|
|
|
|
table.insert( vCmd, { 3, 'Y', dYPosA , 'T', dTPosA, 'V', dVPosA})
|
|
|
|
|
table.insert( vCmd, { 12, 1})
|
|
|
|
|
table.insert( vCmd, { 12, CalcCharStatus( 'V', dVDeltaF)})
|
|
|
|
|
table.insert( vCmd, { 11, 0})
|
|
|
|
|
|
|
|
|
|
-- aggiorno nuova posizione della morsa allo scarico dopo riposizionamento
|
|
|
|
@@ -2007,22 +2030,12 @@ function SpecAdjustCarriages( vCmd, dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF
|
|
|
|
|
dYDeltaI = dYDeltaF
|
|
|
|
|
end
|
|
|
|
|
|
|
|
|
|
-- sistemo apertura morse
|
|
|
|
|
if EMC.YDELTANEXT then
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
end
|
|
|
|
|
if not EMC.VDELTANEXT then
|
|
|
|
|
table.insert( vCmd, { 12, 0})
|
|
|
|
|
-- sposto il carrello Y in parcheggio
|
|
|
|
|
table.insert( vCmd, { 1, 'V', ParkV})
|
|
|
|
|
end
|
|
|
|
|
|
|
|
|
|
-- imposto i nuovi parametri di aggancio
|
|
|
|
|
if EMC.YDELTANEXT and EMC.VDELTANEXT then
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
table.insert( vCmd, { 11, CalcCharStatus( 'Y', dYDeltaF)})
|
|
|
|
|
table.insert( vCmd, { 21, dYDeltaF, dVDeltaF})
|
|
|
|
|
elseif EMC.YDELTANEXT then
|
|
|
|
|
table.insert( vCmd, { 11, 1})
|
|
|
|
|
table.insert( vCmd, { 11, CalcCharStatus( 'Y', dYDeltaF)})
|
|
|
|
|
-- sposto il carrello Y in parcheggio
|
|
|
|
|
table.insert( vCmd, { 12, 0})
|
|
|
|
|
table.insert( vCmd, { 1, 'V', ParkV})
|
|
|
|
@@ -2277,17 +2290,6 @@ function SpecAdjustCarriagesOLD( dTPosI, dYDeltaI, dVDeltaI, dTPosF, dYDeltaF, d
|
|
|
|
|
end
|
|
|
|
|
end
|
|
|
|
|
|
|
|
|
|
---------------------------------------------------------------------
|
|
|
|
|
local function CalcCharStatus( sType, dDelta)
|
|
|
|
|
-- se per carrello Y
|
|
|
|
|
if sType == 'Y' then
|
|
|
|
|
return EgtIf( EMC.LB - dDelta < LenToPress, 1, 2)
|
|
|
|
|
-- altrimenti per carrello V
|
|
|
|
|
else
|
|
|
|
|
return EgtIf( dDelta < LenToPress, 1, 2)
|
|
|
|
|
end
|
|
|
|
|
end
|
|
|
|
|
|
|
|
|
|
---------------------------------------------------------------------
|
|
|
|
|
local function GetCorseDisp( dCorsaYfc, dCorsaVfc, dDistN, sSide)
|
|
|
|
|
local dRecTotn = min( dDistN, dCorsaYfc+ dCorsaVfc) -- recupero possibile al netto di dCorsa..TrA)
|
|
|
|
|