-
Notifications
You must be signed in to change notification settings - Fork 34
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
chore: sync upstream #168
chore: sync upstream #168
Conversation
…2180) * feat(osqp_interface): add warm startup interface Signed-off-by: yutaka <purewater0901@gmail.com> * update Signed-off-by: yutaka <purewater0901@gmail.com> * update Signed-off-by: yutaka <purewater0901@gmail.com> Signed-off-by: yutaka <purewater0901@gmail.com>
…arefoundation#2107) * Add a hyper-parameter class to simplify parameter loading
…on#2181) * fix(default_ad_api): change motion state transition Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix: remove unused variable Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix: state order Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
…utowarefoundation#2183) Signed-off-by: Berkay Karaman <berkay@leodrive.ai> Signed-off-by: Berkay Karaman <berkay@leodrive.ai> Co-authored-by: Berkay Karaman <berkay@leodrive.ai>
…#2189) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
…towarefoundation#2191) Signed-off-by: Berkay Karaman <berkay@leodrive.ai> Signed-off-by: Berkay Karaman <berkay@leodrive.ai> Co-authored-by: Berkay Karaman <berkay@leodrive.ai>
Codecov ReportBase: 12.28% // Head: 13.05% // Increases project coverage by
Additional details and impacted files@@ Coverage Diff @@
## tier4/main #168 +/- ##
==============================================
+ Coverage 12.28% 13.05% +0.76%
==============================================
Files 743 759 +16
Lines 60972 61820 +848
Branches 18417 19491 +1074
==============================================
+ Hits 7490 8069 +579
+ Misses 44867 44487 -380
- Partials 8615 9264 +649
Help us with your feedback. Take ten seconds to tell us how you rate us. Have a feature suggestion? Share it here. ☔ View full report at Codecov. |
* feat(tier4_autoware_utils): add twist library Signed-off-by: scepter914 <scepter914@gmail.com> * fix main merge Signed-off-by: scepter914 <scepter914@gmail.com> * delete function Signed-off-by: scepter914 <scepter914@gmail.com> * fix function Signed-off-by: scepter914 <scepter914@gmail.com> Signed-off-by: scepter914 <scepter914@gmail.com>
…ing (autowarefoundation#2090) * feat(perception_utils): add classification util function with string Signed-off-by: scepter914 <scepter914@gmail.com> * add unit test Signed-off-by: scepter914 <scepter914@gmail.com> * add include string Signed-off-by: scepter914 <scepter914@gmail.com> * fix function interface Signed-off-by: scepter914 <scepter914@gmail.com> * fix unit test Signed-off-by: scepter914 <scepter914@gmail.com> * change function name Signed-off-by: scepter914 <scepter914@gmail.com> * change to except throw Signed-off-by: scepter914 <scepter914@gmail.com> Signed-off-by: scepter914 <scepter914@gmail.com>
…2192) Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>
* Initial commit with barebone SafeVelocityAdjustorNode Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add debug topics, launch file, and config file Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix debug markers Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix dynamic parameters Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add proper collision detection and debug footprint Implements Proposal 1. Calculation of the adjusted velocity still needs to be improved Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add script to compare the original and adjusted velocity profiles Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix calculation of distance to obstacle Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add test for calculation collision distance Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add launch file to test the safe_velocity_adjustor with a bag Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Cleanup code and add tests for forwardSimulatedVector Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Simplify collision detection by not using a footprint polygon Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add filtering of the dynamic objects from the pointcloud Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * [DEBUG] Print runtimes of expensive functions Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add trajectory downsampling to boost performance + improve debug markers Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Modify velocity only from ego pose + distance parameter Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add 1st Eigen version of distanceToClosestCollision + benchmark Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Switch to using contours from occupancy grid for collision checking Filtering of dynamic objects is not great Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add buffer around dynamic obstacles to avoid false obstacle detection Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add parameter to limit the adjusted velocity Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Use vehicle_info_util to get vehicle footprint Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Calculate accurate distance to collision + add tests Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add parameter for the min velocity where a dynamic obstacle is ignored Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add README and some pictures to explain the node inner workings Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update scenario_planning.launch.xml to run the new node Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix format of launch files Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update launcher and rviz config used for debuging with bag Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Cleanup debug publishing Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Complete tests of collision_distance.hpp Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add docstring + Small code cleanup Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Improve test of occupancy_grid_utils Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix bug when setting parameter callback before getting vehicle parameters Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Rename safe_velocity_adjustor to apparent_safe_velocity_limiter Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Move declarations to cpp file (apparent_safe_velocity_limiter_node) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Move declarations to cpp file (occupancy_grid_utils) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Move declarations to cpp file (collision_distance) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add exec of trajectory_visualizer.py in launch files Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Mask trajectory footprint from the occupancy grid (might be expensive) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Filter out the occupancy grid that is outside the envelope polygon Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add improved PolygonIterator using scan line algorithm Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Use autoware_cmake for dependencies Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Improve performances of PolygonIterator Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Minor cleanup of PolygonIterator Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Use improved iterator + add benchmark (max/avg/med) to node Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Minor code cleanup Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Switch from set to vector/list in PolygonIterator Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Remove PolygonIterator and use implementation from grid_map_utils Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add parameter to limit deceleration when adjusting the velocity Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Code cleanup, move type decl and debug functions to separate files Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add support for collision detection using pointcloud Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Code cleanup Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Speedup pointcloud filtering (still ~100ms on bags) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Improve envelope calculation and use separate node for pcd downsampling Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add ProjectionParameters to prepare for the bicycle model projection Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add bicycle projection with various steering offsets Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update docstring Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Major refactoring, calculate envelope from footprints Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add extraction of static obstacles from lanelet map Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Remove stopwatch Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add arc distance calculation when using bicycle projection Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix multi geometry definitions in tier4_autoware_utils/boost_geometry Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Improve geometry operations to take advantage of Eigen Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Switch to min/max offset and simplify footprint calculations Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix unit tests (unset params.heading) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add option to filter obstacles using the safety envelope Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix bug with distance calculation and improve debug markers Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update README Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add parameter to set map obstacles by linestring id (for debug) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Move param structures to dedicated file and add PreprocessingParameters Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add parameter to calculate steering angle of trajectory points Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Cleanup footprint generation Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix bug with debug marker ids Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix bug where the VelocityParameters were not constructed Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update obstacles extraction Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Minor code cleanup Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Switch to collision detection using rtree Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add publishing of the runtime (in microseconds) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add option to ignore obstacles on the trajectory Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add max length and max duration parameters Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Restructure Obstacles structure to separate lines and points for speedup Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Convert obstacle linestrings to segments when used in the rtree Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add parameter for extra distance when filtering the ego path Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix issues caused by rebase Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Minor code cleanup Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update to run with looping bag replay Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Add debug markers for obstacle masks and only publish when subscribed Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update README Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Fix humble build issue with PCL library Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update obstacle extraction from lanelet map (no longer based on route) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Optimize use of rtree + use naive collision checking with few obstacles Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Remove debug code and update default parameters Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Do not wait for self pose Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Rename to obstacle_velocity_limiter Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * More minor cleanup Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update READEME.md Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update README to have the purpose written before the illustration Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update copyright notice: Tier IV -> TIER IV Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Remove use_sim_time param from node launch file Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> * Update launch files to run in the motion_planner + add launch config Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp> Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>
* added the Butterworth filter class. Signed-off-by: ali <boyali@gmail.com> * added the Butterworth filter class: typo in frequency fixed. Signed-off-by: ali <boyali@gmail.com> * added the Butterworth filter class: ReadMe and documentations are updated. Signed-off-by: ali <boyali@gmail.com> * removed unused comments. Signed-off-by: ali <boyali@gmail.com> * removed unused comments. Signed-off-by: ali <boyali@gmail.com> * added new line. Signed-off-by: ali <boyali@gmail.com> * a type in the butterworth_filter_test.cpp is fixed. Signed-off-by: ali <boyali@gmail.com> * a type in the butterworth_filter_test.cpp is fixed. Signed-off-by: ali <boyali@gmail.com> * a typo fixed in the ButterworthFilter.md. Signed-off-by: ali <boyali@gmail.com> * // print("Phase angle x = ", x); comment is removed. Signed-off-by: ali <boyali@gmail.com> * Test fixture is cleaned. Signed-off-by: ali <boyali@gmail.com> * for loop implementations changed. Signed-off-by: ali <boyali@gmail.com> * linted. Signed-off-by: ali <boyali@gmail.com> * early return. Signed-off-by: ali <boyali@gmail.com> * commented cmakline removed. Signed-off-by: ali <boyali@gmail.com> * converting cout to ros log. Signed-off-by: ali <boyali@gmail.com> * converting cout to ros log for root printing. converting cout to ros log for root printing. converting cout to ros log for root printing. Signed-off-by: ali <boyali@gmail.com> * const <--> auto, int, double Signed-off-by: ali <boyali@gmail.com> * added signed-off commit. Signed-off-by: ali <boyali@gmail.com> * Typo correction. Continuous Signed-off-by: ali <boyali@gmail.com> * Early return in computeDiscreteTimeTF. Signed-off-by: ali <boyali@gmail.com> * Reducing code smell primitive obsession. Signed-off-by: ali <boyali@gmail.com> * Reducing code smell primitive obsession. Signed-off-by: ali <boyali@gmail.com> * Reducing code smell primitive obsession. Signed-off-by: ali <boyali@gmail.com> * typo correction. Signed-off-by: ali <boyali@gmail.com> * Typo and copyright correction. Signed-off-by: ali <boyali@gmail.com> * Applied pre-commit. Signed-off-by: ali <boyali@gmail.com> * Applied pre-commit. Signed-off-by: ali <boyali@gmail.com> * Spell-check fix. Signed-off-by: ali <boyali@gmail.com> * Spell-check fix. Signed-off-by: ali <boyali@gmail.com> Signed-off-by: ali <boyali@gmail.com>
…n#2205) Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
…r PathPointWithLaneId (autowarefoundation#2206) Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
…on error (autowarefoundation#2204) * fix issue sligtly out of range due to double's calculation error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update test Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
* perf(intersection): reduce bg::within call Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * use lane interval for getStopLineFromMap too Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * changed index type to size_t Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * replace unsigned to size_t Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
…able area (autowarefoundation#2196) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>
…tion#2217) Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>
Signed-off-by: GitHub <noreply@github.com> Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>
…warefoundation#2199) * first commit Signed-off-by: kminoda <koji.minoda@tier4.jp> * remove align and NdtResults from ndt_scan_matcher Signed-off-by: kminoda <koji.minoda@tier4.jp> * rename variable Signed-off-by: kminoda <koji.minoda@tier4.jp> * ci(pre-commit): autofix * use getResult() function instead of executeScanMatching() Signed-off-by: kminoda <koji.minoda@tier4.jp> * for (auto...) -> for (const auto &...) Signed-off-by: kminoda <koji.minoda@tier4.jp> * removed unnecessary output_cloud declaration Signed-off-by: kminoda <koji.minoda@tier4.jp> Signed-off-by: kminoda <koji.minoda@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
doc(behavior_velocity.traffic): fix typo
…dation#2221) * fixed int/uint for path index Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * reflected comments Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
…#2212) * add-vehicle-pid-test * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
* feat(pure_pursuit): add predicted trajectory Signed-off-by: Berkay Karaman <berkay@leodrive.ai> * ci(pre-commit): autofix * clear up Signed-off-by: Berkay Karaman <berkay@leodrive.ai> * Use operator || instead of or Signed-off-by: Berkay Karaman <berkay@leodrive.ai> * comment update Signed-off-by: Berkay Karaman <berkay@leodrive.ai> Signed-off-by: Berkay Karaman <berkay@leodrive.ai> Co-authored-by: Berkay Karaman <berkay@leodrive.ai> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Signed-off-by: GitHub <noreply@github.com> Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>
…ion#2232) refactor(vehicle_constants_manager)! : remove package Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
…foundation#2201) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Features
Bug Fixes
Documentation
Code Refactoring
Performance Improvements
Continuous Integrations
Chores