#include "headerFile.h"

// SensorManager::Rotation offset;

void setup() {
  // Serial.begin(9600);
  // Serial.println("startup");
  //connect to internet and start sensor
  connectivity.connectWiFi(ssid, pass);
  sensorManager.sensorSetup();
}

unsigned long lastTime = 0;  // will store the last time the code was run

void loop() {
  SensorManager::eulerAngles eulerRotation = sensorManager.getEulerAngles();
  SensorManager::acceleration rotationAcceleration = sensorManager.getAcelleration();

  unsigned long currentTime = millis();
  if (currentTime - lastTime >= 100) {  // 100 ms has passed
    memset(buffer, 0, BUFFER_SIZE);
    sprintf(
        buffer, 
        "{\"deviceId\": %d, \"rotationX\": %f, \"rotationY\": %f, \"rotationZ\": %f, \"accelerationX\": %f, \"accelerationY\": %f, \"accelerationZ\": %f, \"type\": %s}", 
        DEVICE_ID,
        eulerRotation.roll,
        eulerRotation.pitch,
        eulerRotation.yaw,
        rotationAcceleration.x,
        rotationAcceleration.y,
        rotationAcceleration.z,
        "data");
        // %d = int, %f = floatation, %s = string
    connectivity.httpPost("192.168.137.45", "/", 3445, buffer, strlen(buffer), "application/json");
    lastTime = currentTime;
  }
}
//acceleration.X
//acceleration.Y
//acceleration.Z