diff --git a/calibration/head_camera_1024x768.yaml b/calibration/head_camera_1024x768.yaml
new file mode 100644
index 0000000000000000000000000000000000000000..c6b70bd29f69c0835e78bb49215e27454ee34549
--- /dev/null
+++ b/calibration/head_camera_1024x768.yaml
@@ -0,0 +1,20 @@
+image_width: 1024
+image_height: 768
+camera_name: head_camera
+camera_matrix:
+  rows: 3
+  cols: 3
+  data: [513.238105, 0.000000, 526.104889, 0.000000, 476.752621, 403.143888, 0.000000, 0.000000, 1.000000]
+distortion_model: plumb_bob
+distortion_coefficients:
+  rows: 1
+  cols: 5
+  data: [-0.262853, 0.034736, 0.000539, 0.000405, 0.000000]
+rectification_matrix:
+  rows: 3
+  cols: 3
+  data: [1.000000, 0.000000, 0.000000, 0.000000, 1.000000, 0.000000, 0.000000, 0.000000, 1.000000]
+projection_matrix:
+  rows: 3
+  cols: 4
+  data: [340.130188, 0.000000, 533.323878, 0.000000, 0.000000, 349.492493, 426.973587, 0.000000, 0.000000, 0.000000, 1.000000, 0.000000]
diff --git a/calibration/head_camera_640x480.yaml b/calibration/head_camera_640x480.yaml
new file mode 100644
index 0000000000000000000000000000000000000000..6e78206ccf0f430f0b3ac2911fca1eea978ce06e
--- /dev/null
+++ b/calibration/head_camera_640x480.yaml
@@ -0,0 +1,20 @@
+image_width: 640
+image_height: 480
+camera_name: head_camera
+camera_matrix:
+  rows: 3
+  cols: 3
+  data: [287.598727, 0.000000, 271.711029, 0.000000, 293.075813, 255.759142, 0.000000, 0.000000, 1.000000]
+distortion_model: plumb_bob
+distortion_coefficients:
+  rows: 1
+  cols: 5
+  data: [-0.234308, 0.033185, -0.004716, 0.016389, 0.000000]
+rectification_matrix:
+  rows: 3
+  cols: 3
+  data: [1.000000, 0.000000, 0.000000, 0.000000, 1.000000, 0.000000, 0.000000, 0.000000, 1.000000]
+projection_matrix:
+  rows: 3
+  cols: 4
+  data: [191.417130, 0.000000, 294.918463, 0.000000, 0.000000, 230.581131, 259.824962, 0.000000, 0.000000, 0.000000, 1.000000, 0.000000]
diff --git a/config/params_sim.yaml b/config/params_sim.yaml
index 977883e1b995ceb18fd711ca98ced59b18c812b3..2f79c94f99643d05995b1b60f7b1a88aa462b1d0 100644
--- a/config/params_sim.yaml
+++ b/config/params_sim.yaml
@@ -8,8 +8,8 @@ publish_tf: true
 publish_markers: true
 filter_outliers: false
 outliers_max_sq_error: 4.0
