Fixed reset bug and added new port mappings

Author: himalayanelixir

arduino_controller/Port Mapping.txt

@@ -0,0 +1,4 @@
+
+    1               2           3           4           5           6               7           8           9               10          11              12          13              14           15             16            17            18          19              20              21              22            
+
+{{11, 12, 13}, {8, 9, 10}, {5, 6, 7}, {2, 3, 4}, {14, 15, 16}, {17, 18, 19}, {20, 21, 22}, {23, 24, 25}, {29, 30, 31}, {35, 36, 37}, {41, 42, 43}, {47, 48, 49}, {26, 27, 28}, {32, 33, 34}, {38, 39, 40}, {44, 45, 46}, {50, 51, 52}, {53, 54, 55}, {56, 57, 58}, {59, 60, 61}, {63, 64, 65}, {62, 66, 67}};

arduino_controller/arduino_controller.ino

@@ -5,10 +5,11 @@
 #define DEBOUNCE_TIME .4
 #define SAMPLE_FREQUENCY 20
 #define MAXIMUM (DEBOUNCE_TIME * SAMPLE_FREQUENCY)
-#define NUMBER_MOTORS 1
+#define NUMBER_MOTORS 3
 #define TIMEOUT 10000
 
 // relay pin
+//int relayPin = 69;
 int relayPin = 53;
 
 // function declarations`
@@ -25,18 +26,17 @@ bool new_data = false;
 // initialize motors
 Servo my_servo[NUMBER_MOTORS];
 // create a array of ports with the order: motor, counter, reset
-int ports[NUMBER_MOTORS][3] = {{2, 3, 4}};
-// int ports[NUMBER_MOTORS][3] = {{2, 3, 4}, {5, 6, 7}, {8, 9, 10}, {11, 12, 13}, {22, 23, 24}, {25, 26, 27}, {28, 29, 30}, {31, 32, 33}, {34, 35, 36}};
-// int ports[NUMBER_MOTORS][3] = {{2, 3, 4}, {5, 6, 7}, {8, 9, 10}, {11, 12, 13}, {22, 23, 24}, {25, 26, 27}};
+// int ports[NUMBER_MOTORS][3] = {{62, 66, 67}};
+int ports[NUMBER_MOTORS][3] = {{2, 3, 4},{5, 6, 7},{8, 9, 10}};
 // integer array that contains the direction and number of rotations a motor
 // needs to go
 int motor_commands[NUMBER_MOTORS][2] = {0};
 
 // array of new switch values
-byte motor_sensor_counter1[NUMBER_MOTORS] = {1};
+byte motor_sensor_counter1[NUMBER_MOTORS] = {0};
 
 // array of old switch values
-byte motor_sensor_counter2[NUMBER_MOTORS] = {1};
+byte motor_sensor_counter2[NUMBER_MOTORS] = {0};
 
 // 0 or 1 depending on the input signal
 byte input[NUMBER_MOTORS] = {0};

arduino_controller/arduino_controller_functions.ino

@@ -121,7 +121,11 @@ void ProcessData()
   }
   else
   {
-    int reset_counter[NUMBER_MOTORS] = {1};
+    int reset_counter[NUMBER_MOTORS] = {0};
+
+    for (int i = 0; i < NUMBER_MOTORS; ++i){
+      reset_counter[i] = 1;
+    }
 
     while (go == true)
     {
@@ -140,6 +144,9 @@ void ProcessData()
         total_turns += reset_counter[i];
       }
 
+      Serial.print("Total Turns: ");
+      Serial.println(total_turns);
+
       if (total_turns <= 0)
       {
         go = false;