Skip to content

Commit

Permalink
chore(rviz_plugin): move peripheral rviz plugin (#27)
Browse files Browse the repository at this point in the history
* 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]>
  • Loading branch information
1 parent 2c80e30 commit 22fbdfc
Show file tree
Hide file tree
Showing 98 changed files with 6,845 additions and 0 deletions.
23 changes: 23 additions & 0 deletions common/mission_planner_rviz_plugin/CMakeLists.txt
Original file line number Diff line number Diff line change
@@ -0,0 +1,23 @@
cmake_minimum_required(VERSION 3.14)
project(mission_planner_rviz_plugin)

find_package(autoware_cmake REQUIRED)
autoware_package()

find_package(Qt5 REQUIRED Core Widgets)
set(QT_LIBRARIES Qt5::Widgets)
set(CMAKE_AUTOMOC ON)
set(CMAKE_INCLUDE_CURRENT_DIR ON)

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

target_link_libraries(${PROJECT_NAME}
${QT_LIBRARIES}
)

pluginlib_export_plugin_description_file(rviz_common plugins/plugin_description.xml)

ament_auto_package()
18 changes: 18 additions & 0 deletions common/mission_planner_rviz_plugin/README.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,18 @@
# mission_planner_rviz_plugin

## MrmGoalTool

This is a copy of `rviz_default_plugins::tools::GoalTool`. Used together with the RouteSelectorPanel to set the MRM route.
After adding the tool, change the topic name to `/rviz/route_selector/mrm/goal` from the topic property panel in rviz.

## RouteSelectorPanel

This panel shows the main and mrm route state in the route_selector and the route states in the mission_planner.
Additionally, it provides clear and set functions for each main route and mrm route.

| Trigger | Action |
| -------------------------------------- | ------------------------------------------------------------------------ |
| main route clear button | call `/planning/mission_planning/route_selector/main/clear_route` |
| mrm route clear button | call `/planning/mission_planning/route_selector/mrm/clear_route` |
| `/rviz/route_selector/main/goal` topic | call `/planning/mission_planning/route_selector/main/set_waypoint_route` |
| `/rviz/route_selector/mrm/goal` topic | call `/planning/mission_planning/route_selector/mrm/set_waypoint_route` |
29 changes: 29 additions & 0 deletions common/mission_planner_rviz_plugin/package.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,29 @@
<?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>mission_planner_rviz_plugin</name>
<version>0.0.0</version>
<description>The mission_planner_rviz_plugin package</description>
<maintainer email="[email protected]">Takagi, Isamu</maintainer>
<license>Apache License 2.0</license>

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

<depend>geometry_msgs</depend>
<depend>libqt5-core</depend>
<depend>libqt5-gui</depend>
<depend>libqt5-widgets</depend>
<depend>rclcpp</depend>
<depend>rviz_common</depend>
<depend>rviz_default_plugins</depend>
<depend>tier4_planning_msgs</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>
Original file line number Diff line number Diff line change
@@ -0,0 +1,8 @@
<library path="mission_planner_rviz_plugin">
<class type="rviz_plugins::MrmGoalTool" base_class_type="rviz_common::Tool">
<description>MrmGoalTool</description>
</class>
<class type="rviz_plugins::RouteSelectorPanel" base_class_type="rviz_common::Panel">
<description>RouteSelectorPanel</description>
</class>
</library>
34 changes: 34 additions & 0 deletions common/mission_planner_rviz_plugin/src/mrm_goal.cpp
Original file line number Diff line number Diff line change
@@ -0,0 +1,34 @@
// Copyright 2024 The Autoware Contributors
//
// 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.

#include "mrm_goal.hpp"

namespace rviz_plugins
{

MrmGoalTool::MrmGoalTool()
{
shortcut_key_ = 'm';
}

void MrmGoalTool::onInitialize()
{
GoalTool::onInitialize();
setName("MRM Goal Pose");
}

} // namespace rviz_plugins

#include <pluginlib/class_list_macros.hpp>
PLUGINLIB_EXPORT_CLASS(rviz_plugins::MrmGoalTool, rviz_common::Tool)
34 changes: 34 additions & 0 deletions common/mission_planner_rviz_plugin/src/mrm_goal.hpp
Original file line number Diff line number Diff line change
@@ -0,0 +1,34 @@
// Copyright 2024 The Autoware Contributors
//
// 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.

#ifndef MRM_GOAL_HPP_
#define MRM_GOAL_HPP_

