The Revised and final version of the controller I designed for RBE2002 at WPI in Spring 2011