pid: adding verbose as a paramter which gets set over rosparam
rml: major refactor