From c0fc4980c24ea0bbb8bcd9f9406a3bd4c40ff50f Mon Sep 17 00:00:00 2001
From: DL2MF <meinhard.guenther@gmail.com>
Date: Fri, 3 May 2019 11:38:21 +0200
Subject: [PATCH] Added launchsite info to scan and webinterface

---
 RX_FSK/RX_FSK.ino              | 1124 +++++++++++++++++++++-----------
 RX_FSK/data/config.txt         |   11 +-
 RX_FSK/data/networks.txt       |    4 +-
 RX_FSK/version.h               |    2 +
 libraries/SondeLib/Scanner.cpp |    7 +-
 libraries/SondeLib/Sonde.cpp   |   44 +-
 libraries/SondeLib/Sonde.h     |    3 +-
 7 files changed, 785 insertions(+), 410 deletions(-)
 create mode 100644 RX_FSK/version.h

diff --git a/RX_FSK/RX_FSK.ino b/RX_FSK/RX_FSK.ino
index c277ec5..7496f0b 100644
--- a/RX_FSK/RX_FSK.ino
+++ b/RX_FSK/RX_FSK.ino
@@ -10,9 +10,10 @@
 #include <Sonde.h>
 #include <Scanner.h>
 #include <aprs.h>
+#include "version.h"
 
 // UNCOMMENT one of the constructor lines below
-U8X8_SSD1306_128X64_NONAME_SW_I2C *u8x8=NULL;  // initialize later after reading config file
+U8X8_SSD1306_128X64_NONAME_SW_I2C *u8x8 = NULL; // initialize later after reading config file
 //U8X8_SSD1306_128X64_NONAME_SW_I2C u8x8(/* clock=*/ OLED_SCL, /* data=*/ OLED_SDA, /* reset=*/ OLED_RST); // Unbuffered, basic graphics, software I2C
 //U8G2_SSD1306_128X64_NONAME_1_SW_I2C Display(U8G2_R0, /* clock=*/ OLED_SCL, /* data=*/ OLED_SDA, /* reset=*/ OLED_RST); // Page buffer, SW I2C
 //U8G2_SSD1306_128X64_NONAME_F_SW_I2C Display(U8G2_R0, /* clock=*/ OLED_SCL, /* data=*/ OLED_SDA, /* reset=*/ OLED_RST); // Full framebuffer, SW I2C
@@ -32,32 +33,43 @@ int ledPin = 1;
 // Stores LED state
 String ledState;
 
+// timestamp when spectrum display was activated
+static unsigned long specTimer;
+
 // Replaces placeholder with LED state value
