/*
 * ads1210.cpp
 *
 *  Created on: Nov 2, 2014
 *      Author: wn
 */

// #include <Arduino.h>
#include <SPI.h>
#include "Streaming.h"
#include "ads1210.h"
#include "fatal.h"



ADS1210::ADS1210() {
}

void ADS1210::enableCS() const {
	digitalWrite(m_csPin, LOW);
}
void ADS1210::disableCS() const {
	digitalWrite(m_csPin, HIGH);
}

void ADS1210::waitForDRdy() const {
  uint32_t timeOut = 100000;
  while ((0 != digitalRead(m_drdyPin)) && timeOut--) {
  }
  if (0 == timeOut) {
    fatal(1);
  } 
}

void ADS1210::waitForDRdyWOTimeout() const {
  while (0 != digitalRead(m_drdyPin)) {
  }
}

  
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;
}

uint32_t ADS1210::readDataOutRegister() const {
  union {
    uint8_t in[4];
    uint32_t out;
  } res;
  
  waitForDRdy();
  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;
  
  return res.out;
}


void ADS1210::disableRefO() const {
  uint8_t cmr = readRegister(ADDR_CMR3);
  cmr &= ~CMR_REFO;
  writeRegister(ADDR_CMR3, cmr);
}

void ADS1210::enableRefO() const {
  uint8_t cmr = readRegister(ADDR_CMR3);
  cmr |= CMR_REFO;
  writeRegister(ADDR_CMR3, cmr);
}

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_DIV16);
	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);
  Serial << "done." << endl;
    
  Serial << "SelfCalibration ... ";
  setMode(CMR_MD_SelfCalibration);
  waitForDRdyWOTimeout();
  Serial << "done." << endl;  
}


uint32_t ADS1210::get() const {
  return readDataOutRegister();
}