#include <U8g2lib.h>
#include "src/cactus_io_BME280_I2C.h"
#include <Wire.h>

U8G2_SSD1306_128X32_UNIVISION_F_SW_I2C u8g2(U8G2_R0, /* clock=*/ 5, /* data=*/ 4, /* reset=*/ 16);

BME280_I2C bme(0x76);

TwoWire I2Cone = TwoWire();
TwoWire I2Ctwo = TwoWire();

void setup(void) {
  Serial.begin(9600);
  I2Cone.begin(4, 5);
  I2Ctwo.begin(12, 13);

  Serial.println("Bosch BME280 Pressure - Humidity - Temp Sensor | cactus.io");

  if (!bme.begin()) {
    Serial.println("Could not find a valid BME280 sensor, check wiring!");
    while (1);

    Serial.println("Pressure\tHumdity\t\tTemp\ttTemp");

  }

  u8g2.begin();
}

void loop(void) {

  bme.readSensor();

  Serial.print(bme.getPressure_MB()); Serial.print(" mb\t"); // Pressure in millibars
  Serial.print(bme.getHumidity()); Serial.print(" %\t\t");
  Serial.print(bme.getTemperature_C()); Serial.print(" *C\t");
  Serial.print(bme.getTemperature_F()); Serial.println(" *F");

  do {
    u8g2.setFont(u8g2_font_logisoso32_tf);

    u8g2.drawStr(0, 32, "T:");

    u8g2.setCursor(18, 32);
    u8g2.print(bme.getTemperature_C(), 0);

    u8g2.drawStr(64, 32, "H:");

    u8g2.setCursor(84, 32);
    u8g2.print(bme.getHumidity(), 0);

  } while ( u8g2.nextPage() );
  delay(2000);
}