add missing teleplot functions

Author: Godeffroy

src/Printer.cpp

@@ -245,7 +245,39 @@ Format Specifier
         if (teleplotUDP.IsInitialized())
             teleplotUDP.update2D(varName.c_str(), point.x, point.y);
         else
-            println(">" + varName + ":" + String((int)point.x) + ":" + String((int)point.y) + "|xy");
+            println(">%s:%i:%i|xy", varName, point.x, point.y);
+    }
+
+    void teleplot(const String &varName, PointF point)
+    {
+        if (teleplotUDP.IsInitialized())
+            teleplotUDP.update2D(varName.c_str(), point.x, point.y);
+        else
+            println(">%s:%f:%f|xy", varName, point.x, point.y);
+    }
+
+    void teleplot(const String &varName, Pose pose)
+    {
+        if (teleplotUDP.IsInitialized())
+            teleplotUDP.update2D(varName.c_str(), pose.x, pose.y);
+        else
+            println(">%s:%i:%i|xy", varName, pose.x, pose.y);
+    }
+
+    void teleplot(const String &varName, PoseF pose)
+    {
+        if (teleplotUDP.IsInitialized())
+            teleplotUDP.update2D(varName.c_str(), pose.x, pose.y);
+        else
+            println(">%s:%f:%f|xy", varName, pose.x, pose.y);
+    }
+
+    void teleplot(const String &varName, PolarPoint polarPoint)
+    {
+        if (teleplotUDP.IsInitialized())
+            teleplotUDP.update2D(varName.c_str(), polarPoint.x, polarPoint.y);
+        else
+            println(">%s:%f:%f|xy", varName, polarPoint.x, polarPoint.y);
     }
 
 /*