Fix warning dynamic_reconfigure

Author: rbonghi

diff_drive_controller/include/diff_drive_controller/diff_drive_controller.h

@@ -234,8 +234,8 @@ namespace diff_drive_controller{
 
     /// Dynamic Reconfigure server
     typedef dynamic_reconfigure::Server<DiffDriveControllerConfig> ReconfigureServer;
-
     std::shared_ptr<ReconfigureServer> dyn_reconf_server_;
+    boost::recursive_mutex dyn_reconf_server_mutex_;
 
   private:
     /**

diff_drive_controller/src/diff_drive_controller.cpp

@@ -374,8 +374,13 @@ namespace diff_drive_controller{
     config.publish_rate = publish_rate;
     config.enable_odom_tf = enable_odom_tf_;
 
-    dyn_reconf_server_ = std::make_shared<ReconfigureServer>(controller_nh);
+    dyn_reconf_server_ = std::make_shared<ReconfigureServer>(dyn_reconf_server_mutex_, controller_nh);
+
+    // Update parameters
+    dyn_reconf_server_mutex_.lock();
     dyn_reconf_server_->updateConfig(config);
+    dyn_reconf_server_mutex_.unlock();
+
     dyn_reconf_server_->setCallback(boost::bind(&DiffDriveController::reconfCallback, this, _1, _2));
 
     return true;