Commented and reformatted TestOpenCV.cpp, renamed to main.cpp.

Precursor to further pathing work and implementation with PID class.