Посмотрите посты пользователя CeKip. В том числе он ПИД регуляторы выкладывал.