#include <rviz_default_plugins/tools/goal_pose/goal_tool.hpp>

namespace rviz_plugins
{

class MrmGoalTool : public rviz_default_plugins::tools::GoalTool
{
Q_OBJECT

public:
MrmGoalTool();
void onInitialize() override;
};

} // namespace rviz_plugins

#endif // MRM_GOAL_HPP_
148 changes: 148 additions & 0 deletions common/mission_planner_rviz_plugin/src/route_selector_panel.cpp
Original file line number Diff line number Diff line change
@@ -0,0 +1,148 @@
// Copyright 2024 The Autoware Contributors
//
// 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.

#include "route_selector_panel.hpp"

#include <QGridLayout>
#include <rviz_common/display_context.hpp>

#include <memory>
#include <string>

namespace rviz_plugins
{

QString to_string_state(const RouteState & state)
{
// clang-format off
switch (state.state) {
case RouteState::UNKNOWN: return "unknown";
case RouteState::INITIALIZING: return "initializing";
case RouteState::UNSET: return "unset";
case RouteState::ROUTING: return "routing";
case RouteState::SET: return "set";
case RouteState::REROUTING: return "rerouting";
case RouteState::ARRIVED: return "arrived";
case RouteState::ABORTED: return "aborted";
case RouteState::INTERRUPTED: return "interrupted";
default: return "-----";
}
// clang-format on
}

RouteSelectorPanel::RouteSelectorPanel(QWidget * parent) : rviz_common::Panel(parent)
{
main_state_ = new QLabel("unknown");
main_clear_ = new QPushButton("clear");
mrm_state_ = new QLabel("unknown");
mrm_clear_ = new QPushButton("clear");
planner_state_ = new QLabel("unknown");

connect(main_clear_, &QPushButton::clicked, this, &RouteSelectorPanel::onMainClear);
connect(mrm_clear_, &QPushButton::clicked, this, &RouteSelectorPanel::onMrmClear);

const auto layout = new QGridLayout();
setLayout(layout);
layout->addWidget(new QLabel("main"), 0, 0);
layout->addWidget(main_state_, 0, 1);
layout->addWidget(main_clear_, 0, 2);
layout->addWidget(new QLabel("mrm"), 1, 0);
layout->addWidget(mrm_state_, 1, 1);
layout->addWidget(mrm_clear_, 1, 2);
layout->addWidget(new QLabel("planner"), 2, 0);
layout->addWidget(planner_state_, 2, 1);
}

void RouteSelectorPanel::onInitialize()
{
auto lock = getDisplayContext()->getRosNodeAbstraction().lock();
auto node = lock->get_raw_node();

const auto durable_qos = rclcpp::QoS(1).transient_local();

sub_main_goal_ = node->create_subscription<PoseStamped>(
"/rviz/route_selector/main/goal", rclcpp::QoS(1),
std::bind(&RouteSelectorPanel::onMainGoal, this, std::placeholders::_1));
sub_mrm_goal_ = node->create_subscription<PoseStamped>(
"/rviz/route_selector/mrm/goal", rclcpp::QoS(1),
std::bind(&RouteSelectorPanel::onMrmGoal, this, std::placeholders::_1));
sub_main_state_ = node->create_subscription<RouteState>(
"/planning/mission_planning/route_selector/main/state", durable_qos,
std::bind(&RouteSelectorPanel::onMainState, this, std::placeholders::_1));
sub_mrm_state_ = node->create_subscription<RouteState>(
"/planning/mission_planning/route_selector/mrm/state", durable_qos,
std::bind(&RouteSelectorPanel::onMrmState, this, std::placeholders::_1));
sub_planner_state_ = node->create_subscription<RouteState>(
"/planning/mission_planning/state", durable_qos,
std::bind(&RouteSelectorPanel::onPlannerState, this, std::placeholders::_1));

cli_main_clear_ =
node->create_client<ClearRoute>("/planning/mission_planning/route_selector/main/clear_route");
cli_mrm_clear_ =
node->create_client<ClearRoute>("/planning/mission_planning/route_selector/mrm/clear_route");
cli_main_set_waypoint_ = node->create_client<SetWaypointRoute>(
"/planning/mission_planning/route_selector/main/set_waypoint_route");
cli_mrm_set_waypoint_ = node->create_client<SetWaypointRoute>(
"/planning/mission_planning/route_selector/mrm/set_waypoint_route");
}

void RouteSelectorPanel::onMainGoal(const PoseStamped::ConstSharedPtr msg)
{
const auto req = std::make_shared<SetWaypointRoute::Request>();
req->header = msg->header;
req->goal_pose = msg->pose;
req->allow_modification = true;
cli_main_set_waypoint_->async_send_request(req);
}

void RouteSelectorPanel::onMrmGoal(const PoseStamped::ConstSharedPtr msg)
{
const auto req = std::make_shared<SetWaypointRoute::Request>();
req->header = msg->header;
req->goal_pose = msg->pose;
req->allow_modification = true;
cli_mrm_set_waypoint_->async_send_request(req);
}

void RouteSelectorPanel::onMainState(RouteState::ConstSharedPtr msg)
{
main_state_->setText(to_string_state(*msg));
}

void RouteSelectorPanel::onMrmState(RouteState::ConstSharedPtr msg)
{
mrm_state_->setText(to_string_state(*msg));
}

void RouteSelectorPanel::onPlannerState(RouteState::ConstSharedPtr msg)
{
planner_state_->setText(to_string_state(*msg));
}

void RouteSelectorPanel::onMainClear()
{
const auto req = std::make_shared<ClearRoute::Request>();
cli_main_clear_->async_send_request(req);
}

void RouteSelectorPanel::onMrmClear()
{
const auto req = std::make_shared<ClearRoute::Request>();
cli_mrm_clear_->async_send_request(req);
}

} // namespace rviz_plugins

