Minimal PID controller that doesnt overflow the stack ..