ADD create files for multi tasking and modify the main
This commit is contained in:
parent
1ba466569e
commit
c92de22c09
4
main.cpp
4
main.cpp
@ -8,7 +8,7 @@
|
||||
#include "mbed.h" // NOLINT
|
||||
#include "mbed_trace.h"
|
||||
//#include "static_scheduling/bike_system.hpp"
|
||||
#include "static_scheduling_with_event/bike_system.hpp"
|
||||
#include "multi_tasking/bike_system.hpp"
|
||||
|
||||
#if defined(MBED_CONF_MBED_TRACE_ENABLE)
|
||||
#define TRACE_GROUP "MAIN"
|
||||
@ -23,7 +23,7 @@ int main() {
|
||||
// bikeSystem.start();
|
||||
// bikeSystem.startWithEventQueue();
|
||||
|
||||
static_scheduling_with_event::BikeSystem bikeSystem;
|
||||
multi_tasking::BikeSystem bikeSystem;
|
||||
bikeSystem.start();
|
||||
}
|
||||
|
||||
|
255
multi_tasking/bike_system.cpp
Normal file
255
multi_tasking/bike_system.cpp
Normal file
@ -0,0 +1,255 @@
|
||||
// Copyright 2022 Haute école d'ingénierie et d'architecture de Fribourg
|
||||
//
|
||||
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||
// you may not use this file except in compliance with the License.
|
||||
// You may obtain a copy of the License at
|
||||
//
|
||||
// http://www.apache.org/licenses/LICENSE-2.0
|
||||
//
|
||||
// Unless required by applicable law or agreed to in writing, software
|
||||
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
// See the License for the specific language governing permissions and
|
||||
// limitations under the License.
|
||||
|
||||
/****************************************************************************
|
||||
* @file bike_system.cpp
|
||||
* @author Serge Ayer <serge.ayer@hefr.ch>
|
||||
* @author Rémi Heredero <remi@heredero.ch>
|
||||
* @author Yann Sierro <yannsierro.pro@gmail.com>
|
||||
*
|
||||
* @brief Bike System implementation (static scheduling)
|
||||
*
|
||||
* @date 2023-11-15
|
||||
* @version 1.1.0
|
||||
***************************************************************************/
|
||||
|
||||
#include "bike_system.hpp"
|
||||
|
||||
#include <chrono>
|
||||
|
||||
#include "mbed_trace.h"
|
||||
#if MBED_CONF_MBED_TRACE_ENABLE
|
||||
#define TRACE_GROUP "BikeSystem"
|
||||
#endif // MBED_CONF_MBED_TRACE_ENABLE
|
||||
|
||||
namespace multi_tasking {
|
||||
|
||||
static constexpr std::chrono::milliseconds kGearTaskPeriod = 800ms;
|
||||
static constexpr std::chrono::milliseconds kGearTaskDelay = 0ms;
|
||||
static constexpr std::chrono::milliseconds kGearTaskComputationTime = 100ms;
|
||||
|
||||
static constexpr std::chrono::milliseconds kSpeedDistanceTaskPeriod = 400ms;
|
||||
static constexpr std::chrono::milliseconds kSpeedDistanceTaskDelay = 100ms;
|
||||
static constexpr std::chrono::milliseconds kSpeedDistanceTaskComputationTime = 200ms;
|
||||
|
||||
static constexpr std::chrono::milliseconds kDisplayTask1Period = 1600ms;
|
||||
static constexpr std::chrono::milliseconds kDisplayTask1Delay = 300ms;
|
||||
static constexpr std::chrono::milliseconds kDisplayTask1ComputationTime = 200ms;
|
||||
|
||||
static constexpr std::chrono::milliseconds kResetTaskPeriod = 800ms;
|
||||
static constexpr std::chrono::milliseconds kResetTaskDelay = 700ms;
|
||||
static constexpr std::chrono::milliseconds kResetTaskComputationTime = 100ms;
|
||||
|
||||
static constexpr std::chrono::milliseconds kTemperatureTaskPeriod = 1600ms;
|
||||
static constexpr std::chrono::milliseconds kTemperatureTaskDelay = 1100ms;
|
||||
static constexpr std::chrono::milliseconds kTemperatureTaskComputationTime = 100ms;
|
||||
|
||||
static constexpr std::chrono::milliseconds kDisplayTask2Period = 1600ms;
|
||||
static constexpr std::chrono::milliseconds kDisplayTask2Delay = 1200ms;
|
||||
static constexpr std::chrono::milliseconds kDisplayTask2ComputationTime = 100ms;
|
||||
|
||||
static constexpr std::chrono::milliseconds kCPUTaskPeriod = 1600ms;
|
||||
static constexpr std::chrono::milliseconds kCPUTaskDelay = 1200ms;
|
||||
static constexpr std::chrono::milliseconds kCPUTaskComputationTime = 100ms;
|
||||
|
||||
|
||||
BikeSystem::BikeSystem() :
|
||||
_gearDevice(),
|
||||
_pedalDevice(),
|
||||
_resetDevice(callback(this, &BikeSystem::onReset)),
|
||||
_speedometer(_timer),
|
||||
_cpuLogger(_timer)
|
||||
{
|
||||
|
||||
}
|
||||
|
||||
void BikeSystem::start() {
|
||||
|
||||
tr_info("Starting Super-Loop with event handling");
|
||||
|
||||
init();
|
||||
|
||||
EventQueue eventQueue;
|
||||
|
||||
Event<void()> gearEvent(&eventQueue, callback(this, &BikeSystem::gearTask));
|
||||
gearEvent.delay(kGearTaskDelay);
|
||||
gearEvent.period(kGearTaskPeriod);
|
||||
gearEvent.post();
|
||||
|
||||
Event<void()> speedDistanceEvent(&eventQueue, callback(this, &BikeSystem::speedDistanceTask));
|
||||
speedDistanceEvent.delay(kSpeedDistanceTaskDelay);
|
||||
speedDistanceEvent.period(kSpeedDistanceTaskPeriod);
|
||||
speedDistanceEvent.post();
|
||||
|
||||
Event<void()> display1Event(&eventQueue, callback(this, &BikeSystem::displayTask1));
|
||||
display1Event.delay(kDisplayTask1Delay);
|
||||
display1Event.period(kDisplayTask1Period);
|
||||
display1Event.post();
|
||||
|
||||
Event<void()> resetEvent(&eventQueue, callback(this, &BikeSystem::resetTask));
|
||||
resetEvent.delay(kResetTaskDelay);
|
||||
resetEvent.period(kResetTaskPeriod);
|
||||
resetEvent.post();
|
||||
|
||||
Event<void()> temperatureEvent(&eventQueue, callback(this, &BikeSystem::temperatureTask));
|
||||
temperatureEvent.delay(kTemperatureTaskDelay);
|
||||
temperatureEvent.period(kTemperatureTaskPeriod);
|
||||
temperatureEvent.post();
|
||||
|
||||
Event<void()> display2Event(&eventQueue, callback(this, &BikeSystem::displayTask2));
|
||||
display2Event.delay(kDisplayTask2Delay);
|
||||
display2Event.period(kDisplayTask2Period);
|
||||
display2Event.post();
|
||||
|
||||
#if !defined(MBED_TEST_MODE)
|
||||
Event<void()> cpuEvent(&eventQueue, callback(this, &BikeSystem::cpuTask));
|
||||
cpuEvent.delay(kCPUTaskDelay);
|
||||
cpuEvent.period(kCPUTaskPeriod);
|
||||
cpuEvent.post();
|
||||
#endif
|
||||
|
||||
eventQueue.dispatch_forever();
|
||||
}
|
||||
|
||||
void BikeSystem::onReset() {
|
||||
_resetTime = _timer.elapsed_time();
|
||||
core_util_atomic_store_bool(&_resetFlag, true);
|
||||
}
|
||||
|
||||
void BikeSystem::stop() { core_util_atomic_store_bool(&_stopFlag, true); }
|
||||
|
||||
#if defined(MBED_TEST_MODE)
|
||||
const advembsof::TaskLogger& BikeSystem::getTaskLogger() { return _taskLogger; }
|
||||
#endif // defined(MBED_TEST_MODE)
|
||||
|
||||
void BikeSystem::init() {
|
||||
// start the timer
|
||||
_timer.start();
|
||||
|
||||
// initialize the lcd display
|
||||
disco::ReturnCode rc = _displayDevice.init();
|
||||
if (rc != disco::ReturnCode::Ok) {
|
||||
tr_error("Failed to initialized the lcd display: %d", static_cast<int>(rc));
|
||||
}
|
||||
|
||||
// initialize the sensor device
|
||||
bool present = _sensorDevice.init();
|
||||
if (!present) {
|
||||
tr_error("Sensor not present or initialization failed");
|
||||
}
|
||||
|
||||
// enable/disable task logging
|
||||
_taskLogger.enable(true);
|
||||
}
|
||||
|
||||
void BikeSystem::gearTask() {
|
||||
// gear task
|
||||
auto taskStartTime = _timer.elapsed_time();
|
||||
|
||||
// no need to protect access to data members (single threaded)
|
||||
_currentGear = _gearDevice.getCurrentGear();
|
||||
_currentGearSize = _gearDevice.getCurrentGearSize();
|
||||
|
||||
_taskLogger.logPeriodAndExecutionTime(
|
||||
_timer, advembsof::TaskLogger::kGearTaskIndex, taskStartTime
|
||||
);
|
||||
}
|
||||
|
||||
void BikeSystem::speedDistanceTask() {
|
||||
auto taskStartTime = _timer.elapsed_time();
|
||||
|
||||
const auto pedalRotationTime = _pedalDevice.getCurrentRotationTime();
|
||||
_speedometer.setCurrentRotationTime(pedalRotationTime);
|
||||
_speedometer.setGearSize(_currentGearSize);
|
||||
|
||||
_currentSpeed = _speedometer.getCurrentSpeed();
|
||||
_traveledDistance = _speedometer.getDistance();
|
||||
|
||||
_taskLogger.logPeriodAndExecutionTime(
|
||||
_timer, advembsof::TaskLogger::kSpeedTaskIndex, taskStartTime
|
||||
);
|
||||
}
|
||||
|
||||
void BikeSystem::temperatureTask() {
|
||||
auto taskStartTime = _timer.elapsed_time();
|
||||
|
||||
//tr_warn("Tick1 %" PRIu64, _timer.elapsed_time().count());
|
||||
|
||||
// no need to protect access to data members (single threaded)
|
||||
_currentTemperature = _sensorDevice.readTemperature();
|
||||
|
||||
//tr_warn("Tick2 %" PRIu64, _timer.elapsed_time().count());
|
||||
|
||||
ThisThread::sleep_for(
|
||||
std::chrono::duration_cast<std::chrono::milliseconds>(
|
||||
kTemperatureTaskComputationTime - (_timer.elapsed_time() - taskStartTime)
|
||||
)
|
||||
);
|
||||
|
||||
_taskLogger.logPeriodAndExecutionTime(
|
||||
_timer, advembsof::TaskLogger::kTemperatureTaskIndex, taskStartTime);
|
||||
}
|
||||
|
||||
void BikeSystem::resetTask() {
|
||||
auto taskStartTime = _timer.elapsed_time();
|
||||
|
||||
if (core_util_atomic_load_bool(&_resetFlag)) {
|
||||
std::chrono::microseconds responseTime = _timer.elapsed_time() - _resetTime;
|
||||
tr_info("Reset task: response time is %" PRIu64 " usecs", responseTime.count());
|
||||
_speedometer.reset();
|
||||
|
||||
core_util_atomic_store_bool(&_resetFlag, false);
|
||||
}
|
||||
|
||||
_taskLogger.logPeriodAndExecutionTime(
|
||||
_timer, advembsof::TaskLogger::kResetTaskIndex, taskStartTime);
|
||||
}
|
||||
|
||||
void BikeSystem::displayTask1() {
|
||||
auto taskStartTime = _timer.elapsed_time();
|
||||
|
||||
_displayDevice.displayGear(_currentGear);
|
||||
_displayDevice.displaySpeed(_currentSpeed);
|
||||
_displayDevice.displayDistance(_traveledDistance);
|
||||
|
||||
ThisThread::sleep_for(
|
||||
std::chrono::duration_cast<std::chrono::milliseconds>(
|
||||
kDisplayTask1ComputationTime - (_timer.elapsed_time() - taskStartTime)
|
||||
)
|
||||
);
|
||||
|
||||
_taskLogger.logPeriodAndExecutionTime(
|
||||
_timer, advembsof::TaskLogger::kDisplayTask1Index, taskStartTime);
|
||||
}
|
||||
|
||||
void BikeSystem::displayTask2() {
|
||||
auto taskStartTime = _timer.elapsed_time();
|
||||
|
||||
_displayDevice.displayTemperature(_currentTemperature);
|
||||
|
||||
ThisThread::sleep_for(
|
||||
std::chrono::duration_cast<std::chrono::milliseconds>(
|
||||
kDisplayTask2ComputationTime - (_timer.elapsed_time() - taskStartTime)
|
||||
)
|
||||
);
|
||||
|
||||
_taskLogger.logPeriodAndExecutionTime(
|
||||
_timer, advembsof::TaskLogger::kDisplayTask2Index, taskStartTime);
|
||||
}
|
||||
|
||||
void BikeSystem::cpuTask() {
|
||||
_cpuLogger.printStats();
|
||||
}
|
||||
|
||||
} // namespace static_scheduling
|
111
multi_tasking/bike_system.hpp
Normal file
111
multi_tasking/bike_system.hpp
Normal file
@ -0,0 +1,111 @@
|
||||
// Copyright 2022 Haute école d'ingénierie et d'architecture de Fribourg
|
||||
//
|
||||
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||
// you may not use this file except in compliance with the License.
|
||||
// You may obtain a copy of the License at
|
||||
//
|
||||
// http://www.apache.org/licenses/LICENSE-2.0
|
||||
//
|
||||
// Unless required by applicable law or agreed to in writing, software
|
||||
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
// See the License for the specific language governing permissions and
|
||||
// limitations under the License.
|
||||
|
||||
/****************************************************************************
|
||||
* @file bike_system.hpp
|
||||
* @author Serge Ayer <serge.ayer@hefr.ch>
|
||||
*
|
||||
* @brief Bike System header file (static scheduling)
|
||||
*
|
||||
* @date 2023-08-20
|
||||
* @version 1.0.0
|
||||
***************************************************************************/
|
||||
|
||||
#pragma once
|
||||
|
||||
// from advembsof
|
||||
#include "display_device.hpp"
|
||||
#include "task_logger.hpp"
|
||||
#include "cpu_logger.hpp"
|
||||
|
||||
// from common
|
||||
#include "sensor_device.hpp"
|
||||
#include "speedometer.hpp"
|
||||
|
||||
// local
|
||||
#include "gear_device.hpp"
|
||||
#include "pedal_device.hpp"
|
||||
#include "reset_device.hpp"
|
||||
|
||||
namespace multi_tasking {
|
||||
|
||||
class BikeSystem {
|
||||
public:
|
||||
// constructor
|
||||
BikeSystem();
|
||||
|
||||
// make the class non copyable
|
||||
BikeSystem(BikeSystem&) = delete;
|
||||
BikeSystem& operator=(BikeSystem&) = delete;
|
||||
|
||||
// method called in main() for starting the system
|
||||
void start();
|
||||
|
||||
// method called in main() for starting the sysytem with the event queue
|
||||
void startWithEventQueue();
|
||||
|
||||
// method called for stopping the system
|
||||
void stop();
|
||||
|
||||
#if defined(MBED_TEST_MODE)
|
||||
const advembsof::TaskLogger& getTaskLogger();
|
||||
#endif // defined(MBED_TEST_MODE)
|
||||
|
||||
private:
|
||||
// private methods
|
||||
void init();
|
||||
void onReset();
|
||||
void gearTask();
|
||||
void speedDistanceTask();
|
||||
void temperatureTask();
|
||||
void resetTask();
|
||||
void displayTask1();
|
||||
void displayTask2();
|
||||
void cpuTask();
|
||||
|
||||
// stop flag, used for stopping the super-loop (set in stop())
|
||||
bool _stopFlag = false;
|
||||
|
||||
std::chrono::microseconds _resetTime = std::chrono::microseconds::zero();
|
||||
volatile bool _resetFlag = false;
|
||||
|
||||
// timer instance used for loggint task time and used by ResetDevice
|
||||
Timer _timer;
|
||||
// data member that represents the device for manipulating the gear
|
||||
GearDevice _gearDevice;
|
||||
uint8_t _currentGear = bike_computer::kMinGear;
|
||||
uint8_t _currentGearSize = bike_computer::kMinGearSize;
|
||||
// data member that represents the device for manipulating the pedal rotation
|
||||
// speed/time
|
||||
PedalDevice _pedalDevice;
|
||||
float _currentSpeed = 0.0f;
|
||||
float _traveledDistance = 0.0f;
|
||||
// data member that represents the device used for resetting
|
||||
ResetDevice _resetDevice;
|
||||
// data member that represents the device display
|
||||
advembsof::DisplayDevice _displayDevice;
|
||||
// data member that represents the device for counting wheel rotations
|
||||
bike_computer::Speedometer _speedometer;
|
||||
// data member that represents the sensor device
|
||||
bike_computer::SensorDevice _sensorDevice;
|
||||
float _currentTemperature = 0.0f;
|
||||
|
||||
// used for logging task info
|
||||
advembsof::TaskLogger _taskLogger;
|
||||
|
||||
// cpu logger to measure cpu usage
|
||||
advembsof::CPULogger _cpuLogger;
|
||||
};
|
||||
|
||||
} // namespace static_scheduling
|
69
multi_tasking/gear_device.cpp
Normal file
69
multi_tasking/gear_device.cpp
Normal file
@ -0,0 +1,69 @@
|
||||
// Copyright 2022 Haute école d'ingénierie et d'architecture de Fribourg
|
||||
//
|
||||
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||
// you may not use this file except in compliance with the License.
|
||||
// You may obtain a copy of the License at
|
||||
//
|
||||
// http://www.apache.org/licenses/LICENSE-2.0
|
||||
//
|
||||
// Unless required by applicable law or agreed to in writing, software
|
||||
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
// See the License for the specific language governing permissions and
|
||||
// limitations under the License.
|
||||
|
||||
/****************************************************************************
|
||||
* @file gear_device.cpp
|
||||
* @author Serge Ayer <serge.ayer@hefr.ch>
|
||||
* @author Rémi Heredero <remi@heredero.ch>
|
||||
* @author Yann Sierro <yannsierro.pro@gmail.com>
|
||||
*
|
||||
* @brief Gear Device implementation (static scheduling)
|
||||
*
|
||||
* @date 2023-11-17
|
||||
* @version 1.1.0
|
||||
***************************************************************************/
|
||||
|
||||
#include "gear_device.hpp"
|
||||
|
||||
// from disco_h747i/wrappers
|
||||
#include <chrono>
|
||||
|
||||
#include "joystick.hpp"
|
||||
#include "mbed_trace.h"
|
||||
|
||||
#if MBED_CONF_MBED_TRACE_ENABLE
|
||||
#define TRACE_GROUP "GearDevice"
|
||||
#endif // MBED_CONF_MBED_TRACE_ENABLE
|
||||
|
||||
namespace multi_tasking {
|
||||
|
||||
|
||||
GearDevice::GearDevice() {
|
||||
disco::Joystick::getInstance().setUpCallback(
|
||||
callback(this, &GearDevice::onUp));
|
||||
disco::Joystick::getInstance().setDownCallback(
|
||||
callback(this, &GearDevice::onDown));
|
||||
}
|
||||
|
||||
uint8_t GearDevice::getCurrentGear() {
|
||||
return core_util_atomic_load_u8(&_currentGear);
|
||||
}
|
||||
|
||||
uint8_t GearDevice::getCurrentGearSize() const {
|
||||
return bike_computer::kMaxGearSize - core_util_atomic_load_u8(&_currentGear);
|
||||
}
|
||||
|
||||
void GearDevice::onUp() {
|
||||
if (_currentGear < bike_computer::kMaxGear) {
|
||||
core_util_atomic_incr_u8(&_currentGear, 1);
|
||||
}
|
||||
}
|
||||
|
||||
void GearDevice::onDown() {
|
||||
if (_currentGear > bike_computer::kMinGear) {
|
||||
core_util_atomic_decr_u8(&_currentGear, 1);
|
||||
}
|
||||
}
|
||||
|
||||
} // namespace static_scheduling
|
54
multi_tasking/gear_device.hpp
Normal file
54
multi_tasking/gear_device.hpp
Normal file
@ -0,0 +1,54 @@
|
||||
// Copyright 2022 Haute école d'ingénierie et d'architecture de Fribourg
|
||||
//
|
||||
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||
// you may not use this file except in compliance with the License.
|
||||
// You may obtain a copy of the License at
|
||||
//
|
||||
// http://www.apache.org/licenses/LICENSE-2.0
|
||||
//
|
||||
// Unless required by applicable law or agreed to in writing, software
|
||||
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
// See the License for the specific language governing permissions and
|
||||
// limitations under the License.
|
||||
|
||||
/****************************************************************************
|
||||
* @file gear_device.hpp
|
||||
* @author Serge Ayer <serge.ayer@hefr.ch>
|
||||
* @author Rémi Heredero <remi@heredero.ch>
|
||||
* @author Yann Sierro <yannsierro.pro@gmail.com>
|
||||
*
|
||||
* @brief Gear Device header file (static scheduling)
|
||||
*
|
||||
* @date 2023-11-17
|
||||
* @version 1.1.0
|
||||
***************************************************************************/
|
||||
|
||||
#pragma once
|
||||
|
||||
#include "constants.hpp"
|
||||
#include "mbed.h"
|
||||
|
||||
namespace multi_tasking {
|
||||
|
||||
class GearDevice {
|
||||
public:
|
||||
explicit GearDevice(); // NOLINT(runtime/references)
|
||||
|
||||
// make the class non copyable
|
||||
GearDevice(GearDevice&) = delete;
|
||||
GearDevice& operator=(GearDevice&) = delete;
|
||||
|
||||
// method called for updating the bike system
|
||||
uint8_t getCurrentGear();
|
||||
uint8_t getCurrentGearSize() const;
|
||||
|
||||
void onUp();
|
||||
void onDown();
|
||||
|
||||
private:
|
||||
// data members
|
||||
volatile uint8_t _currentGear = bike_computer::kMinGear;
|
||||
};
|
||||
|
||||
} // namespace static_scheduling
|
62
multi_tasking/pedal_device.cpp
Normal file
62
multi_tasking/pedal_device.cpp
Normal file
@ -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 multi_tasking {
|
||||
|
||||
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();
|
||||
}
|
||||
|
||||
}
|
60
multi_tasking/pedal_device.hpp
Normal file
60
multi_tasking/pedal_device.hpp
Normal file
@ -0,0 +1,60 @@
|
||||
// Copyright 2022 Haute école d'ingénierie et d'architecture de Fribourg
|
||||
//
|
||||
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||
// you may not use this file except in compliance with the License.
|
||||
// You may obtain a copy of the License at
|
||||
//
|
||||
// http://www.apache.org/licenses/LICENSE-2.0
|
||||
//
|
||||
// Unless required by applicable law or agreed to in writing, software
|
||||
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
// See the License for the specific language governing permissions and
|
||||
// limitations under the License.
|
||||
|
||||
/****************************************************************************
|
||||
* @file pedal_device.hpp
|
||||
* @author Serge Ayer <serge.ayer@hefr.ch>
|
||||
* @author Rémi Heredero <remi@heredero.ch>
|
||||
* @author Yann Sierro <yannsierro.pro@gmail.com>
|
||||
*
|
||||
* @brief Pedal System header file (static scheduling)
|
||||
*
|
||||
* @date 2023-11-17
|
||||
* @version 1.1.0
|
||||
***************************************************************************/
|
||||
|
||||
#pragma once
|
||||
|
||||
#include "constants.hpp"
|
||||
#include "mbed.h"
|
||||
|
||||
namespace multi_tasking {
|
||||
|
||||
class PedalDevice {
|
||||
public:
|
||||
PedalDevice(); // NOLINT(runtime/references)
|
||||
|
||||
// make the class non copyable
|
||||
PedalDevice(PedalDevice&) = delete;
|
||||
PedalDevice& operator=(PedalDevice&) = delete;
|
||||
|
||||
// method called for updating the bike system
|
||||
std::chrono::milliseconds getCurrentRotationTime();
|
||||
|
||||
private:
|
||||
// private methods
|
||||
void onLeft();
|
||||
void onRight();
|
||||
void increaseRotationSpeed();
|
||||
void decreaseRotationSpeed();
|
||||
|
||||
// data members
|
||||
volatile uint32_t _currentStep = static_cast<uint32_t>(
|
||||
(
|
||||
bike_computer::kInitialPedalRotationTime - bike_computer::kMinPedalRotationTime
|
||||
).count() / bike_computer::kDeltaPedalRotationTime.count()
|
||||
);
|
||||
};
|
||||
|
||||
} // namespace static_scheduling
|
36
multi_tasking/reset_device.cpp
Normal file
36
multi_tasking/reset_device.cpp
Normal file
@ -0,0 +1,36 @@
|
||||
/****************************************************************************
|
||||
* @file reset_device.cpp
|
||||
* @author Rémi Heredero <remi@heredero.ch>
|
||||
* @author Yann Sierro <yannsierro.pro@gmail.com>
|
||||
*
|
||||
* @brief Reset Device implementation (static scheduling with event)
|
||||
* @date 2024-11-17
|
||||
* @version 1.1.0
|
||||
****************************************************************************/
|
||||
|
||||
#include "reset_device.hpp"
|
||||
|
||||
// from disco_h747i/wrappers
|
||||
#include <chrono>
|
||||
|
||||
#include "joystick.hpp"
|
||||
#include "mbed_trace.h"
|
||||
|
||||
#if defined(TARGET_DISCO_H747I)
|
||||
#define PUSH_BUTTON BUTTON1
|
||||
static constexpr uint8_t kPolarityPressed = 1;
|
||||
#endif
|
||||
|
||||
|
||||
#if MBED_CONF_MBED_TRACE_ENABLE
|
||||
#define TRACE_GROUP "ResetDevice"
|
||||
#endif // MBED_CONF_MBED_TRACE_ENABLE
|
||||
|
||||
namespace multi_tasking {
|
||||
|
||||
ResetDevice::ResetDevice(Callback<void()> cb) : _resetButton(PUSH_BUTTON) {
|
||||
_resetButton.fall(cb);
|
||||
}
|
||||
|
||||
|
||||
}
|
48
multi_tasking/reset_device.hpp
Normal file
48
multi_tasking/reset_device.hpp
Normal file
@ -0,0 +1,48 @@
|
||||
// Copyright 2022 Haute école d'ingénierie et d'architecture de Fribourg
|
||||
//
|
||||
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||
// you may not use this file except in compliance with the License.
|
||||
// You may obtain a copy of the License at
|
||||
//
|
||||
// http://www.apache.org/licenses/LICENSE-2.0
|
||||
//
|
||||
// Unless required by applicable law or agreed to in writing, software
|
||||
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
// See the License for the specific language governing permissions and
|
||||
// limitations under the License.
|
||||
|
||||
/****************************************************************************
|
||||
* @file reset_device.hpp
|
||||
* @author Serge Ayer <serge.ayer@hefr.ch>
|
||||
* @author Rémi Heredero <remi@heredero.ch>
|
||||
* @author Yann Sierro <yannsierro.pro@gmail.com>
|
||||
*
|
||||
* @brief ResetDevice header file (static scheduling with event)
|
||||
*
|
||||
* @date 2023-11-17
|
||||
* @version 1.1.0
|
||||
***************************************************************************/
|
||||
|
||||
#pragma once
|
||||
|
||||
#include "mbed.h"
|
||||
|
||||
namespace multi_tasking {
|
||||
|
||||
class ResetDevice {
|
||||
public:
|
||||
explicit ResetDevice(Callback<void()> cb); // NOLINT(runtime/references)
|
||||
|
||||
// make the class non copyable
|
||||
ResetDevice(ResetDevice&) = delete;
|
||||
ResetDevice& operator=(ResetDevice&) = delete;
|
||||
|
||||
private:
|
||||
|
||||
// data members
|
||||
// instance representing the reset button
|
||||
InterruptIn _resetButton;
|
||||
};
|
||||
|
||||
} // namespace static_scheduling
|
Loading…
x
Reference in New Issue
Block a user