ToughC5 Power Management

#include <M5Unified.h>

constexpr int CHARGE_CURRENT_LOW_MA = 180;
constexpr int CHARGE_CURRENT_HIGH_MA = 650;

int chargeCurrentMa = CHARGE_CURRENT_LOW_MA;
uint32_t lastRefreshMs = 0;

void drawStatus()
{
  const auto chargeState = M5.Power.isCharging();
  const char* chargeText =
      chargeState == m5::Power_Class::is_charging ? "Charging" :
      chargeState == m5::Power_Class::is_discharging ? "Not charging" :
      "Unknown";

  const int batteryVoltage = M5.Power.getBatteryVoltage();
  const int batteryLevel = M5.Power.getBatteryLevel();
  const int vbusVoltage = M5.Power.getVBUSVoltage();

  M5.Display.clear();
  M5.Display.setTextSize(2);

  M5.Display.setTextColor(0xFFE0);

  M5.Display.setCursor(10, 8);
  M5.Display.printf("Charge current: %d mA", chargeCurrentMa);

  M5.Display.setCursor(10, 30);
  M5.Display.printf("Current option:");

  M5.Display.setCursor(10, 51);
  M5.Display.printf("180 / 650 mA");

  M5.Display.setCursor(10, 74);
  M5.Display.printf("Touch to change");

  M5.Display.setCursor(10, 95);
  M5.Display.printf("charge level");

  M5.Display.setTextColor(0xFFFF);

  M5.Display.setCursor(10, 123);
  M5.Display.printf("Charging: %s", chargeText);

  M5.Display.setCursor(10, 148);
  if (batteryVoltage < 0) {
    M5.Display.printf("Battery: Unknown");
  } else if (batteryVoltage == 0) {
    M5.Display.printf("Battery: No battery");
  } else {
    M5.Display.printf("Battery: %d mV", batteryVoltage);
  }

  M5.Display.setCursor(10, 173);
  if (batteryLevel < 0) {
    M5.Display.printf("Level: Unknown");
  } else {
    M5.Display.printf("Level: %d%%", batteryLevel);
  }

  M5.Display.setCursor(10, 198);
  if (vbusVoltage < 0) {
    M5.Display.printf("VBUS: Unsupported");
  } else {
    M5.Display.printf("VBUS: %d mV", vbusVoltage);
  }
}

void setup()
{
  auto cfg = M5.config();

  // If powered from the Grove port or DC input, set this to false as needed.
  // cfg.output_power = false;

  M5.begin(cfg);
  M5.Power.setChargeCurrent(chargeCurrentMa);

  drawStatus();
  lastRefreshMs = millis();
}

void loop()
{
  M5.update();

  bool redraw = false;

  if (M5.Touch.getCount() > 0 && M5.Touch.getDetail(0).wasPressed()) {
    chargeCurrentMa = (chargeCurrentMa == CHARGE_CURRENT_LOW_MA)
        ? CHARGE_CURRENT_HIGH_MA
        : CHARGE_CURRENT_LOW_MA;

    M5.Power.setChargeCurrent(chargeCurrentMa);
    redraw = true;
  }

  const uint32_t now = millis();
  if (redraw || now - lastRefreshMs >= 1000) {
    drawStatus();
    lastRefreshMs = now;
  }
}