Such mal im mikrocontroller.net bei Softeware nach PID, da findest Du jede Menge Code.