This code seems to have only the proportional control. I just tried to put together the integral and differential components as well and it works well. However, my code is just for driving backwards:
There is a great lecture on PID posted here
but it in the text code, but the blocks seem to be more accessible for most kids.
