 
 void setup()
 {
+  pinMode(LED1, OUTPUT);
+  digitalWrite(LED1, LOW);
+  bLed1 = true;
+  pinMode(LED2, OUTPUT);
+  digitalWrite(LED2, LOW);
+  
   bme.begin();
   SoftSerial.begin(9600);
   Serial.begin(9600);

int count=0;
boolean routeStarted = false;

unsigned long interval = 1000; // the time we need to wait
unsigned long previousMillisTPHv2 = 0;
unsigned long previousMillisGPS = 0;

boolean previousButtonState = false;

Adafruit_BME280 bme;


  }

  previousButtonState = currentButtonState;
}

void setLed(int led)
{
  if(led == 1 && bLed1)
  {
      bLed1State = !bLed1State;
      if(bLed1State)
        digitalWrite(LED1, HIGH);
      else
        digitalWrite(LED1, LOW);
  }
  else
  {
    digitalWrite(LED1, LOW);
  }
  
  if(led == 2 && bLed2)
  {
      bLed2State = !bLed2State;
      if(bLed2State)
        digitalWrite(LED2, HIGH);
      else
        digitalWrite(LED2, LOW);
  }
  else
  {
    digitalWrite(LED2, LOW);
  }
}

void checkTPHv2()
