Add dynamic_reconfigure feature