Labels support colors

include/turtlesim/turtle.h

@@ -98,6 +98,7 @@ private:
 
   float meter_;
   bool label_on_ = false;
+  QPen pen_label_;
   QString label_ = "";
 
   struct TeleportRequest

src/turtle.cpp

@@ -94,6 +94,8 @@ bool Turtle::setPenCallback(turtlesim::SetPen::Request& req, turtlesim::SetPen::
 bool Turtle::setLabelCallback(turtlesim_xl::SetLabel::Request& req, turtlesim_xl::SetLabel::Response&){
   Turtle::label_ = QString(req.name.c_str());
   label_on_ = req.on;
+  QPen pen(QColor(req.r, req.g, req.b));
+  pen_label_ = pen;
   return true;
 }
 bool Turtle::teleportRelativeCallback(turtlesim::TeleportRelative::Request& req, turtlesim::TeleportRelative::Response&)
@@ -227,7 +229,7 @@ void Turtle::paint(QPainter& painter)
   if(label_on_){
     QPointF pl = pos_ * meter_;
     pl.rx() -= 0.3 * turtle_rotated_image_.width();
-    painter.setPen(Qt::red);
+    painter.setPen(pen_label_);
     painter.setFont(QFont("Arial",meter_/2));
     painter.drawText(pl,Turtle::label_);
   }

srv/SetLabel.srv

 string name
+uint8 r
+uint8 g
+uint8 b
 uint8 on
\ No newline at end of file