Files
evaluation/esp32_readout/esp32_readout.ino
2025-04-19 16:00:18 +02:00

155 lines
4.5 KiB
C++

#include "env.h"
#include "display.h"
Display display;
Adafruit_NAU7802 nau;
unsigned long _millis = 0;
int32_t val = 0;
bool goToSleep = False;
#if BLE
BLEServer *pServer = NULL;
BLECharacteristic *millisCharacteristic = NULL;
BLECharacteristic *weightCharacteristic = NULL;
BLEAdvertising *pAdvertising = NULL;
bool deviceConnected = false;
bool oldDeviceConnected = false;
// Callback class to handle connection events
class MyServerCallbacks : public BLEServerCallbacks {
void onConnect(BLEServer* pServer) {
deviceConnected = true;
BLEDevice::startAdvertising();
}
void onDisconnect(BLEServer* pServer) {
deviceConnected = false;
}
};
#endif
void print_wakeup_reason() {
esp_sleep_wakeup_cause_t wakeup_reason;
wakeup_reason = esp_sleep_get_wakeup_cause();
switch (wakeup_reason) {
case ESP_SLEEP_WAKEUP_EXT0: Serial.println("Wakeup caused by external signal using RTC_IO"); break;
case ESP_SLEEP_WAKEUP_EXT1: Serial.println("Wakeup caused by external signal using RTC_CNTL"); break;
case ESP_SLEEP_WAKEUP_TIMER: Serial.println("Wakeup caused by timer"); break;
case ESP_SLEEP_WAKEUP_TOUCHPAD: Serial.println("Wakeup caused by touchpad"); break;
case ESP_SLEEP_WAKEUP_ULP: Serial.println("Wakeup caused by ULP program"); break;
default: Serial.printf("Wakeup was not caused by deep sleep: %d\n", wakeup_reason); break;
}
}
void IRAM_ATTR startSleep() {
display.clear();
esp_sleep_enable_ext0_wakeup(WAKEUP_GPIO, 1);
rtc_gpio_pullup_dis(WAKEUP_GPIO);
rtc_gpio_pulldown_en(WAKEUP_GPIO);
esp_deep_sleep_start();
}
void setup() {
Serial.begin(115200);
display.setup();
print_wakeup_reason();
/**** setup sleep interrupt ******/
pinMode(SLEEP_GPIO, INPUT);
attachInterrupt(digitalPinToInterrupt(SLEEP_GPIO), startSleep, FALLING);
if (! nau.begin()) {
Serial.println("Failed to find NAU7802");
while (1) delay(10); // Don't proceed.
}
nau.setLDO(LDO);
nau.setGain(GAIN);
nau.setRate(SPS);
// Take 10 readings to flush out readings
for (uint8_t i=0; i<10; i++) {
while (! nau.available()) delay(1);
nau.read();
}
while (! nau.calibrate(NAU7802_CALMOD_INTERNAL)) {
Serial.println("Failed to calibrate internal offset, retrying!");
delay(1000);
}
while (! nau.calibrate(NAU7802_CALMOD_OFFSET)) {
Serial.println("Failed to calibrate system offset, retrying!");
delay(1000);
}
#if BLE
// initialize the Bluetooth® Low Energy hardware
BLEDevice::init("Smaage");
pServer = BLEDevice::createServer();
pServer->setCallbacks(new MyServerCallbacks());
BLEService *pService = pServer->createService(SERVICE_UUID);
millisCharacteristic = pService->createCharacteristic(
MILLIS_UUID,
BLECharacteristic::PROPERTY_READ | BLECharacteristic::PROPERTY_NOTIFY
);
weightCharacteristic = pService->createCharacteristic(
WEIGHT_UUID,
BLECharacteristic::PROPERTY_READ | BLECharacteristic::PROPERTY_NOTIFY
);
millisCharacteristic->setValue((uint8_t *)&_millis, sizeof _millis);
weightCharacteristic->setValue((uint8_t *)&val, sizeof val);
pService->start();
pAdvertising = BLEDevice::getAdvertising();
pAdvertising->addServiceUUID(SERVICE_UUID);
pAdvertising->setScanResponse(true);
BLEDevice::startAdvertising();
Serial.println("BLE device is now advertising...");
Serial.print("BLE Address: ");
Serial.println(BLEDevice::getAddress().toString().c_str());
#endif
display.print("Smaage is ready!");
}
void loop() {
while (!nau.available()) {
delay(1);
}
val = nau.read();
#if BLE
if (deviceConnected) {
// Send the sensor reading
_millis = millis();
millisCharacteristic->setValue((uint8_t *)&_millis, sizeof _millis);
millisCharacteristic->notify();
weightCharacteristic->setValue((uint8_t *)&val, sizeof val);
weightCharacteristic->notify();
}
// disconnecting
if (!deviceConnected && oldDeviceConnected) {
delay(500); // give the bluetooth stack the chance to get things ready
pServer->startAdvertising(); // restart advertising
Serial.println("start advertising");
oldDeviceConnected = deviceConnected;
}
// connecting
if (deviceConnected && !oldDeviceConnected) {
// do stuff here on connecting
oldDeviceConnected = deviceConnected;
}
#else
Serial.print(millis()); Serial.print(","); Serial.println(val);
#endif
}