This is the lejos code that was on my robot that received second place at the MICS Robotics Competition.