ADD [WIP] Static scheduling with event

static_scheduling_with_event/pedal_device.cpp

@@ -0,0 +1,62 @@
+/****************************************************************************
+* @file pedal_device.cpp
+* @author Rémi Heredero <remi@heredero.ch>
+* @author Yann Sierro <yannsierro.pro@gmail.com>
+*
+* @brief Pedal Device implementation (static scheduling)
+* @date 2024-11-17
+* @version 1.1.0
+****************************************************************************/
+
+#include "pedal_device.hpp"
+
+// from disco_h747i/wrappers
+#include <chrono>
+
+#include "joystick.hpp"
+#include "mbed_trace.h"
+
+#if MBED_CONF_MBED_TRACE_ENABLE
+#define TRACE_GROUP "PedalDevice"
+#endif  // MBED_CONF_MBED_TRACE_ENABLE
+
+namespace static_scheduling_with_event {
+
+	PedalDevice::PedalDevice() {
+		disco::Joystick::getInstance().setLeftCallback(
+            callback(this, &PedalDevice::onLeft)
+        );
+        disco::Joystick::getInstance().setRightCallback(
+            callback(this, &PedalDevice::onRight)
+        );
+	}
+
+
+    std::chrono::milliseconds PedalDevice::getCurrentRotationTime() {
+        uint32_t currentStep = core_util_atomic_load_u32(&_currentStep);
+        return bike_computer::kMinPedalRotationTime + currentStep * bike_computer::kDeltaPedalRotationTime;
+    }
+
+    void PedalDevice::increaseRotationSpeed() {
+        uint32_t currentStep = core_util_atomic_load_u32(&_currentStep);
+        if (currentStep > 0) {
+            core_util_atomic_decr_u32(&_currentStep, 1);
+        }
+    }
+
+    void PedalDevice::decreaseRotationSpeed() {
+        uint32_t currentStep = core_util_atomic_load_u32(&_currentStep);
+        if (currentStep < bike_computer::kNbrOfSteps) {
+            core_util_atomic_incr_u32(&_currentStep, 1);
+        }
+    }
+
+    void PedalDevice::onLeft() {
+        decreaseRotationSpeed();
+    }
+
+    void PedalDevice::onRight() {
+        increaseRotationSpeed();
+    }
+
+}