Skip to content

Commit

Permalink
feat: add autoware_state_monitor package (#9)
Browse files Browse the repository at this point in the history
* release v0.4.0

* Add map diag (autowarefoundation#688)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Change default value of disengage_on_route (autowarefoundation#703)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Change localization diag namespace (autowarefoundation#718)

* Change default value of output_diagnostics_topic

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Remove localization_diagnostic.js from web_controller

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Integrate localization diag to diagnostic_aggregator

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Delete old and unused publisher

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Support error in autoware state (autowarefoundation#728)

* Support Error in autoware_state_monitor

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Refactor autoware_state_monitor

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Wait after planning completed

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Integrate FailedToArriveGoal and Error into Emergency state

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Remove override after arrived goal in autoware_state_monitor (autowarefoundation#737)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Improve autoware state monitor diag (autowarefoundation#792)

* Add ok_list to stats

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Use key-value

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Add ok_list

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Revert "remove ROS1 packages temporarily"

This reverts commit 470b35a4a07baca60033f7b363dba2f4279ff9c7.

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Rename launch files to launch.xml (autowarefoundation#28)

* [WIP] ROS2 Porting: autoware_state_monitor (autowarefoundation#81)

* Fix CMake and package.xml
 - Remove topic_tools deps in package.xml
 - Fix cmake refs
 - Build just core without other deps

* Remove colcon ignore

* Convert CMake to ament_cmake_auto

* Fix package.xml with correct deps
 - Remove topic tools

* Convert yaml files to be ROS2 compliant
 - Previous XmlRpc was used to collect yaml array like structures
 - Use _configs.names string array to locate config.<name>.<field>
 - Will need to convert the way the parametersa are retrieved

* First pass - make compile

* Port headers
 - Change the name of arrived goal for consistency
 - Port state machine
 - Port diagnostics wrapper methods

* Add subscription, publisher and timers
 - Add simple parameters
 - Add back functionality
 - Add topic state functionality
 - Add functionality

* Add configuration parameter implementations

* Add launch files and clean up
 - Remove commented code from cmake and package.xml
 - Remove rosconsole.h

* Clean up
 - Remove changes to autoware_sysytem_msgs
 - remove comments

* Added types to the launch files
 - Make type arrays to allow for multiple types

* Add rclcpp_generic implementation for subscriptions
 - Add the callback method back
 - Include exec_depends in package.xml

* Clean up
 - Remove boost dependencies
 - Remove commented out dependencies
 - Remove comments

* Rename h files to hpp (autowarefoundation#142)

* Change includes

* Rename files

* Adjustments to make things compile

* Other packages

* Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143)

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

* Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151)

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* Add linters and fix some clang-tidy warnings (autowarefoundation#205)

* [autoware_state_monitor] fix parameter in autoware_state_monitor.planning_simulation.yaml (autowarefoundation#244)

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Modify autoware state monitor (autowarefoundation#288)

* comment out param config

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* fix minor issues

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* change engage from bool to control msg (autowarefoundation#292)

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* Ros2 v0.8.0 autoware state monitor (autowarefoundation#277)

* Ros2 v0.8.0 engage (autowarefoundation#342)

* [autoware_vehicle_msgs]: Add engage message

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* [as]: Update message

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* [awapi_awiv_adapter]: Update message

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* [web_controller]: Update message

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* [vehicle_cmd_gate]: Update message

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* [autoware_state_monitor]: Update message

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* [autoware_control_msgs]: Remove EngageMode message

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* [simple_planning_simulator]: Update message

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix invalid exception handling (autowarefoundation#344)

* remove invalid exception handling

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* remove unnecessary topics

Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp>

* Ros2 v0.8.0 fix packages (autowarefoundation#351)

* add subscription to QoS

* add vihicle_param _file to simple_planning_sim

* update cmake/packages.xml

* comment out unused parameter

* apply lint

* add vehicle_info_util to lane_change_planner

* add vehicle_info_util to vehicle_cmd_gate

* fix cmake of simple planning simulator

* update cmake/packages.xml of vehicle cmd gate

* apply lint

* apply lint

* add latch option to autoware_state_monitor

* delete unused comment

* fix implement miss in autoware_state_monitor

* Rename ROS-related .yaml to .param.yaml (autowarefoundation#352)

* Rename ROS-related .yaml to .param.yaml

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Remove prefix 'default_' of yaml files

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Rename vehicle_info.yaml to vehicle_info.param.yaml

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Rename diagnostic_aggregator's param files

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix overlooked parameters

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Ros2 v0.8.0 fix packages2 (autowarefoundation#354)

* fix topic name

* fix duration rate

* fix sensing.yaml

* fix topic name

* add latch-option to autoware_state_monitor

* fix timer callback

* fix autoware state monitor config

* fix sensing.yaml

* Add parameter args to autoware_state_monitor.launch (autowarefoundation#1175) (autowarefoundation#385)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Feature/Add route cancel service (autowarefoundation#384)

* Feature/Add route cancel service (autowarefoundation#1100)

* Feature/Add route cancel service

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Add guard

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* fix service name in launch

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* remove spin_some within service callback functions

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* apply ament_uncrustify

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* change wait time for state transition (autowarefoundation#416)

* Sensor data qos (autowarefoundation#407)

* Use sensor data qos for pointcloud preprocessor

Signed-off-by: Autoware <autoware@tier4.jp>

* Use sensor data qos for pointcloud

Signed-off-by: Autoware <autoware@tier4.jp>

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Use sensor data qos for livox tag filter and vector map filter

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Autoware <autoware@tier4.jp>

* Fix typo in system module (autowarefoundation#434)

* Fix typo in system module

* Change variable name

* Move comments

* Apply uncrustify

* add use_sim-time option (autowarefoundation#454)

* add missing topic to topic config list (autowarefoundation#1224)

* remove pointcloud from state_monitor (autowarefoundation#1236)

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Use integrated generic subscription (autowarefoundation#1342)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* suppress warnings for autoware_state_monitor (autowarefoundation#1722)

* suppress warnings for autoware_state_monitor

* fix style

* re fix style

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix mistake

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>

* Sync v1.3.0 (autowarefoundation#1909)

* Add elevation_map to autoware_state_monitor (autowarefoundation#1907)

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Disable saving elevation map temporarily (autowarefoundation#1906)

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* sync rc (autowarefoundation#1930)

* Remove elevation_map from autoware_state_monitor (autowarefoundation#1922)

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* Use base_ref (autowarefoundation#1925)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

* Add autoware api (autowarefoundation#1979)

* suport auto recovery on autoware_state_monitor (autowarefoundation#2006)

* disable emergency check if hazard_status is not received (autowarefoundation#2024)

* suppress warnings for system directory autowarefoundation#2046

* add sort-package-xml hook in pre-commit (autowarefoundation#1881)

* add sort xml hook in pre-commit

* change retval to exit_status

* rename

* add prettier plugin-xml

* use early return

* add license note

* add tier4 license

* restore prettier

* change license order

* move local hooks to public repo

* move prettier-xml to pre-commit-hooks-ros

* update version for bug-fix

* apply pre-commit

* Added warning about lookupTransform failure in autoware_status_monitor (autowarefoundation#2099)

* Change formatter to clang-format and black (autowarefoundation#2332)

* Revert "Temporarily comment out pre-commit hooks"

This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.

* Replace ament_lint_common with autoware_lint_common

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply Black

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply clang-format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix build errors

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply clang-format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix build errors

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* [autoware state monitor] support autoware.auto msg (autowarefoundation#521)

* support autoware.auto msg

* add readme

* remove unused code

* remove emergency state

* stop to subscribe hazard_status

* remove VehicleStateReport/VehicleStateCommand/VehicleControlCommand (autowarefoundation#549)

* fix autoware_error_monitor

* fix state monitor

* fix emergency handler(vehicle_state_report)

* fix emergency Handler(vehicle_state_command)

* fix shift_decider

* fix emergency_handler(vehicle_control_command)

* fix topic name

* fix readme

* Update system/autoware_state_monitor/Readme.md

Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>

* fix format

* Update system/autoware_state_monitor/launch/autoware_state_monitor.launch.xml

Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>

* fix typo

Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>

* [autowere_web_controller/autoware_state_monitor/emergency_handler]fix some packages (autowarefoundation#603)

* fix vehicle_engage.js

* fix autoware_state_monitor param

* fix emergency_handler

* oh

* update autoware_state.js

* [autoware_state_monitor]route -> had_map_route (autowarefoundation#635)

* route -> had_map_route

* Rename Readme.md to README.md

Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>

* Fix autoware monitors readme (autowarefoundation#629)

* Fix readme of autoware_state_monitor

* Fix readme of autoware_error_monitor

* adapt to actuation cmd/status as control msg (autowarefoundation#646)

* adapt to actuation cmd/status as control msg

* fix readme

* fix topics

* fix remaing topics

* as to pacmod interface

* fix vehicle status

* add header to twist

* revert gyro_odometer_change

* revert twist topic change

* revert unchanged package

* Fix topic name in autoware_state_monitor (autowarefoundation#667)

* Fix no ground pointcloud topic name (autowarefoundation#733)

Signed-off-by: j4tfwm6z <proj-jpntaxi@tier4.jp>

Co-authored-by: j4tfwm6z <proj-jpntaxi@tier4.jp>

* fix/rename segmentation namespace (autowarefoundation#742)

* rename segmentation directory

* fix namespace: system stack

* fix namespace: planning

* fix namespace: control stack

* fix namespace: perception stack

* fix readme

Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: Nikolai Morin <nnmmgit@gmail.com>
Co-authored-by: Jilada Eccleston <jilada.eccleston@gmail.com>
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: Autoware <autoware@tier4.jp>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com>
Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com>
Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com>
Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp>
Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>
Co-authored-by: Yohei Mishina <66298900+YoheiMishina@users.noreply.github.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>
Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com>
Co-authored-by: j4tfwm6z <proj-jpntaxi@tier4.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>
  • Loading branch information
1 parent 7949818 commit d5e926d
Show file tree
Hide file tree
Showing 15 changed files with 1,949 additions and 0 deletions.
40 changes: 40 additions & 0 deletions system/autoware_state_monitor/CMakeLists.txt
Original file line number Diff line number Diff line change
@@ -0,0 +1,40 @@
cmake_minimum_required(VERSION 3.5)
project(autoware_state_monitor)

### Compile options
if(NOT CMAKE_CXX_STANDARD)
set(CMAKE_CXX_STANDARD 14)
set(CMAKE_CXX_STANDARD_REQUIRED ON)
set(CMAKE_CXX_EXTENSIONS OFF)
endif()
if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
add_compile_options(-Wall -Wextra -Wpedantic -Werror)
endif()

### Dependencies
find_package(ament_cmake_auto REQUIRED)
ament_auto_find_build_dependencies()

# Target
## Set source files
set(AUTOWARE_STATE_MONITOR_SRC
src/autoware_state_monitor_node/autoware_state_monitor_node.cpp
src/autoware_state_monitor_node/state_machine.cpp
src/autoware_state_monitor_node/diagnostics.cpp
)

## Add executables
ament_auto_add_executable(autoware_state_monitor
src/autoware_state_monitor_node/main.cpp
${AUTOWARE_STATE_MONITOR_SRC}
)

if(BUILD_TESTING)
find_package(ament_lint_auto REQUIRED)
ament_lint_auto_find_test_dependencies()
endif()

ament_auto_package(INSTALL_TO_SHARE
launch
config
)
46 changes: 46 additions & 0 deletions system/autoware_state_monitor/README.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,46 @@
# autoware_state_monitor

## Purpose

This node manages AutowareState transitions.

## Inner-workings / Algorithms

## Inputs / Outputs

### Input

| Name | Type | Description |
| ---------------------------------- | ---------------------------------------------------- | ------------------------------------------------- |
| `/planning/mission_planning/route` | `autoware_auto_planning_msgs::msg::HADMapRoute` | Subscribe route |
| `/localization/kinematic_state` | `nav_msgs::msg::Odometry` | Used to decide whether vehicle is stopped or not |
| `/vehicle/state_report` | `autoware_auto_vehicle_msgs::msg::ControlModeReport` | Used to check vehicle mode: autonomous or manual. |

### Output

| Name | Type | Description |
| ------------------ | ----------------------------------------------- | -------------------------------------------------- |
| `/autoware/engage` | `autoware_auto_vehicle_msgs::msg::Engage` | publish disengage flag on AutowareState transition |
| `/autoware/state` | `autoware_auto_system_msgs::msg::AutowareState` | publish AutowareState |

## Parameters

### Node Parameters

| Name | Type | Default Value | Explanation |
| ------------- | ---- | ------------- | ---------------------- |
| `update_rate` | int | `10` | Timer callback period. |

### Core Parameters

| Name | Type | Default Value | Explanation |
| ------------------------- | ------ | ------------- | -------------------------------------------------------------------------- |
| `th_arrived_distance_m` | double | 1.0 | threshold distance to check if vehicle has arrived at the route's endpoint |
| `th_stopped_time_sec` | double | 1.0 | threshold time to check if vehicle is stopped |
| `th_stopped_velocity_mps` | double | 0.01 | threshold velocity to check if vehicle is stopped |
| `disengage_on_route` | bool | true | send disengage flag or not when the route is subscribed |
| `disengage_on_goal` | bool | true | send disengage flag or not when the vehicle is arrived goal |

## Assumptions / Known limits

TBD.
155 changes: 155 additions & 0 deletions system/autoware_state_monitor/config/autoware_state_monitor.param.yaml
Original file line number Diff line number Diff line change
@@ -0,0 +1,155 @@
# Autoware State Monitor Parameters
/**:
ros__parameters:
# modules_names: string array
module_names: [
"map",
"sensing",
"perception",
"localization",
"planning",
"control",
"vehicle",
"system"
]

# Topic Config
## names: string array
## configs: top level
### names used to declare parameter group
#### module: string
#### timeout[s]: double (0: none)
#### warn_rate[hz]: double (0: none)
topic_configs:
names: [
"/map/vector_map",
"/map/pointcloud_map",
"/perception/obstacle_segmentation/pointcloud",
"/initialpose3d",
"/localization/pose_twist_fusion_filter/pose",
"/perception/object_recognition/objects",
"/planning/mission_planning/route",
"/planning/scenario_planning/trajectory",
"/control/trajectory_follower/control_cmd",
"/control/command/control_cmd",
"/vehicle/status/velocity_status",
"/vehicle/status/steering_status",
"/system/emergency/control_cmd"
]

configs:
/map/vector_map:
module: "map"
timeout: 0.0
warn_rate: 0.0
type: "autoware_auto_mapping_msgs/msg/HADMapBin"
transient_local: True

/map/pointcloud_map:
module: "map"
timeout: 0.0
warn_rate: 0.0
type: "sensor_msgs/msg/PointCloud2"
transient_local: True

/perception/obstacle_segmentation/pointcloud:
module: "sensing"
timeout: 1.0
warn_rate: 5.0
type: "sensor_msgs/msg/PointCloud2"
best_effort: True

/initialpose3d:
module: "localization"
timeout: 0.0
warn_rate: 0.0
type: "geometry_msgs/msg/PoseWithCovarianceStamped"

/localization/pose_twist_fusion_filter/pose:
module: "localization"
timeout: 1.0
warn_rate: 5.0
type: "geometry_msgs/msg/PoseStamped"

# Can be both with feature array or without
# In prediction.launch.xml this is set to without
/perception/object_recognition/objects:
module: "perception"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_perception_msgs/msg/PredictedObjects"
# This topic could have two different types depending on the launch flags used.
# The implementation of subscriptions in ROS2 does not allow for multiple types
# to be defined for a topic. By default this is set to not use have features.
# type: ["autoware_perception_msgs/msg/DynamicObjectArray", "autoware_perception_msgs/msg/DynamicObjectWithFeatureArray"]

/planning/mission_planning/route:
module: "planning"
timeout: 0.0
warn_rate: 0.0
type: "autoware_auto_planning_msgs/msg/HADMapRoute"
transient_local: True

/planning/scenario_planning/trajectory:
module: "planning"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_planning_msgs/msg/Trajectory"

/control/trajectory_follower/control_cmd:
module: "control"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_control_msgs/msg/AckermannControlCommand"

/control/command/control_cmd:
module: "control"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_control_msgs/msg/AckermannControlCommand"

/vehicle/status/velocity_status:
module: "vehicle"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_vehicle_msgs/msg/VelocityReport"

/vehicle/status/steering_status:
module: "vehicle"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_vehicle_msgs/msg/SteeringReport"

/system/emergency/control_cmd:
module: "system"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_control_msgs/msg/AckermannControlCommand"

# Param Config
## names: string array
## configs: top level
### names used to declare parameter group
#### module: string
# param_configs:
# names: ["/vehicle_info"]
# configs:
# /vehicle_info:
# module: "vehicle"

# TF Config
## names: string array
## configs: top level
### names used to declare parameter group
#### module: string
#### from: string
#### to: string
#### timeout[s]: double (0: none)
tf_configs:
names: ["map_to_base_link"]
configs:
map_to_base_link:
module: "localization"
from: "map"
to: "base_link"
timeout: 1.0
Original file line number Diff line number Diff line change
@@ -0,0 +1,134 @@
# Autoware State Monitor: Planning Simulator Parameters
/**:
ros__parameters:
# modules_names: string array
module_names: [
"map",
"sensing",
"perception",
"localization",
"planning",
"control",
"vehicle",
"system"
]

# Topic Config
## names: string array
## configs: top level
### names used to declare parameter group
#### module: string
#### timeout[s]: double (0: none)
#### warn_rate[hz]: double (0: none)
topic_configs:
names: [
"/map/vector_map",
"/map/pointcloud_map",
"/perception/object_recognition/objects",
"/initialpose2d",
"/planning/mission_planning/route",
"/planning/scenario_planning/trajectory",
"/control/trajectory_follower/control_cmd",
"/control/command/control_cmd",
"/vehicle/status/velocity_status",
"/vehicle/status/steering_status",
"/system/emergency/control_cmd"
]

configs:
/map/vector_map:
module: "map"
timeout: 0.0
warn_rate: 0.0
type: "autoware_auto_mapping_msgs/msg/HADMapBin"
transient_local: True

/map/pointcloud_map:
module: "map"
timeout: 0.0
warn_rate: 0.0
type: "sensor_msgs/msg/PointCloud2"
transient_local: True

/perception/object_recognition/objects:
module: "perception"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_perception_msgs/msg/PredictedObjects"

/initialpose2d:
module: "localization"
timeout: 0.0
warn_rate: 0.0
type: "geometry_msgs/msg/PoseWithCovarianceStamped"

/planning/mission_planning/route:
module: "planning"
timeout: 0.0
warn_rate: 0.0
type: "autoware_auto_planning_msgs/msg/HADMapRoute"
transient_local: True

/planning/scenario_planning/trajectory:
module: "planning"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_planning_msgs/msg/Trajectory"

/control/trajectory_follower/control_cmd:
module: "control"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_control_msgs/msg/AckermannControlCommand"

/control/command/control_cmd:
module: "control"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_control_msgs/msg/AckermannControlCommand"

/vehicle/status/velocity_status:
module: "vehicle"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_vehicle_msgs/msg/VelocityReport"

/vehicle/status/steering_status:
module: "vehicle"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_vehicle_msgs/msg/SteeringReport"

/system/emergency/control_cmd:
module: "system"
timeout: 1.0
warn_rate: 5.0
type: "autoware_auto_control_msgs/msg/AckermannControlCommand"

# Param Config
## names: string array
## configs: top level
### names used to declare parameter group
#### module: string
# param_configs:
# names: ["/vehicle_info"]
# configs:
# /vehicle_info:
# module: "vehicle"

# TF Config
## names: string array
## configs: top level
### names used to declare parameter group
#### module: string
#### from: string
#### to: string
#### timeout[s]: double (0: none)
tf_configs:
names: ["map_to_base_link"]
configs:
map_to_base_link:
module: "localization"
from: "map"
to: "base_link"
timeout: 1.0
Loading

0 comments on commit d5e926d

Please sign in to comment.