Skip to content

Commit

Permalink
feat(control_data_collecting_tool): add control_data_collecting_tool (#…
Browse files Browse the repository at this point in the history
…33)

* Add control data collecting tool for learning-based control

* Implement basic part

* Disable data collection area selection during automatic driving

* Remove unnecessary code

* Add rviz_config for data collection

* Update rviz_config for data collection

* Changed to start driving by pressing LOCAL

* Fix hard coding rviz config path when launching

* Add a launch file in this package

* Add missing changes

* Claen up arguments to use rviz_config

* Updated pre-commit-hooks-ros version from v0.8.0 to v0.9.0 (#24)

Signed-off-by: Shintaro Sakoda <[email protected]>

* Add 8-figure target route

* Avoid errors when data collecting area cannot be selected by clicking properly.

* Change to launch another launch for data collection after launching the standard autoware_launch.

* chore(tools): move system and evaluation tools to this repo from autoware.universe (#26)

* chore(tools): move system tools

Signed-off-by: satoshi-ota <[email protected]>

* chore(evaluator): move evaluators

Signed-off-by: satoshi-ota <[email protected]>

---------

Signed-off-by: satoshi-ota <[email protected]>

* update

* update trajectory publisher

* update

* feat(driving_environment_analyzer): add rviz plugin (#23)

* feat(driving_environment_analyzer): add rviz plugin

Signed-off-by: satoshi-ota <[email protected]>

* feat(driving_environment_analyzer): output csv file

Signed-off-by: satoshi-ota <[email protected]>

---------

Signed-off-by: satoshi-ota <[email protected]>

* add naive pure pursuit

* update

* clean up naive pure pursuit

* smoothing trajectory position

* refactor

* chore(rviz_plugin): move peripheral rviz plugin (#27)

* feat:  calibrator tier4 pkg name (#200)

* feat: change names

Signed-off-by: tanaka3 <[email protected]>

* feat: move pkg to common

Signed-off-by: tanaka3 <[email protected]>

* feat: change pkg name

Signed-off-by: tanaka3 <[email protected]>

* fix: library path (#225)

Signed-off-by: taikitanaka3 <[email protected]>

Co-authored-by: taikitanaka3 <[email protected]>

* feat: add rviz plugin to publish and control the simulated clock (#349)

* Add tier4_clock_rviz_plugin to publish&control the sim clock in rviz

Signed-off-by: Maxime CLEMENT <[email protected]>

* Add step control

Signed-off-by: Maxime CLEMENT <[email protected]>

* Fix precommit

Signed-off-by: Maxime CLEMENT <[email protected]>

* Update documentation

Signed-off-by: Maxime CLEMENT <[email protected]>

* Fix spellcheck

Signed-off-by: Maxime CLEMENT <[email protected]>

* Update plugin description and icon

Signed-off-by: Maxime CLEMENT <[email protected]>

* Rename package

Signed-off-by: Maxime CLEMENT <[email protected]>

* Fix bug with long duration jumps (high speed + low rate)

Signed-off-by: Maxime CLEMENT <[email protected]>

* ci: check include guard (#438)

* ci: check include guard

* apply pre-commit

* Update .pre-commit-config.yaml

Co-authored-by: Kenji Miyake <[email protected]>

* fix: pre-commit

Signed-off-by: Takagi, Isamu <[email protected]>

Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>

* chore: sync files (#629)

* chore: sync files

Signed-off-by: GitHub <[email protected]>

* ci(pre-commit): autofix

Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* style: fix format of package.xml (#844)

Signed-off-by: Kenji Miyake <[email protected]>

* refactor: use autoware cmake (#849)

* remove autoware_auto_cmake

Signed-off-by: Kenji Miyake <[email protected]>

* add build_depend of autoware_cmake

Signed-off-by: Kenji Miyake <[email protected]>

* use autoware_cmake in CMakeLists.txt

Signed-off-by: Kenji Miyake <[email protected]>

* fix bugs

Signed-off-by: Kenji Miyake <[email protected]>

* fix cmake lint errors

Signed-off-by: Kenji Miyake <[email protected]>

* chore: upgrade cmake_minimum_required to 3.14 (#856)

Signed-off-by: Kenji Miyake <[email protected]>

* fix(accel_brake_map_calibrator): rviz panel type (#895)

* fixed panel type

Signed-off-by: Mamoru Sobue <[email protected]>

* modified instruction for rosbag replay case

Signed-off-by: Mamoru Sobue <[email protected]>

* modified update_map_dir service name

Signed-off-by: Mamoru Sobue <[email protected]>

* feat: add manual controller (#989)

* feat: add manual controller

Signed-off-by: tanaka3 <[email protected]>

* ci(pre-commit): autofix

Signed-off-by: Shumpei Wakabayashi <[email protected]>

* fix : typo

Signed-off-by: Shumpei Wakabayashi <[email protected]>

* chore: minor update

Signed-off-by: tanaka3 <[email protected]>
Signed-off-by: Shumpei Wakabayashi <[email protected]>

* chore : add minor update

Signed-off-by: tanaka3 <[email protected]>
Signed-off-by: Shumpei Wakabayashi <[email protected]>

* docs: add image for readme

Signed-off-by: Shumpei Wakabayashi <[email protected]>

* docs: update docs

Signed-off-by: Shumpei Wakabayashi <[email protected]>

* ci(pre-commit): autofix

Signed-off-by: Shumpei Wakabayashi <[email protected]>

* ci(pre-commit): autofix

* Update common/tier4_control_rviz_plugin/src/tools/manual_controller.cpp

Signed-off-by: Shumpei Wakabayashi <Shumpei Wakabayashi>

Co-authored-by: taikitanaka3 <[email protected]>

* Update common/tier4_control_rviz_plugin/src/tools/manual_controller.hpp

Co-authored-by: taikitanaka3 <[email protected]>

Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Shumpei Wakabayashi <[email protected]>
Co-authored-by: Shumpei Wakabayashi <[email protected]>

* feat(manual_controller): support backward driving (#1119)

* feat(manual_controller): support backward driving

Signed-off-by: tanaka3 <[email protected]>

* chore: unite variable

* feat: add screen capture package (#1177)

* feat: add screen capture package

Signed-off-by: tanaka3 <[email protected]>

* feat: add state to current process

* style: refactor codes

* fix: time

* feat: add mp4 writer and finalize folders

* feat: add trigger by service

Signed-off-by: tanaka3 <[email protected]>

* feat: update recorder

Signed-off-by: tanaka3 <[email protected]>

* fix: change codec of mp4 to h264 (#1262)

Signed-off-by: tomoya.kimura <[email protected]>

* feat: optimize screen capture panel (#1470)

* feat: optimize screen capture panel

Signed-off-by: tomoya.kimura <[email protected]>

* apply pre-commit

Signed-off-by: tomoya.kimura <[email protected]>

* fix: remove unused check of rviz plugin version (#1474)

Signed-off-by: Takagi, Isamu <[email protected]>

* fix(rviz_plugin): fix screen capture plugin (#1492)

Signed-off-by: tanaka3 <[email protected]>

* refactor(tier4_calibration_rviz_plugin): apply clang-tidy (#1596)

* refactor(tier4_control_rviz_plugin): apply clang-tidy (#1597)

* refactor(tier4_control_rviz_plugin): apply clang-tidy

* revert: readability-identifier-naming

Signed-off-by: h-ohta <[email protected]>

Signed-off-by: h-ohta <[email protected]>

* revert(tier4_calibration_rviz_plugin): readability-identifier-naming (#1618)

* fix(tier4_screen_capture_rviz_plugin): fix release process to handle video writer correctly (#1622)

* refactor(tier4_screen_capture_rviz_plugin):apply clang-tidy (#1649)

Signed-off-by: h-ohta <[email protected]>

Signed-off-by: h-ohta <[email protected]>

* fix(tier4_screen_capture_rviz_plugin): fix spell check (#1790)

* fix(tier4_screen_capture_rviz_plugin): fix spell check

Signed-off-by: h-ohta <[email protected]>

* ci(pre-commit): autofix

Signed-off-by: h-ohta <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* feat: add rtc  manager rviz plugin (#1936)

* feat: add rtc  manager rviz plugin

Signed-off-by: tanaka3 <[email protected]>

* chore: cosmetic change

Signed-off-by: tanaka3 <[email protected]>

* chore: remove indent

Signed-off-by: tanaka3 <[email protected]>

* feat: add rtc safe unsafe color

Signed-off-by: tanaka3 <[email protected]>

* fix: typo

Signed-off-by: tanaka3 <[email protected]>

* chore: simplify layout

Signed-off-by: tanaka3 <[email protected]>

* feat: update rtc panel

Signed-off-by: tanaka3 <[email protected]>

Signed-off-by: tanaka3 <[email protected]>

* feat(rtc_manager_panel): add rtc all approval (#2009)

* feat(rtc_manager_panel): add rtc all approval

Signed-off-by: taikitanaka3 <[email protected]>

* chore: cosmetic change

Signed-off-by: taikitanaka3 <[email protected]>

* fix: static cast

Signed-off-by: tanaka3 <[email protected]>

* chore: update text

Co-authored-by: Fumiya Watanabe <[email protected]>

* chore: update text

Co-authored-by: Fumiya Watanabe <[email protected]>

* doc: update documents

Signed-off-by: tanaka3 <[email protected]>

* doc: update

Signed-off-by: tanaka3 <[email protected]>

* doc: small update

Signed-off-by: tanaka3 <[email protected]>

Signed-off-by: taikitanaka3 <[email protected]>
Signed-off-by: tanaka3 <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>

* feat(rtc_manager_rviz_plugin): add_indivisual_exe (#2021)

Signed-off-by: tanaka3 <[email protected]>

Signed-off-by: tanaka3 <[email protected]>

* feat(tier4_screen_capture_rviz_plugin): add prefix to video name (#2038)

feat: add  prefix

* feat(tier4_debug_rviz_plugin): pie chart with float32 multi array stamped (#2055)

* feat(tier4_debug_rviz_plugin): add ros2 pie chart with Float32MultiArrayStamped

Signed-off-by: Takayuki Murooka <[email protected]>

* update README.md

Signed-off-by: Takayuki Murooka <[email protected]>

* fix typo

Signed-off-by: Takayuki Murooka <[email protected]>

* fixed license

Signed-off-by: Takayuki Murooka <[email protected]>

* fix

Signed-off-by: Takayuki Murooka <[email protected]>

* removed unnecessary include

Signed-off-by: Takayuki Murooka <[email protected]>

* fix

Signed-off-by: Takayuki Murooka <[email protected]>

* fix

Signed-off-by: Takayuki Murooka <[email protected]>

Signed-off-by: Takayuki Murooka <[email protected]>

* fix(tier4_control_rviz_plugin): add time stamp for control command (#2154)

Signed-off-by: tanaka3 <[email protected]>

Signed-off-by: tanaka3 <[email protected]>

* fix(rtc_manager_rviz_plugin): size check (#2163)

* feat(behavior_path_planner): external request lane change (#2442)

* feature(behavior_path_planner): add external request lane change module

Signed-off-by: Fumiya Watanabe <[email protected]>

feature(behavior_path_planner): fix for RTC

Signed-off-by: Fumiya Watanabe <[email protected]>

feature(behavior_path_planner): fix decision logic

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): fix behavior_path_planner_tree.xml

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): fix for rebase

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): output multiple candidate paths

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): get path candidate in behavior tree manager

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): fix for multiple candidate path

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): separate external request lane change module

Signed-off-by: Fumiya Watanabe <[email protected]>

feature(behavior_path_planner): add create publisher method

Signed-off-by: Fumiya Watanabe <[email protected]>

feature(behavior_path_planner): move publishers to node

Signed-off-by: Fumiya Watanabe <[email protected]>

feature(behavior_path_planner): remove unnecessary publisher

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): move reset path candidate function to behavior tree manager

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): add external request lane change path candidate publisher

Signed-off-by: Fumiya Watanabe <[email protected]>

feat(behavior_path_planner): apply abort lane change

Signed-off-by: Fumiya Watanabe <[email protected]>

* fix(behavior_path_planner): remove unnecessary change

Signed-off-by: Fumiya Watanabe <[email protected]>

* feat(behavior_path_planner): fix getLaneChangePaths()

Signed-off-by: Fumiya Watanabe <[email protected]>

* feat(behavior_path_planner): disable external request lane change in default tree

Signed-off-by: Fumiya Watanabe <[email protected]>

* Update rtc_auto_mode_manager.param.yaml

* fix(route_handler): remove redundant code

* fix(behavior_path_planner): fix for turn signal

Signed-off-by: Fumiya Watanabe <[email protected]>

Signed-off-by: Fumiya Watanabe <[email protected]>

* chore(rtc_manager_rviz_plugin): add code owner (#2792)

Signed-off-by: tomoya.kimura <[email protected]>

* feat(rtc_manager_rviz_plugin): add the number of rtc status (#2791)

* feat(rtc_manager_rviz_plugin): add the number of rtc status

Signed-off-by: taikitanaka3 <[email protected]>

* chore: simplify layout

Signed-off-by: taikitanaka3 <[email protected]>

---------

Signed-off-by: taikitanaka3 <[email protected]>
Co-authored-by: Tomoya Kimura <[email protected]>

* feat(automatic_goal): add automatic goal rviz plugin (#3031)

* add first version automatic_goal plugin

Signed-off-by: Dawid Moszyński <[email protected]>

* feat(automatic_goal): extract automatic_goal_sender, add logging achieved goals

Signed-off-by: Dawid Moszyński <[email protected]>

* doc(automatic_goal): append README

Signed-off-by: Dawid Moszyński <[email protected]>

* ref(automatic_goal): apply pre-commity, fix depend

Signed-off-by: Dawid Moszyński <[email protected]>

* fix(automatic_goal): fix warnings - treated as errors

Signed-off-by: Dawid Moszyński <[email protected]>

* ref(automatic_goal): add author, apply clang-tidy hints

Signed-off-by: Dawid Moszyński <[email protected]>

* ref(automatic_goal): add maintainer, change  year

Signed-off-by: Dawid Moszyński <[email protected]>

* ref(automatic_goal): fix package.xml order

Signed-off-by: Dawid Moszyński <[email protected]>

* ref(automatic_goal): names, initializations, main except

Signed-off-by: Dawid Moszyński <[email protected]>

* fix(automatic_goal): change path home->tmp

Signed-off-by: Dawid Moszyński <[email protected]>

* fix(automatic_goal): fix bad string init, expand readme

Signed-off-by: Dawid Moszyński <[email protected]>

* fix(automatic_goal): fix name

Signed-off-by: Dawid Moszyński <[email protected]>

---------

Signed-off-by: Dawid Moszyński <[email protected]>

* feat(rtc_manager_rviz_plugin): add avoidance by lc (#3118)

Signed-off-by: satoshi-ota <[email protected]>

* fix(tier4_screen_capture_rviz_plugin): fix extra/missing naming components (#3207)

Signed-off-by: Mehmet Dogru <[email protected]>

* chore: sync files (#3227)

* chore: sync files

Signed-off-by: GitHub <[email protected]>

* style(pre-commit): autofix

---------

Signed-off-by: GitHub <[email protected]>
Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* feat: change external lane change rtc name (#3259)

* feat: change external lane change rtc name

Signed-off-by: Takayuki Murooka <[email protected]>

* update config

Signed-off-by: Takayuki Murooka <[email protected]>

---------

Signed-off-by: Takayuki Murooka <[email protected]>

* feat(behavior_velocity_planner::intersection): add occlusion detection feature (#3458)

* migrated

Signed-off-by: Mamoru Sobue <[email protected]>

* WIP

Signed-off-by: Mamoru Sobue <[email protected]>

* IntersectionModuleManager own one rtc_interface for intersection_occlusion

Signed-off-by: Mamoru Sobue <[email protected]>

* divide occlusion safety and activated

Signed-off-by: Mamoru Sobue <[email protected]>

* fixed to update occlusion cooperate status at construction

Signed-off-by: Mamoru Sobue <[email protected]>

* fixed getOcclusionFirstStopSafety()

Signed-off-by: Mamoru Sobue <[email protected]>

* fixed not to show both intersection and intersection_occlusion  after passed 1st stop line

Signed-off-by: Mamoru Sobue <[email protected]>

* fixed the intersection_occlusion/inersection stop position afte r CLEARED

Signed-off-by: Mamoru Sobue <[email protected]>

* if occlusion cleared when eog is before 1st stop line, set stop line to 1st stop line and clear prev_occlusion_stop_line_pose_

Signed-off-by: Mamoru Sobue <[email protected]>

* (misc) fix viz, sync param

Signed-off-by: Mamoru Sobue <[email protected]>

* fixed vehicle footprint offset calculation

Signed-off-by: Mamoru Sobue <[email protected]>

* add occcupancy_grid_map method/param var to launcher

Signed-off-by: Mamoru Sobue <[email protected]>

* migrated latest

Signed-off-by: Mamoru Sobue <[email protected]>

* use static pass judge line

Signed-off-by: Mamoru Sobue <[email protected]>

* removed some params

Signed-off-by: Mamoru Sobue <[email protected]>

* organized param

Signed-off-by: Mamoru Sobue <[email protected]>

* add occlusion enable flag

Signed-off-by: Mamoru Sobue <[email protected]>

* revert occupancy grid settings in this PR

Signed-off-by: Mamoru Sobue <[email protected]>

* remove comment

Signed-off-by: Mamoru Sobue <[email protected]>

* fixed pass judge line collision detection to original

Signed-off-by: Mamoru Sobue <[email protected]>

* style(pre-commit): autofix

* use vehicle_length for static pass judge line

Signed-off-by: Mamoru Sobue <[email protected]>

* fixed virtual wall marker

Signed-off-by: Mamoru Sobue <[email protected]>

---------

Signed-off-by: Mamoru Sobue <[email protected]>
Signed-off-by: Mamoru Sobue <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* fix(rtc_manager_rviz_plugin): update panel visualization properly (#3517)

Signed-off-by: tomoya.kimura <[email protected]>

* refactor(behavior_path_planner): rename pull_over to goal_planner (#3501)

Signed-off-by: kosuke55 <[email protected]>

* build: mark autoware_cmake as <buildtool_depend> (#3616)

* build: mark autoware_cmake as <buildtool_depend>

with <build_depend>, autoware_cmake is automatically exported with ament_target_dependencies() (unecessary)

Signed-off-by: Vincent Richard <[email protected]>

* style(pre-commit): autofix

* chore: fix pre-commit errors

Signed-off-by: Kenji Miyake <[email protected]>

---------

Signed-off-by: Vincent Richard <[email protected]>
Signed-off-by: Kenji Miyake <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Kenji Miyake <[email protected]>

* build(iron): remove rmw_qos_profile_t (#3809)

Signed-off-by: wep21 <[email protected]>

* refactor(start_planner): rename pull out to start planner (#3908)

Signed-off-by: kosuke55 <[email protected]>

* fix(accel_brake_map_calibrator_button_panel): fix calibration service name (#4539)

* fix(accel_brake_map_calibrator_button_panel): fix calibration service name

Signed-off-by: tomoya.kimura <[email protected]>

* misc

Signed-off-by: tomoya.kimura <[email protected]>

---------

Signed-off-by: tomoya.kimura <[email protected]>

* feat(rviz_plugin): add target object type display (#4855)

* add common/tier4_target_object_type_rviz_plugin

Signed-off-by: Takamasa Horibe <[email protected]>

* fix format

Signed-off-by: Takamasa Horibe <[email protected]>

* update color

Signed-off-by: Takamasa Horibe <[email protected]>

* update

Signed-off-by: Takamasa Horibe <[email protected]>

* add readme

Signed-off-by: Takamasa Horibe <[email protected]>

* Update common/tier4_target_object_type_rviz_plugin/src/target_object_type_panel.cpp

Co-authored-by: Satoshi OTA <[email protected]>

* Update common/tier4_target_object_type_rviz_plugin/src/target_object_type_panel.hpp

Co-authored-by: Satoshi OTA <[email protected]>

* remove unused depend

Signed-off-by: Takamasa Horibe <[email protected]>

---------

Signed-off-by: Takamasa Horibe <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>

* fix(rtc_manager_panel): fix panel chattering (#4988)

Signed-off-by: satoshi-ota <[email protected]>

* build(tier4_target_object_type_rviz_plugin): add missing cv_bridge dependency (#5000)

Signed-off-by: Esteve Fernandez <[email protected]>

* feat(logging_level_configure): add rviz plugin to change logging level (#5112)

* feat(logging_level_configure): add rviz plugin to change logging level

Signed-off-by: Takamasa Horibe <[email protected]>

* change file names

Signed-off-by: Takamasa Horibe <[email protected]>

* move initialization code from constructor to onInitialize

Signed-off-by: Takamasa Horibe <[email protected]>

* add maintainer

Signed-off-by: Takamasa Horibe <[email protected]>

* add maintainer

Signed-off-by: Takamasa Horibe <[email protected]>

* fix include

Signed-off-by: Takamasa Horibe <[email protected]>

---------

Signed-off-by: Takamasa Horibe <[email protected]>

* feat(logger_level_reconfigure_plugin): use node interface and some cosmetic updates (#5204)

* use node service

Signed-off-by: Takamasa Horibe <[email protected]>

* enable yaml configuration

Signed-off-by: Takamasa Horibe <[email protected]>

* update yaml loading

Signed-off-by: Takamasa Horibe <[email protected]>

* make it scrollable

Signed-off-by: Takamasa Horibe <[email protected]>

* change function order

Signed-off-by: Takamasa Horibe <[email protected]>

* change color for level

Signed-off-by: Takamasa Horibe <[email protected]>

* fix depend

Signed-off-by: Takamasa Horibe <[email protected]>

* Update common/tier4_logging_level_configure_rviz_plugin/src/logging_level_configure.cpp

Co-authored-by: Kosuke Takeuchi <[email protected]>

* Update common/tier4_logging_level_configure_rviz_plugin/src/logging_level_configure.cpp

---------

Signed-off-by: Takamasa Horibe <[email protected]>
Co-authored-by: Kosuke Takeuchi <[email protected]>

* refactor(lane_change): add debug log (#5308)

Signed-off-by: Takamasa Horibe <[email protected]>

* docs(logger_level_reconfigure): update readme (#5471)

Signed-off-by: Takamasa Horibe <[email protected]>

* feat(localization): enable logging_level_configure (#5487)

* feat(localization): enable logging_level_configure

* style(pre-commit): autofix

* update logger config

Signed-off-by: kminoda <[email protected]>

* fix pre-commit

Signed-off-by: kminoda <[email protected]>

* add tier4_autoware_utils in dependency

Signed-off-by: kminoda <[email protected]>

* add tier4_autoware_utils in dependency

Signed-off-by: kminoda <[email protected]>

---------

Signed-off-by: kminoda <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* Logger level update (#5494)

* address ordering

Signed-off-by: Takamasa Horibe <[email protected]>

* add grouping

Signed-off-by: Takamasa Horibe <[email protected]>

* remove unused comment

Signed-off-by: Takamasa Horibe <[email protected]>

---------

Signed-off-by: Takamasa Horibe <[email protected]>

* feat(logging_level_configure_rviz_plugin): add autoware_util logger button (#5666)

* feat(logging_level_configure_rviz_plugin): add autoware_util logger button

Signed-off-by: Takamasa Horibe <[email protected]>

* add for control

Signed-off-by: Takamasa Horibe <[email protected]>

---------

Signed-off-by: Takamasa Horibe <[email protected]>

* refactor(lane_change): standardizing lane change logger name (#5899)

Signed-off-by: Zulfaqar Azmi <[email protected]>

* feat(tier4_logging_level_configure_rviz_plugin): add goal/start planner (#5978)

Signed-off-by: kosuke55 <[email protected]>

* chore: set log level of debug printing in rviz plugin to DEBUG (#5996)

Signed-off-by: Takayuki Murooka <[email protected]>

* feat(rviz_plugin): add string visualization plugin (#6100)

Signed-off-by: satoshi-ota <[email protected]>

* feat(tier4_automatic_goal_rviz_plugin): make it possible to register checkpoints (#6153)

Signed-off-by: satoshi-ota <[email protected]>

* chore(object_type_panel): update rosparam name config (#6347)

Signed-off-by: Takamasa Horibe <[email protected]>

* style(update): autoware tools icons (#6351)

Signed-off-by: KhalilSelyan <[email protected]>

* fix(readme): add acknowledgement for material icons in tool plugins (#6354)

Signed-off-by: KhalilSelyan <[email protected]>

* feat(mission_planner_rviz_plugin): create mission planner tool (#6362)

* feat(mission_planner_rviz_plugin): create package

Signed-off-by: Takagi, Isamu <[email protected]>

* fix copyright

Signed-off-by: Takagi, Isamu <[email protected]>

* add interrupted state

Signed-off-by: Takagi, Isamu <[email protected]>

* use full license text instead of spdx

Signed-off-by: Takagi, Isamu <[email protected]>

---------

Signed-off-by: Takagi, Isamu <[email protected]>

* fix(manual_controller): set PARK gear when going from reverse to drive (#6230)

Signed-off-by: Maxime CLEMENT <[email protected]>

* feat(logger_level_configure): make it possible to change level of container logger (#6823)

* feat(launch): add logging_demo::LoggerConfig into container

Signed-off-by: satoshi-ota <[email protected]>

* fix(logger_level_reconfigure_plugin): fix yaml

Signed-off-by: satoshi-ota <[email protected]>

* feat(logging_level_configure): add composable node

Signed-off-by: satoshi-ota <[email protected]>

---------

Signed-off-by: satoshi-ota <[email protected]>

* revert: "feat(logger_level_configure): make it possible to change level of container logger (#6823)" (#6842)

This reverts commit 9d04533.

* docs(tier4_logging_level_configure_rviz_plugin): update document (#6720)

* docs(tier4_logging_level_configure_rviz_plugin): update document

Signed-off-by: Zulfaqar Azmi <[email protected]>

* fix spell check

Signed-off-by: Zulfaqar Azmi <[email protected]>

* fix Warning

Signed-off-by: Zulfaqar Azmi <[email protected]>

---------

Signed-off-by: Zulfaqar Azmi <[email protected]>

* refactor(bpp, avoidance): remove unnecessary verbose flag (#6822)

* refactor(avoidance): logger small change

Signed-off-by: satoshi-ota <[email protected]>

* refactor(bpp): remove verbose flag

Signed-off-by: satoshi-ota <[email protected]>

---------

Signed-off-by: satoshi-ota <[email protected]>

* feat(tier4_screen_capture_panel): add new service to capture screen shot (#6867)

* feat(tier4_screen_capture_panel): add new service to capture screen shot

Signed-off-by: satoshi-ota <[email protected]>

* docs(tier4_screen_capture_rviz_plugin): update readme

Signed-off-by: satoshi-ota <[email protected]>

---------

Signed-off-by: satoshi-ota <[email protected]>

* refactor(lane_change): fix logger (#6873)

Signed-off-by: Zulfaqar Azmi <[email protected]>

* fix(route_handler): add logger (#6888)

* fix(route_handler): add logger

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

* fix indent

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

---------

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

* docs(tier4_simulated_clock_rviz_plugin): update how to use (#6914)

* docs(tier4_simulated_clock_rviz_plugin): update how to use

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

* fixed tabbed warning

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

* fix warning not working

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

* Fix bullet list

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

---------

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

* refactor(bpp): path shifter clang tidy and logging level configuration (#6917)

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

* fix(accel_brake_calibrator): fix to set service name and exception failure (#6973)

* add service

* fix exception

* fix style

* refactor(motion_utils): supress log message with rclcpp logging (#6955)

* refactor(motion_utils): supress log message with rclcpp logging

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

* remove std string

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

---------

Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>

---------

Signed-off-by: tanaka3 <[email protected]>
Signed-off-by: Maxime CLEMENT <[email protected]>
Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: Mamoru Sobue <[email protected]>
Signed-off-by: tomoya.kimura <[email protected]>
Signed-off-by: Takagi, Isamu <[email protected]>
Signed-off-by: h-ohta <[email protected]>
Signed-off-by: taikitanaka3 <[email protected]>
Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: Fumiya Watanabe <[email protected]>
Signed-off-by: Dawid Moszyński <[email protected]>
Signed-off-by: satoshi-ota <[email protected]>
Signed-off-by: Mehmet Dogru <[email protected]>
Signed-off-by: GitHub <[email protected]>
Signed-off-by: Mamoru Sobue <[email protected]>
Signed-off-by: kosuke55 <[email protected]>
Signed-off-by: Vincent Richard <[email protected]>
Signed-off-by: wep21 <[email protected]>
Signed-off-by: Takamasa Horibe <[email protected]>
Signed-off-by: Esteve Fernandez <[email protected]>
Signed-off-by: kminoda <[email protected]>
Signed-off-by: Zulfaqar Azmi <[email protected]>
Signed-off-by: KhalilSelyan <[email protected]>
Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com>
Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Shumpei Wakabayashi <[email protected]>
Co-authored-by: Shumpei Wakabayashi <[email protected]>
Co-authored-by: Tomoya Kimura <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: dmoszynski <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Mehmet Dogru <[email protected]>
Co-authored-by: Kosuke Takeuchi <[email protected]>
Co-authored-by: Vincent Richard <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: kminoda <[email protected]>
Co-authored-by: Zulfaqar Azmi <[email protected]>
Co-authored-by: Khalil Selyan <[email protected]>

* update smoothing of start/end-point

* Add simplified lateral acc limit

* update debug plot

* add gif

* Update README.md

* Update README.md

* use ros param

* ros param

* update

* update image

* Update README.md

* Add velocity noise

* Update acc and steer noises

* update rviz

* update resource

* Update README.md

* Update README.md

* Update control_data_collecting_tool/README.md

Co-authored-by: Kosuke Takeuchi <[email protected]>

* update readme

* Update bag2lanelet/scripts/bag2map.py

Co-authored-by: Kosuke Takeuchi <[email protected]>

* modify sentence

* chore(rtc_manager_panel): update module name (#29)

* chore(rtc_manager_panel): update module name

Signed-off-by: satoshi-ota <[email protected]>

* chore(gitignore): remove py cache

Signed-off-by: satoshi-ota <[email protected]>

---------

Signed-off-by: satoshi-ota <[email protected]>

* improve pure pursuit

* Update control_data_collecting_tool/scripts/data_collecting_trajectory_publisher.py

Co-authored-by: Kosuke Takeuchi <[email protected]>

* remove deprecated linearized pure pursuit

* clean up traj pub

* Reduce speed for large lateral error

* Improve how to obtain the trajectory closest point

* update readme

* rename variables

* compute trajectory only when receive data collecting area info

* smoothing target yaw

* add yaw error threshold

* remove rviz config

* renew png and gif

* add arrow on png

* feat(driving_environment_analyzer): remove dependency to autoware_auto_tf2 (#31)

Signed-off-by: Ryohsuke Mitsudome <[email protected]>

---------

Signed-off-by: Shintaro Sakoda <[email protected]>
Signed-off-by: satoshi-ota <[email protected]>
Signed-off-by: tanaka3 <[email protected]>
Signed-off-by: Maxime CLEMENT <[email protected]>
Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: Mamoru Sobue <[email protected]>
Signed-off-by: tomoya.kimura <[email protected]>
Signed-off-by: Takagi, Isamu <[email protected]>
Signed-off-by: h-ohta <[email protected]>
Signed-off-by: taikitanaka3 <[email protected]>
Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: Fumiya Watanabe <[email protected]>
Signed-off-by: Dawid Moszyński <[email protected]>
Signed-off-by: Mehmet Dogru <[email protected]>
Signed-off-by: GitHub <[email protected]>
Signed-off-by: Mamoru Sobue <[email protected]>
Signed-off-by: kosuke55 <[email protected]>
Signed-off-by: Vincent Richard <[email protected]>
Signed-off-by: wep21 <[email protected]>
Signed-off-by: Takamasa Horibe <[email protected]>
Signed-off-by: Esteve Fernandez <[email protected]>
Signed-off-by: kminoda <[email protected]>
Signed-off-by: Zulfaqar Azmi <[email protected]>
Signed-off-by: KhalilSelyan <[email protected]>
Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>
Signed-off-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: SakodaShintaro <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Mamoru Sobue <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com>
Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Shumpei Wakabayashi <[email protected]>
Co-authored-by: Shumpei Wakabayashi <[email protected]>
Co-authored-by: Tomoya Kimura <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: dmoszynski <[email protected]>
Co-authored-by: Mehmet Dogru <[email protected]>
Co-authored-by: Kosuke Takeuchi <[email protected]>
Co-authored-by: Vincent Richard <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: kminoda <[email protected]>
Co-authored-by: Zulfaqar Azmi <[email protected]>
Co-authored-by: Khalil Selyan <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>

* fix markdownlint in README

Signed-off-by: Toru Hishinuma <[email protected]>

* add maitainers

Signed-off-by: Toru Hishinuma <[email protected]>

* update msgs

Signed-off-by: kosuke55 <[email protected]>

* add linearized pure pursuit control

Signed-off-by: Toru Hishinuma <[email protected]>

* change default params

Signed-off-by: Toru Hishinuma <[email protected]>

* add stop automatic driving

Signed-off-by: Toru Hishinuma <[email protected]>

* update control cmd limit

Signed-off-by: Toru Hishinuma <[email protected]>

* [bug fix] recompute trajectory when changing rosparam online

Signed-off-by: Toru Hishinuma <[email protected]>

* fix dead link

Signed-off-by: Toru Hishinuma <[email protected]>

* run pre-commit

Signed-off-by: kosuke55 <[email protected]>

* fix spell

Signed-off-by: kosuke55 <[email protected]>

* Update bag2lanelet/scripts/bag2map.py

Co-authored-by: Kosuke Takeuchi <[email protected]>

---------

Signed-off-by: Shintaro Sakoda <[email protected]>
Signed-off-by: satoshi-ota <[email protected]>
Signed-off-by: tanaka3 <[email protected]>
Signed-off-by: Maxime CLEMENT <[email protected]>
Signed-off-by: Kenji Miyake <[email protected]>
Signed-off-by: Mamoru Sobue <[email protected]>
Signed-off-by: tomoya.kimura <[email protected]>
Signed-off-by: Takagi, Isamu <[email protected]>
Signed-off-by: h-ohta <[email protected]>
Signed-off-by: taikitanaka3 <[email protected]>
Signed-off-by: Takayuki Murooka <[email protected]>
Signed-off-by: Fumiya Watanabe <[email protected]>
Signed-off-by: Dawid Moszyński <[email protected]>
Signed-off-by: Mehmet Dogru <[email protected]>
Signed-off-by: GitHub <[email protected]>
Signed-off-by: Mamoru Sobue <[email protected]>
Signed-off-by: kosuke55 <[email protected]>
Signed-off-by: Vincent Richard <[email protected]>
Signed-off-by: wep21 <[email protected]>
Signed-off-by: Takamasa Horibe <[email protected]>
Signed-off-by: Esteve Fernandez <[email protected]>
Signed-off-by: kminoda <[email protected]>
Signed-off-by: Zulfaqar Azmi <[email protected]>
Signed-off-by: KhalilSelyan <[email protected]>
Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>
Signed-off-by: Ryohsuke Mitsudome <[email protected]>
Signed-off-by: Toru Hishinuma <[email protected]>
Co-authored-by: SakodaShintaro <[email protected]>
Co-authored-by: Satoshi OTA <[email protected]>
Co-authored-by: Mamoru Sobue <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: taikitanaka3 <[email protected]>
Co-authored-by: Maxime CLEMENT <[email protected]>
Co-authored-by: Takagi, Isamu <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: Kenji Miyake <[email protected]>
Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com>
Co-authored-by: kenji-miyake <[email protected]>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Shumpei Wakabayashi <[email protected]>
Co-authored-by: Shumpei Wakabayashi <[email protected]>
Co-authored-by: Tomoya Kimura <[email protected]>
Co-authored-by: Hiroki OTA <[email protected]>
Co-authored-by: Fumiya Watanabe <[email protected]>
Co-authored-by: Takayuki Murooka <[email protected]>
Co-authored-by: dmoszynski <[email protected]>
Co-authored-by: Mehmet Dogru <[email protected]>
Co-authored-by: Kosuke Takeuchi <[email protected]>
Co-authored-by: Vincent Richard <[email protected]>
Co-authored-by: Daisuke Nishimatsu <[email protected]>
Co-authored-by: Takamasa Horibe <[email protected]>
Co-authored-by: Esteve Fernandez <[email protected]>
Co-authored-by: kminoda <[email protected]>
Co-authored-by: Zulfaqar Azmi <[email protected]>
Co-authored-by: Khalil Selyan <[email protected]>
Co-authored-by: Ryohsuke Mitsudome <[email protected]>
Co-authored-by: masayukiaino <[email protected]>
Signed-off-by: temkei.kem <[email protected]>
  • Loading branch information
1 parent 59ae7c5 commit 2814932
Show file tree
Hide file tree
Showing 15 changed files with 1,867 additions and 0 deletions.
33 changes: 33 additions & 0 deletions control_data_collecting_tool/CMakeLists.txt
Original file line number Diff line number Diff line change
@@ -0,0 +1,33 @@
cmake_minimum_required(VERSION 3.14)
project(control_data_collecting_tool)

find_package(autoware_cmake REQUIRED)
autoware_package()

install(PROGRAMS
scripts/data_collecting_pure_pursuit_trajectory_follower.py
scripts/data_collecting_trajectory_publisher.py
DESTINATION lib/${PROJECT_NAME}
)

find_package(Qt5 REQUIRED Core Widgets)
set(QT_LIBRARIES Qt5::Widgets)

set(CMAKE_AUTOMOC ON)


ament_auto_add_library(${PROJECT_NAME} SHARED
src/data_collecting_area_selection.cpp
)

target_link_libraries(${PROJECT_NAME}
${QT_LIBRARIES})

pluginlib_export_plugin_description_file(rviz_common plugins/plugin_description.xml)

install(DIRECTORY launch DESTINATION share/${PROJECT_NAME})

ament_auto_package(
INSTALL_TO_SHARE
plugins
)
120 changes: 120 additions & 0 deletions control_data_collecting_tool/README.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,120 @@
# Control data collecting tool

This package provides tools for automatically collecting data using pure pursuit control within a specified rectangular area.

<img src="resource/demo.gif" width="800">

## Overview

- This package aims to collect a dataset consisting of control inputs (i.e. `control_cmd`) and observation variables (i.e. `kinematic_state`, `steering_status`, etc).
- The collected dataset can be used as training dataset for learning-based controllers, including [smart_mpc](https://github.com/autowarefoundation/autoware.universe/tree/f30c0350861d020ad26a45806ab1334895122fab/control/smart_mpc_trajectory_follower).
- The data collecting approach is as follows:
- Setting a figure-eight target trajectory within the specified rectangular area.
- Following the trajectory using a pure pursuit control law.
- Adding noises to the trajectory and the control command for data diversity, improving the prediction accuracy of learning model.

## How to use

1. Launch Autoware.

```bash
ros2 launch autoware_launch planning_simulator.launch.xml map_path:=$HOME/autoware_map/sample-map-planning vehicle_model:=sample_vehicle sensor_model:=sample_sensor_kit
```

2. Set an initial pose, see [here](https://autowarefoundation.github.io/autoware-documentation/main/tutorials/ad-hoc-simulation/planning-simulation/#2-set-an-initial-pose-for-the-ego-vehicle).

3. Add `DataCollectingAreaSelectionTool` rviz plugin.

<img src="resource/add_rviz_plugin.png" width="480">

4. Launch control_data_collecting_tool.

```bash
ros2 launch control_data_collecting_tool control_data_collecting_tool.launch.py
```

5. Add visualization in rviz:

- `/data_collecting_area`
- Type: Polygon
- `/data_collecting_trajectory_marker_array`
- Type: MarkerArray
- `/data_collecting_lookahead_marker_array`
- Type: MarkerArray

6. Select `DataCollectingAreaSelectionTool` plugin.

<img src="resource/select_tool.png" width="480">

Highlight the data collecting area by dragging the mouse over it.

<img src="resource/select_area.gif" width="480">

> [!NOTE]
> You cannot change the data collecting area while driving.
7. start recording rosbag data. For example, run the following command:

```bash
ros2 bag record /localization/kinematic_state /localization/acceleration /vehicle/status/steering_status /sensing/imu/imu_data /system/operation_mode/state /vehicle/status/control_mode /external/selected/control_cmd /external/selected/gear_cmd /data_collecting_trajectory
```

8. Click the `LOCAL` button on `OperationMode` in `AutowareStatePanel`.

<img src="resource/push_LOCAL.png" width="480">

Then, data collecting starts.

<img src="resource/demo.gif" width="480">

9. If you want to stop data collecting automatic driving, run the following command

```bash
ros2 topic pub /data_collecting_stop_request std_msgs/msg/Bool "data: true" --once
```

10. If you want to restart data collecting automatic driving, run the following command

```bash
ros2 topic pub /data_collecting_stop_request std_msgs/msg/Bool "data: false" --once
```

## Parameter

ROS 2 params in `/data_collecting_trajectory_publisher` node:

| Name | Type | Description | Default value |
| :--------------------------------------- | :------- | :-------------------------------------------------------------------- | :------------ |
| `max_lateral_accel` | `double` | Max lateral acceleration limit [m/ss] | 2.94 |
| `lateral_error_threshold` | `double` | Lateral error threshold where applying velocity limit [m/s] | 5.0 |
| `yaw_error_threshold` | `double` | Yaw error threshold where applying velocity limit [rad] | 0.5 |
| `velocity_limit_by_tracking_error` | `double` | Velocity limit applied when tracking error exceeds threshold [m/s] | 2.0 |
| `mov_ave_window` | `int` | Moving average smoothing window size | 50 |
| `target_longitudinal_velocity` | `double` | Target longitudinal velocity [m/s] | 6.0 |
| `longitudinal_velocity_noise_amp` | `double` | Target longitudinal velocity additional sine noise amplitude [m/s] | 0.1 |
| `longitudinal_velocity_noise_min_period` | `double` | Target longitudinal velocity additional sine noise minimum period [s] | 5.0 |
| `longitudinal_velocity_noise_max_period` | `double` | Target longitudinal velocity additional sine noise maximum period [s] | 20.0 |

ROS 2 params in `/data_collecting_pure_pursuit_trajectory_follower` node:

| Name | Type | Description | Default value |
| :--------------------------------------- | :------- | :------------------------------------------------------------- | :------------ |
| `pure_pursuit_type` | `string` | Pure pursuit type (`naive` or `linearized` steer control law ) | `linearized` |
| `wheel_base` | `double` | Wheel base [m] | 2.79 |
| `acc_kp` | `double` | Accel command proportional gain | 0.5 |
| `lookahead_time` | `double` | Pure pursuit lookahead time [s] | 1.5 |
| `min_lookahead` | `double` | Pure pursuit minimum lookahead length [m] | 3.0 |
| `linearized_pure_pursuit_steer_kp_param` | `double` | Linearized pure pursuit steering P gain parameter | 2.0 |
| `linearized_pure_pursuit_steer_kd_param` | `double` | Linearized pure pursuit steering D gain parameter | 2.0 |
| `stop_acc` | `double` | Accel command for stopping data collecting driving [m/ss] | -2.0 |
| `stop_jerk_lim` | `double` | Jerk limit for stopping data collecting driving [m/sss] | 1.0 |
| `lon_acc_lim` | `double` | Longitudinal acceleration limit [m/ss] | 5.0 |
| `lon_jerk_lim` | `double` | Longitudinal jerk limit [m/sss] | 5.0 |
| `steer_lim` | `double` | Steering angle limit [rad] | 1.0 |
| `steer_rate_lim` | `double` | Steering angle rate limit [rad/s] | 1.0 |
| `acc_noise_amp` | `double` | Accel command additional sine noise amplitude [m/ss] | 0.01 |
| `acc_noise_min_period` | `double` | Accel command additional sine noise minimum period [s] | 5.0 |
| `acc_noise_max_period` | `double` | Accel command additional sine noise maximum period [s] | 20.0 |
| `steer_noise_amp` | `double` | Steer command additional sine noise amplitude [rad] | 0.01 |
| `steer_noise_max_period` | `double` | Steer command additional sine noise maximum period [s] | 5.0 |
| `steer_noise_min_period` | `double` | Steer command additional sine noise minimum period [s] | 20.0 |
Original file line number Diff line number Diff line change
@@ -0,0 +1,42 @@
#!/usr/bin/env python3

# Copyright 2020 Proxima Technology Inc, Tier IV Inc. All rights reserved.
#
# Licensed under the Apache License, Version 2.0 (the "License");
# you may not use this file except in compliance with the License.
# You may obtain a copy of the License at
#
# http://www.apache.org/licenses/LICENSE-2.0
#
# Unless required by applicable law or agreed to in writing, software
# distributed under the License is distributed on an "AS IS" BASIS,
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
# See the License for the specific language governing permissions and
# limitations under the License.

import launch
from launch import LaunchService
from launch_ros.actions import Node


def generate_launch_description():
return launch.LaunchDescription(
[
Node(
package="control_data_collecting_tool",
executable="data_collecting_pure_pursuit_trajectory_follower.py",
name="data_collecting_pure_pursuit_trajectory_follower",
),
Node(
package="control_data_collecting_tool",
executable="data_collecting_trajectory_publisher.py",
name="data_collecting_trajectory_publisher",
),
]
)


if __name__ == "__main__":
ls = LaunchService()
ls.include_launch_description(generate_launch_description())
ls.run()
34 changes: 34 additions & 0 deletions control_data_collecting_tool/package.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,34 @@
<?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>control_data_collecting_tool</name>
<version>1.0.0</version>
<description>The pure pursuit control data collection tool package</description>
<maintainer email="[email protected]">Masayuki Aino</maintainer>
<maintainer email="[email protected]">Asei Inoue</maintainer>
<maintainer email="[email protected]">Toru Hishinuma</maintainer>
<maintainer email="[email protected]">Kosuke Takeuchi</maintainer>
<maintainer email="[email protected]">Takamasa Horibe</maintainer>
<maintainer email="[email protected]">Takayuki Murooka</maintainer>
<license>Apache License 2.0</license>

<buildtool_depend>ament_cmake_auto</buildtool_depend>
<buildtool_depend>autoware_cmake</buildtool_depend>

<depend>autoware_adapi_v1_msgs</depend>
<depend>autoware_control_msgs</depend>
<depend>autoware_planning_msgs</depend>
<depend>nav_msgs</depend>
<depend>python3-scipy</depend>
<depend>rviz_common</depend>
<depend>rviz_default_plugins</depend>

<test_depend>ament_index_python</test_depend>
<test_depend>ament_lint_auto</test_depend>
<test_depend>autoware_lint_common</test_depend>

<export>
<build_type>ament_cmake</build_type>
<rviz plugin="${prefix}/plugins/plugin_description.xml"/>
</export>
</package>
6 changes: 6 additions & 0 deletions control_data_collecting_tool/plugins/plugin_description.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,6 @@
<library path="control_data_collecting_tool">
<class name="rviz_plugins/DataCollectingAreaSelectionTool"
type="rviz_plugins::DataCollectingAreaSelectionTool"
base_class_type="rviz_common::Tool">
</class>
</library>
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Binary file added control_data_collecting_tool/resource/demo.gif
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Loading
Sorry, something went wrong. Reload?
Sorry, we cannot display this file.
Sorry, this file is invalid so it cannot be displayed.
Empty file.
Loading

0 comments on commit 2814932

Please sign in to comment.