feat: add accel and pedal maps configuration

NOTICE

@@ -1,4 +1,4 @@
-autowarefoundation/sample_vehicle_launch
+autowarefoundation/awsim_labs_vehicle_launch
 Copyright 2021 The Autoware Foundation
 
 This product includes software developed at

README.md

@@ -1 +1 @@
-# sample_vehicle_launch
+# awsim_labs_vehicle_launch

sample_vehicle_description/CMakeLists.txt → awsim_labs_vehicle_description/CMakeLists.txt

@@ -1,5 +1,5 @@
 cmake_minimum_required(VERSION 3.5)
-project(sample_vehicle_description)
+project(awsim_labs_vehicle_description)
 
 if(NOT CMAKE_CXX_STANDARD)
   set(CMAKE_CXX_STANDARD 17)

sample_vehicle_description/package.xml → awsim_labs_vehicle_description/package.xml

@@ -1,9 +1,9 @@
 <?xml version="1.0"?>
 <?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
 <package format="3">
-  <name>sample_vehicle_description</name>
+  <name>awsim_labs_vehicle_description</name>
   <version>0.1.0</version>
-  <description>The sample_vehicle_description package</description>
+  <description>The awsim_labs_vehicle_description package</description>
   <maintainer email="[email protected]">Ryohsuke Mitsudome</maintainer>
   <maintainer email="[email protected]">Yukihiro Saito</maintainer>
   <license>Apache 2.0 License</license>

sample_vehicle_description/urdf/vehicle.xacro → awsim_labs_vehicle_description/urdf/vehicle.xacro

@@ -1,14 +1,14 @@
 <?xml version="1.0"?>
 <robot xmlns:xacro="http://ros.org/wiki/xacro">
   <!-- load parameter -->
-  <xacro:property name="vehicle_info" value="${xacro.load_yaml('$(find sample_vehicle_description)/config/vehicle_info.param.yaml')}"/>
+  <xacro:property name="vehicle_info" value="${xacro.load_yaml('$(find awsim_labs_vehicle_description)/config/vehicle_info.param.yaml')}"/>
 
   <!-- vehicle body -->
   <link name="base_link">
     <visual>
       <origin xyz="${vehicle_info['/**']['ros__parameters']['wheel_base']/2.0} 0 0" rpy="${pi/2.0} 0 ${pi}"/>
       <geometry>
-        <mesh filename="package://sample_vehicle_description/mesh/lexus.dae" scale="1 1 1"/>
+        <mesh filename="package://awsim_labs_vehicle_description/mesh/lexus.dae" scale="1 1 1"/>
       </geometry>
     </visual>
   </link>

sample_vehicle_launch/CMakeLists.txt → awsim_labs_vehicle_launch/CMakeLists.txt

@@ -1,5 +1,5 @@
 cmake_minimum_required(VERSION 3.5)
-project(sample_vehicle_launch)
+project(awsim_labs_vehicle_launch)
 
 if(NOT CMAKE_CXX_STANDARD)
   set(CMAKE_CXX_STANDARD 17)
@@ -15,5 +15,7 @@ find_package(ament_cmake_auto REQUIRED)
 ament_auto_find_build_dependencies()
 
 ament_auto_package(INSTALL_TO_SHARE
+  config
+  data
   launch
 )

awsim_labs_vehicle_launch/config/raw_vehicle_cmd_converter/raw_vehicle_cmd_converter.param.yaml

