PID controllers now automatically publish feedback info. Added a launch file to start rqt_plot to visualize this.