TeamLib
See also:
PID Controller
http://www.youtube.com/watch?v=7BDjZYGHupE&fmt=18