…405)

* feat(behavior_velocity): add index to index calculation to stop line

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* chore(behavior_velocity): add debug cout

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* chore(behavior_velocity): devide pair

Signed-off-by: taikitanaka <ttatcoder@outlook.jp>

* feat(behavior_velocity): update functions

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* chore(behaivor_velocity): remove debug

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* fix(behavior_velocity): calculate signed arc length consider stop margin from stop line

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

…elet tag (#478)

* feat(lanelet2_extension): add guard_rails fence wall as lanelet tag

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* feat(map_loader): add visualization for partion lanelet

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

* feat: use multi thread for behavior vel

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

* feat: applied clang format

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

* fix: remove unnecessary mutex and add comments

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

* fix: fix typo

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

Signed-off-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>

* feat: add roll pitch rate

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* Update localization/gyro_odometer/src/gyro_odometer_core.cpp

Co-authored-by: Yamato Ando <yamato.ando@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* Update localization/gyro_odometer/src/gyro_odometer_core.cpp

Co-authored-by: Yamato Ando <yamato.ando@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* Update localization/gyro_odometer/src/gyro_odometer_core.cpp

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* fix: add new parameter description in imu_corrector/readme.md

Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* ci(pre-commit): autofix

* Update localization/gyro_odometer/src/gyro_odometer_core.cpp

Co-authored-by: Yamato Ando <yamato.ando@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* Update localization/gyro_odometer/src/gyro_odometer_core.cpp

Co-authored-by: Yamato Ando <yamato.ando@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>

* Update localization/gyro_odometer/src/gyro_odometer_core.cpp

Co-authored-by: Yamato Ando <yamato.ando@gmail.com>
Signed-off-by: kminoda <koji.m.minoda@gmail.com>

Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Yamato Ando <yamato.ando@gmail.com>

Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp>

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* feat: use multi thread for obstacle stop

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

* feat: minor change with comments

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

* fix: fix typo

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

…reshold (#404)

* parametrize lateral threshold

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

* format readme

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

* apply clang format

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

…epositioning ego pose (#502)

* fix integration miss

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* bug fix

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* add detection by tracker

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* Update launch/tier4_perception_launch/launch/object_recognition/detection/camera_lidar_fusion_based_detection.launch.xml

* fix(behavior_velocity): fix interpolation add missing last point

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* fix(behavior_velocity): add missing last point of clipped path

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* chore(behavior_velocity): make implementation simpler

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

Co-authored-by: Takayuki Murooka <takayuki5168@gmail.com>

#475)

* add debugger

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* change iou

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* feat(behavior_velocity): add partition lanelet

Signed-off-by: taikitanaka <ttatcoder@outlook.jp>

* feat(behavior_velocity): add get partition lanelet to utils

Signed-off-by: taikitanaka <ttatcoder@outlook.jp>

* chore(behavior_velocity): remove unused function

Signed-off-by: taikitanaka <ttatcoder@outlook.jp>

* chore(behavior_velocity): unite variables

Signed-off-by: taikitanaka <ttatcoder@outlook.jp>

* feat(behavior_velocity): apply concept of partition

Signed-off-by: taikitanaka <ttatcoder@outlook.jp>

* chore(behavior_velocity): change partition marker color

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* doc(behavior_velocity): update doc

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

* chore(behavior_velocity): to default setting

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* refactor(avoidance_module): change implementation to lambda

In the generateExtendedDrivableArea function, the implementation to extend
drivable areas with reference to object is refactor to lambda.

This will allow the function to be used for some future planned updates.

The refactor doesn't affect the behavior of the avoidance_module.

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* refactor: add default flag to extend_to_opposite side

By default, the parameter is true, therefore it doesn't affect the original
behavior.

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* ci(pre-commit): autofix

* fix: rework function for better extension

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* refactor(route handler, avoidance_module): move the implementation

The implementation is made into function and moved into route handler

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* Refactor: convert lambdas to function

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* chore: add comments for comments for documentation in the header file

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* Refactor: local variable rename

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* refactor: make a wrapper function to get furthest linestrings

Also modified some avoidance_module to include the refactored functions

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* fix(ad_service_state_monitor): fix callback group

Signed-off-by: Shinnosuke Hirakawa <shinnosuke.hirakawa@tier4.jp>

* fix(external_cmd_selector): fix callback grouop

Signed-off-by: Shinnosuke Hirakawa <shinnosuke.hirakawa@tier4.jp>

* chore: clang-format

Signed-off-by: Shinnosuke Hirakawa <shinnosuke.hirakawa@tier4.jp>

* fix(fault_injection): fix launch_testing

Signed-off-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>

* add label

Signed-off-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>

* add todo comment

Signed-off-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>

Signed-off-by: GitHub <noreply@github.com>

Co-authored-by: kenji-miyake <kenji-miyake@users.noreply.github.com>

…stop line insertion ,occlusion spot (#505)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

)

* fix(lane_change):fix predicted path size is small case

* fix(pull_over):fix predicted path size is small case

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* fix(side_shift):side shift unable to properly reset

Add comparison between lateral offset and shift point.

the last shift point was compared.

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* ci(pre-commit): autofix

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* fix: extend drivable areas relative to ego position

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* fix: constraint request time to prevent input abuse

In this fix, request time is constraint according to time_to_start_shifting in
the side_shift.param.yaml.

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* fix: refactor condition

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* Update planning/behavior_path_planner/src/scene_module/side_shift/side_shift_module.cpp

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* Update planning/behavior_path_planner/include/behavior_path_planner/scene_module/side_shift/side_shift_module.hpp

Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>
Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* chore: variable name refactoring

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* fix: added new parameter so that the request time is configurable

The fix also added stl remove_if algorithm to remove shift points that exceed
maximum threshold

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* refactor: replace chrono to rclcpp::Time

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

* Revert "refactor: replace chrono to rclcpp::Time"

This reverts commit 76823c6.

* refactor: replace chrono to rclcpp::Time

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Yukihiro Saito <yukky.saito@gmail.com>

* chore(dummy_diag_publisher): add exec_depend

Signed-off-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>

* Update system/dummy_diag_publisher/package.xml

Signed-off-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

…#515)

* feat(planning_error_monitor): supress error when no message was set.

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

* add empty commit

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

Signed-off-by: Makoto Kurihara <mkuri8m@gmail.com>

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>

#498)

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

* feat: support single frame mode in occ grid

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* ci(pre-commit): autofix

Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* add iou gate

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* ci(pre-commit): autofix

* cosmetic change

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* fix bug

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* ci(pre-commit): autofix

* fix bug

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

* fix tier4_launch

Signed-off-by: Yukihiro Saito <yukky.saito@gmail.com>

Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

* chore: update README

* feat: add param in launch

* chore: Update system/dummy_diag_publisher/README.md

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

* chore: update readme

* ci(pre-commit): autofix

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

… register user specific diag and delete tier4 specific diags (#537)

* feat: add 'extra_agg_config_file_system'

* feat: delete tier4 specific diag