Klagarge/BikeComputer
Archived
1
0
Fork 0
Code Issues Pull Requests Actions Projects Releases Activity

ADD mail box for gear device

Browse Source
This commit is contained in:
fastium
2025-01-03 20:22:23 +01:00
parent 62fd302d84
commit 4fb09c690c
4 changed files with 99 additions and 76 deletions
Download Patch File Download Diff File Expand all files Collapse all files

31
multi_tasking/gear_device.cpp
View File

@@ -30,6 +30,7 @@
#include <chrono>
#include "joystick.hpp"
#include "mbed_atomic.h"
#include "mbed_trace.h"
#if MBED_CONF_MBED_TRACE_ENABLE
@@ -38,9 +39,33 @@
namespace multi_tasking {
GearDevice::GearDevice(Callback<void()> cbOnUp, Callback<void()> cbOnDown) {
disco::Joystick::getInstance().setUpCallback(callback(cbOnUp));
disco::Joystick::getInstance().setDownCallback(callback(cbOnDown));
GearDevice::GearDevice(Mail<uint8_t, 16>* mailBox) {
disco::Joystick::getInstance().setUpCallback(callback(this, &GearDevice::onUp));
disco::Joystick::getInstance().setDownCallback(callback(this, &GearDevice::onDown));
_mailBox = mailBox;
}
void GearDevice::onUp() {
if (_currentGear < bike_computer::kMaxGear) {
core_util_atomic_incr_u8(&_currentGear, 1);
sendMail(core_util_atomic_load_u8(&_currentGear));
}
}
void GearDevice::onDown() {
if (_currentGear > bike_computer::kMinGear) {
core_util_atomic_decr_u8(&_currentGear, 1);
sendMail(core_util_atomic_load_u8(&_currentGear));
}
}
void GearDevice::sendMail(uint32_t data) {
uint8_t* currentGear = _mailBox->try_alloc();
if (currentGear != nullptr) {
*currentGear = data;
_mailBox->put(currentGear);
}
}
} // namespace multi_tasking