#include "M5NanoC6.h"
#include "UNIT_SCALES.h"
#include <U8g2lib.h>

UNIT_SCALES scales;

U8G2_SSD1306_72X40_ER_F_HW_I2C  u8g2(
    U8G2_R0, /* reset=*/U8X8_PIN_NONE);  // EastRising 0.42" OLED

void setup() {
    NanoC6.begin();
    while (!scales.begin(&Wire, 2, 1, DEVICE_DEFAULT_ADDR)) {
        Serial.println("scales connect error");
        delay(1000);
    }
    scales.setLEDColor(0x001000);
    u8g2.begin();
}

void loop() {
    float weight = scales.getWeight();
    float gap    = scales.getGapValue();
    int adc      = scales.getRawADC();
    char weightstr[8];
    char dispstr[8];
    char serialstr[16];

    dtostrf(weight,4,1,weightstr);
    sprintf(dispstr,"%sg",weightstr);
    Serial.println(weightstr);

    NanoC6.update();
    if (NanoC6.BtnA.wasPressed()) {
        scales.setOffset();
    }

    u8g2.clearBuffer();                  // clear the internal memory
    u8g2.setFont(u8g2_font_helvR10_tf);  // choose a suitable font
    u8g2.drawStr(0, 12, "Mini Scales");  // write something to the internal memory
    u8g2.setFont(u8g2_font_helvR14_tf);  // choose a suitable font
    u8g2.drawStr(u8g2.getWidth()-u8g2.getStrWidth(dispstr), 36, dispstr);  // write something to the internal memory
    u8g2.sendBuffer();  // transfer internal memory to the display

    delay(200);
}