diff --git a/config/adc_common/adc_global_ekf_odom_imu_amcl.yaml b/config/adc_common/adc_global_ekf_odom_imu_amcl.yaml
index 1a9f4503c6695b14bc89eb67c2c10f50eb680bea..b3434fd215a3326265c4c459bfea58477b15ed83 100644
--- a/config/adc_common/adc_global_ekf_odom_imu_amcl.yaml
+++ b/config/adc_common/adc_global_ekf_odom_imu_amcl.yaml
@@ -9,7 +9,7 @@ use_control: true
 control_config: [true, true, false, false, false, true]
 
 
-publish_tf: false
+publish_tf: true
 map_frame: map
 odom_frame: adc_car/odom
 base_link_frame: adc_car/base_footprint
diff --git a/config/adc_common/landmarks_loc/amcl_mapping.yaml b/config/adc_common/landmarks_loc/amcl_mapping.yaml
index bbbbe0e8b7e0f8625f23e859daf66717abbf860a..1be0e2a61d65c44ec6d03a3ec0c145855e8a20e8 100644
--- a/config/adc_common/landmarks_loc/amcl_mapping.yaml
+++ b/config/adc_common/landmarks_loc/amcl_mapping.yaml
@@ -3,20 +3,21 @@ global_frame: "map"
 odom_frame: "adc_car/odom"
 base_link_frame: "adc_car/base_link"
 tf_timeout: 0.1
+amcl_pose_estimated_sigma: 0.25
 publish_pose_rate: 0.001
 publish_pose_distance: 0.1
 publish_pose_angle: 0.1
 
-publish_visualization : True
-load_landmarks : False
-landmarks_pos_fixed : False
-search_for_new_landmarks : True
-first_robot_state_fixed : False
-last_robot_state_fixed : True
-all_robot_states_fixed : True
-amcl_localization : True
-calculate_covariance : False
-publish_tf_map_odom : False
+publish_visualization: True
+load_landmarks: False
+landmarks_pos_fixed: False
+search_for_new_landmarks: True
+first_robot_state_estimated: False
+last_robot_state_estimated: False
+all_robot_states_estimated: True
+amcl_localization: True
+calculate_covariance: False
+publish_tf_map_odom: False
 
 update_problem_rate: 0.1
 update_problem_distance: 0.2
diff --git a/config/adc_common/landmarks_loc/landmarks_calibration.yaml b/config/adc_common/landmarks_loc/landmarks_calibration.yaml
index a66e49dbb8b4b8b5496ad51f5f72ec54b4a5a410..a3c83ed3db029dd4935f67ed2a113f2726935078 100644
--- a/config/adc_common/landmarks_loc/landmarks_calibration.yaml
+++ b/config/adc_common/landmarks_loc/landmarks_calibration.yaml
@@ -3,20 +3,21 @@ global_frame: "map"
 odom_frame: "adc_car/odom"
 base_link_frame: "adc_car/base_link"
 tf_timeout: 0.1
+amcl_pose_estimated_sigma: 0.25
 publish_pose_rate: 0.001
 publish_pose_distance: 0.1
 publish_pose_angle: 0.1
 
-publish_visualization : True
-load_landmarks : True
-landmarks_pos_fixed : False
-search_for_new_landmarks : False
-first_robot_state_fixed : True
-last_robot_state_fixed : False
-all_robot_states_fixed : False
-amcl_localization : False
-calculate_covariance : False
-publish_tf_map_odom : True
+publish_visualization: True
+load_landmarks: True
+landmarks_pos_fixed: False
+search_for_new_landmarks: False
+first_robot_state_estimated: True
+last_robot_state_estimated: False
+all_robot_states_estimated: False
+amcl_localization: False
+calculate_covariance: False
+publish_tf_map_odom: True
 
 update_problem_rate: 0.1
 update_problem_distance: 0.2
diff --git a/config/adc_common/landmarks_loc/landmarks_calibration_amcl.yaml b/config/adc_common/landmarks_loc/landmarks_calibration_amcl.yaml
index 0c27f1ef45e0a30722769ddc7e220bd1d57924d2..448a4d566d9c2dd3b6ae0b84c72cc4792a357974 100644
--- a/config/adc_common/landmarks_loc/landmarks_calibration_amcl.yaml
+++ b/config/adc_common/landmarks_loc/landmarks_calibration_amcl.yaml
@@ -3,20 +3,21 @@ global_frame: "map"
 odom_frame: "adc_car/odom"
 base_link_frame: "adc_car/base_link"
 tf_timeout: 0.1
