function renaming, solved handling of pid_controller for *_PID methods, better debug output