feat(aip_xx1_gen2_launch): add aip xx1 gen2 launch again #326

aip_xx1_gen2_launch/config/lidar_gen2.yaml

@@ -6,7 +6,7 @@ launches:
       sensor_frame: hesai_top
       sensor_ip: 192.168.1.201
       data_port: 2368
-      scan_phase: 160
+      scan_phase: 160.0
       vertical_bins: 128
   - sensor_type: hesai_XT32
     namespace: front_left

aip_xx1_gen2_launch/config/mosaic_x5_rover.param.yaml

@@ -0,0 +1,97 @@
+/**:
+  # cspell: ignore ntrip
+  # cspell: ignore gpsfix
+  # cspell: ignore gpgga
+  # cspell: ignore gprmc
+  # cspell: ignore gpst
+  # cspell: ignore measepoch
+  # cspell: ignore pvtcartesian
+  # cspell: ignore basevectorcart
+  # cspell: ignore basevectorgeod
+  # cspell: ignore poscovcartesian
+  # cspell: ignore velcovgeodetic
+  # cspell: ignore atteuler
+  # cspell: ignore attcoveuler
+  # cspell: ignore gpgsa
+  # cspell: ignore gpgsv
+  ros__parameters:
+    device: tcp://192.168.20.102:28784
+
+    frame_id: gnss_link
+    aux1_frame_id: aux1
+    get_spatial_config_from_tf: false
+    use_ros_axis_orientation: false
+    receiver_type: gnss
+    multi_antenna: false
+
+    datum: Default
+
+    att_offset:
+      heading: 0.0
+      pitch: 0.0
+
+    ant_type: Unknown
+    ant_serial_nr: Unknown
+    ant_aux1_type: Unknown
+    ant_aux1_serial_nr: Unknown
+
+    polling_period:
+      pvt: 200
+      rest: 200
+
+    use_gnss_time: false
+
+    rtk_settings:
+      ntrip_1:
+        id: ""
+        caster: ""
+        caster_port: 2101
+        username: ""
+        password: ""
+        mountpoint: ""
+        version: "v2"
+        tls: false
+        fingerprint: ""
+        rtk_standard: "auto"
+        send_gga: "auto"
+        keep_open: true
+      ip_server_1:
+        id: "IPS1"
+        port: 28785
+        rtk_standard: "RTCMv3"
+        send_gga: "auto"
+        keep_open: true
+      serial_1:
+        port: ""
+        baud_rate: 115200
+        rtk_standard: "auto"
+        send_gga: "auto"
+        keep_open: true
+
+    publish:
+      # For both GNSS and INS Rxs
+      navsatfix: true
+      gpsfix: false
+      gpgga: false
+      gprmc: false
+      gpst: false
+      measepoch: false
+      pvtcartesian: false
+      pvtgeodetic: true
+      basevectorcart: false
+      basevectorgeod: false
+      poscovcartesian: false
+      poscovgeodetic: true
+      velcovgeodetic: false
+      atteuler: false
+      attcoveuler: false
+      pose: false
+      twist: false
+      diagnostics: true
+      # For GNSS Rx only
+      gpgsa: false
+      gpgsv: false
+
+    # logger
+
+    activate_debug_log: false

aip_xx1_gen2_launch/launch/gnss.launch.xml

@@ -22,7 +22,12 @@
 
     <!-- Septentrio GNSS Driver -->
     <group if="$(eval &quot;'$(var launch_driver)' and '$(var gnss_receiver)'=='septentrio'&quot;)">
-      <include file="$(find-pkg-share septentrio_gnss_driver)/launch/mosaic_x5_rover.launch.xml" />
+      <node pkg="septentrio_gnss_driver" name="septentrio" exec="septentrio_gnss_driver_node" if="$(var launch_driver)">
+        <param from="$(find-pkg-share aip_xx1_gen2_launch)/config/mosaic_x5_rover.param.yaml"/>
+        <remap from="navsatfix" to="~/nav_sat_fix"/>
+        <remap from="poscovgeodetic" to="~/poscovgeodetic"/>
+        <remap from="pvtgeodetic" to="~/pvtgeodetic"/>
+      </node>
     </group>
 
     <!-- NavSatFix to MGRS Pose -->

aip_xx1_gen2_launch/launch/imu.launch.xml

@@ -36,7 +36,7 @@
 
     <!-- IMU Correction launch-->
     <arg name="imu_raw_name" default="tamagawa/imu_raw"/>
-    <arg name="imu_corrector_param_file" default="$(find-pkg-share individual_params)/config/$(var vehicle_id)/aip_xx1/imu_corrector.param.yaml"/>
+    <arg name="imu_corrector_param_file" default="$(find-pkg-share individual_params)/config/$(var vehicle_id)/aip_xx1_gen2/imu_corrector.param.yaml"/>
     <include file="$(find-pkg-share autoware_imu_corrector)/launch/imu_corrector.launch.xml">
       <arg name="input_topic" value="$(var imu_raw_name)"/>
       <arg name="output_topic" value="imu_data"/>

aip_xx1_gen2_launch/launch/lidar.launch.py

@@ -92,11 +92,12 @@ def load_yaml(yaml_file_path):
     path_dictionary = generate_launch_dictionary()
 
     base_parameters = {}
-    base_parameters["host_ip"] = LaunchConfiguration("host_ip")
+    base_parameters["host_ip"] = LaunchConfiguration("host_ip").perform(context)
     base_parameters["vehicle_mirror_param_file"] = LaunchConfiguration(
         "vehicle_mirror_param_file"
     ).perform(context)
     base_parameters["launch_driver"] = LaunchConfiguration("launch_driver").perform(context)
+    base_parameters["launch_hw_monitor"] = LaunchConfiguration("launch_hw_monitor").perform(context)
     base_parameters["vehicle_id"] = LaunchConfiguration("vehicle_id").perform(context)
     base_parameters["pointcloud_container_name"] = LaunchConfiguration(
         "pointcloud_container_name"
@@ -159,7 +160,7 @@ def generate_launch_description():
     config_file_arg = DeclareLaunchArgument(
         "config_file",
         default_value=os.path.join(
-            get_package_share_directory("aip_xx1_gen2_launch"), "config", "lidar_launch.yaml"
+            get_package_share_directory("aip_xx1_gen2_launch"), "config", "lidar_gen2.yaml"
         ),
         description="Path to the configuration file",
     )
@@ -169,6 +170,7 @@ def add_launch_arg(name: str, default_value=None, **kwargs):
         launch_arguments.append(DeclareLaunchArgument(name, default_value=default_value, **kwargs))
 
     add_launch_arg("launch_driver", "true")
+    add_launch_arg("launch_hw_monitor", "true", description="launch hardware monitor")
     add_launch_arg("host_ip", "192.168.1.10")
     add_launch_arg("use_concat_filter", "true")
     add_launch_arg(

aip_xx1_gen2_launch/launch/sensing.launch.xml

@@ -23,23 +23,26 @@
     <!-- IMU Driver -->
     <include file="$(find-pkg-share aip_xx1_gen2_launch)/launch/imu.launch.xml">
       <arg name="launch_driver" value="$(var launch_driver)" />
+      <arg name="imu_connection" value="can" />
     </include>
 
     <!-- GNSS Driver -->
     <include file="$(find-pkg-share aip_xx1_gen2_launch)/launch/gnss.launch.xml">
       <arg name="launch_driver" value="$(var launch_driver)" />
+      <arg name="gnss_receiver" value="septentrio"/>
     </include>
 
     <!-- Radar Driver -->
     <include file="$(find-pkg-share aip_xx1_gen2_launch)/launch/radar.launch.xml">
       <arg name="launch_driver" value="$(var launch_driver)" />
+      <arg name="ars_version" value="ars548" />
     </include>
 
     <!-- Vehicle twist -->
     <include file="$(find-pkg-share vehicle_velocity_converter)/launch/vehicle_velocity_converter.launch.xml">
       <arg name="input_vehicle_velocity_topic" value="/vehicle/status/velocity_status"/>
       <arg name="output_twist_with_covariance" value="/sensing/vehicle_velocity_converter/twist_with_covariance"/>
-      <arg name="config_file" value="$(find-pkg-share individual_params)/config/$(var vehicle_id)/aip_xx1/vehicle_velocity_converter.param.yaml" />
+      <arg name="config_file" value="$(find-pkg-share individual_params)/config/$(var vehicle_id)/aip_xx1_gen2/vehicle_velocity_converter.param.yaml" />
     </include>
 
   </group>