summaryrefslogtreecommitdiff
path: root/src/drivers/relative_wheel.cpp
blob: de982d5a85ee96b769bb0a5526015e063d9271e8 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
/*
 * Copyright 2023 jacqueline <me@jacqueline.id.au>
 *
 * SPDX-License-Identifier: GPL-3.0-only
 */

#include "relative_wheel.hpp"

#include <stdint.h>
#include <cstdint>

#include "esp_log.h"

namespace drivers {

RelativeWheel::RelativeWheel(TouchWheel* touch)
    : touch_(touch),
      is_clicking_(false),
      was_clicking_(false),
      is_first_read_(true),
      ticks_(0),
      last_angle_(0) {}

auto RelativeWheel::Update() -> void {
  touch_->Update();
  TouchWheelData d = touch_->GetTouchWheelData();

  is_clicking_ = d.is_button_touched;

  if (is_clicking_) {
    ticks_ = 0;
    return;
  }

  if (!d.is_wheel_touched) {
    ticks_ = 0;
    is_first_read_ = true;
    return;
  }

  uint8_t new_angle = d.wheel_position;
  if (is_first_read_) {
    is_first_read_ = false;
    last_angle_ = new_angle;
    return;
  }

  int delta = 128 - last_angle_;
  uint8_t rotated_angle = new_angle + delta;
  int threshold = 20;

  if (rotated_angle < 128 - threshold) {
    ticks_ = 1;
    last_angle_ = new_angle;
  } else if (rotated_angle > 128 + threshold) {
    ticks_ = -1;
    last_angle_ = new_angle;
  } else {
    ticks_ = 0;
  }

}

auto RelativeWheel::is_clicking() -> bool {
  bool ret = is_clicking_;
  is_clicking_ = 0;
  return ret;
}

auto RelativeWheel::ticks() -> std::int_fast16_t {
  int_fast16_t t = ticks_;
  if (t != 0) {
    ESP_LOGI("teeks", "ticks %d", t);
  }
  ticks_ = 0;
  return t;
}

}  // namespace drivers