133 lines
2.6 KiB
C++
133 lines
2.6 KiB
C++
/*
|
|
* ads1210.cpp
|
|
*
|
|
* Created on: Nov 2, 2014
|
|
* Author: wn
|
|
*/
|
|
|
|
// #include <Arduino.h>
|
|
#include <SPI.h>
|
|
// #include "Streaming.h"
|
|
#include "ads1210.h"
|
|
#include "fatal.h"
|
|
|
|
|
|
|
|
|
|
void ADS1210::enableCS() const {
|
|
digitalWrite(m_csPin, LOW);
|
|
}
|
|
void ADS1210::disableCS() const {
|
|
digitalWrite(m_csPin, HIGH);
|
|
}
|
|
|
|
void ADS1210::waitForDRdy() const {
|
|
uint32_t timeOut = 1000000;
|
|
while ((0 != digitalRead(m_drdyPin)) && timeOut) {
|
|
timeOut--;
|
|
}
|
|
if (0 == timeOut) {
|
|
fatal(1);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void ADS1210::writeRegister(const uint8_t regAddr, const uint8_t value) const {
|
|
//waitForDRdy();
|
|
enableCS();
|
|
SPI.transfer(regAddr);
|
|
SPI.transfer(value);
|
|
disableCS();
|
|
}
|
|
|
|
|
|
uint8_t ADS1210::readRegister(const uint8_t regAddr) const {
|
|
uint8_t res;
|
|
|
|
//waitForDRdy();
|
|
enableCS();
|
|
SPI.transfer(regAddr | INSR_RW);
|
|
res = SPI.transfer(0);
|
|
disableCS();
|
|
|
|
return res;
|
|
}
|
|
|
|
void ADS1210::exec() {
|
|
if (0 == digitalRead(m_drdyPin)) {
|
|
union {
|
|
uint8_t in[4];
|
|
uint32_t out;
|
|
} res;
|
|
|
|
enableCS();
|
|
SPI.transfer(ADDR_DOR2 | INSR_MB1 | INSR_RW);
|
|
res.in[2] = SPI.transfer(0);
|
|
res.in[1] = SPI.transfer(0);
|
|
res.in[0] = SPI.transfer(0);
|
|
res.in[3] = 0;
|
|
disableCS();
|
|
|
|
//Serial << "DOR4x8: " << _HEX(res.in[3]) << " " << _HEX(res.in[2]) << " " << _HEX(res.in[1]) << " " << _HEX(res.in[0]) << endl;
|
|
//Serial << "DOR1x32: " << _HEX(res.out) << endl;
|
|
|
|
value = res.out;
|
|
|
|
if (value == 0) {
|
|
// fatal(2);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
void ADS1210::setMode(uint8_t mode) const {
|
|
uint8_t cmr = readRegister(ADDR_CMR2);
|
|
cmr &= ~CMR_MD_Mask;
|
|
cmr |= mode;
|
|
writeRegister(ADDR_CMR2, cmr);
|
|
}
|
|
|
|
void ADS1210::setGain(uint8_t gain) const {
|
|
uint8_t cmr = readRegister(ADDR_CMR2);
|
|
cmr &= ~CMR_Gain_Mask;
|
|
cmr |= gain;
|
|
writeRegister(ADDR_CMR2, cmr);
|
|
}
|
|
|
|
void ADS1210::begin(uint8_t csPin, uint8_t drdyPin) {
|
|
static bool onlyOnce = false;
|
|
|
|
m_csPin = csPin;
|
|
m_drdyPin = drdyPin;
|
|
|
|
// initialization of SPI
|
|
// Serial << "Start SPI initialization ... ";
|
|
pinMode(m_csPin, OUTPUT);
|
|
digitalWrite(m_csPin, HIGH);
|
|
SPI.begin();
|
|
SPI.setBitOrder(MSBFIRST);
|
|
SPI.setClockDivider(SPI_CLOCK_DIV8);
|
|
SPI.setDataMode(SPI_MODE1);
|
|
// Serial << "done." << endl;
|
|
|
|
// initialization of ADS1210
|
|
// Serial << "Start ADS1210 initialization ... ";
|
|
pinMode(m_drdyPin, INPUT);
|
|
writeRegister(ADDR_CMR3, CMR_SDL | CMR_UB | CMR_REFO);
|
|
writeRegister(ADDR_CMR1, 0x1b); // data rate
|
|
writeRegister(ADDR_CMR0, 0x58);
|
|
// Serial << "done." << endl;
|
|
|
|
// Serial << "Set gain ... ";
|
|
// setGain(CMR_Gain_2);
|
|
// Serial << "done." << endl;
|
|
|
|
// Serial << "SelfCalibration ... ";
|
|
setMode(CMR_MD_SelfCalibration);
|
|
waitForDRdy();
|
|
// Serial << "done." << endl;
|
|
}
|
|
|
|
|