bætti við prentskipunum til þess að geta plottað step response

include/operational_state.h

@@ -3,9 +3,17 @@
 
 #include "state.h"
 
+#include <stdint.h>
+
 
 class OperationalState : public State
 {
+private:
+    static constexpr double SAMPLE_PERIOD_MS = 4.0;
+
+    // uint32_t svo teljarinn flæði ekki yfir eftir ~4 mín (eins og uint16_t)
+    uint32_t sample_count = 0;
+
 public:
     void enter() override;