58 lines
1.1 KiB
C++
58 lines
1.1 KiB
C++
|
|
#include "./SC60228.h"
|
|
|
|
|
|
SC60228::SC60228(SPISettings settings, int nCS) : settings(settings), nCS(nCS) {
|
|
// nix
|
|
};
|
|
|
|
SC60228::~SC60228() { };
|
|
|
|
void SC60228::init(SPIClass* _spi) {
|
|
spi = _spi;
|
|
if (nCS>=0)
|
|
pinMode(nCS, OUTPUT);
|
|
digitalWrite(nCS, HIGH);
|
|
spi->begin();
|
|
readRawAngle();
|
|
};
|
|
|
|
|
|
|
|
SC60228Angle SC60228::readRawAngle(){
|
|
SC60228Angle result;
|
|
result.reg = spi_transfer16(0x0000);
|
|
errorflag = (result.err==1);
|
|
// TODO check parity
|
|
// Serial.print("0x");
|
|
// Serial.print(result.angle, HEX);
|
|
// Serial.print(" - 0x");
|
|
// Serial.println(result.reg, HEX);
|
|
return result;
|
|
};
|
|
|
|
|
|
|
|
bool SC60228::isError() {
|
|
return errorflag;
|
|
};
|
|
|
|
|
|
|
|
uint16_t SC60228::spi_transfer16(uint16_t outdata){
|
|
uint16_t result;
|
|
if (nCS>=0)
|
|
digitalWrite(nCS, LOW);
|
|
// min delay here: 250ns
|
|
spi->beginTransaction(settings);
|
|
result = spi->transfer16(outdata);
|
|
// min delay here: clock period / 2
|
|
spi->endTransaction();
|
|
if (nCS>=0)
|
|
digitalWrite(nCS, HIGH);
|
|
// min delay until next read: 250ns
|
|
return result;
|
|
};
|
|
|
|
|