Wrote some methods for ball finding and added the servo stuff to the MoveRobot file.