@@ -0,0 +1,33 @@
+/**:
+  ros__parameters:
+    csv_path_accel_map: $(find-pkg-share awsim_labs_vehicle_launch)/data/accel_map.csv
+    csv_path_brake_map: $(find-pkg-share awsim_labs_vehicle_launch)/data/brake_map.csv
+    csv_path_steer_map: $(find-pkg-share awsim_labs_vehicle_launch)/data/steer_map.csv
+    convert_accel_cmd: true
+    convert_brake_cmd: true
+    convert_steer_cmd: false
+    use_steer_ff: true
+    use_steer_fb: true
+    is_debugging: false
+    max_throttle: 0.4
+    max_brake: 0.8
+    max_steer: 10.0
+    min_steer: -10.0
+    steer_pid:
+      kp: 150.0
+      ki: 15.0
+      kd: 0.0
+      max: 8.0
+      min: -8.0
+      max_p: 8.0
+      min_p: -8.0
+      max_i: 8.0
+      min_i: -8.0
+      max_d: 0.0
+      min_d: 0.0
+      invalid_integration_decay: 0.97
+    convert_steer_cmd_method: "vgr"  # "vgr" or "steer_map"
+    vgr_coef_a: 15.713
+    vgr_coef_b: 0.053
+    vgr_coef_c: 0.042
+    convert_actuation_to_steering_status: false

awsim_labs_vehicle_launch/data/accel_map.csv

@@ -0,0 +1,7 @@
+default,0,1.39,2.78,4.17,5.56,6.94,8.33,9.72,11.11,12.5,13.89
+0,0.300,-0.050,-0.297,-0.390,-0.400,-0.410,-0.420,-0.440,-0.573,-0.574,-0.575
+0.100,0.600,0.420,0.240,0.064,-0.266,-0.267,-0.268,-0.269,-0.270,-0.290,-0.291
+0.200,0.642,0.421,0.241,0.065,0.052,0.051,-0.029,-0.030,-0.065,-0.066,-0.067
+0.300,1.420,0.636,0.635,0.587,0.586,0.585,0.584,0.583,0.582,0.186,0.185
+0.400,1.964,1.338,1.324,1.323,1.322,1.321,1.320,1.239,0.900,0.899,0.898
+0.500,2.620,1.339,1.335,1.324,1.323,1.922,2.007,1.938,1.874,1.406,1.454

awsim_labs_vehicle_launch/data/brake_map.csv

@@ -0,0 +1,10 @@
+default,0,1.39,2.78,4.17,5.56,6.94,8.33,9.72,11.11,12.5,13.89
+0,0.3,-0.05,-0.297,-0.39,-0.4,-0.531,-1.115,-1.116,-1.117,-1.118,-1.119
+0.1,0.117,-0.487,-0.825,-1.004,-1.114,-1.115,-1.116,-1.117,-1.118,-1.119,-1.12
+0.2,-0.821,-1.374,-1.606,-1.77,-2.225,-2.226,-2.227,-2.228,-2.231,-2.232,-2.233
+0.3,-1.473,-1.963,-2.23,-2.376,-2.695,-2.696,-2.697,-2.698,-2.699,-2.7,-2.701
+0.4,-1.959,-2.496,-2.665,-2.856,-3.034,-3.035,-3.036,-3.037,-3.038,-3.039,-3.04
+0.5,-2.181,-2.87,-3.015,-3.139,-3.3,-3.301,-3.302,-3.303,-3.304,-3.305,-3.306
+0.6,-2.182,-2.871,-3.016,-3.14,-3.301,-3.302,-3.303,-3.304,-3.305,-3.306,-3.307
+0.7,-2.183,-2.872,-3.017,-3.141,-3.302,-3.303,-3.304,-3.305,-3.306,-3.307,-3.308
+0.8,-2.201,-2.873,-3.018,-3.142,-3.303,-3.304,-3.305,-3.306,-3.307,-3.308,-3.309

awsim_labs_vehicle_launch/data/steer_map.csv

@@ -0,0 +1,14 @@
+default,-0.6,-0.5,-0.4,-0.3,-0.2,-0.1,0,0.1,0.2,0.3,0.4,0.5,0.6
+-12,-0.29,-0.3234236132,-0.3468991362,-0.37274847,-0.4288688461,-0.4696573,-0.4781014157,-0.49,-0.51,-0.52,-0.53,-0.54,-0.55
+-10,-0.2,-0.2451308686,-0.2667782734,-0.3090752469,-0.3575200568,-0.3874868999,-0.4041493831,-0.42,-0.43,-0.44,-0.45,-0.46,-0.47
+-8,-0.1,-0.1586739777,-0.2020698818,-0.2317654357,-0.2778998646,-0.3029839842,-0.3188172953,-0.32,-0.33,-0.34,-0.35,-0.36,-0.37
+-6,-0.0404761584,-0.0806574159,-0.1208386734,-0.1559621241,-0.1888907059,-0.210790018,-0.2322336736,-0.24,-0.25,-0.26,-0.27,-0.28,-0.29
+-4,0.01,-0.01428569928,-0.04,-0.06805018099,-0.09718925222,-0.1189509092,-0.1361293637,-0.14,-0.153044463,-0.1688321844,-0.18,-0.2,-0.22
+-2,0.06,0.05,0.03,0.01,-0.006091655083,-0.03546033903,-0.05319488695,-0.06097627388,-0.07576251508,-0.09165178816,-0.1,-0.12,-0.14
+0,0.11,0.09,0.07,0.05,0.03,0.01,-0.0004106386541,-0.01,-0.03,-0.05,-0.07,-0.09,-0.11
+2,0.15,0.13,0.11,0.09,0.07812978496,0.06023545297,0.04386326928,0.02314813566,0.003779338416,-0.01390526686,-0.0324840879,-0.05106290894,-0.06964172998
+4,0.24,0.22,0.2,0.1839795042,0.1649754952,0.1455879759,0.1274837062,0.1020632549,0.0861964856,0.06971503353,0.04541294018,0.01308869356,-0.01923555307
+6,0.33,0.31,0.29,0.274963497,0.2447295892,0.2337353319,0.2126138313,0.1767700907,0.1578757866,0.1440584148,0.1136331403,0.0827443595,0.05185557872
+8,0.43,0.41,0.39,0.3714915121,0.3299578073,0.3156403746,0.2997845963,0.2500495071,0.2339668568,0.2153133621,0.1815127859,0.156071251,0.1306297162
+10,0.5,0.49,0.48,0.4629455165,0.4210353203,0.3977027236,0.3865034288,0.3250957262,0.312237913,0.2885123051,0.2474220915,0.2123900615,0.1773580315
+12,0.56,0.54,0.53,0.5151036525,0.5046070554,0.4897214196,0.4687756354,0.4036994672,0.3812674227,0.3496883008,0.32482655,0.2783538423,0.2318811345

awsim_labs_vehicle_launch/launch/vehicle_interface.launch.xml

@@ -0,0 +1,22 @@
+<?xml version="1.0" encoding="UTF-8"?>
+<launch>
+  <arg name="vehicle_id" default="$(env VEHICLE_ID default)"/>
+  <arg name="input_control_cmd" default="/control/command/control_cmd"/>
+  <arg name="input_odometry" default="/localization/kinematic_state"/>
+  <arg name="input_steering" default="/vehicle/status/steering_status"/>
+  <arg name="input_actuation_status" default="/vehicle/status/actuation_status"/>
+  <arg name="output_actuation_cmd" default="/control/command/actuation_cmd"/>
+  <arg name="output_steering_status" default="/vehicle/status/steering_status"/>
+  <!-- Parameter -->
+  <arg name="config_file" default="$(find-pkg-share awsim_labs_vehicle_launch)/config/raw_vehicle_cmd_converter/raw_vehicle_cmd_converter.param.yaml"/>
+
+  <node pkg="autoware_raw_vehicle_cmd_converter" exec="autoware_raw_vehicle_cmd_converter_node" name="raw_vehicle_cmd_converter" output="screen">
+    <param from="$(var config_file)" allow_substs="true"/>
+    <remap from="~/input/control_cmd" to="$(var input_control_cmd)"/>
+    <remap from="~/input/odometry" to="$(var input_odometry)"/>
+    <remap from="~/input/steering" to="$(var input_steering)"/>
+    <remap from="~/input/actuation_status" to="$(var input_actuation_status)"/>
+    <remap from="~/output/actuation_cmd" to="$(var output_actuation_cmd)"/>
+    <remap from="~/output/steering_status" to="$(var output_steering_status)"/>
+  </node>
+</launch>

sample_vehicle_launch/package.xml → awsim_labs_vehicle_launch/package.xml

@@ -1,9 +1,9 @@
 <?xml version="1.0"?>
 <?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
 <package format="3">
-  <name>sample_vehicle_launch</name>
+  <name>awsim_labs_vehicle_launch</name>
   <version>0.1.0</version>
-  <description>The sample_vehicle_launch package</description>
+  <description>The awsim_labs_vehicle_launch package</description>
   <maintainer email="[email protected]">Ryohsuke Mitsudome</maintainer>
   <maintainer email="[email protected]">Yukihiro Saito</maintainer>
   <license>Apache 2.0 License</license>