MothOS/LedManager.cpp at main · tratzla/MothOS · GitHub

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
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
#include "Arduino.h"
#include "LedManager.h"

LedManager::LedManager(int pinA, int pinB, int pinC, int pinD) {

  outPinA = pinA;
  outPinB = pinB;
  outPinC = pinC;
  outPinD = pinD;
  pinMode(outPinA, OUTPUT);
  pinMode(outPinB, OUTPUT);
  pinMode(outPinC, OUTPUT);
  pinMode(outPinD, OUTPUT);
  lastMillis = millis();
  command = 'T';
}

void LedManager::SetPattern(bool pPlay, int p) {
  patternPlay = pPlay;
  pattern = p;
}

void LedManager::UpdateLed() {
  if (command == 'T') {
    float timeDelta = millis() - lastMillis;
    lastMillis = millis();

    if (timeLit > 0) {
      timeLit -= timeDelta;
      if (timeLit <= 0) {
        digitalWrite(outPinA, LOW);
        digitalWrite(outPinB, LOW);
        digitalWrite(outPinC, LOW);
        digitalWrite(outPinD, LOW);
      }
    }
  }
  if (patternPlay) {
    flipBlink = !flipBlink;
    if (flipBlink) {
      switch (pattern) {
        case 0:
          digitalWrite(outPinA, HIGH);
          break;
        case 1:
          digitalWrite(outPinB, HIGH);
          break;
        case 2:
          digitalWrite(outPinC, HIGH);
          break;
        case 3:
          digitalWrite(outPinD, HIGH);
          break;
      }
    } else {
      switch (pattern) {
        case 0:
          digitalWrite(outPinA, LOW);
          break;
        case 1:
          digitalWrite(outPinB, LOW);
          break;
        case 2:
          digitalWrite(outPinC, LOW);
          break;
        case 3:
          digitalWrite(outPinD, LOW);
          break;
      }
    }
  }
}

void LedManager::SetCommand(char com) {
  command = com;
  digitalWrite(outPinA, LOW);
  digitalWrite(outPinB, LOW);
  digitalWrite(outPinC, LOW);
  digitalWrite(outPinD, LOW);
  switch (command) {
    case 'A':
      digitalWrite(outPinA, HIGH);
      break;
    case 'B':
      digitalWrite(outPinB, HIGH);
      break;
    case 'C':
      digitalWrite(outPinC, HIGH);
      break;
    case 'D':
      digitalWrite(outPinD, HIGH);
      break;
    case 'T':
      break;
  }
}

void LedManager::SetLit(float time, int col) {

  if (command != 'T') {
    return;
  }

  digitalWrite(outPinA, LOW);
  digitalWrite(outPinB, LOW);
  digitalWrite(outPinC, LOW);
  digitalWrite(outPinD, LOW);
  if (col == 0) {
    digitalWrite(outPinA, HIGH);
  } else if (col == 1) {
    digitalWrite(outPinB, HIGH);
  } else if (col == 2) {
    digitalWrite(outPinC, HIGH);
  } else if (col == 3) {
    digitalWrite(outPinD, HIGH);
  }
  timeLit = time;
}