feat(tier4_planning_rviz_plugins): add vehicle_info to Footprint Displays #712

kenji-miyake · 2022-04-16T08:54:47Z

Description

Resolves #710

Pre-review checklist for the PR author

The PR author must check the checkboxes below when creating the PR.

I've confirmed the contribution guidelines.
The PR follows the pull request guidelines.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

The PR follows the pull request guidelines.

Post-review checklist for the PR author

The PR author must check the checkboxes below before merging.

There are no open discussions or they are tracked via tickets.

After all checkboxes are checked, anyone who has write access can merge the PR.

kenji-miyake · 2022-04-16T08:55:11Z

@takayuki5168 Could you update the code as you like?

kenji-miyake · 2022-04-16T08:56:49Z

If you launch RViz separately from Autoware, you have to prepare a launch file that will load Autoware's global parameters and run RViz.

codecov · 2022-04-16T09:03:51Z

Codecov Report

Merging #712 (c913b46) into main (ae8422b) will decrease coverage by 0.01%.
The diff coverage is 0.00%.

@@           Coverage Diff            @@
##            main    #712      +/-   ##
========================================
- Coverage   9.64%   9.62%   -0.02%     
========================================
  Files        907     907              
  Lines      56518   56623     +105     
  Branches    6694    6694              
========================================
  Hits        5450    5450              
- Misses     46573   46678     +105     
  Partials    4495    4495

Flag	Coverage Δ		*Carryforward flag
differential	`0.00% <0.00%> (?)`
total	`9.64% <0.00%> (ø)`		Carriedforward from 5d278dd

*This pull request uses carry forward flags. Click here to find out more.

Impacted Files	Coverage Δ
...ing_rviz_plugin/include/path_footprint/display.hpp	`0.00% <ø> (ø)`
...in/include/path_with_lane_id_footprint/display.hpp	`0.00% <ø> (ø)`
...iz_plugin/include/trajectory_footprint/display.hpp	`0.00% <ø> (ø)`
...lanning_rviz_plugin/src/path_footprint/display.cpp	`0.00% <0.00%> (ø)`
...plugin/src/path_with_lane_id_footprint/display.cpp	`0.00% <0.00%> (ø)`
...g_rviz_plugin/src/trajectory_footprint/display.cpp	`0.00% <0.00%> (ø)`
... and 2 more

Continue to review full report at Codecov.

Legend - Click here to learn more
Δ = absolute <relative> (impact), ø = not affected, ? = missing data
Powered by Codecov. Last update ae8422b...c913b46. Read the comment docs.

takayuki5168 · 2022-04-17T02:52:36Z

Ah now I think I got it.
I understand that in rviz plugin we just get vehicle parameters via the rviz ros node if we launch the plugin with autoware.

I'll update this PR. Thank you so much!

