chore(smart_mpc_trajectory_follower): add prefix autoware_ to smart_m…

…pc_trajectory_follower (#7367) * add prefix Signed-off-by: Go Sakayori <[email protected]> * fix pre-commit Signed-off-by: Go Sakayori <[email protected]> --------- Signed-off-by: Go Sakayori <[email protected]>
autowarefoundation · Jul 22, 2024 · 284e8fe · 284e8fe
1 parent 39fafb3
commit 284e8fe
Show file tree

Hide file tree

Showing 45 changed files with 75 additions and 71 deletions.
diff --git a/.github/CODEOWNERS b/.github/CODEOWNERS
@@ -57,7 +57,7 @@ control/pid_longitudinal_controller/** [email protected] takamasa.horibe@tie
 control/predicted_path_checker/** [email protected]
 control/pure_pursuit/** [email protected]
 control/shift_decider/** [email protected]
-control/smart_mpc_trajectory_follower/** [email protected]
+control/autoware_smart_mpc_trajectory_follower/** [email protected]
 control/trajectory_follower_base/** [email protected] [email protected]
 control/trajectory_follower_node/** [email protected] [email protected]
 control/vehicle_cmd_gate/** [email protected] [email protected]

diff --git a/.../smart_mpc_trajectory_follower/.gitignore → ..._smart_mpc_trajectory_follower/.gitignore b/.../smart_mpc_trajectory_follower/.gitignore → ..._smart_mpc_trajectory_follower/.gitignore
diff --git a/...rt_mpc_trajectory_follower/CMakeLists.txt → ...rt_mpc_trajectory_follower/CMakeLists.txt b/...rt_mpc_trajectory_follower/CMakeLists.txt → ...rt_mpc_trajectory_follower/CMakeLists.txt
@@ -1,11 +1,11 @@
 cmake_minimum_required(VERSION 3.14)
-project(smart_mpc_trajectory_follower)
+project(autoware_smart_mpc_trajectory_follower)
 
 find_package(autoware_cmake REQUIRED)
 autoware_package()
 
 install(PROGRAMS
-  smart_mpc_trajectory_follower/scripts/pympc_trajectory_follower.py
+  autoware_smart_mpc_trajectory_follower/scripts/pympc_trajectory_follower.py
   DESTINATION lib/${PROJECT_NAME}
 )
 ament_auto_package(

diff --git a/...l/smart_mpc_trajectory_follower/README.md → ...e_smart_mpc_trajectory_follower/README.md b/...l/smart_mpc_trajectory_follower/README.md → ...e_smart_mpc_trajectory_follower/README.md
diff --git a/.../smart_mpc_trajectory_follower/.gitignore → ..._smart_mpc_trajectory_follower/.gitignore b/.../smart_mpc_trajectory_follower/.gitignore → ..._smart_mpc_trajectory_follower/.gitignore
diff --git a/...smart_mpc_trajectory_follower/__init__.py → ...smart_mpc_trajectory_follower/__init__.py b/...smart_mpc_trajectory_follower/__init__.py → ...smart_mpc_trajectory_follower/__init__.py
diff --git a/..._mpc_trajectory_follower/clear_pycache.py → ..._mpc_trajectory_follower/clear_pycache.py b/..._mpc_trajectory_follower/clear_pycache.py → ..._mpc_trajectory_follower/clear_pycache.py
@@ -16,10 +16,10 @@
 from pathlib import Path
 import shutil
 
-import smart_mpc_trajectory_follower
+import autoware_smart_mpc_trajectory_follower
 
 if __name__ == "__main__":
-    package_dir = str(Path(smart_mpc_trajectory_follower.__file__).parent)
+    package_dir = str(Path(autoware_smart_mpc_trajectory_follower.__file__).parent)
 
     remove_dirs = [
         package_dir + "/__pycache__",

diff --git a/..._trajectory_follower/param/mpc_param.yaml → ..._trajectory_follower/param/mpc_param.yaml b/..._trajectory_follower/param/mpc_param.yaml → ..._trajectory_follower/param/mpc_param.yaml
diff --git a/...jectory_follower/param/nominal_param.yaml → ...jectory_follower/param/nominal_param.yaml b/...jectory_follower/param/nominal_param.yaml → ...jectory_follower/param/nominal_param.yaml
diff --git a/...y_follower/param/trained_model_param.yaml → ...y_follower/param/trained_model_param.yaml b/...y_follower/param/trained_model_param.yaml → ...y_follower/param/trained_model_param.yaml
diff --git a/...tory_follower/python_simulator/.gitignore → ...tory_follower/python_simulator/.gitignore b/...tory_follower/python_simulator/.gitignore → ...tory_follower/python_simulator/.gitignore
diff --git a/...y_follower/python_simulator/accel_map.csv → ...y_follower/python_simulator/accel_map.csv b/...y_follower/python_simulator/accel_map.csv → ...y_follower/python_simulator/accel_map.csv
diff --git a/...hon_simulator/plot_auto_test_result.ipynb → ...hon_simulator/plot_auto_test_result.ipynb b/...hon_simulator/plot_auto_test_result.ipynb → ...hon_simulator/plot_auto_test_result.ipynb
diff --git a/...ower/python_simulator/python_simulator.py → ...ower/python_simulator/python_simulator.py b/...ower/python_simulator/python_simulator.py → ...ower/python_simulator/python_simulator.py
@@ -18,14 +18,14 @@
 import datetime
 import os
 
+from autoware_smart_mpc_trajectory_follower.scripts import drive_controller
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
 import matplotlib.pyplot as plt
 from numba import njit
 import numpy as np
 import pandas as pd
 import scipy.interpolate
 import simplejson as json
-from smart_mpc_trajectory_follower.scripts import drive_controller
-from smart_mpc_trajectory_follower.scripts import drive_functions
 
 print("\n\n### import python_simulator.py ###")
 

diff --git a/.../python_simulator/run_python_simulator.py → .../python_simulator/run_python_simulator.py b/.../python_simulator/run_python_simulator.py → .../python_simulator/run_python_simulator.py
@@ -12,9 +12,9 @@
 # See the License for the specific language governing permissions and
 # limitations under the License.
 
+from autoware_smart_mpc_trajectory_follower.training_and_data_check import train_drive_NN_model
 import numpy as np
 import python_simulator
-from smart_mpc_trajectory_follower.training_and_data_check import train_drive_NN_model
 
 initial_error = np.array(
     [0.001, 0.03, 0.01, -0.001, 0, 2 * python_simulator.measurement_steer_bias]

diff --git a/...tory_follower/python_simulator/run_sim.py → ...tory_follower/python_simulator/run_sim.py b/...tory_follower/python_simulator/run_sim.py → ...tory_follower/python_simulator/run_sim.py
@@ -23,9 +23,9 @@
 import traceback
 from typing import Dict
 
+from autoware_smart_mpc_trajectory_follower.training_and_data_check import train_drive_NN_model
 import numpy as np
 import python_simulator
-from smart_mpc_trajectory_follower.training_and_data_check import train_drive_NN_model
 
 parser = argparse.ArgumentParser()
 parser.add_argument("--param_name", default=None)

diff --git a/...r/python_simulator/slalom_course_data.csv → ...r/python_simulator/slalom_course_data.csv b/...r/python_simulator/slalom_course_data.csv → ...r/python_simulator/slalom_course_data.csv
diff --git a/...pc_trajectory_follower/scripts/.gitignore → ...pc_trajectory_follower/scripts/.gitignore b/...pc_trajectory_follower/scripts/.gitignore → ...pc_trajectory_follower/scripts/.gitignore
diff --git a/...c_trajectory_follower/scripts/__init__.py → ...c_trajectory_follower/scripts/__init__.py b/...c_trajectory_follower/scripts/__init__.py → ...c_trajectory_follower/scripts/__init__.py
diff --git a/...c_trajectory_follower/scripts/drive_GP.py → ...c_trajectory_follower/scripts/drive_GP.py b/...c_trajectory_follower/scripts/drive_GP.py → ...c_trajectory_follower/scripts/drive_GP.py
@@ -16,9 +16,9 @@
 
 from functools import partial
 
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
 from numba import njit
 import numpy as np
-from smart_mpc_trajectory_follower.scripts import drive_functions
 
 sqrt_mpc_time_step = np.sqrt(drive_functions.mpc_time_step)
 

diff --git a/...c_trajectory_follower/scripts/drive_NN.py → ...c_trajectory_follower/scripts/drive_NN.py b/...c_trajectory_follower/scripts/drive_NN.py → ...c_trajectory_follower/scripts/drive_NN.py
@@ -13,9 +13,9 @@
 # limitations under the License.
 
 
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
+from autoware_smart_mpc_trajectory_follower.scripts import proxima_calc
 import numpy as np
-from smart_mpc_trajectory_follower.scripts import drive_functions
-from smart_mpc_trajectory_follower.scripts import proxima_calc
 import torch
 from torch import nn
 

diff --git a/...tory_follower/scripts/drive_controller.py → ...tory_follower/scripts/drive_controller.py b/...tory_follower/scripts/drive_controller.py → ...tory_follower/scripts/drive_controller.py
@@ -21,14 +21,14 @@
 import threading
 import time
 
+from autoware_smart_mpc_trajectory_follower.scripts import drive_GP
+from autoware_smart_mpc_trajectory_follower.scripts import drive_NN
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
+from autoware_smart_mpc_trajectory_follower.scripts import drive_iLQR
+from autoware_smart_mpc_trajectory_follower.scripts import drive_mppi
 import numpy as np
 import scipy.interpolate  # type: ignore
 from sklearn.preprocessing import PolynomialFeatures
-from smart_mpc_trajectory_follower.scripts import drive_GP
-from smart_mpc_trajectory_follower.scripts import drive_NN
-from smart_mpc_trajectory_follower.scripts import drive_functions
-from smart_mpc_trajectory_follower.scripts import drive_iLQR
-from smart_mpc_trajectory_follower.scripts import drive_mppi
 import torch
 
 ctrl_index_for_polynomial_reg = np.concatenate(

diff --git a/...ctory_follower/scripts/drive_functions.py → ...ctory_follower/scripts/drive_functions.py b/...ctory_follower/scripts/drive_functions.py → ...ctory_follower/scripts/drive_functions.py
@@ -31,7 +31,9 @@
 with open(package_path_json, "r") as file:
     package_path = json.load(file)
 
-mpc_param_path = package_path["path"] + "/smart_mpc_trajectory_follower/param/mpc_param.yaml"
+mpc_param_path = (
+    package_path["path"] + "/autoware_smart_mpc_trajectory_follower/param/mpc_param.yaml"
+)
 with open(mpc_param_path, "r") as yml:
     mpc_param = yaml.safe_load(yml)
 
@@ -101,7 +103,7 @@
 cap_pred_error = np.array(mpc_param["mpc_parameter"]["preprocessing"]["cap_pred_error"])
 
 nominal_param_path = (
-    package_path["path"] + "/smart_mpc_trajectory_follower/param/nominal_param.yaml"
+    package_path["path"] + "/autoware_smart_mpc_trajectory_follower/param/nominal_param.yaml"
 )
 with open(nominal_param_path, "r") as yml:
     nominal_param = yaml.safe_load(yml)
@@ -172,7 +174,7 @@
     mpc_param["mpc_parameter"]["preprocessing"]["sg_window_size_for_nominal_inputs"]
 )
 trained_model_param_path = (
-    package_path["path"] + "/smart_mpc_trajectory_follower/param/trained_model_param.yaml"
+    package_path["path"] + "/autoware_smart_mpc_trajectory_follower/param/trained_model_param.yaml"
 )
 with open(trained_model_param_path, "r") as yml:
     trained_model_param = yaml.safe_load(yml)

diff --git a/...trajectory_follower/scripts/drive_iLQR.py → ...trajectory_follower/scripts/drive_iLQR.py b/...trajectory_follower/scripts/drive_iLQR.py → ...trajectory_follower/scripts/drive_iLQR.py
@@ -21,9 +21,9 @@
 import time
 from typing import Callable
 
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
 from numba import njit
 import numpy as np
-from smart_mpc_trajectory_follower.scripts import drive_functions
 
 index_cost = np.concatenate(
     (

diff --git a/...trajectory_follower/scripts/drive_mppi.py → ...trajectory_follower/scripts/drive_mppi.py b/...trajectory_follower/scripts/drive_mppi.py → ...trajectory_follower/scripts/drive_mppi.py
@@ -16,9 +16,9 @@
 
 from typing import Callable
 
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
 from numba import njit
 import numpy as np
-from smart_mpc_trajectory_follower.scripts import drive_functions
 
 index_cost = np.concatenate(
     (

diff --git a/...jectory_follower/scripts/proxima_calc.cpp → ...jectory_follower/scripts/proxima_calc.cpp b/...jectory_follower/scripts/proxima_calc.cpp → ...jectory_follower/scripts/proxima_calc.cpp
diff --git a/...ower/scripts/pympc_trajectory_follower.py → ...ower/scripts/pympc_trajectory_follower.py b/...ower/scripts/pympc_trajectory_follower.py → ...ower/scripts/pympc_trajectory_follower.py
@@ -22,6 +22,8 @@
 from autoware_control_msgs.msg import Control
 from autoware_planning_msgs.msg import Trajectory
 from autoware_planning_msgs.msg import TrajectoryPoint
+from autoware_smart_mpc_trajectory_follower.scripts import drive_controller
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
 from autoware_vehicle_msgs.msg import SteeringReport
 from builtin_interfaces.msg import Duration
 from geometry_msgs.msg import AccelWithCovarianceStamped
@@ -34,8 +36,6 @@
 import scipy.interpolate
 from scipy.spatial.transform import Rotation as R
 from scipy.spatial.transform import Slerp
-from smart_mpc_trajectory_follower.scripts import drive_controller
-from smart_mpc_trajectory_follower.scripts import drive_functions
 from std_msgs.msg import String
 from tier4_debug_msgs.msg import BoolStamped
 from tier4_debug_msgs.msg import Float32MultiArrayStamped

diff --git a/...llower/training_and_data_check/.gitignore → ...llower/training_and_data_check/.gitignore b/...llower/training_and_data_check/.gitignore → ...llower/training_and_data_check/.gitignore
diff --git a/...lower/training_and_data_check/__init__.py → ...lower/training_and_data_check/__init__.py b/...lower/training_and_data_check/__init__.py → ...lower/training_and_data_check/__init__.py
diff --git a/..._data_check/add_training_data_from_csv.py → ..._data_check/add_training_data_from_csv.py b/..._data_check/add_training_data_from_csv.py → ..._data_check/add_training_data_from_csv.py
@@ -23,11 +23,11 @@
 import os
 from pathlib import Path
 
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
 import numpy as np
 import scipy.interpolate
 from scipy.ndimage import gaussian_filter
 from scipy.spatial.transform import Rotation
-from smart_mpc_trajectory_follower.scripts import drive_functions
 
 
 def data_smoothing(data: np.ndarray, sigma: float) -> np.ndarray:
@@ -76,7 +76,7 @@ def transform_rosbag_to_csv(self, dir_name: str, delete_csv_first: bool = True)
         os.system(
             "cp "
             + package_path["path"]
-            + "/smart_mpc_trajectory_follower/training_and_data_check/rosbag2.bash "
+            + "/autoware_smart_mpc_trajectory_follower/training_and_data_check/rosbag2.bash "
             + dir_name
         )
         os.chdir(dir_name)

diff --git a/...raining_and_data_check/data_checker.ipynb → ...raining_and_data_check/data_checker.ipynb b/...raining_and_data_check/data_checker.ipynb → ...raining_and_data_check/data_checker.ipynb
diff --git a/..._check/execute_train_drive_NN_model.ipynb → ..._check/execute_train_drive_NN_model.ipynb b/..._check/execute_train_drive_NN_model.ipynb → ..._check/execute_train_drive_NN_model.ipynb
diff --git a/...ower/training_and_data_check/rosbag2.bash → ...ower/training_and_data_check/rosbag2.bash b/...ower/training_and_data_check/rosbag2.bash → ...ower/training_and_data_check/rosbag2.bash
diff --git a/...ng_and_data_check/train_drive_GP_model.py → ...ng_and_data_check/train_drive_GP_model.py b/...ng_and_data_check/train_drive_GP_model.py → ...ng_and_data_check/train_drive_GP_model.py
diff --git a/...ng_and_data_check/train_drive_NN_model.py → ...ng_and_data_check/train_drive_NN_model.py b/...ng_and_data_check/train_drive_NN_model.py → ...ng_and_data_check/train_drive_NN_model.py
@@ -15,13 +15,15 @@
 # cspell: ignore optim savez suptitle
 
 """Class for training neural nets from driving data."""
+from autoware_smart_mpc_trajectory_follower.scripts import drive_NN
+from autoware_smart_mpc_trajectory_follower.scripts import drive_functions
+from autoware_smart_mpc_trajectory_follower.training_and_data_check import (
+    add_training_data_from_csv,
+)
 import matplotlib.pyplot as plt
 import numpy as np
 from sklearn import linear_model
 from sklearn.preprocessing import PolynomialFeatures
-from smart_mpc_trajectory_follower.scripts import drive_NN
-from smart_mpc_trajectory_follower.scripts import drive_functions
-from smart_mpc_trajectory_follower.training_and_data_check import add_training_data_from_csv
 import torch
 from torch import nn
 from torch.utils.data import DataLoader

diff --git a/...ry_follower/images/autoware_smart_mpc.png → ...ry_follower/images/autoware_smart_mpc.png b/...ry_follower/images/autoware_smart_mpc.png → ...ry_follower/images/autoware_smart_mpc.png
diff --git a/...er/images/lateral_error_nominal_model.png → ...er/images/lateral_error_nominal_model.png b/...er/images/lateral_error_nominal_model.png → ...er/images/lateral_error_nominal_model.png
diff --git a/...er/images/lateral_error_trained_model.png → ...er/images/lateral_error_trained_model.png b/...er/images/lateral_error_trained_model.png → ...er/images/lateral_error_trained_model.png
diff --git a/...ajectory_follower/images/proxima_logo.png → ...ajectory_follower/images/proxima_logo.png b/...ajectory_follower/images/proxima_logo.png → ...ajectory_follower/images/proxima_logo.png
diff --git a/...ython_sim_lateral_error_nominal_model.png → ...ython_sim_lateral_error_nominal_model.png b/...ython_sim_lateral_error_nominal_model.png → ...ython_sim_lateral_error_nominal_model.png
diff --git a/...ython_sim_lateral_error_trained_model.png → ...ython_sim_lateral_error_trained_model.png b/...ython_sim_lateral_error_trained_model.png → ...ython_sim_lateral_error_trained_model.png
diff --git a/...trajectory_follower/images/test_route.png → ...trajectory_follower/images/test_route.png b/...trajectory_follower/images/test_route.png → ...trajectory_follower/images/test_route.png
diff --git a/...smart_mpc_trajectory_follower/package.xml → ...smart_mpc_trajectory_follower/package.xml b/...smart_mpc_trajectory_follower/package.xml → ...smart_mpc_trajectory_follower/package.xml
@@ -1,7 +1,7 @@
 <?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>smart_mpc_trajectory_follower</name>
+  <name>autoware_smart_mpc_trajectory_follower</name>
   <version>1.0.0</version>
   <description>Nodes to follow a trajectory by generating control commands using smart mpc</description>
 

diff --git a/...ol/smart_mpc_trajectory_follower/setup.py → ...re_smart_mpc_trajectory_follower/setup.py b/...ol/smart_mpc_trajectory_follower/setup.py → ...re_smart_mpc_trajectory_follower/setup.py
@@ -13,25 +13,25 @@
 os.system("pip3 install torch")
 package_path = {}
 package_path["path"] = str(Path(__file__).parent)
-with open("smart_mpc_trajectory_follower/package_path.json", "w") as f:
+with open("autoware_smart_mpc_trajectory_follower/package_path.json", "w") as f:
     json.dump(package_path, f)
 build_cpp_command = "g++ -Ofast -Wall -shared -std=c++11 -fPIC $(python3 -m pybind11 --includes) "
-build_cpp_command += "smart_mpc_trajectory_follower/scripts/proxima_calc.cpp "
-build_cpp_command += (
-    "-o smart_mpc_trajectory_follower/scripts/proxima_calc$(python3-config --extension-suffix) "
-)
+build_cpp_command += "autoware_smart_mpc_trajectory_follower/scripts/proxima_calc.cpp "
+build_cpp_command += "-o autoware_smart_mpc_trajectory_follower/scripts/proxima_calc$(python3-config --extension-suffix) "
 build_cpp_command += "-lrt -I/usr/include/eigen3"
 os.system(build_cpp_command)
 
 so_path = (
     "scripts/"
-    + glob.glob("smart_mpc_trajectory_follower/scripts/proxima_calc.*.so")[0].split("/")[-1]
+    + glob.glob("autoware_smart_mpc_trajectory_follower/scripts/proxima_calc.*.so")[0].split("/")[
+        -1
+    ]
 )
 setup(
     name="smart_mpc_trajectory_follower",
     version="1.0.0",
     packages=find_packages(),
     package_data={
-        "smart_mpc_trajectory_follower": ["package_path.json", so_path],
+        "autoware_smart_mpc_trajectory_follower": ["package_path.json", so_path],
     },
 )
diff --git a/launch/tier4_control_launch/launch/control.launch.py b/launch/tier4_control_launch/launch/control.launch.py
@@ -432,7 +432,7 @@ def launch_setup(context, *args, **kwargs):
     )
 
     smart_mpc_trajectory_follower = Node(
-        package="smart_mpc_trajectory_follower",
+        package="autoware_smart_mpc_trajectory_follower",
         executable="pympc_trajectory_follower.py",
         name="pympc_trajectory_follower",
     )