Java Lego Robotics drive system procedure - Doolittle Institute Lego Mini Urban Challenge