* Initial commit * release v0.4.0 * Feature/stop reason (autowarefoundation#712) * add stop reason msg * add mock of stop resaon publisher * change namespace of stop reason * update stop reason msg * add toRosPoint * implement stop reason publisher of blind stop * implement stop reason publisher of crosswalk * implement stop reason publisher of intersection * implement stop reason publisher of stop line * implement stop reason publisher of trafficlight * implement stop reason publisher of detection area * fix bug * remove unnecessary process * add remained stop factor * clean code * fix bug * not punlish stop reason if array size is 0 * add stop reason to stuck object in intersection * add stop factor of obstacle stop planner * add stop reason of surround_obstacle checker * Apply review Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix message type * delete unused message from cmake * remove stopReasonStamped * change topic name of stop reasons Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Support error in autoware state (autowarefoundation#728) * Support Error in autoware_state_monitor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor autoware_state_monitor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Wait after planning completed Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Integrate FailedToArriveGoal and Error into Emergency state Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Publish tl states stamped (autowarefoundation#744) * Add TrafficLightStateStamped.msg Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use msg instead of struct Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Publish traffic light state Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Check if lamp state is empty Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Apply clang-format Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Cosmetic change Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Revert "Publish tl states stamped (autowarefoundation#744)" (autowarefoundation#771) This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753. * Fix/publish tl state stamped (autowarefoundation#772) * Publish tl states stamped (autowarefoundation#744) * Add TrafficLightStateStamped.msg Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use msg instead of struct Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Publish traffic light state Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Check if lamp state is empty Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Apply clang-format Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Cosmetic change Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Use dynamic pointer cast Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Feature/add stop reason lane change (autowarefoundation#769) * add stop reason of lane change planner * add stop factor of blocked by obstacle * delete typo * add const * delete unnecessary namespace * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add sample ros2 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add ros2 perception msgs Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix dependency issue in autoware_control_msgs (autowarefoundation#22) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Port vehicle_cmd_gate to ROS2 (#3) * Port vehicle_cmd_gate to ROS2 * Sim-time-respecting timer * add autoware_debug_msg (autowarefoundation#54) * add autoware_debug_msg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * rename to *stamped Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix format version (autowarefoundation#73) * port motion_velocity_optimizer (autowarefoundation#77) * port motion_velocity_optimizer Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix for warning Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix blockUntilVehiclePositionAvailable() Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Port of obstacle avoidance planner to ROS2 (autowarefoundation#83) * Port to ROS2 Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed ros/console include Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added THROTTLE Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Changed numbers to floats Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed <double> from params Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Use new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Replaced dynamic reconfigure Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added EnableAvoidance.msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Fixed parameter mismatch Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Port behavior_velocity_planner to ROS2 (autowarefoundation#80) * Revert "Add geometry2 to repos (autowarefoundation#76)" This reverts commit 6d22704. * Automatic parts of the package port * Interesting part * Fix typo in package.xml * Review comments * Child logger names * Document logging duration Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> * Ros2 v0.8.0 awapi and system msgs (autowarefoundation#274) * Ros2 v0.8.0 engage (autowarefoundation#342) * [autoware_vehicle_msgs]: Add engage message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [as]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [awapi_awiv_adapter]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [web_controller]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [vehicle_cmd_gate]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_state_monitor]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_control_msgs]: Remove EngageMode message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [simple_planning_simulator]: Update message Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Ros2 v0.8.0 lane_change_planner (autowarefoundation#322) * Remove lane_change_planner v0.5 Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Import lane_change_planner v0.8 (ROS1) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Modify header files * Remove header disable * Modify msg namespace * Modify time type * Modify pub/sub class * Modify node handle, etc. * Modify ConstPtr * Modify entry point * Modify time and publisher * Modify parameter, timer, and subscription * Modify data manager * Modify route handler * Modify state machine * Modify utility * Fix arguments * Modify states part1 * Modify states part2 * Modify common function * Fix for lint * Fix for lint * Modify comment type * Add copyright * Use duration from_seconds * Use double quotes for non-system headers * Fix include order Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Replace std_msgs Bool Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix line length Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix latch topic subscription Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix stamp initialization and reference Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add super class destructor and fix waitForData Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Ros2 v0.8.0 remove std msgs awapi (autowarefoundation#348) * [autoware_vehicle_msgs] add BatteryStatus msg Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_planning_msgs] add ExpandStopRange and StopSpeedExceeded messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_api_msgs] add DoorControlCommand, StopCommand, and VelocityLimit messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * remove std_msgs related to autoware_awaiv_adapter node Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * apply ament_uncrustify Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix build failure Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix test failures Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * address review commends Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Sync with Ros2 v0.8.0 beta (autowarefoundation#393) * add nullptr check when publish concatenate data (autowarefoundation#369) * Add warning msg when concat pointcloud is not published (autowarefoundation#388) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add timeout notification stamp msgs (autowarefoundation#363) * add timeout notification stamp msgs * fix uncursify * delete timeout notification stamped * Revert "delete timeout notification stamped" This reverts commit 365d29209f6a7f5ec75eb80c5d8c2ef38daeae79. * fix message Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * modify pose_initialize for foa (autowarefoundation#382) * pose_initialize for foa (autowarefoundation#1171) * pose_initialize for foa Signed-off-by: Yamato ANDO <yamato.ando@gmail.com> * rename topic Signed-off-by: Yamato ANDO <yamato.ando@gmail.com> * fix topic name Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add autoware version node (autowarefoundation#394) * Add autoware version node Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Remove todo Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Remove unused variable Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix node name Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix typo (autowarefoundation#427) * Fix typo in common module (autowarefoundation#433) * Unify Apache-2.0 license name (autowarefoundation#1242) * Porting remote cmd selector (autowarefoundation#1286) * Feature/add remote cmd selector (autowarefoundation#1179) * Add in/out args of remote_cmd_converter.launch Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change remote input topic of vehicle_cmd_gate Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add msgs for remote_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add remote_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename remote_cmd_selector to external_cmd_selector Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove VehicleCommand support in autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Support external_cmd_source in autoware_joy_controller.launch (autowarefoundation#1194) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix porting miss Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix missing function * modify xml format * fix include guard * add callback group * modify remap name * Revert "modify remap name" This reverts commit 169cc8d28442825b1d61b0439b9892c913304527. * change topic name * use rclcpp_component * Remove autoware_debug_msgs from autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change default mode of autoware_joy_controller Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add perception traffic light state output (autowarefoundation#1302) * Add perception traffic light state output Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Modify message type Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Apply message type to relay Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix msgs (autowarefoundation#1379) * Fix msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * [autoware_planning_rviz_plugin]: Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Message refinement (autowarefoundation#1381) * Message refinement * Simplify CMakeLists.txt with ament cmake auto * Add test Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autoware_planning_msgs]: Fix dependency Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix ament_cmake_auto Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ros2/create/external commands (autowarefoundation#1299) * add remote message * add remote commands * fix topic * remove unnecessary topic * remove unused topic * add external cmd instead * ToExternalComd * fix topic in joy con * publish perception and external tl_state for mlops (autowarefoundation#1350) (autowarefoundation#1375) * publish perception and external tl_state for mlops * fix tl_state time stamp Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Add newlines Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add PR template (#3) * Add PR template Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update PULL_REQUEST_TEMPLATE.md * Add CI (#4) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * change msg type looking traffic light state (autowarefoundation#1455) (#6) * change msg type looking traffic light state * fix msg name * using namespace * change function name * fix typo * add readme * Update awapi/awapi_awiv_adapter/Readme.md fix typo Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Fix dependency type of rosidl_default_generators (autowarefoundation#15) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add auto-main-sync CI workflow for develop (autowarefoundation#16) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add autoware_api_msgs (autowarefoundation#12) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Feature/add virtual traffic light planner (autowarefoundation#9) * Add VIRTUAL_TRAFFIC_LIGHT to StopReason.msg Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add VirtualTrafficLightState msgs to autoware_system_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add InfrastructureCommand msgs to autoware_planning_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Move messages to autoware_v2x_msgs Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix dependency type of rosidl_default_generators Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix dependency type of rosidl_default_generators (autowarefoundation#19) * Change CI docker images to setup-ros-docker (autowarefoundation#20) * Change CI docker images to setup-ros-docker Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Replace foxy with galactic Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add DEBIAN_FRONTEND=noninteractive to rosdep install (autowarefoundation#21) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update colcon-package-selection in build_and_test_pr.yml (autowarefoundation#22) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add autoware_simulation_msgs (autowarefoundation#13) * add autoware_simulation_msgs * update event name * Add autoware api (autowarefoundation#29) * add autoware multimedia msgs Signed-off-by: tkhmy <tkh.my.p@gmail.com> * add newline Signed-off-by: tkhmy <tkh.my.p@gmail.com> * change name to autoware_hmi_msgs Signed-off-by: tkhmy <tkh.my.p@gmail.com> * Rename external select message (#8) * Rename external select message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add selector mode to unknown Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix selector mode constant Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix format Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Move control command messages to external api Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Add build dependency Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix CI Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Co-authored-by: tkhmy <tkh.my.p@gmail.com> * Fix CI for develop branch (autowarefoundation#31) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add emergency_holding flag to HazardStatus (autowarefoundation#25) * add EmergencyState.msg (autowarefoundation#32) * Add new workflow `sync-public.yaml` to sync with `AutowareArchitectureProposal_msgs` (autowarefoundation#35) * Add new workflow `sync-public.yaml` to sync with `AutowareArchitectureProposal_msgs` * Remove this workflow specific comments * Remove some this workflow specific comments * Rename `oss` to `public` * Replace branch name `main` to more generic description * Add line `fetch-depth: 0` (autowarefoundation#36) * Add EmergencyStateStamped.msg (autowarefoundation#38) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add sync-public-develop.yaml (autowarefoundation#42) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Change proposal sync app ID (autowarefoundation#44) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add MultiArrayDimension/Layout, and update MultiArrayMsgs (autowarefoundation#28) * add MultiArrayDimension/Layout, and update MultiArrayMsgs * add kind of license * Feature/vehicle interface improvements (autowarefoundation#1361) (autowarefoundation#48) * add vehicle msg * add pacmod interface * add eps controller * use each control commands instead of vehicle command * fixed details * fixed speell check * const * fixed brake status * publish cmd when recieving ctrl cmd * fix shift cmd ptr * remove unused function and set proper license * fix names * fix typo for pacmod * remove unnecessary waiting * use flags, limit, multiarray * remove accel brake dependency * fix retrun value * replace eps to steer * cosmetic change for namespace * fix segfo and retval * Use Enum instead of int * remove unused var * add const * rename to calcFFMap * prev time steer calc * add sample csv * add new line Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * remove EmergencyMode and DricingCapability (autowarefoundation#33) * develop -> main sync (autowarefoundation#53) * Add detected object with feature (autowarefoundation#54) * Add detected object with feature Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add autoware_auto_msgs Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Revert "Add detected object with feature (autowarefoundation#54)" (autowarefoundation#57) This reverts commit 3fcfe9936361928256ed5ffa7d8a1ef4c978ca09. * Add detected object with feature (autowarefoundation#54) (autowarefoundation#59) (#4) * Add detected object with feature (autowarefoundation#54) (autowarefoundation#59) * Add detected object with feature Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add autoware_auto_msgs Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * update build depends Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add message converter (autowarefoundation#58) * Add message converter * Move autoware state converter * add VehicleEmergency (autowarefoundation#55) * Add two convert method (autowarefoundation#64) * add convert method from iv_shift to auto_gear Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * remove space Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * add convert method from for turn & hazard signal Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * fix dependency of iv_auto_msgs converter (#8) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * move actuation msg (autowarefoundation#66) * Revert "move actuation msg (autowarefoundation#66)" This reverts commit d8e3ccdcabacab819360cf399442950cc162a648. * merge autoware_localization_srvs to autoware_localization_msgs * rename pose_with_cov to pose_with_covariance * add steering wheel status stamped * fix: remove workflow and PR_TEMPLATE * fix: remove autoware_api_msgs dependency * ci(pre-commit): autofix Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: Nikolai Morin <nnmmgit@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Esteve Fernandez <esteve@apache.org> Co-authored-by: Servando <43142004+sgermanserrano@users.noreply.github.com> Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: Shigeki Kobayashi <32808802+sgk-000@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Keisuke Shima <keisuke.shima@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: tkhmy <tkh.my.p@gmail.com> Co-authored-by: Tatsuya Yamasaki <httperror@404-notfound.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Kah Hooi Tan <41041286+tkhmy@users.noreply.github.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: tanaka3 <ttatcoder@outlook.jp> Co-authored-by: YamatoAndo <yamato.ando@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* release v0.4.0 * fix bug(return true in getPose) (autowarefoundation#686) * Feature/stop reason (autowarefoundation#712) * add stop reason msg * add mock of stop resaon publisher * change namespace of stop reason * update stop reason msg * add toRosPoint * implement stop reason publisher of blind stop * implement stop reason publisher of crosswalk * implement stop reason publisher of intersection * implement stop reason publisher of stop line * implement stop reason publisher of trafficlight * implement stop reason publisher of detection area * fix bug * remove unnecessary process * add remained stop factor * clean code * fix bug * not punlish stop reason if array size is 0 * add stop reason to stuck object in intersection * add stop factor of obstacle stop planner * add stop reason of surround_obstacle checker * Apply review Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix message type * delete unused message from cmake * remove stopReasonStamped * change topic name of stop reasons Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix/stop reason (autowarefoundation#724) * input stop reason of traffic light * add comment * add empty traffic light handling * change calculation method of traffic light position * avoid 0 position output * Add surround obstacle state (autowarefoundation#785) * Cleanup code Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add state to surround_obstacle_checker Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Guard pushObstaclePoint for StopFactor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Revert "remove ROS1 packages temporarily" This reverts commit 623dc7f7b59bb12639c5ca768f87b8e2d24c19b7. Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add COLCON_IGNORE to ros1 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Rename launch files to launch.xml (autowarefoundation#28) * Surround obstacle checker (autowarefoundation#64) * Port surround_obstacle_checker to ROS2 * Reviewer comment * Review comment * Fix launch files (autowarefoundation#122) * [surround_obstacle_checker] add parameter and arguments to launch file Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [obstacle_stop_planner] modify launch file to remap trajectory from argument Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [obstacle_avoidance_planner] modify launch file to remap topics from arguments Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [motion_velocity_optimizer] modify launch file to enable remapping from argument Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Convert calls of Duration to Duration::from_seconds where appropriate (autowarefoundation#131) * Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143) * Use quotes for includes where appropriate (autowarefoundation#144) * Use quotes for includes where appropriate * Fix lint tests * Make tests pass hopefully * Fix lints in surround_obstacle_checker package (autowarefoundation#130) * Replace waitForTransform by lookupTransform in surround_obstacle_checker (autowarefoundation#212) * Fix erroneous waitForTransform in surround_obstacle_checker * Line length fix * Ros2 v0.8.0 surround obstacle checker (autowarefoundation#328) * Rename ROS-related .yaml to .param.yaml (autowarefoundation#352) * Rename ROS-related .yaml to .param.yaml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove prefix 'default_' of yaml files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename vehicle_info.yaml to vehicle_info.param.yaml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename diagnostic_aggregator's param files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix overlooked parameters Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * rename vehicle_info_param to vehicle_param_file (autowarefoundation#353) Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * Sensor data qos (autowarefoundation#407) * Use sensor data qos for pointcloud preprocessor Signed-off-by: Autoware <autoware@tier4.jp> * Use sensor data qos for pointcloud Signed-off-by: Autoware <autoware@tier4.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use sensor data qos for livox tag filter and vector map filter Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Autoware <autoware@tier4.jp> * Ros2 fix topic name part1 (autowarefoundation#408) * Fix topic name of lane_departure_checker debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of mpc_follower debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of velocity_controller debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of motion_velocity_optimizer debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_change_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_avoidance_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of motion_velocity_optimizer Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_departure_checker Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of mpc_follower Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of velocity_controller Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_change_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_avoidance_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_stop_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of freespace_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of surround_obstacle_checker Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of emergency_handler Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint errors Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix typo Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * add use_sim-time option (autowarefoundation#454) * Fix rolling build errors (autowarefoundation#1225) * Add missing include files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Replace rclcpp::Duration Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Use reference for exceptions Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Use from_seconds Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Sync public repo (autowarefoundation#1228) * [simple_planning_simulator] add readme (autowarefoundation#424) * add readme of simple_planning_simulator Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update simulator/simple_planning_simulator/README.md * set transit_margin_time to intersect. planner (autowarefoundation#460) * Fix pose2twist (autowarefoundation#462) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Ros2 vehicle info param server (autowarefoundation#447) * add vehicle_info_param_server * update vehicle info * apply format * fix bug * skip unnecessary search * delete vehicle param file * fix bug * Ros2 fix topic name part2 (autowarefoundation#425) * Fix topic name of traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_visualization Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_map_based_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_recognition Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix issues in hdd_reader (autowarefoundation#466) * Fix some issues detected by Coverity Scan and Clang-Tidy * Update launch command * Add more `close(new_sock)` * Simplify the definitions of struct * fix: re-construct laneletMapLayer for reindex RTree (autowarefoundation#463) * Rviz overlay render fix (autowarefoundation#461) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * super class now back to MFD Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * uncrustified Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * acquire data in mutex Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * back to RTD as superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * Rviz overlay render in update (autowarefoundation#465) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * super class now back to MFD Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * uncrustified Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * acquire data in mutex Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * removed unnecessary includes and some dead code Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * restored RTD superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com> Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai> * Unify Apache-2.0 license name (autowarefoundation#1242) * Make planning modules components (autowarefoundation#1263) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Remove use_sim_time for set_parameter (autowarefoundation#1260) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Refactor vehicle info util (autowarefoundation#1305) * Update license Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor vehicle_info_util Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename and split files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix interfaces Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix bug and add error handling Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add "// namespace" Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add missing include Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wunused-parameter (autowarefoundation#1836) * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix spell * Fix lint issues Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore flake8 warnings Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> * Add surround_obstacle_checker document (autowarefoundation#1895) * Add surround_obstacle_checker document * Remove unnecessary unit * Fix stop condition * Fix japanese doc and add english doc * Fix typo * Add detail information Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * Fix figure files and explainations * Add known limits Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * add sort-package-xml hook in pre-commit (autowarefoundation#1881) * add sort xml hook in pre-commit * change retval to exit_status * rename * add prettier plugin-xml * use early return * add license note * add tier4 license * restore prettier * change license order * move local hooks to public repo * move prettier-xml to pre-commit-hooks-ros * update version for bug-fix * apply pre-commit * Change formatter to clang-format and black (autowarefoundation#2332) * Revert "Temporarily comment out pre-commit hooks" This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3. * Replace ament_lint_common with autoware_lint_common Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove ament_cmake_uncrustify and ament_clang_format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply Black Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply clang-format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix build errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix for cpplint * Fix include double quotes to angle brackets Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply clang-format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix build errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add COLCON_IGNORE (autowarefoundation#500) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * port surround obstacle checker (autowarefoundation#493) * change trajectory msg * change dynamicobject to predictedobject * run pre-commit * delete colcon ignore * deal with non polygon shape * replace twist with odometry * rename to README.md (autowarefoundation#550) * rename to README.md * dealt with new auto_msgs format Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * [apply_predicted_obj_type] adapt to autoware auto msgs (autowarefoundation#564) * fix obj shape * fix obj shape * fix goal pose * rename topic name twist -> odometry (autowarefoundation#568) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * update iv_msgs -> auto_msgs in planning readme (autowarefoundation#576) * update iv_msgs -> auto_msgs in planning readme * minor change * some fix * some fix Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * Auto/fix surround obstacle checker (autowarefoundation#684) * change trajectory to trajectorypoints in function * add header to output * use output_trajectory_points Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp> * Fix no ground pointcloud topic name (autowarefoundation#733) Signed-off-by: j4tfwm6z <proj-jpntaxi@tier4.jp> Co-authored-by: j4tfwm6z <proj-jpntaxi@tier4.jp> * fix/rename segmentation namespace (autowarefoundation#742) * rename segmentation directory * fix namespace: system stack * fix namespace: planning * fix namespace: control stack * fix namespace: perception stack * fix readme * ci(pre-commit): autofix Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Nikolai Morin <nnmmgit@gmail.com> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Autoware <autoware@tier4.jp> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com> Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: j4tfwm6z <proj-jpntaxi@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* release v0.4.0 * Feature/stop reason (autowarefoundation#712) * add stop reason msg * add mock of stop resaon publisher * change namespace of stop reason * update stop reason msg * add toRosPoint * implement stop reason publisher of blind stop * implement stop reason publisher of crosswalk * implement stop reason publisher of intersection * implement stop reason publisher of stop line * implement stop reason publisher of trafficlight * implement stop reason publisher of detection area * fix bug * remove unnecessary process * add remained stop factor * clean code * fix bug * not punlish stop reason if array size is 0 * add stop reason to stuck object in intersection * add stop factor of obstacle stop planner * add stop reason of surround_obstacle checker * Apply review Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix message type * delete unused message from cmake * remove stopReasonStamped * change topic name of stop reasons Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix/stop reason (autowarefoundation#724) * input stop reason of traffic light * add comment * add empty traffic light handling * change calculation method of traffic light position * avoid 0 position output * add debug values of adaptive cruise control (autowarefoundation#742) * add debug values of adaptive cruise control * add rqt config file * cosmetic change (autowarefoundation#738) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * Fix/acc same pointcloud (autowarefoundation#743) * add handling with same pointcloud * clean code * add obstacle_stop_planner.yaml (autowarefoundation#766) * add stop_planner.yaml * change file name * add explanation of the parameters * fix wrong start index (autowarefoundation#745) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * Feature/smooth adaptive cruise (autowarefoundation#789) * change param * do not insert max velocity near the ego vehicle position * Change min_slow_down_vel to 3kmph (autowarefoundation#796) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove duplicated param (autowarefoundation#797) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Feature/lowpass adaptive cruise control (autowarefoundation#802) * add lowpass filter * update xml * change the method of insert velocity * change parameter * change default lowpass gain in acc (autowarefoundation#820) * change default deceleration in acc * change lowpass gain * Reduce calc cost of slow down (#826) * Cosmetic change Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix rough search range Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add circle inside/outside judgement Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply clang Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix uninitialized variables (autowarefoundation#816) * Revert "Reduce calc cost of slow down (#826)" (autowarefoundation#832) This reverts commit 845ab7b1b90f8817c8fcb12880b5af6f78c2b183. * Reduce calc cost stop planner (autowarefoundation#833) * Reduce calc cost of slow down (#826) * Cosmetic change Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix rough search range Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add circle inside/outside judgement Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply clang Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Parameterize step length Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix search range Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Revert "remove ROS1 packages temporarily" This reverts commit dae63c141d17c2c7d0402ca2b9c5c1f008101631. Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add COLCON_IGNORE to ros1 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Rename launch files to launch.xml (autowarefoundation#28) * Port obstacle stop planner (autowarefoundation#86) * Port to ROS2 Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Use autoware_debug_msgs Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Fix variable name Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Fix launch files (autowarefoundation#122) * [surround_obstacle_checker] add parameter and arguments to launch file Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [obstacle_stop_planner] modify launch file to remap trajectory from argument Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [obstacle_avoidance_planner] modify launch file to remap topics from arguments Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [motion_velocity_optimizer] modify launch file to enable remapping from argument Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Convert calls of Duration to Duration::from_seconds where appropriate (autowarefoundation#131) * Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143) * Use quotes for includes where appropriate (autowarefoundation#144) * Use quotes for includes where appropriate * Fix lint tests * Make tests pass hopefully * Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151) * Run uncrustify on the entire Pilot.Auto codebase * Exclude open PRs * Added linters to obstacle_stop_planner (autowarefoundation#154) * Added linters to obstacle_stop_planner * Remove use of deprecated ConstPtr * Remove use of deprecated ::Ptr * Removed unused variables * Fix sign mismatches * Fix non-void returns * Fix cpplint error * Fix sign mismatching Co-authored-by: Jilada Eccleston <jilada.eccleston@tier4.jp> * Ros2 v0.8.0 obstacle stop planner (autowarefoundation#300) * rename before v0.8.0 update * Update default parameters of slow_down_planner (autowarefoundation#846) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix missing break (autowarefoundation#855) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix slow down param (autowarefoundation#871) * Fix typos in planning modules (autowarefoundation#866) * fix typos in planning * fix corresponding typos in planning * revert fixed typos temporarily due to its impact on launchers * enable to change acc_param file from arg (autowarefoundation#997) * Feature/refactor obstacle stop planner (autowarefoundation#1000) * devide functions * add StopPoint and SlowDownPoint structure * apply clang-format 6.0 * Feature/update adaptive cruise control (autowarefoundation#995) * avoid upper velocity chattering * add option to use rough velocity estimation * fix typo * apply format * fix comment * change min velocity by PID (autowarefoundation#1008) * Feature/obstacle stop after goal margin (autowarefoundation#957) * devide functions * add StopPoint and SlowDownPoint structure * apply clang-format 6.0 * add extend trajectory method * change extend_distance default value to 0.0 * does not insert when insert point over output_msg points size * fix acc limit (autowarefoundation#1015) * Feature/compensate lidar delay to acc (autowarefoundation#1032) * add compensation to calc dist * change compensation way * delete debug output * separate emerngecy stop param (autowarefoundation#1033) * improve accuracy of insert stop pose (autowarefoundation#1034) * add error handling (autowarefoundation#1037) * expand stop param (autowarefoundation#1068) * add param * add awapi topic Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp> * fix default param (autowarefoundation#1071) * Add expand_stop_range to obstacle_stop_planner.yaml (autowarefoundation#1084) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Revert "rename before v0.8.0 update" This reverts commit 395c529ee1a854db35ee4f4d517da2dfb401914c. * fix clock & restore include guard * fix code style * fix node * fix params * nest acc params Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Ros2 v0.8.0 remove std msgs awapi (autowarefoundation#348) * [autoware_vehicle_msgs] add BatteryStatus msg Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_planning_msgs] add ExpandStopRange and StopSpeedExceeded messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [autoware_api_msgs] add DoorControlCommand, StopCommand, and VelocityLimit messages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * remove std_msgs related to autoware_awaiv_adapter node Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * apply ament_uncrustify Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix build failure Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix test failures Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * address review commends Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Rename ROS-related .yaml to .param.yaml (autowarefoundation#352) * Rename ROS-related .yaml to .param.yaml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove prefix 'default_' of yaml files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename vehicle_info.yaml to vehicle_info.param.yaml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename diagnostic_aggregator's param files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix overlooked parameters Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix insert slow down point bug (autowarefoundation#1159) (autowarefoundation#376) * fix slow down insert slow down point bug * refactor code Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> * fix implement miss (autowarefoundation#409) * Sensor data qos (autowarefoundation#407) * Use sensor data qos for pointcloud preprocessor Signed-off-by: Autoware <autoware@tier4.jp> * Use sensor data qos for pointcloud Signed-off-by: Autoware <autoware@tier4.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use sensor data qos for livox tag filter and vector map filter Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Autoware <autoware@tier4.jp> * Ros2 fix topic name part1 (autowarefoundation#408) * Fix topic name of lane_departure_checker debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of mpc_follower debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of velocity_controller debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of motion_velocity_optimizer debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_change_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_avoidance_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of motion_velocity_optimizer Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_departure_checker Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of mpc_follower Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of velocity_controller Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_change_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_avoidance_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_stop_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of freespace_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of surround_obstacle_checker Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of emergency_handler Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint errors Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix typo Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * add use_sim-time option (autowarefoundation#454) * Fix rolling build errors (autowarefoundation#1225) * Add missing include files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Replace rclcpp::Duration Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Use reference for exceptions Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Use from_seconds Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Sync public repo (autowarefoundation#1228) * [simple_planning_simulator] add readme (autowarefoundation#424) * add readme of simple_planning_simulator Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update simulator/simple_planning_simulator/README.md * set transit_margin_time to intersect. planner (autowarefoundation#460) * Fix pose2twist (autowarefoundation#462) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Ros2 vehicle info param server (autowarefoundation#447) * add vehicle_info_param_server * update vehicle info * apply format * fix bug * skip unnecessary search * delete vehicle param file * fix bug * Ros2 fix topic name part2 (autowarefoundation#425) * Fix topic name of traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_visualization Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_map_based_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_recognition Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix issues in hdd_reader (autowarefoundation#466) * Fix some issues detected by Coverity Scan and Clang-Tidy * Update launch command * Add more `close(new_sock)` * Simplify the definitions of struct * fix: re-construct laneletMapLayer for reindex RTree (autowarefoundation#463) * Rviz overlay render fix (autowarefoundation#461) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * super class now back to MFD Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * uncrustified Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * acquire data in mutex Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * back to RTD as superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * Rviz overlay render in update (autowarefoundation#465) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * super class now back to MFD Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * uncrustified Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * acquire data in mutex Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * removed unnecessary includes and some dead code Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * restored RTD superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com> Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai> * Unify Apache-2.0 license name (autowarefoundation#1242) * Make planning modules components (autowarefoundation#1263) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix miss spell (autowarefoundation#1268) * Remove use_sim_time for set_parameter (autowarefoundation#1260) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Refactor vehicle info util (autowarefoundation#1305) * Update license Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor vehicle_info_util Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename and split files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix interfaces Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix bug and add error handling Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add "// namespace" Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add missing include Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add config file of plot juggler (autowarefoundation#1328) * Add pre-commit (autowarefoundation#1560) * add pre-commit * add pre-commit-config * add additional settings for private repository * use default pre-commit-config * update pre-commit setting * Ignore whitespace for line breaks in markdown * Update .github/workflows/pre-commit.yml Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * exclude svg * remove pretty-format-json * add double-quote-string-fixer * consider COLCON_IGNORE file when seaching modified package * format file * pre-commit fixes * Update pre-commit.yml * Update .pre-commit-config.yaml Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: pre-commit <pre-commit@example.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> * Fix -Wunused-parameter (autowarefoundation#1836) * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix spell * Fix lint issues Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore flake8 warnings Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> * Fix compiler warnings (autowarefoundation#1837) * Fix -Wunused-private-field Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wunused-variable Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wformat-security Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Winvalid-constexpr Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wdelete-non-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wdelete-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Winconsistent-missing-override Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wrange-loop-construct Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix "invalid application of 'sizeof' to an incomplete type" Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore -Wgnu-anonymous-struct and -Wnested-anon-types Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix lint Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore -Wno-deprecated-declarations in CUDA-related packages Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * suppress warnings for planning (autowarefoundation#1893) * add Werror * add maybe_unused * fix estm -> estimate * fix some typos (autowarefoundation#1941) * fix some typos * fix typo * Fix typo Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix calc_dist in acc (autowarefoundation#1945) * fix calc_dist in acc * use baselink2front * remove unused variable * fix * add sort-package-xml hook in pre-commit (autowarefoundation#1881) * add sort xml hook in pre-commit * change retval to exit_status * rename * add prettier plugin-xml * use early return * add license note * add tier4 license * restore prettier * change license order * move local hooks to public repo * move prettier-xml to pre-commit-hooks-ros * update version for bug-fix * apply pre-commit * Feature/changeable slow down margin (autowarefoundation#1546) (autowarefoundation#1726) * Feature/changeable slow down margin (autowarefoundation#1546) * start slow down at SlowDownStart * add publisher for debug * update slow down planner implementation * delete unnecessary publisher * change function name * apply clang-format * refactoring * refactoring & apply clang-format * add virtual wall marker Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Fix typo Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply uncrustify Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply cpplint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix package.xml Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Remove unused variable Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Fix/not appropriate velocity overwrite (autowarefoundation#1750) * fix not appropriate velocity overwrite * apply format * cleanup/wrap planner params by using struct (autowarefoundation#1788) * wrap planner params by using struct * move bg alias & add address operator * improve readability of loading parameters * remove unsuitable vehicle_info alias * remove unsuitable slow_down/stop planner param alias * add struct NodeParam * move using define * change param order Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * improvement/replace several lines with autoware_utils func (autowarefoundation#1783) * clean up * remove redundant blank line * LINE_STRIP -> LINE_LIST Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Refactor/obstacle stop planner (autowarefoundation#1811) * use autoware_utils getRPY() * use point alias & rename variables * use TrajectoryPoint instead of Eigen::Vector2d * split insertSlowDownSection() into two part * use trajectory point alias * change variables order * fix build error * use std::numeric_limits::epsilon() & small change * add address operator * fix typo * apply format * update TrajectoryPoint insert condition * use std::hypot * change alias name * move using alias & remove unnesessary include * remove an unnecessary variable * improve readability * undo the insert min dist * remane variables & improve readability * fix redundant variables name * tmp : remove scope * remove unnecessary alias * rename alias to improve readability * p_end -> p_back * undo partial rename * undo calc order modification * undo split insertSlowDownSection() into two parts * prevent TrajectoryPoint overlapping * remove unnecessary file * undo logic modification * initialize struct * fix constraints * fix indent * improve struct initialize * remove redundant address operator * initialize TrajectoryPoint * guard invalid index * remove std::min Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Fix/obstacle search radius in obstacle stop planner (autowarefoundation#1823) * guard activation both of slow down and stop by a collision obstacle * fix obstacle search radius bug * fix indent * rename variables * not deactivate slow down planning * initialize index * remove .swp Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * set initial value of lowpass filter in acc (autowarefoundation#1880) * set initial value of lowpass filter in acc * add space * Feature/add obstacle stop doc (autowarefoundation#1890) * add base doc. * add svg files * add flow chart * add roles * fix svg * add discription of flowchart * add figure to readme * fix typo * add plantuml * fix typo * upper velocity -> target velocity * add svg * add more dicription of stop/slow down planner * add adaptive cruise document * fix typo * apply markdown lint * fix format * fix format * fix svg * fix typo * fix format * Update planning/scenario_planning/lane_driving/motion_planning/obstacle_stop_planner/README.md Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * Update planning/scenario_planning/lane_driving/motion_planning/obstacle_stop_planner/README.md Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * add adaptive cruise description * fix deceleration range * fix description of slow down planner Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * add maybe unused (autowarefoundation#1908) * prevent chattering in adaptive cruise (autowarefoundation#1954) * fix typo * update readme * add description * add two threhold of obstacle velocity * fix calc_dist in acc (autowarefoundation#1945) * fix calc_dist in acc * use baselink2front * remove unused variable * fix * remove unused arg (autowarefoundation#1971) * improve/commonize calc insert point function (autowarefoundation#1825) * add insert function * fix typo * remove unnecessary address operator * use common function * index small change * rename variables * fix loop condition * fix loop condition no use static_cast * remove .swp * update insert inplementation * fix dist_remain plus/minus * improve readability Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Fix package.xml (autowarefoundation#2056) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix obstacle stop (autowarefoundation#2083) (autowarefoundation#2086) Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Feature/keep slow down speed until end point of slow down section (autowarefoundation#1985) * modify logic: not escape slow down until slow down section end * refactor: add findNearestFrontIndex() * remove unused argument & function * improve readability * add utility func * modify logic condition * fix for createQuaternionFromRPY/Yaw (autowarefoundation#2154) * fix unexpected slow down in sharp curves (autowarefoundation#2181) * Fix/insert implementation (autowarefoundation#2186) * Feature/consider jerk by using external velocity limit (autowarefoundation#2158) * consider jerk and acc constraint in slow down * use external velocity limit * consider constraints * add publisher for debug * publish jerk/acc constraints * add undershoot measures * add plotjuggle config (slow down planner) * fix unexpected speed up * update undershoot guard * bool initialize * support new VelocityLimit.msg * smplify velocity limit logic * improve readability * clean up debug publisher * use planner data * add publishDebugData() * clean up trajectory preprocess * add bad index detection * split a huge process into two parts * fix typo(threshould -> threshold) * use limit selector * add comment * update plotjuggler config * update member variables Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Fix/use common planning param (autowarefoundation#2246) * use common planning param * jerk_min_slow_down -> slow_down_min_jerk * fix velocity threshold (autowarefoundation#2264) * Fix/trajectory preprocess (autowarefoundation#2285) * fix preprocess * add index guard * Change formatter to clang-format and black (autowarefoundation#2332) * Revert "Temporarily comment out pre-commit hooks" This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3. * Replace ament_lint_common with autoware_lint_common Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove ament_cmake_uncrustify and ament_clang_format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply Black Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply clang-format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix build errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix for cpplint * Fix include double quotes to angle brackets Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply clang-format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix build errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add COLCON_IGNORE (autowarefoundation#500) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Auto/obstacle stop planner (autowarefoundation#531) * delete COLCON_IGNORE * port obstacle stop planner * run pre commit * add nav_msgs * type conversion * [apply_predicted_obj_type] adapt to autoware auto msgs (autowarefoundation#564) * fix obj shape * fix obj shape * fix goal pose * rename topic name twist -> odometry (autowarefoundation#568) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * update iv_msgs -> auto_msgs in planning readme (autowarefoundation#576) * update iv_msgs -> auto_msgs in planning readme * minor change * some fix * some fix Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * Auto/fix obstacle stop planner (#678) * change trajectory to trajectory point in node * update * update * delete comment * fix invalidContainerReference * substitute header to output Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp> * mix readme * add common param Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Nikolai Morin <nnmmgit@gmail.com> Co-authored-by: Servando <43142004+sgermanserrano@users.noreply.github.com> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve@apache.org> Co-authored-by: Jilada Eccleston <jilada.eccleston@tier4.jp> Co-authored-by: Shinnosuke Hirakawa <8327162+0x126@users.noreply.github.com> Co-authored-by: Autoware <autoware@tier4.jp> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com> Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai> Co-authored-by: Yusuke FUJII <yusuke.fujii@tier4.jp> Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: pre-commit <pre-commit@example.com> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp>

* release v0.4.0 * Fix typo (#700) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix detection area (#701) * Replace calcDistance with calcSignedDistance Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add STOP state Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * intersection: change detection area length parameter from 100m to 200m (#702) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * intersection: fix stuck vehicle behavior (#695) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Feature/intersection use spline interpolation library (#710) * Use spline_interpolation module * Remove debug messages * Feature/stop reason (#712) * add stop reason msg * add mock of stop resaon publisher * change namespace of stop reason * update stop reason msg * add toRosPoint * implement stop reason publisher of blind stop * implement stop reason publisher of crosswalk * implement stop reason publisher of intersection * implement stop reason publisher of stop line * implement stop reason publisher of trafficlight * implement stop reason publisher of detection area * fix bug * remove unnecessary process * add remained stop factor * clean code * fix bug * not punlish stop reason if array size is 0 * add stop reason to stuck object in intersection * add stop factor of obstacle stop planner * add stop reason of surround_obstacle checker * Apply review Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix message type * delete unused message from cmake * remove stopReasonStamped * change topic name of stop reasons Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix/stop reason (#724) * input stop reason of traffic light * add comment * add empty traffic light handling * change calculation method of traffic light position * avoid 0 position output * Fix/spline interpolation in intersection module (#726) * Remove duplicating sample points * Change isValidInput * Apply clang-format * Fix convergence check in PCG * fix clac signed distance bug (#733) * intersection: ignore stop plane when path[0] is in detection area (#739) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Publish tl states stamped (#744) * Add TrafficLightStateStamped.msg Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use msg instead of struct Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Publish traffic light state Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Check if lamp state is empty Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Apply clang-format Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Cosmetic change Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * update visualization marker (#759) * fix stack area (#758) * dont check pointcloud (#765) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * fix stop factor of merge_from_private_area (#749) * Revert "Publish tl states stamped (#744)" (#771) This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753. * fix intersection bug (#773) * fix bug * fix bug * change uid of marker (#775) * Fix/publish tl state stamped (#772) * Publish tl states stamped (#744) * Add TrafficLightStateStamped.msg Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use msg instead of struct Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Publish traffic light state Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Check if lamp state is empty Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Apply clang-format Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Cosmetic change Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Use dynamic pointer cast Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Fix blind spot areas and logic for creating a stop line (#732) * Fix blind spot areas Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Change logic for creating a stop line Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Do not add marker when marker is empty Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Cosmetic change Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Return boost optional for first conflict point Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Return boost optional for intersection start point Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Apply clang Signed-off-by: Daisuke Nishimatsu <border_goldenmarket@yahoo.co.jp> * Fix/intersection stuck detect area (#764) * fix stuck-vehicle detection area in intersection module * separate vehicle param * change the way ouf start idx count * change param * avoid to input -1 index (#777) * add dead line and pass through when over dead line (#784) * Add arg for input tl topic name (#783) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * change margin to 1.0m (#790) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * fix insert target point bug (#798) * fix typo stop_liine to stop_line (#799) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * traffic light scene module : fix bug and change param (#800) * fix bug (passs judge line) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * bug fix Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * change param Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * Intersection add debug comment (#803) * blind spot : modify debug comment Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * merge from private road : modify debug comment Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * intersection : modify debug comment Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * intersection util: modify generateStopLine() for debug Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add comment Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix intersection preceeding lane query (#807) * modified interseciton module to add lanelets in intersection to objective lanelets due to change in getPreceedingLaneletSequences() Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * update comment Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Fix blind spot area (#806) * Fix blind spot area Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use range based for Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use std::unique to remove adjacent duplicates Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use generateFineCenterline Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix detection area start point Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Revert "Use generateFineCenterline" This reverts commit 9d4f46bf65d7296b9286b30dfeed217a566a815c. * Fix centerline of half lanelet Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix area start point Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Revert "fix insert target point bug (#798)" (#815) This reverts commit 12eac2023538531e28a85a8914305cb534499f29. * Fix/traffic light state (#801) * fix bug (passs judge line) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * bug fix Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * change param Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * bug fix : remove stop state Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * add lower limit Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * change param (#821) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * stopline: parametrize check distance (#825) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Check if lanelets are sequential (#823) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix uninitialized variables (#816) * Parameterization for calculating judge line distance (#831) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Revert "remove ROS1 packages temporarily" This reverts commit 96b63e981899f79f2f5c6a6377e9600cc278e233. Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add COLCON_IGNORE to ros1 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Rename launch files to launch.xml (#28) * Port behavior_velocity_planner to ROS2 (#80) * Revert "Add geometry2 to repos (#76)" This reverts commit 6d2270476aaafdf1a8098d700d52a508525ea04b. * Automatic parts of the package port * Interesting part * Fix typo in package.xml * Review comments * Child logger names * Document logging duration Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> * [ROS2] Fix behavior velocity planner (#110) * install launch and config folders Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * port launch file Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix config files Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * improve vehicle_info_utils to enable multiple declaration of VehicleInfo objects Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix sementation fault Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Convert calls of Duration to Duration::from_seconds where appropriate (#131) * Rename h files to hpp (#142) * Change includes * Rename files * Adjustments to make things compile * Other packages * Adjust copyright notice on 532 out of 699 source files (#143) * Use quotes for includes where appropriate (#144) * Use quotes for includes where appropriate * Fix lint tests * Make tests pass hopefully * Run uncrustify on the entire Pilot.Auto codebase (#151) * Run uncrustify on the entire Pilot.Auto codebase * Exclude open PRs * fixing trasient_local in ROS2 packages (#160) * Enable cppcheck lints in behavior_velocity_planner (#159) * Enable lints in behavior_velocity_planner * Fix package.xml * Make launch files load vehicle model params dependent on argument (#228) * Make vehicle_model configurable in behavior_velocity_planner * Make vehicle_model configurable in vehicle_cmd_gate * change from vehicle_model to vehicle_param_file (#242) Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * Ros2 v0.8 fix typo of "preceding" (#323) * Fix typo of getPrecedingLaneletSequences * Fix comment * Ros2 v0.8.0 behavior velocity planner (#332) * restore behavior velocity planner files for v0.8.0 update * Fix detection area (#808) * Remove PASS state Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Keep stopping after going over dead-line in STOP state Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Clear state after obstacle disappears Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Parameterize and change conditions Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add elapsed time checker * Refactor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore inserting point if points are too close Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename NORMAL to GO Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Revert "Ignore inserting point if points are too close" This reverts commit 91c8d620ea11e703611945cb9a50877d175f4ff6. * Fix small bug Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: taichiH <azumade.30@gmail.com> * fix timing of publish stop reason of stop_line (#845) * fix timing of publish stop reason of stop_line * Fix formatting Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix task registration of detection area module (#856) * Fix task registration of detection area module Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix id of factor_text marker Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Do not interpolate if path size is 1 (#865) * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ce07d3c2bfae562d56fec46c4f81d5351fd936a1. * fix some implement miss * restore behavior velocity planner files for v0.8.0 update * change intersection param (#861) * Fix/intersection stop line (#841) * add trimmed path function * fix typo * avoid to insert stop line outside intersection * Add pass judge flag (#872) * Add pass judge flag Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix wrong format Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix flag order in judge condition Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add ignore width with blind spot (#864) * add ignore width with blind spot * remove unused function * fix typo * fix margin * remove bicycle from intersection stuck vehicle (#896) * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9. * fix implement miss * restore behavior velocity planner files for v0.8.0 update (fixed) * Add external traffic light input (#912) * Add external traffic light input Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Update topic namespace * Fix typos in planning modules (#866) * fix typos in planning * fix corresponding typos in planning * revert fixed typos temporarily due to its impact on launchers * add exception handling to intersection module (#920) * add exception handling * output input path * prevent passthrough chattering (#901) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * cosnider current_velocity to calculate intersection passing time (#880) * cosnider current_velocity to calculate intersection passing time * add fabs to current velocity * Improve stuck vehicle detect (#824) * intersection: modify stuck vehicle detect logic to consider the object shape Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * intersection: consider ego-vehicle length when calculate stuck vehicle detection area Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * intersection: change param stuck_vehicle_ignore_dist: 5.0 -> 7.0 Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * intersection: use vehicle_info/vehicle_length Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix implement miss * fix target pedestrian (#927) Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * fix insert backward point (#953) * fix insert backward point * add comment Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * remove unnecessary if Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * Add stop line referred from road marking (#968) * Add stop line referred from road marking Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add stop line for walkway Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Feature/external input (#982) * add external input msg * impl external input(crosswalk, intersection) * :put_litter_in_its_place: * change to ++14 * fix bug * fix bug * cosmetic change * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9. * Fix typo (#1013) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix/blind spot insert point (#1027) * Copy insert point from previous point * Reset path unless state is stop Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * change slow down speed (#1030) * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/walkway stop judge range (#1028) * Fix walkway stop judge Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Make refer id same Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix getObjectivePolygons() so that intersecting lanelet is added to objective lanelets even when there is no preceeding lanelets (#1010) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix implement miss for marker * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/blind spot polygon (#1056) * Fix detection area for blind spot Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply clang format Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Shrink conflicting area Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * chane slowdown judgement (#1066) * chane slowdown judgement * cosmetic change * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fixed for ros2 style * restore behavior velocity planner files for v0.8.0 update (fixed) * Remove unused headers in behavior_velocity_planner (#1072) * publish walkway stop reason (#1073) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * restore behavior velocity planner files for v0.8.0 update (fixed) * Add correspondence marker of detection_area and stop_line (#1081) * Fix comment Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add const Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add correspondence marker of detection_area and stop_line Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add obstacle marker Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fixup Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add id marker Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Clear state when time rollback found Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix typo Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * change stop to polygon line * apply clang format * fix code * fix bug Co-authored-by: taichiH <azumade.30@gmail.com> * Fix pass judge idx (#1090) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix bug (#1087) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix for ros2 style * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/remove duplicated point (#1107) * Split PoseDeviaiton functions Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove unnecessary pose Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Don't insert point if duplicated point exists Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix condition of duplicated points Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * seperate stop distance param (#1137) * seperate stop distance param Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * apply param for automotically generated stop line Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * shift slow down line Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add param in yaml file Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * fix prediction_time_margin bug (#1148) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix ros2 style * remove deprecated * reformat * add test temporary launch * cpp_lint_namespace_what_you_use * lint_comment_line_length * pass ament cpplint * fixe commit * fix code * remove unneccesary * fix param structure * fix missng params * fix throttle time Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: taichiH <azumade.30@gmail.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> * Rename ROS-related .yaml to .param.yaml (#352) * Rename ROS-related .yaml to .param.yaml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove prefix 'default_' of yaml files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename vehicle_info.yaml to vehicle_info.param.yaml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename diagnostic_aggregator's param files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix overlooked parameters Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * [behavior_velocity_planner]: Fix missing ros2 porting (#392) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix error handling of tf lookupTransform (#405) Co-authored-by: autoware <autoware@example.com> * rm_std_msgs (#402) * Sensor data qos (#407) * Use sensor data qos for pointcloud preprocessor Signed-off-by: Autoware <autoware@tier4.jp> * Use sensor data qos for pointcloud Signed-off-by: Autoware <autoware@tier4.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use sensor data qos for livox tag filter and vector map filter Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Autoware <autoware@tier4.jp> * Ros2 fix topic name part1 (#408) * Fix topic name of lane_departure_checker debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of mpc_follower debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of velocity_controller debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of motion_velocity_optimizer debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_change_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_avoidance_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of motion_velocity_optimizer Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_departure_checker Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of mpc_follower Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of velocity_controller Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_change_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_avoidance_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_stop_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of freespace_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of surround_obstacle_checker Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of emergency_handler Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint errors Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix typo Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix typo in planning module (#432) * Fix typo in planning module * Fix remaining errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply cpplint and uncrustify. Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix traffic light module (#458) * change log type (#459) * add use_sim-time option (#454) * Fix rolling build errors (#1225) * Add missing include files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Replace rclcpp::Duration Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Use reference for exceptions Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Use from_seconds Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Sync public repo (#1228) * [simple_planning_simulator] add readme (#424) * add readme of simple_planning_simulator Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update simulator/simple_planning_simulator/README.md * set transit_margin_time to intersect. planner (#460) * Fix pose2twist (#462) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Ros2 vehicle info param server (#447) * add vehicle_info_param_server * update vehicle info * apply format * fix bug * skip unnecessary search * delete vehicle param file * fix bug * Ros2 fix topic name part2 (#425) * Fix topic name of traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_visualization Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_map_based_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_recognition Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix issues in hdd_reader (#466) * Fix some issues detected by Coverity Scan and Clang-Tidy * Update launch command * Add more `close(new_sock)` * Simplify the definitions of struct * fix: re-construct laneletMapLayer for reindex RTree (#463) * Rviz overlay render fix (#461) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * super class now back to MFD Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * uncrustified Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * acquire data in mutex Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * back to RTD as superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * Rviz overlay render in update (#465) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * super class now back to MFD Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * uncrustified Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * acquire data in mutex Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * removed unnecessary includes and some dead code Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * restored RTD superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com> Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai> * Unify Apache-2.0 license name (#1242) * Make planning modules components (#1263) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Remove use_sim_time for set_parameter (#1260) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Refactor vehicle info util (#1305) * Update license Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor vehicle_info_util Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename and split files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix interfaces Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix bug and add error handling Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add "// namespace" Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add missing include Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix slow/stop marker color & stop reason (#1347) (#1354) Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * fix intersection stop line (#1272) (#1349) * fix intersection stop line (#1272) * fix intersection stop line * fix comment * Fix typo Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Avoid passing empty lanelets to getPolygonFromArcLength (#1371) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add perception traffic light state output (#1302) * Add perception traffic light state output Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Modify message type Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Apply message type to relay Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Feature/consider jerk limit in passjudge (#1339) (#1351) * Feature/consider jerk limit in passjudge (#1339) * make new branch for behavior velocity planner * update implementation for considering accel & jerk limit * refactoring * change default params * change default params * change minimum velocity which decides to conduct pass judge * remove ROS_DEBUG_COND() * remove unnecessary variables * fix lowpass filter implementation * calc acceleration in planner_data_ Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Fix typo Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Feature/refactor stop line module (#1343) (#1359) * Refactor stop_line planner module Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add document Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix English Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> * Feature/add stop duration ros2 (#1380) * Feature/add stop duration (#1367) * Add stop_duration to behavior_velocity_planner Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * parameterize stop duration sec * Use stop_duration in Stop Line module Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Change default value Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix topic name of external traffic light input (#1412) * publish perception and external tl_state for mlops (#1350) (#1375) * publish perception and external tl_state for mlops * fix tl_state time stamp Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Fix/traffic light planning module (#1424) (#1487) * Fix/traffic light planning module (#1424) * bug fix * refactor * refactor * cosmetic change * fix typo * cosmetic change * refactor * remove unused func * enable restart * cosmetic change * fix typo * refactor * bug fix * cosmetic change * modify debug_data * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Remove unnecesarry comment Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix bug Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * change msg type looking traffic light state (#1494) * change msg type looking traffic light state (#1455) * change msg type looking traffic light state * fix msg name * using namespace * change function name * fix typo * add readme * Update awapi/awapi_awiv_adapter/Readme.md fix typo Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Remove deprecated message include Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Add namespace to behavior_velocity_planner (#1542) * Add namespace to behavior_velocity_planner Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix typo Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Avoid passing uninitialized index (#1609) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * suppress warnings for behavior_velocity_planner (#1733) * add Werror * suppress warnings for stopline module * fix for crosswalk * fix for traffic light * fix for detection area * fix style * use {} * use auto * Fix -Wunused-parameter (#1836) * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix spell * Fix lint issues Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore flake8 warnings Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> * Fix compiler warnings (#1837) * Fix -Wunused-private-field Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wunused-variable Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wformat-security Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Winvalid-constexpr Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wdelete-non-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wdelete-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Winconsistent-missing-override Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wrange-loop-construct Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix "invalid application of 'sizeof' to an incomplete type" Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore -Wgnu-anonymous-struct and -Wnested-anon-types Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix lint Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore -Wno-deprecated-declarations in CUDA-related packages Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add autoware api (#1979) * Feature/add virtual traffic light planner (#1588) * add sort-package-xml hook in pre-commit (#1881) * add sort xml hook in pre-commit * change retval to exit_status * rename * add prettier plugin-xml * use early return * add license note * add tier4 license * restore prettier * change license order * move local hooks to public repo * move prettier-xml to pre-commit-hooks-ros * update version for bug-fix * apply pre-commit * remove spline_interpolation, and create interpolation package that ha… (#2114) * remove spline_interpolation and add interpolation package * fix bugs and add simple test * modify application for interpolation package * add some tests and fix ci test * add some tests * add -Werror * move functions to anonymous * fix reviews * fix typo * fix review and lint * add tests * resolve TODOs * add README.md * Update common/math/interpolation/test/src/test_interpolation_utils.cpp Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> * Update common/math/interpolation/test/src/test_interpolation_utils.cpp Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> * Update common/math/interpolation/test/src/test_interpolation_utils.cpp Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> * fix README.md * dealt with reviews * update README.md * update README.md * Update common/math/interpolation/README.md * fix some bugs * fix typo * update README.md * Update common/math/interpolation/README.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * fix test * Update common/math/interpolation/README.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * fix cdots * fix README.md * Update common/math/interpolation/README.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Sync develop/fix interpolation and speed up calculation (#2290) * debug slope calculation in behavior (#1566) (#1727) * debug slope calculation in behavior (#1566) * update * update * revert change of autoware_utils * define getPose in behavior_path_planner * update * update * update * update * interpolate z in obstacle_avoidance_planner * update velocity controller * fix detection area and scene * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * update comment in velocity controller * remove debug print * update Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix typo Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix variable names Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix uncrustify Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * add underscore to marker namespace (#1785) Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * [obstacle_avoidance_planner] remove useless get nearest idx (#1851) * modify velocity insertion in obstacle_avoidance_planner Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [obstacle_avoidance_planner] reduce calculation cost in relative/absolute transformation (#1844) * implement relative/absolute transformation without yaw but directly sin/cos of yaw * rename: relative_p to absolute_p * assigin point.z to rel/abs_z * fix cpp-lint error Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix argument order (#1502) (#1622) Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Change param (#1559) (#1677) Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Feature/use spline module in behavior velocity planner (#1457) (#1495) * Feature/use spline module in behavior velocity planner (#1457) * Use spline_interpolation module * Remove unused function * Remove unused include * Use autoware_utils * Remove unused function * Remove cubic_spline.hpp * Fix error handling * Fix interpolation of velocity Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * change warning threshold (#1539) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Feature/porting behavior path planner (#1645) * Add behavior path planner pkg with Lane Change (#1525) * add lanelet extension funcs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add planning msgs for FOA Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add behavior_path_planner pkg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply clang format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add error handling for config load failure Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replace word: foa with remote control Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add readme Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use pointer for return value of path Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix hz Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove debug print Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove shide-shift & avoidance related files Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Clip path by goal * add build depend for behavior tree cpp Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * temporally disable lint test in lanelet2_extension Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: rej55 <rej55.g@gmail.com> * Add avoidance module in behavior_path_planner (#1528) * Revert "remove shide-shift & avoidance related files" This reverts commit d819ea0291fca251012e4b9ffd16de3896830aa2. * refactor findNewShiftPoint func Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove duplicated decleration Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix barkward length issue - add clipPathLenght func in avoidance Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * refactor: - translate english - minor modification for traffic distance Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * support debug marker in behavior_path_planner Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * clean up side shift module Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change topic name Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove japanese Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/side_shift/side_shift_module.hpp Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove unused var Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * adress reviewer comments: - add const for variables - add comment - fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Replace behavior_path utilities with autoware_utils (#1532) * replace calcDistance Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replace arange Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replave convertToEigenPt with autoware_utils::fromMsg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replace normalizeRadian Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * cosmetic change Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * import #1526 into behavior path planner (#1531) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix/behavior path empty path output guard (#1536) * add guard Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/behavior_path_planner.cpp * fix lateral jerk calculation (#1549) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix: error handling on exception in behavior_path_planner (#1551) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix ignore too steep avoidance path (#1550) * ignore too steep path Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp * parametrize lateral jerk limit Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/avoidance/avoidance_module.hpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * use offsetNoThrow and add error log (#1615) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Ignore object ahead goal for avoidance (#1618) * Ignore object ahead goal for avoidance * Add flag * Fix position of definition of goal_pose * Fix arclength calculation * Fix position of definition of goal_pose * fix intersection stop line (#1636) * fix intersection stop line * fix typo * add document (#1635) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Port behavior path planner to ros2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix typo Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix map qos Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * debug slope calculation in behavior (#1566) * update * update * revert change of autoware_utils * define getPose in behavior_path_planner * update * update * update * update * interpolate z in obstacle_avoidance_planner * update velocity controller * fix detection area and scene * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * update comment in velocity controller * remove debug print * update Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Address review: Fix config file name Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * pre-commit fixes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix redeclaring parameters Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add missing tf2 geometry function Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix rclcpp Time initialization Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use now() instead of msg stamp Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use throttle output in getExpandedLanelet Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add missing const Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: rej55 <rej55.g@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> * Fix/generate intersection stop (#1590) (#1679) * Fix/generate intersection stop (#1590) * fix bug of conflicting polygons * clean code * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Fix/stop margin time ros2 (#1683) * Add stop margin time in walkway and merge_from_private_area (#1613) * Add stop margin time in walkway, merge_from_private_area * Fix param name * Fix bug * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Feature/change stop lines handling to support parking car avoidance p… (#1676) * Feature/change stop lines handling to support parking car avoidance path (#1464) * support parking car avoidance * change log level * apply clang-format * add extendLine function * clean up & apply clang-format * change implementation getStopPoseFromMap() * remove unuse comment line Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * fix argument order (#1580) Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * Feature/porting occlusion spot (#1740) * Feature/occlusion_spot safety planner public road (#1594) * add blind spot safety planner public road * remove duplicated procesing * remove unused private param * renaming fix typo add comments * fix spell check * velocity -> relative velocity * calc2d, To param, simplify search, To original * add the num possible collision gurd * computational cost reduction * Cosmetic change for PossibleCollisionInfo * add interpolation to possible collision value * refactor codes * fix details * invalid point gurd * To Param * refacotor to occlusion spot util * cosmetic change * clean up blindspot * To Occlusion Spot * revise readme * refactor drawing * for better explanation * fix velocity profile * clean up details * cosmetic change for debug marker * use max velocity in obstacle info instead * add gtest for Too Many Possible Collision case * change case * refactor readme * minor fix * add more occlusion spot explanation * replace svg * add gtest build path lanelet * hotfix lateral distance and searching method * update g test for lateral distance * use faster search * set more realistic param * add lanelet subtype highway * cosmetic change of reviews * add occlusion spot module in private area (#1640) * add occlusion spot in private * For debugging change * add spline interpolation to path * add review changes * adding minor change * cosmetic change * Vector to retval * Blindspot To OcclusionSpot1 * To Occlusion Spot 2 * To Occlusions spot3 * update gtest with unified anchor * remove anchor * add test slice * simplify interpolation * Too Occlusion spot4 * add test buffer * To Occlusion spot * namespace gurd * correct slice and add interpolation first * handle self crossing with check for invation * to ros debug stream * removed unused interpolation * add readme to plant uml * cosmetic change * minor change * update readme * review change * change occlusion spot text color * To Offset no Throw * better debug marker * catch only inversion error * skip return in case of inversion * for better grid * simplify path lanelet at first * remove std::cout * for better path * limit ego path inside target lanelet location * remove last points * cosmetic change for markers * apply module for limited scene * fix interpolation gurd * for better params * do not includes path behind * remove dummy perception publisher * Revert "remove dummy perception publisher" This reverts commit 4acad985fe31dd9befaa21a16631495de6c3a117. * replace hard coded occupancy grid option in psim * remove respawn * add arg to params and remove redundunt launch * fix spell check * fix default value Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Feature/occlusion spot private slice size param (#1703) * add min slice size * for a bit narrow lateral distance * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/config/occlusion_spot_param.yaml Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com> Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com> * Rename files Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Porting to ros2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * pre-commit fixes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix typo Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix launch namespace Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Fix parameter type Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/scene_occlusion_spot_in_private_road.cpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com> * fix function name and condition for detection area (#1758) * Fix build warning for occlusion spot (#1766) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix passing uninitialized index (#1792) * Fix passing uninitialized index Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply uncrustify Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix return value Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix/intersection bug (#1787) * fix insert point function * apply format * separate insertPoint and hasDuplicatedPoint * clean code * fix bug * replace velocity if collision point is too close to original path point (#1799) * replace velocity if collision point is too close to original path point * fix comment * Fix compile warnings (#1852) Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Fix -Wunused-private-field Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Fix -Wunused-lambda-capture Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Fix -Wdelete-non-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Fix -Wrange-loop-construct Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Ignore lint error Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Document / behavior velocity planner (#1767) update document Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * fix occlusion spot insert velocity ros2 (#1821) * Fix/occlusion spot offset (#1824) * merge calcCollisionFunction * ConsiderSignedOffset * add extractRoadTargetAndSignedOffset * apply signed offset and fix longitudinal distance * fix unapplied param * update gtest * consider offset until target road * refactor for proper variable name * fix typo * remove unused first index * fix closest * fix diff * fix velocity and height * tune distance thershold * fix colcon test * apply param at the experiment * fix unused and param * Fix/current acc initialize (#1899) * use boost::optional * null guard * fix typo * Feature/improve intersection detection area (#1958) * exclude ego_lanes from detection_area * add empty handling * remove unused function * Fix for uncrustify Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> * [behavior_velocity_planner] remove unnecessary graph search to reduce computational cost (#1980) * remote unnecessary graph search Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add var for graph id Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove unused stopline search for computational cost reduction Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * restore lane_ids iteration as it was Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * sort sidewalk slice by arc length (#1967) * sort sidewalk slice by arc length * handle invalid index * divide offset to ego to closest to and closest to target * fix cartesian distance to arc lane distance * consider ego to target to ignore length * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/occlusion_spot_utils.cpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * Fix/merge from private area (#2005) * fix insert pos. of merge from private area * exclude entrance of private road from path * extract exit of private road * Feature/intersection module detect obstacle (#1990) * change the way to detect target objects in detection area * check the angle of deteced objects * ignore predicted path with low confidence * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/README.md Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * fix format * fix object position judge * change function * apply format Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * occlusion spot lower min ego velocity (#2140) Co-authored-by: taikitanaka3 <taiki.tanaka@tier4.jp> * add behavior velocity planner utils (#2113) * add gtest utils * add state machine as utils * add arc lane utils * remove empty file * add gtest for offset segment * use calcdist2d in autoware util * apply get point * fix uncrustify * fix conflict getPoint in behavior path * apply commit suggestion * slower than ros1 * use interpolation::slerp (#2161) * Update traffic light state if ref stop point is ahead of previous one (#2197) (#2240) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> * Change formatter to clang-format and black (#2332) * Revert "Temporarily comment out pre-commit hooks" This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3. * Replace ament_lint_common with autoware_lint_common Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove ament_cmake_uncrustify and ament_clang_format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply Black Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply clang-format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix build errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix for cpplint * Fix include double quotes to angle brackets Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply clang-format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix build errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add COLCON_IGNORE (#500) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * rename topic name twist -> odometry (#568) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * Auto/behavior velocity (#605) * port except for traffic light * fix test * update traffic light * fix errors * rename traffic message: final -> result * fix package.xml * twist -> odometry * use confidence * rename topic name of dynamic objects * remove TODOs * deal with probabilistic test failure * deal with probabilistic test failure2 Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * Sync .auto branch with the latest branch in internal repository (#691) * add trajectory point offset in rviz plugin (#2270) * sync rc rc/v0.23.0 (#2258) * fix interpolation for insert point (#2228) * fix interpolation for insert point * to prev interpolation pkg * Revert "to prev interpolation pkg" This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef. Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: taikitanaka <ttatcoder@outlook.jp> * fix topic name (#2266) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Add namespace to diag for dual_return_filter (#2269) * Add a function to make 'geometry_msgs::msg::TransformStamped' (#2250) * Add a function to make 'geometry_msgs::msg::TransformStamped' * Add 'child_frame_id' as an argument of 'pose2transform' * Simplify marker scale initialization (#2286) * Fix/crosswalk polygon (#2279) * extend crosswalk polygon * improve readability * fix polygon shape * Add warning when decel distance calculation fails (#2289) Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * [motion_velocity_smoother] ignore debug print (#2292) * cosmetic change Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * cahnge severity from WARN to DEBUG for debug info Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use util for stop_watch Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix map based prediction (#2200) * fix map based prediction * fix format * change map based prediction * fix spells * fix spells in comments * fix for cpplint * fix some problems * fix format and code for clang-tidy * fix space for cpplint * Update Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * fix vector access method * fix readme format * add parameter * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <kmiya@out…

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

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>

takayuki5168 · 2022-04-23T04:51:33Z

@kenji-miyake I updated all other plugins. I've already verified that all of them worked well. Give me LGTM.

takayuki5168 · 2022-04-23T04:52:09Z

Ahh wait. This is your PR. So if you think it's ok to merge, let me know. Then I will approve and merge.

common/tier4_planning_rviz_plugin/src/path_footprint/display.cpp

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>

kenji-miyake · 2022-04-23T05:18:07Z

@takayuki5168 Will you update the title?

takayuki5168 · 2022-04-23T05:18:52Z

Ah right. Done.

takayuki5168

LGTM

kenji-miyake · 2022-04-23T05:20:05Z

I think * is a bit unclear, so I fixed it again. 🙇

…lay (tier4#712) * feat(tier4_planning_rviz_plugins): add vehicle_info to PathFootprintDisplay Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add vehicle_info to other footprint displays Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix the scope of local variables Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>

chore: sync upstream

kenji-miyake requested a review from takayuki5168 April 16, 2022 08:54

Kenji Miyake and others added 2 commits April 23, 2022 12:36

feat(tier4_planning_rviz_plugins): add vehicle_info to PathFootprintD…

e90be4b

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

add vehicle_info to other footprint displays

5d278dd

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>

takayuki5168 force-pushed the get-vehicle-info-in-rviz-plugins branch from dead06f to 5d278dd Compare April 23, 2022 04:49

takayuki5168 marked this pull request as ready for review April 23, 2022 04:49

kenji-miyake commented Apr 23, 2022

View reviewed changes

common/tier4_planning_rviz_plugin/src/path_footprint/display.cpp Show resolved Hide resolved

fix the scope of local variables

c913b46

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>

takayuki5168 changed the title ~~feat(tier4_planning_rviz_plugins): add vehicle_info to PathFootprintDisplay~~ feat(tier4_planning_rviz_plugins): add vehicle_info to *FootprintDisplay Apr 23, 2022

takayuki5168 approved these changes Apr 23, 2022

View reviewed changes

takayuki5168 enabled auto-merge (squash) April 23, 2022 05:19

kenji-miyake changed the title ~~feat(tier4_planning_rviz_plugins): add vehicle_info to *FootprintDisplay~~ feat(tier4_planning_rviz_plugins): add vehicle_info to Footprint Displays Apr 23, 2022

takayuki5168 merged commit 55a1101 into main Apr 23, 2022

takayuki5168 deleted the get-vehicle-info-in-rviz-plugins branch April 23, 2022 05:25

tier4-autoware-public-bot bot mentioned this pull request Apr 24, 2022

chore: sync upstream tier4/autoware.universe#39

Merged

kyoichi-sugahara pushed a commit to kyoichi-sugahara/autoware.universe that referenced this pull request Sep 3, 2023

Merge pull request autowarefoundation#712 from tier4/sync-upstream

78310c8

chore: sync upstream

Provide feedback

Saved searches

Use saved searches to filter your results more quickly

feat(tier4_planning_rviz_plugins): add vehicle_info to Footprint Displays #712

feat(tier4_planning_rviz_plugins): add vehicle_info to Footprint Displays #712

kenji-miyake commented Apr 16, 2022 •

edited

Loading

kenji-miyake commented Apr 16, 2022

kenji-miyake commented Apr 16, 2022

codecov bot commented Apr 16, 2022 •

edited

Loading

takayuki5168 commented Apr 17, 2022

takayuki5168 commented Apr 23, 2022

takayuki5168 commented Apr 23, 2022

kenji-miyake commented Apr 23, 2022

takayuki5168 commented Apr 23, 2022

takayuki5168 left a comment

kenji-miyake commented Apr 23, 2022

feat(tier4_planning_rviz_plugins): add vehicle_info to Footprint Displays #712

feat(tier4_planning_rviz_plugins): add vehicle_info to Footprint Displays #712

Conversation

kenji-miyake commented Apr 16, 2022 • edited Loading

Description

Pre-review checklist for the PR author

In-review checklist for the PR reviewers

Post-review checklist for the PR author

kenji-miyake commented Apr 16, 2022

kenji-miyake commented Apr 16, 2022

codecov bot commented Apr 16, 2022 • edited Loading

Codecov Report

takayuki5168 commented Apr 17, 2022

takayuki5168 commented Apr 23, 2022

takayuki5168 commented Apr 23, 2022

kenji-miyake commented Apr 23, 2022

takayuki5168 commented Apr 23, 2022

takayuki5168 left a comment

Choose a reason for hiding this comment

kenji-miyake commented Apr 23, 2022

kenji-miyake commented Apr 16, 2022 •

edited

Loading

codecov bot commented Apr 16, 2022 •

edited

Loading