feat(behavior_path_planner): add route handler diagnostic #1081
Conversation
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Signed-off-by: Shumpei Wakabayashi <[email protected]>
Codecov Report
@@ Coverage Diff @@
## main #1081 +/- ##
========================================
- Coverage 8.98% 8.96% -0.02%
========================================
Files 1024 1024
Lines 69421 69573 +152
Branches 11697 11697
========================================
Hits 6239 6239
- Misses 57999 58151 +152
Partials 5183 5183
*This pull request uses carry forward flags. Click here to find out more.
Continue to review full report at Codecov.
|
yukkysaito
added a commit
to yukkysaito/autoware.universe
that referenced
this pull request
Jun 29, 2022
* release v0.4.0 * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <[email protected]> * add sample ros2 packages Signed-off-by: mitsudome-r <[email protected]> * remove ROS1 packages Signed-off-by: mitsudome-r <[email protected]> * Revert "remove ROS1 packages temporarily" This reverts commit aaf2f7d3908ee5f865105ea9094ed358ea9d3c75. Signed-off-by: mitsudome-r <[email protected]> * add COLCON_IGNORE to ros1 packages Signed-off-by: mitsudome-r <[email protected]> * Port autoware_utils (#33) * Port autoware_utils * Fix function name * Fix buildtool_depend * Rename h files to hpp (#142) * Change includes * Rename files * Adjustments to make things compile * Other packages * Adjust copyright notice on 532 out of 699 source files (#143) * Use quotes for includes where appropriate (#144) * Use quotes for includes where appropriate * Fix lint tests * Make tests pass hopefully * Run uncrustify on the entire Pilot.Auto codebase (#151) * Run uncrustify on the entire Pilot.Auto codebase * Exclude open PRs * Ros2 v0.8.0 autoware utils (#291) * restore file name for v0.8.0 update Signed-off-by: wep21 <[email protected]> * Improve autoware utils (#986) * Refactor Signed-off-by: Kenji Miyake <[email protected]> * Add features to autoware_utils Signed-off-by: Kenji Miyake <[email protected]> * Add lane departure checker (#928) Signed-off-by: Kenji Miyake <[email protected]> * Fix/remove duplicated point (#1107) * Split PoseDeviaiton functions Signed-off-by: Kenji Miyake <[email protected]> * Remove unnecessary pose Signed-off-by: Kenji Miyake <[email protected]> * Don't insert point if duplicated point exists Signed-off-by: Kenji Miyake <[email protected]> * Fix condition of duplicated points Signed-off-by: Kenji Miyake <[email protected]> * Rename file name for v0.8.0 update Signed-off-by: wep21 <[email protected]> * Add dependencies into package.xml Signed-off-by: wep21 <[email protected]> * [autoware_utils]: Fix CMakeLists.txt and package.xml for lint and testing Signed-off-by: wep21 <[email protected]> * [autoware_utils]: Fix lint Signed-off-by: wep21 <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> * [autoware_utils]: fix traits (#326) Signed-off-by: wep21 <[email protected]> * Ros2 v0.8.0 lane departure checker (#327) * Add lane departure checker (#928) Signed-off-by: Kenji Miyake <[email protected]> * Fix bug of lane_departure_checker (#1011) * Fix bug of lane_departure_checker Since preceeding lanelets are missing, when vehicle is at the beginning of a lanelet, it's mistakenly considered as out of lane. Signed-off-by: Kenji Miyake <[email protected]> * Fix typo Signed-off-by: Kenji Miyake <[email protected]> * Reduce computational cost of lane_departure_checker (#1026) Lanelet visualization will be too slow when big lanelets are visualized. Signed-off-by: Kenji Miyake <[email protected]> * Fix typo (#1062) Signed-off-by: Kenji Miyake <[email protected]> * [lane_departure_checker]: Port to ROS2 Signed-off-by: wep21 <[email protected]> * [lane_departure_checker]: Fix lint Signed-off-by: wep21 <[email protected]> * [autoware_utils]: Publish autoware debug msgs Signed-off-by: wep21 <[email protected]> * [lane_departure_checker]: Use autoware_debug_msgs instead of std_msgs Signed-off-by: wep21 <[email protected]> * [goal_distance_calculator]: Use autoware_debug_msgs instead of std_msgs Signed-off-by: wep21 <[email protected]> * [autoware_utils]: Add namespace to debug traits Signed-off-by: wep21 <[email protected]> * [lane_departure_checker]: Fix lint Signed-off-by: wep21 <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> * Ros2 v0.8.0 behavior velocity planner (#332) * restore behavior velocity planner files for v0.8.0 update * Fix detection area (#808) * Remove PASS state Signed-off-by: Kenji Miyake <[email protected]> * Keep stopping after going over dead-line in STOP state Signed-off-by: Kenji Miyake <[email protected]> * Clear state after obstacle disappears Signed-off-by: Kenji Miyake <[email protected]> * Parameterize and change conditions Signed-off-by: Kenji Miyake <[email protected]> * Refactor Signed-off-by: Kenji Miyake <[email protected]> * add elapsed time checker * Refactor Signed-off-by: Kenji Miyake <[email protected]> * Ignore inserting point if points are too close Signed-off-by: Kenji Miyake <[email protected]> * Rename NORMAL to GO Signed-off-by: Kenji Miyake <[email protected]> * Revert "Ignore inserting point if points are too close" This reverts commit 91c8d620ea11e703611945cb9a50877d175f4ff6. * Fix small bug Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: taichiH <[email protected]> * fix timing of publish stop reason of stop_line (#845) * fix timing of publish stop reason of stop_line * Fix formatting Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> * Fix task registration of detection area module (#856) * Fix task registration of detection area module Signed-off-by: Kenji Miyake <[email protected]> * Fix id of factor_text marker Signed-off-by: Kenji Miyake <[email protected]> * Do not interpolate if path size is 1 (#865) * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ce07d3c2bfae562d56fec46c4f81d5351fd936a1. * fix some implement miss * restore behavior velocity planner files for v0.8.0 update * change intersection param (#861) * Fix/intersection stop line (#841) * add trimmed path function * fix typo * avoid to insert stop line outside intersection * Add pass judge flag (#872) * Add pass judge flag Signed-off-by: wep21 <[email protected]> * Fix wrong format Signed-off-by: wep21 <[email protected]> * Fix flag order in judge condition Signed-off-by: wep21 <[email protected]> * add ignore width with blind spot (#864) * add ignore width with blind spot * remove unused function * fix typo * fix margin * remove bicycle from intersection stuck vehicle (#896) * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9. * fix implement miss * restore behavior velocity planner files for v0.8.0 update (fixed) * Add external traffic light input (#912) * Add external traffic light input Signed-off-by: wep21 <[email protected]> * Update topic namespace * Fix typos in planning modules (#866) * fix typos in planning * fix corresponding typos in planning * revert fixed typos temporarily due to its impact on launchers * add exception handling to intersection module (#920) * add exception handling * output input path * prevent passthrough chattering (#901) Signed-off-by: Yukihiro Saito <[email protected]> * cosnider current_velocity to calculate intersection passing time (#880) * cosnider current_velocity to calculate intersection passing time * add fabs to current velocity * Improve stuck vehicle detect (#824) * intersection: modify stuck vehicle detect logic to consider the object shape Signed-off-by: Takamasa Horibe <[email protected]> * intersection: consider ego-vehicle length when calculate stuck vehicle detection area Signed-off-by: Takamasa Horibe <[email protected]> * intersection: change param stuck_vehicle_ignore_dist: 5.0 -> 7.0 Signed-off-by: Takamasa Horibe <[email protected]> * intersection: use vehicle_info/vehicle_length Signed-off-by: Takamasa Horibe <[email protected]> * fix implement miss * fix target pedestrian (#927) Signed-off-by: Yukihiro Saito <[email protected]> * fix insert backward point (#953) * fix insert backward point * add comment Signed-off-by: Kosuke Murakami <[email protected]> * remove unnecessary if Signed-off-by: Kosuke Murakami <[email protected]> * Add stop line referred from road marking (#968) * Add stop line referred from road marking Signed-off-by: wep21 <[email protected]> * Add stop line for walkway Signed-off-by: wep21 <[email protected]> * Feature/external input (#982) * add external input msg * impl external input(crosswalk, intersection) * :put_litter_in_its_place: * change to ++14 * fix bug * fix bug * cosmetic change * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9. * Fix typo (#1013) Signed-off-by: Kenji Miyake <[email protected]> * Fix/blind spot insert point (#1027) * Copy insert point from previous point * Reset path unless state is stop Signed-off-by: wep21 <[email protected]> * change slow down speed (#1030) * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/walkway stop judge range (#1028) * Fix walkway stop judge Signed-off-by: wep21 <[email protected]> * Make refer id same Signed-off-by: wep21 <[email protected]> * fix getObjectivePolygons() so that intersecting lanelet is added to objective lanelets even when there is no preceeding lanelets (#1010) Signed-off-by: mitsudome-r <[email protected]> * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix implement miss for marker * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/blind spot polygon (#1056) * Fix detection area for blind spot Signed-off-by: wep21 <[email protected]> * Apply clang format Signed-off-by: wep21 <[email protected]> * Shrink conflicting area Signed-off-by: wep21 <[email protected]> * chane slowdown judgement (#1066) * chane slowdown judgement * cosmetic change * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fixed for ros2 style * restore behavior velocity planner files for v0.8.0 update (fixed) * Remove unused headers in behavior_velocity_planner (#1072) * publish walkway stop reason (#1073) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * restore behavior velocity planner files for v0.8.0 update (fixed) * Add correspondence marker of detection_area and stop_line (#1081) * Fix comment Signed-off-by: Kenji Miyake <[email protected]> * Add const Signed-off-by: Kenji Miyake <[email protected]> * Add correspondence marker of detection_area and stop_line Signed-off-by: Kenji Miyake <[email protected]> * Add obstacle marker Signed-off-by: Kenji Miyake <[email protected]> * Fixup Signed-off-by: Kenji Miyake <[email protected]> * Add id marker Signed-off-by: Kenji Miyake <[email protected]> * Clear state when time rollback found Signed-off-by: Kenji Miyake <[email protected]> * Fix typo Signed-off-by: Kenji Miyake <[email protected]> * change stop to polygon line * apply clang format * fix code * fix bug Co-authored-by: taichiH <[email protected]> * Fix pass judge idx (#1090) Signed-off-by: wep21 <[email protected]> * fix bug (#1087) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix for ros2 style * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/remove duplicated point (#1107) * Split PoseDeviaiton functions Signed-off-by: Kenji Miyake <[email protected]> * Remove unnecessary pose Signed-off-by: Kenji Miyake <[email protected]> * Don't insert point if duplicated point exists Signed-off-by: Kenji Miyake <[email protected]> * Fix condition of duplicated points Signed-off-by: Kenji Miyake <[email protected]> * seperate stop distance param (#1137) * seperate stop distance param Signed-off-by: Kosuke Murakami <[email protected]> * apply param for automotically generated stop line Signed-off-by: Kosuke Murakami <[email protected]> * shift slow down line Signed-off-by: Kosuke Murakami <[email protected]> * add param in yaml file Signed-off-by: Kosuke Murakami <[email protected]> * fix prediction_time_margin bug (#1148) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix ros2 style * remove deprecated * reformat * add test temporary launch * cpp_lint_namespace_what_you_use * lint_comment_line_length * pass ament cpplint * fixe commit * fix code * remove unneccesary * fix param structure * fix missng params * fix throttle time Co-authored-by: tomoya.kimura <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: taichiH <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: Fumiya Watanabe <[email protected]> Co-authored-by: Daisuke Nishimatsu <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: Kosuke Murakami <[email protected]> Co-authored-by: Ryohsuke Mitsudome <[email protected]> * Fix/lane departure checker (#386) * Fix/lane departure checker (#1177) * Add more processing time measurement Signed-off-by: Kenji Miyake <[email protected]> * Rename processing_time to processing_time_ms Signed-off-by: Kenji Miyake <[email protected]> * Refactor StopWatch class Signed-off-by: Kenji Miyake <[email protected]> * apply ament_uncrustify Signed-off-by: mitsudome-r <[email protected]> * Fix autoware_utils (#419) * Fix autoware_utils Signed-off-by: Kenji Miyake <[email protected]> * Apply format Signed-off-by: Kenji Miyake <[email protected]> * Add <memory> Signed-off-by: Kenji Miyake <[email protected]> * Ros2 fix topic name part1 (#408) * Fix topic name of lane_departure_checker debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of mpc_follower debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of velocity_controller debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of motion_velocity_optimizer debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of lane_change_planner debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of behavior_velocity_planner debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of obstacle_avoidance_planner debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of motion_velocity_optimizer Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of lane_departure_checker Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of mpc_follower Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of velocity_controller Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of lane_change_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of obstacle_avoidance_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of obstacle_stop_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of freespace_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of surround_obstacle_checker Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of emergency_handler Signed-off-by: Takagi, Isamu <[email protected]> * Fix lint errors Signed-off-by: Takagi, Isamu <[email protected]> * Fix typo Signed-off-by: Takagi, Isamu <[email protected]> * Fix rolling build errors (#1225) * Add missing include files Signed-off-by: Kenji Miyake <[email protected]> * Replace rclcpp::Duration Signed-off-by: Kenji Miyake <[email protected]> * Use reference for exceptions Signed-off-by: Kenji Miyake <[email protected]> * Use from_seconds Signed-off-by: Kenji Miyake <[email protected]> * Ros2 delete vehicle info (#1227) * remove dependency on vehicle info in autoware_utils * delete vehicle_info in autoware_utils * Unify Apache-2.0 license name (#1242) * Fix/fix utils (#1310) * Add missing namespace to autoware_utils Signed-off-by: Kenji Miyake <[email protected]> * Add createVehicleInfo Signed-off-by: Kenji Miyake <[email protected]> * Add rethrow Signed-off-by: Kenji Miyake <[email protected]> * Format package.xml Signed-off-by: Kenji Miyake <[email protected]> * Fix usage of autoware_utils Signed-off-by: Kenji Miyake <[email protected]> * Add missing namespace comment Signed-off-by: Kenji Miyake <[email protected]> * Make a curvature calculation function in autoware_utils' library (#1388) (#1393) * add curvature calculation function * add two functions * integrate 2 functions into 1 function by template function * add unit test for curvature calculation * modify spell * Update common/util/autoware_utils/include/autoware_utils/math/curvature.h Co-authored-by: Kazuki Miyahara <[email protected]> * add modifications * modify format * update * update Co-authored-by: Kazuki Miyahara <[email protected]> Signed-off-by: wep21 <[email protected]> Co-authored-by: purewater0901 <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> * rename function from calculateCUrvature to calcCurvature (#1461) (#1486) Signed-off-by: Takamasa Horibe <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> * Add trajectory functions in autoware_utils (#1410)(#1438)(#1416)(#1473)(#1491) (#1482) * Add closest point index calculation function in autoware_utils (#1410) * add nearest point calculator * update * add template * update * update * update * update variables name * update variables name * remove redundant expression * add unit test * update test * test has some errors * update * update name * update name * modify bug * update * update * add new test cases * add new function * add get pose function * delete unnecessary file * update test * delete namespace * add emtpy handler * remove redundant test * remove template * add necessary files to autoware_utils (#1438) * add necessary files * Apply fix Signed-off-by: Kenji Miyake <[email protected]> * fix test Co-authored-by: Kenji Miyake <[email protected]> * Fix lint Signed-off-by: wep21 <[email protected]> * Fix build warning Signed-off-by: wep21 <[email protected]> * add some trajectory functions commonly used in planning/control (#1416) * add some trajectory functions commonly used in p/c * minor fix with reviews * refactor based on reviews * minor changes * refactor based on reviews * minor changes * minor changes * refactor based on reviews * use std::vector<T> and T in findClosestIndex * fix bugs that I wrote wrong * refactor * refactor * fix bug of including optional.hpp twice * refactor * refactor * fix bug * fix bugs * update * apply clang-format * add blank line * add test for searchZeroVelocityIndex * update * update * update * add some tests * closest -> nearest * add some test * update test * not to use optional if not necessary * not unsigned * add explanation of segment * update * 契約プログラミング * add signed to variable of length * update * update * update * update test * update * update test * update * update test * update * update * update * update * update * update * update * Remove wrapper for autoware_plannig_msgs Signed-off-by: Kenji Miyake <[email protected]> * Fix test Signed-off-by: Kenji Miyake <[email protected]> * Change implementation of calcLongitudinalOffsetToSegment Signed-off-by: Kenji Miyake <[email protected]> * Set default value for trajectory velocity Signed-off-by: Kenji Miyake <[email protected]> * Remove unused function Signed-off-by: Kenji Miyake <[email protected]> * add 3 cases for curve trajectory * update * Revert "update" This reverts commit 6d4f3ee25f49dcca146340c9a1ed3f4c1ac4f55c. * Revert "add 3 cases for curve trajectory" This reverts commit d3f4751851afcdac41e160fecbb6bee9ac9f60a2. * Add test case Signed-off-by: Kenji Miyake <[email protected]> * Fix comment Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> * use template in geometry.hpp (#1473) Signed-off-by: Takamasa Horibe <[email protected]> * Fix include Signed-off-by: Kenji Miyake <[email protected]> * Fix errors Signed-off-by: Kenji Miyake <[email protected]> * Fix license Signed-off-by: Kenji Miyake <[email protected]> * Fix find nearest segment index (#1491) * add odd test case, and confirmed that the test don't pass * fix findNearestSegmentIndex, and confirmed all the test passed * use calcLongitudinalOffsetToSegment * use vector in test * add deleted comment Co-authored-by: purewater0901 <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: Takayuki Murooka <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> * Feature/update autoware utils (#1501)(#1513)(#1522)(#1463)(#1503) (#1544) * generalize searchZeroVelocityIndex Function (#1501) * generalize searchZeroVelocityIndex Function * update test * fix test case * update test case * update terminal index in the test * Fix/fix autoware utils geometry (#1513) * Revert geometry.cpp Signed-off-by: Kenji Miyake <[email protected]> * Add default implementations Signed-off-by: Kenji Miyake <[email protected]> * add constant gravity (#1522) * add arange & linspace in math util (#1463) * [WIP] add arange & linspace in math util Signed-off-by: Takamasa Horibe <[email protected]> * add unittest cases of arange and linspace * implement and test arange and linspace in util library * fix issues found in review * fix typos * fix issue found in review * fix typo * fix issues found in review * fix issues found in review Co-authored-by: nisshan-x <[email protected]> * extend findNearestIndex, and add tests (#1503) * extend findNearestIndex, and add tests * apply clang-format * update * hoge_threshold -> max_hoge * _min/_max -> min_/max_, and update * update * update * update * update * update * Fix warnings Signed-off-by: Kenji Miyake <[email protected]> * Add reserve for autoware_utils::arange Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: purewater0901 <[email protected]> Co-authored-by: Takayuki Murooka <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: nisshan-x <[email protected]> * Add update_param.hpp in autoware_utils (#1556) * Add update_param.hpp in autoware_utils Signed-off-by: Kenji Miyake <[email protected]> * Change to bool Signed-off-by: Kenji Miyake <[email protected]> * Remove unnecesarry file for test (#1605) Signed-off-by: wep21 <[email protected]> * Feature/update autoware_utils (#1576) (#1599) (#1603) (#1619) (#1631) (#1650) * Add tests for autoware_utils::StopWatch (#1832) Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wunused-parameter (#1836) * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <[email protected]> * Fix mistake Signed-off-by: Kenji Miyake <[email protected]> * fix spell * Fix lint issues Signed-off-by: Kenji Miyake <[email protected]> * Ignore flake8 warnings Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Hiroki OTA <[email protected]> * Fix compiler warnings (#1837) * Fix -Wunused-private-field Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wunused-variable Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wformat-security Signed-off-by: Kenji Miyake <[email protected]> * Fix -Winvalid-constexpr Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wdelete-non-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wdelete-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <[email protected]> * Fix -Winconsistent-missing-override Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wrange-loop-construct Signed-off-by: Kenji Miyake <[email protected]> * Fix "invalid application of 'sizeof' to an incomplete type" Signed-off-by: Kenji Miyake <[email protected]> * Ignore -Wgnu-anonymous-struct and -Wnested-anon-types Signed-off-by: Kenji Miyake <[email protected]> * Fix lint Signed-off-by: Kenji Miyake <[email protected]> * Ignore -Wno-deprecated-declarations in CUDA-related packages Signed-off-by: Kenji Miyake <[email protected]> * Fix mistake Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <[email protected]> * Autoware util squared dist main merge (#1853) * autoware_utils: use calcSquaredDistance in calcClosest Signed-off-by: Takamasa Horibe <[email protected]> * add test Signed-off-by: Takamasa Horibe <[email protected]> * Fix clang warnings (#1859) * Fix -Wreturn-std-move Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wunused-private-field Signed-off-by: Kenji Miyake <[email protected]> * Ignore -Wnonportable-include-path for mussp Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wunused-const-variable Signed-off-by: Kenji Miyake <[email protected]> * Fix "can not be used when making a shared object" Signed-off-by: Kenji Miyake <[email protected]> * Fix clang-tidy warnings of autoware_utils (#1854) Signed-off-by: Kenji Miyake <[email protected]> * Revive constructor of StopWatch class (#1882) Signed-off-by: Kenji Miyake <[email protected]> * enable autonomous recovery (#1904) * add createQuaternionFromYaw (#2120) * add createQuaternionFromYaw * add test * change return value type of createQuaternionFromRPY from tf2::quat to geomety_msgs::msg::quat * use geometry_msgs::msg::Quaternion in createQuaternionFromRPY in application * implement fast findNearestIndex with threshold (#2142) * implement fast findNearestIndex with threshold * fix reviews * add calcLateralLength (#2226) * add calcLateralLength * rename length to offset * imeplemet in ROS2 (#1868) * add new get point function for posewithcovariancestamped (#2156) * add new get point function for posewithcovariancestamped * fix format * add behavior velocity planner utils (#2113) * add gtest utils * add state machine as utils * add arc lane utils * remove empty file * add gtest for offset segment * use calcdist2d in autoware util * apply get point * fix uncrustify * fix conflict getPoint in behavior path * apply commit suggestion * slower than ros1 * Change formatter to clang-format and black (#2332) * Revert "Temporarily comment out pre-commit hooks" This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3. * Replace ament_lint_common with autoware_lint_common Signed-off-by: Kenji Miyake <[email protected]> * Remove ament_cmake_uncrustify and ament_clang_format Signed-off-by: Kenji Miyake <[email protected]> * Apply Black Signed-off-by: Kenji Miyake <[email protected]> * Apply clang-format Signed-off-by: Kenji Miyake <[email protected]> * Fix build errors Signed-off-by: Kenji Miyake <[email protected]> * Fix for cpplint * Fix include double quotes to angle brackets Signed-off-by: Kenji Miyake <[email protected]> * Apply clang-format Signed-off-by: Kenji Miyake <[email protected]> * Fix build errors Signed-off-by: Kenji Miyake <[email protected]> * Add COLCON_IGNORE (#500) Signed-off-by: Kenji Miyake <[email protected]> * use autoware_auto_msgs (#489) Co-authored-by: Takayuki Murooka <[email protected]> * remove COLCON_IGNORE (#502) Co-authored-by: Takayuki Murooka <[email protected]> * Add trajectory converter (#512) * Add trajectory converter * Add comment * Fix comment * Fix comment * Add TODO in comment * Update common/util/autoware_utils/include/autoware_utils/trajectory/convert.hpp Co-authored-by: Kenji Miyake <[email protected]> * Fix comment * Use doxygen style comment * Fix function name * Fix test code Co-authored-by: Kenji Miyake <[email protected]> * add README (#671) * Sync .auto branch with the latest branch in internal repository (#691) * add trajectory point offset in rviz plugin (#2270) * sync rc rc/v0.23.0 (#2258) * fix interpolation for insert point (#2228) * fix interpolation for insert point * to prev interpolation pkg * Revert "to prev interpolation pkg" This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef. Co-authored-by: taikitanaka3 <[email protected]> Co-authored-by: taikitanaka <[email protected]> * fix topic name (#2266) Signed-off-by: Takamasa Horibe <[email protected]> * Add namespace to diag for dual_return_filter (#2269) * Add a function to make 'geometry_msgs::msg::TransformStamped' (#2250) * Add a function to make 'geometry_msgs::msg::TransformStamped' * Add 'child_frame_id' as an argument of 'pose2transform' * Simplify marker scale initialization (#2286) * Fix/crosswalk polygon (#2279) * extend crosswalk polygon * improve readability * fix polygon shape * Add warning when decel distance calculation fails (#2289) Signed-off-by: Makoto Kurihara <[email protected]> * [motion_velocity_smoother] ignore debug print (#2292) * cosmetic change Signed-off-by: Takamasa Horibe <[email protected]> * cahnge severity from WARN to DEBUG for debug info Signed-off-by: Takamasa Horibe <[email protected]> * use util for stop_watch Signed-off-by: Takamasa Horibe <[email protected]> * fix map based prediction (#2200) * fix map based prediction * fix format * change map based prediction * fix spells * fix spells in comments * fix for cpplint * fix some problems * fix format and code for clang-tidy * fix space for cpplint * Update Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * fix vector access method * fix readme format * add parameter * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <[email protected]> * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <[email protected]> * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <[email protected]> * Update Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> * remove failure condition for 0 velocity trajectory (#2295) Signed-off-by: Takamasa Horibe <[email protected]> * [mpc_follower] remove stop distance condition from stopState decision (#1916) * [mpc_follower] remove stop distance condition from stopState decision Signed-off-by: Takamasa Horibe <[email protected]> * add invalid index handling Signed-off-by: Takamasa Horibe <[email protected]> * Move the debug marker initialization part to another file (#2288) * Move the debug marker initialization part to 'debug.cpp' * Make 'isLocalOptimalSolutionOscillation' independent from 'NDTScanMatcher' (#2300) * Remove an unused function 'getTransform' (#2301) * Simplify iteration of initial poses (#2310) * Make a transform object const (#2311) * Represent poses in 'std::vector' instead of 'geometry_msgs::msg::PoseArray' (#2312) * Feature/no stopping area (#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 <[email protected]> * update license Co-authored-by: Yukihiro Saito <[email protected]> * update license Co-authored-by: Yukihiro Saito <[email protected]> * update license Co-authored-by: Yukihiro Saito <[email protected]> * 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 <[email protected]> * sync rc rc/v0.23.0 (#2281) * Fix side shift planner (#2171) (#2172) * add print debug Signed-off-by: TakaHoribe <[email protected]> * remove forward shift points when adding new point Signed-off-by: TakaHoribe <[email protected]> * remove debug print Signed-off-by: TakaHoribe <[email protected]> * format Signed-off-by: TakaHoribe <[email protected]> * Fix remove threshold Co-authored-by: Fumiya Watanabe <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> * Fix/pull out and pull over (#2175) * delete unnecessary check * fix condition of starting pull out * Add emergency status API (#2174) (#2182) * Fix/mpc reset prev result (#2185) (#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 <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> * [hotfix] 1 path point exception after resampling (#2204) * fix 1 path point exception after resampling Signed-off-by: TakaHoribe <[email protected]> * Apply suggestions from code review * Apply suggestions from code review Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: tkimura4 <[email protected]> * [hotfix] Fix lane ids (#2211) * Fix lane ids * Prevent acceleration on avoidance (#2214) * prevent acceleration on avoidance Signed-off-by: TakaHoribe <[email protected]> * fix param name Signed-off-by: TakaHoribe <[email protected]> * parametrize avoidance acc Signed-off-by: Takamasa Horibe <[email protected]> * change param name Signed-off-by: Takamasa Horibe <[email protected]> * fix typo Signed-off-by: Takamasa Horibe <[email protected]> * Fix qos in roi cluster fusion (#2218) * fix confidence (#2220) * too high confidence (#2229) * Fix/obstacle stop 0.23.0 (#2232) * fix unexpected slow down in sharp curves (#2181) * Fix/insert implementation (#2186) Co-authored-by: Satoshi OTA <[email protected]> * [hotfix] Remove exception in avoidance module (#2233) * Remove exception * Fix clock * Remove blank line * Update traffic light state if ref stop point is ahead of previous one (#2197) Signed-off-by: wep21 <[email protected]> * fix interpolation for insert point (#2228) * fix interpolation for insert point * to prev interpolation pkg * fix index (#2265) * turn signal calculation (#2280) * add turn signal funtion in path shifter * add ros parameters Co-authored-by: Fumiya Watanabe <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Takagi, Isamu <[email protected]> Co-authored-by: Daisuke Nishimatsu <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: taikitanaka3 <[email protected]> Co-authored-by: Sugatyon <[email protected]> * [behavior_path_planner] fix sudden path change around ego (#2305) (#2318) * fix return-from-ego shift point generation logic Signed-off-by: Takamasa Horibe <[email protected]> * change param for trimSimilarGradShiftPoint Signed-off-by: Takamasa Horibe <[email protected]> * add comment for issue Signed-off-by: Takamasa Horibe <[email protected]> * update comment Signed-off-by: Takamasa Horibe <[email protected]> * replace code with function (logic has not changed) Signed-off-by: Takamasa Horibe <[email protected]> * move func to cpp Signed-off-by: Takamasa Horibe <[email protected]> * add comment for issue Signed-off-by: Takamasa Horibe <[email protected]> * fix typo Signed-off-by: Takamasa Horibe <[email protected]> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp Co-authored-by: Kazuki Miyahara <[email protected]> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> * Add functions to make stamped scalar messages (#2317) * Fix/object yaw in intersection module (#2294) * fix object orientation * fix function name * add guard (#2321) * reduce cost (double to float) (#2298) * Add detail collision check (#2274) * Add detail collision check Signed-off-by: wep21 <[email protected]> * Remove unused function Signed-off-by: wep21 <[email protected]> * Fix arc length Signed-off-by: wep21 <[email protected]> * Seperate time margin Signed-off-by: wep21 <[email protected]> * Fix parameter name Signed-off-by: wep21 <[email protected]> * Update Readme Signed-off-by: wep21 <[email protected]> * Address review: Add comment for TimeDistanceArray Signed-off-by: wep21 <[email protected]> * Run pre-commit Signed-off-by: wep21 <[email protected]> * Fix cpplint Signed-off-by: wep21 <[email protected]> * Add return for empty polygon Signed-off-by: wep21 <[email protected]> * update CenterPoint (#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 (#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 <[email protected]> * 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 <[email protected]> * Add Planning Evaluator (#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 <[email protected]> * fix yaml format to fix pre-commit check Signed-off-by: Takamasa Horibe <[email protected]> * fix yaml format Signed-off-by: Takamasa Horibe <[email protected]> * apply clang-format Signed-off-by: Takamasa Horibe <[email protected]> * apply clang-format Signed-off-by: Takamasa Horibe <[email protected]> * 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 <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> * Add keep braking function at driving state (#2346) * Add keep braking function at driving state Signed-off-by: Makoto Kurihara <[email protected]> * Remove debug messages Signed-off-by: Makoto Kurihara <[email protected]> * Fix format Signed-off-by: Makoto Kurihara <[email protected]> * Change diag_updater's pediod from default to 0.1sec (#2348) * add cross judgement and common signal function (#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 (#2340) Signed-off-by: Makoto Kurihara <[email protected]> * add time offset param to point cloud concatenation (#2303) * add offset param * clang-format Co-authored-by: Akihito OHSATO <[email protected]> * Feature/add doc for keep braking function at driving state (#2366) * Add the description of brake keeping Signed-off-by: Makoto Kurihara <[email protected]> * Add the english document Signed-off-by: Makoto Kurihara <[email protected]> * Improve description Signed-off-by: Makoto Kurihara <[email protected]> * Add english description Signed-off-by: Makoto Kurihara <[email protected]> * Fix include files (#2339) Signed-off-by: Kenji Miyake <[email protected]> * 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 (#1916)" This reverts commit ff4f0b5a844d1f835f1b93bd3b36a76747b0cd02. * Revert "Add keep braking function at driving state (#2346)" This reverts commit f0478187db4c28bf6092c198723dcc5ec11a9c70. * Revert "Feature/add doc for keep braking function at driving state (#2366)" This reverts commit 66de2f3924a479049fce2d5c5c6b579cacbd3e49. * Fix orientation availability in centerpoint Signed-off-by: wep21 <[email protected]> * fix test_trajectory.cpp * add target link libraries * Use .auto msg in test code for planniing evaluator Signed-off-by: wep21 <[email protected]> * fix include Signed-off-by: wep21 <[email protected]> Co-authored-by: Takayuki Murooka <[email protected]> Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com> Co-authored-by: taikitanaka3 <[email protected]> Co-authored-by: taikitanaka <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: Takeshi Miura <[email protected]> Co-authored-by: Takeshi Ishita <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: Makoto Kurihara <[email protected]> Co-authored-by: purewater0901 <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> Co-authored-by: Fumiya Watanabe <[email protected]> Co-authored-by: Takagi, Isamu <[email protected]> Co-authored-by: Sugatyon <[email protected]> Co-authored-by: s-murakami-esol <[email protected]> Co-authored-by: Yusuke Muramatsu <[email protected]> Co-authored-by: Maxime CLEMENT <[email protected]> Co-authored-by: Shunsuke Miura <[email protected]> Co-authored-by: Shinnosuke Hirakawa <[email protected]> Co-authored-by: Akihito OHSATO <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: mitsudome-r <[email protected]> Co-authored-by: Nikolai Morin <[email protected]> Co-authored-by: Daisuke Nishimatsu <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: taikitanaka3 <[email protected]> Co-authored-by: taichiH <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: Fumiya Watanabe <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: Kosuke Murakami <[email protected]> Co-authored-by: Ryohsuke Mitsudome <[email protected]> Co-authored-by: Takagi, Isamu <[email protected]> Co-authored-by: purewater0901 <[email protected]> Co-authored-by: Takayuki Murooka <[email protected]> Co-authored-by: nisshan-x <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: Hiroki OTA <[email protected]> Co-authored-by: Taichi Higashide <[email protected]> Co-authored-by: Takayuki Murooka <[email protected]> Co-authored-by: Takeshi Miura <[email protected]> Co-authored-by: autoware-iv-sync-ci[bot] <87871706+autoware-iv-sync-ci[bot]@users.noreply.github.com> Co-authored-by: taikitanaka <[email protected]> Co-authored-by: Takeshi Ishita <[email protected]> Co-authored-by: Makoto Kurihara <[email protected]> Co-authored-by: Sugatyon <[email protected]> Co-authored-by: s-murakami-esol <[email protected]> Co-authored-by: Yusuke Muramatsu <[email protected]> Co-authored-by: Maxime CLEMENT <[email protected]> Co-authored-by: Shunsuke Miura <[email protected]> Co-authored-by: Shinnosuke Hirakawa <[email protected]> Co-authored-by: Akihito OHSATO <[email protected]>
yukkysaito
added a commit
to yukkysaito/autoware.universe
that referenced
this pull request
Jun 29, 2022
* release v0.4.0 * Fix typo (#700) Signed-off-by: Kenji Miyake <[email protected]> * Fix detection area (#701) * Replace calcDistance with calcSignedDistance Signed-off-by: Kenji Miyake <[email protected]> * Add STOP state Signed-off-by: Kenji Miyake <[email protected]> * intersection: change detection area length parameter from 100m to 200m (#702) Signed-off-by: Takamasa Horibe <[email protected]> * intersection: fix stuck vehicle behavior (#695) Signed-off-by: Takamasa Horibe <[email protected]> * Feature/intersection use spline interpolation library (#710) * Use spline_interpolation module * Remove debug messages * Feature/stop reason (#712) * add stop reason msg * add mock of stop resaon publisher * change namespace of stop reason * update stop reason msg * add toRosPoint * implement stop reason publisher of blind stop * implement stop reason publisher of crosswalk * implement stop reason publisher of intersection * implement stop reason publisher of stop line * implement stop reason publisher of trafficlight * implement stop reason publisher of detection area * fix bug * remove unnecessary process * add remained stop factor * clean code * fix bug * not punlish stop reason if array size is 0 * add stop reason to stuck object in intersection * add stop factor of obstacle stop planner * add stop reason of surround_obstacle checker * Apply review Signed-off-by: Kenji Miyake <[email protected]> * fix message type * delete unused message from cmake * remove stopReasonStamped * change topic name of stop reasons Co-authored-by: Kenji Miyake <[email protected]> * Fix/stop reason (#724) * input stop reason of traffic light * add comment * add empty traffic light handling * change calculation method of traffic light position * avoid 0 position output * Fix/spline interpolation in intersection module (#726) * Remove duplicating sample points * Change isValidInput * Apply clang-format * Fix convergence check in PCG * fix clac signed distance bug (#733) * intersection: ignore stop plane when path[0] is in detection area (#739) Signed-off-by: Takamasa Horibe <[email protected]> * Publish tl states stamped (#744) * Add TrafficLightStateStamped.msg Signed-off-by: wep21 <[email protected]> * Use msg instead of struct Signed-off-by: wep21 <[email protected]> * Publish traffic light state Signed-off-by: wep21 <[email protected]> * Check if lamp state is empty Signed-off-by: Daisuke Nishimatsu <[email protected]> * Apply clang-format Signed-off-by: Daisuke Nishimatsu <[email protected]> * Cosmetic change Signed-off-by: Daisuke Nishimatsu <[email protected]> * update visualization marker (#759) * fix stack area (#758) * dont check pointcloud (#765) Signed-off-by: Yukihiro Saito <[email protected]> * fix stop factor of merge_from_private_area (#749) * Revert "Publish tl states stamped (#744)" (#771) This reverts commit 35a7e29e987afb29d9348b5f64866a584a65f753. * fix intersection bug (#773) * fix bug * fix bug * change uid of marker (#775) * Fix/publish tl state stamped (#772) * Publish tl states stamped (#744) * Add TrafficLightStateStamped.msg Signed-off-by: wep21 <[email protected]> * Use msg instead of struct Signed-off-by: wep21 <[email protected]> * Publish traffic light state Signed-off-by: wep21 <[email protected]> * Check if lamp state is empty Signed-off-by: Daisuke Nishimatsu <[email protected]> * Apply clang-format Signed-off-by: Daisuke Nishimatsu <[email protected]> * Cosmetic change Signed-off-by: Daisuke Nishimatsu <[email protected]> * Use dynamic pointer cast Signed-off-by: Daisuke Nishimatsu <[email protected]> * Fix blind spot areas and logic for creating a stop line (#732) * Fix blind spot areas Signed-off-by: Daisuke Nishimatsu <[email protected]> * Change logic for creating a stop line Signed-off-by: Daisuke Nishimatsu <[email protected]> * Do not add marker when marker is empty Signed-off-by: Daisuke Nishimatsu <[email protected]> * Cosmetic change Signed-off-by: Daisuke Nishimatsu <[email protected]> * Return boost optional for first conflict point Signed-off-by: Daisuke Nishimatsu <[email protected]> * Return boost optional for intersection start point Signed-off-by: Daisuke Nishimatsu <[email protected]> * Apply clang Signed-off-by: Daisuke Nishimatsu <[email protected]> * Fix/intersection stuck detect area (#764) * fix stuck-vehicle detection area in intersection module * separate vehicle param * change the way ouf start idx count * change param * avoid to input -1 index (#777) * add dead line and pass through when over dead line (#784) * Add arg for input tl topic name (#783) Signed-off-by: wep21 <[email protected]> * change margin to 1.0m (#790) Signed-off-by: Yukihiro Saito <[email protected]> * fix insert target point bug (#798) * fix typo stop_liine to stop_line (#799) Signed-off-by: Takamasa Horibe <[email protected]> * traffic light scene module : fix bug and change param (#800) * fix bug (passs judge line) Signed-off-by: Yukihiro Saito <[email protected]> * bug fix Signed-off-by: Yukihiro Saito <[email protected]> * change param Signed-off-by: Yukihiro Saito <[email protected]> * Intersection add debug comment (#803) * blind spot : modify debug comment Signed-off-by: Takamasa Horibe <[email protected]> * merge from private road : modify debug comment Signed-off-by: Takamasa Horibe <[email protected]> * intersection : modify debug comment Signed-off-by: Takamasa Horibe <[email protected]> * intersection util: modify generateStopLine() for debug Signed-off-by: Takamasa Horibe <[email protected]> * add comment Signed-off-by: Takamasa Horibe <[email protected]> * Fix intersection preceeding lane query (#807) * modified interseciton module to add lanelets in intersection to objective lanelets due to change in getPreceedingLaneletSequences() Signed-off-by: mitsudome-r <[email protected]> * update comment Signed-off-by: mitsudome-r <[email protected]> * Fix blind spot area (#806) * Fix blind spot area Signed-off-by: wep21 <[email protected]> * Use range based for Signed-off-by: wep21 <[email protected]> * Use std::unique to remove adjacent duplicates Signed-off-by: wep21 <[email protected]> * Use generateFineCenterline Signed-off-by: wep21 <[email protected]> * Fix detection area start point Signed-off-by: wep21 <[email protected]> * Revert "Use generateFineCenterline" This reverts commit 9d4f46bf65d7296b9286b30dfeed217a566a815c. * Fix centerline of half lanelet Signed-off-by: wep21 <[email protected]> * Fix area start point Signed-off-by: wep21 <[email protected]> * Revert "fix insert target point bug (#798)" (#815) This reverts commit 12eac2023538531e28a85a8914305cb534499f29. * Fix/traffic light state (#801) * fix bug (passs judge line) Signed-off-by: Yukihiro Saito <[email protected]> * bug fix Signed-off-by: Yukihiro Saito <[email protected]> * change param Signed-off-by: Yukihiro Saito <[email protected]> * bug fix : remove stop state Signed-off-by: Yukihiro Saito <[email protected]> * add lower limit Signed-off-by: Yukihiro Saito <[email protected]> * change param (#821) Signed-off-by: Yukihiro Saito <[email protected]> * stopline: parametrize check distance (#825) Signed-off-by: Takamasa Horibe <[email protected]> * Check if lanelets are sequential (#823) Signed-off-by: wep21 <[email protected]> * fix uninitialized variables (#816) * Parameterization for calculating judge line distance (#831) Signed-off-by: wep21 <[email protected]> * remove ROS1 packages temporarily Signed-off-by: mitsudome-r <[email protected]> * Revert "remove ROS1 packages temporarily" This reverts commit 96b63e981899f79f2f5c6a6377e9600cc278e233. Signed-off-by: mitsudome-r <[email protected]> * add COLCON_IGNORE to ros1 packages Signed-off-by: mitsudome-r <[email protected]> * Rename launch files to launch.xml (#28) * Port behavior_velocity_planner to ROS2 (#80) * Revert "Add geometry2 to repos (#76)" This reverts commit 6d2270476aaafdf1a8098d700d52a508525ea04b. * Automatic parts of the package port * Interesting part * Fix typo in package.xml * Review comments * Child logger names * Document logging duration Co-authored-by: Ryohsuke Mitsudome <[email protected]> * [ROS2] Fix behavior velocity planner (#110) * install launch and config folders Signed-off-by: mitsudome-r <[email protected]> * port launch file Signed-off-by: mitsudome-r <[email protected]> * fix config files Signed-off-by: mitsudome-r <[email protected]> * improve vehicle_info_utils to enable multiple declaration of VehicleInfo objects Signed-off-by: mitsudome-r <[email protected]> * fix sementation fault Signed-off-by: mitsudome-r <[email protected]> * Convert calls of Duration to Duration::from_seconds where appropriate (#131) * Rename h files to hpp (#142) * Change includes * Rename files * Adjustments to make things compile * Other packages * Adjust copyright notice on 532 out of 699 source files (#143) * Use quotes for includes where appropriate (#144) * Use quotes for includes where appropriate * Fix lint tests * Make tests pass hopefully * Run uncrustify on the entire Pilot.Auto codebase (#151) * Run uncrustify on the entire Pilot.Auto codebase * Exclude open PRs * fixing trasient_local in ROS2 packages (#160) * Enable cppcheck lints in behavior_velocity_planner (#159) * Enable lints in behavior_velocity_planner * Fix package.xml * Make launch files load vehicle model params dependent on argument (#228) * Make vehicle_model configurable in behavior_velocity_planner * Make vehicle_model configurable in vehicle_cmd_gate * change from vehicle_model to vehicle_param_file (#242) Signed-off-by: kosuke murakami <[email protected]> * Ros2 v0.8 fix typo of "preceding" (#323) * Fix typo of getPrecedingLaneletSequences * Fix comment * Ros2 v0.8.0 behavior velocity planner (#332) * restore behavior velocity planner files for v0.8.0 update * Fix detection area (#808) * Remove PASS state Signed-off-by: Kenji Miyake <[email protected]> * Keep stopping after going over dead-line in STOP state Signed-off-by: Kenji Miyake <[email protected]> * Clear state after obstacle disappears Signed-off-by: Kenji Miyake <[email protected]> * Parameterize and change conditions Signed-off-by: Kenji Miyake <[email protected]> * Refactor Signed-off-by: Kenji Miyake <[email protected]> * add elapsed time checker * Refactor Signed-off-by: Kenji Miyake <[email protected]> * Ignore inserting point if points are too close Signed-off-by: Kenji Miyake <[email protected]> * Rename NORMAL to GO Signed-off-by: Kenji Miyake <[email protected]> * Revert "Ignore inserting point if points are too close" This reverts commit 91c8d620ea11e703611945cb9a50877d175f4ff6. * Fix small bug Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: taichiH <[email protected]> * fix timing of publish stop reason of stop_line (#845) * fix timing of publish stop reason of stop_line * Fix formatting Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> * Fix task registration of detection area module (#856) * Fix task registration of detection area module Signed-off-by: Kenji Miyake <[email protected]> * Fix id of factor_text marker Signed-off-by: Kenji Miyake <[email protected]> * Do not interpolate if path size is 1 (#865) * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ce07d3c2bfae562d56fec46c4f81d5351fd936a1. * fix some implement miss * restore behavior velocity planner files for v0.8.0 update * change intersection param (#861) * Fix/intersection stop line (#841) * add trimmed path function * fix typo * avoid to insert stop line outside intersection * Add pass judge flag (#872) * Add pass judge flag Signed-off-by: wep21 <[email protected]> * Fix wrong format Signed-off-by: wep21 <[email protected]> * Fix flag order in judge condition Signed-off-by: wep21 <[email protected]> * add ignore width with blind spot (#864) * add ignore width with blind spot * remove unused function * fix typo * fix margin * remove bicycle from intersection stuck vehicle (#896) * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9. * fix implement miss * restore behavior velocity planner files for v0.8.0 update (fixed) * Add external traffic light input (#912) * Add external traffic light input Signed-off-by: wep21 <[email protected]> * Update topic namespace * Fix typos in planning modules (#866) * fix typos in planning * fix corresponding typos in planning * revert fixed typos temporarily due to its impact on launchers * add exception handling to intersection module (#920) * add exception handling * output input path * prevent passthrough chattering (#901) Signed-off-by: Yukihiro Saito <[email protected]> * cosnider current_velocity to calculate intersection passing time (#880) * cosnider current_velocity to calculate intersection passing time * add fabs to current velocity * Improve stuck vehicle detect (#824) * intersection: modify stuck vehicle detect logic to consider the object shape Signed-off-by: Takamasa Horibe <[email protected]> * intersection: consider ego-vehicle length when calculate stuck vehicle detection area Signed-off-by: Takamasa Horibe <[email protected]> * intersection: change param stuck_vehicle_ignore_dist: 5.0 -> 7.0 Signed-off-by: Takamasa Horibe <[email protected]> * intersection: use vehicle_info/vehicle_length Signed-off-by: Takamasa Horibe <[email protected]> * fix implement miss * fix target pedestrian (#927) Signed-off-by: Yukihiro Saito <[email protected]> * fix insert backward point (#953) * fix insert backward point * add comment Signed-off-by: Kosuke Murakami <[email protected]> * remove unnecessary if Signed-off-by: Kosuke Murakami <[email protected]> * Add stop line referred from road marking (#968) * Add stop line referred from road marking Signed-off-by: wep21 <[email protected]> * Add stop line for walkway Signed-off-by: wep21 <[email protected]> * Feature/external input (#982) * add external input msg * impl external input(crosswalk, intersection) * :put_litter_in_its_place: * change to ++14 * fix bug * fix bug * cosmetic change * Revert "restore behavior velocity planner files for v0.8.0 update" This reverts commit ff61ee56f2ce4728e53eb698836db60d68bf64b9. * Fix typo (#1013) Signed-off-by: Kenji Miyake <[email protected]> * Fix/blind spot insert point (#1027) * Copy insert point from previous point * Reset path unless state is stop Signed-off-by: wep21 <[email protected]> * change slow down speed (#1030) * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/walkway stop judge range (#1028) * Fix walkway stop judge Signed-off-by: wep21 <[email protected]> * Make refer id same Signed-off-by: wep21 <[email protected]> * fix getObjectivePolygons() so that intersecting lanelet is added to objective lanelets even when there is no preceeding lanelets (#1010) Signed-off-by: mitsudome-r <[email protected]> * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix implement miss for marker * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/blind spot polygon (#1056) * Fix detection area for blind spot Signed-off-by: wep21 <[email protected]> * Apply clang format Signed-off-by: wep21 <[email protected]> * Shrink conflicting area Signed-off-by: wep21 <[email protected]> * chane slowdown judgement (#1066) * chane slowdown judgement * cosmetic change * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fixed for ros2 style * restore behavior velocity planner files for v0.8.0 update (fixed) * Remove unused headers in behavior_velocity_planner (#1072) * publish walkway stop reason (#1073) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * restore behavior velocity planner files for v0.8.0 update (fixed) * Add correspondence marker of detection_area and stop_line (#1081) * Fix comment Signed-off-by: Kenji Miyake <[email protected]> * Add const Signed-off-by: Kenji Miyake <[email protected]> * Add correspondence marker of detection_area and stop_line Signed-off-by: Kenji Miyake <[email protected]> * Add obstacle marker Signed-off-by: Kenji Miyake <[email protected]> * Fixup Signed-off-by: Kenji Miyake <[email protected]> * Add id marker Signed-off-by: Kenji Miyake <[email protected]> * Clear state when time rollback found Signed-off-by: Kenji Miyake <[email protected]> * Fix typo Signed-off-by: Kenji Miyake <[email protected]> * change stop to polygon line * apply clang format * fix code * fix bug Co-authored-by: taichiH <[email protected]> * Fix pass judge idx (#1090) Signed-off-by: wep21 <[email protected]> * fix bug (#1087) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix for ros2 style * restore behavior velocity planner files for v0.8.0 update (fixed) * Fix/remove duplicated point (#1107) * Split PoseDeviaiton functions Signed-off-by: Kenji Miyake <[email protected]> * Remove unnecessary pose Signed-off-by: Kenji Miyake <[email protected]> * Don't insert point if duplicated point exists Signed-off-by: Kenji Miyake <[email protected]> * Fix condition of duplicated points Signed-off-by: Kenji Miyake <[email protected]> * seperate stop distance param (#1137) * seperate stop distance param Signed-off-by: Kosuke Murakami <[email protected]> * apply param for automotically generated stop line Signed-off-by: Kosuke Murakami <[email protected]> * shift slow down line Signed-off-by: Kosuke Murakami <[email protected]> * add param in yaml file Signed-off-by: Kosuke Murakami <[email protected]> * fix prediction_time_margin bug (#1148) * Revert "restore behavior velocity planner files for v0.8.0 update (fixed)" This reverts commit 39231f23eb17e39a418f28f5ccfe1df55b3fb45c. * fix ros2 style * remove deprecated * reformat * add test temporary launch * cpp_lint_namespace_what_you_use * lint_comment_line_length * pass ament cpplint * fixe commit * fix code * remove unneccesary * fix param structure * fix missng params * fix throttle time Co-authored-by: tomoya.kimura <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: taichiH <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: Fumiya Watanabe <[email protected]> Co-authored-by: Daisuke Nishimatsu <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: Kosuke Murakami <[email protected]> Co-authored-by: Ryohsuke Mitsudome <[email protected]> * Rename ROS-related .yaml to .param.yaml (#352) * Rename ROS-related .yaml to .param.yaml Signed-off-by: Kenji Miyake <[email protected]> * Remove prefix 'default_' of yaml files Signed-off-by: Kenji Miyake <[email protected]> * Rename vehicle_info.yaml to vehicle_info.param.yaml Signed-off-by: Kenji Miyake <[email protected]> * Rename diagnostic_aggregator's param files Signed-off-by: Kenji Miyake <[email protected]> * Fix overlooked parameters Signed-off-by: Kenji Miyake <[email protected]> * [behavior_velocity_planner]: Fix missing ros2 porting (#392) Signed-off-by: wep21 <[email protected]> * Fix error handling of tf lookupTransform (#405) Co-authored-by: autoware <[email protected]> * rm_std_msgs (#402) * Sensor data qos (#407) * Use sensor data qos for pointcloud preprocessor Signed-off-by: Autoware <[email protected]> * Use sensor data qos for pointcloud Signed-off-by: Autoware <[email protected]> * Fix lint Signed-off-by: wep21 <[email protected]> * Use sensor data qos for livox tag filter and vector map filter Signed-off-by: wep21 <[email protected]> * Fix lint Signed-off-by: wep21 <[email protected]> Co-authored-by: Autoware <[email protected]> * Ros2 fix topic name part1 (#408) * Fix topic name of lane_departure_checker debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of mpc_follower debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of velocity_controller debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of motion_velocity_optimizer debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of lane_change_planner debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of behavior_velocity_planner debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of obstacle_avoidance_planner debug Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of motion_velocity_optimizer Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of lane_departure_checker Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of mpc_follower Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of behavior_velocity_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of velocity_controller Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of lane_change_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of obstacle_avoidance_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of obstacle_stop_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of freespace_planner Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of surround_obstacle_checker Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of costmap_generator Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of emergency_handler Signed-off-by: Takagi, Isamu <[email protected]> * Fix lint errors Signed-off-by: Takagi, Isamu <[email protected]> * Fix typo Signed-off-by: Takagi, Isamu <[email protected]> * Fix typo in planning module (#432) * Fix typo in planning module * Fix remaining errors Signed-off-by: Kenji Miyake <[email protected]> * Apply cpplint and uncrustify. Co-authored-by: Kenji Miyake <[email protected]> * fix traffic light module (#458) * change log type (#459) * add use_sim-time option (#454) * Fix rolling build errors (#1225) * Add missing include files Signed-off-by: Kenji Miyake <[email protected]> * Replace rclcpp::Duration Signed-off-by: Kenji Miyake <[email protected]> * Use reference for exceptions Signed-off-by: Kenji Miyake <[email protected]> * Use from_seconds Signed-off-by: Kenji Miyake <[email protected]> * Sync public repo (#1228) * [simple_planning_simulator] add readme (#424) * add readme of simple_planning_simulator Signed-off-by: Takamasa Horibe <[email protected]> * Update simulator/simple_planning_simulator/README.md * set transit_margin_time to intersect. planner (#460) * Fix pose2twist (#462) Signed-off-by: Takagi, Isamu <[email protected]> * Ros2 vehicle info param server (#447) * add vehicle_info_param_server * update vehicle info * apply format * fix bug * skip unnecessary search * delete vehicle param file * fix bug * Ros2 fix topic name part2 (#425) * Fix topic name of traffic_light_classifier Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of traffic_light_visualization Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <[email protected]> * Fix topic name of traffic_light_map_based_detector Signed-off-by: Takagi, Isamu <[email protected]> * Fix lint traffic_light_recognition Signed-off-by: Takagi, Isamu <[email protected]> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <[email protected]> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <[email protected]> * Fix lint traffic_light_classifier Signed-off-by: Takagi, Isamu <[email protected]> * Fix lint traffic_light_ssd_fine_detector Signed-off-by: Takagi, Isamu <[email protected]> * Fix issues in hdd_reader (#466) * Fix some issues detected by Coverity Scan and Clang-Tidy * Update launch command * Add more `close(new_sock)` * Simplify the definitions of struct * fix: re-construct laneletMapLayer for reindex RTree (#463) * Rviz overlay render fix (#461) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <[email protected]> * super class now back to MFD Signed-off-by: Adam Dabrowski <[email protected]> * uncrustified Signed-off-by: Adam Dabrowski <[email protected]> * acquire data in mutex Signed-off-by: Adam Dabrowski <[email protected]> * back to RTD as superclass Signed-off-by: Adam Dabrowski <[email protected]> * Rviz overlay render in update (#465) * Moved painiting in SteeringAngle plugin to update() Signed-off-by: Adam Dabrowski <[email protected]> * super class now back to MFD Signed-off-by: Adam Dabrowski <[email protected]> * uncrustified Signed-off-by: Adam Dabrowski <[email protected]> * acquire data in mutex Signed-off-by: Adam Dabrowski <[email protected]> * removed unnecessary includes and some dead code Signed-off-by: Adam Dabrowski <[email protected]> * Adepted remaining vehicle plugin classes to render-in-update concept. Returned to MFD superclass Signed-off-by: Adam Dabrowski <[email protected]> * restored RTD superclass Signed-off-by: Adam Dabrowski <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Takagi, Isamu <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: Makoto Tokunaga <[email protected]> Co-authored-by: Adam Dąbrowski <[email protected]> * Unify Apache-2.0 license name (#1242) * Make planning modules components (#1263) Signed-off-by: wep21 <[email protected]> * Remove use_sim_time for set_parameter (#1260) Signed-off-by: wep21 <[email protected]> * Refactor vehicle info util (#1305) * Update license Signed-off-by: Kenji Miyake <[email protected]> * Refactor vehicle_info_util Signed-off-by: Kenji Miyake <[email protected]> * Rename and split files Signed-off-by: Kenji Miyake <[email protected]> * Fix interfaces Signed-off-by: Kenji Miyake <[email protected]> * Fix bug and add error handling Signed-off-by: Kenji Miyake <[email protected]> * Add "// namespace" Signed-off-by: Kenji Miyake <[email protected]> * Add missing include Signed-off-by: Kenji Miyake <[email protected]> * fix slow/stop marker color & stop reason (#1347) (#1354) Co-authored-by: satoshi-ota <[email protected]> Signed-off-by: wep21 <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: satoshi-ota <[email protected]> * fix intersection stop line (#1272) (#1349) * fix intersection stop line (#1272) * fix intersection stop line * fix comment * Fix typo Signed-off-by: wep21 <[email protected]> Co-authored-by: tkimura4 <[email protected]> * Avoid passing empty lanelets to getPolygonFromArcLength (#1371) Signed-off-by: wep21 <[email protected]> * Add perception traffic light state output (#1302) * Add perception traffic light state output Signed-off-by: Takagi, Isamu <[email protected]> * Modify message type Signed-off-by: Takagi, Isamu <[email protected]> * Apply message type to relay Signed-off-by: Takagi, Isamu <[email protected]> * Feature/consider jerk limit in passjudge (#1339) (#1351) * Feature/consider jerk limit in passjudge (#1339) * make new branch for behavior velocity planner * update implementation for considering accel & jerk limit * refactoring * change default params * change default params * change minimum velocity which decides to conduct pass judge * remove ROS_DEBUG_COND() * remove unnecessary variables * fix lowpass filter implementation * calc acceleration in planner_data_ Co-authored-by: satoshi-ota <[email protected]> * Fix typo Signed-off-by: wep21 <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: satoshi-ota <[email protected]> * Feature/refactor stop line module (#1343) (#1359) * Refactor stop_line planner module Signed-off-by: Kenji Miyake <[email protected]> * Add document Signed-off-by: Kenji Miyake <[email protected]> * Fix English Signed-off-by: Kenji Miyake <[email protected]> * Fix Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> * Feature/add stop duration ros2 (#1380) * Feature/add stop duration (#1367) * Add stop_duration to behavior_velocity_planner Signed-off-by: Kenji Miyake <[email protected]> * parameterize stop duration sec * Use stop_duration in Stop Line module Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Hiroki OTA <[email protected]> Signed-off-by: wep21 <[email protected]> * Change default value Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: Hiroki OTA <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> * Fix topic name of external traffic light input (#1412) * publish perception and external tl_state for mlops (#1350) (#1375) * publish perception and external tl_state for mlops * fix tl_state time stamp Co-authored-by: satoshi-ota <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: satoshi-ota <[email protected]> * Fix/traffic light planning module (#1424) (#1487) * Fix/traffic light planning module (#1424) * bug fix * refactor * refactor * cosmetic change * fix typo * cosmetic change * refactor * remove unused func * enable restart * cosmetic change * fix typo * refactor * bug fix * cosmetic change * modify debug_data * Apply lint Signed-off-by: wep21 <[email protected]> * Remove unnecesarry comment Signed-off-by: wep21 <[email protected]> * Fix bug Signed-off-by: wep21 <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> * change msg type looking traffic light state (#1494) * change msg type looking traffic light state (#1455) * change msg type looking traffic light state * fix msg name * using namespace * change function name * fix typo * add readme * Update awapi/awapi_awiv_adapter/Readme.md fix typo Co-authored-by: Yukihiro Saito <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> * Remove deprecated message include Signed-off-by: wep21 <[email protected]> * Fix lint Signed-off-by: wep21 <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> * Add namespace to behavior_velocity_planner (#1542) * Add namespace to behavior_velocity_planner Signed-off-by: Kenji Miyake <[email protected]> * Fix typo Signed-off-by: Kenji Miyake <[email protected]> * Avoid passing uninitialized index (#1609) Signed-off-by: wep21 <[email protected]> * suppress warnings for behavior_velocity_planner (#1733) * add Werror * suppress warnings for stopline module * fix for crosswalk * fix for traffic light * fix for detection area * fix style * use {} * use auto * Fix -Wunused-parameter (#1836) * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <[email protected]> * Fix mistake Signed-off-by: Kenji Miyake <[email protected]> * fix spell * Fix lint issues Signed-off-by: Kenji Miyake <[email protected]> * Ignore flake8 warnings Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Hiroki OTA <[email protected]> * Fix compiler warnings (#1837) * Fix -Wunused-private-field Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wunused-variable Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wformat-security Signed-off-by: Kenji Miyake <[email protected]> * Fix -Winvalid-constexpr Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wdelete-non-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wdelete-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <[email protected]> * Fix -Winconsistent-missing-override Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wrange-loop-construct Signed-off-by: Kenji Miyake <[email protected]> * Fix "invalid application of 'sizeof' to an incomplete type" Signed-off-by: Kenji Miyake <[email protected]> * Ignore -Wgnu-anonymous-struct and -Wnested-anon-types Signed-off-by: Kenji Miyake <[email protected]> * Fix lint Signed-off-by: Kenji Miyake <[email protected]> * Ignore -Wno-deprecated-declarations in CUDA-related packages Signed-off-by: Kenji Miyake <[email protected]> * Fix mistake Signed-off-by: Kenji Miyake <[email protected]> * Fix -Wunused-parameter Signed-off-by: Kenji Miyake <[email protected]> * Add autoware api (#1979) * Feature/add virtual traffic light planner (#1588) * add sort-package-xml hook in pre-commit (#1881) * add sort xml hook in pre-commit * change retval to exit_status * rename * add prettier plugin-xml * use early return * add license note * add tier4 license * restore prettier * change license order * move local hooks to public repo * move prettier-xml to pre-commit-hooks-ros * update version for bug-fix * apply pre-commit * remove spline_interpolation, and create interpolation package that ha… (#2114) * remove spline_interpolation and add interpolation package * fix bugs and add simple test * modify application for interpolation package * add some tests and fix ci test * add some tests * add -Werror * move functions to anonymous * fix reviews * fix typo * fix review and lint * add tests * resolve TODOs * add README.md * Update common/math/interpolation/test/src/test_interpolation_utils.cpp Co-authored-by: Kenji Miyake <[email protected]> * Update common/math/interpolation/test/src/test_interpolation_utils.cpp Co-authored-by: Kenji Miyake <[email protected]> * Update common/math/interpolation/test/src/test_interpolation_utils.cpp Co-authored-by: Kenji Miyake <[email protected]> * 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 <[email protected]> * fix test * Update common/math/interpolation/README.md Co-authored-by: Kazuki Miyahara <[email protected]> * fix cdots * fix README.md * Update common/math/interpolation/README.md Co-authored-by: Kazuki Miyahara <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: Kazuki Miyahara <[email protected]> * Sync develop/fix interpolation and speed up calculation (#2290) * debug slope calculation in behavior (#1566) (#1727) * debug slope calculation in behavior (#1566) * update * update * revert change of autoware_utils * define getPose in behavior_path_planner * update * update * update * update * interpolate z in obstacle_avoidance_planner * update velocity controller * fix detection area and scene * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp Co-authored-by: tkimura4 <[email protected]> * update comment in velocity controller * remove debug print * update Co-authored-by: tkimura4 <[email protected]> Signed-off-by: wep21 <[email protected]> * Fix typo Signed-off-by: wep21 <[email protected]> * Fix variable names Signed-off-by: Kenji Miyake <[email protected]> * Fix uncrustify Signed-off-by: Kenji Miyake <[email protected]> * Fix mistake Signed-off-by: Kenji Miyake <[email protected]> Co-authored-by: Takayuki Murooka <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> * add underscore to marker namespace (#1785) Co-authored-by: satoshi-ota <[email protected]> * [obstacle_avoidance_planner] remove useless get nearest idx (#1851) * modify velocity insertion in obstacle_avoidance_planner Signed-off-by: Takamasa Horibe <[email protected]> * [obstacle_avoidance_planner] reduce calculation cost in relative/absolute transformation (#1844) * implement relative/absolute transformation without yaw but directly sin/cos of yaw * rename: relative_p to absolute_p * assigin point.z to rel/abs_z * fix cpp-lint error Co-authored-by: Daisuke Nishimatsu <[email protected]> Co-authored-by: Takayuki Murooka <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Kenji Miyake <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: satoshi-ota <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> * fix argument order (#1502) (#1622) Co-authored-by: satoshi-ota <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: satoshi-ota <[email protected]> * Change param (#1559) (#1677) Co-authored-by: Fumiya Watanabe <[email protected]> * Feature/use spline module in behavior velocity planner (#1457) (#1495) * Feature/use spline module in behavior velocity planner (#1457) * Use spline_interpolation module * Remove unused function * Remove unused include * Use autoware_utils * Remove unused function * Remove cubic_spline.hpp * Fix error handling * Fix interpolation of velocity Signed-off-by: wep21 <[email protected]> * change warning threshold (#1539) Signed-off-by: Takamasa Horibe <[email protected]> * Apply lint Signed-off-by: wep21 <[email protected]> Co-authored-by: Fumiya Watanabe <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> * Feature/porting behavior path planner (#1645) * Add behavior path planner pkg with Lane Change (#1525) * add lanelet extension funcs Signed-off-by: Takamasa Horibe <[email protected]> * add planning msgs for FOA Signed-off-by: Takamasa Horibe <[email protected]> * add behavior_path_planner pkg Signed-off-by: Takamasa Horibe <[email protected]> * apply clang format Signed-off-by: Takamasa Horibe <[email protected]> * add error handling for config load failure Signed-off-by: Takamasa Horibe <[email protected]> * replace word: foa with remote control Signed-off-by: Takamasa Horibe <[email protected]> * add readme Signed-off-by: Takamasa Horibe <[email protected]> * use pointer for return value of path Signed-off-by: Takamasa Horibe <[email protected]> * fix hz Signed-off-by: Takamasa Horibe <[email protected]> * remove debug print Signed-off-by: Takamasa Horibe <[email protected]> * remove shide-shift & avoidance related files Signed-off-by: Takamasa Horibe <[email protected]> * Clip path by goal * add build depend for behavior tree cpp Signed-off-by: Takamasa Horibe <[email protected]> * temporally disable lint test in lanelet2_extension Signed-off-by: Takamasa Horibe <[email protected]> Co-authored-by: rej55 <[email protected]> * Add avoidance module in behavior_path_planner (#1528) * Revert "remove shide-shift & avoidance related files" This reverts commit d819ea0291fca251012e4b9ffd16de3896830aa2. * refactor findNewShiftPoint func Signed-off-by: Takamasa Horibe <[email protected]> * remove duplicated decleration Signed-off-by: Takamasa Horibe <[email protected]> * fix barkward length issue - add clipPathLenght func in avoidance Signed-off-by: Takamasa Horibe <[email protected]> * refactor: - translate english - minor modification for traffic distance Signed-off-by: Takamasa Horibe <[email protected]> * support debug marker in behavior_path_planner Signed-off-by: Takamasa Horibe <[email protected]> * clean up side shift module Signed-off-by: Takamasa Horibe <[email protected]> * change topic name Signed-off-by: Takamasa Horibe <[email protected]> * remove japanese Signed-off-by: Takamasa Horibe <[email protected]> * 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 <[email protected]> * fix typo Signed-off-by: Takamasa Horibe <[email protected]> * remove unused var Signed-off-by: Takamasa Horibe <[email protected]> * adress reviewer comments: - add const for variables - add comment - fix typo Signed-off-by: Takamasa Horibe <[email protected]> * fix typo Signed-off-by: Takamasa Horibe <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> * Replace behavior_path utilities with autoware_utils (#1532) * replace calcDistance Signed-off-by: Takamasa Horibe <[email protected]> * replace arange Signed-off-by: Takamasa Horibe <[email protected]> * replave convertToEigenPt with autoware_utils::fromMsg Signed-off-by: Takamasa Horibe <[email protected]> * replace normalizeRadian Signed-off-by: Takamasa Horibe <[email protected]> * cosmetic change Signed-off-by: Takamasa Horibe <[email protected]> * import #1526 into behavior path planner (#1531) Signed-off-by: Takamasa Horibe <[email protected]> * Fix/behavior path empty path output guard (#1536) * add guard Signed-off-by: Takamasa Horibe <[email protected]> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/behavior_path_planner.cpp * fix lateral jerk calculation (#1549) Signed-off-by: Takamasa Horibe <[email protected]> * fix: error handling on exception in behavior_path_planner (#1551) Signed-off-by: Takamasa Horibe <[email protected]> * Fix ignore too steep avoidance path (#1550) * ignore too steep path Signed-off-by: Takamasa Horibe <[email protected]> * 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 <[email protected]> * 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 <[email protected]> Co-authored-by: tkimura4 <[email protected]> * use offsetNoThrow and add error log (#1615) Signed-off-by: Takamasa Horibe <[email protected]> * Ignore object ahead goal for avoidance (#1618) * Ignore object ahead goal for avoidance * Add flag * Fix position of definition of goal_pose * Fix arclength calculation * Fix position of definition of goal_pose * fix intersection stop line (#1636) * fix intersection stop line * fix typo * add document (#1635) Signed-off-by: Takamasa Horibe <[email protected]> * Port behavior path planner to ros2 Signed-off-by: wep21 <[email protected]> * Apply lint Signed-off-by: wep21 <[email protected]> * Fix typo Signed-off-by: wep21 <[email protected]> * Fix map qos Signed-off-by: wep21 <[email protected]> * debug slope calculation in behavior (#1566) * update * update * revert change of autoware_utils * define getPose in behavior_path_planner * update * update * update * update * interpolate z in obstacle_avoidance_planner * update velocity controller * fix detection area and scene * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/src/utilities.cpp Co-authored-by: tkimura4 <[email protected]> * update comment in velocity controller * remove debug print * update Co-authored-by: tkimura4 <[email protected]> * Address review: Fix config file name Signed-off-by: wep21 <[email protected]> * pre-commit fixes Signed-off-by: wep21 <[email protected]> * Fix redeclaring parameters Signed-off-by: wep21 <[email protected]> * Add missing tf2 geometry function Signed-off-by: wep21 <[email protected]> * Apply lint Signed-off-by: wep21 <[email protected]> * Fix rclcpp Time initialization Signed-off-by: wep21 <[email protected]> * Use now() instead of msg stamp Signed-off-by: wep21 <[email protected]> * Use throttle output in getExpandedLanelet Signed-off-by: wep21 <[email protected]> * Add missing const Signed-off-by: wep21 <[email protected]> * Fix lint Signed-off-by: wep21 <[email protected]> Co-authored-by: Takamasa Horibe <[email protected]> Co-authored-by: rej55 <[email protected]> Co-authored-by: Yukihiro Saito <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Takayuki Murooka <[email protected]> * Fix/generate intersection stop (#1590) (#1679) * Fix/generate intersection stop (#1590) * fix bug of conflicting polygons * clean code * Fix lint Signed-off-by: wep21 <[email protected]> Co-authored-by: tkimura4 <[email protected]> * Fix/stop margin time ros2 (#1683) * Add stop margin time in walkway and merge_from_private_area (#1613) * Add stop margin time in walkway, merge_from_private_area * Fix param name * Fix bug * Apply lint Signed-off-by: wep21 <[email protected]> Co-authored-by: Fumiya Watanabe <[email protected]> * Feature/change stop lines handling to support parking car avoidance p… (#1676) * Feature/change stop lines handling to support parking car avoidance path (#1464) * support parking car avoidance * change log level * apply clang-format * add extendLine function * clean up & apply clang-format * change implementation getStopPoseFromMap() * remove unuse comment line Co-authored-by: satoshi-ota <[email protected]> * fix argument order (#1580) Co-authored-by: satoshi-ota <[email protected]> Co-authored-by: Satoshi OTA <[email protected]> Co-authored-by: satoshi-ota <[email protected]> * Feature/porting occlusion spot (#1740) * Feature/occlusion_spot safety planner public road (#1594) * add blind spot safety planner public road * remove duplicated procesing * remove unused private param * renaming fix typo add comments * fix spell check * velocity -> relative velocity * calc2d, To param, simplify search, To original * add the num possible collision gurd * computational cost reduction * Cosmetic change for PossibleCollisionInfo * add interpolation to possible collision value * refactor codes * fix details * invalid point gurd * To Param * refacotor to occlusion spot util * cosmetic change * clean up blindspot * To Occlusion Spot * revise readme * refactor drawing * for better explanation * fix velocity profile * clean up details * cosmetic change for debug marker * use max velocity in obstacle info instead * add gtest for Too Many Possible Collision case * change case * refactor readme * minor fix * add more occlusion spot explanation * replace svg * add gtest build path lanelet * hotfix lateral distance and searching method * update g test for lateral distance * use faster search * set more realistic param * add lanelet subtype highway * cosmetic change of reviews * add occlusion spot module in private area (#1640) * add occlusion spot in private * For debugging change * add spline interpolation to path * add review changes * adding minor change * cosmetic change * Vector to retval * Blindspot To OcclusionSpot1 * To Occlusion Spot 2 * To Occlusions spot3 * update gtest with unified anchor * remove anchor * add test slice * simplify interpolation * Too Occlusion spot4 * add test buffer * To Occlusion spot * namespace gurd * correct slice and add interpolation first * handle self crossing with check for invation * to ros debug stream * removed unused interpolation * add readme to plant uml * cosmetic change * minor change * update readme * review change * change occlusion spot text color * To Offset no Throw * better debug marker * catch only inversion error * skip return in case of inversion * for better grid * simplify path lanelet at first * remove std::cout * for better path * limit ego path inside target lanelet location * remove last points * cosmetic change for markers * apply module for limited scene * fix interpolation gurd * for better params * do not includes path behind * remove dummy perception publisher * Revert "remove dummy perception publisher" This reverts commit 4acad985fe31dd9befaa21a16631495de6c3a117. * replace hard coded occupancy grid option in psim * remove respawn * add arg to params and remove redundunt launch * fix spell check * fix default value Co-authored-by: tkimura4 <[email protected]> * Feature/occlusion spot private slice size param (#1703) * add min slice size * for a bit narrow lateral distance * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/config/occlusion_spot_param.yaml Co-authored-by: Maxime CLEMENT <[email protected]> Co-authored-by: Maxime CLEMENT <[email protected]> * Rename files Signed-off-by: wep21 <[email protected]> * Porting to ros2 Signed-off-by: wep21 <[email protected]> * pre-commit fixes Signed-off-by: wep21 <[email protected]> * Fix typo Signed-off-by: wep21 <[email protected]> * Fix launch namespace Co-authored-by: tkimura4 <[email protected]> * Fix parameter type Co-authored-by: tkimura4 <[email protected]> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/scene_occlusion_spot_in_private_road.cpp Co-authored-by: tkimura4 <[email protected]> Co-authored-by: taikitanaka3 <[email protected]> Co-authored-by: tkimura4 <[email protected]> Co-authored-by: Maxime CLEMENT <[email protected]> * fix function name and condition for detection area (#1758) * Fix build warning for occlusion spot (#1766) Signed-off-by: wep21 <[email protected]> * Fix passing uninitialized index (#1792) * Fix passing uninitialized index Signed-off-by: wep21 <[email protected]> * Apply uncrustify Signed-off-by: wep21 <[email protected]> * Fix return value Signed-off-by: wep21 <[email protected]> * Fix/intersection bug (#1787) * fix insert point function * apply format * separate insertPoint and hasDuplicatedPoint * clean code * fix bug * replace velocity if collision point is too close to original path point (#1799) * replace velocity if collision point is too close to original path point * fix comment * Fix compile warnings (#1852) Fix -Wunused-parameter Signed-off-by: Kenji Miyake <[email protected]> Fix -Wunused-private-field Signed-off-by: Kenji Miyake <[email protected]> Fix -Wunused-lambda-capture Signed-off-by: Kenji Miyake <[email protected]> Fix -Wdelete-non-abstract-non-virtual-dtor Signed-off-by: Kenji Miyake <[email protected]> Fix -Wrange-loop-construct Signed-off-by: Kenji Miyake <[email protected]> Ignore lint error Signed-off-by: Kenji Miyake <[email protected]> * Document / behavior velocity planner (#1767) update document Co-authored-by: Kazuki Miyahara <[email protected]> * fix occlusion spot insert velocity ros2 (#1821) * Fix/occlusion spot offset (#1824) * merge calcCollisionFunction * ConsiderSignedOffset * add extractRoadTargetAndSignedOffset * apply signed offset and fix longitudinal distance * fix unapplied param * update gtest * consider offset until target road * refactor for proper variable name * fix typo * remove unused first index * fix closest * fix diff * fix velocity and height * tune distance thershold * fix colcon test * apply param at the experiment * fix unused and param * Fix/current acc initialize (#1899) * use boost::optional * null guard * fix typo * Feature/improve intersection detection area (#1958) * exclude ego_lanes from detection_area * add empty handling * remove unused function * Fix for uncrustify Co-authored-by: Kenji Miyake <[email protected]> * [behavior_velocity_planner] remove unnecessary graph search to reduce computational cost (#1980) * remote unnecessary graph search Signed-off-by: Takamasa Horibe <[email protected]> * add var for graph id Signed-off-by: Takamasa Horibe <[email protected]> * remove unused stopline search for computational cost reduction Signed-off-by: Takamasa Horibe <[email protected]> * restore lane_ids iteration as it was Signed-off-by: Takamasa Horibe <[email protected]> * sort sidewalk slice by arc length (#1967) * sort sidewalk slice by arc length * handle invalid index * divide offset to ego to closest to and closest to target * fix cartesian distance to arc lane distance * consider ego to target to ignore length * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/src/scene_module/occlusion_spot/occlusion_spot_utils.cpp Co-authored-by: tkimura4 <[email protected]> Co-authored-by: tkimura4 <[email protected]> * Fix/merge from private area (#2005) * fix insert pos. of merge from private area * exclude entrance of private road from path * extract exit of private road * Feature/intersection module detect obstacle (#1990) * change the way to detect target objects in detection area * check the angle of deteced objects * ignore predicted path with low confidence * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp Co-authored-by: taikitanaka3 <[email protected]> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp Co-authored-by: taikitanaka3 <[email protected]> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/README.md Co-authored-by: taikitanaka3 <[email protected]> * Update planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/include/scene_module/intersection/scene_intersection.hpp Co-authored-by: taikitanaka3 <[email protected]> * fix format * fix object position judge * change function * apply format Co-authored-by: taikitanaka3 <[email protected]> * occlusion spot lower min ego velocity (#2140) Co-authored-by: taikitanaka3 <[email protected]> * add behavior velocity planner utils (#2113) * add gtest utils * add state machine as utils * add arc lane utils * remove empty file * add gtest for offset segment * use calcdist2d in autoware util * apply get point * fix uncrustify * fix conflict getPoint in behavior path * apply commit suggestion * slower than ros1 * use interpolation::slerp (#2161) * Update traffic light state if ref stop point is ahead of previous one (#2197) (#2240) Signed-off-by: wep21 <[email protected]> Co-authored-by: Daisuke Nishimatsu <[email protected]> * Change formatter to clang-format and black (#2332) * Revert "Temporarily comment out pre-commit hooks" This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3. * Replace ament_lint_common with autoware_lint_common Signed-off-by: Kenji Miyake <[email protected]> * Remove ament_cmake_uncrustify and ament_clang_format Signed-off-by: Kenji Miyake <[email protected]> * Apply Black Signed-off-by: Kenji Miyake <[email protected]> * Apply clang-format Signed-off-by: Kenji Miyake <[email protected]> * Fix build errors Signed-off-by: Kenji Miyake <[email protected]> * Fix for cpplint * Fix include double quotes to angle brackets Signed-off-by: Kenji Miyake <[email protected]> * Apply clang-format Signed-off-by: Kenji Miyake <[email protected]> * Fix build errors Signed-off-by: Kenji Miyake <[email protected]> * Add COLCON_IGNORE (#500) Signed-off-by: Kenji Miyake <[email protected]> * rename topic name twist -> odometry (#568) Co-authored-by: Takayuki Murooka <[email protected]> * Auto/behavior velocity (#605) * port except for traffic light * fix test * update traffic light * fix errors * rename traffic message: final -> result * fix package.xml * twist -> odometry * use confidence * rename topic name of dynamic objects * remove TODOs * deal with probabilistic test failure * deal with probabilistic test failure2 Co-authored-by: Takayuki Murooka <[email protected]> * Sync .auto branch with the latest branch in internal repository (#691) * add trajectory point offset in rviz plugin (#2270) * sync rc rc/v0.23.0 (#2258) * fix interpolation for insert point (#2228) * fix interpolation for insert point * to prev interpolation pkg * Revert "to prev interpolation pkg" This reverts commit 9eb145b5d36e297186015fb17c267ccd5b3c21ef. Co-authored-by: taikitanaka3 <[email protected]> Co-authored-by: taikitanaka <[email protected]> * fix topic name (#2266) Signed-off-by: Takamasa Horibe <[email protected]> * Add namespace to diag for dual_return_filter (#2269) * Add a function to make 'geometry_msgs::msg::TransformStamped' (#2250) * Add a function to make 'geometry_msgs::msg::TransformStamped' * Add 'child_frame_id' as an argument of 'pose2transform' * Simplify marker scale initialization (#2286) * Fix/crosswalk polygon (#2279) * extend crosswalk polygon * improve readability * fix polygon shape * Add warning when decel distance calculation fails (#2289) Signed-off-by: Makoto Kurihara <[email protected]> * [motion_velocity_smoother] ignore debug print (#2292) * cosmetic change Signed-off-by: Takamasa Horibe <[email protected]> * cahnge severity from WARN to DEBUG for debug info Signed-off-by: Takamasa Horibe <[email protected]> * use util for stop_watch Signed-off-by: Takamasa Horibe <[email protected]> * fix map based prediction (#2200) * fix map based prediction * fix format * change map based prediction * fix spells * fix spells in comments * fix for cpplint * fix some problems * fix format and code for clang-tidy * fix space for cpplint * Update Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * Update perception/object_recognition/prediction/map_based_prediction/Readme.md * fix vector access method * fix readme format * add parameter * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <[email protected]> * Update perception/object_recognition/prediction/map_based_prediction/Readme.md Co-authored-by: Kazuki Miyahara <kmiya@out…
|
This pull request has been automatically marked as stale because it has not had recent activity. |
|
@shmpwk |
|
I close this PR since I don't have plan to commit this. |
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Signed-off-by: Shumpei Wakabayashi [email protected]
Description
Add diagnostic ERROR for the wrong route in behavior path planner.
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.