   }
   // Init LCD
   pinMode(lcd_bl, OUTPUT);
-  digitalWrite(lcd_bl, HIGH);  
+  digitalWrite(lcd_bl, HIGH);
   lcd.begin(16,2);
   lcdWrite("Initializing...");
-  
+
   espPort.begin(115200);
   lcdWrite("Initializing...", "WIFI Connecting");
   esp.enable();

  esp.reset();
  delay(500);
  while(!esp.ready());
  
  if (Debugging) {
    debugger.println("ARDUINO: Setup MQTT client");
  }
  lcdWrite("Initializing...", "MQTT Connecting");
  if (!mqtt.begin("coop_duino", "", "", 120, 1)) { // client_id, username, password, keepalive time, cleansession boolean
    if (Debugging) {
      debugger.println("ARDUINO: Failed to setup MQTT");
    }
    lcdWrite("MQTT Connect", "Failure");
    while(1);
  }
  
  mqtt.connectedCb.attach(&mqttConnected);
  mqtt.disconnectedCb.attach(&mqttDisconnected);
  mqtt.publishedCb.attach(&mqttPublished);
  mqtt.dataCb.attach(&mqttData);
  
  if (Debugging) {
    debugger.println("ARDUINO: Setup WIFI");
  }
  esp.wifiCb.attach(&wifiCb);
  esp.wifiConnect(wHost, wPass);
  
  lcdWrite("System Ready");
  
  /**
   * Setup pin modes
   */
  pinMode(lampRelay, OUTPUT);
  pinMode(heaterRelay, OUTPUT);  
  pinMode(doorOpen, OUTPUT);
  pinMode(doorClose, OUTPUT);
  pinMode(doorSpeed, OUTPUT);

  lcd.print(firstLine);
  lcd.setCursor(0,1);
  lcd.print(secondLine);
  if (Debugging) {
    debugger.println("Output to LCD:");
    debugger.println(firstLine);
    debugger.println(secondLine);
  }
}

/**
