mini-beieli-node/mini_beieli_node_nau7802.h

171 lines
4.5 KiB
C

#pragma once
#include <Wire.h>
#ifndef _HELPER_H_
#include "helper.h"
#endif
#include "SparkFun_Qwiic_Scale_NAU7802_Arduino_Library.h"
#define SAMPLES 5
NAU7802 myScale; //Create instance of the NAU7802 class
byte debug_level;
byte interruptPin = A0;
void SetScalesDebugLevel(byte dbg_level)
{
debug_level = dbg_level;
}
bool InitializeScales()
{
bool result;
result &= myScale.reset(); //Reset all registers
result &= myScale.powerUp(); //Power on analog and digital sections of the scale
result &= myScale.setIntPolarityHigh();
result &= myScale.setLDO(NAU7802_LDO_3V3); //Set LDO to 3.3V
result &= myScale.setGain(NAU7802_GAIN_128); //Set gain to 128
result &= myScale.setSampleRate(NAU7802_SPS_40); //Set samples per second to 40
result &= myScale.setRegister(NAU7802_ADC, 0x30); //Turn off CLK_CHP. From 9.1 power on sequencing.
result &= myScale.clearBit(NAU7802_PGA_PWR_PGA_CAP_EN, NAU7802_PGA_PWR);
//result &= myScale.setRegister(NAU7802_OTP_B1, 0x30);
//result &= myScale.setRegister(NAU7802_PGA, NAU7802_PGA_OUT_EN | NAU7802_PGA_CHP_DIS);
result &= myScale.calibrateAFE(); //Re-cal analog front end when we change gain, sample rate, or channel
return result;
}
bool SetupScales(byte dbg_level)
{
debug_level = dbg_level;
if (debug_level > 0) {
gCatena.SafePrintf("SetupScales start\n");
}
pinMode(interruptPin, INPUT);
if (!myScale.begin(Wire, false))
{
gCatena.SafePrintf("Scale not detected. Please check wiring. Freezing...\n");
return false;
}
gCatena.SafePrintf("Scale detected!\n");
bool result = InitializeScales();
if (debug_level > 0) {
gCatena.SafePrintf("SetupScales done, result: %d\n", result);
}
return result;
}
long ReadScale(char channel)
{
long res;
if (debug_level > 0) {
gCatena.SafePrintf("ReadScale Start, Channel %c\n", channel);
}
uint8_t channelNumber;
if (channel == 'B') {
channelNumber = NAU7802_CHANNEL_1;
} else {
channelNumber = NAU7802_CHANNEL_2;
}
long startTime = millis();
myScale.setChannel(channelNumber);
bool calibrate_success = myScale.calibrateAFE();
if (! calibrate_success) {
if (debug_level > 0) {
gCatena.SafePrintf("Error: Calibration not successful!\n");
}
}
if (myScale.available()) {
long dummy = myScale.getReading();
}
int const num_scale_readings = SAMPLES; // number of instantaneous scale readings to calculate the median
// we use the median, not the average, see https://community.particle.io/t/boron-gpio-provides-less-current-than-electrons-gpio/46647/13
long readings[num_scale_readings]; // create arry to hold readings
for (int i = 0; i < num_scale_readings; i++) {
//while (digitalRead(interruptPin) == LOW) {
while (! myScale.available()) {
// we set a timeout of 60 seconds for the measurement...
if ((millis() - startTime) > 60000) {
if (debug_level > 0) {
gCatena.SafePrintf("Timeout while reading scale...\n");
}
break;
}
delay(1);
}
long reading = myScale.getReading();
if (debug_level > 0) {
gCatena.SafePrintf("Reading: %d\n", reading);
}
readings[i] = reading; // fill the array with instantaneous readings from the scale
delay(10);
}
long duration = millis() - startTime;
res = median(readings, num_scale_readings); // calculate median
if (debug_level > 0) {
gCatena.SafePrintf("Median of %d samples: %d\n", num_scale_readings, res);
float sdev;
sdev = stddev(readings, num_scale_readings);
float sdev_proc;
sdev_proc = 100 * (sdev / float(res));
gCatena.SafePrintf("Measurements: [");
for (int i = 0; i < num_scale_readings; i++) {
gCatena.SafePrintf("%d", readings[i]);
if (i < (SAMPLES - 1)) {
gCatena.SafePrintf(",");
}
}
gCatena.SafePrintf("]\n");
gCatena.SafePrintf("Standard Deviation: %d.%03d\n", (int)sdev, (int)abs(sdev * 1000) % 1000);
gCatena.SafePrintf("Standard Deviation / Median (Percent): %d.%03d\n", (int)sdev_proc, (int)abs(sdev_proc * 1000) % 1000);
gCatena.SafePrintf("Duration (ms): %d\n", duration);
}
if (debug_level > 0) {
gCatena.SafePrintf("ReadScale Done\n");
}
return res;
}
void PowerdownScale()
{
if (debug_level > 0) {
gCatena.SafePrintf("PowerdownScale Start\n");
}
myScale.powerDown();
if (debug_level > 0) {
gCatena.SafePrintf("PowerdownScale Done\n");
}
}
void PowerupScale()
{
if (debug_level > 0) {
gCatena.SafePrintf("PowerupScale Start\n");
}
InitializeScales();
if (debug_level > 0) {
gCatena.SafePrintf("PowerupScale Done\n");
}
}