63 lines
1.7 KiB
C++
63 lines
1.7 KiB
C++
|
/****************************************************************************
|
||
|
|
* @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();
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|