diff --git a/src/shared/actuators/Servo/ServoData.h b/src/shared/actuators/Servo/ServoData.h
index bbed26513a4b8805492ed2533d62992e22a34de5..b4ff14d357a09257f6d9882ed6921c640fad430e 100644
--- a/src/shared/actuators/Servo/ServoData.h
+++ b/src/shared/actuators/Servo/ServoData.h
@@ -34,11 +34,12 @@ struct ServoData
     uint8_t channel;
     float position;
 
-    static std::string header() { return "timestamp,position\n"; }
+    static std::string header() { return "timestamp,timer,channel,position\n"; }
 
     void print(std::ostream& os) const
     {
-        os << timestamp << "," << position << "\n";
+        os << timestamp << "," << timer << "," << channel << "," << position
+           << "\n";
     }
 };