// 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_atomic.h"
#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(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