pid output filter added

optional output filter
Autotuning prototype

work in progress