Implemented Camera Class

Moved camera code into class.
Moved thresholds & constants to config file.
Cleaned up camera code

Cleaned up camera code.
Removed un-necessary delays.