diff --git a/aip_x2_description/config/front_unit_calibration.yaml b/aip_x2_description/config/front_unit_calibration.yaml
deleted file mode 100644
index 0c21e2d5..00000000
--- a/aip_x2_description/config/front_unit_calibration.yaml
+++ /dev/null
@@ -1,43 +0,0 @@
-front_unit_base_link:
- pandar_40p_front_base_link:
- x: 0.0
- y: 0.0
- z: 0.0
- roll: 0.0
- pitch: 0.0
- yaw: 1.570796
- pandar_qt_front_base_link:
- x: 0.019
- y: 0.0
- z: 0.136
- roll: 0.0
- pitch: 0.0
- yaw: 2.09439
- camera6/camera_link:
- x: 0.0534
- y: 0.0
- z: 0.2657
- roll: 0.0
- pitch: 0.0
- yaw: 0.0
- front_center/radar_link:
- x: -0.01295
- y: 0.0
- z: -0.07554
- roll: 0.0
- pitch: 0.0
- yaw: 0.0
- front_left/radar_link:
- x: -0.132
- y: 1.0 # todo
- z: 0.0174
- roll: 0.0
- pitch: 0.0
- yaw: 1.2217 # 70[deg]
- front_right/radar_link:
- x: -0.132
- y: -1.0 # todo
- z: 0.0174
- roll: 0.0
- pitch: 0.0
- yaw: -1.2217 # 70[deg]
diff --git a/aip_x2_description/config/rear_unit_calibration.yaml b/aip_x2_description/config/rear_unit_calibration.yaml
deleted file mode 100644
index ed4c5c4b..00000000
--- a/aip_x2_description/config/rear_unit_calibration.yaml
+++ /dev/null
@@ -1,43 +0,0 @@
-rear_unit_base_link:
- pandar_40p_rear_base_link:
- x: 0.0
- y: 0.0
- z: 0.0
- roll: 0.0
- pitch: 0.0
- yaw: 1.570796
- pandar_qt_rear_base_link:
- x: 0.0189
- y: 0.0
- z: 0.135
- roll: 0.0
- pitch: 0.0
- yaw: 1.91986
- camera3/camera_link:
- x: 0.002
- y: 0.125
- z: 0.17965
- roll: 0.0
- pitch: 0.0
- yaw: 0.0
- rear_center/radar_link:
- x: 0.0
- y: 0.0
- z: -0.09819
- roll: 0.0
- pitch: 0.0
- yaw: 0.0
- rear_left/radar_link:
- x: -0.01295
- y: -1.11225 # todo
- z: 0.092
- roll: 0.0
- pitch: 0.0
- yaw: -1.2217 # 70[deg]
- rear_right/radar_link:
- x: -0.01295
- y: 1.11225 # todo
- z: 0.092
- roll: 0.0
- pitch: 0.0
- yaw: 1.2217 # 70[deg]
diff --git a/aip_x2_description/config/sensor_kit_calibration.yaml b/aip_x2_description/config/sensor_kit_calibration.yaml
new file mode 100644
index 00000000..4a37420d
--- /dev/null
+++ b/aip_x2_description/config/sensor_kit_calibration.yaml
@@ -0,0 +1,173 @@
+sensor_kit_base_link:
+ # left upper
+ left_upper/lidar_base_link:
+ x: 0.0
+ y: 0.0
+ z: 0.0
+ roll: 0.0
+ pitch: 0.0
+ yaw: 3.141592 # 180 [deg] to turn the connector toward the vehicle
+ left_lower/lidar_base_link:
+ x: 0.0
+ y: -0.025
+ z: -0.115
+ roll: 0.6981 # 40[deg]
+ pitch: 0.0
+ yaw: 3.141592 # 180 [deg] to turn the connector toward the vehicle
+ left_front/camera_link:
+ x: 0.12758
+ y: -0.04589
+ z: -0.0866
+ roll: 0.0
+ pitch: 0.08722 # 5 [deg]
+ yaw: 0.85478 # 49 [deg]
+ left_rear/camera_link:
+ x: -0.12842
+ y: -0.04589
+ z: -0.0866
+ roll: 0.0
+ pitch: 0.08722 # 5 [deg]
+ yaw: 2.2678 # 130 [deg]
+ left_center/camera_link:
+ x: 0.0
+ y: -0.04089
+ z: -0.18666
+ roll: 0.0
+ pitch: 0.933278 # 53.50 [deg]
+ yaw: 1.570796 # 90 [deg]
+
+ # right upper
+ right_upper/lidar_base_link:
+ x: 0.0
+ y: -2.15178
+ z: 0.0
+ roll: 0.0
+ pitch: 0.0
+ yaw: 0.0 # to turn the connector toward the vehicle
+ right_lower/lidar_base_link:
+ x: 0.0
+ y: -2.12678
+ z: -0.115
+ roll: 0.6981 # 40 [deg]
+ pitch: 0.0
+ yaw: 0.0 # to turn the connector toward the vehicle
+ right_front/camera_link:
+ x: 0.12758
+ y: -2.10589
+ z: -0.0866
+ roll: 0.0
+ pitch: 0.08722 # 5 [deg]
+ yaw: -0.85478 # -49 [deg]
+ right_rear/camera_link:
+ x: -0.12842
+ y: -2.10589
+ z: -0.0866
+ roll: 0.0
+ pitch: 0.08722 # 5 [deg]
+ yaw: -2.2678 # -130 [deg]
+ right_center/camera_link:
+ x: 0.0
+ y: -2.11089
+ z: -0.18666
+ roll: 0.0
+ pitch: 0.933278 # 53.50 [deg]
+ yaw: -1.570796 # -90 [deg]
+
+ # front upper
+ top_front_left/imu_link:
+ x: 0.562
+ y: -0.99974
+ z: -0.06146
+ roll: 3.141592
+ pitch: 0.0
+ yaw: 0.0
+ top_front_right/imu_link:
+ x: 0.562
+ y: -1.13974
+ z: -0.06146
+ roll: 3.141592
+ pitch: 0.0
+ yaw: 0.0
+ top_front_right/camera_link:
+ x: 0.73758
+ y: -1.26439
+ z: -0.06666
+ roll: 0.0
+ pitch: 0.8373 # 48 [deg]
+ yaw: 0.0
+ top_front_center_right/camera_link:
+ x: 0.73058
+ y: -1.18899
+ z: -0.02166
+ roll: 0.0
+ pitch: 0.0
+ yaw: 0.0
+ top_front_center_left/camera_link:
+ x: 0.73058
+ y: -1.03819
+ z: -0.02166
+ roll: 0.0
+ pitch: 0.0
+ yaw: 0.0
+ top_front_left/camera_link:
+ x: 0.73058
+ y: -0.96279
+ z: -0.02166
+ roll: 0.0
+ pitch: 0.0
+ yaw: 0.0
+ top_front/gnss_link:
+ x: 0.30133
+ y: -1.07589
+ z: 0.02861
+ roll: 0.0
+ pitch: 0.0
+ yaw: 0.0
+
+ # rear upper
+ top_rear_center/camera_link:
+ x: -6.06359
+ y: -1.20389
+ z: -0.14078
+ roll: 0.0
+ pitch: 0.0
+ yaw: 3.141592 # 180 [deg] to turn the connector toward the vehicle
+ top_rear/gnss_link:
+ x: -5.77517
+ y: -1.07589
+ z: 0.02861
+ roll: 0.0
+ pitch: 0.0
+ yaw: 0.0
+
+ # front lower
+ front_upper/lidar_base_link:
+ x: 0.94058
+ y: -1.07589
+ z: -1.91826
+ roll: 0.0
+ pitch: 0.0
+ yaw: 1.570796 # 90 [deg] to turn the connector toward the vehicle
+ front_lower/lidar_base_link:
+ x: 0.96758
+ y: -1.07589
+ z: -2.15234
+ roll: 0.6981 # 40[deg]
+ pitch: 0.0
+ yaw: 1.570796 # 90 [deg] to turn the connector toward the vehicle
+
+ # rear lower
+ rear_upper/lidar_base_link:
+ x: -6.08042
+ y: -1.07589
+ z: -1.91826
+ roll: 0.0
+ pitch: 0.0
+ yaw: -1.570796 # 90 [deg] to turn the connector toward the vehicle
+ rear_lower/lidar_base_link:
+ x: -6.10742
+ y: -1.07589
+ z: -2.15234
+ roll: 0.6981 # 40[deg]
+ pitch: 0.0
+ yaw: -1.570796 # 90 [deg] to turn the connector toward the vehicle
diff --git a/aip_x2_description/config/sensors_calibration.yaml b/aip_x2_description/config/sensors_calibration.yaml
index bb0f7591..1b5105f0 100644
--- a/aip_x2_description/config/sensors_calibration.yaml
+++ b/aip_x2_description/config/sensors_calibration.yaml
@@ -1,29 +1,57 @@
base_link:
- top_unit_base_link:
- x: 4.6621
- y: 1.079
- z: 2.8087
+ sensor_kit_base_link:
+ x: 4.66244
+ y: 1.07589
+ z: 2.78926
roll: 0.0
pitch: 0.0
yaw: 0.0
- front_unit_base_link:
- x: 5.6221
+
+ # radar
+ front_center/radar_link:
+ x: 5.69207
y: 0.0
- z: 0.7547
+ z: 0.78894
roll: 0.0
pitch: 0.0
yaw: 0.0
- rear_unit_base_link:
- x: -1.4271
- y: 0.0
- z: 0.4795
- roll: 0
- pitch: 0
- yaw: -3.141500
- gnss_link:
- x: -0.3
+
+ front_left/radar_link:
+ x: 5.37204
+ y: 1.08537
+ z: 0.73431
+ roll: 0.0
+ pitch: 0.0
+ yaw: 1.2211 # 70 [deg]
+
+ front_right/radar_link:
+ x: 5.37204
+ y: -1.06642
+ z: 0.73431
+ roll: 0.0
+ pitch: 0.0
+ yaw: -1.2211 # 70 [deg]
+
+ rear_center/radar_link:
+ x: -1.50704
y: 0.0
- z: 2.689
+ z: 0.78894
roll: 0.0
pitch: 0.0
- yaw: 0.0
+ yaw: 3.141592 # 180 [deg]
+
+ rear_left/radar_link:
+ x: -1.27564
+ y: 1.07767
+ z: 0.5487
+ roll: 0.0
+ pitch: 0.0
+ yaw: 1.9189 # 110 [deg]
+
+ rear_right/radar_link:
+ x: -1.27564
+ y: -1.07768
+ z: 0.5487
+ roll: 0.0
+ pitch: 0.0
+ yaw: -1.9189 # 110 [deg]
diff --git a/aip_x2_description/config/top_unit_calibration.yaml b/aip_x2_description/config/top_unit_calibration.yaml
deleted file mode 100644
index 562db0c1..00000000
--- a/aip_x2_description/config/top_unit_calibration.yaml
+++ /dev/null
@@ -1,78 +0,0 @@
-top_unit_base_link:
- camera0/camera_link:
- x: 0.76673
- y: -1.186
- z: 0.05965
- roll: 0.0
- pitch: 0.0
- yaw: 0.0
- camera1/camera_link:
- x: 0.16818
- y: -2.10372
- z: -0.0651
- roll: 0.0
- pitch: 0.22689 # 13[deg]
- yaw: -1.134464 # 65[deg]
- camera2/camera_link:
- x: -0.19012
- y: -2.09141
- z: -0.0651
- roll: 0.0
- pitch: 0.22689 # 13[deg]
- yaw: -2.39110 # 137[deg]
- camera4/camera_link:
- x: -0.19012
- y: -0.06258
- z: -0.0651
- roll: 0.0
- pitch: 0.22689 # 13[deg]
- yaw: 2.39110 # 137[deg]
- camera5/camera_link:
- x: 0.16818
- y: -0.05027
- z: -0.0651
- roll: 0.000000
- pitch: 0.22689 # 13[deg]
- yaw: 1.134464 # 65[deg]
- camera7/camera_link:
- x: 0.76673
- y: -0.964
- z: 0.05965
- roll: 0.0
- pitch: 0.0
- yaw: 0.0
- pandar_40p_left_base_link:
- x: 0.0
- y: 0.0
- z: 0.0
- roll: 0.0
- pitch: 0.0
- yaw: 3.141592
- pandar_qt_left_base_link:
- x: 0.0
- y: -0.04
- z: -0.17
- roll: 0.6981 # 40[deg]
- pitch: 0.0
- yaw: -3.141592
- pandar_40p_right_base_link:
- x: 0.000000
- y: -2.154
- z: 0.0
- roll: 0.0
- pitch: 0.0
- yaw: 0.0
- pandar_qt_right_base_link:
- x: 0.0
- y: -2.114
- z: -0.17
- roll: 0.6981 # 40[deg]
- pitch: 0.0
- yaw: 0.0
- tamagawa/imu_link:
- x: 0.5675
- y: 0.0
- z: -0.0651
- roll: 3.141592
- pitch: 0.0
- yaw: 0.0
diff --git a/aip_x2_description/urdf/front_unit.xacro b/aip_x2_description/urdf/front_unit.xacro
deleted file mode 100644
index ac5a7fee..00000000
--- a/aip_x2_description/urdf/front_unit.xacro
+++ /dev/null
@@ -1,101 +0,0 @@
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
diff --git a/aip_x2_description/urdf/gnss.xacro b/aip_x2_description/urdf/gnss.xacro
new file mode 100644
index 00000000..55002be0
--- /dev/null
+++ b/aip_x2_description/urdf/gnss.xacro
@@ -0,0 +1,24 @@
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
diff --git a/aip_x2_description/urdf/rear_unit.xacro b/aip_x2_description/urdf/rear_unit.xacro
deleted file mode 100644
index c2c052d3..00000000
--- a/aip_x2_description/urdf/rear_unit.xacro
+++ /dev/null
@@ -1,101 +0,0 @@
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
diff --git a/aip_x2_description/urdf/sensor_kit.xacro b/aip_x2_description/urdf/sensor_kit.xacro
new file mode 100644
index 00000000..fa1bf069
--- /dev/null
+++ b/aip_x2_description/urdf/sensor_kit.xacro
@@ -0,0 +1,345 @@
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
diff --git a/aip_x2_description/urdf/sensors.xacro b/aip_x2_description/urdf/sensors.xacro
index 5d362e51..3513f98e 100644
--- a/aip_x2_description/urdf/sensors.xacro
+++ b/aip_x2_description/urdf/sensors.xacro
@@ -1,71 +1,87 @@
-
-
-
+
+
+
-
-
-
+
+
-
-
-
+
-
-
-
-
-
-
-
+
+
+
+
diff --git a/aip_x2_description/urdf/top_unit.xacro b/aip_x2_description/urdf/top_unit.xacro
deleted file mode 100644
index 43277584..00000000
--- a/aip_x2_description/urdf/top_unit.xacro
+++ /dev/null
@@ -1,194 +0,0 @@
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-
-