The PID code can be found here.
http://kevin.org/frc/navigation_frc2005_01_08.zip
This code does not support the CMUcam.
This is the unofficial version of the code that supports the camera, gyro, PID, and scripting.
http://www.chiefdelphi.com/forums/pa...le&paperid=413