     lastSkittleTime = millis();
   }
 
-  if (topServoTimeoutEnable && reverseDirection && millis() - lastSkittleTime > 500) {
-    // Set direction back to normal after .5s
+  if (F_TOP_SERVO_TIMEOUT_ENABLED && reverseDirection && millis() - lastSkittleTime > 1000) {
+    // Set direction back to normal after 1s
     reverseDirection = false;
   }
 

// Create the color sensor object
Adafruit_TCS34725 tcs = Adafruit_TCS34725(C_ATIME, TCS34725_GAIN_1X);

// The number of skittles sorted
int skittleCount = 0;
// Time when the last skittle was being sorted
unsigned long lastSkittleTime = 0;

void setup() {
  // Set up the serial for debugging purposes

//    Color View Red pin to diginal pin 7
//    Color View Green pin to diginal pin 9
//    Color View Blue pin to diginal pin 6
#define PIN_COLOR_RED 7
#define PIN_COLOR_GREEN 9
#define PIN_COLOR_BLUE 6
// * LCD
//    RS pin to digital pin 12
#define PIN_LCD_RS 12
