ADD PedalDevice

static_scheduling/pedal_device.cpp

@@ -0,0 +1,72 @@
+/****************************************************************************
+* @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-09
+* @version 0.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 {
+
+	static constexpr std::chrono::microseconds kTaskRunTime = 200000us;
+
+	PedalDevice::PedalDevice(Timer& timer) : _timer(timer) {}
+
+
+    std::chrono::milliseconds PedalDevice::getCurrentRotationTime() {
+        // TODO
+        std::chrono::microseconds initialTime = _timer.elapsed_time();
+    	std::chrono::microseconds elapsedTime = std::chrono::microseconds::zero();
+    	// we bound the change to one increment/decrement per call
+    	bool hasChanged = false;
+    	while (elapsedTime < kTaskRunTime) {
+	        if (!hasChanged) {
+				disco::Joystick::State joystickState = disco::Joystick::getInstance().getState();
+
+				switch (joystickState) {
+                	case disco::Joystick::State::LeftPressed:
+	                    if (_pedalRotationTime < bike_computer::kMaxPedalRotationTime) {
+	                        decreaseRotationSpeed();
+	                    	hasChanged = true;
+	                    }
+	                    break;
+
+	                case disco::Joystick::State::DownPressed:
+	                    if (_pedalRotationTime > bike_computer::kMinPedalRotationTime) {
+	                        decreaseRotationSpeed();
+                            hasChanged = true;
+	                    }
+	                    break;
+
+	                default:
+	                    break;
+	            }
+	        }
+	        elapsedTime = _timer.elapsed_time() - initialTime;
+	    }
+        return _pedalRotationTime;
+    }
+
+    void PedalDevice::increaseRotationSpeed() {
+        _pedalRotationTime -= bike_computer::kDeltaPedalRotationTime;
+    }
+
+    void PedalDevice::decreaseRotationSpeed() {
+        _pedalRotationTime += bike_computer::kDeltaPedalRotationTime;
+    }
+
+}