Cleaned up code

Removed un-necessary code and variables.
Implemented TouchSensor Class

Implemented TouchSensor Class.
Cleaned up code.
Improved logic in state machines

Improved logic in state machines.
Added a GOAL_KICK_DELAY state.