fix(behavior_velocity): calculate detection area from the nearest point from ego #730

TomohitoAndo · 2022-04-19T15:49:09Z

Description

I fixed createDetectionAreaPolygons to calculate detection area from the nearest point from ego

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.

… of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

TomohitoAndo · 2022-04-19T16:03:34Z

@taikitanaka3
by this change, you have to clip the predicted_path from the ego pose in occlusion spot module. (I think this is better because path velocity is smoothed from nearest point from ego)
and you don't need offset_from_start_to_ego once you clip the path from ego.
https://github.com/autowarefoundation/autoware.universe/blob/main/planning/behavior_velocity_planner/src/scene_module/occlusion_spot/scene_occlusion_spot.cpp#L127-L128

Could you fix the code or can I fix?

taikitanaka3 · 2022-04-19T21:51:12Z

@TomohitoAndo
thankyou offset from start to ego is necessary because smoothed path is added path behind at last step. you can see util.cpp smooth function.
however we need to use velocity of the path from closest to ego while detection area start.position is.front bumper with offset right?
can you fix it if its possible?

taikitanaka3 · 2022-04-19T23:49:30Z

this part

autoware.universe/planning/behavior_velocity_planner/include/utilization/trajectory_utils.hpp

Line 179 in b2f90a0

traj_smoothed.insert(

codecov · 2022-04-20T01:47:07Z

Codecov Report

Merging #730 (f4bc7b8) into main (b2f90a0) will increase coverage by 0.06%.
The diff coverage is 0.00%.

@@           Coverage Diff            @@
##            main    #730      +/-   ##
========================================
+ Coverage   9.64%   9.70%   +0.06%     
========================================
  Files        907     907              
  Lines      56508   56729     +221     
  Branches    6693    6817     +124     
========================================
+ Hits        5451    5508      +57     
- Misses     46566   46719     +153     
- Partials    4491    4502      +11

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

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

Impacted Files	Coverage Δ
...ene_module/occlusion_spot/occlusion_spot_utils.hpp	`40.00% <ø> (ø)`
...vior_velocity_planner/include/utilization/util.hpp	`7.84% <ø> (ø)`
...ene_module/occlusion_spot/occlusion_spot_utils.cpp	`10.54% <0.00%> (+1.26%)`	⬆️
...ene_module/occlusion_spot/scene_occlusion_spot.cpp	`0.00% <0.00%> (ø)`
...behavior_velocity_planner/src/utilization/util.cpp	`30.00% <0.00%> (+3.36%)`	⬆️

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 b2f90a0...f4bc7b8. Read the comment docs.

Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

TomohitoAndo · 2022-04-20T07:10:44Z

@taikitanaka3
I fixed to calculate the distance from the nearest point of the path.
200a465
I changed to pass the nearest_idx instead of offset because to calculate ego nearest point from offset is redundant.

TomohitoAndo · 2022-04-20T07:11:33Z

I confirmed occlusion_spot module works in psim.
https://user-images.githubusercontent.com/11865769/164171235-3ac55e9e-8b1d-434a-a2d1-a94a23fef5a5.mp4

Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

TomohitoAndo · 2022-04-20T07:20:22Z

struct was passd by value so I changed it to pass by reference.
10fb00c

taikitanaka3 · 2022-04-20T23:56:23Z

@TomohitoAndo
sorry for late. nearest_idx at interpolated path and nearest index in smoothed path is different so please find nearest index in util function.

Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

TomohitoAndo · 2022-04-21T03:34:42Z

@taikitanaka3
I fixed to find nearest index in util function. f4bc7b8

I've confirmed that occlusion spot module works in psim.

simplescreenrecorder-2022-04-21_12.11.26.mp4

taikitanaka3

LGTM

* release v0.4.0 * Add spline interpolation library (autowarefoundation#705) * Feature/intersection use spline interpolation library (autowarefoundation#710) * Use spline_interpolation module * Remove debug messages * Fix/spline interpolation in intersection module (autowarefoundation#726) * Remove duplicating sample points * Change isValidInput * Apply clang-format * Fix convergence check in PCG * update osqp interface (autowarefoundation#730) * 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> * remove ROS1 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Revert "remove ROS1 packages temporarily" This reverts commit 7127cf7. Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add COLCON_IGNORE to ros1 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Port osqp-interface to ros2 (autowarefoundation#45) It doesn't use any ros functionality so the source code is unchanged, only `package.xml` and `CMakeLists.txt` needed to be modified. But osqp is added through a vendor package created at https://github.com/tier4/osqp_vendor To test this locally, eigen needs to be installed in the environment with sudo apt install libeigen3-dev * Port spline interpolation to ros2. (autowarefoundation#65) * Fix osqp_interface dependencies (autowarefoundation#66) * [osqp_interface] fix eigen3 dependencies fixes autowarefoundation#63 * Fix link order in consumers of osqp_interface * Update logger name for SOR class (autowarefoundation#87) Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Rename h files to hpp (autowarefoundation#142) * Change includes * Rename files * Adjustments to make things compile * Other packages * Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143) * Use quotes for includes where appropriate (autowarefoundation#144) * Use quotes for includes where appropriate * Fix lint tests * Make tests pass hopefully * Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151) * Run uncrustify on the entire Pilot.Auto codebase * Exclude open PRs * ROS2 Linting: osqp_interface (autowarefoundation#202) * Add linters * Fix clang-tidy missing header error * ROS2 Linting: spline_interpolation (autowarefoundation#203) * Add linters and fix indentation in package.xml * Address PR comments: - Convert indents to spaces * Use two spaces for indent Co-authored-by: Esteve Fernandez <esteve@apache.org> * Fix out-of-range bug of spline_interpolation (autowarefoundation#917) (autowarefoundation#273) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> * Ros2 v0.8.0 osqp interface (autowarefoundation#271) * restore file name for v0.8.0 update Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix typos in common modules (autowarefoundation#914) * fix typos in common modules * minor fix (lowercasing) * revert changes in PathPoint.msg * Fix/osqp interface api error (autowarefoundation#969) * [osqp_interface] fix update setting api Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [osqp_interface] fix format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Revert "restore file name for v0.8.0 update" This reverts commit b767c308d492c6f754f9aa45ab9521f209ad9c9c. Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Ros2 v0.8.0 ekf localizer (autowarefoundation#270) * restore file name for v0.8.0 update Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix typos in localization (autowarefoundation#890) * move kalman filter to lib package (autowarefoundation#1141) * move kalman filter to lib package * add kalman_filter dir * Revert "restore file name for v0.8.0 update" This reverts commit 485111da0aba91eeddda77e1e3b6b3f517373163. Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Feature/ekf tracker (autowarefoundation#1158) (autowarefoundation#381) * Feature/ekf tracker (autowarefoundation#1158) * change to ekf tracker * visualize covariance * cosmetic change * cosmetic change * change param * add multi model ekf tracker (autowarefoundation#1165) * add multi model ekf tracker * cosmetic change * cosmetic change * add iou filter * change correct license * change correct license * cosmetic change * bug fix * cosmetic change * check clockwise * change param * bug fix * cosmetic change * add comment * add enum * cosmetic change * cosmetic change * apply format * apply format * fix config name Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [multi_object_tracker] apply ament_uncrustify Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [multi_object_tracker] fix lint errors Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * fix include brackets Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Fix typo in common module (autowarefoundation#433) * Unify Apache-2.0 license name (autowarefoundation#1242) * Make control modules components (autowarefoundation#1262) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Make planning modules components (autowarefoundation#1263) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Porting small fix (autowarefoundation#1288) * Delete unused code (autowarefoundation#1183) * Fix control topic name of closest_velocity_checker.py (autowarefoundation#1174) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add comments for livox tag (autowarefoundation#1188) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Clear return value (autowarefoundation#1193) * Change tracker model of unknown object (autowarefoundation#1204) * treat polygon points as relative (autowarefoundation#1205) Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * hotfix: reference velocity in consideration of vehicle gear (autowarefoundation#1213) * fix reference velocity for vehicle gear * add initialization * revert * add comment * change max area param (autowarefoundation#1218) * Fix an identical code for different branches (autowarefoundation#1230) * Update livox_tag_filter.launch.xml * Fixup Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: shin <8327162+0x126@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix osqp interface double free problem (autowarefoundation#1327) * Use smart pointers for members * Add test code * Fix typo * Fix test code * Change variable name * Fix for lint test * Fix include * Fix header and CMakeLists.txt Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * add new updater function to osqp_interface (autowarefoundation#1433) (autowarefoundation#1483) * add new updater function * modify spell Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> * 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 bugprone-fold-init-type in spline_interpolation (autowarefoundation#1816) * Fix bugprone-fold-init-type * Fix modernize-use-override * Fix cppcoreguidelines-pro-type-member-init * Fix modernize-loop-convert * 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 * remove spline_interpolation, and create interpolation package that ha… (autowarefoundation#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> * Feature/lpf in common ros2 (autowarefoundation#1628) * add first order lowpass filter (autowarefoundation#1505) * add first order lowpass filter * fix bugs, and add tests * update copyright * apply clang-format * add another constructor * add another reset member function * update * add test * update test * update test * rename lowpass filter to signal processing * Porting lpf1d to ros2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> * [osqp interface] size check invalid argument error ros2 (autowarefoundation#1870) * throw invalid_argument when osqp matrix/vector are invalid * add test for invalid_argumetn * 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> * remove COLCON_IGNORE (autowarefoundation#506) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * Remove COLCON_IGNORE from interpolation (autowarefoundation#516) * delete COLCON IGNORE in signal processing package(autowarefoundation#537) * Delet colcon ignore (autowarefoundation#534) * Back port .auto control packages (autowarefoundation#571) * Implement Lateral and Longitudinal Control Muxer * [autowarefoundation#570] Porting wf_simulator * [autowarefoundation#1189] Deactivate flaky test in 'trajectory_follower_nodes' * [autowarefoundation#1189] Fix flacky test in 'trajectory_follower_nodes/latlon_muxer' * [autowarefoundation#1057] Add osqp_interface package * [autowarefoundation#1057] Add library code for MPC-based lateral control * [autowarefoundation#1271] Use std::abs instead of abs * [autowarefoundation#1057] Implement Lateral Controller for Cargo ODD * [autowarefoundation#1246] Resolve "Test case names currently use snake_case but should be CamelCase" * [autowarefoundation#1325] Deactivate flaky smoke test in 'trajectory_follower_nodes' * [autowarefoundation#1058] Add library code of longitudinal controller * Fix build error for trajectory follower Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix build error for trajectory follower nodes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * [autowarefoundation#1272] Add AckermannControlCommand support to simple_planning_simulator * [autowarefoundation#1058] Add Longitudinal Controller node * [autowarefoundation#1058] Rename velocity_controller -> longitudinal_controller * [autowarefoundation#1058] Update CMakeLists.txt for the longitudinal_controller_node * [autowarefoundation#1058] Add smoke test python launch file * [autowarefoundation#1058] Use LowPassFilter1d from trajectory_follower * [autowarefoundation#1058] Use autoware_auto_msgs * [autowarefoundation#1058] Changes for .auto (debug msg tmp fix, common func, tf listener) * [autowarefoundation#1058] Remove unused parameters * [autowarefoundation#1058] Fix ros test * [autowarefoundation#1058] Rm default params from declare_parameters + use autoware types * [autowarefoundation#1058] Use default param file to setup NodeOptions in the ros test * [autowarefoundation#1058] Fix docstring * [autowarefoundation#1058] Replace receiving a Twist with a VehicleKinematicState * [autowarefoundation#1058] Change class variables format to m_ prefix * [autowarefoundation#1058] Fix plugin name of LongitudinalController in CMakeLists.txt * [autowarefoundation#1058] Fix copyright dates * [autowarefoundation#1058] Reorder includes * [autowarefoundation#1058] Add some tests (~89% coverage without disabling flaky tests) * [autowarefoundation#1058] Add more tests (90+% coverage without disabling flaky tests) * [autowarefoundation#1058] Use Float32MultiArrayDiagnostic message for debug and slope * [autowarefoundation#1058] Calculate wheel_base value from vehicle parameters * [autowarefoundation#1058] Cleanup redundant logger setting in tests * [autowarefoundation#1058] Set ROS_DOMAIN_ID when running tests to prevent CI failures * [autowarefoundation#1058] Remove TF listener and use published vehicle state instead * [autowarefoundation#1058] Change smoke tests to use autoware_testing * [autowarefoundation#1058] Add plotjuggler cfg for both lateral and longitudinal control * [autowarefoundation#1058] Improve design documents * [autowarefoundation#1058] Disable flaky test * [autowarefoundation#1058] Properly transform vehicle state in longitudinal node * [autowarefoundation#1058] Fix TF buffer of lateral controller * [autowarefoundation#1058] Tuning of lateral controller for LGSVL * [autowarefoundation#1058] Fix formating * [autowarefoundation#1058] Fix /tf_static sub to be transient_local * [autowarefoundation#1058] Fix yaw recalculation of reverse trajs in the lateral controller * modify trajectory_follower for galactic build Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [autowarefoundation#1379] Update trajectory_follower * [autowarefoundation#1379] Update simple_planning_simulator * [autowarefoundation#1379] Update trajectory_follower_nodes * apply trajectory msg modification in control Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move directory Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remote control/trajectory_follower level dorectpry Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove .iv trajectory follower Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use .auto trajectory_follower Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove .iv simple_planning_simulator & osqp_interface Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use .iv simple_planning_simulator & osqp_interface Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add tmp_autoware_auto_dependencies Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * tmporally add autoware_auto_msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply .auto message split Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix build depend Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix packages using osqp * fix autoware_auto_geometry * ignore lint of some packages * ignore ament_lint of some packages * ignore lint/pre-commit of trajectory_follower_nodes * disable unit tests of some packages Co-authored-by: Maxime CLEMENT <maxime.clement@tier4.jp> Co-authored-by: Joshua Whitley <josh.whitley@autoware.org> Co-authored-by: Igor Bogoslavskyi <igor.bogoslavskyi@gmail.com> Co-authored-by: MIURA Yasuyuki <kokosabu@gmail.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp> * add readme signal processing (autowarefoundation#587) * add readme signal processing * better fix * add readme in kalman_filter (autowarefoundation#633) * ci(pre-commit): autofix Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Frederik Beaujean <72439809+fred-apex-ai@users.noreply.github.com> Co-authored-by: Yunus Emre Çalışkan <yunus.ec@gmail.com> Co-authored-by: Servando <43142004+sgermanserrano@users.noreply.github.com> Co-authored-by: Nikolai Morin <nnmmgit@gmail.com> Co-authored-by: Jilada Eccleston <jilada.eccleston@gmail.com> Co-authored-by: Jilada Eccleston <jilada.eccleston@tier4.jp> Co-authored-by: Esteve Fernandez <esteve@apache.org> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: Keisuke Shima <keisuke.shima@tier4.jp> Co-authored-by: shin <8327162+0x126@users.noreply.github.com> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: pre-commit <pre-commit@example.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com> Co-authored-by: Yohei Mishina <66298900+YoheiMishina@users.noreply.github.com> Co-authored-by: Maxime CLEMENT <maxime.clement@tier4.jp> Co-authored-by: Joshua Whitley <josh.whitley@autoware.org> Co-authored-by: Igor Bogoslavskyi <igor.bogoslavskyi@gmail.com> Co-authored-by: MIURA Yasuyuki <kokosabu@gmail.com> Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…nt from ego (autowarefoundation#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

* fix(behavior_velocity): calculate detection area from the nearest point from ego (#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(longitudinal_controller_node, vehicle_cmd_gate): update stopped condition and behavior (#700) * fix(longitudinal_controller_node): parameterize stopped state entry condition Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(longitudinal_controller_node): simply set stopped velocity in STOPPED STATE Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(vehicle_cmd_gate): check time duration since the vehicle stopped Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs(autoware_testing): fix link (#741) * docs(autoware_testing): fix link * fix typo Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix: trajectory visualizer (#745) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(tier4_autoware_utils): modify build error in rolling (#720) * fix(tier4_autoware_utils): modify build error in rolling Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lanelet2_extension): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ekf_localizer): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planning_algorithms): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(interpolation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lane_departure_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(map_based_prediction): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ground_segmentation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(motion_velocity_smoother): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(multi_object_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(control_performance_analysis): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detected_object_validation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(goal_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ndt_scan_matcher): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(route_handler): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_path_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(mission_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_avoidance_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_stop_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_collision_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(shape_estimation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_velocity_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(path_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detection_by_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(surround_obstacle_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(probabilistic_occupancy_grid_map): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_debug_tools): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_vehicle_rviz_plugin): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(pure_pursuit): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower_nodes): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(occupancy_grid_map_outlier_filter): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(traffic_light_map_based_detector): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_error_monitor): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_evaluator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lidar_centerpoint): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity): handle the case when finding index failed (#746) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * feat: add scene module of dynamic obstacle stop Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix warnings Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add temporary debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to go after stopping Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix parameter namespace Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use planner util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation when multiple obstacles are detected in one step polygon Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary debug Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option to apply limit jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Modify parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to exclude obstacles outside of partition Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify search distance for partitions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * apply voxel grid filter to input points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * set smoother param by passing node instance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add parameter for velocity limit (temporary) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * avoid acceleration when stopping for obstacles Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix lateral distance to publish distance from vehicle side Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify the location to publish longitudinal distance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation of stop index Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use current velocity for stop dicision Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic parameter for slow down limit Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value to display passing dist Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify stopping velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update param Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use smoother in planner data Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use path with lane id instead of trajectory Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary data check Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * extend path to consider obstacles after the end of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename public member variables Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unused paramter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create detection area using util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of stop distance marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * make option for detection method easier to understand Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove parameter about whether to enable this feature Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * calculate and publish debug data in function Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add comment Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of detection area when calculation of stop distance failed Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option whether to specify the jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix format Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary includes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launcher for compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch and config for dynamic obstacle stop planner Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix finding package name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change of util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * relay points for simulation Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix position and color of stop line marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pre-commit fixes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add documents for dynamic obstacle stop module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update documents Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: begin a sentence with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: replace predicted with smoothed for path velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create interface class to switch method Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * run compare map filter only when points method is used Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused functions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename functions for inserting velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename parameter of path_size to max_prediction_time Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): dynamic obstacle stop planner docs Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): add ego vehicle description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): change space to hyphen Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change smoothed to expected target velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Start a sentence in figure with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use voxel distance based compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * select detection method from param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * do not launch as default for now Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename dynamic_obstacle_stop to run_out Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary change Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change default to false Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update cmake to build run_out module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch_run_out parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add note for compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change for virtual wall marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename the parameters for smoother Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * launch compare map only when run out module is enabled Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add calculation time for modify path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Tomoya Kimura <tomoya.kimura@tier4.jp> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>

* fix(behavior_velocity): calculate detection area from the nearest point from ego (autowarefoundation#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(longitudinal_controller_node, vehicle_cmd_gate): update stopped condition and behavior (autowarefoundation#700) * fix(longitudinal_controller_node): parameterize stopped state entry condition Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(longitudinal_controller_node): simply set stopped velocity in STOPPED STATE Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(vehicle_cmd_gate): check time duration since the vehicle stopped Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs(autoware_testing): fix link (autowarefoundation#741) * docs(autoware_testing): fix link * fix typo Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix: trajectory visualizer (autowarefoundation#745) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(tier4_autoware_utils): modify build error in rolling (autowarefoundation#720) * fix(tier4_autoware_utils): modify build error in rolling Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lanelet2_extension): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ekf_localizer): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planning_algorithms): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(interpolation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lane_departure_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(map_based_prediction): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ground_segmentation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(motion_velocity_smoother): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(multi_object_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(control_performance_analysis): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detected_object_validation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(goal_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ndt_scan_matcher): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(route_handler): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_path_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(mission_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_avoidance_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_stop_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_collision_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(shape_estimation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_velocity_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(path_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detection_by_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(surround_obstacle_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(probabilistic_occupancy_grid_map): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_debug_tools): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_vehicle_rviz_plugin): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(pure_pursuit): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower_nodes): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(occupancy_grid_map_outlier_filter): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(traffic_light_map_based_detector): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_error_monitor): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_evaluator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lidar_centerpoint): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity): handle the case when finding index failed (autowarefoundation#746) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * feat: add scene module of dynamic obstacle stop Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix warnings Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add temporary debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to go after stopping Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix parameter namespace Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use planner util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation when multiple obstacles are detected in one step polygon Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary debug Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option to apply limit jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Modify parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to exclude obstacles outside of partition Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify search distance for partitions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * apply voxel grid filter to input points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * set smoother param by passing node instance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add parameter for velocity limit (temporary) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * avoid acceleration when stopping for obstacles Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix lateral distance to publish distance from vehicle side Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify the location to publish longitudinal distance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation of stop index Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use current velocity for stop dicision Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic parameter for slow down limit Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value to display passing dist Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify stopping velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update param Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use smoother in planner data Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use path with lane id instead of trajectory Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary data check Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * extend path to consider obstacles after the end of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename public member variables Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unused paramter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create detection area using util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of stop distance marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * make option for detection method easier to understand Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove parameter about whether to enable this feature Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * calculate and publish debug data in function Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add comment Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of detection area when calculation of stop distance failed Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option whether to specify the jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix format Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary includes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launcher for compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch and config for dynamic obstacle stop planner Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix finding package name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change of util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * relay points for simulation Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix position and color of stop line marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pre-commit fixes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add documents for dynamic obstacle stop module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update documents Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: begin a sentence with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: replace predicted with smoothed for path velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create interface class to switch method Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * run compare map filter only when points method is used Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused functions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename functions for inserting velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename parameter of path_size to max_prediction_time Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): dynamic obstacle stop planner docs Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): add ego vehicle description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): change space to hyphen Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change smoothed to expected target velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Start a sentence in figure with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use voxel distance based compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * select detection method from param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * do not launch as default for now Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename dynamic_obstacle_stop to run_out Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary change Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change default to false Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update cmake to build run_out module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch_run_out parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add note for compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change for virtual wall marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename the parameters for smoother Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * launch compare map only when run out module is enabled Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add calculation time for modify path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Tomoya Kimura <tomoya.kimura@tier4.jp> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* fix(behavior_velocity): calculate detection area from the nearest point from ego (#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(longitudinal_controller_node, vehicle_cmd_gate): update stopped condition and behavior (#700) * fix(longitudinal_controller_node): parameterize stopped state entry condition Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(longitudinal_controller_node): simply set stopped velocity in STOPPED STATE Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(vehicle_cmd_gate): check time duration since the vehicle stopped Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs(autoware_testing): fix link (#741) * docs(autoware_testing): fix link * fix typo Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix: trajectory visualizer (#745) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(tier4_autoware_utils): modify build error in rolling (#720) * fix(tier4_autoware_utils): modify build error in rolling Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lanelet2_extension): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ekf_localizer): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planning_algorithms): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(interpolation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lane_departure_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(map_based_prediction): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ground_segmentation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(motion_velocity_smoother): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(multi_object_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(control_performance_analysis): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detected_object_validation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(goal_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ndt_scan_matcher): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(route_handler): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_path_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(mission_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_avoidance_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_stop_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_collision_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(shape_estimation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_velocity_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(path_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detection_by_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(surround_obstacle_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(probabilistic_occupancy_grid_map): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_debug_tools): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_vehicle_rviz_plugin): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(pure_pursuit): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower_nodes): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(occupancy_grid_map_outlier_filter): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(traffic_light_map_based_detector): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_error_monitor): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_evaluator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lidar_centerpoint): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity): handle the case when finding index failed (#746) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * feat: add scene module of dynamic obstacle stop Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix warnings Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add temporary debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to go after stopping Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix parameter namespace Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use planner util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation when multiple obstacles are detected in one step polygon Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary debug Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option to apply limit jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Modify parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to exclude obstacles outside of partition Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify search distance for partitions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * apply voxel grid filter to input points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * set smoother param by passing node instance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add parameter for velocity limit (temporary) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * avoid acceleration when stopping for obstacles Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix lateral distance to publish distance from vehicle side Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify the location to publish longitudinal distance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation of stop index Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use current velocity for stop dicision Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic parameter for slow down limit Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value to display passing dist Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify stopping velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update param Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use smoother in planner data Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use path with lane id instead of trajectory Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary data check Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * extend path to consider obstacles after the end of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename public member variables Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unused paramter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create detection area using util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of stop distance marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * make option for detection method easier to understand Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove parameter about whether to enable this feature Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * calculate and publish debug data in function Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add comment Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of detection area when calculation of stop distance failed Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option whether to specify the jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix format Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary includes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launcher for compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch and config for dynamic obstacle stop planner Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix finding package name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change of util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * relay points for simulation Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix position and color of stop line marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pre-commit fixes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add documents for dynamic obstacle stop module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update documents Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: begin a sentence with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: replace predicted with smoothed for path velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create interface class to switch method Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * run compare map filter only when points method is used Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused functions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename functions for inserting velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename parameter of path_size to max_prediction_time Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): dynamic obstacle stop planner docs Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): add ego vehicle description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): change space to hyphen Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change smoothed to expected target velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Start a sentence in figure with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use voxel distance based compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * select detection method from param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * do not launch as default for now Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename dynamic_obstacle_stop to run_out Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary change Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change default to false Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update cmake to build run_out module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch_run_out parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add note for compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change for virtual wall marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename the parameters for smoother Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * launch compare map only when run out module is enabled Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add calculation time for modify path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Tomoya Kimura <tomoya.kimura@tier4.jp> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Xinyu Wang <xinyu.wang@tier4.jp>

…nt from ego (tier4#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

* fix(behavior_velocity): calculate detection area from the nearest point from ego (tier4#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(longitudinal_controller_node, vehicle_cmd_gate): update stopped condition and behavior (tier4#700) * fix(longitudinal_controller_node): parameterize stopped state entry condition Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(longitudinal_controller_node): simply set stopped velocity in STOPPED STATE Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(vehicle_cmd_gate): check time duration since the vehicle stopped Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs(autoware_testing): fix link (tier4#741) * docs(autoware_testing): fix link * fix typo Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix: trajectory visualizer (tier4#745) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(tier4_autoware_utils): modify build error in rolling (tier4#720) * fix(tier4_autoware_utils): modify build error in rolling Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lanelet2_extension): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ekf_localizer): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planning_algorithms): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(interpolation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lane_departure_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(map_based_prediction): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ground_segmentation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(motion_velocity_smoother): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(multi_object_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(control_performance_analysis): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detected_object_validation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(goal_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ndt_scan_matcher): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(route_handler): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_path_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(mission_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_avoidance_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_stop_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_collision_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(shape_estimation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_velocity_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(path_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detection_by_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(surround_obstacle_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(probabilistic_occupancy_grid_map): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_debug_tools): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_vehicle_rviz_plugin): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(pure_pursuit): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower_nodes): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(occupancy_grid_map_outlier_filter): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(traffic_light_map_based_detector): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_error_monitor): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_evaluator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lidar_centerpoint): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity): handle the case when finding index failed (tier4#746) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * feat: add scene module of dynamic obstacle stop Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix warnings Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add temporary debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to go after stopping Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix parameter namespace Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use planner util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation when multiple obstacles are detected in one step polygon Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary debug Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option to apply limit jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Modify parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to exclude obstacles outside of partition Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify search distance for partitions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * apply voxel grid filter to input points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * set smoother param by passing node instance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add parameter for velocity limit (temporary) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * avoid acceleration when stopping for obstacles Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix lateral distance to publish distance from vehicle side Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify the location to publish longitudinal distance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation of stop index Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use current velocity for stop dicision Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic parameter for slow down limit Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value to display passing dist Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify stopping velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update param Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use smoother in planner data Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use path with lane id instead of trajectory Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary data check Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * extend path to consider obstacles after the end of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename public member variables Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unused paramter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create detection area using util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of stop distance marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * make option for detection method easier to understand Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove parameter about whether to enable this feature Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * calculate and publish debug data in function Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add comment Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of detection area when calculation of stop distance failed Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option whether to specify the jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix format Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary includes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launcher for compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch and config for dynamic obstacle stop planner Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix finding package name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change of util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * relay points for simulation Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix position and color of stop line marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pre-commit fixes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add documents for dynamic obstacle stop module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update documents Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: begin a sentence with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: replace predicted with smoothed for path velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create interface class to switch method Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * run compare map filter only when points method is used Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused functions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename functions for inserting velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename parameter of path_size to max_prediction_time Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): dynamic obstacle stop planner docs Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): add ego vehicle description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): change space to hyphen Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change smoothed to expected target velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Start a sentence in figure with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use voxel distance based compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * select detection method from param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * do not launch as default for now Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename dynamic_obstacle_stop to run_out Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary change Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change default to false Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update cmake to build run_out module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch_run_out parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add note for compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change for virtual wall marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename the parameters for smoother Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * launch compare map only when run out module is enabled Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add calculation time for modify path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Tomoya Kimura <tomoya.kimura@tier4.jp> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>

…nt from ego (tier4#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

* fix(behavior_velocity): calculate detection area from the nearest point from ego (tier4#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(longitudinal_controller_node, vehicle_cmd_gate): update stopped condition and behavior (tier4#700) * fix(longitudinal_controller_node): parameterize stopped state entry condition Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(longitudinal_controller_node): simply set stopped velocity in STOPPED STATE Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(vehicle_cmd_gate): check time duration since the vehicle stopped Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs(autoware_testing): fix link (tier4#741) * docs(autoware_testing): fix link * fix typo Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix: trajectory visualizer (tier4#745) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(tier4_autoware_utils): modify build error in rolling (tier4#720) * fix(tier4_autoware_utils): modify build error in rolling Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lanelet2_extension): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ekf_localizer): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planning_algorithms): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(interpolation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lane_departure_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(map_based_prediction): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ground_segmentation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(motion_velocity_smoother): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(multi_object_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(control_performance_analysis): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detected_object_validation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(goal_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ndt_scan_matcher): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(route_handler): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_path_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(mission_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_avoidance_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_stop_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_collision_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(shape_estimation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_velocity_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(path_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detection_by_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(surround_obstacle_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(probabilistic_occupancy_grid_map): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_debug_tools): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_vehicle_rviz_plugin): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(pure_pursuit): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower_nodes): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(occupancy_grid_map_outlier_filter): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(traffic_light_map_based_detector): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_error_monitor): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_evaluator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lidar_centerpoint): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity): handle the case when finding index failed (tier4#746) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * feat: add scene module of dynamic obstacle stop Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix warnings Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add temporary debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to go after stopping Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix parameter namespace Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use planner util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation when multiple obstacles are detected in one step polygon Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary debug Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option to apply limit jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Modify parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to exclude obstacles outside of partition Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify search distance for partitions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * apply voxel grid filter to input points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * set smoother param by passing node instance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add parameter for velocity limit (temporary) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * avoid acceleration when stopping for obstacles Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix lateral distance to publish distance from vehicle side Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify the location to publish longitudinal distance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation of stop index Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use current velocity for stop dicision Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic parameter for slow down limit Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value to display passing dist Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify stopping velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update param Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use smoother in planner data Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use path with lane id instead of trajectory Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary data check Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * extend path to consider obstacles after the end of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename public member variables Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unused paramter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create detection area using util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of stop distance marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * make option for detection method easier to understand Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove parameter about whether to enable this feature Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * calculate and publish debug data in function Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add comment Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of detection area when calculation of stop distance failed Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option whether to specify the jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix format Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary includes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launcher for compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch and config for dynamic obstacle stop planner Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix finding package name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change of util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * relay points for simulation Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix position and color of stop line marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pre-commit fixes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add documents for dynamic obstacle stop module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update documents Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: begin a sentence with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: replace predicted with smoothed for path velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create interface class to switch method Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * run compare map filter only when points method is used Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused functions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename functions for inserting velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename parameter of path_size to max_prediction_time Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): dynamic obstacle stop planner docs Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): add ego vehicle description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): change space to hyphen Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change smoothed to expected target velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Start a sentence in figure with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use voxel distance based compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * select detection method from param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * do not launch as default for now Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename dynamic_obstacle_stop to run_out Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary change Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change default to false Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update cmake to build run_out module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch_run_out parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add note for compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change for virtual wall marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename the parameters for smoother Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * launch compare map only when run out module is enabled Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add calculation time for modify path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Tomoya Kimura <tomoya.kimura@tier4.jp> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>

…nt from ego (tier4#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

* fix(behavior_velocity): calculate detection area from the nearest point from ego (tier4#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(longitudinal_controller_node, vehicle_cmd_gate): update stopped condition and behavior (tier4#700) * fix(longitudinal_controller_node): parameterize stopped state entry condition Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(longitudinal_controller_node): simply set stopped velocity in STOPPED STATE Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(vehicle_cmd_gate): check time duration since the vehicle stopped Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs(autoware_testing): fix link (tier4#741) * docs(autoware_testing): fix link * fix typo Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix: trajectory visualizer (tier4#745) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(tier4_autoware_utils): modify build error in rolling (tier4#720) * fix(tier4_autoware_utils): modify build error in rolling Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lanelet2_extension): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ekf_localizer): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planning_algorithms): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(interpolation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lane_departure_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(map_based_prediction): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ground_segmentation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(motion_velocity_smoother): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(multi_object_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(control_performance_analysis): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detected_object_validation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(goal_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ndt_scan_matcher): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(route_handler): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_path_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(mission_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_avoidance_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_stop_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_collision_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(shape_estimation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_velocity_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(path_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detection_by_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(surround_obstacle_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(probabilistic_occupancy_grid_map): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_debug_tools): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_vehicle_rviz_plugin): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(pure_pursuit): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower_nodes): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(occupancy_grid_map_outlier_filter): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(traffic_light_map_based_detector): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_error_monitor): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_evaluator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lidar_centerpoint): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity): handle the case when finding index failed (tier4#746) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * feat: add scene module of dynamic obstacle stop Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix warnings Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add temporary debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to go after stopping Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix parameter namespace Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use planner util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation when multiple obstacles are detected in one step polygon Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary debug Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option to apply limit jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Modify parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to exclude obstacles outside of partition Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify search distance for partitions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * apply voxel grid filter to input points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * set smoother param by passing node instance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add parameter for velocity limit (temporary) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * avoid acceleration when stopping for obstacles Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix lateral distance to publish distance from vehicle side Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify the location to publish longitudinal distance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation of stop index Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use current velocity for stop dicision Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic parameter for slow down limit Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value to display passing dist Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify stopping velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update param Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use smoother in planner data Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use path with lane id instead of trajectory Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary data check Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * extend path to consider obstacles after the end of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename public member variables Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unused paramter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create detection area using util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of stop distance marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * make option for detection method easier to understand Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove parameter about whether to enable this feature Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * calculate and publish debug data in function Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add comment Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of detection area when calculation of stop distance failed Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option whether to specify the jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix format Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary includes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launcher for compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch and config for dynamic obstacle stop planner Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix finding package name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change of util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * relay points for simulation Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix position and color of stop line marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pre-commit fixes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add documents for dynamic obstacle stop module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update documents Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: begin a sentence with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: replace predicted with smoothed for path velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create interface class to switch method Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * run compare map filter only when points method is used Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused functions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename functions for inserting velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename parameter of path_size to max_prediction_time Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): dynamic obstacle stop planner docs Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): add ego vehicle description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): change space to hyphen Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change smoothed to expected target velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Start a sentence in figure with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use voxel distance based compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * select detection method from param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * do not launch as default for now Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename dynamic_obstacle_stop to run_out Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary change Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change default to false Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update cmake to build run_out module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch_run_out parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add note for compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change for virtual wall marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename the parameters for smoother Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * launch compare map only when run out module is enabled Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add calculation time for modify path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Tomoya Kimura <tomoya.kimura@tier4.jp> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>

…nt from ego (tier4#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

* fix(behavior_velocity): calculate detection area from the nearest point from ego (tier4#730) * fix(behavior_velocity): calculate lateral distance from the beginning of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add argument of min_velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use veloicty from the nearest point from ego Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pass struct by reference Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix to interpolate point in util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(longitudinal_controller_node, vehicle_cmd_gate): update stopped condition and behavior (tier4#700) * fix(longitudinal_controller_node): parameterize stopped state entry condition Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(longitudinal_controller_node): simply set stopped velocity in STOPPED STATE Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(vehicle_cmd_gate): check time duration since the vehicle stopped Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs(autoware_testing): fix link (tier4#741) * docs(autoware_testing): fix link * fix typo Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix: trajectory visualizer (tier4#745) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(tier4_autoware_utils): modify build error in rolling (tier4#720) * fix(tier4_autoware_utils): modify build error in rolling Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lanelet2_extension): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ekf_localizer): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planning_algorithms): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(interpolation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(freespace_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lane_departure_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(map_based_prediction): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ground_segmentation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(motion_velocity_smoother): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(multi_object_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(control_performance_analysis): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detected_object_validation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(goal_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(ndt_scan_matcher): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(route_handler): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_path_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(mission_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_avoidance_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_stop_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(obstacle_collision_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(shape_estimation): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(behavior_velocity_planner): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(path_distance_calculator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(detection_by_tracker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(surround_obstacle_checker): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(probabilistic_occupancy_grid_map): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_debug_tools): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(tier4_vehicle_rviz_plugin): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(pure_pursuit): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(trajectory_follower_nodes): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(occupancy_grid_map_outlier_filter): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(traffic_light_map_based_detector): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_error_monitor): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(planning_evaluator): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix(lidar_centerpoint): add target compile definition for geometry2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity): handle the case when finding index failed (tier4#746) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * feat: add scene module of dynamic obstacle stop Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix warnings Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add temporary debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to go after stopping Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix parameter namespace Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use planner util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation when multiple obstacles are detected in one step polygon Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary debug Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option to apply limit jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Modify parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add feature to exclude obstacles outside of partition Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify search distance for partitions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * apply voxel grid filter to input points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * set smoother param by passing node instance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add parameter for velocity limit (temporary) Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * avoid acceleration when stopping for obstacles Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix lateral distance to publish distance from vehicle side Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify the location to publish longitudinal distance Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix calculation of stop index Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use current velocity for stop dicision Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add dynamic parameter for slow down limit Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add debug value to display passing dist Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * modify stopping velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update param Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use smoother in planner data Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use path with lane id instead of trajectory Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary data check Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * extend path to consider obstacles after the end of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename public member variables Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unused paramter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create detection area using util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of stop distance marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * make option for detection method easier to understand Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove parameter about whether to enable this feature Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * calculate and publish debug data in function Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add comment Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix visualization of detection area when calculation of stop distance failed Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add option whether to specify the jerk Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix format Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change parameter name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove dynamic reconfigure Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary includes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launcher for compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch and config for dynamic obstacle stop planner Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix finding package name Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change of util Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * relay points for simulation Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix position and color of stop line marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * pre-commit fixes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary comments Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix Copyright Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add documents for dynamic obstacle stop module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update documents Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: begin a sentence with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * docs: replace predicted with smoothed for path velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * create interface class to switch method Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * run compare map filter only when points method is used Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * delete unused functions Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename functions for inserting velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename parameter of path_size to max_prediction_time Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): dynamic obstacle stop planner docs Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): add ego vehicle description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix(behavior_velocity_planner): change space to hyphen Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change smoothed to expected target velocity Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Start a sentence in figure with a capital letter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * use voxel distance based compare map Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * select detection method from param file Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * do not launch as default for now Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename dynamic_obstacle_stop to run_out Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary change Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * remove unnecessary changes Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix typo Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * change default to false Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update cmake to build run_out module Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add launch_run_out parameter Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * Add note for compare map filtered points Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * handle the change for virtual wall marker Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * rename the parameters for smoother Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * fix build error in humble Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * launch compare map only when run out module is enabled Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * add calculation time for modify path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> * update a document Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve.fernandez@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Tomoya Kimura <tomoya.kimura@tier4.jp> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com>

chore: sync upstream

* feat: add get_ml_model script (autowarefoundation#688) * feat: add get_ml_model script Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> * style(pre-commit): autofix * fix: fix pre-commit Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> * style(pre-commit): autofix --------- Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> Co-authored-by: 1222-takeshi <1222-takeshi@users.noreply.github.com> * feat: update model install script (autowarefoundation#690) Signed-off-by: Shin-kyoto <aquashin0202@gmail.com> --------- Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> Signed-off-by: Shin-kyoto <aquashin0202@gmail.com> Co-authored-by: 1222-takeshi <1222-takeshi@users.noreply.github.com> Co-authored-by: Shintaro Tomie <58775300+Shin-kyoto@users.noreply.github.com>

* feat: change repos to latest autoware Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> * chore: sync latest (autowarefoundation#505) * fix: fix typo vender -> vendor (autowarefoundation#504) * chore: sync files (autowarefoundation#497) Signed-off-by: GitHub <noreply@github.com> Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> * fix: use hash for Autoware's Ansible Galaxy (autowarefoundation#506) * chore: remove kvaser role (autowarefoundation#491) * chore: remove kvaser roles (autowarefoundation#145) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> * fix: remove kvaser role (autowarefoundation#146) Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> * chore: sync files (autowarefoundation#507) * chore: sync files Signed-off-by: GitHub <noreply@github.com> * Update ansible-galaxy-requirements.yaml Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: GitHub <noreply@github.com> Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: tier4-autoware-private-bot[bot] <87871706+tier4-autoware-private-bot[bot]@users.noreply.github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Tomoya Kimura <tomoya.kimura@tier4.jp> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * [repos] add rclcpp to fix server connection failure in scenario test Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix(rclcpp): use humble retry patch branch (autowarefoundation#575) fix(rclcpp): use humble retry patch branch Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * feat: add sync from awf-latest -> awf-latest-xx1 (autowarefoundation#578) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * feat: change launch repo (autowarefoundation#603) feat: change launch repo to awf/autoware_launch Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * chore: remove unnecessary sync (autowarefoundation#611) * chore: remove unnecessary sync Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * add new sync for reference design Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> --------- Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * feat: remove rclcpp hotfix (autowarefoundation#610) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * feat: add eagleye packages in autoware.repos Signed-off-by: kminoda <koji.minoda@tier4.jp> * style(pre-commit): autofix * feat: use develop/planning_control scenario_simulator_v2 (autowarefoundation#633) Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * chore(repos): update branch of `transport_drivers` (autowarefoundation#636) chore(repos): update repos Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * chore: update simulator.repos (autowarefoundation#685) update branch of scenario_simulator_v2 from develop/planning_control to master Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp> * feat: add run_out's stop margin (autowarefoundation#692) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * feat: add j6_gen1 and ymc_golfcart_m0 description (autowarefoundation#693) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * revert: feat: add j6_gen1 and ymc_golfcart_m0 description (autowarefoundation#693) (autowarefoundation#694) Revert "feat: add j6_gen1 and ymc_golfcart_m0 description (autowarefoundation#693)" This reverts commit 46c1046c68e19404f3d430c8775d7c436266e125. * feat: add j6_gen1 and ymc_golfcart_m0 description (autowarefoundation#695) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * feat: use awf-latest branch for universe and launcher (autowarefoundation#720) * feat: use awf-latest branch for universe and launcher Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update README.md Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * minor update Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix spell Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> --------- Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * chore: sync files (autowarefoundation#708) Signed-off-by: GitHub <noreply@github.com> Co-authored-by: github-actions <github-actions@github.com> * feat: add get ml model script (autowarefoundation#730) * feat: add get_ml_model script (autowarefoundation#688) * feat: add get_ml_model script Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> * style(pre-commit): autofix * fix: fix pre-commit Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> * style(pre-commit): autofix --------- Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> Co-authored-by: 1222-takeshi <1222-takeshi@users.noreply.github.com> * feat: update model install script (autowarefoundation#690) Signed-off-by: Shin-kyoto <aquashin0202@gmail.com> --------- Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> Signed-off-by: Shin-kyoto <aquashin0202@gmail.com> Co-authored-by: 1222-takeshi <1222-takeshi@users.noreply.github.com> Co-authored-by: Shintaro Tomie <58775300+Shin-kyoto@users.noreply.github.com> * chore: remove no longer used ml_model_provider repo (autowarefoundation#731) Signed-off-by: Shunsuke Miura <shunsuke.miura@tier4.jp> * chore: sync files (autowarefoundation#738) Signed-off-by: GitHub <noreply@github.com> Co-authored-by: github-actions <github-actions@github.com> * awf pr 4212 Signed-off-by: Mamoru Sobue <hilo.soblin@gmail.com> * feat: update README.md (autowarefoundation#765) * feat: update README.md Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * remove sync-awf-latest Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix typo Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> --------- Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> --------- Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Signed-off-by: GitHub <noreply@github.com> Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: kminoda <koji.minoda@tier4.jp> Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp> Signed-off-by: 1222-takeshi <m.takeshi1995@gmail.com> Signed-off-by: Shin-kyoto <aquashin0202@gmail.com> Signed-off-by: Shunsuke Miura <shunsuke.miura@tier4.jp> Signed-off-by: Mamoru Sobue <hilo.soblin@gmail.com> Co-authored-by: tomoya.kimura <tomoya.kimura@tier4.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: tier4-autoware-private-bot[bot] <87871706+tier4-autoware-private-bot[bot]@users.noreply.github.com> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com> Co-authored-by: kminoda <koji.minoda@tier4.jp> Co-authored-by: kminoda <kminoda@users.noreply.github.com> Co-authored-by: kminoda <44218668+kminoda@users.noreply.github.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Kyoichi Sugahara <kyoichi.sugahara@tier4.jp> Co-authored-by: github-actions <github-actions@github.com> Co-authored-by: Takeshi Miura <m.takeshi1995@gmail.com> Co-authored-by: 1222-takeshi <1222-takeshi@users.noreply.github.com> Co-authored-by: Shintaro Tomie <58775300+Shin-kyoto@users.noreply.github.com> Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com> Co-authored-by: Mamoru Sobue <hilo.soblin@gmail.com>

…le (autowarefoundation#730) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>

chore: sync awf-latest

TomohitoAndo added 2 commits April 20, 2022 00:34

fix(behavior_velocity): calculate lateral distance from the beginning…

6f30592

… of the path Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

add argument of min_velocity

aad4291

Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

TomohitoAndo changed the title ~~Fix create detection area~~ fix(behavior_velocity): calculate lateral distance from the beginning of the path Apr 19, 2022

TomohitoAndo requested a review from taikitanaka3 April 19, 2022 16:03

use veloicty from the nearest point from ego

200a465

Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

pass struct by reference

10fb00c

Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

fix to interpolate point in util

f4bc7b8

Signed-off-by: Tomohito Ando <tomohito.ando@tier4.jp>

taikitanaka3 approved these changes Apr 21, 2022

View reviewed changes

TomohitoAndo changed the title ~~fix(behavior_velocity): calculate lateral distance from the beginning of the path~~ fix(behavior_velocity): calculate detection area from the nearest point from ego Apr 21, 2022

TomohitoAndo enabled auto-merge (squash) April 21, 2022 04:01

TomohitoAndo merged commit 09cd14a into autowarefoundation:main Apr 21, 2022

TomohitoAndo deleted the fix-create-detection-area branch April 21, 2022 14:05

tier4-autoware-public-bot bot mentioned this pull request Apr 22, 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#730 from tier4/sync-upstream

e0bf702

chore: sync upstream

iwatake2222 pushed a commit to iwatake2222/autoware.universe that referenced this pull request Jan 17, 2025

feat(behavior_velocity_planner): add new 'dynamic_obstacle_stop' modu…

daea9fc

…le (autowarefoundation#730) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>

Kazunori-Nakajima pushed a commit to Kazunori-Nakajima/autoware.universe that referenced this pull request Feb 6, 2025

Merge pull request autowarefoundation#730 from tier4/sync-awf-latest

2cf9d3f

chore: sync awf-latest

Provide feedback

Saved searches

Use saved searches to filter your results more quickly

fix(behavior_velocity): calculate detection area from the nearest point from ego #730

fix(behavior_velocity): calculate detection area from the nearest point from ego #730

TomohitoAndo commented Apr 19, 2022 •

edited

Loading

TomohitoAndo commented Apr 19, 2022

taikitanaka3 commented Apr 19, 2022 •

edited

Loading

taikitanaka3 commented Apr 19, 2022

codecov bot commented Apr 20, 2022 •

edited

Loading

TomohitoAndo commented Apr 20, 2022

TomohitoAndo commented Apr 20, 2022

TomohitoAndo commented Apr 20, 2022

taikitanaka3 commented Apr 20, 2022

TomohitoAndo commented Apr 21, 2022

taikitanaka3 left a comment

fix(behavior_velocity): calculate detection area from the nearest point from ego #730

fix(behavior_velocity): calculate detection area from the nearest point from ego #730

Conversation

TomohitoAndo commented Apr 19, 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

TomohitoAndo commented Apr 19, 2022

taikitanaka3 commented Apr 19, 2022 • edited Loading

taikitanaka3 commented Apr 19, 2022

codecov bot commented Apr 20, 2022 • edited Loading

Codecov Report

TomohitoAndo commented Apr 20, 2022

TomohitoAndo commented Apr 20, 2022

TomohitoAndo commented Apr 20, 2022

taikitanaka3 commented Apr 20, 2022

TomohitoAndo commented Apr 21, 2022

taikitanaka3 left a comment

Choose a reason for hiding this comment

TomohitoAndo commented Apr 19, 2022 •

edited

Loading

taikitanaka3 commented Apr 19, 2022 •

edited

Loading

codecov bot commented Apr 20, 2022 •

edited

Loading