-
Notifications
You must be signed in to change notification settings - Fork 650
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
feat(obstacle_avoidance_planner): explicitly insert zero velocity #906
feat(obstacle_avoidance_planner): explicitly insert zero velocity #906
Conversation
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
29f2b8d
to
1ecc532
Compare
Codecov Report
@@ Coverage Diff @@
## main #906 +/- ##
========================================
- Coverage 9.54% 9.42% -0.13%
========================================
Files 933 933
Lines 57727 58467 +740
Branches 10408 10408
========================================
Hits 5510 5510
- Misses 47685 48425 +740
Partials 4532 4532
*This pull request uses carry forward flags. Click here to find out more.
Continue to review full report at Codecov.
|
(@TakaHoribe @tkimura4 If it's hard to review, just give me LGTM. I'll check if this PR works a lot.) |
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
LGTM
…towarefoundation#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp>
* feat(state_rviz_plugin): add GateMode and PathChangeApproval Button (#894) * feat(state_rviz_plugin): add GateMode and PathChangeApproval Button * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: update link style Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: fix link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_tf_generator): accelerate the 'viewer' coordinate calculation (#890) * add random point sampling function to quickly calculate the 'viewer' coordinate Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(obstacle_stop_planner): update documentation (#880) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(tier4_traffic_light_rviz_plugin): update documentation (#905) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(accel_brake_map_calibrator): rviz panel type (#895) * fixed panel type Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified instruction for rosbag replay case Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified update_map_dir service name Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior velocity planner): skipping emplace back stop reason if it is empty (#898) * skipping emplace back stop reason if it is empty Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * add braces Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_path_planner): weakened noise filtering of drivable area (#838) * feat(behavior_path_planner): Weakened noise filtering of drivable area Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix lanelet's longitudinal disconnection Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * add comments of erode/dilate process Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle-cmd-gate): using namespace for msgs (#913) * refactor(vehicle-cmd-gate): using namespace for msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * for clang Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(pose_initializer): introduce an array copy function (#900) Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add lidar point filter when debug (#865) * feat: add lidar point filter when debug Signed-off-by: suchang <chang.su@autocore.ai> * ci(pre-commit): autofix Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(component_interface_utils): add interface classes (#899) * feat(component_interface_utils): add interface classes Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * feat(default_ad_api): apply the changes of interface utils Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove old comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): add client log Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove unimplemented message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add design policy Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle_cmd_gate): change namespace in launch file (#927) Signed-off-by: Berkay <berkay@leodrive.ai> Co-authored-by: Berkay <berkay@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: visualize lane boundaries (#923) * feat: visualize lane boundaries * fix: start_bound * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): fix truncation warning in strncpy (#872) * fix(system_monitor): fix truncation warning in strncpy * Use std::string constructor to copy char array * Fixed typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior_velocity_planner.stopline): extend following and previous search range to avoid no collision (#917) * fix: extend following and previous search range to avoid no collision * chore: add debug marker * fix: simplify logic * chore: update debug code Signed-off-by: h-ohta <hiroki.ota@tier4.jp> * fix: delete space * fix: some fix * ci(pre-commit): autofix * fix: delete debug code Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(surround obstacle checker): update documentation (#878) * docs(surround_obstacle_checker): update pub/sub topics & params Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacle_checker): remove unused files Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacke_checker): update purpose Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_autoware_utils): add vehicle state checker (#896) * feat(tier4_autoware_utils): add vehicle state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): use absolute value Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * feat(tier4_autoware_utils): divide into two classies Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * test(tier4_autoware_utils): add unit test for vehicle_state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): impl class inheritance Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(tier4_autoware_utils): add vehicle_state_checker document Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): into same loop Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): fix variables name Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): remove redundant codes Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point (#816) * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * Modify overwriteStopPoint input and output Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): explicitly insert zero velocity (#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_velocity): find occlusion more efficiently (#829) Signed-off-by: tanaka3 <ttatcoder@outlook.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): add some smart information to diagnostics (#708) Signed-off-by: kk-inoue-esol <kk-inoue@esol.co.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): dealt with close lane change (#921) * feat(obstacle_avoidance_planner): dealt with close lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of right lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): some fix for narrow driving (#916) * use car like constraints in mpt * use not widest bounds for the first bounds Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * organized params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix format Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * prepare rear_drive and uniform_circle constraints Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix param callback Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update config Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * remove unnecessary files Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update tier4_planning_launch params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(obstacle_avoidance_planner): removed obsolete obstacle_avoidance_planner doc in Japanese (#919) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check (#932) * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check * feat: use marker helper Signed-off-by: h-ohta <hiroki.ota@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_loader): visualize center line by points (#931) * feat: visualize center line points * fix: delete space * feat: visualize center line by arrow * revert insertMarkerArray * fix: delete space Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add RTC interface (#765) * feature(rtc_interface): add files Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): implement functions Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): reimprement functions to use CooperateCommands and write README.md Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add getModuleType() Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix definition of constructor Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix time stamp Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add isRegistered and clearCooperateStatus Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: sync files (#911) Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: replace boost::mutex::scoped_lock to std::scoped_lock (#907) * fix: replace boost::mutex::scoped_lock to std::scoped_lock * fix: replace boost::mutex to std::mutex Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node (#885) * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node Signed-off-by: Kaan Colak <kcolak@leodrive.ai> * feat(tensorrt_yolo): update arg Signed-off-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner (#887) * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner * Update launch/tier4_planning_launch/config/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * feat: add param.yaml in behavior_velocity_planner package * some fix Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader (#942) * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): remove c_str Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): replace c_str to string Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix relative links Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore rare unknown words Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore unknown words one by one Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Mamoru Sobue <hilo.soblin@gmail.com> Co-authored-by: TakumiKozaka-T4 <70260442+TakumiKozaka-T4@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: storrrrrrrrm <103425473+storrrrrrrrm@users.noreply.github.com> Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: Berkay <brkay54@gmail.com> Co-authored-by: Berkay <berkay@leodrive.ai> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: kk-inoue-esol <76925382+kk-inoue-esol@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Co-authored-by: Kaan Çolak <kaancolak95@gmail.com> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
* feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
…towarefoundation#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>
* feat(state_rviz_plugin): add GateMode and PathChangeApproval Button (autowarefoundation#894) * feat(state_rviz_plugin): add GateMode and PathChangeApproval Button * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: update link style Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: fix link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_tf_generator): accelerate the 'viewer' coordinate calculation (autowarefoundation#890) * add random point sampling function to quickly calculate the 'viewer' coordinate Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(obstacle_stop_planner): update documentation (autowarefoundation#880) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(tier4_traffic_light_rviz_plugin): update documentation (autowarefoundation#905) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(accel_brake_map_calibrator): rviz panel type (autowarefoundation#895) * fixed panel type Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified instruction for rosbag replay case Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified update_map_dir service name Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior velocity planner): skipping emplace back stop reason if it is empty (autowarefoundation#898) * skipping emplace back stop reason if it is empty Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * add braces Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_path_planner): weakened noise filtering of drivable area (autowarefoundation#838) * feat(behavior_path_planner): Weakened noise filtering of drivable area Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix lanelet's longitudinal disconnection Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * add comments of erode/dilate process Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle-cmd-gate): using namespace for msgs (autowarefoundation#913) * refactor(vehicle-cmd-gate): using namespace for msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * for clang Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(pose_initializer): introduce an array copy function (autowarefoundation#900) Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add lidar point filter when debug (autowarefoundation#865) * feat: add lidar point filter when debug Signed-off-by: suchang <chang.su@autocore.ai> * ci(pre-commit): autofix Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(component_interface_utils): add interface classes (autowarefoundation#899) * feat(component_interface_utils): add interface classes Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * feat(default_ad_api): apply the changes of interface utils Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove old comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): add client log Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove unimplemented message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add design policy Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle_cmd_gate): change namespace in launch file (autowarefoundation#927) Signed-off-by: Berkay <berkay@leodrive.ai> Co-authored-by: Berkay <berkay@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: visualize lane boundaries (autowarefoundation#923) * feat: visualize lane boundaries * fix: start_bound * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): fix truncation warning in strncpy (autowarefoundation#872) * fix(system_monitor): fix truncation warning in strncpy * Use std::string constructor to copy char array * Fixed typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior_velocity_planner.stopline): extend following and previous search range to avoid no collision (autowarefoundation#917) * fix: extend following and previous search range to avoid no collision * chore: add debug marker * fix: simplify logic * chore: update debug code Signed-off-by: h-ohta <hiroki.ota@tier4.jp> * fix: delete space * fix: some fix * ci(pre-commit): autofix * fix: delete debug code Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(surround obstacle checker): update documentation (autowarefoundation#878) * docs(surround_obstacle_checker): update pub/sub topics & params Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacle_checker): remove unused files Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacke_checker): update purpose Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_autoware_utils): add vehicle state checker (autowarefoundation#896) * feat(tier4_autoware_utils): add vehicle state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): use absolute value Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * feat(tier4_autoware_utils): divide into two classies Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * test(tier4_autoware_utils): add unit test for vehicle_state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): impl class inheritance Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(tier4_autoware_utils): add vehicle_state_checker document Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): into same loop Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): fix variables name Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): remove redundant codes Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point (autowarefoundation#816) * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * Modify overwriteStopPoint input and output Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): explicitly insert zero velocity (autowarefoundation#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_velocity): find occlusion more efficiently (autowarefoundation#829) Signed-off-by: tanaka3 <ttatcoder@outlook.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): add some smart information to diagnostics (autowarefoundation#708) Signed-off-by: kk-inoue-esol <kk-inoue@esol.co.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): dealt with close lane change (autowarefoundation#921) * feat(obstacle_avoidance_planner): dealt with close lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of right lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): some fix for narrow driving (autowarefoundation#916) * use car like constraints in mpt * use not widest bounds for the first bounds Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * organized params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix format Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * prepare rear_drive and uniform_circle constraints Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix param callback Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update config Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * remove unnecessary files Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update tier4_planning_launch params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(obstacle_avoidance_planner): removed obsolete obstacle_avoidance_planner doc in Japanese (autowarefoundation#919) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check (autowarefoundation#932) * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check * feat: use marker helper Signed-off-by: h-ohta <hiroki.ota@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_loader): visualize center line by points (autowarefoundation#931) * feat: visualize center line points * fix: delete space * feat: visualize center line by arrow * revert insertMarkerArray * fix: delete space Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add RTC interface (autowarefoundation#765) * feature(rtc_interface): add files Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): implement functions Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): reimprement functions to use CooperateCommands and write README.md Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add getModuleType() Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix definition of constructor Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix time stamp Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add isRegistered and clearCooperateStatus Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: sync files (autowarefoundation#911) Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: replace boost::mutex::scoped_lock to std::scoped_lock (autowarefoundation#907) * fix: replace boost::mutex::scoped_lock to std::scoped_lock * fix: replace boost::mutex to std::mutex Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node (autowarefoundation#885) * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node Signed-off-by: Kaan Colak <kcolak@leodrive.ai> * feat(tensorrt_yolo): update arg Signed-off-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner (autowarefoundation#887) * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner * Update launch/tier4_planning_launch/config/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * feat: add param.yaml in behavior_velocity_planner package * some fix Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader (autowarefoundation#942) * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): remove c_str Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): replace c_str to string Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix relative links Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore rare unknown words Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore unknown words one by one Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Mamoru Sobue <hilo.soblin@gmail.com> Co-authored-by: TakumiKozaka-T4 <70260442+TakumiKozaka-T4@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: storrrrrrrrm <103425473+storrrrrrrrm@users.noreply.github.com> Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: Berkay <brkay54@gmail.com> Co-authored-by: Berkay <berkay@leodrive.ai> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: kk-inoue-esol <76925382+kk-inoue-esol@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Co-authored-by: Kaan Çolak <kaancolak95@gmail.com> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>
…er4#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
* feat(state_rviz_plugin): add GateMode and PathChangeApproval Button (tier4#894) * feat(state_rviz_plugin): add GateMode and PathChangeApproval Button * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: update link style Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: fix link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_tf_generator): accelerate the 'viewer' coordinate calculation (tier4#890) * add random point sampling function to quickly calculate the 'viewer' coordinate Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(obstacle_stop_planner): update documentation (tier4#880) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(tier4_traffic_light_rviz_plugin): update documentation (tier4#905) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(accel_brake_map_calibrator): rviz panel type (tier4#895) * fixed panel type Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified instruction for rosbag replay case Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified update_map_dir service name Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior velocity planner): skipping emplace back stop reason if it is empty (tier4#898) * skipping emplace back stop reason if it is empty Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * add braces Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_path_planner): weakened noise filtering of drivable area (tier4#838) * feat(behavior_path_planner): Weakened noise filtering of drivable area Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix lanelet's longitudinal disconnection Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * add comments of erode/dilate process Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle-cmd-gate): using namespace for msgs (tier4#913) * refactor(vehicle-cmd-gate): using namespace for msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * for clang Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(pose_initializer): introduce an array copy function (tier4#900) Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add lidar point filter when debug (tier4#865) * feat: add lidar point filter when debug Signed-off-by: suchang <chang.su@autocore.ai> * ci(pre-commit): autofix Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(component_interface_utils): add interface classes (tier4#899) * feat(component_interface_utils): add interface classes Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * feat(default_ad_api): apply the changes of interface utils Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove old comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): add client log Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove unimplemented message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add design policy Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle_cmd_gate): change namespace in launch file (tier4#927) Signed-off-by: Berkay <berkay@leodrive.ai> Co-authored-by: Berkay <berkay@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: visualize lane boundaries (tier4#923) * feat: visualize lane boundaries * fix: start_bound * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): fix truncation warning in strncpy (tier4#872) * fix(system_monitor): fix truncation warning in strncpy * Use std::string constructor to copy char array * Fixed typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior_velocity_planner.stopline): extend following and previous search range to avoid no collision (tier4#917) * fix: extend following and previous search range to avoid no collision * chore: add debug marker * fix: simplify logic * chore: update debug code Signed-off-by: h-ohta <hiroki.ota@tier4.jp> * fix: delete space * fix: some fix * ci(pre-commit): autofix * fix: delete debug code Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(surround obstacle checker): update documentation (tier4#878) * docs(surround_obstacle_checker): update pub/sub topics & params Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacle_checker): remove unused files Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacke_checker): update purpose Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_autoware_utils): add vehicle state checker (tier4#896) * feat(tier4_autoware_utils): add vehicle state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): use absolute value Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * feat(tier4_autoware_utils): divide into two classies Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * test(tier4_autoware_utils): add unit test for vehicle_state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): impl class inheritance Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(tier4_autoware_utils): add vehicle_state_checker document Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): into same loop Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): fix variables name Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): remove redundant codes Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point (tier4#816) * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * Modify overwriteStopPoint input and output Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): explicitly insert zero velocity (tier4#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_velocity): find occlusion more efficiently (tier4#829) Signed-off-by: tanaka3 <ttatcoder@outlook.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): add some smart information to diagnostics (tier4#708) Signed-off-by: kk-inoue-esol <kk-inoue@esol.co.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): dealt with close lane change (tier4#921) * feat(obstacle_avoidance_planner): dealt with close lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of right lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): some fix for narrow driving (tier4#916) * use car like constraints in mpt * use not widest bounds for the first bounds Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * organized params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix format Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * prepare rear_drive and uniform_circle constraints Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix param callback Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update config Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * remove unnecessary files Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update tier4_planning_launch params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(obstacle_avoidance_planner): removed obsolete obstacle_avoidance_planner doc in Japanese (tier4#919) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check (tier4#932) * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check * feat: use marker helper Signed-off-by: h-ohta <hiroki.ota@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_loader): visualize center line by points (tier4#931) * feat: visualize center line points * fix: delete space * feat: visualize center line by arrow * revert insertMarkerArray * fix: delete space Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add RTC interface (tier4#765) * feature(rtc_interface): add files Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): implement functions Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): reimprement functions to use CooperateCommands and write README.md Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add getModuleType() Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix definition of constructor Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix time stamp Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add isRegistered and clearCooperateStatus Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: sync files (tier4#911) Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: replace boost::mutex::scoped_lock to std::scoped_lock (tier4#907) * fix: replace boost::mutex::scoped_lock to std::scoped_lock * fix: replace boost::mutex to std::mutex Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node (tier4#885) * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node Signed-off-by: Kaan Colak <kcolak@leodrive.ai> * feat(tensorrt_yolo): update arg Signed-off-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner (tier4#887) * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner * Update launch/tier4_planning_launch/config/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * feat: add param.yaml in behavior_velocity_planner package * some fix Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader (tier4#942) * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): remove c_str Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): replace c_str to string Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix relative links Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore rare unknown words Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore unknown words one by one Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Mamoru Sobue <hilo.soblin@gmail.com> Co-authored-by: TakumiKozaka-T4 <70260442+TakumiKozaka-T4@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: storrrrrrrrm <103425473+storrrrrrrrm@users.noreply.github.com> Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: Berkay <brkay54@gmail.com> Co-authored-by: Berkay <berkay@leodrive.ai> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: kk-inoue-esol <76925382+kk-inoue-esol@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Co-authored-by: Kaan Çolak <kaancolak95@gmail.com> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
…er4#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
* feat(state_rviz_plugin): add GateMode and PathChangeApproval Button (tier4#894) * feat(state_rviz_plugin): add GateMode and PathChangeApproval Button * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: update link style Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: fix link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_tf_generator): accelerate the 'viewer' coordinate calculation (tier4#890) * add random point sampling function to quickly calculate the 'viewer' coordinate Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(obstacle_stop_planner): update documentation (tier4#880) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(tier4_traffic_light_rviz_plugin): update documentation (tier4#905) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(accel_brake_map_calibrator): rviz panel type (tier4#895) * fixed panel type Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified instruction for rosbag replay case Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified update_map_dir service name Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior velocity planner): skipping emplace back stop reason if it is empty (tier4#898) * skipping emplace back stop reason if it is empty Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * add braces Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_path_planner): weakened noise filtering of drivable area (tier4#838) * feat(behavior_path_planner): Weakened noise filtering of drivable area Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix lanelet's longitudinal disconnection Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * add comments of erode/dilate process Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle-cmd-gate): using namespace for msgs (tier4#913) * refactor(vehicle-cmd-gate): using namespace for msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * for clang Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(pose_initializer): introduce an array copy function (tier4#900) Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add lidar point filter when debug (tier4#865) * feat: add lidar point filter when debug Signed-off-by: suchang <chang.su@autocore.ai> * ci(pre-commit): autofix Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(component_interface_utils): add interface classes (tier4#899) * feat(component_interface_utils): add interface classes Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * feat(default_ad_api): apply the changes of interface utils Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove old comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): add client log Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove unimplemented message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add design policy Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle_cmd_gate): change namespace in launch file (tier4#927) Signed-off-by: Berkay <berkay@leodrive.ai> Co-authored-by: Berkay <berkay@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: visualize lane boundaries (tier4#923) * feat: visualize lane boundaries * fix: start_bound * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): fix truncation warning in strncpy (tier4#872) * fix(system_monitor): fix truncation warning in strncpy * Use std::string constructor to copy char array * Fixed typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior_velocity_planner.stopline): extend following and previous search range to avoid no collision (tier4#917) * fix: extend following and previous search range to avoid no collision * chore: add debug marker * fix: simplify logic * chore: update debug code Signed-off-by: h-ohta <hiroki.ota@tier4.jp> * fix: delete space * fix: some fix * ci(pre-commit): autofix * fix: delete debug code Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(surround obstacle checker): update documentation (tier4#878) * docs(surround_obstacle_checker): update pub/sub topics & params Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacle_checker): remove unused files Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacke_checker): update purpose Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_autoware_utils): add vehicle state checker (tier4#896) * feat(tier4_autoware_utils): add vehicle state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): use absolute value Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * feat(tier4_autoware_utils): divide into two classies Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * test(tier4_autoware_utils): add unit test for vehicle_state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): impl class inheritance Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(tier4_autoware_utils): add vehicle_state_checker document Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): into same loop Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): fix variables name Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): remove redundant codes Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point (tier4#816) * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * Modify overwriteStopPoint input and output Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): explicitly insert zero velocity (tier4#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_velocity): find occlusion more efficiently (tier4#829) Signed-off-by: tanaka3 <ttatcoder@outlook.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): add some smart information to diagnostics (tier4#708) Signed-off-by: kk-inoue-esol <kk-inoue@esol.co.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): dealt with close lane change (tier4#921) * feat(obstacle_avoidance_planner): dealt with close lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of right lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): some fix for narrow driving (tier4#916) * use car like constraints in mpt * use not widest bounds for the first bounds Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * organized params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix format Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * prepare rear_drive and uniform_circle constraints Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix param callback Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update config Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * remove unnecessary files Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update tier4_planning_launch params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(obstacle_avoidance_planner): removed obsolete obstacle_avoidance_planner doc in Japanese (tier4#919) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check (tier4#932) * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check * feat: use marker helper Signed-off-by: h-ohta <hiroki.ota@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_loader): visualize center line by points (tier4#931) * feat: visualize center line points * fix: delete space * feat: visualize center line by arrow * revert insertMarkerArray * fix: delete space Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add RTC interface (tier4#765) * feature(rtc_interface): add files Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): implement functions Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): reimprement functions to use CooperateCommands and write README.md Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add getModuleType() Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix definition of constructor Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix time stamp Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add isRegistered and clearCooperateStatus Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: sync files (tier4#911) Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: replace boost::mutex::scoped_lock to std::scoped_lock (tier4#907) * fix: replace boost::mutex::scoped_lock to std::scoped_lock * fix: replace boost::mutex to std::mutex Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node (tier4#885) * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node Signed-off-by: Kaan Colak <kcolak@leodrive.ai> * feat(tensorrt_yolo): update arg Signed-off-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner (tier4#887) * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner * Update launch/tier4_planning_launch/config/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * feat: add param.yaml in behavior_velocity_planner package * some fix Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader (tier4#942) * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): remove c_str Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): replace c_str to string Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix relative links Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore rare unknown words Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore unknown words one by one Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Mamoru Sobue <hilo.soblin@gmail.com> Co-authored-by: TakumiKozaka-T4 <70260442+TakumiKozaka-T4@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: storrrrrrrrm <103425473+storrrrrrrrm@users.noreply.github.com> Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: Berkay <brkay54@gmail.com> Co-authored-by: Berkay <berkay@leodrive.ai> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: kk-inoue-esol <76925382+kk-inoue-esol@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Co-authored-by: Kaan Çolak <kaancolak95@gmail.com> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
…er4#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
* feat(state_rviz_plugin): add GateMode and PathChangeApproval Button (tier4#894) * feat(state_rviz_plugin): add GateMode and PathChangeApproval Button * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: update link style Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: fix link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_tf_generator): accelerate the 'viewer' coordinate calculation (tier4#890) * add random point sampling function to quickly calculate the 'viewer' coordinate Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(obstacle_stop_planner): update documentation (tier4#880) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(tier4_traffic_light_rviz_plugin): update documentation (tier4#905) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(accel_brake_map_calibrator): rviz panel type (tier4#895) * fixed panel type Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified instruction for rosbag replay case Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified update_map_dir service name Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior velocity planner): skipping emplace back stop reason if it is empty (tier4#898) * skipping emplace back stop reason if it is empty Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * add braces Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_path_planner): weakened noise filtering of drivable area (tier4#838) * feat(behavior_path_planner): Weakened noise filtering of drivable area Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix lanelet's longitudinal disconnection Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * add comments of erode/dilate process Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle-cmd-gate): using namespace for msgs (tier4#913) * refactor(vehicle-cmd-gate): using namespace for msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * for clang Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(pose_initializer): introduce an array copy function (tier4#900) Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add lidar point filter when debug (tier4#865) * feat: add lidar point filter when debug Signed-off-by: suchang <chang.su@autocore.ai> * ci(pre-commit): autofix Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(component_interface_utils): add interface classes (tier4#899) * feat(component_interface_utils): add interface classes Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * feat(default_ad_api): apply the changes of interface utils Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove old comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): add client log Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove unimplemented message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add design policy Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle_cmd_gate): change namespace in launch file (tier4#927) Signed-off-by: Berkay <berkay@leodrive.ai> Co-authored-by: Berkay <berkay@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: visualize lane boundaries (tier4#923) * feat: visualize lane boundaries * fix: start_bound * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): fix truncation warning in strncpy (tier4#872) * fix(system_monitor): fix truncation warning in strncpy * Use std::string constructor to copy char array * Fixed typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior_velocity_planner.stopline): extend following and previous search range to avoid no collision (tier4#917) * fix: extend following and previous search range to avoid no collision * chore: add debug marker * fix: simplify logic * chore: update debug code Signed-off-by: h-ohta <hiroki.ota@tier4.jp> * fix: delete space * fix: some fix * ci(pre-commit): autofix * fix: delete debug code Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(surround obstacle checker): update documentation (tier4#878) * docs(surround_obstacle_checker): update pub/sub topics & params Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacle_checker): remove unused files Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacke_checker): update purpose Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_autoware_utils): add vehicle state checker (tier4#896) * feat(tier4_autoware_utils): add vehicle state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): use absolute value Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * feat(tier4_autoware_utils): divide into two classies Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * test(tier4_autoware_utils): add unit test for vehicle_state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): impl class inheritance Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(tier4_autoware_utils): add vehicle_state_checker document Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): into same loop Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): fix variables name Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): remove redundant codes Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point (tier4#816) * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * Modify overwriteStopPoint input and output Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): explicitly insert zero velocity (tier4#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_velocity): find occlusion more efficiently (tier4#829) Signed-off-by: tanaka3 <ttatcoder@outlook.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): add some smart information to diagnostics (tier4#708) Signed-off-by: kk-inoue-esol <kk-inoue@esol.co.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): dealt with close lane change (tier4#921) * feat(obstacle_avoidance_planner): dealt with close lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of right lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): some fix for narrow driving (tier4#916) * use car like constraints in mpt * use not widest bounds for the first bounds Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * organized params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix format Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * prepare rear_drive and uniform_circle constraints Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix param callback Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update config Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * remove unnecessary files Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update tier4_planning_launch params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(obstacle_avoidance_planner): removed obsolete obstacle_avoidance_planner doc in Japanese (tier4#919) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check (tier4#932) * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check * feat: use marker helper Signed-off-by: h-ohta <hiroki.ota@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_loader): visualize center line by points (tier4#931) * feat: visualize center line points * fix: delete space * feat: visualize center line by arrow * revert insertMarkerArray * fix: delete space Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add RTC interface (tier4#765) * feature(rtc_interface): add files Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): implement functions Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): reimprement functions to use CooperateCommands and write README.md Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add getModuleType() Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix definition of constructor Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix time stamp Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add isRegistered and clearCooperateStatus Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: sync files (tier4#911) Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: replace boost::mutex::scoped_lock to std::scoped_lock (tier4#907) * fix: replace boost::mutex::scoped_lock to std::scoped_lock * fix: replace boost::mutex to std::mutex Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node (tier4#885) * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node Signed-off-by: Kaan Colak <kcolak@leodrive.ai> * feat(tensorrt_yolo): update arg Signed-off-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner (tier4#887) * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner * Update launch/tier4_planning_launch/config/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * feat: add param.yaml in behavior_velocity_planner package * some fix Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader (tier4#942) * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): remove c_str Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): replace c_str to string Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix relative links Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore rare unknown words Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore unknown words one by one Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Mamoru Sobue <hilo.soblin@gmail.com> Co-authored-by: TakumiKozaka-T4 <70260442+TakumiKozaka-T4@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: storrrrrrrrm <103425473+storrrrrrrrm@users.noreply.github.com> Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: Berkay <brkay54@gmail.com> Co-authored-by: Berkay <berkay@leodrive.ai> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: kk-inoue-esol <76925382+kk-inoue-esol@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Co-authored-by: Kaan Çolak <kaancolak95@gmail.com> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
…er4#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
* feat(state_rviz_plugin): add GateMode and PathChangeApproval Button (tier4#894) * feat(state_rviz_plugin): add GateMode and PathChangeApproval Button * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: update link style Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: fix link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_tf_generator): accelerate the 'viewer' coordinate calculation (tier4#890) * add random point sampling function to quickly calculate the 'viewer' coordinate Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(obstacle_stop_planner): update documentation (tier4#880) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(tier4_traffic_light_rviz_plugin): update documentation (tier4#905) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(accel_brake_map_calibrator): rviz panel type (tier4#895) * fixed panel type Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified instruction for rosbag replay case Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> * modified update_map_dir service name Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior velocity planner): skipping emplace back stop reason if it is empty (tier4#898) * skipping emplace back stop reason if it is empty Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * add braces Signed-off-by: TakumiKozaka-T4 <takumi.kozaka@tier4.jp> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_path_planner): weakened noise filtering of drivable area (tier4#838) * feat(behavior_path_planner): Weakened noise filtering of drivable area Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix lanelet's longitudinal disconnection Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * add comments of erode/dilate process Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle-cmd-gate): using namespace for msgs (tier4#913) * refactor(vehicle-cmd-gate): using namespace for msgs Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> * for clang Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(pose_initializer): introduce an array copy function (tier4#900) Signed-off-by: IshitaTakeshi <ishitah.takeshi@gmail.com> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add lidar point filter when debug (tier4#865) * feat: add lidar point filter when debug Signed-off-by: suchang <chang.su@autocore.ai> * ci(pre-commit): autofix Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(component_interface_utils): add interface classes (tier4#899) * feat(component_interface_utils): add interface classes Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * feat(default_ad_api): apply the changes of interface utils Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove old comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): add client log Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * fix(component_interface_utils): remove unimplemented message Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add design policy Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> * docs(component_interface_utils): add comment Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * refactor(vehicle_cmd_gate): change namespace in launch file (tier4#927) Signed-off-by: Berkay <berkay@leodrive.ai> Co-authored-by: Berkay <berkay@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: visualize lane boundaries (tier4#923) * feat: visualize lane boundaries * fix: start_bound * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): fix truncation warning in strncpy (tier4#872) * fix(system_monitor): fix truncation warning in strncpy * Use std::string constructor to copy char array * Fixed typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(behavior_velocity_planner.stopline): extend following and previous search range to avoid no collision (tier4#917) * fix: extend following and previous search range to avoid no collision * chore: add debug marker * fix: simplify logic * chore: update debug code Signed-off-by: h-ohta <hiroki.ota@tier4.jp> * fix: delete space * fix: some fix * ci(pre-commit): autofix * fix: delete debug code Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs(surround obstacle checker): update documentation (tier4#878) * docs(surround_obstacle_checker): update pub/sub topics & params Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacle_checker): remove unused files Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(surround_obstacke_checker): update purpose Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_autoware_utils): add vehicle state checker (tier4#896) * feat(tier4_autoware_utils): add vehicle state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): use absolute value Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * feat(tier4_autoware_utils): divide into two classies Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * test(tier4_autoware_utils): add unit test for vehicle_state checker Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): impl class inheritance Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * docs(tier4_autoware_utils): add vehicle_state_checker document Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): into same loop Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): fix variables name Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> * fix(tier4_autoware_utils): remove redundant codes Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point (tier4#816) * fix(motion_velocity_smoother): fix overwriteStopPoint using backward point Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> * Modify overwriteStopPoint input and output Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): explicitly insert zero velocity (tier4#906) * feat(obstacle_avoidance_planner) fix bug of stop line unalignment Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of unsorted output points Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * move calcVelocity in node.cpp Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix build error Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(behavior_velocity): find occlusion more efficiently (tier4#829) Signed-off-by: tanaka3 <ttatcoder@outlook.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(system_monitor): add some smart information to diagnostics (tier4#708) Signed-off-by: kk-inoue-esol <kk-inoue@esol.co.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): dealt with close lane change (tier4#921) * feat(obstacle_avoidance_planner): dealt with close lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix bug of right lane change Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(obstacle_avoidance_planner): some fix for narrow driving (tier4#916) * use car like constraints in mpt * use not widest bounds for the first bounds Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * organized params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix format Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * prepare rear_drive and uniform_circle constraints Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * fix param callback Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update config Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * remove unnecessary files Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> * update tier4_planning_launch params Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(obstacle_avoidance_planner): removed obsolete obstacle_avoidance_planner doc in Japanese (tier4#919) Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check (tier4#932) * chore(behavior_velocity_planner.stopline): add debug marker for stopline collision check * feat: use marker helper Signed-off-by: h-ohta <hiroki.ota@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(map_loader): visualize center line by points (tier4#931) * feat: visualize center line points * fix: delete space * feat: visualize center line by arrow * revert insertMarkerArray * fix: delete space Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat: add RTC interface (tier4#765) * feature(rtc_interface): add files Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): implement functions Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): reimprement functions to use CooperateCommands and write README.md Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add getModuleType() Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix definition of constructor Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix time stamp Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): fix README Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * feature(rtc_interface): add isRegistered and clearCooperateStatus Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com> * ci(pre-commit): autofix Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * chore: sync files (tier4#911) Signed-off-by: GitHub <noreply@github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: replace boost::mutex::scoped_lock to std::scoped_lock (tier4#907) * fix: replace boost::mutex::scoped_lock to std::scoped_lock * fix: replace boost::mutex to std::mutex Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node (tier4#885) * feat(tensorrt_yolo): add multi gpu support to tensorrt_yolo node Signed-off-by: Kaan Colak <kcolak@leodrive.ai> * feat(tensorrt_yolo): update arg Signed-off-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner (tier4#887) * feat(tier4_planning_launch): create parameter yaml for behavior_velocity_planner * Update launch/tier4_planning_launch/config/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/behavior_velocity_planner.param.yaml Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> * feat: add param.yaml in behavior_velocity_planner package * some fix Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader (tier4#942) * fix(map_loader): use std::filesystem to load pcd files in pointcloud_map_loader Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): remove c_str Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> * fix(map_loader): replace c_str to string Signed-off-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative link Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: relative links Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix: typo Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * fix relative links Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp> Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore rare unknown words Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * docs: ignore unknown words one by one Signed-off-by: Shumpei Wakabayashi <shumpei.wakabayashi@tier4.jp> * ci(pre-commit): autofix Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp> Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com> Co-authored-by: Takeshi Ishita <ishitah.takeshi@gmail.com> Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com> Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com> Co-authored-by: Mamoru Sobue <hilo.soblin@gmail.com> Co-authored-by: TakumiKozaka-T4 <70260442+TakumiKozaka-T4@users.noreply.github.com> Co-authored-by: Takagi, Isamu <43976882+isamu-takagi@users.noreply.github.com> Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com> Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com> Co-authored-by: storrrrrrrrm <103425473+storrrrrrrrm@users.noreply.github.com> Co-authored-by: suchang <chang.su@autocore.ai> Co-authored-by: Berkay <brkay54@gmail.com> Co-authored-by: Berkay <berkay@leodrive.ai> Co-authored-by: ito-san <57388357+ito-san@users.noreply.github.com> Co-authored-by: Kosuke Takeuchi <kosuke.tnp@gmail.com> Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com> Co-authored-by: kk-inoue-esol <76925382+kk-inoue-esol@users.noreply.github.com> Co-authored-by: Fumiya Watanabe <rej55.g@gmail.com> Co-authored-by: awf-autoware-bot[bot] <94889083+awf-autoware-bot[bot]@users.noreply.github.com> Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com> Co-authored-by: RyuYamamoto <ryu.yamamoto@tier4.jp> Co-authored-by: Kaan Çolak <kaancolak95@gmail.com> Co-authored-by: Kaan Colak <kcolak@leodrive.ai> Co-authored-by: Kenji Miyake <kenji.miyake@tier4.jp>
… & longitudinal (autowarefoundation#4874) (autowarefoundation#906) Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: Takayuki Murooka takayuki5168@gmail.com
Description
In obstacle avoidance planner, a stop point is not explicitly inserted in an output trajectory.
Therefore the stop point changes a little bit comparing before and after obstacle avoidance planner.
In this PR, I inserted the stop point in the output trajectory.
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.