EgtMachKernel :

- correzioni a Disposition per gestione stato
- modifiche a SetAxisPos per restituire la posizione effettivamente raggiunta
- modifiche a Simulator per gestire errori da PathStartAux e PathEndAux.
This commit is contained in:
Dario Sassi
2019-03-20 07:49:40 +00:00
parent 39bf1700d9
commit 81c17e4029
7 changed files with 39 additions and 16 deletions
+4 -1
View File
@@ -72,7 +72,7 @@ Machine::GetAxisType( const string& sAxis, bool& bLinear) const
//----------------------------------------------------------------------------
bool
Machine::SetAxisPos( const string& sAxis, double dVal)
Machine::SetAxisPos( const string& sAxis, double dVal, double* pdNewVal)
{
// controllo GeomDB
if ( m_pGeomDB == nullptr)
@@ -107,6 +107,9 @@ Machine::SetAxisPos( const string& sAxis, double dVal)
m_pGeomDB->TranslateGroup( nAxGrp, vtDir * ( dVal - dCurrVal)) ;
else
m_pGeomDB->RotateGroup( nAxGrp, ptPos, vtDir, ( dVal - dCurrVal)) ;
// se richiesto, restituisco la nuova posizione
if ( pdNewVal != nullptr)
*pdNewVal = dVal ;
// salvo la nuova posizione
return pAx->SetCurrVal( dVal) ;
}