Fix teleplot delete/reset

Author: Godeffroy

include/Teleplot.h

@@ -210,7 +210,7 @@ class ShapeTeleplot {
 
 class Teleplot {
 public:
-    Teleplot(){};
+    Teleplot() { Reset(); };
     #ifndef TELEPLOT_DISABLE
     Teleplot(std::string address, uint32_t port=47269, uint32_t bufferingFrequencyHz = 30)
         : address_(address)
@@ -228,8 +228,30 @@ class Teleplot {
         #endif
     };
     #endif
-    ~Teleplot() {initialized_ = false;};
+    ~Teleplot() { Reset(); };
     bool IsInitialized() {return initialized_;}
+    void Reset()
+    {
+        initialized_ = false;
+    #ifndef TELEPLOT_DISABLE
+        if (sockfd_ >= 0)
+        {
+            close(sockfd_);
+        }
+        sockfd_ = -1;
+        address_.clear();
+        memset(&serv_, 0, sizeof(serv_));
+        bufferingFrequencyHz_ = 0;
+        lastBufferingFlushTimestampUs_ = 0;
+    #ifdef TELEPLOT_USE_BUFFERING
+        bufferingMap_.clear();
+        bufferingFlushTimestampsUs_.clear();
+    #endif
+    #ifdef TELEPLOT_USE_FREQUENCY
+        updateTimestampsUs_.clear();
+    #endif
+    #endif
+    }
 
     #ifndef TELEPLOT_DISABLE
     // Static localhost instance

src/Printer.cpp

@@ -292,7 +292,7 @@ Format Specifier
         if (teleplotUDP.IsInitialized())
             teleplotUDP.update(varName.c_str(), var);
         else
-            println(">%s:%f", varName, var);            
+            println(">%s:%f", varName.c_str(), var);            
     }
 
     void teleplot(const String &varName, Point point)

src/Wifi_Helper.cpp

@@ -329,8 +329,9 @@ namespace Wifi_Helper
         if (Printer::teleplotUDP.IsInitialized())
         {
             // We need to un-init in case of wifi lost
-            println("Deleting Teleplot");
-            Printer::teleplotUDP.~Teleplot();
+            println("Deleting Teleplot because WiFi is down");
+            Printer::teleplotUDP.Reset();
+            println("Teleplot reset complete after WiFi loss");
         }
     }
 
@@ -362,13 +363,16 @@ namespace Wifi_Helper
 
         if (!Printer::teleplotUDP.IsInitialized() && teleplotTO.IsTimeOut() && Printer::teleplotUDPEnable == Enable::ENABLE_TRUE)
         {
-            println("Initialising Teleplot");
+            println("Initialising Teleplot on %s:%i", wifi_teleplot_ip.c_str(), wifi_teleplot_port);
             Printer::teleplotUDP = Teleplot(wifi_teleplot_ip.c_str(), wifi_teleplot_port);
+            println("Teleplot init state: %s", Printer::teleplotUDP.IsInitialized() ? "ready" : "not ready");
         }
 
         if (Printer::teleplotUDP.IsInitialized() && Printer::teleplotUDPEnable == Enable::ENABLE_FALSE)
         {
-            Printer::teleplotUDP.~Teleplot();
+            println("Resetting Teleplot because Teleplot UDP was disabled");
+            Printer::teleplotUDP.Reset();
+            println("Teleplot reset complete after disable request");
         }
     }