rqt_reconfigure) Code cleanup, add TODO for upcoming fixation.