rqt_reconfigure) Minor; performance improve. Add avoid possible deadlock.