Initial commit

src/main.cpp

@@ -0,0 +1,141 @@
+// Other peoples libraries
+#include <Arduino.h>
+#include <BluetoothSerial.h>
+
+// project specific libraries
+#include "BluetoothSerialMessage.h"
+#include "BoardLayout.h"
+#include "BOARD-DEFINITIONS.h"
+#include "Color.h"
+#include "ColorManager.h"
+
+// --------------------------------------------------
+// ----------------- Types ----------------------
+// --------------------------------------------------
+enum Commands : uint8_t{
+  BoardState = 0,
+  PING = 1,
+  SetStackColors = 2,
+  GoToIdle = 3
+};
+
+// --------------------------------------------------
+// ------------- OBJECT DEFINITIONS -----------------
+// --------------------------------------------------
+BluetoothSerial SerialBT;
+BluetoothSerialMessage serialMessageBT(&SerialBT);
+SerialMessage serialMessage(&Serial);
+BoardLayout board(BOARD_WIDTH, BOARD_LENGTH, BOARD_HEIGHT, stacks);
+
+// Temporary thing until we can get bluetooth color management working on the quest
+ColorManager colorManager(&board);
+
+// --------------------------------------------------
+// ----------------- VARIABLES ----------------------
+// --------------------------------------------------
+
+// --------------------------------------------------
+// ----------------- FUNCTIONS ----------------------
+// --------------------------------------------------
+void printBoardState(){
+  // create a buffer to hold the board state
+  uint16_t boardState[BOARD_WIDTH * BOARD_LENGTH];
+  // read in the board state
+  board.GetBoardState(boardState);
+
+  Serial.print("!0,");
+  SerialBT.print("!0,");
+
+  for(int i = 0; i < (BOARD_WIDTH * BOARD_LENGTH); i++){
+    Serial.print(boardState[i]);
+    SerialBT.print(boardState[i]);
+    if(i == (BOARD_WIDTH * BOARD_LENGTH) - 1){
+      break;
+    }
+    Serial.print(",");
+    SerialBT.print(",");
+  }
+
+  Serial.println(";");
+  SerialBT.println(";");
+}
+
+void setStackColor(int * args, int argsLength){
+  int stackNum = args[1];
+  int numColors = (argsLength - 2) / 3;
+  Color colors[numColors];
+  
+  for(int i = 0; i < numColors; i++){
+    int red = args[2 + (i * 3)];
+    int green = args[3 + (i * 3)];
+    int blue = args[4 + (i * 3)];
+    colors[i] = Color(red, green, blue);
+  }
+
+  board.SetStackColors(stackNum, colors);
+
+
+}
+
+void parseData(int * args, int argsLength){
+  int command = args[0];
+  switch(command){
+    case Commands::BoardState:
+      printBoardState();
+      break;
+    case Commands::PING:
+      Serial.print("!");
+      SerialBT.print("!");
+      Serial.print(Commands::PING);
+      SerialBT.print(Commands::PING);
+      Serial.println(";");
+      SerialBT.println(";");
+      break;
+    case Commands::SetStackColors:
+      Serial.println("!2;");
+      SerialBT.println("!2;");
+      colorManager.Enable(false);
+      setStackColor(args, argsLength);
+      break;
+    case Commands::GoToIdle:
+      Serial.println("!3;");
+      SerialBT.println("!3;");
+      colorManager.Enable(true);
+      break;
+    default:
+      Serial.println("INVALID COMMAND");
+      SerialBT.println("INVALID COMMAND");
+      break;
+  }
+}
+
+// --------------------------------------------------
+// ----------------- SETUP AND LOOP -----------------
+// --------------------------------------------------
+void setup() {
+  Serial.begin(115200);
+  SerialBT.begin("blockPartyBT");
+  Color colors[] = {Color(255, 0, 0), Color(0, 0, 0), Color(0, 0, 0)};
+  board.SetStackColors(2, colors);
+  
+}
+
+void loop() {
+  if(board.BoardStateHasChanged()){
+    printBoardState();
+    
+  }
+
+  // DO serial processing
+  serialMessage.Update();
+  if(serialMessage.IsNewData()){
+    parseData(serialMessage.GetArgs(), serialMessage.GetArgsLength());
+    serialMessage.ClearNewData();
+  }
+  serialMessageBT.Update();
+  if(serialMessageBT.IsNewData()){
+    parseData(serialMessageBT.GetArgs(), serialMessageBT.GetArgsLength());
+    serialMessageBT.ClearNewData();
+  }
+  colorManager.Update();
+}