     delay(5);
     Serial.print(" ");
     delay(5);
-    Serial.print(VELS_COMMAND_INDEXES[i]);
+    Serial.print(VELS_COMMANDS[i]);
     delay(5);
     Serial.print(" ");
     delay(5);

        
        lastMeasureTime = currentTime;
        velsTimes[velsIndex] = currentTime - BASE_TIME;
        velsCommandIndexes[velsIndex++] = volComsIndex;
      }
    }
  }

where TOTAL_TICKS is the number of ticks per revolution, which is approximately 3000.

Author: Ryan J. Marcotte
Date: 18 March 2014
*/

//#####SYSTEM ID PARAMETERS#######
//#####MODIFY THESE FIELDS########
#define TEST_PIN FORWARD_RIGHT //the pin of the motor you are working with (options: FORWARD_RIGHT,
                                  //FORWARD_LEFT, REVERSE_RIGHT, REVERSE_LEFT)
const int TOTAL_VOL_COMS = 20; //the total number of voltage commands to be executed by the robot
                               //increasing beyond ~20, memory can become an issue
                               //if the board runs out of memory, it resets itself which can be 
                               //a challenging bug to diagnose
const int MIN_COM_DUR = 5; //the minimum duration a command could be executed for
