-
Notifications
You must be signed in to change notification settings - Fork 650
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
fix(gnss_poser): add local cartesian option for origin value #725
fix(gnss_poser): add local cartesian option for origin value #725
Conversation
54ebb07
to
b0098ea
Compare
Codecov Report
@@ Coverage Diff @@
## main #725 +/- ##
========================================
- Coverage 8.98% 8.97% -0.02%
========================================
Files 1024 1024
Lines 69413 69527 +114
Branches 11697 11697
========================================
Hits 6238 6238
- Misses 57991 58105 +114
Partials 5184 5184
*This pull request uses carry forward flags. Click here to find out more.
Continue to review full report at Codecov.
|
@meliketanrikulu Thank you for your contribution! |
@YamatoAndo Thanks for your suggestion. You are right, it seems more appropriate to create a global config file. In which package would you recommend we create a global config file? |
@meliketanrikulu I think we can utilize something like global_param.launch.py that is proposed in #143. |
@mitsudome-r let's create an issue for discussing how the map origin is updated/passed |
e3c5120
to
422f8ef
Compare
0ed6873
to
3ae6064
Compare
* 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>
* Feature/porting behavior path planner (autowarefoundation#1645) * Add behavior path planner pkg with Lane Change (autowarefoundation#1525) * add lanelet extension funcs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add planning msgs for FOA Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add behavior_path_planner pkg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply clang format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add error handling for config load failure Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replace word: foa with remote control Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add readme Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use pointer for return value of path Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix hz Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove debug print Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove shide-shift & avoidance related files Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Clip path by goal * add build depend for behavior tree cpp Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * temporally disable lint test in lanelet2_extension Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: rej55 <rej55.g@gmail.com> * Add avoidance module in behavior_path_planner (autowarefoundation#1528) * Revert "remove shide-shift & avoidance related files" This reverts commit d819ea0291fca251012e4b9ffd16de3896830aa2. * refactor findNewShiftPoint func Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove duplicated decleration Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix barkward length issue - add clipPathLenght func in avoidance Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * refactor: - translate english - minor modification for traffic distance Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * support debug marker in behavior_path_planner Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * clean up side shift module Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change topic name Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove japanese Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/side_shift/side_shift_module.hpp Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove unused var Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * adress reviewer comments: - add const for variables - add comment - fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * Replace behavior_path utilities with autoware_utils (autowarefoundation#1532) * replace calcDistance Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replace arange Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replave convertToEigenPt with autoware_utils::fromMsg Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replace normalizeRadian Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * cosmetic change Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * import autowarefoundation#1526 into behavior path planner (autowarefoundation#1531) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix/behavior path empty path output guard (autowarefoundation#1536) * add guard Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/behavior_path_planner.cpp * fix lateral jerk calculation (autowarefoundation#1549) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix: error handling on exception in behavior_path_planner (autowarefoundation#1551) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix ignore too steep avoidance path (autowarefoundation#1550) * ignore too steep path Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp * parametrize lateral jerk limit Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/include/behavior_path_planner/scene_module/avoidance/avoidance_module.hpp Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * use offsetNoThrow and add error log (autowarefoundation#1615) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Ignore object ahead goal for avoidance (autowarefoundation#1618) * Ignore object ahead goal for avoidance * Add flag * Fix position of definition of goal_pose * Fix arclength calculation * Fix position of definition of goal_pose * fix intersection stop line (autowarefoundation#1636) * fix intersection stop line * fix typo * add document (autowarefoundation#1635) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Port behavior path planner to ros2 Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix typo Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix map qos Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * debug slope calculation in behavior (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> * Address review: Fix config file name Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * pre-commit fixes Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix redeclaring parameters Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add missing tf2 geometry function Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Apply lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix rclcpp Time initialization Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use now() instead of msg stamp Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Use throttle output in getExpandedLanelet Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add missing const Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix lint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: rej55 <rej55.g@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> * Fix/separate drivable area calculation (autowarefoundation#1828) * Do not calculate drivable area at plan candidate * Remove is_first_plan_ * Fix comment * Fix compile warnings (autowarefoundation#1852) Fix -Wunused-parameter Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Fix -Wunused-private-field Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Fix -Wunused-lambda-capture Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Fix -Wdelete-non-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Fix -Wrange-loop-construct Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Ignore lint error Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Feature/behavior fillpoly drivable area fast (autowarefoundation#1843) * add sample codes to check how overlapped polygon works, which have to be removed before merged * remove cv::Mats for each lanelet * remove unused variable * remove test sample codes * assign pose to pre goal in behavior (autowarefoundation#1874) * Rearrange behavior path planner utilities (autowarefoundation#1944) * Refactor route handler * Refactor utilities * Remove unnecessary blank line * [behavior_path_planner] refactor parameter declaration (autowarefoundation#1953) * refactor parameter definition Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [behavior_path_planner] remove unused drivable area calculation (autowarefoundation#1977) * [behavior_path_planner] remove unused drivable area calculation in planCandidate() Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change function name Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [behavior_path_planner] update side shift module (autowarefoundation#1968) * fix side_shift module with path_shifter Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update readme for side shift Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix markdown lint Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove unused drivable area calculation Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * rename thres -> threshold Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix package.xml (autowarefoundation#2056) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * Feature/expand drivable area (autowarefoundation#1812) * check if ego lane has adjacent lane or not * expand drivable area by using lanelet * remove unnecessary operator * use extra drivable area * fix variable names * fix indent * get polygon by id * fix variable name * remove redundant logic * update area name * disable expand by default Co-authored-by: satoshi-ota <satoshi.ota@gmail.com> * fix clip path length (autowarefoundation#2095) * fix clip path Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * not ignore lanelet altitude (autowarefoundation#2132) (autowarefoundation#2133) Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> * Fix/side shift approval (autowarefoundation#2126) * Fix approval * Add clear approval * Fix typo * add pull over/out module (autowarefoundation#2147) * Improve avoidance algorithm in behavior_path_planner (autowarefoundation#2127) * add debug comment Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use same clock and logger Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove Frenet struct Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change param Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Correspond exactly to the modified and raw shift points. Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * separate structure file Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix return shift calculation Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * add index info on path marker Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update returnSHift func Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * update param Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * update findNewShiftPoiint logic by using linear shifter Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix return distance calculation Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix return shift for steep shape Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix for return shift after approval Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * re-fix for return shift after approval Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * re-re-fix for return shift after approval Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * add same object_id shift for parent_ids even if it is not overwrapped. Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix clock for approval_handler Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix bug: extra_return_shift is not registered Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update - update logic of unique check for registered shift - update addReturnShift func to support for opposite obstacle case - disable trimSmallShift Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use relative shift for avoid start point Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update path_shifter: use end_point shift for relative shift calculation so that the desired shift length is set at shift_point's end_idx (before, it was set at the end point of the path) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update: select existing shift point that will be removed before adding a new one Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix path_shifter: current_shift for linear shift Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update - add ignore over-jerk shift function - improve debug print Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update - add control flag for debug print - add control flag for debug marker Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * TMP: add sparse resampling to reduce computational cost Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update parameter: min_nominal_avoidance_speed 3.0 -> 5.0 Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * cosmetic change - move some debug functions to debug.cpp - remove temporal debug comment - remove unused params - parametrize some values - align function decleration order Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * add empty avoidance design Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * applly format Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix design.md directory Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change variable nale sudden, tight -> sharp Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * remove unused param Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix default value Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add design Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move some functions to util Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix design typo Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * remove temporal mutable & adjust function name Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * parametrize some hard-coded params Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * follow ament_uncrustify & cpplint Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix parent_id inheritance bug Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * back to experiment config Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * update trim filter: trimSharpReturn Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * add lost-detection compensator Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * resolve todo for empty path Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * change param: set false for debug publisher Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * update debug comment Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * remove unused debug print Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * update default param Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use closest footpoint from ego for avoidance point Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * cosmetic change Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move lateral and longitudinal distance calculation to util Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * simplify mergeShift function Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix readme style Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * revert unexpected changes Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * - remove unused comment - translate to english Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix for createQuaternionFromRPY/Yaw (autowarefoundation#2154) * add behavior velocity planner utils (autowarefoundation#2113) * add gtest utils * add state machine as utils * add arc lane utils * remove empty file * add gtest for offset segment * use calcdist2d in autoware util * apply get point * fix uncrustify * fix conflict getPoint in behavior path * apply commit suggestion * slower than ros1 * use interpolation::slerp (autowarefoundation#2161) * Fix side shift planner (autowarefoundation#2171) * add print debug Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * remove forward shift points when adding new point Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * remove debug print Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * format Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * Fix remove threshold Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Fix/pull out and pull over (autowarefoundation#2175) (autowarefoundation#2177) * delete unnecessary check * fix condition of starting pull out Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * change threshold_distance_object_is_on_center to 1.0 (autowarefoundation#2176) Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * [hotfix] 1 path point exception after resampling (autowarefoundation#2204) (autowarefoundation#2208) * fix 1 path point exception after resampling Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * Apply suggestions from code review * Apply suggestions from code review Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * [hotfix] Fix lane ids (autowarefoundation#2211) (autowarefoundation#2212) * Fix lane ids Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Prevent acceleration on avoidance (autowarefoundation#2214) (autowarefoundation#2216) * prevent acceleration on avoidance Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix param name Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * parametrize avoidance acc Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change param name Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> * design document for avoidance module (autowarefoundation#2196) * Update behavior_path_planner_avoidance-design.md Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix for markdown lint Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix lint Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/behavior_path_planner_avoidance-design.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/behavior_path_planner_avoidance-design.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/behavior_path_planner_avoidance-design.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/behavior_path_planner_avoidance-design.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/behavior_path_planner_avoidance-design.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/behavior_path_planner_avoidance-design.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/behavior_path_planner_avoidance-design.md * update Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * [hotfix] Remove exception in avoidance module (autowarefoundation#2233) (autowarefoundation#2234) * Remove exception * Fix clock * Remove blank line Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> * Add description in behavior path planner (autowarefoundation#2248) * add description for goal point management functions Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change function name Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update readme Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix readme Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * refactor center line calculation (autowarefoundation#2252) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * 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> * rename topic name twist -> odometry (autowarefoundation#568) Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> * Port behavior path planner (autowarefoundation#622) * Convert message to autoware_auto_msgs * Use route_handler package and fix bugs * Fix README * Fix hazard signal * Fix default value of TurnSignalInfo and use get_clock() * Use odometry * Sync .auto branch with the latest branch in internal repository (autowarefoundation#691) * add trajectory point offset in rviz plugin (autowarefoundation#2270) * sync rc rc/v0.23.0 (autowarefoundation#2258) * fix interpolation for insert point (autowarefoundation#2228) * fix interpolation for insert point * to prev interpolation pkg * Revert "to prev interpolation pkg" This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef. Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: taikitanaka <ttatcoder@outlook.jp> * fix topic name (autowarefoundation#2266) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Add namespace to diag for dual_return_filter (autowarefoundation#2269) * Add a function to make 'geometry_msgs::msg::TransformStamped' (autowarefoundation#2250) * Add a function to make 'geometry_msgs::msg::TransformStamped' * Add 'child_frame_id' as an argument of 'pose2transform' * Simplify marker scale initialization (autowarefoundation#2286) * Fix/crosswalk polygon (autowarefoundation#2279) * extend crosswalk polygon * improve readability * fix polygon shape * Add warning when decel distance calculation fails (autowarefoundation#2289) Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * [motion_velocity_smoother] ignore debug print (autowarefoundation#2292) * cosmetic change Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * cahnge severity from WARN to DEBUG for debug info Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * use util for stop_watch Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix map based prediction (autowarefoundation#2200) * fix map based prediction * fix format * change map based prediction * fix spells * fix spells in comments * fix for cpplint * fix some problems * fix format and code for clang-tidy * fix space for cpplint * Update Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * fix vector access method * fix readme format * add parameter * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * remove failure condition for 0 velocity trajectory (autowarefoundation#2295) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [mpc_follower] remove stop distance condition from stopState decision (autowarefoundation#1916) * [mpc_follower] remove stop distance condition from stopState decision Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add invalid index handling Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Move the debug marker initialization part to another file (autowarefoundation#2288) * Move the debug marker initialization part to 'debug.cpp' * Make 'isLocalOptimalSolutionOscillation' independent from 'NDTScanMatcher' (autowarefoundation#2300) * Remove an unused function 'getTransform' (autowarefoundation#2301) * Simplify iteration of initial poses (autowarefoundation#2310) * Make a transform object const (autowarefoundation#2311) * Represent poses in 'std::vector' instead of 'geometry_msgs::msg::PoseArray' (autowarefoundation#2312) * Feature/no stopping area (autowarefoundation#2163) * add no stopping area module to behavior velocity planner * apply utils * add polygon interpolation module order stopline around area is considered * devide jpass udge with stop line polygon * update docs * rename file name * update to latest * minor change for marker * update license Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * update license Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * update license Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * update license Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * minor fix * add parameter tuning at experiment * update readme * format doc * apply comments * add exception gurd * cosmetic change * fix ament * fix typo and remove for statement * & to " " * better ns * return pass judge param * add missing stoppable condition * add clear pass judge and stoppable flag * add comment * precommit fix * cpplint Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> * sync rc rc/v0.23.0 (autowarefoundation#2281) * Fix side shift planner (autowarefoundation#2171) (autowarefoundation#2172) * add print debug Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * remove forward shift points when adding new point Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * remove debug print Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * format Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * Fix remove threshold Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix/pull out and pull over (autowarefoundation#2175) * delete unnecessary check * fix condition of starting pull out * Add emergency status API (autowarefoundation#2174) (autowarefoundation#2182) * Fix/mpc reset prev result (autowarefoundation#2185) (autowarefoundation#2195) * reset prev result * clean code * reset only raw_steer_cmd * Update control/mpc_follower/src/mpc_follower_core.cpp Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> * [hotfix] 1 path point exception after resampling (autowarefoundation#2204) * fix 1 path point exception after resampling Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * Apply suggestions from code review * Apply suggestions from code review Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> * [hotfix] Fix lane ids (autowarefoundation#2211) * Fix lane ids * Prevent acceleration on avoidance (autowarefoundation#2214) * prevent acceleration on avoidance Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * fix param name Signed-off-by: TakaHoribe <horibe.takamasa@gmail.com> * parametrize avoidance acc Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change param name Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Fix qos in roi cluster fusion (autowarefoundation#2218) * fix confidence (autowarefoundation#2220) * too high confidence (autowarefoundation#2229) * Fix/obstacle stop 0.23.0 (autowarefoundation#2232) * fix unexpected slow down in sharp curves (autowarefoundation#2181) * Fix/insert implementation (autowarefoundation#2186) Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> * [hotfix] Remove exception in avoidance module (autowarefoundation#2233) * Remove exception * Fix clock * Remove blank line * Update traffic light state if ref stop point is ahead of previous one (autowarefoundation#2197) Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix interpolation for insert point (autowarefoundation#2228) * fix interpolation for insert point * to prev interpolation pkg * fix index (autowarefoundation#2265) * turn signal calculation (#2280) * add turn signal funtion in path shifter * add ros parameters Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> 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: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com> * [behavior_path_planner] fix sudden path change around ego (autowarefoundation#2305) (autowarefoundation#2318) * fix return-from-ego shift point generation logic Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * change param for trimSimilarGradShiftPoint Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add comment for issue Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * update comment Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * replace code with function (logic has not changed) Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * move func to cpp Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * add comment for issue Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix typo Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Add functions to make stamped scalar messages (autowarefoundation#2317) * Fix/object yaw in intersection module (autowarefoundation#2294) * fix object orientation * fix function name * add guard (autowarefoundation#2321) * reduce cost (double to float) (autowarefoundation#2298) * Add detail collision check (autowarefoundation#2274) * Add detail collision check Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Remove unused function Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix arc length Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Seperate time margin Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix parameter name Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Update Readme Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Address review: Add comment for TimeDistanceArray Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Run pre-commit Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Fix cpplint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * Add return for empty polygon Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * update CenterPoint (autowarefoundation#2222) * update to model trained by mmdet3d * add vizualizer (debug) * for multi-frame inputs * chagne config * use autoware_utils::pi * project specific model and param * rename vfe -> encoder * rename general to common * update download link * update * fix * rename model_name * change training toolbox link * chage lint package * fix test error * commit suggestion * Feature/lane change detection (autowarefoundation#2331) * add old information deleter * fix access bug * change to deque * update obstacle buffer * fix some bugs * add lane change detector * make a update lanelet function * fix code style * parameterize essential values * Update perception/object_recognition/prediction/map_based_prediction/src/map_based_prediction_ros.cpp Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * fix slash position * remove unnecessary lines * fix format * fix format * change to new enum * fix format * fix typo and add guard * change funciton name * add lane change description Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> * Add Planning Evaluator (autowarefoundation#2293) * Add prototype planning evaluator Produced data for dist between points, curvature, and relative angle * Cleanup the code to make adding metrics easier * Add remaining basic metrics (length, duration, vel, accel, jerk) * Add motion_evaluator to evaluate the actual ego motion + code cleanup * Add deviation metrics * Add naive stability metric * Handle invalid stat (TODO: fix the output file formatting) * Add parameter file and cleanup * Add basic obstacle metric (TTC not yet implemented) and fix output file format * Add basic time to collision * Add lateral-distance based stability metric * Add check (at init time) that metrics' maps are complete * Publish metrics as ParamaterDeclaration msg (for openscenario) * Use lookahead and start from ego_pose when calculating stability metrics * Code cleanup * Fix lint * Add tests * Fix bug with Frechet dist and the last traj point * Finish implementing tests * Fix lint * Code cleanup * Update README.md * Remove unused metric * Change msg type of published metrics to DiagnosticArray * fix format to fix pre-commit check Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix yaml format to fix pre-commit check Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * fix yaml format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply clang-format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * apply clang-format Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Update planning/planning_diagnostics/planning_evaluator/include/planning_evaluator/planning_evaluator_node.hpp * Update planning/planning_diagnostics/planning_evaluator/test/test_planning_evaluator_node.cpp * Update planning/planning_diagnostics/planning_evaluator/test/test_planning_evaluator_node.cpp * change lint format to autoware_lint_common Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> * Add keep braking function at driving state (autowarefoundation#2346) * Add keep braking function at driving state Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Remove debug messages Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix format Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Change diag_updater's pediod from default to 0.1sec (autowarefoundation#2348) * add cross judgement and common signal function (autowarefoundation#2319) * merge branch turn_signal_common * add turn signal function in signal decider * add cross judge in path_utilities and delete from turn_signal_decider * remove original signal calculation in lane change * omit substitution * replace turn signal decider in pull over function * modify cross judge logic * replace turn signal decider in avoidance * add readme of turn signal * update * delete print debug * update * delete lane change decider in path shifter * delete blank line * fix indent * fix typo * fix typo * decrease nest * run pre commit * Add 0 limit at forward jerk velocity filter (autowarefoundation#2340) Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * add time offset param to point cloud concatenation (autowarefoundation#2303) * add offset param * clang-format Co-authored-by: Akihito OHSATO <aohsato@gmail.com> * Feature/add doc for keep braking function at driving state (autowarefoundation#2366) * Add the description of brake keeping Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add the english document Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Improve description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Add english description Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com> * Fix include files (autowarefoundation#2339) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> * fix behavior intersection module * fix behavior no stopping area module * fix planning_evaluator * fix motion_velocity_smoother * rename variable * Revert "[mpc_follower] remove stop distance condition from stopState decision (autowarefoundation#1916)" This reverts commit ff4f0b5a844d1f835f1b93bd3b36a76747b0cd02. * Revert "Add keep braking function at driving state (autowarefoundation#2346)" This reverts commit f0478187db4c28bf6092c198723dcc5ec11a9c70. * Revert "Feature/add doc for keep braking function at driving state (autowarefoundation#2366)" This reverts commit 66de2f3924a479049fce2d5c5c6b579cacbd3e49. * Fix orientation availability in centerpoint Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix test_trajectory.cpp * add target link libraries * Use .auto msg in test code for planniing evaluator Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> * fix include Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: taikitanaka <ttatcoder@outlook.jp> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com> Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com> Co-authored-by: s-murakami-esol <81723883+s-murakami-esol@users.noreply.github.com> Co-authored-by: Yusuke Muramatsu <yukke42@users.noreply.github.com> Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com> Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com> Co-authored-by: Shinnosuke Hirakawa <8327162+0x126@users.noreply.github.com> Co-authored-by: Akihito OHSATO <aohsato@gmail.com> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> * [behavior_path_planner]fix velocity of pre_refined_goal (autowarefoundation#725) * fix velocity of pre_refined_goal * use std::clamp Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: rej55 <rej55.g@gmail.com> Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> 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: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com> Co-authored-by: kyoichi sugahara <81.s.kyo.19@gmail.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: Kazuki Miyahara <kmiya@outlook.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki.murooka@tier4.jp> Co-authored-by: taikitanaka <ttatcoder@outlook.jp> Co-authored-by: Takeshi Miura <57553950+1222-takeshi@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Makoto Kurihara <mkuri8m@gmail.com> Co-authored-by: purewater0901 <43805014+purewater0901@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Sugatyon <32741405+Sugatyon@users.noreply.github.com> Co-authored-by: s-murakami-esol <81723883+s-murakami-esol@users.noreply.github.com> Co-authored-by: Yusuke Muramatsu <yukke42@users.noreply.github.com> Co-authored-by: Maxime CLEMENT <78338830+maxime-clem@users.noreply.github.com> Co-authored-by: Shunsuke Miura <37187849+miursh@users.noreply.github.com> Co-authored-by: Shinnosuke Hirakawa <8327162+0x126@users.noreply.github.com> Co-authored-by: Akihito OHSATO <aohsato@gmail.com>
8ef6bd4
to
5624358
Compare
@YamatoAndo @mitsudome-r @xmfcx Hello. I'm getting an error like this (https://github.com/autowarefoundation/autoware.universe/runs/6125866560?check_suite_focus=true) in the pipeline but when I compile the package in local computer, I can't see any problem. Also, I don't think the changes I made in the code will cause this error. Any idea what could be the reason? Thanks for your response. |
5624358
to
fc9f4bf
Compare
@meliketanrikulu @kenji-miyake Do you have any ideas? |
@YamatoAndo @meliketanrikulu I'll track it in this issue. So for now, please ignore the error. 🙏 |
Thanks for your reply. In this case it is ready for review. Can you check this PR @xmfcx @YamatoAndo @mitsudome-r |
2b78b56
to
a37b97d
Compare
Hi @xmfcx @mitsudome-r @YamatoAndo . Can you take a look at this PR? ready for review. |
71b2b6b
to
76c9416
Compare
@mitsudome-r In this PR, we don't need to consider global_param.launch.py?
|
Hello thanks for your reply @YamatoAndo .Maybe we can open another issue for this package and map_loader package. we can work on the global_param.yaml file in this issue. |
76c9416
to
0feebce
Compare
0feebce
to
205553b
Compare
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Apart from a simple refactor, rest seems well put to me, good job!
67b8795
to
5b6769a
Compare
5b6769a
to
c9b8e4e
Compare
Signed-off-by: melike tanrikulu <melike@leodrive.ai> ci(pre-commit): autofix fix(gnss_poser): local cartesian added as coordinate system Signed-off-by: melike tanrikulu <melike@leodrive.ai> fix(gnss_poser): unnecessary parts removed Signed-off-by: melike tanrikulu <melike@leodrive.ai> ci(pre-commit): autofix fix(gnss_poser): updated for space errors Signed-off-by: melike tanrikulu <melike@leodrive.ai> fix(gnss_poser): fix boost error Signed-off-by: melike tanrikulu <melike@leodrive.ai> fix(gnss_poser): fix boost error Signed-off-by: melike tanrikulu <melike@leodrive.ai> add local cartesian option for origin value Signed-off-by: melike tanrikulu <melike@leodrive.ai> ci(pre-commit): autofix Revert "ci(pre-commit): autofix" This reverts commit 82b85b3. Signed-off-by: melike tanrikulu <melike@leodrive.ai> Revert "add local cartesian option for origin value" This reverts commit 40f88e4. Signed-off-by: melike tanrikulu <melike@leodrive.ai>
Co-authored-by: M. Fatih Cırıt <xmfcx@users.noreply.github.com>
Signed-off-by: melike tanrikulu <melike@leodrive.ai>
c9b8e4e
to
f3c4aa4
Compare
…efoundation#725) Signed-off-by: melike tanrikulu <melike@leodrive.ai>
…efoundation#725) Signed-off-by: melike tanrikulu <melike@leodrive.ai> Signed-off-by: SoohyeokPark-MORAI <shpark.morai@gmail.com>
…efoundation#725) Signed-off-by: melike tanrikulu <melike@leodrive.ai>
Signed-off-by: melike tanrikulu <melike@leodrive.ai>
Signed-off-by: melike tanrikulu <melike@leodrive.ai>
Signed-off-by: melike tanrikulu <melike@leodrive.ai>
Signed-off-by: melike tanrikulu <melike@leodrive.ai>
Signed-off-by: melike tanrikulu <melike@leodrive.ai>
…ation#725) * fix(behavior_path_planner): fix simultaneous execution Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * fix for v0.9.0 Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * fix typo Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> --------- Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
…ation#725) * fix(behavior_path_planner): fix simultaneous execution Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * fix for v0.9.0 Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * fix typo Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> --------- Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> remove setIsSimultaneousExecutableAs from start_planner to fix build
Signed-off-by: melike melike@leodrive.ai
Description
This PR is intended to add local small origin values to the gnss_poser package. Local cartesian is determined using Geographiclib. It takes a geodetic coordinate as origin and allows you to convert any other geodetic coordinate to local cartesian coordinates with the Forward() method.
Related links
Fixes: #576
Tests performed
Notes for reviewers
Pre-review checklist for the PR author
The PR author must check the checkboxes below when creating the PR.
In-review checklist for the PR reviewers
The PR reviewers must check the checkboxes below before approval.
Post-review checklist for the PR author
The PR author must check the checkboxes below before merging.
After all checkboxes are checked, anyone who has write access can merge the PR.