screwdriver/ScrewDriver.cpp at master · t-coons/screwdriver · 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

#include "ScrewDriver.h"

ScrewDriver::ScrewDriver() {
}

ScrewDriver::COMMAND_NAMES ScrewDriver::ParseCommand(String s) {
  s.toLowerCase();
  if (s.equals("set"))
    return SET;
  if (s.equals("update"))
    return UPDATE;
  if (s.equals("list"))
    return LIST;
  if (s.equals("print"))
    return PRINT;
  return NONE;

}

ScrewDriver::COMMAND ScrewDriver::Tokenize(String s) {
  COMMAND cmd;
  s.trim();
  int i = s.indexOf(' ');
  if (i == -1) {
    cmd.name = ParseCommand(s);
  } else {
    cmd.name = ParseCommand(s.substring(0, i));
    int j = s.indexOf(' ', i + 1);
    if (j != -1) {
      cmd.variable = s.substring(i + 1, j);
    } else {
      cmd.variable = s.substring(i + 1);
    }
    if (j != -1) {
      int k = s.indexOf(' ', j + 1);
      if (k != -1) {
        cmd.value = s.substring(j + 1, k);
      } else {
        cmd.value = s.substring(j + 1);
      }
    }
  }
  return cmd;
}

int ScrewDriver::VariableLookup(String varName) {
  for (unsigned int i = 0; i < variableMapSize; i++) {
    if (varName.equals(variableMap[i].varName)) {
      return i;
    }
  }
  return -1;
}

void ScrewDriver::ListVariables() {
  for (unsigned int i = 0; i < variableMapSize; i++) {
    Serial.print(variableMap[i].varName);
    Serial.print("[");
    variableMap[i].var.PrintType();
    Serial.print("]");
    Serial.print(": ");
    variableMap[i].var.Print();
    Serial.println();
  }
}

void ScrewDriver::PrintVariable(String varName) {
  int i = VariableLookup(varName);
  Serial.print(varName);
  if (i > -1) {
    Serial.print("[");
    variableMap[i].var.PrintType();
    Serial.print("]");
    Serial.print(": ");
    variableMap[i].var.Print();
  }
  Serial.println();
}

void ScrewDriver::AddVariableMap(VARIABLE_PAIR variableMap[], unsigned int variableMapSize) {
  this->variableMap = variableMap;
  this->variableMapSize = variableMapSize;
}

void ScrewDriver::Run(String s) {
  Serial.println(s);
  COMMAND cmd = Tokenize(s);
  if (cmd.name == NONE) {
    return;
  }
  int i = 0;
  switch (cmd.name) {
    case SET:
      // TODO: Impliment set
      break;
    case UPDATE:
      i = VariableLookup(cmd.variable);
      if (i > -1) {
        variableMap[i].var.Set(cmd.value);
      }
      break;
    case LIST:
      ListVariables();
      break;
    case PRINT:
      PrintVariable(cmd.variable);
      break;
  }
}

ScrewDriver::~ScrewDriver() {
}