Cleaned up CMakelists.txt.
Cleaned up README.md.
Cleaned up FSMDriver.
Tried to clean up StraightLine.h.
Cleaned up Stuck.h.
Tried to clean up OutOfTrack.h.