/*
 * Sample arduino sketch using contiki features.
 * We turn the LED off 
 * We allow read the moisture sensor
 * Unfortunately sleeping for long times in loop() isn't currently
 * possible, something turns off the CPU (including PWM outputs) if a
 * Proto-Thread is taking too long. We need to find out how to sleep in
 * a Contiki-compatible way.
 * Note that for a normal arduino sketch you won't have to include any
 * of the contiki-specific files here, the sketch should just work.
 */

#include <Wire.h>
#include <Adafruit_Sensor.h>
#include <Adafruit_BME280.h>

extern "C" {
#include "arduino-process.h"
#include "rest-engine.h"

extern resource_t res_bmptemp,res_bmppress,res_bmpatm,res_bmpalt, res_battery;

float bmptemp;
float bmppress;
float bmpatm;
float bmpalt;
float bmphum;
char  bmptemp_s[8];
char  bmppress_s[8];
char  bmpatm_s[8];
char  bmpalt_s[8];
char  bmphum_s[8];

#define SEALEVELPRESSURE_HPA (1013.25)
Adafruit_BME280 bme; // I2C

#define LED_PIN 4
}

void setup (void)
{
    // switch off the led
    pinMode(LED_PIN, OUTPUT);
    digitalWrite(LED_PIN, HIGH);

    bool status;
    
    // default settings
    status = bme.begin(0x77);
    if (!status) {
        printf("Could not find a valid BME280 sensor, check wiring!");
    }
    // init coap resourcen
    rest_init_engine ();
    #pragma GCC diagnostic ignored "-Wwrite-strings"
    rest_activate_resource (&res_bmptemp, "s/temp");
    rest_activate_resource (&res_bmppress, "s/press");
    rest_activate_resource (&res_bmpatm, "s/atm");
    rest_activate_resource (&res_bmpalt, "s/alt");
    rest_activate_resource (&res_battery, "s/battery");
    #pragma GCC diagnostic pop
}

// at project-conf.h
// LOOP_INTERVAL		(10 * CLOCK_SECOND)
void loop (void)
{
    bmptemp = bme.readTemperature();
    bmppress = bme.readPressure();
    bmpalt = bme.readAltitude(SEALEVELPRESSURE_HPA);
    bmpatm = bme.readPressure() / 100.0F;
    bmphum = bme.readHumidity();
    
    dtostrf(bmptemp , 6, 2, bmptemp_s );   
    dtostrf(bmppress , 6, 2, bmppress_s );
    dtostrf(bmpalt , 6, 2, bmpalt_s );
    dtostrf(bmpatm , 6, 2, bmpatm_s );
    dtostrf(bmphum , 6, 2, bmphum_s );
    
    // remove space
    if(bmptemp_s[0]==' '){
      memcpy (bmptemp_s,bmptemp_s+1,strlen(bmptemp_s)+1);
    }
    if(bmppress_s[0]==' '){
      memcpy (bmppress_s,bmppress_s+1,strlen(bmppress_s)+1);
    }
    if(bmpalt_s[0]==' '){
      memcpy (bmpalt_s,bmpalt_s+1,strlen(bmpalt_s)+1);
    }
    if(bmpatm_s[0]==' '){
      memcpy (bmpatm_s,bmpatm_s+1,strlen(bmpatm_s)+1);
    }
    if(bmphum_s[0]==' '){
      memcpy (bmphum_s,bmphum_s+1,strlen(bmphum_s)+1);
    }
         
// Debug Print
	printf("Temp: %s\n",bmptemp_s);
    printf("Press: %s\n",bmppress_s);
    printf("Altitude: %s\n",bmpalt_s);
    printf("atm: %s\n",bmpatm_s);
    printf("hum: %s\n",bmphum_s);   
}