Added iGyroscope interface

Signed-off-by: Serban Waltter <serban.waltter@rinftech.com>
Signed-off-by: Mihai Tudor Panu <mihai.tudor.panu@intel.com>
This commit is contained in:
Serban Waltter
2018-10-02 14:06:17 +03:00
committed by Mihai Tudor Panu
parent 34bb12933d
commit aa966946d5
39 changed files with 222 additions and 47 deletions

View File

@@ -97,3 +97,24 @@ float ADXRS610::getAngularVelocity()
else
return -((m_zeroPoint - dataV) / m_degreeCoeff);
}
std::vector<float> ADXRS610::getGyroscope()
{
float dataV = getDataVolts();
// check the deadband
if (dataV < (m_zeroPoint + m_deadband) &&
dataV > (m_zeroPoint - m_deadband))
return std::vector<float>{0 ,0 ,0};
if (dataV > m_zeroPoint)
{
float v = ((dataV - m_zeroPoint) / m_degreeCoeff);
return std::vector<float>{0 ,0 , v};
}
else
{
float v = -((m_zeroPoint - dataV) / m_degreeCoeff);
return std::vector<float>{0 ,0 , v};
}
}