-use_manual_params: true
-fx: 70
-fy: 70
-cx: 320.5
-cy: 240.5
\ No newline at end of file
+use_manual_params: false
+  fx: 70
+  fy: 70
+  cx: 320.5
+  cy: 240.5
\ No newline at end of file
diff --git a/launch/fish_eye_camera.launch b/launch/fish_eye_camera.launch
new file mode 100644
index 0000000000000000000000000000000000000000..92b5c0782d65e53d4c266c1d63bb9ee66e58e23a
--- /dev/null
+++ b/launch/fish_eye_camera.launch
@@ -0,0 +1,30 @@
+<?xml version="1.0"?>
+<launch>
+ <arg name="dev" default="/dev/video0"/>
+ <arg name="w" default="640"/> <!-- 1024 , 640 -->
+ <arg name="h" default="480"/> <!-- 768  , 480 -->
+ <arg name="camera_info_url" default="$(find iri_visual_gps)/calibration/head_camera_$(arg w)x$(arg h).yaml"/>
+ <arg name="exposure"      default="15"/>
+ <arg name="white_balance" default="4000"/>
+ 
+ <node name="usb_cam"
+       pkg ="usb_cam"
+       type="usb_cam_node"
+       output="screen" >
+    <param name="video_device" value="$(arg dev)" />
+    <param name="image_width"  value="$(arg w)" />
+    <param name="image_height" value="$(arg h)" />
+    <param name="pixel_format" value="yuyv" />
+    <param name="camera_frame_id" value="usb_cam" />
+    <param name="io_method" value="mmap"/>
+    <param name="camera_info_url" value="file://$(arg camera_info_url)"/>
+    <param name="autoexposure"       value="false"/>
+    <param name="exposure"           value="$(arg exposure)"/>
+    <param name="auto_white_balance" value="false"/>
+    <param name="white_balance"      value="$(arg white_balance)"/>
+  </node>
+  
+  <node pkg="tf" type="static_transform_publisher" name="static_tf_camera_top"         args="0.128 0 0.187    0      -1.5709 -3.14159  base_link  top_camera         100" />
+  <node pkg="tf" type="static_transform_publisher" name="static_tf_camera_top_optical" args="0     0 0       -1.5709  0      -1.5709   top_camera top_camera_optical 100" />
+
+</launch>
\ No newline at end of file
diff --git a/launch/node.launch b/launch/node.launch
index 266ed9ecd814203fdd0279560c870e4ec2d22074..2ddb72ed8bf801c8c685b680443b5a2cbb5f7a08 100644
--- a/launch/node.launch
+++ b/launch/node.launch
@@ -2,7 +2,7 @@
 <!-- -->
 <launch>
 
-  <arg name="node_name"      default="iri_visual_gps"/>
+  <arg name="node_name"      default="visual_gps"/>
   <arg name="positions_file" default="position_sample.yaml"/>
   <arg name="param_file"     default="params_sample.yaml"/>
   <arg name="param_path"     default="$(find iri_visual_gps)/config"/>
diff --git a/launch/real.launch b/launch/real.launch
index de71734a6fbde97c568d00130cc1855d9add7886..ffb227e54351efe14afa6f3cfa4cfbb8a9c27a17 100644
--- a/launch/real.launch
+++ b/launch/real.launch
@@ -2,6 +2,7 @@
 <!-- -->
 <launch>
 
+  
   <include file="$(find iri_blob_detector)/launch/node.launch">
     <arg name="node_name"   value="blob_detector_red"/>
     <arg name="param_file"  value="red_lab.yaml"/>
@@ -34,32 +35,32 @@
     <arg name="blobs_topic" value="blob_detector_yellow/blobs"/>
   </include>
   
-  <include file="$(find undistort_pixels)/launch/node.launch">
+  <include file="$(find iri_undistort_pixels)/launch/node.launch">
     <arg name="node_name"       value="undistort_blob_red"/>
     <arg name="topic_blobs_in"  value="blob_detector_red/blobs"/>
     <arg name="topic_blobs_out" value="blob_detector_red/blobs_undist"/>
   </include>
   
-  <include file="$(find undistort_pixels)/launch/node.launch">
+  <include file="$(find iri_undistort_pixels)/launch/node.launch">
     <arg name="node_name"       value="undistort_blob_green"/>
     <arg name="topic_blobs_in"  value="blob_detector_green/blobs"/>
     <arg name="topic_blobs_out" value="blob_detector_green/blobs_undist"/>
   </include>
   
-  <include file="$(find undistort_pixels)/launch/node.launch">
+  <include file="$(find iri_undistort_pixels)/launch/node.launch">
     <arg name="node_name"       value="undistort_blob_blue"/>
     <arg name="topic_blobs_in"  value="blob_detector_blue/blobs"/>
     <arg name="topic_blobs_out" value="blob_detector_blue/blobs_undist"/>
   </include>
   
-  <include file="$(find undistort_pixels)/launch/node.launch">
+  <include file="$(find iri_undistort_pixels)/launch/node.launch">
     <arg name="node_name"       value="undistort_blob_yellow"/>
     <arg name="topic_blobs_in"  value="blob_detector_yellow/blobs"/>
     <arg name="topic_blobs_out" value="blob_detector_yellow/blobs_undist"/>
   </include>
   
   <include file="$(find iri_visual_gps)/launch/node.launch">
