Reorganized into packages, built main classes for running our program. Started writing GUI to follow real robot.