Added back in all dynamic reconfigure parameters and removed selftest and diagnostics