#include <pluginlib/class_list_macros.hpp>
PLUGINLIB_EXPORT_CLASS(rviz_plugins::RouteSelectorPanel, rviz_common::Panel)
75 changes: 75 additions & 0 deletions common/mission_planner_rviz_plugin/src/route_selector_panel.hpp
Original file line number Diff line number Diff line change
@@ -0,0 +1,75 @@
// Copyright 2024 The Autoware Contributors
//
// 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.

#ifndef ROUTE_SELECTOR_PANEL_HPP_
#define ROUTE_SELECTOR_PANEL_HPP_

#include <QLabel>
#include <QPushButton>
#include <rclcpp/rclcpp.hpp>
#include <rviz_common/panel.hpp>

#include <geometry_msgs/msg/pose_stamped.hpp>
#include <tier4_planning_msgs/msg/route_state.hpp>
#include <tier4_planning_msgs/srv/clear_route.hpp>
#include <tier4_planning_msgs/srv/set_waypoint_route.hpp>

namespace rviz_plugins
{

using geometry_msgs::msg::PoseStamped;
using tier4_planning_msgs::msg::RouteState;
using tier4_planning_msgs::srv::ClearRoute;
using tier4_planning_msgs::srv::SetWaypointRoute;

class RouteSelectorPanel : public rviz_common::Panel
{
Q_OBJECT

public:
explicit RouteSelectorPanel(QWidget * parent = nullptr);
void onInitialize() override;

private:
QLabel * main_state_;
QLabel * mrm_state_;
QLabel * planner_state_;
QPushButton * main_clear_;
QPushButton * mrm_clear_;

rclcpp::Subscription<PoseStamped>::SharedPtr sub_main_goal_;
rclcpp::Subscription<PoseStamped>::SharedPtr sub_mrm_goal_;
void onMainGoal(const PoseStamped::ConstSharedPtr msg);
void onMrmGoal(const PoseStamped::ConstSharedPtr msg);

rclcpp::Subscription<RouteState>::SharedPtr sub_main_state_;
rclcpp::Subscription<RouteState>::SharedPtr sub_mrm_state_;
rclcpp::Subscription<RouteState>::SharedPtr sub_planner_state_;
void onMainState(RouteState::ConstSharedPtr msg);
void onMrmState(RouteState::ConstSharedPtr msg);
void onPlannerState(RouteState::ConstSharedPtr msg);

rclcpp::Client<ClearRoute>::SharedPtr cli_main_clear_;
rclcpp::Client<ClearRoute>::SharedPtr cli_mrm_clear_;
rclcpp::Client<SetWaypointRoute>::SharedPtr cli_main_set_waypoint_;
rclcpp::Client<SetWaypointRoute>::SharedPtr cli_mrm_set_waypoint_;

private Q_SLOTS:
void onMainClear();
void onMrmClear();
};

} // namespace rviz_plugins

#endif // ROUTE_SELECTOR_PANEL_HPP_
Loading

0 comments on commit 22fbdfc

Please sign in to comment.