Refactor color sensor code to separate file

This change aims to modularize the robot code by moving the color sensor code to a separate file.

Summary of Changes

• Add color.h and color.cpp file
• Move all functions to the color files
• Move the global variables associated with color to color.cpp
• Add a calibrateWhite and calibrateBlack() function