/*
 * peripherals_button.hpp
 *
 *  Created on: Apr 17, 2021
 *      Author: erki
 */

#ifndef SKULLC_PERIPHERALS_BUTTON_HPP_
#define SKULLC_PERIPHERALS_BUTTON_HPP_

#include <cstdint>

namespace Peripherals
{

enum class ButtonPress : std::uint32_t
{
  NOT_PRESSED,
  SHORT_PRESS,
  LONG_PRESS
};

template<typename G, typename H>
class Button
{
public:
  using gpio = G;
  using hal = H;

  gpio sw;

  static constexpr std::uint32_t TIMEOUT_SHORT_PRESS = 50;
  static constexpr std::uint32_t TIMEOUT_LONG_PRESS = 500;

  Button() = delete;
  explicit Button(const gpio& sw)
      : sw(sw)
  {}

  void update()
  {
    const bool is_pressed = sw.read();
    ButtonPress new_state = ButtonPress::NOT_PRESSED;

    const std::uint32_t time_held = hal::getMillis() - time_pressed_down_;

    if (is_pressed && !was_pressed_)
    {
      time_pressed_down_ = hal::getMillis();
    }
    else if (!is_pressed && was_pressed_)
    {
      if (time_held > TIMEOUT_SHORT_PRESS && time_held <= TIMEOUT_LONG_PRESS)
        new_state = ButtonPress::SHORT_PRESS;

      time_pressed_down_ = 0;
    }
    else if (is_pressed && was_pressed_)
    {
      if (current_state_ == ButtonPress::NOT_PRESSED && time_held > TIMEOUT_LONG_PRESS)
        new_state = ButtonPress::LONG_PRESS;
    }

    was_pressed_ = is_pressed;
    current_state_ = new_state;
  }

  [[nodiscard]] ButtonPress getState() const
  {
    return current_state_;
  }

private:
  bool was_pressed_ = false;
  std::uint32_t time_pressed_down_ = 0;
  ButtonPress current_state_ = ButtonPress::NOT_PRESSED;
};

}// namespace Peripherals

#endif /* SKULLC_PERIPHERALS_BUTTON_HPP_ */