Cleaned up more unused leJOS and worked on making RegulatedDrivetrain project independent.
Added command to go to random waypoint given environment map.