Add more example to Teleplot

Author: Godeffroy

examples/Example6_Teleplot/Example6_Teleplot.cpp

@@ -20,17 +20,25 @@ void setup(void)
     Printer::teleplotUDPEnable = Enable::ENABLE_TRUE;
 }
 
-int32_t cpt = 0;
+static int32_t cpt = 0;
 Point point = Point(0, 0);
+PoseF pose = PoseF(0.0f, 0.0f, 0.0f);
+int64_t timeSinceBoot = 0;
 
 void loop(void)
 {
     // This will be send over Wifi if enable and also on Serial
     println("Hello World %i times !", cpt++);
     point.x = cpt + cpt;
     point.y = cpt * cpt;
+    pose.x = cpt / 3.0f;
+    pose.y = cpt * 1.2f;
+    pose.h = pose.x + pose.y;
     delay(1000);
+    timeSinceBoot = esp_timer_get_time();
 
+    teleplot("time", timeSinceBoot);
     teleplot("cpt", cpt);
     teleplot("point", point);
+    teleplot("pose", pose);
 }

src/Printer.cpp

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