In addition to the link Mike Soukup posted, I have two more links for you.
My post in the "
Drivetrain, what did you use?" thread talks about our drivetrain from 2003 and has a brief overview of the way we controlled it. There're also many threads about programming a swerve (which is very intimately involved in how the control system is set up). I recommend hunting them down and reviewing them.