feat(obstacle_velocity_planner): add obstacle_velocity_planner from .iv's development #484

takayuki5168 · 2022-03-07T02:26:18Z

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

Related Issue(required)

Description(required)

Review Procedure(required)

Related PR(optional)

Pre-Review Checklist for the PR Author

PR Author should check the checkboxes below when creating the PR.

Read commit-guidelines
Assign PR to reviewer

If you are adding new package following items are required:

Documentation with description of the package is available
A sample launch file and parameter file are available if the package contains executable nodes

Checklist for the PR Reviewer

Reviewers should check the checkboxes below before approval.

Commits are properly organized and messages are according to the guideline
PR title describes the changes

Post-Review Checklist for the PR Author

PR Author should check the checkboxes below before merging.

All open points are addressed and tracked via issues or tickets

CI Checks

Build and test for PR / build-and-test-pr: Required to pass before the merge.
Build and test for PR / clang-tidy-pr: NOT required to pass before the merge. It is up to the reviewer(s). Found false positives? See the [guidelines][clang-tidy-guidelines].
Check spelling: NOT required to pass before the merge. It is up to the reviewer(s). See here if you want to add some words to the spell check dictionary.

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

* release v0.4.0 * add dynamic_reconfigure to obstacle avoidance planner (autowarefoundation#673) * fix apply dynamic param (autowarefoundation#704) * add warning logging to foa.data.is_is_avoidance_possible (autowarefoundation#725) * Feature/improve obstacle avoidance (autowarefoundation#731) * add license terms (autowarefoundation#941) * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Revert "remove ROS1 packages temporarily" This reverts commit 10813fa0e7b67c9ad6c7d4df6aeee0931c866b41. Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * add COLCON_IGNORE to ros1 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Rename launch files to launch.xml (autowarefoundation#28) * Port of obstacle avoidance planner to ROS2 (autowarefoundation#83) * Port to ROS2 Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed ros/console include Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added THROTTLE Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Changed numbers to floats Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Removed <double> from params Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Use new msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Replaced dynamic reconfigure Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Added EnableAvoidance.msg Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Fixed parameter mismatch Signed-off-by: Servando German Serrano <servando.german.serrano@linaro.org> * Fix launch files (autowarefoundation#122) * [surround_obstacle_checker] add parameter and arguments to launch file Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [obstacle_stop_planner] modify launch file to remap trajectory from argument Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [obstacle_avoidance_planner] modify launch file to remap topics from arguments Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * [motion_velocity_optimizer] modify launch file to enable remapping from argument Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Convert calls of Duration to Duration::from_seconds where appropriate (autowarefoundation#131) * 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 * [lane_change_planner] [obstacle_avoidance_planner] fix clock type (autowarefoundation#183) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Add linters to obstacle_avoidance_planner (autowarefoundation#158) * Added linters to obstacle_avoidance_planner * Fix header issues * Fix linting issues * Fix more linting issues * Fix even more linting issues * Final linting fixes * Fix dependencies * Use ament_cmake_cppcheck and ament_cmake_cpplint * [obstacle_avoidance_planner] add missing return values (autowarefoundation#214) Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Obstacle avoidance planner 0.8 (autowarefoundation#308) * fix rosparam typo Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * empty check before access Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * modify way to fix the points Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * apply format Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add baselink2front dist for virutual_wall Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add avoiding object type Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add exception handling for avoiding object Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * apply format Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add vehicle_info dependency Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * modify to pass lint Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * fix lint Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add vehicle_info_param in launch Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * modify nested pram declaration Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * apply ament-uncrastify Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * fix boost_none handling (autowarefoundation#349) * fix boost_none handling Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add another one Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add another one Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add another one Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * Rename ROS-related .yaml to .param.yaml (autowarefoundation#352) * Rename ROS-related .yaml to .param.yaml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove prefix 'default_' of yaml files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename vehicle_info.yaml to vehicle_info.param.yaml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename diagnostic_aggregator's param files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix overlooked parameters Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * rename vehicle_info_param to vehicle_param_file (autowarefoundation#353) Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * Ros2 fix topic name part1 (autowarefoundation#408) * Fix topic name of lane_departure_checker debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of mpc_follower debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of velocity_controller debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of motion_velocity_optimizer debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_change_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_avoidance_planner debug Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of motion_velocity_optimizer Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_departure_checker Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of mpc_follower Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of velocity_controller Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of lane_change_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_avoidance_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of obstacle_stop_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of freespace_planner Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of surround_obstacle_checker Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of emergency_handler Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint errors Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix typo Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix typo in planning module (autowarefoundation#432) * Fix typo in planning module * Fix remaining errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply cpplint and uncrustify. Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix duration (autowarefoundation#445) * fix duration Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * change to from_seconds Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * fix other duration Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * replace -1 with 0 Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * apply ament_lint_common Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * uncrustify Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add space Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * add another space Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * update log (autowarefoundation#456) Signed-off-by: Kosuke Murakami <kosuke.murakami@tier4.jp> * fix bug (autowarefoundation#457) * add use_sim-time option (autowarefoundation#454) * Format launch files (autowarefoundation#1219) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix rolling build errors (autowarefoundation#1225) * Add missing include files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Replace rclcpp::Duration Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Use reference for exceptions Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Use from_seconds Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Sync public repo (autowarefoundation#1228) * [simple_planning_simulator] add readme (autowarefoundation#424) * add readme of simple_planning_simulator Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update simulator/simple_planning_simulator/README.md * set transit_margin_time to intersect. planner (autowarefoundation#460) * Fix pose2twist (autowarefoundation#462) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Ros2 vehicle info param server (autowarefoundation#447) * add vehicle_info_param_server * update vehicle info * apply format * fix bug * skip unnecessary search * delete vehicle param file * fix bug * Ros2 fix topic name part2 (autowarefoundation#425) * Fix topic name of traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_visualization Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name of traffic_light_map_based_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_recognition Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix issues in hdd_reader (autowarefoundation#466) * Fix some issues detected by Coverity Scan and Clang-Tidy * Update launch command * Add more `close(new_sock)` * Simplify the definitions of struct * fix: re-construct laneletMapLayer for reindex RTree (autowarefoundation#463) * Rviz overlay render fix (autowarefoundation#461) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * super class now back to MFD Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * uncrustified Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * acquire data in mutex Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * back to RTD as superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * Rviz overlay render in update (autowarefoundation#465) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * super class now back to MFD Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * uncrustified Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * acquire data in mutex Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * removed unnecessary includes and some dead code Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> * restored RTD superclass Signed-off-by: Adam Dabrowski <adam.dabrowski@robotec.ai> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com> Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai> * Unify Apache-2.0 license name (autowarefoundation#1242) * Make planning modules components (autowarefoundation#1263) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Remove use_sim_time for set_parameter (autowarefoundation#1260) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * 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> * Refactor vehicle info util (autowarefoundation#1305) * Update license Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Refactor vehicle_info_util Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Rename and split files Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix interfaces Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix bug and add error handling Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add "// namespace" Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add missing include Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix lint errors (autowarefoundation#1378) * Fix lint errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix variable names Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Disable debug output of obstacle_avoidance_planner by default (autowarefoundation#1391) * Disable debug output of obstacle_avoidance_planner by default Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix typo Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * suppress warnings for obstacle avoidance planner (autowarefoundation#1764) * add Werror * fix Duration * fix debug.cpp * fix node.cpp * fix util.cpp * fix for loop for mpt_optimizer.cpp * fix unused for mpt_optimizer.cpp * fix process_cv.cpp * fix sign compare for eb_path_optimizer.cpp * fix unused for eb_path_optimizer.cpp * fix for cpplint * fix for cpplint * re fix debug.cpp * fix typo * fix typo * re fix process_cv.cpp * fix typo * re fix util.cpp * re re fix util.cpp * Fix -Wunused-parameter (autowarefoundation#1836) * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix spell * Fix lint issues Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore flake8 warnings Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> * Fix compiler warnings (autowarefoundation#1837) * Fix -Wunused-private-field Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wunused-variable Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wformat-security Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Winvalid-constexpr Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wdelete-non-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wdelete-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Winconsistent-missing-override Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wrange-loop-construct Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix "invalid application of 'sizeof' to an incomplete type" Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore -Wgnu-anonymous-struct and -Wnested-anon-types Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix lint Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Ignore -Wno-deprecated-declarations in CUDA-related packages Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix spellcheck fail for some packages (autowarefoundation#1842) * fix transed -> transformed * fix Urefex to Uref_ex * fix spell * Yrefex -> Yref_ex * add space * fix for spellcheck * fix for lint * fix feedbacked to feedback * delete Yref_ex * [obstacle avoidance planner] move doc from develop (autowarefoundation#1898) * move doc from develop * add figures * update docs * fix * update doc * use /approx * use \sin \cos \tan * use \arctan * use \cos * 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> * update doc (autowarefoundation#2164) * update doc * Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md * Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md * Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * fix \min, \max * Update planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner-design.ja.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * update readme for how to debug (autowarefoundation#2253) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add explanation of drivable area in obstacle avoidance planner (autowarefoundation#2291) * add explanation of drivable area in obstacle avoidance planner * fix spell * add explanations * Sync develop/fix interpolation and speed up calculation (autowarefoundation#2290) * debug slope calculation in behavior (autowarefoundation#1566) (autowarefoundation#1727) * debug slope calculation in behavior (autowarefoundation#1566) * update * update * revert change of autoware_utils * define getPose in behavior_path_planner * update * update * update * update * interpolate z in obstacle_avoidance_planner * update velocity controller * fix detection area and scene * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * update comment in velocity controller * remove debug print * update Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix typo Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix variable names Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix uncrustify Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix mistake Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * add underscore to marker namespace (autowarefoundation#1785) Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * [obstacle_avoidance_planner] remove useless get nearest idx (autowarefoundation#1851) * modify velocity insertion in obstacle_avoidance_planner Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [obstacle_avoidance_planner] reduce calculation cost in relative/absolute transformation (autowarefoundation#1844) * implement relative/absolute transformation without yaw but directly sin/cos of yaw * rename: relative_p to absolute_p * assigin point.z to rel/abs_z * fix cpp-lint error Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Feature/obstacle avoidance planner some improvements (autowarefoundation#1964) * add some improvements * fix typo * Revert "Feature/obstacle avoidance planner some improvements (autowarefoundation#1964)" (autowarefoundation#2000) This reverts commit 07795e57bf03cb2fbb95a8f82253d8757b4686e9. * Change formatter to clang-format and black (autowarefoundation#2332) * Revert "Temporarily comment out pre-commit hooks" This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3. * Replace ament_lint_common with autoware_lint_common Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove ament_cmake_uncrustify and ament_clang_format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply Black Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply clang-format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix build errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix for cpplint * Fix include double quotes to angle brackets Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Apply clang-format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix build errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add COLCON_IGNORE (autowarefoundation#500) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * port obstacle avoidance planner (autowarefoundation#484) * use_auto_msgs * use predicted object * use autoware_auto_perception_msgs * complile succeeded * use odom * assign header to twist staped as well * rename to readme.md Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * [apply_predicted_obj_type] adapt to autoware auto msgs (autowarefoundation#564) * fix obj shape * fix obj shape * fix goal pose * update README.md in obstacle avoidance planner (autowarefoundation#555) * update README.md * fix typo * update README.md * fix typo * minor change Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * update iv_msgs -> auto_msgs in planning readme (autowarefoundation#576) * update iv_msgs -> auto_msgs in planning readme * minor change * some fix * some fix Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * 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> * [planning module]fix bug (autowarefoundation#643) * fix topic name * remove angular z from LinearInterpolation in motion_velocity_smoother * fix readme * ci(pre-commit): autofix Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: Taichi Higashide <taichi.higashide@tier4.jp> Co-authored-by: Satoshi Tanaka <st14.828soccer@gmail.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: Nikolai Morin <nnmmgit@gmail.com> Co-authored-by: Servando <43142004+sgermanserrano@users.noreply.github.com> Co-authored-by: Esteve Fernandez <esteve@apache.org> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Makoto Tokunaga <vios-fish@users.noreply.github.com> Co-authored-by: Adam Dąbrowski <adam.dabrowski@robotec.ai> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@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: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@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: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* Add simulator_launch package (autowarefoundation#459) * Add simulator_launch package * add argument * fix depend order * add argument * move dummy_perception_publisher * add arg for dummy_perception_publisher * Update simulator_launch/launch/simulator.launch.xml Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> * Move simple_planning_simulator to simulator_launch (autowarefoundation#462) * move simple_planning_simulator * add simulation arg to logging_simulator.launch * delete unused argument * add arguments for logging simulation * change default value * update README * add default value to simulator arg * restore vehicle_simulation arg * Fix/revert initial engage state (autowarefoundation#484) * Fix args Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add initial_engage_state to vehicle.launch.xml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update vehicle.launch.xml * Change formatter to black (autowarefoundation#488) * Update pre-commit settings * Apply Black * Replace ament_lint_common with autoware_lint_common * Update build_depends.repos * Fix build_depends * Auto/fix launch (autowarefoundation#110) * fix namespace * remove dynamic_object_visualization * fix rviz * add default vehicle param file Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> * ci(pre-commit): autofix * fix typo Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>

* release v0.4.0 * Modify to change calib param for each vehicle (autowarefoundation#51) * add vehicle id to change parameter of each vehicle Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * add vehicle id to change param for each vehicle Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com> * add some dependencies (autowarefoundation#54) * Add some scenario-simulation specifiec parameters as arguments (autowarefoundation#57) * Add some scenario-simulation specifiec parameters as arguments * Update arg to pass 'initial_engage_state' to simple_planning_simulator * Add new optional argument 'rviz_args' * Rename some roslaunch arguments * Remove unneeded arguments * removed ROS1 package Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * Revert "removed ROS1 package" This reverts commit 561686456a78d767c1de9e976ef451b340d65343. * add COLCON_IGNORE file to all ROS1 packages Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * rename *.launch files to *.launch.xml Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> * port vehicle_launch Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Add linters (autowarefoundation#30) * Ros2 v0.8.0 vehicle launch (autowarefoundation#55) * restore file name Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Add default config of aip_x1 (autowarefoundation#141) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Pass all args to vehicle_interface.launch (autowarefoundation#147) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Revert "restore file name" This reverts commit 3e28661e8ba1a44cc570ca19b7b4759ba0bf0941. * fix vehicle_interface.launch arg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [vehicle_launch]: Remove pass_all_args Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> * Ros2 v0.8.0 fix packages (autowarefoundation#64) * add vehicle_param_file to simple planning simulator * add vehicle_param_file to lane change planner * Move individual params to a separate package (autowarefoundation#100) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add use_sim-time option (autowarefoundation#99) * Sync public repo (autowarefoundation#185) * add tier4 usbcam (autowarefoundation#104) * add tier4 usbcam * change version * tier4/ros2 * Ros2 vehicle info param server (autowarefoundation#96) * add vehicle info param server * delete vehicle param file Co-authored-by: taikitanaka <ttatcoder@outlook.jp> * Ros2 fix topic name part2 (autowarefoundation#89) * Fix topic name for traffic_light_classifier Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name for traffic_light_visualization Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * Fix topic name for traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: taikitanaka <ttatcoder@outlook.jp> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> * add group (autowarefoundation#195) * Use set_parameter for use_sim_time (autowarefoundation#198) * Use set_parameter for use_sim_time Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add default parameter for scenario simulator Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * add param for psim v2 (autowarefoundation#197) * add param for psim v2 Signed-off-by: kosuke murakami <kosuke.murakami@tier4.jp> * Update to pass var 'scenario_simulation' to dummy_perception_publisher * Update dummy_perception_publisher's arg-name Co-authored-by: yamacir-kit <httperror@404-notfound.jp> * Add vehicle info launch for setting vehicle info param (autowarefoundation#199) * Add vehicle info launch for setting vehicle info param Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add comment for global parameters section Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix year and apply format Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove ready vehicle info param Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix CI build depends (autowarefoundation#261) * Fix CI build depends Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Remove xacro find package Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Move global_params.launch.py and vehicle_info.launch.py to autoware_global_parameter_loader (autowarefoundation#282) * Move global_params.launch.py and vehicle_info.launch.py to autoware_global_parameter_loader Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add exec_depend Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * add description for vehicle_launch (autowarefoundation#337) * add description * delete duplicate * delete slash * fix sentence * add README.md and svg files (autowarefoundation#328) * add md and svg * fix typo * fix typo * fix word * fix typo * add lack of things * Update README * fix depending packages * fix word * Fix pre-commit (autowarefoundation#407) * Fix pre-commit errors Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Fix package.xml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Move simple_planning_simulator to simulator_launch (autowarefoundation#462) * move simple_planning_simulator * add simulation arg to logging_simulator.launch * delete unused argument * add arguments for logging simulation * change default value * update README * add default value to simulator arg * restore vehicle_simulation arg * Fix/revert initial engage state (autowarefoundation#484) * Fix args Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add initial_engage_state to vehicle.launch.xml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update vehicle.launch.xml * Change formatter to black (autowarefoundation#488) * Update pre-commit settings * Apply Black * Replace ament_lint_common with autoware_lint_common * Update build_depends.repos * Fix build_depends * add build depend Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp> * ci(pre-commit): autofix * remove depends * update readme Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: hiroyuki obinata <58019445+obi-t4@users.noreply.github.com> Co-authored-by: Yamasaki Tatsuya <httperror@404-notfound.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Jilada Eccleston <jilada.eccleston@tier4.jp> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: taikitanaka <ttatcoder@outlook.jp> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com>

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

takayuki5168 · 2022-03-07T09:40:08Z

I've done universe porting of obstacle_velocity_planner.
I will confirm it works well after @.purewater0901's map_base_prediction improvement.

We should carefully check universe porting commit.

takayuki5168 · 2022-03-07T10:08:21Z

@yukkysaito Is it ok to use map in motion (obstacle_velocity_planner in this case)? Or should we remove it before merging this PR.

yukkysaito · 2022-03-07T13:01:59Z

Is it ok to use map in motion

Not good.
I have talked with @tkimura4

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

codecov · 2022-03-08T10:52:11Z

Codecov Report

Merging #484 (8769a79) into main (4bd241b) will decrease coverage by 10.91%.
The diff coverage is 0.00%.

@@            Coverage Diff             @@
##             main    #484       +/-   ##
==========================================
- Coverage   10.91%   0.00%   -10.92%     
==========================================
  Files         706       8      -698     
  Lines       49835    1054    -48781     
  Branches     7116       0     -7116     
==========================================
- Hits         5438       0     -5438     
+ Misses      40016    1054    -38962     
+ Partials     4381       0     -4381

Impacted Files	Coverage Δ
...lanner/include/obstacle_velocity_planner/box2d.hpp	`0.00% <0.00%> (ø)`
...de/obstacle_velocity_planner/common/s_boundary.hpp	`0.00% <0.00%> (ø)`
...planner/include/obstacle_velocity_planner/node.hpp	`0.00% <0.00%> (ø)`
...e/obstacle_velocity_planner/velocity_optimizer.hpp	`0.00% <0.00%> (ø)`
planning/obstacle_velocity_planner/src/box2d.cpp	`0.00% <0.00%> (ø)`
planning/obstacle_velocity_planner/src/node.cpp	`0.00% <0.00%> (ø)`
...lanning/obstacle_velocity_planner/src/resample.cpp	`0.00% <0.00%> (ø)`
...stacle_velocity_planner/src/velocity_optimizer.cpp	`0.00% <0.00%> (ø)`
...lization/src/traffic_light_map_visualizer/node.cpp
...nverter/include/raw_vehicle_cmd_converter/node.hpp
... and 704 more

Continue to review full report at Codecov.

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

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

takayuki5168 · 2022-03-08T04:06:51Z

planning/obstacle_velocity_planner/src/node.cpp

+  const auto closest_idx = tier4_autoware_utils::findNearestIndex(
+    msg->points, current_pose_ptr_->pose, delta_yaw_threshold_of_nearest_index_);


The order of argument may be wrong

(points, pose, max_dist, max_yaw)

Yes, the order of the argument seems incorrect here

const auto closest_idx = tier4_autoware_utils::findNearestIndex( msg->points, current_pose_ptr_->pose, std::numeric_limits<double>::max(), delta_yaw_threshold_of_nearest_index_);

…efactoring feat(obstacle_velocity_planner): refactor, add debug markers, and prepare algorithmic data for acc

* Fix args Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Add initial_engage_state to vehicle.launch.xml Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Update vehicle.launch.xml

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

…66) (autowarefoundation#484) feat(behavior_path_planner): lane change abort (autowarefoundation#3566) * feat(behavior_path_planner): lane change abort feat(behavior_path_planner): fix abort path generation replace support strong typing in isLaneChangePathSafe move is approved path Move isEndOfLane move lane change states to interface style(pre-commit): autofix rearrange base class style(pre-commit): autofix fix conflict feat(behavior_path_planner): rebase and fix feat(behavior_path_planner): add state transition functions fix other module terminated due to lane change giving empty reference fix current_state_ not being overwritten feat(behavior_path_planner): new arch fix(behavior_path_planner): solve conflicts * fix(behavior_path_planner): use old arch * fix(behavior_path_planner): fix safety check * fix(behavior_path_planner): fix updateState * fix(behavior_path_planner): fix get abort path * fix(behavior_path_planner): fix stop state transition * fix(behavior_path_planner): remove unnecessary functions * fix(behavior_path_planner): fix state transition if cancel condition is satisfied * Update planning/behavior_path_planner/src/scene_module/lane_change/normal.cpp * Update planning/behavior_path_planner/src/scene_module/lane_change/normal.cpp * style(pre-commit): autofix --------- Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Zulfaqar Azmi <93502286+zulfaqar-azmi-t4@users.noreply.github.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…ondition in dynamic_avoidance (autowarefoundation#484) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>

* Removed calibration tools from the autoware.repos and added a specific .repos file to install the calibration tools and its dependencies * fix: moved calibration tools to a independent .repos file * Moved the image_pipeline package to calibration tools

Update repos files Co-authored-by: GitHub Actions <actions@example.com>

add obstacle_velocity_planner from .iv's development

00ca0da

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

universe porting

4c54cbc

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

takayuki5168 force-pushed the feature/obstacle-velocity-planner branch from ea95735 to 4c54cbc Compare March 7, 2022 09:28

takayuki5168 changed the title ~~add obstacle_velocity_planner from .iv's development~~ feat(obstacle_velocity_planner): add obstacle_velocity_planner from .iv's development Mar 7, 2022

apply pre-commit

0c267be

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

takayuki5168 requested review from tkimura4 and TakaHoribe March 7, 2022 09:34

takayuki5168 requested review from yukkysaito and purewater0901 March 7, 2022 09:49

fix odometry msg and prediction bug

328a6d8

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

takayuki5168 force-pushed the feature/obstacle-velocity-planner branch from c8f4d9d to 328a6d8 Compare March 8, 2022 10:39

fix function name format

56d55ee

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

takayuki5168 added 2 commits March 9, 2022 15:26

impelement wall marker, and create planner data

249d60f

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

add debug object marker

6d46fed

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

takayuki5168 commented Mar 22, 2022

View reviewed changes

takayuki5168 mentioned this pull request Mar 22, 2022

add obstacle_velocity_planner tier4/autoware_launch-old#245

Closed

8 tasks

takayuki5168 added 2 commits March 23, 2022 10:32

Merge pull request #22 from tier4/feature/obstacle-velocity-planner-r…

c972bbb

…efactoring feat(obstacle_velocity_planner): refactor, add debug markers, and prepare algorithmic data for acc

Merge branch 'main' into feature/obstacle-velocity-planner

8769a79

takayuki5168 closed this May 16, 2022

takayuki5168 deleted the feature/obstacle-velocity-planner branch May 16, 2022 13:26

tkimura4 referenced this pull request in tier4/autoware.universe Oct 24, 2022

feat(shift_decider): add shift decider config (#484)

de49ece

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

keiota pushed a commit to keiota/autoware.universe that referenced this pull request Aug 17, 2023

feat(autoware_launch): add successive_num_to_exit_dynamic_avoidance_c…

230a913

…ondition in dynamic_avoidance (autowarefoundation#484) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>

HansOersted pushed a commit to HansOersted/autoware.universe that referenced this pull request Mar 8, 2024

chore: update beta branch for beta/v2.3.0 (autowarefoundation#484)

b6e7752

Update repos files Co-authored-by: GitHub Actions <actions@example.com>

Provide feedback

Saved searches

Use saved searches to filter your results more quickly

feat(obstacle_velocity_planner): add obstacle_velocity_planner from .iv's development #484

feat(obstacle_velocity_planner): add obstacle_velocity_planner from .iv's development #484

takayuki5168 commented Mar 7, 2022 •

edited

Loading

takayuki5168 commented Mar 7, 2022

takayuki5168 commented Mar 7, 2022

yukkysaito commented Mar 7, 2022 •

edited

Loading

codecov bot commented Mar 8, 2022 •

edited

Loading

takayuki5168 Mar 8, 2022

takayuki5168 Mar 8, 2022

purewater0901 Mar 22, 2022

purewater0901 Mar 22, 2022

		const auto closest_idx = tier4_autoware_utils::findNearestIndex(
		msg->points, current_pose_ptr_->pose, delta_yaw_threshold_of_nearest_index_);

feat(obstacle_velocity_planner): add obstacle_velocity_planner from .iv's development #484

feat(obstacle_velocity_planner): add obstacle_velocity_planner from .iv's development #484

Conversation

takayuki5168 commented Mar 7, 2022 • edited Loading

Related Issue(required)

Description(required)

Review Procedure(required)

Related PR(optional)

Pre-Review Checklist for the PR Author

Checklist for the PR Reviewer

Post-Review Checklist for the PR Author

CI Checks

takayuki5168 commented Mar 7, 2022

takayuki5168 commented Mar 7, 2022

yukkysaito commented Mar 7, 2022 • edited Loading

codecov bot commented Mar 8, 2022 • edited Loading

Codecov Report

takayuki5168 Mar 8, 2022

Choose a reason for hiding this comment

takayuki5168 Mar 8, 2022

Choose a reason for hiding this comment

purewater0901 Mar 22, 2022

Choose a reason for hiding this comment

purewater0901 Mar 22, 2022

Choose a reason for hiding this comment

takayuki5168 commented Mar 7, 2022 •

edited

Loading

yukkysaito commented Mar 7, 2022 •

edited

Loading

codecov bot commented Mar 8, 2022 •

edited

Loading