mitzi player and incomplete client firmware

PinkConnection2-Firmware-Servo-HelenMitzi/PinkConnection2-Firmware-Servo-HelenMitzi.ino

@@ -0,0 +1,103 @@
+// PINKCONNECTION2 Client Program for Helen Henny/Mitzi Mozzarella Servo
+
+#include <Servo.h>
+#include <string.h>
+
+Servo servoChannel[19];
+byte onDegrees[19] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }; // these are incomplete, i need to tune them when i get the servos in
+byte offDegrees[19] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 };
+
+int byte1 = 0;
+int byte2 = 0;
+int byte3 = 0;
+int byte4 = 0;
+int byte5 = 0;
+
+void setup() {
+  servoChannel[0].attach(2);
+  servoChannel[1].attach(3);
+  servoChannel[2].attach(4);
+  servoChannel[3].attach(5);
+  servoChannel[4].attach(6);
+  servoChannel[5].attach(7);
+  servoChannel[6].attach(8);
+  servoChannel[7].attach(9);
+  for (int i = 0; i < 19; i++) servoChannel[i].write(offDegrees[i]);
+  Serial.begin(9600);
+}
+
+void loop() {
+  if (Serial.available() > 4) {
+    byte1 = Serial.read();
+    byte2 = Serial.read();
+    byte3 = Serial.read();
+    byte4 = Serial.read();
+    byte5 = Serial.read();
+
+    if ((byte1 & 64) && (byte2 & 64))
+      if (byte1 & 1) {
+        servoChannel[0].write(onDegrees[0]);
+        digitalWrite(A0, 1);
+      } else {
+        servoChannel[0].write(offDegrees[0]);
+        digitalWrite(A0, 0);
+      }
+
+      if (byte1 & 2) {
+        servoChannel[1].write(onDegrees[1]);
+        digitalWrite(A1, 1);
+      } else {
+        servoChannel[1].write(offDegrees[1]);
+        digitalWrite(A1, 0);
+      }
+
+      if (byte1 & 4) {
+        servoChannel[2].write(onDegrees[2]);
+        digitalWrite(A2, 1);
+      } else {
+        servoChannel[2].write(offDegrees[2]);
+        digitalWrite(A2, 0);
+      }
+
+      if (byte1 & 8) {
+        servoChannel[2].write(onDegrees[3]);
+        digitalWrite(A3, 1);
+      } else {
+        //servoChannel[2].write(offDegrees[3]); dont
+        digitalWrite(A3, 0);
+      }
+
+      if (byte2 & 1) {
+        servoChannel[4].write(onDegrees[4]);
+        digitalWrite(A4, 1);
+      } else {
+        servoChannel[4].write(offDegrees[4]);
+        digitalWrite(A4, 0);
+      }
+
+      if (byte2 & 2) {
+        servoChannel[4].write(onDegrees[5]);
+        digitalWrite(A5, 1);
+      } else {
+        //servoChannel[4].write(offDegrees[5]); dont
+        digitalWrite(A5, 0);
+      }
+
+      if (byte2 & 4) {
+        servoChannel[6].write(onDegrees[6]);
+        digitalWrite(10, 1);
+      } else {
+        servoChannel[6].write(offDegrees[6]);
+        digitalWrite(10, 0);
+      }
+
+      if (byte2 & 8) {
+        servoChannel[7].write(onDegrees[7]);
+        digitalWrite(11, 1);
+      } else {
+        servoChannel[7].write(offDegrees[7]);
+        digitalWrite(11, 0);
+      }
+  
+  }
+}