Lots of code cleanup. Not fully functional.

Smart Robot is broken. Velocity PID Controller doesn't work - needs
attention. Simple (dumb) tank drive works though.