#include <Wire.h>
#include <Adafruit_Sensor.h>
#include <Adafruit_BMP085.h>
#include <Adafruit_AHTX0.h>
#include <Adafruit_MPU6050.h>

Adafruit_BMP085 bmp;
Adafruit_MPU6050 mpu;
Adafruit_AHTX0 aht;

TwoWire wire;

void setup() {
  Serial.begin(115200);

  wire.begin(4,5);

  if (!mpu.begin(0x68, &wire)) {
    Serial.println("Could not find a valid MPU6050 sensor, check wiring!");
    while (1);
  } else {
    Serial.println("Initialized MPU6050!");
  }
  mpu.setAccelerometerRange(MPU6050_RANGE_2_G);
  mpu.setGyroRange(MPU6050_RANGE_250_DEG);
  mpu.setFilterBandwidth(MPU6050_BAND_184_HZ);
//  mpu.setCycleRate(MPU6050_CYCLE_40_HZ);

  if (!bmp.begin(BMP085_ULTRAHIGHRES, &wire)) {
    Serial.println("Could not find a valid BMP085 sensor, check wiring!");
    while (1);
  } else {
    Serial.println("Initialized BMP085!");
  }

  wire.begin(12,14);
  if (!aht.begin(&wire)) {
    Serial.println("Could not find a valid AHT10 sensor, check wiring!");
    while (1);
  } else {
    Serial.println("Initialized AHT10!");
  }
  wire.begin(4,5);
}

void getEnvironmental(float* temp, float* pressure, float* humidity) {
  wire.begin(12,14);
  sensors_event_t h, t;
  aht.getEvent(&h, &t);// populate temp and humidity objects with fresh data
  wire.begin(4,5);
  *temp = (bmp.readTemperature() + t.temperature)/2;
  *pressure = bmp.readPressure() / 100.0F;
  *humidity = h.relative_humidity;
}

unsigned long envTime = 0;
float temperature, pressure, humidity;

void loop() {
  if (millis() - envTime > 1000) {
    getEnvironmental(&temperature, &pressure, &humidity);
    envTime = millis();
  }
//  getEnvironmental(&temperature, &pressure, &humidity);
  Serial.print("Temperature:");
  Serial.print(temperature);
  Serial.print(",");

  Serial.print("Pressure:");
  Serial.print(pressure);
  Serial.print(",");

  Serial.print("Humidity:");
  Serial.print(humidity);
  Serial.print(",");

  // Acceleration Sensor
  sensors_event_t a, g, temp;
  mpu.getEvent(&a, &g, &temp);

  Serial.print("AccelX:");
  Serial.print(a.acceleration.x);
  Serial.print(",");
  Serial.print("AccelY:");
  Serial.print(a.acceleration.y);
  Serial.print(",");
  Serial.print("AccelZ:");
  Serial.print(a.acceleration.z);
  Serial.print(", ");
  Serial.print("GyroX:");
  Serial.print(g.gyro.x);
  Serial.print(",");
  Serial.print("GyroY:");
  Serial.print(g.gyro.y);
  Serial.print(",");
  Serial.print("GyroZ:");
  Serial.print(g.gyro.z);
  Serial.println("");
}