GY-63_MS5611/libraries/A1301/A1301.cpp
2022-12-02 12:52:49 +01:00

192 lines
2.6 KiB
C++

//
// FILE: A1301.cpp
// AUTHOR: Rob Tillaart
// VERSION: 0.1.1
// DATE: 2010-07-22
// PURPOSE: Arduino library for A1301 A1302 magnetometer.
#include "A1301.h"
HALL::HALL(uint8_t pin)
{
_pin = pin;
_midPoint = 512;
_prevGauss = 0;
_lastGauss = 0;
_mVGauss = 2.5;
_mVStep = 5000.0 / 1023; // default 10 bit 5V ADC
_maxADC = 1023;
}
void HALL::begin(float voltage, uint16_t steps)
{
_maxADC = steps;
_mVStep = voltage / steps;
}
void HALL::setMidPoint(float midPoint)
{
_midPoint = midPoint;
}
float HALL::getMidPoint()
{
return _midPoint;
}
void HALL::setSensitivity(float sensitivity)
{
_mVGauss = sensitivity;
}
float HALL::getSensitivity()
{
return _mVGauss;
}
/////////////////////////////////////////////////////////////////////////////
//
// READ
//
float HALL::raw(uint8_t times)
{
float sum = 0;
if (times == 0) times = 1;
for (int i = 0; i < times; i++)
{
sum += analogRead(_pin);
}
if (times > 1) sum /= times;
return sum;
}
float HALL::read(uint8_t times)
{
float milliVolts = (raw(times) - _midPoint) * _mVStep;
_prevGauss = _lastGauss;
_lastGauss = milliVolts / _mVGauss;
return _lastGauss;
}
float HALL::readExt(float raw)
{
float milliVolts = (raw - _midPoint) * _mVStep;
_prevGauss = _lastGauss;
_lastGauss = milliVolts / _mVGauss;
return _lastGauss;
}
/////////////////////////////////////////////////////////////////////////////
//
// ANALYSE
//
bool HALL::isNorth()
{
return (_lastGauss > 0);
}
bool HALL::isSouth()
{
return (_lastGauss < 0);
}
float HALL::lastGauss()
{
return _lastGauss;
}
float HALL::prevGauss()
{
return _prevGauss;
}
// CONVERTORs
float HALL::Tesla(float Gauss)
{
return Gauss * 0.0001;
}
float HALL::mTesla(float Gauss)
{
return Gauss * 0.1;
}
float HALL::uTesla(float Gauss)
{
return Gauss * 100;
}
/////////////////////////////////////////////////////////////////////////////
//
// EXPERIMENTAL
//
void HALL::setMaxGauss(uint16_t maxGauss)
{
_maxGauss = maxGauss;
}
float HALL::getMaxGauss()
{
return _maxGauss;
}
bool HALL::isSaturated()
{
// experimental, depends on sensor? to elaborate
return (abs(_lastGauss) >= _maxGauss);
}
/////////////////////////////////////////////////////////////////////////////
//
// DERIVED
//
A1301::A1301(uint8_t pin) : HALL(pin)
{
_mVGauss = 2.5;
}
A1302::A1302(uint8_t pin) : HALL(pin)
{
_mVGauss = 1.3;
}
A1324::A1324(uint8_t pin) : HALL(pin)
{
_mVGauss = 5.0;
}
A1325::A1325(uint8_t pin) : HALL(pin)
{
_mVGauss = 3.125;
}
A1326::A1326(uint8_t pin) : HALL(pin)
{
_mVGauss = 2.5;
}
// -- END OF FILE --