ADD measure time call

multi_tasking/bike_system.hpp

@@ -66,8 +66,7 @@ class BikeSystem {
 
     // Main Thread
     void temperatureTask();
-    void displayTask1();
-    void displayTask2();
+    void displayTask();
     void cpuTask();
 
     // ISR Thread
@@ -83,8 +82,8 @@ class BikeSystem {
     // GETTER - SETTER
     uint8_t getCurrentGear();
     uint8_t getCurrentGearSize();
-    uint32_t getCurrentSpeed();
-    uint32_t getCurrentDistance();
+    float getCurrentSpeed();
+    float getCurrentDistance();
     void setCurrentGear(uint8_t gear);
 
     // Thread functions
@@ -99,6 +98,27 @@ class BikeSystem {
     std::chrono::microseconds _onGearDownTime = std::chrono::microseconds::zero();
 
     Timer _timer;
+
+    // Event queues
+    EventQueue _isrEventQueue;
+    EventQueue _eventQueue;
+
+    // Mail
+    Mail<pedalMail_t, 16> _mailPedalDevice;
+    Mail<gearMail_t, 16> _mailGearDevice;
+
+    // mutex for shared resource
+    Mutex _mutexGearSize;
+    Mutex _mutexGear;
+    Mutex _mutexSpeed;
+    Mutex _mutexDistance;
+    Mutex _mutexSpeedometer;
+
+    // Tread for isr events
+    Thread _isrEventThread;
+    Thread _speedDistanceThread;
+    Thread _gearTaskThread;
+
     // data member that represents the device for manipulating the gear
     GearDevice _gearDevice;
 
@@ -133,26 +153,6 @@ class BikeSystem {
 
     // cpu logger to measure cpu usage
     advembsof::CPULogger _cpuLogger;
-
-    // Event queues
-    EventQueue _isrEventQueue;
-    EventQueue _eventQueue;
-
-    // Mail
-    Mail<uint32_t, 16> _mailPedalDevice;
-    Mail<uint8_t, 16> _mailGearDevice;
-
-    // mutex for shared resource
-    Mutex _mutexGearSize;
-    Mutex _mutexGear;
-    Mutex _mutexSpeed;
-    Mutex _mutexDistance;
-    Mutex _mutexSpeedometer;
-
-    // Tread for isr events
-    Thread _isrEventThread;
-    Thread _speedDistanceThread;
-    Thread _gearTaskThread;
 };
 
 }  // namespace multi_tasking