Finished basic in-house field test

Added more Serial debug logging.
Attached motors and tweaked motor methods so that robot moves in the
correct direction.
Tweaked PID constants for more optimal motion (to be adjusted more later)
Slightly modified the example code to help with motor configuration.