#include <DHT.h>
#include <TinyGPS.h>             // http://arduiniana.org/libraries/tinygpsplus/
#include <SD.h>


TinyGPS gps; // create a TinyGPS object
#define DHTPIN 3  
#define DHTTYPE DHT22 
DHT dht(DHTPIN, DHTTYPE);

int chipSelect=4;
int LED=7;
int LM335=0,PT1000=1,MPX5100=2,ADXLX=3,ADXLY=4,ADXLZ=5,BPW1=8,BPW2=10;
int Ax,Ay,Az,L1,L2,T0,T1;
int PWMGPS=6,PWMDHT=5;
unsigned long t0,t1, fix_age;
float lat, lon, alti, vitesse,tdht,P;
int res=5000,h,hr;
float N0=42.5,E0=3.5;     // Etalonage offset GPS et résolution en pt/°   16384 pts au total
int erreurSD=0;            // E0=4.5 Janetti changé en E0=3.5 pour Eyguières 
byte N1,N2,E1,E2,transfert;
int annee,mesure,fix,i=0,j=0,k=0;
byte c,mois, jour, seconde, minute, heure, centiemes;
String date ="";


void setup()
{
  Serial.begin(9600);
  Serial1.begin(9600); // GPS devices frequently operate at 4800 baud
  Serial.println("Initialisation...");
  pinMode(chipSelect, OUTPUT);
  digitalWrite(chipSelect,LOW);
  pinMode(LED,OUTPUT);
  if (!SD.begin(chipSelect)) { Serial.println("Erreur carte SD");erreurSD=1;} 
  else Serial.println("Carte presente");
  t1=millis();
}
void loop()
{
  t0=millis();
  acquisitionGPS();// durée d'acquisition 1s;
  do 
  {
    switch (j % 8) {                                    // La trame GPS est transférée en 8 étapes
    case 0: initransfert(); break;                     // Etalon 1 + mise en forme des coordonnées
    case 1: transfert = N1; break;                     // Latitude octet de poids fort
    case 2: transfert = 104; break;                    // Etalon 2
    case 3: transfert = N2;  break;                     // Latitude octet de poids faible
    case 4: transfert = 156; break;                     // Etalon 3                 
    case 5: transfert = E1;  break;                     // Longitude octet de poids fort
    case 6: transfert = 208; break;                     // Etalon 4 
    case 7: transfert = E2;  break;                     // Longitude octet de poids faible           
    } 
    analogWrite(PWMGPS,transfert);          
  } 
  while (millis()-t0 < 2000);  // Une mesure toutes les 2 secondes
  k++; // k : N° de mesure toutes les 2s, j : chgt transfert toutes les 3*2 = 6 s ; i: Nlle mesure GPS toutes les 8*6 = 48 s
 if (k%3==0) j++;                // 3 *2 = 6 s entre 2 transferts (8 transferts pour une trame GPS soit 48 s)
}


void acquisitionGPS()
{
  t1=millis();
  while (millis()-t1<1100)
  {  
    if (Serial1.available()){
      c = Serial1.read();
      gps.encode(c);
    }
  }
  Serial.println();
  lireGPS();
}

void lireGPS()
{
  gps.f_get_position(&lat, &lon);
  gps.crack_datetime(&annee, &mois, &jour, &heure, &minute, &seconde, ¢iemes, &fix_age);
  alti = gps.f_altitude(); // +/- altitude en mètres
  vitesse = gps.f_speed_mps();
  date =String(jour) + "/" + String(mois) + "/" + String(annee) + " "+ String (heure+2) + ":" + String (minute) + ":" + String (seconde);
  Serial.println();
  Serial.println(date);
  Serial.print("Mesure ");
  Serial.println(i);
  Serial.print(lat,5);
  Serial.print(",");
  Serial.println(lon,5);
  Serial.println(alti,1);
  Serial.println();

  mesures();
  digitalWrite(LED,1);
  if (i==0) entete();
  ecritureSD();
  if (!erreurSD) digitalWrite(LED,0);  
  i++;
  fix=0;
}

