Check out this thread
http://www.chiefdelphi.com/forums/sh...ad.php?t=71887
The last post has a link to the code that team 330 is using. We took this code over the weekend and had our robot tracking the flag after about 5 hours of tweaking the PID loop constants and adding in the ability to read the USER1 switch on the cRIO to determine the alliance.