-String processor(const String& var){
+String processor(const String& var) {
   Serial.println(var);
-  if(var == "STATE"){
-    if(digitalRead(ledPin)){
+  if (var == "STATE") {
+    if (digitalRead(ledPin)) {
       ledState = "ON";
     }
-    else{
+    else {
       ledState = "OFF";
     }
     Serial.print(ledState);
     return ledState;
   }
+  if (var == "VERSION_NAME") {
+    return String(version_name);
+  }
+  if (var == "VERSION_ID") {
+    return String(version_id);
+  }
   return String();
 }
 
 const String sondeTypeSelect(int activeType) {
   String sts = "";
-  for(int i=0; i<3; i++) {
-     sts += "<option value=\"";
-     sts += sondeTypeStr[i];
-     sts += "\"";
-     if(activeType==i) { sts += " selected"; }
-     sts += ">";
-     sts += sondeTypeStr[i];
-     sts += "</option>";
+  for (int i = 0; i < 3; i++) {
+    sts += "<option value=\"";
+    sts += sondeTypeStr[i];
+    sts += "\"";
+    if (activeType == i) {
+      sts += " selected";
+    }
+    sts += ">";
+    sts += sondeTypeStr[i];
+    sts += "</option>";
   }
   return sts;
 }
@@ -66,63 +78,85 @@ const String sondeTypeSelect(int activeType) {
 //trying to work around
 //"assertion "heap != NULL && "free() target pointer is outside heap areas"" failed:"
 // which happens if request->send is called in createQRGForm!?!??
-char message[10240];
+char message[10240 * 4]; //needs to be large enough for all forms (not checked in code)
+// QRG form is currently about 24kb with 100 entries
 
 ///////////////////////// Functions for Reading / Writing QRG list from/to qrg.txt
 
 void setupChannelList() {
   File file = SPIFFS.open("/qrg.txt", "r");
-  if(!file) {
+  if (!file) {
     Serial.println("There was an error opening the file '/qrg.txt' for reading");
     return;
   }
-  int i=0;
+  int i = 0;
+  char launchsite[17];
   sonde.clearSonde();
-  Serial.println("Reading channel config:");  
-  while(file.available()) {
+  Serial.println("Reading channel config:");
+  while (file.available()) {
     String line = file.readStringUntil('\n');
-    if(!file.available()) break;
-    if(line[0] == '#') continue;
+    String sitename;
+    if (!file.available()) break;
+    if (line[0] == '#') continue;
     char *space = strchr(line.c_str(), ' ');
-    if(!space) continue;
+    if (!space) continue;
     *space = 0;
     float freq = atof(line.c_str());
     SondeType type;
-    if(space[1]=='4') { type=STYPE_RS41; }
-    else if (space[1]=='9') { type=STYPE_DFM09; }
-    else if (space[1]=='6') { type=STYPE_DFM06; }
+    if (space[1] == '4') {
+      type = STYPE_RS41;
+    }
+    else if (space[1] == '9') {
+      type = STYPE_DFM09;
+    }
+    else if (space[1] == '6') {
+      type = STYPE_DFM06;
+    }
     else continue;
-    int active = space[3]=='+'?1:0;
-    char *launchsite = strchr(line.c_str(), ' ');
-    Serial.printf("Add %f - type %d (on/off: %d)- Site: \n",freq,type,active,launchsite);
+    int active = space[3] == '+' ? 1 : 0;
+    if (space[4] == ' ') {
+      sitename = line.substring(12) + "                ";   // Don't change start of substr(12) !!!!
+      int str_len = sitename.length() + 1;
+      sitename.toCharArray(launchsite, 17);
+
+      if (sonde.config.debug == 1) {
+        Serial.printf("Add %f - sondetype: %d (on/off: %d) - site #%d - name: %s\n ", freq, type, active, i, launchsite);
+        //Serial.println(sitename);
+      }
+    }
+
     sonde.addSonde(freq, type, active, launchsite);
     i++;
   }
+  file.close();
 }
 
 const char *createQRGForm() {
   char *ptr = message;
-  strcpy(ptr,"<html><head><link rel=\"stylesheet\" type=\"text/css\" href=\"style.css\"></head><body><form action=\"qrg.html\" method=\"post\"><table><tr><th>ID</th><th>Active</th><th>Freq</th><th>Mode</th></tr>");
-   for(int i=0; i<sonde.config.maxsonde; i++) {
-    String s = sondeTypeSelect(i>=sonde.nSonde?2:sonde.sondeList[i].type);
-     sprintf(ptr+strlen(ptr), "<tr><td>%d</td><td><input name=\"A%d\" type=\"checkbox\" %s/></td>"
-        "<td><input name=\"F%d\" type=\"text\" value=\"%3.3f\"></td>"       
-        "<td><select name=\"T%d\">%s</select></td>",
-        i+1,
-        i+1, (i<sonde.nSonde&&sonde.sondeList[i].active)?"checked":"",
-        i+1, i>=sonde.nSonde?400.000:sonde.sondeList[i].freq,
-        i+1, s.c_str());
-   }
-   strcat(ptr,"</table><input type=\"submit\" value=\"Update\"/></form></body></html>");
-   return message;
+  strcpy(ptr, "<html><head><link rel=\"stylesheet\" type=\"text/css\" href=\"style.css\"></head><body><form action=\"qrg.html\" method=\"post\"><table><tr><th>ID</th><th>Active</th><th>Freq</th><th>Launchsite</th><th>Mode</th></tr>");
+  for (int i = 0; i < sonde.config.maxsonde; i++) {
+    String s = sondeTypeSelect(i >= sonde.nSonde ? 2 : sonde.sondeList[i].type);
+    String site = sonde.sondeList[i].launchsite;
+    sprintf(ptr + strlen(ptr), "<tr><td>%d</td><td><input name=\"A%d\" type=\"checkbox\" %s/></td>"
+            "<td><input name=\"F%d\" type=\"text\" value=\"%3.3f\"></td>"
+            "<td><input name=\"S%d\" type=\"text\" value=\"%s\"></td>"
+            "<td><select name=\"T%d\">%s</select></td>",
+            i + 1,
+            i + 1, (i < sonde.nSonde && sonde.sondeList[i].active) ? "checked" : "",
+            i + 1, i >= sonde.nSonde ? 400.000 : sonde.sondeList[i].freq,
+            i + 1, i >= sonde.nSonde ? "                " : sonde.sondeList[i].launchsite,
+            i + 1, s.c_str());
+  }
+  strcat(ptr, "</table><input type=\"submit\" value=\"Update\"/></form></body></html>");
+  return message;
 }
 
 const char *handleQRGPost(AsyncWebServerRequest *request) {
   char label[10];
   // parameters: a_i, f_1, t_i  (active/frequency/type)
 #if 1
-  File f = SPIFFS.open("/qrg.txt", "w");
-  if(!f) {
+  File file = SPIFFS.open("/qrg.txt", "w");
+  if (!file) {
     Serial.println("Error while opening '/qrg.txt' for writing");
     return "Error while opening '/qrg.txt' for writing";
   }
@@ -130,29 +164,37 @@ const char *handleQRGPost(AsyncWebServerRequest *request) {
   Serial.println("Handling post request");
 #if 0
   int params = request->params();
-  for(int i=0; i<params; i++) {
-    Serial.println(request->getParam(i)->name().c_str());
+  for (int i = 0; i < params; i++) {
+    String pname = request->getParam(i)->name();
+    Serial.println(pname.c_str());
   }
 #endif
-  for(int i=1; i<=sonde.config.maxsonde; i++) {  
+  for (int i = 1; i <= sonde.config.maxsonde; i++) {
     snprintf(label, 10, "A%d", i);
     AsyncWebParameter *active = request->getParam(label, true);
     snprintf(label, 10, "F%d", i);
     AsyncWebParameter *freq = request->getParam(label, true);
-    if(!freq) continue;
+    snprintf(label, 10, "S%d", i);
+    AsyncWebParameter *launchsite = request->getParam(label, true);
+    if (!freq) continue;
     snprintf(label, 10, "T%d", i);
     AsyncWebParameter *type = request->getParam(label, true);
-    if(!type) continue;
-    const char *fstr = freq->value().c_str();
-    const char *tstr = type->value().c_str();
-    Serial.printf("Processing a=%s, f=%s, t=%s\n", active?"YES":"NO", fstr, tstr);
-    char typech = (tstr[2]=='4'?'4':tstr[3]);  // Ugly TODO 
-    f.printf("%3.3f %c %c\n", atof(fstr), typech, active?'+':'-');
+    if (!type) continue;
+    String fstring = freq->value();
+    String tstring = type->value();
+    String sstring = launchsite->value();
+    const char *fstr = fstring.c_str();
+    const char *tstr = tstring.c_str();
+    const char *sstr = sstring.c_str();
+    Serial.printf("Processing a=%s, f=%s, t=%s, site=%s\n", active ? "YES" : "NO", fstr, tstr, sstr);
+    char typech = (tstr[2] == '4' ? '4' : tstr[3]); // Ugly TODO
+    file.printf("%3.3f %c %c %s\n", atof(fstr), typech, active ? '+' : '-', sstr);
   }
-  f.close();
+  file.close();
+
   Serial.println("Channel setup finished");
   Serial.println();
-  
+  delay(500);
   setupChannelList();
 }
 
@@ -161,45 +203,52 @@ const char *handleQRGPost(AsyncWebServerRequest *request) {
 
 #define MAX_WIFI 10
 int nNetworks;
-struct { String id; String pw; } networks[MAX_WIFI];
+struct {
+  String id;
+  String pw;
+} networks[MAX_WIFI];
 
 // FIXME: For now, we don't uspport wifi networks that contain newline or null characters
 // ... would require a more sophisicated file format (currently one line SSID; one line Password
 void setupWifiList() {
   File file = SPIFFS.open("/networks.txt", "r");
-  if(!file){
+  if (!file) {
     Serial.println("There was an error opening the file '/networks.txt' for reading");
     return;
   }
-  int i=0;
-  
-  while(file.available()) {
+  int i = 0;
+
+  while (file.available()) {
     String line = file.readStringUntil('\n');
-    if(!file.available()) break;
-     networks[i].id = line;
-     networks[i].pw = file.readStringUntil('\n');
-     i++;
+    if (!file.available()) break;
+    networks[i].id = line;
+    networks[i].pw = file.readStringUntil('\n');
+    i++;
   }
   nNetworks = i;
   Serial.print(i); Serial.println(" networks in networks.txt\n");
-  for(int j=0; j<i; j++) { Serial.print(networks[j].id); Serial.print(": "); Serial.println(networks[j].pw); }
+  for (int j = 0; j < i; j++) {
+    Serial.print(networks[j].id);
+    Serial.print(": ");
+    Serial.println(networks[j].pw);
+  }
 }
 
 
 const char *createWIFIForm() {
   char *ptr = message;
   char tmp[4];
-  strcpy(ptr,"<html><head><link rel=\"stylesheet\" type=\"text/css\" href=\"style.css\"></head><body><form action=\"wifi.html\" method=\"post\"><table><tr><th>Nr</th><th>SSID</th><th>Password</th></tr>");
-  for(int i=0; i<MAX_WIFI; i++) {
-     sprintf(tmp,"%d",i);
-     sprintf(ptr+strlen(ptr), "<tr><td>%s</td><td><input name=\"S%d\" type=\"text\" value=\"%s\"/></td>"
-        "<td><input name=\"P%d\" type=\"text\" value=\"%s\"/></td>",   
-        i==0?"<b>AP</b>":tmp,
-        i+1, i<nNetworks?networks[i].id.c_str():"",
-        i+1, i<nNetworks?networks[i].pw.c_str():"");
-   }
-   strcat(ptr,"</table><input type=\"submit\" value=\"Update\"></input></form></body></html>");
-   return message;
+  strcpy(ptr, "<html><head><link rel=\"stylesheet\" type=\"text/css\" href=\"style.css\"></head><body><form action=\"wifi.html\" method=\"post\"><table><tr><th>Nr</th><th>SSID</th><th>Password</th></tr>");
+  for (int i = 0; i < MAX_WIFI; i++) {
+    sprintf(tmp, "%d", i);
+    sprintf(ptr + strlen(ptr), "<tr><td>%s</td><td><input name=\"S%d\" type=\"text\" value=\"%s\"/></td>"
+            "<td><input name=\"P%d\" type=\"text\" value=\"%s\"/></td>",
+            i == 0 ? "<b>AP</b>" : tmp,
+            i + 1, i < nNetworks ? networks[i].id.c_str() : "",
+            i + 1, i < nNetworks ? networks[i].pw.c_str() : "");
+  }
+  strcat(ptr, "</table><input type=\"submit\" value=\"Update\"></input></form></body></html>");
+  return message;
 }
 
 const char *handleWIFIPost(AsyncWebServerRequest *request) {
@@ -207,7 +256,7 @@ const char *handleWIFIPost(AsyncWebServerRequest *request) {
   // parameters: a_i, f_1, t_i  (active/frequency/type)
 #if 1
   File f = SPIFFS.open("/networks.txt", "w");
-  if(!f) {
+  if (!f) {
     Serial.println("Error while opening '/networks.txt' for writing");
     return "Error while opening '/networks.txt' for writing";
   }
@@ -215,20 +264,23 @@ const char *handleWIFIPost(AsyncWebServerRequest *request) {
   Serial.println("Handling post request");
 #if 0
   int params = request->params();
-  for(int i=0; i<params; i++) {
-    Serial.println(request->getParam(i)->name().c_str());
+  for (int i = 0; i < params; i++) {
+    String param = request->getParam(i)->name();
+    Serial.println(param.c_str());
   }
 #endif
-  for(int i=1; i<=MAX_WIFI; i++) {  
+  for (int i = 1; i <= MAX_WIFI; i++) {
     snprintf(label, 10, "S%d", i);
     AsyncWebParameter *ssid = request->getParam(label, true);
-    if(!ssid) continue;
+    if (!ssid) continue;
     snprintf(label, 10, "P%d", i);
     AsyncWebParameter *pw = request->getParam(label, true);
-    if(!pw) continue;
-    const char *sstr = ssid->value().c_str();
-    const char *pstr = pw->value().c_str();
-    if(strlen(sstr)==0) continue;
+    if (!pw) continue;
+    String sstring = ssid->value();
+    String pstring = pw->value();
+    const char *sstr = sstring.c_str();
+    const char *pstr = pstring.c_str();
+    if (strlen(sstr) == 0) continue;
     Serial.printf("Processing S=%s, P=%s\n", sstr, pstr);
     f.printf("%s\n%s\n", sstr, pstr);
   }
@@ -241,24 +293,24 @@ void addSondeStatus(char *ptr, int i)
 {
   SondeInfo *s = &sonde.sondeList[i];
   strcat(ptr, "<table>");
-  sprintf(ptr+strlen(ptr),"<tr><td id=\"sfreq\">%3.3f MHz, Type: %s</td><tr><td>ID: %s</td></tr><tr><td>QTH: %.6f,%.6f h=%.0fm</td></tr>\n",
-    s->freq, sondeTypeStr[s->type],
-    s->validID?s->id:"<??>",
-    s->lat, s->lon, s->alt);
-  sprintf(ptr+strlen(ptr), "<tr><td><a target=\"_empty\" href=\"geo:%.6f,%.6f\">GEO-App</a> - ", s->lat, s->lon);
-  sprintf(ptr+strlen(ptr), "<a target=\"_empty\" href=\"https://wx.dl2mf.de/?%s\">WX.DL2MF.de</a> - ", s->id);
-  sprintf(ptr+strlen(ptr), "<a target=\"_empty\" href=\"https://www.openstreetmap.org/?mlat=%.6f&mlon=%.6f&zoom=14\">OSM</a></td></tr>", s->lat, s->lon);
+  sprintf(ptr + strlen(ptr), "<tr><td id=\"sfreq\">%3.3f MHz, Type: %s</td><tr><td>ID: %s</td></tr><tr><td>QTH: %.6f,%.6f h=%.0fm</td></tr>\n",
+          s->freq, sondeTypeStr[s->type],
+          s->validID ? s->id : "<??>",
+          s->lat, s->lon, s->alt);
+  sprintf(ptr + strlen(ptr), "<tr><td><a target=\"_empty\" href=\"geo:%.6f,%.6f\">GEO-App</a> - ", s->lat, s->lon);
+  sprintf(ptr + strlen(ptr), "<a target=\"_empty\" href=\"https://wx.dl2mf.de/?%s\">WX.DL2MF.de</a> - ", s->id);
+  sprintf(ptr + strlen(ptr), "<a target=\"_empty\" href=\"https://www.openstreetmap.org/?mlat=%.6f&mlon=%.6f&zoom=14\">OSM</a></td></tr>", s->lat, s->lon);
   strcat(ptr, "</table><p/>\n");
 }
 
 const char *createStatusForm() {
   char *ptr = message;
-  strcpy(ptr,"<html><head><link rel=\"stylesheet\" type=\"text/css\" href=\"style.css\"><meta http-equiv=\"refresh\" content=\"5\"></head><body>");
-  
-  for(int i=0; i<sonde.nSonde; i++) {
-    addSondeStatus(ptr, (i+sonde.currentSonde)%sonde.nSonde);
+  strcpy(ptr, "<html><head><link rel=\"stylesheet\" type=\"text/css\" href=\"style.css\"><meta http-equiv=\"refresh\" content=\"5\"></head><body>");
+
+  for (int i = 0; i < sonde.nSonde; i++) {
+    addSondeStatus(ptr, (i + sonde.currentSonde) % sonde.nSonde);
   }
-  strcat(ptr,"</body></html>");
+  strcat(ptr, "</body></html>");
   return message;
 }
 
@@ -267,11 +319,11 @@ const char *createStatusForm() {
 
 void setupConfigData() {
   File file = SPIFFS.open("/config.txt", "r");
-  if(!file) {
+  if (!file) {
     Serial.println("There was an error opening the file '/config.txt' for reading");
     return;
   }
-  while(file.available()) {
+  while (file.available()) {
     String line = file.readStringUntil('\n');
     sonde.setConfig(line.c_str());
   }
@@ -279,41 +331,59 @@ void setupConfigData() {
 
 
 struct st_configitems {
+  const char *name;
   const char *label;
   int type;  // 0: numeric; i>0 string of length i; -1: separator; -2: type selector
   void *data;
-}; 
-#define N_CONFIG 20
-struct st_configitems config_list[N_CONFIG] = {
-  {"ShowSpectrum (s)", 0, &sonde.config.spectrum},
-  {"Startfreq (MHz)", 0, &sonde.config.startfreq},
-  {"Bandwidth (kHz)", 0, &sonde.config.channelbw},  
-  {"---", -1, NULL},
-  {"Call", 8, sonde.config.call},
-  {"Passcode", 8, sonde.config.passcode},
-  {"---", -1, NULL},
-  {"AXUDP active", -3, &sonde.config.udpfeed.active},
-  {"AXUDP Host", 63, sonde.config.udpfeed.host},
-  {"AXUDP Port", 0, &sonde.config.udpfeed.port},
-  {"DFM ID Format", -2, &sonde.config.udpfeed.idformat},
-  {"Rate limit", 0, &sonde.config.udpfeed.highrate},
-  {"---", -1, NULL},
-  {"APRS TCP active", -3, &sonde.config.tcpfeed.active},
-  {"ARPS TCP Host", 63, sonde.config.tcpfeed.host},
-  {"APRS TCP Port", 0, &sonde.config.tcpfeed.port},
-  {"DFM ID Format", -2, &sonde.config.tcpfeed.idformat},
-  {"Rate limit", 0, &sonde.config.tcpfeed.highrate},
-  {"---", -1, NULL},
-  {"Spectrum noise floor", 0, &sonde.config.noisefloor}
 };
 
+struct st_configitems config_list[] = {
+  /* General config settings */
+  {"wifi", "Wifi mode (0/1/2/3)", 0, &sonde.config.wifi},
+  {"debug", "Debug mode (0/1)", 0, &sonde.config.debug},
+  {"maxsonde", "Maxsonde (requires reboot?)", 0, &sonde.config.maxsonde},
+  /* Spectrum display settings */
+  {"spectrum", "ShowSpectrum (s)", 0, &sonde.config.spectrum},
+  {"startfreq", "Startfreq (MHz)", 0, &sonde.config.startfreq},
+  {"channelbw", "Bandwidth (kHz)", 0, &sonde.config.channelbw},
+  {"timer", "Spectrum Timer", 0, &sonde.config.timer},
+  {"marker", "Spectrum MHz marker", 0, &sonde.config.marker},
+  {"noisefloor", "Sepctrum noisefloor", 0, &sonde.config.noisefloor},
+  {"---", "---", -1, NULL},
+  /* APRS settings */
+  {"call", "Call", 8, sonde.config.call},
+  {"passcode", "Passcode", 8, sonde.config.passcode},
+  {"---", "---", -1, NULL},
+  /* AXUDP settings */
+  {"axudp.active", "AXUDP active", -3, &sonde.config.udpfeed.active},
+  {"axudp.host", "AXUDP Host", 63, sonde.config.udpfeed.host},
+  {"axudp.port", "AXUDP Port", 0, &sonde.config.udpfeed.port},
+  {"axudp.idformat", "DFM ID Format", -2, &sonde.config.udpfeed.idformat},
+  {"axudp.highrate", "Rate limit", 0, &sonde.config.udpfeed.highrate},
+  {"---", "---", -1, NULL},
+  /* APRS TCP settings, current not used */
+  {"tcp.active", "APRS TCP active", -3, &sonde.config.tcpfeed.active},
+  {"tcp.host", "ARPS TCP Host", 63, sonde.config.tcpfeed.host},
+  {"tcp.port", "APRS TCP Port", 0, &sonde.config.tcpfeed.port},
+  {"tcp.idformat", "DFM ID Format", -2, &sonde.config.tcpfeed.idformat},
+  {"tcp.highrate", "Rate limit", 0, &sonde.config.tcpfeed.highrate},
+  {"---", "---", -1, NULL},
+  /* Hardware dependeing settings */
+  {"oled_sda", "OLED SDA (needs reboot)", 0, &sonde.config.oled_sda},
+  {"oled_scl", "OLED SCL (needs reboot)", 0, &sonde.config.oled_scl},
+  {"oled_rst", "OLED RST (needs reboot)", 0, &sonde.config.oled_rst},
+  {"button_pin", "Button input port (needs reboot)", 0, &sonde.config.button_pin},
+  {"led_pout", "LED output port (needs reboot)", 0, &sonde.config.led_pout},
+};
+const static int N_CONFIG = (sizeof(config_list) / sizeof(struct st_configitems));
+
 void addConfigStringEntry(char *ptr, int idx, const char *label, int len, char *field) {
-   sprintf(ptr+strlen(ptr), "<tr><td>%s</td><td><input name=\"CFG%d\" type=\"text\" value=\"%s\"/></td></tr>\n",
-      label, idx, field);
+  sprintf(ptr + strlen(ptr), "<tr><td>%s</td><td><input name=\"CFG%d\" type=\"text\" value=\"%s\"/></td></tr>\n",
+          label, idx, field);
 }
 void addConfigNumEntry(char *ptr, int idx, const char *label, int *value) {
-   sprintf(ptr+strlen(ptr), "<tr><td>%s</td><td><input name=\"CFG%d\" type=\"text\" value=\"%d\"/></td></tr>\n",
-      label, idx, *value);
+  sprintf(ptr + strlen(ptr), "<tr><td>%s</td><td><input name=\"CFG%d\" type=\"text\" value=\"%d\"/></td></tr>\n",
+          label, idx, *value);
 }
 void addConfigTypeEntry(char *ptr, int idx, const char *label, int *value) {
   // TODO
@@ -322,15 +392,15 @@ void addConfigOnOffEntry(char *ptr, int idx, const char *label, int *value) {
   // TODO
 }
 void addConfigSeparatorEntry(char *ptr) {
-   strcat(ptr, "<tr><td colspan=\"2\" class=\"divider\"><hr /></td></tr>\n");
+  strcat(ptr, "<tr><td colspan=\"2\" class=\"divider\"><hr /></td></tr>\n");
 }
 
 const char *createConfigForm() {
   char *ptr = message;
   char tmp[4];
-  strcpy(ptr,"<html><head><link rel=\"stylesheet\" type=\"text/css\" href=\"style.css\"></head><body><form action=\"config.html\" method=\"post\"><table><tr><th>Option</th><th>Value</th></tr>");
-  for(int i=0; i<N_CONFIG; i++) {
-    switch(config_list[i].type) {
+  strcpy(ptr, "<html><head><link rel=\"stylesheet\" type=\"text/css\" href=\"style.css\"></head><body><form action=\"config.html\" method=\"post\"><table><tr><th>Option</th><th>Value</th></tr>");
+  for (int i = 0; i < N_CONFIG; i++) {
+    switch (config_list[i].type) {
       case -3: // in/offt
         addConfigOnOffEntry(ptr, i, config_list[i].label, (int *)config_list[i].data);
         break;
@@ -348,59 +418,98 @@ const char *createConfigForm() {
         break;
     }
   }
-  strcat(ptr,"</table><input type=\"submit\" value=\"Update not yet implemented\"></input></form></body></html>");
+  strcat(ptr, "</table><input type=\"submit\" value=\"Update\"></input></form></body></html>");
   return message;
 }
 
 
+const char *handleConfigPost(AsyncWebServerRequest *request) {
+  char label[10];
+  // parameters: a_i, f_1, t_i  (active/frequency/type)
+#if 1
+  File f = SPIFFS.open("/config.txt", "w");
+  if (!f) {
+    Serial.println("Error while opening '/config.txt' for writing");
+    return "Error while opening '/config.txt' for writing";
+  }
+#endif
+  Serial.println("Handling post request");
+#if 1
+  int params = request->params();
+  for (int i = 0; i < params; i++) {
+    String param = request->getParam(i)->name();
+    Serial.println(param.c_str());
+  }
+#endif
+  for (int i = 0; i < params; i++) {
+    String strlabel = request->getParam(i)->name();
+    const char *label = strlabel.c_str();
+    if (strncmp(label, "CFG", 3) != 0) continue;
+    int idx = atoi(label + 3);
+    Serial.printf("idx is %d\n", idx);
+    if (config_list[idx].type == -1) continue; // skip separator entries, should not happen
+    AsyncWebParameter *value = request->getParam(label, true);
+    if (!value) continue;
+    String strvalue = value->value();
+    Serial.printf("Processing  %s=%s\n", config_list[idx].name, strvalue.c_str());
+    f.printf("%s=%s\n", config_list[idx].name, strvalue.c_str());
+  }
+  f.close();
+  setupConfigData();
+}
+
 
 const char* PARAM_MESSAGE = "message";
 void SetupAsyncServer() {
-// Route for root / web page
- server.on("/", HTTP_GET, [](AsyncWebServerRequest *request){
-    request->send(SPIFFS, "/index.html", String(), false, processor);
-    });
-    
-  server.on("/index.html", HTTP_GET, [](AsyncWebServerRequest *request){
+  server.reset();
+  // Route for root / web page
+  server.on("/", HTTP_GET, [](AsyncWebServerRequest * request) {
     request->send(SPIFFS, "/index.html", String(), false, processor);
   });
 
-  server.on("/test.html", HTTP_GET, [](AsyncWebServerRequest *request){
+  server.on("/index.html", HTTP_GET, [](AsyncWebServerRequest * request) {
+    request->send(SPIFFS, "/index.html", String(), false, processor);
+  });
+
+  server.on("/test.html", HTTP_GET, [](AsyncWebServerRequest * request) {
     request->send(SPIFFS, "/test.html", String(), false, processor);
   });
 
-  server.on("/qrg.html", HTTP_GET,  [](AsyncWebServerRequest *request){
-     request->send(200, "text/html", createQRGForm());
+  server.on("/qrg.html", HTTP_GET,  [](AsyncWebServerRequest * request) {
+    request->send(200, "text/html", createQRGForm());
   });
-  server.on("/qrg.html", HTTP_POST, [](AsyncWebServerRequest *request){
+  server.on("/qrg.html", HTTP_POST, [](AsyncWebServerRequest * request) {
     handleQRGPost(request);
     request->send(200, "text/html", createQRGForm());
   });
 
-  server.on("/wifi.html", HTTP_GET,  [](AsyncWebServerRequest *request){
-     request->send(200, "text/html", createWIFIForm());
+  server.on("/wifi.html", HTTP_GET,  [](AsyncWebServerRequest * request) {
+    request->send(200, "text/html", createWIFIForm());
   });
-  server.on("/wifi.html", HTTP_POST, [](AsyncWebServerRequest *request){
+  server.on("/wifi.html", HTTP_POST, [](AsyncWebServerRequest * request) {
     handleWIFIPost(request);
     request->send(200, "text/html", createWIFIForm());
   });
 
-  server.on("/config.html", HTTP_GET,  [](AsyncWebServerRequest *request){
-     request->send(200, "text/html", createConfigForm());
-  });  
-
-  server.on("/status.html", HTTP_GET,  [](AsyncWebServerRequest *request){
-     request->send(200, "text/html", createStatusForm());
+  server.on("/config.html", HTTP_GET,  [](AsyncWebServerRequest * request) {
+    request->send(200, "text/html", createConfigForm());
   });
-  
+  server.on("/config.html", HTTP_POST, [](AsyncWebServerRequest * request) {
+    handleConfigPost(request);
+    request->send(200, "text/html", createConfigForm());
+  });
+  server.on("/status.html", HTTP_GET,  [](AsyncWebServerRequest * request) {
+    request->send(200, "text/html", createStatusForm());
+  });
+
   // Route to load style.css file
-  server.on("/style.css", HTTP_GET, [](AsyncWebServerRequest *request){
+  server.on("/style.css", HTTP_GET, [](AsyncWebServerRequest * request) {
     request->send(SPIFFS, "/style.css", "text/css");
   });
 
-   // Route to set GPIO to HIGH
-  server.on("/test.php", HTTP_POST, [](AsyncWebServerRequest *request){
-    //digitalWrite(ledPin, HIGH);    
+  // Route to set GPIO to HIGH
+  server.on("/test.php", HTTP_POST, [](AsyncWebServerRequest * request) {
+    //digitalWrite(ledPin, HIGH);
     request->send(SPIFFS, "/index.html", String(), false, processor);
   });
 
@@ -408,21 +517,49 @@ void SetupAsyncServer() {
   server.begin();
 }
 
+int fetchWifiIndex(const char *id) {
+  for (int i = 0; i < nNetworks; i++) {
+    if (strcmp(id, networks[i].id.c_str()) == 0) {
+      Serial.printf("Match for %s at %d\n", id, i);
+      return i;
+    }
+    Serial.printf("No match: '%s' vs '%s'\n", id, networks[i].id.c_str());
+    const char *cfgid = networks[i].id.c_str();
+    int len = strlen(cfgid);
+    if (strlen(id) > len) len = strlen(id);
+    Serial.print("SSID: ");
+    for (int i = 0; i < len; i++) {
+      Serial.printf("%02x ", id[i]);
+    } Serial.println("");
+    Serial.print("Conf: ");
+    for (int i = 0; i < len; i++) {
+      Serial.printf("%02x ", cfgid[i]);
+    } Serial.println("");
+  }
+  return -1;
+}
+
+const char *fetchWifiSSID(int i) {
+  return networks[i].id.c_str();
+}
+const char *fetchWifiPw(int i) {
+  return networks[i].pw.c_str();
+}
 
 const char *fetchWifiPw(const char *id) {
-  for(int i=0; i<nNetworks; i++) {
+  for (int i = 0; i < nNetworks; i++) {
     //Serial.print("Comparing '");
     //Serial.print(id);
     //Serial.print("' and '");
     //Serial.print(networks[i].id.c_str());
     //Serial.println("'");
-    if(strcmp(id,networks[i].id.c_str())==0) return networks[i].pw.c_str();
+    if (strcmp(id, networks[i].id.c_str()) == 0) return networks[i].pw.c_str();
   }
   return NULL;
 }
-  
 
-enum KeyPress { KP_NONE=0, KP_SHORT, KP_DOUBLE, KP_MID, KP_LONG };
+
+enum KeyPress { KP_NONE = 0, KP_SHORT, KP_DOUBLE, KP_MID, KP_LONG };
 
 struct Button {
   uint8_t pin;
@@ -434,8 +571,8 @@ struct Button {
 Button button1 = {0, 0, KP_NONE, 0, false};
 
 void IRAM_ATTR buttonISR() {
-  if(digitalRead(button1.pin)==0) { // Button down
-    if(millis()-button1.press_ts<500) {
+  if (digitalRead(button1.pin) == 0) { // Button down
+    if (millis() - button1.press_ts < 500) {
       // Double press
       button1.doublepress = true;
     } else {
@@ -443,13 +580,17 @@ void IRAM_ATTR buttonISR() {
     }
     button1.press_ts = millis();
   } else { //Button up
-    unsigned int elapsed = millis()-button1.press_ts;
-    if(elapsed>1500) {
-      if(elapsed<4000) { button1.pressed=KP_MID; }
-      else { button1.pressed=KP_LONG; }
+    unsigned int elapsed = millis() - button1.press_ts;
+    if (elapsed > 1500) {
+      if (elapsed < 4000) {
+        button1.pressed = KP_MID;
+      }
+      else {
+        button1.pressed = KP_LONG;
+      }
     } else {
-      if(button1.doublepress) button1.pressed=KP_DOUBLE;
-      else button1.pressed=KP_SHORT;
+      if (button1.doublepress) button1.pressed = KP_DOUBLE;
+      else button1.pressed = KP_SHORT;
     }
     button1.numberKeyPresses += 1;
     button1.press_ts = millis();
@@ -467,21 +608,26 @@ int hasKeyPress() {
 
 void setup()
 {
-  char buf[12];  
+  char buf[12];
   // Open serial communications and wait for port to open:
   Serial.begin(115200);
+  for (int i = 0; i < 39; i++) {
+    int v = gpio_get_level((gpio_num_t)i);
+    Serial.printf("%d:%d ", i, v);
+  }
+  Serial.println("");
   pinMode(LORA_LED, OUTPUT);
-  
+
   aprs_gencrctab();
 
   // Initialize SPIFFS
-  if(!SPIFFS.begin(true)){
+  if (!SPIFFS.begin(true)) {
     Serial.println("An Error has occurred while mounting SPIFFS");
     return;
   }
-  
-  setupConfigData();    // configuration must be read first due to OLED ports!!! 
-  LORA_LED = sonde.config.led_pout; 
+
+  setupConfigData();    // configuration must be read first due to OLED ports!!!
+  LORA_LED = sonde.config.led_pout;
 
   u8x8 = new U8X8_SSD1306_128X64_NONAME_SW_I2C(/* clock=*/ sonde.config.oled_scl, /* data=*/ sonde.config.oled_sda, /* reset=*/ sonde.config.oled_rst); // Unbuffered, basic graphics, software I2C
   u8x8->begin();
@@ -490,60 +636,62 @@ void setup()
   u8x8->clear();
 
   u8x8->setFont(u8x8_font_7x14_1x2_r);
-  u8x8->drawString(1, 1, "RDZ_TTGO_SONDE"); 
-  u8x8->drawString(2, 3, "    V0.1e");   
-  u8x8->drawString(1, 5, "Mods by DL2MF");     
+  u8x8->drawString(8 - strlen(version_name) / 2, 1, version_name);
+  u8x8->drawString(8 - strlen(version_id) / 2, 3, version_id);
+  u8x8->setFont(u8x8_font_chroma48medium8_r);
+  u8x8->drawString(0, 5, "by Hansi, DL9RDZ");
+  u8x8->drawString(1, 6, "Mods by DL2MF");
   delay(3000);
- 
+
   sonde.clearDisplay();
-  
+
   setupWifiList();
   button1.pin = sonde.config.button_pin;
 
   // == show initial values from config.txt ========================= //
-  if (sonde.config.debug == 1) {
-  u8x8->setFont(u8x8_font_chroma48medium8_r);
-  u8x8->drawString(0, 0, "Config:");
+  if (sonde.config.debug == 2) {
+    u8x8->setFont(u8x8_font_chroma48medium8_r);
+    u8x8->drawString(0, 0, "Config:");
 
-  delay(500);
-  itoa(sonde.config.oled_sda, buf, 10);
-  u8x8->drawString(0, 1, " SDA:");
-  u8x8->drawString(6, 1, buf);                        
+    delay(500);
+    itoa(sonde.config.oled_sda, buf, 10);
+    u8x8->drawString(0, 1, " SDA:");
+    u8x8->drawString(6, 1, buf);
 
-  delay(500);
-  itoa(sonde.config.oled_scl, buf, 10);
-  u8x8->drawString(0, 2, " SCL:");            
-  u8x8->drawString(6, 2, buf);                        
+    delay(500);
+    itoa(sonde.config.oled_scl, buf, 10);
+    u8x8->drawString(0, 2, " SCL:");
+    u8x8->drawString(6, 2, buf);
 
-  delay(500);
-  itoa(sonde.config.oled_rst, buf, 10);
-  u8x8->drawString(0, 3, " RST:");
-  u8x8->drawString(6, 3, buf);  
+    delay(500);
+    itoa(sonde.config.oled_rst, buf, 10);
+    u8x8->drawString(0, 3, " RST:");
+    u8x8->drawString(6, 3, buf);
 
-  delay(1000);
-  itoa(sonde.config.led_pout, buf, 10);
-  u8x8->drawString(0, 4, " LED:");
-  u8x8->drawString(6, 4, buf);  
+    delay(1000);
+    itoa(sonde.config.led_pout, buf, 10);
+    u8x8->drawString(0, 4, " LED:");
+    u8x8->drawString(6, 4, buf);
 
-  delay(500);
-  itoa(sonde.config.spectrum, buf, 10);
-  u8x8->drawString(0, 5, " SPEC:");
-  u8x8->drawString(6, 5, buf);                          
+    delay(500);
+    itoa(sonde.config.spectrum, buf, 10);
+    u8x8->drawString(0, 5, " SPEC:");
+    u8x8->drawString(6, 5, buf);
 
-  delay(500);
-  itoa(sonde.config.maxsonde, buf, 10);
-  u8x8->drawString(0, 6, " MAX:");
-  u8x8->drawString(6, 6, buf);   
-  
-  delay(5000);
-  sonde.clearDisplay(); 
-  } 
-  // == show initial values from config.txt ========================= //  
-  
+    delay(500);
+    itoa(sonde.config.maxsonde, buf, 10);
+    u8x8->drawString(0, 6, " MAX:");
+    u8x8->drawString(6, 6, buf);
 
-#if 0 
+    delay(5000);
+    sonde.clearDisplay();
+  }
+  // == show initial values from config.txt ========================= //
+
+
+#if 0
   // == check the radio chip by setting default frequency =========== //
-  if(rs41.setFrequency(402700000)==0) {
+  if (rs41.setFrequency(402700000) == 0) {
     Serial.println(F("Setting freq: SUCCESS "));
   } else {
     Serial.println(F("Setting freq: ERROR "));
@@ -551,7 +699,7 @@ void setup()
   float f = sx1278.getFrequency();
   Serial.print("Frequency set to ");
   Serial.println(f);
-  // == check the radio chip by setting default frequency =========== //  
+  // == check the radio chip by setting default frequency =========== //
 #endif
 
   //sx1278.setLNAGain(-48);
@@ -567,7 +715,7 @@ void setup()
   Serial.println("Setup finished");
   Serial.println();
   // int returnValue = pthread_create(&wifithread, NULL, wifiloop, (void *)0);
- 
+
   //  if (returnValue) {
   //     Serial.println("An error has occurred");
   //  }
@@ -578,32 +726,38 @@ void setup()
 
   // == setup default channel list if qrg.txt read fails =========== //
   setupChannelList();
- #if 0
+#if 0
   sonde.clearSonde();
   sonde.addSonde(402.700, STYPE_RS41);
   sonde.addSonde(405.700, STYPE_RS41);
-  sonde.addSonde(405.900, STYPE_RS41);  
+  sonde.addSonde(405.900, STYPE_RS41);
   sonde.addSonde(403.450, STYPE_DFM09);
   Serial.println("No channel config file, using defaults!");
-  Serial.println();  
- #endif
+  Serial.println();
+#endif
   /// not here, done by sonde.setup(): rs41.setup();
   // == setup default channel list if qrg.txt read fails =========== //
-  
+
   sonde.setup();
+
+  WiFi.onEvent(WiFiEvent);
 }
 
 enum MainState { ST_DECODER, ST_SCANNER, ST_SPECTRUM, ST_WIFISCAN };
-
-static MainState mainState = ST_WIFISCAN;
+static MainState mainState = ST_WIFISCAN; // ST_WIFISCAN;
 
 void enterMode(int mode) {
   mainState = (MainState)mode;
+  if (mainState == ST_SPECTRUM) {
+    sonde.clearDisplay();
+    u8x8->setFont(u8x8_font_chroma48medium8_r);
+    specTimer = millis();
+  }
   sonde.clearDisplay();
 }
 
 void loopDecoder() {
-  switch(getKeyPress()) {
+  switch (getKeyPress()) {
     case KP_SHORT:
       sonde.nextConfig();
       sonde.updateDisplayRXConfig();
@@ -622,58 +776,62 @@ void loopDecoder() {
   // sonde knows the current type and frequency, and delegates to the right decoder
   int res = sonde.receiveFrame();
 
-  if(res==0 && connected){
+  if (res == 0 && connected) {
     //Send a packet with position information
     // first check if ID and position lat+lonis ok
-    if(sonde.si()->validID && (sonde.si()->validPos&0x03==0x03)) {
+    if (sonde.si()->validID && (sonde.si()->validPos & 0x03 == 0x03)) {
       Serial.println("Sending position via UDP");
       SondeInfo *s = sonde.si();
       char raw[201];
-      const char *str = aprs_senddata(s->lat, s->lon, s->alt, s->hs, s->dir, s->vs, sondeTypeStr[s->type], s->id, "TE0ST", 
-        sonde.config.udpfeed.symbol);
+      const char *str = aprs_senddata(s->lat, s->lon, s->alt, s->hs, s->dir, s->vs, sondeTypeStr[s->type], s->id, "TE0ST",
+                                      sonde.config.udpfeed.symbol);
       int rawlen = aprsstr_mon2raw(str, raw, APRS_MAXLEN);
       Serial.print("Sending: "); Serial.println(raw);
-      udp.beginPacket(sonde.config.udpfeed.host,sonde.config.udpfeed.port);
-      udp.write((const uint8_t *)raw,rawlen);
+      udp.beginPacket(sonde.config.udpfeed.host, sonde.config.udpfeed.port);
+      udp.write((const uint8_t *)raw, rawlen);
       udp.endPacket();
     }
-  }  
+  }
   sonde.updateDisplay();
 }
 
 #define SCAN_MAXTRIES 1
 void loopScanner() {
   sonde.updateDisplayScanner();
-  static int tries=0;
-  switch(getKeyPress()) {
+  static int tries = 0;
+  switch (getKeyPress()) {
     case KP_SHORT:
-       enterMode(ST_DECODER);
-       return;
+      enterMode(ST_DECODER);
+      return;
     case KP_DOUBLE: break; /* ignored */
     case KP_MID:
-       enterMode(ST_SPECTRUM);
-       return;
-     case KP_LONG:
-       enterMode(ST_WIFISCAN);
-       return;
+      enterMode(ST_SPECTRUM);
+      return;
+    case KP_LONG:
+      enterMode(ST_WIFISCAN);
+      return;
   }
   // receiveFrame returns 0 on success, 1 on timeout
   int res = sonde.receiveFrame();   // Maybe instead of receiveFrame, just detect if right type is present? TODO
   Serial.print("Scanner: receiveFrame returned: ");
   Serial.println(res);
-  if(res==0) {
-      enterMode(ST_DECODER);
-      return;
+  if (res == 0) {
+    enterMode(ST_DECODER);
+    return;
   }
-  if(++tries>=SCAN_MAXTRIES && !hasKeyPress()) {
+  if (++tries >= SCAN_MAXTRIES && !hasKeyPress()) {
     sonde.nextConfig();
     tries = 0;
   }
 }
 
+
 void loopSpectrum() {
-  switch(getKeyPress()) {
-    case KP_SHORT: /* move selection of peak, TODO */ 
+  int marker = 0;
+  char buf[10];
+
+  switch (getKeyPress()) {
+    case KP_SHORT: /* move selection of peak, TODO */
       sonde.nextConfig(); // TODO: Should be set specific frequency
       enterMode(ST_DECODER);
       return;
@@ -684,43 +842,37 @@ void loopSpectrum() {
     case KP_DOUBLE: /* ignore */ break;
     default: break;
   }
+
   scanner.scan();
   scanner.plotResult();
+  if (sonde.config.marker != 0) {
+    itoa((sonde.config.startfreq), buf, 10);
+    u8x8->drawString(0, 1, buf);
+    u8x8->drawString(7, 1, "MHz");
+    itoa((sonde.config.startfreq + 6), buf, 10);
+    u8x8->drawString(13, 1, buf);
+  }
+  if (sonde.config.timer) {
+    int remaining = sonde.config.spectrum - (millis() - specTimer) / 1000;
+    itoa(remaining, buf, 10);
+    Serial.printf("timer:%d config.spectrum:%d  specTimer:%ld millis:%ld remaining:%d\n", sonde.config.timer, sonde.config.spectrum, specTimer, millis(), remaining);
+    if (sonde.config.marker != 0) {
+      marker = 1;
+    }
+    u8x8->drawString(0, 1 + marker, buf);
+    u8x8->drawString(2, 1 + marker, "Sec.");
+    if (remaining <= 0) {
+      enterMode(ST_SCANNER);
+    }
+  }
 }
 
 void startSpectrumDisplay() {
-  int marker=0;
-  char buf[5];
-
   sonde.clearDisplay();
   u8x8->setFont(u8x8_font_chroma48medium8_r);
   u8x8->drawString(0, 0, "Spectrum Scan...");
   delay(500);
-
   enterMode(ST_SPECTRUM);
-
-  for (int i = 0; i < sonde.config.spectrum; i++) {
-    scanner.scan();
-    scanner.plotResult();
-
-     if (sonde.config.marker != 0) {
-     itoa((sonde.config.startfreq), buf, 10);
-     u8x8->drawString(0, 1, buf);
-     u8x8->drawString(7, 1, "MHz");
-     itoa((sonde.config.startfreq + 6), buf, 10);
-     u8x8->drawString(13, 1, buf);
-     }
-
-    if (sonde.config.timer != 0) {
-     itoa((sonde.config.spectrum - i), buf, 10);
-     if (sonde.config.marker != 0) {
-       marker = 1;
-     }
-     u8x8->drawString(0, 1+marker, buf);
-     u8x8->drawString(2, 1+marker, "Sec.");
-    }
-   }
-   delay(1000);
 }
 
 String translateEncryptionType(wifi_auth_mode_t encryptionType) {
@@ -740,144 +892,350 @@ String translateEncryptionType(wifi_auth_mode_t encryptionType) {
   }
 }
 
-//wifi event handler
-void WiFiEvent(WiFiEvent_t event){
-    switch(event) {
-      case SYSTEM_EVENT_STA_GOT_IP:
-          //When connected set 
-          Serial.print("WiFi connected! IP address: ");
-          Serial.println(WiFi.localIP());  
-          //initializes the UDP state
-          //This initializes the transfer buffer
-          udp.begin(WiFi.localIP(),LOCALUDPPORT);
-          connected = true;
-          break;
-      case SYSTEM_EVENT_STA_DISCONNECTED:
-          Serial.println("WiFi lost connection");
-          connected = false;
-          break;
-    }
+void enableNetwork(bool enable) {
+  if (enable) {
+    SetupAsyncServer();
+    udp.begin(WiFi.localIP(), LOCALUDPPORT);
+    connected = true;
+  } else {
+    connected = false;
+  }
 }
 
-static char* _scan[2]={"/","\\"};
+
+enum t_wifi_state { WIFI_DISABLED, WIFI_SCAN, WIFI_CONNECT, WIFI_CONNECTED, WIFI_APMODE };
+
+static t_wifi_state wifi_state = WIFI_DISABLED;
+
+// Events used only for debug output right now
+void WiFiEvent(WiFiEvent_t event)
+{
+  Serial.printf("[WiFi-event] event: %d\n", event);
+
+  switch (event) {
+    case SYSTEM_EVENT_WIFI_READY:
+      Serial.println("WiFi interface ready");
+      break;
+    case SYSTEM_EVENT_SCAN_DONE:
+      Serial.println("Completed scan for access points");
+      break;
+    case SYSTEM_EVENT_STA_START:
+      Serial.println("WiFi client started");
+      break;
+    case SYSTEM_EVENT_STA_STOP:
+      Serial.println("WiFi clients stopped");
+      break;
+    case SYSTEM_EVENT_STA_CONNECTED:
+      Serial.println("Connected to access point");
+      break;
+    case SYSTEM_EVENT_STA_DISCONNECTED:
+      Serial.println("Disconnected from WiFi access point");
+      if (wifi_state == WIFI_CONNECT) {
+        // If we get a disconnect event while waiting for connection (as I do sometimes with my FritzBox),
+        // just start from scratch with WiFi scan
+        wifi_state = WIFI_DISABLED;
+        WiFi.disconnect(true);
+      }
+      break;
+    case SYSTEM_EVENT_STA_AUTHMODE_CHANGE:
+      Serial.println("Authentication mode of access point has changed");
+      break;
+    case SYSTEM_EVENT_STA_GOT_IP:
+      Serial.print("Obtained IP address: ");
+      Serial.println(WiFi.localIP());
+      break;
+    case SYSTEM_EVENT_STA_LOST_IP:
+      Serial.println("Lost IP address and IP address is reset to 0");
+      break;
+    case SYSTEM_EVENT_STA_WPS_ER_SUCCESS:
+      Serial.println("WiFi Protected Setup (WPS): succeeded in enrollee mode");
+      break;
+    case SYSTEM_EVENT_STA_WPS_ER_FAILED:
+      Serial.println("WiFi Protected Setup (WPS): failed in enrollee mode");
+      break;
+    case SYSTEM_EVENT_STA_WPS_ER_TIMEOUT:
+      Serial.println("WiFi Protected Setup (WPS): timeout in enrollee mode");
+      break;
+    case SYSTEM_EVENT_STA_WPS_ER_PIN:
+      Serial.println("WiFi Protected Setup (WPS): pin code in enrollee mode");
+      break;
+    case SYSTEM_EVENT_AP_START:
+      Serial.println("WiFi access point started");
+      break;
+    case SYSTEM_EVENT_AP_STOP:
+      Serial.println("WiFi access point  stopped");
+      break;
+    case SYSTEM_EVENT_AP_STACONNECTED:
+      Serial.println("Client connected");
+      break;
+    case SYSTEM_EVENT_AP_STADISCONNECTED:
+      Serial.println("Client disconnected");
+      break;
+    case SYSTEM_EVENT_AP_STAIPASSIGNED:
+      Serial.println("Assigned IP address to client");
+      break;
+    case SYSTEM_EVENT_AP_PROBEREQRECVED:
+      Serial.println("Received probe request");
+      break;
+    case SYSTEM_EVENT_GOT_IP6:
+      Serial.println("IPv6 is preferred");
+      break;
+    case SYSTEM_EVENT_ETH_START:
+      Serial.println("Ethernet started");
+      break;
+    case SYSTEM_EVENT_ETH_STOP:
+      Serial.println("Ethernet stopped");
+      break;
+    case SYSTEM_EVENT_ETH_CONNECTED:
+      Serial.println("Ethernet connected");
+      break;
+    case SYSTEM_EVENT_ETH_DISCONNECTED:
+      Serial.println("Ethernet disconnected");
+      break;
+    case SYSTEM_EVENT_ETH_GOT_IP:
+      Serial.println("Obtained IP address");
+      break;
+  }
+}
+
+
+int wifiConnect(int16_t res) {
+  Serial.printf("WLAN scan result: found %d networks\n", res);
+
+  // pick best network
+  int bestEntry = -1;
+  int bestRSSI = INT_MIN;
+  uint8_t bestBSSID[6];
+  int32_t bestChannel = 0;
+
+  for (int8_t i = 0; i < res; i++) {
+    String ssid_scan;
+    int32_t rssi_scan;
+    uint8_t sec_scan;
+    uint8_t* BSSID_scan;
+    int32_t chan_scan;
+    WiFi.getNetworkInfo(i, ssid_scan, sec_scan, rssi_scan, BSSID_scan, chan_scan);
+    int networkEntry = fetchWifiIndex(ssid_scan.c_str());
+    if (networkEntry < 0) continue;
+    if (rssi_scan <= bestRSSI) continue;
+    bestEntry = networkEntry;
+    bestRSSI = rssi_scan;
+    bestChannel = chan_scan;
+    memcpy((void*) &bestBSSID, (void*) BSSID_scan, sizeof(bestBSSID));
+  }
+  WiFi.scanDelete();
+  if (bestEntry >= 0) {
+    Serial.printf("WiFi Connecting BSSID: %02X:%02X:%02X:%02X:%02X:%02X SSID: %s PW %s Channel: %d (RSSI %d)\n", bestBSSID[0], bestBSSID[1], bestBSSID[2], bestBSSID[3], bestBSSID[4], bestBSSID[5], fetchWifiSSID(bestEntry), fetchWifiPw(bestEntry), bestChannel, bestRSSI);
+    WiFi.begin(fetchWifiSSID(bestEntry), fetchWifiPw(bestEntry), bestChannel, bestBSSID);
+    wifi_state = WIFI_CONNECT;
+  } else {
+    // rescan
+    // wifiStart();
+    WiFi.disconnect(true);
+    wifi_state = WIFI_DISABLED;
+  }
+}
+
+static int wifi_cto;
+
+void loopWifiBackground() {
+  Serial.printf("WifiBackground: state %d\n", wifi_state);
+  // handle Wifi station mode in background
+  if (sonde.config.wifi == 0 || sonde.config.wifi == 2) return; // nothing to do if disabled or access point mode
+
+  if (wifi_state == WIFI_DISABLED) {  // stopped => start can
+    wifi_state = WIFI_SCAN;
+    Serial.println("WLAN start scan");
+    WiFi.scanNetworks(true); // scan in async mode
+  } else if (wifi_state == WIFI_SCAN) {
+    int16_t res = WiFi.scanComplete();
+    if (res == 0 || res == WIFI_SCAN_FAILED) {
+      // retry
+      Serial.println("WLAN restart scan");
+      WiFi.disconnect(true);
+      wifi_state = WIFI_DISABLED;
+      return;
+    }
+    if (res == WIFI_SCAN_RUNNING) {
+      return;
+    }
+    // Scan finished, try to connect
+    wifiConnect(res);
+    wifi_cto = 0;
+  } else if (wifi_state == WIFI_CONNECT) {
+    wifi_cto++;
+    if (WiFi.isConnected()) {
+      wifi_state = WIFI_CONNECTED;
+      // update IP in display
+      String localIPstr = WiFi.localIP().toString();
+      sonde.setIP(localIPstr.c_str(), false);
+      sonde.updateDisplayIP();
+      enableNetwork(true);
+    }
+    if (wifi_cto > 20) { // failed, restart scanning
+      wifi_state = WIFI_DISABLED;
+      WiFi.disconnect(true);
+    }
+  } else if (wifi_state == WIFI_CONNECTED) {
+    if (!WiFi.isConnected()) {
+      sonde.clearIP();
+      sonde.updateDisplayIP();
+      wifi_state = WIFI_DISABLED;  // restart scan
+      enableNetwork(false);
+      WiFi.disconnect(true);
+    }
+  }
+}
+
+void startAP() {
+  Serial.println("Activating access point mode");
+  wifi_state = WIFI_APMODE;
+  WiFi.softAP(networks[0].id.c_str(), networks[0].pw.c_str());
+  IPAddress myIP = WiFi.softAPIP();
+  String myIPstr = myIP.toString();
+  sonde.setIP(myIPstr.c_str(), true);
+  sonde.updateDisplayIP();
+  SetupAsyncServer();
+}
+
+void initialMode() {
+  if (sonde.config.spectrum != 0) {    // enable Spectrum in config.txt: spectrum=number_of_seconds
+    startSpectrumDisplay();
+    //done in startSpectrumScan(): enterMode(ST_SPECTRUM);
+  } else {
+    enterMode(ST_SCANNER);
+  }
+}
+
+// Wifi modes
+// 0: disabled. directly start initial mode (spectrum or scanner)
+// 1: station mode in background. directly start initial mode (spectrum or scanner)
+// 2: access point mode in background. directly start initial mode (spectrum or scanner)
+// 3: traditional sync. WifiScan. Tries to connect to a network, in case of failure activates AP.
+//    Mode 3 shows more debug information on serial port and display.
+#define MAXWIFIDELAY 20
+static const char* _scan[2] = {"/", "\\"};
 void loopWifiScan() {
+  if (sonde.config.wifi == 0) {   // no Wifi
+    wifi_state = WIFI_DISABLED;
+    initialMode();
+    return;
+  }
+  if (sonde.config.wifi == 1) { // station mode, setup in background
+    wifi_state = WIFI_DISABLED;  // will start scanning in wifiLoopBackgroiund
+    initialMode();
+    return;
+  }
+  if (sonde.config.wifi == 2) { // AP mode, setup in background
+    startAP();
+    initialMode();
+    return;
+  }
+  // wifi==3 => original mode with non-async wifi setup
   u8x8->setFont(u8x8_font_chroma48medium8_r);
-  if (sonde.config.wifi != 0) {
-    u8x8->drawString(0,0,"WiFi Scan...");
-  }
-  else if (sonde.config.wifiap != 0) {
-    u8x8->drawString(0,0,"WiFi AP-Mode:");
-  }
-  
-  int line=0;
-  int cnt=0;
+  u8x8->drawString(0, 0, "WiFi Scan...");
+
+  int line = 0;
+  int cnt = 0;
+  int marker = 0;
+  char buf[5];
 
   WiFi.disconnect(true);
   WiFi.mode(WIFI_STA);
-  const char *id, *pw, *wifipw;
-  char idstr[64]="test";
-
-  if (sonde.config.wifi != 0) {
-    int n = WiFi.scanNetworks();
-     for (int i = 0; i < n; i++) {
-        Serial.print("Network name: ");
-        Serial.println(WiFi.SSID(i));
-        u8x8->drawString(0,1+line,WiFi.SSID(i).c_str());
-        line = (line+1)%5;
-        Serial.print("Signal strength: ");
-        Serial.println(WiFi.RSSI(i));
-        Serial.print("MAC address: ");
-        Serial.println(WiFi.BSSIDstr(i));
-        Serial.print("Encryption type: ");
-        String encryptionTypeDescription = translateEncryptionType(WiFi.encryptionType(i));
-        Serial.println(encryptionTypeDescription);
-        Serial.println("-----------------------");
-        id=WiFi.SSID(i).c_str();
-        pw=fetchWifiPw(id);
-        if(pw) {
-          strncpy(idstr, id, 63);
-          wifipw = pw;
-        }
-      }
-      if(!wifipw) { wifipw="test"; }
-      Serial.print("Connecting to: "); Serial.println(idstr);
-      u8x8->drawString(0,6, "Conn:");
-      u8x8->drawString(6,6, idstr);
-      //register event handler
-      WiFi.onEvent(WiFiEvent);
-  
-      WiFi.begin(idstr, wifipw);
+  int index = -1;
+  int n = WiFi.scanNetworks();
+  for (int i = 0; i < n; i++) {
+    Serial.print("Network name: ");
+    String ssid = WiFi.SSID(i);
+    Serial.println(ssid);
+    u8x8->drawString(0, 1 + line, ssid.c_str());
+    line = (line + 1) % 5;
+    Serial.print("Signal strength: ");
+    Serial.println(WiFi.RSSI(i));
+    Serial.print("MAC address: ");
+    Serial.println(WiFi.BSSIDstr(i));
+    Serial.print("Encryption type: ");
+    String encryptionTypeDescription = translateEncryptionType(WiFi.encryptionType(i));
+    Serial.println(encryptionTypeDescription);
+    Serial.println("-----------------------");
+    int curidx = fetchWifiIndex(ssid.c_str());
+    if (curidx >= 0 && index == -1) {
+      index = curidx;
+      Serial.printf("Match found at scan entry %d, config network %d\n", i, index);
+    }
   }
-  
-  while(WiFi.status() != WL_CONNECTED)  {
+  if (index >= 0) { // some network was found
+    Serial.print("Connecting to: "); Serial.print(fetchWifiSSID(index));
+    Serial.print(" with password "); Serial.println(fetchWifiPw(index));
+
+    u8x8->drawString(0, 6, "Conn:");
+    u8x8->drawString(6, 6, fetchWifiSSID(index));
+    WiFi.begin(fetchWifiSSID(index), fetchWifiPw(index));
+    while (WiFi.status() != WL_CONNECTED && cnt < MAXWIFIDELAY)  {
+      delay(500);
+      Serial.print(".");
+      if (cnt == 5) {
+        // my FritzBox needs this for reconnecting
+        WiFi.disconnect(true);
         delay(500);
-        Serial.print(".");
-        u8x8->drawString(15,7,_scan[cnt&1]);
-        cnt++;
-        #if 0
-        if(cnt==4) {
-            WiFi.disconnect(true);  // retry, for my buggy FritzBox
-            WiFi.onEvent(WiFiEvent);
-            WiFi.begin(idstr, wifipw);
-        }
-        #endif
-        if(cnt==15) {
-            WiFi.disconnect(true);
-            
-            if (sonde.config.wifiap != 0) {         // enable WiFi AP mode in config.txt: wifi=1
-              delay(1000);
-              WiFi.softAP(networks[0].id.c_str(),networks[0].pw.c_str());
-              IPAddress myIP = WiFi.softAPIP();
-              Serial.print("AP IP address: ");
-              Serial.println(myIP);
-              u8x8->drawString(0,6, "AP:             ");
-              u8x8->drawString(6,6, networks[0].id.c_str());
-              sonde.setIP(myIP.toString().c_str(), true);
-              sonde.updateDisplayIP();
-              SetupAsyncServer();
-              delay(3000);
-            }
-
-            if (sonde.config.spectrum != 0) {     // enable Spectrum in config.txt: spectrum=number_of_seconds
-              startSpectrumDisplay();
-            }           
-
-            enterMode(ST_SCANNER);
-            return;
-        }
-
+        WiFi.begin(fetchWifiSSID(index), fetchWifiPw(index));
+        Serial.print("Reconnecting to: "); Serial.print(fetchWifiSSID(index));
+        Serial.print(" with password "); Serial.println(fetchWifiPw(index));
+        delay(500);
+      }
+      u8x8->drawString(15, 7, _scan[cnt & 1]);
+      cnt++;
+    }
+  }
+  if (index < 0 || cnt >= MAXWIFIDELAY) { // no network found, or connect not successful
+    WiFi.disconnect(true);
+    delay(1000);
+    startAP();
+    IPAddress myIP = WiFi.softAPIP();
+    Serial.print("AP IP address: ");
+    Serial.println(myIP);
+    u8x8->drawString(0, 6, "AP:             ");
+    u8x8->drawString(6, 6, networks[0].id.c_str());
+    delay(3000);
+  } else {
+    Serial.println("");
+    Serial.println("WiFi connected");
+    Serial.println("IP address: ");
+    String localIPstr = WiFi.localIP().toString();
+    Serial.println(localIPstr);
+    sonde.setIP(localIPstr.c_str(), false);
+    sonde.updateDisplayIP();
+    wifi_state = WIFI_CONNECTED;
+    delay(3000);
   }
-
-  Serial.println("");
-  Serial.println("WiFi connected");
-  Serial.println("IP address: ");
-  Serial.println(WiFi.localIP());
-  sonde.setIP(WiFi.localIP().toString().c_str(), false);
-  sonde.updateDisplayIP();
   SetupAsyncServer();
-  delay(2000);
+  initialMode();
 
   if (sonde.config.spectrum != 0) {     // enable Spectrum in config.txt: spectrum=number_of_seconds
-   startSpectrumDisplay();
+    //startSpectrumDisplay();
+    enterMode(ST_SPECTRUM);
+  } else {
+    enterMode(ST_SCANNER);
   }
-  enterMode(ST_SCANNER);  
 }
 
 void loop() {
-  Serial.println("Running main loop");
-  switch(mainState) {
+  Serial.print("Running main loop. free heap:");
+  Serial.println(ESP.getFreeHeap());
+  switch (mainState) {
     case ST_DECODER: loopDecoder(); break;
     case ST_SCANNER: loopScanner(); break;
     case ST_SPECTRUM: loopSpectrum(); break;
     case ST_WIFISCAN: loopWifiScan(); break;
   }
-#if 1                  
+#if 1
   int rssi = sx1278.getRSSI();
   Serial.print("  RSSI: ");
   Serial.print(rssi);
-  
+
   int gain = sx1278.getLNAGain();
   Serial.print(" LNA Gain: "),
-  Serial.println(gain);
+               Serial.println(gain);
 #endif
+  loopWifiBackground();
 }
diff --git a/RX_FSK/data/config.txt b/RX_FSK/data/config.txt
index 8b34287..d4d550c 100644
--- a/RX_FSK/data/config.txt
+++ b/RX_FSK/data/config.txt
@@ -7,16 +7,17 @@ led_pout=9
 # OLED Setup is depending on hardware of LoRa board
 # TTGO v1:  SDA=4  SCL=15, RST=16 
 # TTGO v2:  SDA=21 SCL=22, RST=16
-oled_sda=21
-oled_scl=22
+# No specification in config file: try autodetection (gpio4 pin level at startup)
+#oled_sda=21
+#oled_scl=22
 oled_rst=16
 #-------------------------------#
 # General config settings
 #-------------------------------#
 maxsonde=20
-debug=0
-wifi=1
-wifiap=1
+debug=1
+# wifi mode: 1=client in background; 2=AP in background; 3=client on startup, ap if failure
+wifi=3
 #-------------------------------#
 # Spectrum display settings
 #-------------------------------#
diff --git a/RX_FSK/data/networks.txt b/RX_FSK/data/networks.txt
index 6e57bfa..4d0204f 100644
--- a/RX_FSK/data/networks.txt
+++ b/RX_FSK/data/networks.txt
@@ -1,4 +1,4 @@
-AUTORX
+SONDERX
 12345678
 WXSONDE
-radiosonde
+12345678
diff --git a/RX_FSK/version.h b/RX_FSK/version.h
new file mode 100644
index 0000000..ff90c12
--- /dev/null
+++ b/RX_FSK/version.h
@@ -0,0 +1,2 @@
+const char *version_name = "RDZ_TTGO_SONDE";
+const char *version_id = "master v0.6b";
diff --git a/libraries/SondeLib/Scanner.cpp b/libraries/SondeLib/Scanner.cpp
index 20f1be9..4239910 100644
--- a/libraries/SondeLib/Scanner.cpp
+++ b/libraries/SondeLib/Scanner.cpp
@@ -23,7 +23,8 @@ int scandisp[NCHAN/PIXSAMPL];
 #define PLOT_N 128
 #define TICK1 (128/6)
 #define TICK2 (TICK1/4)
-#define PLOT_MIN -250
+//#define PLOT_MIN -250
+#define PLOT_MIN (sonde.config.noisefloor*2)
 #define PLOT_SCALE(x) (x<PLOT_MIN?0:(x-PLOT_MIN)/2)
 
 const byte tilepatterns[9]={0,0x80,0xC0,0xE0,0xF0,0xF8,0xFC,0xFE,0xFF};
@@ -51,6 +52,10 @@ void Scanner::plotResult()
 		        if( ((i+j)%TICK2)==0) { row[j] |= 0x01; }
 		}
 		for(int y=0; y<8; y++) {
+			if(sonde.config.marker && y==1) {
+				// don't overwrite MHz marker text
+				if(i<3*8 || (i>=7*8&&i<10*8) || i>=13*8) continue;
+			}
 			u8x8->drawTile(i/8, y, 1, row+8*y);
 		}
 	}
diff --git a/libraries/SondeLib/Sonde.cpp b/libraries/SondeLib/Sonde.cpp
index c652938..c9217f9 100644
--- a/libraries/SondeLib/Sonde.cpp
+++ b/libraries/SondeLib/Sonde.cpp
@@ -48,12 +48,21 @@ static uint8_t empty_tile2[8]={0x00, 0x11, 0x02, 0x02, 0x02, 0x01, 0x00, 0x00};
 static uint8_t ap_tile[8]={0x00,0x04,0x22,0x92, 0x92, 0x22, 0x04, 0x00};
 
 Sonde::Sonde() {
-	config.button_pin = 1;
+	config.button_pin = 0;
 	config.led_pout = 9;	
-	//config.oled_sda = 0;
-	//config.oled_scl = 0;
-	//config.oled_rst = 0;
-	config.noisefloor = -130;
+	// Try autodetecting board type
+  	// Seems like on startup, GPIO4 is 1 on v1 boards, 0 on v2.1 boards?
+   	int autodetect = gpio_get_level((gpio_num_t)4); 
+	if(autodetect==1) {
+		config.oled_sda = 4;
+		config.oled_scl = 15;
+	} else {
+		config.oled_sda = 21;
+		config.oled_scl = 22;
+	}
+	//
+	config.oled_rst = 16;
+	config.noisefloor = -125;
 	strcpy(config.call,"NOCALL");
 	strcpy(config.passcode, "---");
 	config.maxsonde=15;
@@ -109,6 +118,7 @@ void Sonde::setConfig(const char *cfg) {
 		config.oled_rst = atoi(val);
 	} else if(strcmp(cfg,"maxsonde")==0) {
 		config.maxsonde = atoi(val);
+		if(config.maxsonde>MAXSONDE) config.maxsonde=MAXSONDE;
 	} else if(strcmp(cfg,"debug")==0) {
 		config.debug = atoi(val);
 	} else if(strcmp(cfg,"wifi")==0) {
@@ -154,6 +164,10 @@ void Sonde::setConfig(const char *cfg) {
 	}
 }
 
+void Sonde::clearIP() {
+  memset(myIP_tiles, 0, 11*8);
+}
+
 void Sonde::setIP(const char *ip, bool AP) {
   memset(myIP_tiles, 0, 11*8);
   int len = strlen(ip);
@@ -183,13 +197,13 @@ void Sonde::addSonde(float frequency, SondeType type, int active, char *launchsi
 	sondeList[nSonde].type = type;
 	sondeList[nSonde].freq = frequency;
 	sondeList[nSonde].active = active;
-	sondeList[nSonde].launchsite = launchsite;	
+	strncpy(sondeList[nSonde].launchsite, launchsite, 17);	
 	memcpy(sondeList[nSonde].rxStat, "\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3\x3", 18); // unknown/undefined
 	nSonde++;
 }
 void Sonde::nextConfig() {
 	currentSonde++;
-	// Skip non-active entries (but don't loop forever if there are no active ones
+	// Skip non-active entries (but don't loop forever if there are no active ones)
 	for(int i=0; i<config.maxsonde; i++) {
 		if(!sondeList[currentSonde].active) {
 			currentSonde++;
@@ -221,9 +235,6 @@ void Sonde::setup() {
 		dfm.setFrequency(sondeList[currentSonde].freq * 1000000);
 		break;
 	}
-	// Update display
-	//updateDisplayRXConfig();
-	//updateDisplay();
 }
 int Sonde::receiveFrame() {
 	int ret;
@@ -305,11 +316,9 @@ void Sonde::updateDisplayRXConfig() {
 	u8x8->setFont(u8x8_font_chroma48medium8_r);
 	u8x8->drawString(0,0, sondeTypeStr[si()->type]);
 	snprintf(buf, 16, "%3.3f MHz", si()->freq);
-	u8x8->drawString(5,0, buf);
-    //snprintf(buf, 8, "%s", si()->launchsite);
-    //u8x8->drawString(0,5, buf);		
-	u8x8->drawTile(14,3,2,kmh_tiles);	
-
+	u8x8->drawString(7,0, buf);
+    //snprintf(buf, 6, "%s", si()->launchsite);
+    //u8x8->drawString(9,1, buf);		
 }
 
 void Sonde::updateDisplayIP() {
@@ -325,9 +334,8 @@ void Sonde::updateDisplayScanner() {
 	u8x8->drawString(8, 0,  sondeTypeStr[si()->type]);
     snprintf(buf, 16, "%3.3f MHz", si()->freq);
     u8x8->drawString(0,3, buf);
-    //snprintf(buf, 8, "%s", si()->launchsite);
-    //u8x8->drawString(0,5, buf);	
-
+    snprintf(buf, 16, "%s", si()->launchsite);
+    u8x8->drawString(0,5, buf);	
 	updateDisplayIP();
 }
 
diff --git a/libraries/SondeLib/Sonde.h b/libraries/SondeLib/Sonde.h
index 77e6f95..663da41 100644
--- a/libraries/SondeLib/Sonde.h
+++ b/libraries/SondeLib/Sonde.h
@@ -43,7 +43,7 @@ typedef struct st_sondeinfo {
         // decoded ID
         char id[10];
         bool validID;
-		char *launchsite;		
+		char launchsite[18];		
         // decoded position
         float lat;			// latitude
         float lon;			// longitude
@@ -92,6 +92,7 @@ public:
 	void updateDisplayScanner();
 	void clearDisplay();
 	void setIP(const char *ip, bool isAP);
+	void clearIP();
 };
 
 extern Sonde sonde;