28 lines
658 B
C++
28 lines
658 B
C++
/**
|
|
* @author Matthew Kennedy, (c) 2019
|
|
*/
|
|
|
|
#include "resistance_func.h"
|
|
|
|
void ResistanceFunc::configure(float supplyVoltage, float pullupResistor) {
|
|
m_pullupResistor = pullupResistor;
|
|
m_supplyVoltage = supplyVoltage;
|
|
}
|
|
|
|
SensorResult ResistanceFunc::convert(float raw) const {
|
|
// If the voltage is very low, the sensor is a dead short.
|
|
if (raw < 0.05f) {
|
|
return unexpected;
|
|
}
|
|
|
|
// If the voltage is very high (98% VCC), the sensor is open circuit.
|
|
if (raw > (m_supplyVoltage * 0.98f)) {
|
|
return unexpected;
|
|
}
|
|
|
|
// Voltage is in a sensible range - convert
|
|
float resistance = m_pullupResistor / (m_supplyVoltage / raw - 1);
|
|
|
|
return resistance;
|
|
}
|