       lastSkittleTime = millis();
       // Serial.println("Start measuring this Skittle's color.");
       isColorBeingMeasured = true;
-      min_clear = C_HOLE_CLEAR;// C_SKITTLE_CLEAR;
+      min_clear = C_HOLE_CLEAR;
   }
   if(isColorBeingMeasured){
     if(colors.c < min_clear){

#include <LiquidCrystal.h>      // LCD display
#include <Servo.h>              // Servos
#include "Adafruit_TCS34725.h"  // Color Sensor
#include "C_Color.h"            // Color Processing Class

// Calibrated Skittle's Colors
// These are the skittle's colors 
#define C_SKITTLE_GREEN C_Color(64, 109, 51) 

// Initialize the display with the numbers of the interface pins
LiquidCrystal lcd(PIN_LCD_RS, PIN_LCD_ENABLE, PIN_LCD_D4, PIN_LCD_D5, PIN_LCD_D6, PIN_LCD_D7);

  servoBtm.write(btmAngle);
}

void __calibrating(C_Color new_color){
  /* This function is used to test and get the average color 
   *  of a certain Skittle
  */
  static C_Color avg_c = C_Color(new_color.r, new_color.g, new_color.b);
  static int count = 0;
  int diff = avg_c.compare(new_color).aggregate();
  Serial.print("Diff: "); Serial.println(diff);
  if(diff > 64){
    Serial.println("Difference too big. This data is discarded.");
  }else{
    avg_c.r = (avg_c.r * count + new_color.r) / (count + 1);
    avg_c.g = (avg_c.g * count + new_color.g) / (count + 1);
    avg_c.b = (avg_c.b * count + new_color.b) / (count + 1);
    count++;
    Serial.println("Average color:");
    avg_c.print();
  }
  
  
}