void initransfert()                    // Mise en forme des coordonnées
{
  N1=int((lat-N0)*res/256)*4;         // on se contente de 6 bits pour le poids fort (soit quantum * 4)
  N2=int((lat-N0)*res) % 256;         // reste de la division par 256 = octet de poids faible     % = modulo
  E1=int((lon-E0)*res/256)*4;
  E2=int((lon-E0)*res) % 256;
  transfert = 52;
}


void entete(){                  // Pour utiliser Google table de fusion séparateur ;  stl.janetti@gmail.com 
  File GPStab = SD.open("Mesures.csv", FILE_WRITE);
  if (GPStab) {
    GPStab.print("date"); GPStab.print(";");   
    GPStab.print("latitude"); GPStab.print(";");
    GPStab.print("longitude"); GPStab.print(";");
    GPStab.print("Altitude"); GPStab.print(";");
    GPStab.print("Vitesse"); GPStab.print(";");    
    GPStab.print("LM335"); GPStab.print(";");
    GPStab.print("PT1000"); GPStab.print(";");
    GPStab.print("MPX5100"); GPStab.print(";");
    GPStab.print("ADXL X"); GPStab.print(";");
    GPStab.print("ADXL Y"); GPStab.print(";");
    GPStab.print("ADXL Z"); GPStab.print(";");
    GPStab.print("BPW34 (1)"); GPStab.print(";");
    GPStab.print("BPW34 (2)"); GPStab.print(";");
    GPStab.print("DHT22 Hr"); GPStab.print(";");
    GPStab.println("DHT22 T");
    GPStab.close();
  }
}
void mesures() {
  h = dht.readHumidity();
  tdht = dht.readTemperature();
  hr=(alti/100); // Dernier moment : on choisit de transmettre l'altitude (max 25500 m) par le Kiwi au lieu de Hr... 
  Serial.print("Hr= ");Serial.print(h);Serial.println("%");
  Serial.print("t(DHT)= ");Serial.println(tdht,1);
  T0= analogRead(LM335); Serial.println(T0);
  //T0=0.10389*float(analogRead(LM335))-67; Serial.println(T0,1);  
  T1 = analogRead(PT1000); Serial.println(T1);
  //T1=0.109131*float(analogRead(PT1000))-69.9; Serial.println(T1,1);
  // P= analogRead(MPX5100); Serial.println(P);
  P=1.0995*float(analogRead(MPX5100))+124; Serial.println(P,1);
  Ax= analogRead(ADXLX); Serial.println(Ax);
  Ay= analogRead(ADXLY); Serial.println(Ay);
  Az= analogRead(ADXLZ); Serial.println(Az); 
  L1= analogRead(BPW1); Serial.println(L1);
  L2 = analogRead(BPW2); Serial.println(L2);
  analogWrite(PWMDHT,hr); //hr : altitude/100 ou humidité relavive à choisir... 
}

void ecritureSD() { 
  File GPStab = SD.open("Mesures.csv", FILE_WRITE);
  if (GPStab) {
    GPStab.print(date); GPStab.print(";");
    GPStab.print(lat,5); GPStab.print(";");
    GPStab.print(lon,5); GPStab.print(";");
    GPStab.print(alti,1); GPStab.print(";");
    GPStab.print(vitesse,1); GPStab.print(";");
    GPStab.print(T0,1); GPStab.print(";");
    GPStab.print(T1,1); GPStab.print(";");
    GPStab.print(P,1); GPStab.print(";");
    GPStab.print(Ax); GPStab.print(";");
    GPStab.print(Ay); GPStab.print(";");
    GPStab.print(Az); GPStab.print(";");
    GPStab.print(L1); GPStab.print(";");
    GPStab.print(L2); GPStab.print(";");
    GPStab.print(h); GPStab.print(";");
    GPStab.println(tdht,1);    
    GPStab.close();
    erreurSD=0;
  }
  else  {
    Serial.println("Erreur Mesures.csv");
    erreurSD=1;
  }
}