MewPro4/a_Queue.ino at master · orangkucing/MewPro4 · 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
boolean inputAvailable()
{
  if (queueidx != -1 || Serial.available()) {
    return true;
  }
  return false;
}

int unreadBuf = -1;
void myUnread(char c)
{
  unreadBuf = c & 0xFF;
}

char myRead()
{
  char c;
  if (unreadBuf != -1) {
    c = (char)unreadBuf;
    unreadBuf = -1;
    return c;
  }
  if (serialfirst && Serial.available()) {
    return Serial.read();
  }
  if (queueidx != -1) {
    c = (char)pgm_read_byte(queueadr + queueidx++);
    if (!c) {
      queueidx = -1;
      c = '\n';
    }
    serialfirst = false;
    return c;
  }
  serialfirst = true;
  return Serial.read();
}

// Utility functions
void queueIn(char *p)
{
  queueadr = p;
  queueidx = 0;
}

void __emptyInputBuffer()
{
  while (inputAvailable()) {
    if (myRead() == '\n') {
      return;
    }
  }
}

void emptyQueue()
{
  queueidx = -1;
  recvc = 0;
  bufp = 6;
  serialfirst = false;
  while (Serial.available()) { // clear serial buffer
    Serial.read();
  }
}

// Utility functions for standalone
void startRecording()
{
  switch (mode) {
    case MODE_VIDEO:
      queueIn((char *)F("YY00021B0000"));
      break;
    case MODE_PHOTO:
      queueIn((char *)F("YY0003170000"));
      break;
    case MODE_MULTI_SHOT:
      queueIn((char *)F("YY00041B0000"));
      break;
  }
}

void stopRecording()
{
  switch (mode) {
    case MODE_VIDEO:
      queueIn((char *)F("YY00021C0000"));
      break;
    case MODE_PHOTO:
      queueIn((char *)F("YY0003180000"));
      break;
    case MODE_MULTI_SHOT:
      queueIn((char *)F("YY00041C0000"));
      break;
  }
}