+amcl_pose_estimated_sigma: 0.25
 publish_pose_rate: 0.001
 publish_pose_distance: 0.1
 publish_pose_angle: 0.1
 
-publish_visualization : True
-load_landmarks : True
-landmarks_pos_fixed : False
-search_for_new_landmarks : False
-first_robot_state_fixed : False
-last_robot_state_fixed : False
-all_robot_states_fixed : True
-amcl_localization : True
-calculate_covariance : False
-publish_tf_map_odom : False
+publish_visualization: True
+load_landmarks: True
+landmarks_pos_fixed: False
+search_for_new_landmarks: False
+first_robot_state_estimated: False
+last_robot_state_estimated: False
+all_robot_states_estimated: True
+amcl_localization: True
+calculate_covariance: False
+publish_tf_map_odom: False
 
 update_problem_rate: 0.1
 update_problem_distance: 0.2
diff --git a/config/adc_common/landmarks_loc/localization.yaml b/config/adc_common/landmarks_loc/localization.yaml
index 317fdbf6d1e7275d756484c6b275407abd2c9deb..0b9eec2f71532eda381cea0b0dcf6d0fbf1c6bad 100644
--- a/config/adc_common/landmarks_loc/localization.yaml
+++ b/config/adc_common/landmarks_loc/localization.yaml
@@ -3,20 +3,21 @@ global_frame: "map"
 odom_frame: "adc_car/odom"
 base_link_frame: "adc_car/base_link"
 tf_timeout: 0.1
+amcl_pose_estimated_sigma: 0.25
 publish_pose_rate: 0.001
 publish_pose_distance: 0.1
 publish_pose_angle: 0.1
 
-publish_visualization : True
-load_landmarks : True
-landmarks_pos_fixed : True
-search_for_new_landmarks : False
-first_robot_state_fixed : False
-last_robot_state_fixed : False
-all_robot_states_fixed : False
-amcl_localization : False
-calculate_covariance : True
-publish_tf_map_odom : True
+publish_visualization: True
+load_landmarks: True
+landmarks_pos_fixed: True
+search_for_new_landmarks: False
+first_robot_state_estimated: False
+last_robot_state_estimated: False
+all_robot_states_estimated: False
+amcl_localization: False
+calculate_covariance: True
+publish_tf_map_odom: True
 
 update_problem_rate: 0.1
 update_problem_distance: 0.2
diff --git a/config/adc_common/landmarks_loc/slam_mapping.yaml b/config/adc_common/landmarks_loc/slam_mapping.yaml
index b0ee7bb06c93cb791afe56a972219d9c519765f4..4e943f3c8d8fd32292d48141e899c6b9b594f6c7 100644
--- a/config/adc_common/landmarks_loc/slam_mapping.yaml
+++ b/config/adc_common/landmarks_loc/slam_mapping.yaml
@@ -3,20 +3,21 @@ global_frame: "map"
 odom_frame: "adc_car/odom"
 base_link_frame: "adc_car/base_link"
 tf_timeout: 0.1
+amcl_pose_estimated_sigma: 0.25
 publish_pose_rate: 0.001
 publish_pose_distance: 0.1
 publish_pose_angle: 0.1
 
-publish_visualization : True
-load_landmarks : False
-landmarks_pos_fixed : False
-search_for_new_landmarks : True
-first_robot_state_fixed : True
-last_robot_state_fixed : False
-all_robot_states_fixed : False
-amcl_localization : False
-calculate_covariance : False
-publish_tf_map_odom : True
+publish_visualization: True
+load_landmarks: False
+landmarks_pos_fixed: False
+search_for_new_landmarks: True
+first_robot_state_estimated: True
+last_robot_state_estimated: False
+all_robot_states_estimated: False
+amcl_localization: False
+calculate_covariance: False
+publish_tf_map_odom: True
 
 update_problem_rate: 0.1
 update_problem_distance: 0.2