83 lines
2.7 KiB
C++
83 lines
2.7 KiB
C++
// 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>
|
|
*
|
|
* @brief Gear Device implementation (static scheduling)
|
|
*
|
|
* @date 2023-08-20
|
|
* @version 1.0.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 static_scheduling {
|
|
|
|
// definition of task execution time
|
|
static constexpr std::chrono::microseconds kTaskRunTime = 100000us;
|
|
|
|
GearDevice::GearDevice(Timer& timer) : _timer(timer) {}
|
|
|
|
uint8_t GearDevice::getCurrentGear() {
|
|
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::UpPressed:
|
|
if (_currentGear < bike_computer::kMaxGear) {
|
|
_currentGear++;
|
|
}
|
|
hasChanged = true;
|
|
break;
|
|
|
|
case disco::Joystick::State::DownPressed:
|
|
if (_currentGear > bike_computer::kMinGear) {
|
|
_currentGear--;
|
|
}
|
|
hasChanged = true;
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
elapsedTime = _timer.elapsed_time() - initialTime;
|
|
}
|
|
return _currentGear;
|
|
}
|
|
|
|
uint8_t GearDevice::getCurrentGearSize() const {
|
|
// simulate task computation by waiting for the required task run time
|
|
// wait_us(kTaskRunTime.count());
|
|
return bike_computer::kMaxGearSize - _currentGear;
|
|
}
|
|
|
|
} // namespace static_scheduling
|