-    <arg name="node_name"       value="iri_visual_gps"/>
+    <arg name="node_name"       value="visual_gps"/>
     <arg name="positions_file"  value="position_lab.yaml"/>
     <arg name="param_file"      value="params_lab.yaml"/>
     <arg name="param_path"      value="$(find iri_visual_gps)/config"/>
diff --git a/launch/sim.launch b/launch/sim.launch
index 6799cb4d9ca9ea73c0b9d198882b5d68096cdb8a..343035e2dce3bcda4c46f9fff306f710cf40f3c4 100644
--- a/launch/sim.launch
+++ b/launch/sim.launch
@@ -1,6 +1,12 @@
 <?xml version="1.0"?>
 <!-- -->
 <launch>
+  
+  <!--
+  <include file="$(find seat_car_gazebo)/launch/sim.launch">
+    <arg name="fake_localization" value="false"/>
+  </include>
+  -->
 
   <include file="$(find iri_blob_detector)/launch/node.launch">
     <arg name="node_name"   value="blob_detector_red"/>
@@ -34,32 +40,33 @@
     <arg name="blobs_topic" value="blob_detector_yellow/blobs"/>
   </include>
   
-  <include file="$(find undistort_pixels)/launch/node.launch">
+  <include file="$(find iri_undistort_pixels)/launch/node.launch">
     <arg name="node_name"       value="undistort_blob_red"/>
     <arg name="topic_blobs_in"  value="blob_detector_red/blobs"/>
     <arg name="topic_blobs_out" value="blob_detector_red/blobs_undist"/>
   </include>
   
-  <include file="$(find undistort_pixels)/launch/node.launch">
+  <include file="$(find iri_undistort_pixels)/launch/node.launch">
     <arg name="node_name"       value="undistort_blob_green"/>
     <arg name="topic_blobs_in"  value="blob_detector_green/blobs"/>
     <arg name="topic_blobs_out" value="blob_detector_green/blobs_undist"/>
   </include>
   
-  <include file="$(find undistort_pixels)/launch/node.launch">
+  <include file="$(find iri_undistort_pixels)/launch/node.launch">
     <arg name="node_name"       value="undistort_blob_blue"/>
     <arg name="topic_blobs_in"  value="blob_detector_blue/blobs"/>
     <arg name="topic_blobs_out" value="blob_detector_blue/blobs_undist"/>
   </include>
   
-  <include file="$(find undistort_pixels)/launch/node.launch">
+  <include file="$(find iri_undistort_pixels)/launch/node.launch">
     <arg name="node_name"       value="undistort_blob_yellow"/>
     <arg name="topic_blobs_in"  value="blob_detector_yellow/blobs"/>
     <arg name="topic_blobs_out" value="blob_detector_yellow/blobs_undist"/>
+    <arg name="config_file" value="params_image.yaml"/>
   </include>
   
   <include file="$(find iri_visual_gps)/launch/node.launch">
-    <arg name="node_name"       value="iri_visual_gps"/>
+    <arg name="node_name"       value="visual_gps"/>
     <arg name="positions_file"  value="position_sim.yaml"/>
     <arg name="param_file"      value="params_sim.yaml"/>
     <arg name="param_path"      value="$(find iri_visual_gps)/config"/>
diff --git a/launch/sim_no_undist.launch b/launch/sim_no_undist.launch
index c040052b29cdffeea0ddce6da25116417c541821..a24ded5985372686e2a12fd542dc1d66873eb4f2 100644
--- a/launch/sim_no_undist.launch
+++ b/launch/sim_no_undist.launch
@@ -1,6 +1,12 @@
 <?xml version="1.0"?>
 <!-- -->
 <launch>
+  
+  <!--
+  <include file="$(find seat_car_gazebo)/launch/sim.launch">
+    <arg name="fake_localization" value="false"/>
+  </include>
+  -->
 
   <include file="$(find iri_blob_detector)/launch/node.launch">
     <arg name="node_name"   value="blob_detector_red"/>
@@ -35,7 +41,7 @@
   </include>
   
   <include file="$(find iri_visual_gps)/launch/node.launch">
-    <arg name="node_name"       value="iri_visual_gps"/>
+    <arg name="node_name"       value="visual_gps"/>
     <arg name="positions_file"  value="position_sim.yaml"/>
     <arg name="param_file"      value="params_sim.yaml"/>
     <arg name="param_path"      value="$(find iri_visual_gps)/config"/>