Dokładnie tak. Ja też tak mam
Problemem jest sama struktura regulatora. Regulator PID bazujący tylko na uchybie położenia nie będzie działał.
> Autor ELM publikuje schemat blokowy i kod źródłowy - można coś przylookać.
Zerknąłem na rysunek ze strukturą regulatora - dokładnie to o czym pisałem - regulator P-PI

Zrobiłem symulację. Jest pięknie. Teraz przerabiam nieco elektronikę i wrzucam to do procka.