…asurementPose/Twist (autowarefoundation#5691)

* Added X_delay_times_ to obtain the accumulated lap times of the timer callback.
Added find_closest_index function to easily use the X_delay_times_.

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* Added a concept/variable of accumulated_delay_time_ and store every lap time of timer callback.
The delay_step will be calculated from it, and the bug of calculating delay_step should be gone.
Besides, removed dt in measurementUpdatePose/Twist since it is not needed.

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* Fixed dt to ekf_dt_ in predictUpdateFrequency()

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* Removed temporary debug stuff

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* style(pre-commit): autofix

* Fixed code style pointed out from pre-commit.ci

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* style(pre-commit): autofix

* Fixed typo

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* Removed variable ekf_rate_ which is currently unused.
Added warnings when the ekf_dt_ is too large.

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* style(pre-commit): autofix

* Changed threshold of delay time so that to look the most last (or largest) value of accumulated_delay_times_

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* Correct the warning messages of diag_info to look up the last (or largest) value of accumulated_delay_times_

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

* style(pre-commit): autofix

---------

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…foundation#5792)

1. The `updateData()` function now sets `status_.is_safe_dynamic_objects` to true when `requiresDynamicObjectsCollisionDetection()` returns false.

2. The `isExecutionReady()` function now checks for dynamic object collisions only if `requiresDynamicObjectsCollisionDetection()` returns true and `isWaitingApproval()` also returns true. This change ensures that dynamic object collision detection is performed only when necessary and approval is pending.

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

…dation#5782)

* feat(start_planner): add surround moving obstacle check
This commit introduces a new feature in the start_planner module for checking surrounding moving obstacles.
- It adds parameters to specify the search radius and threshold velocity for moving obstacles, along with flags to indicate which types of objects should be checked.
- The `noMovingObjectsAround` function has been added to filter dynamic objects within a certain radius based on their velocity.
  - If no moving objects are detected, the function returns true; otherwise, it returns false.
- This feature enhances the safety of the start_planner by ensuring that the path can't be approved while surrond moving obstacles exist.
---------
Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

…warefoundation#5790)

* refactor(avoidance): separate package

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* refactor(AbLC): separate package

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* refactor(bpp): remove separate module

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(bpp): fix test error

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

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

…utowarefoundation#5758)

* refactor(motion_velocity_smoother): boost::optional to std::optional

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

* style(pre-commit): autofix

---------

Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…dation#5802)

* separate packages

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

---------

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…ndation#5806)

delete unnecessary TODO

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…ic signals with duplicated ids (autowarefoundation#5653)

* fix: add operation to remove traffic signals with duplicated ids

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* feat: move operation into `crosswalk_traffic_light_estimator`

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

---------

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

…owarefoundation#5769)

* rework multi object tracker parameters

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* update README

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* rework radar tracker parameter too

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

---------

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* fix typo
* update comments

Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp>

…utowarefoundation#5755)

Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>

detection_by_tracker_param_path was missing

Signed-off-by: Taekjin LEE <taekjin.lee@tier4.jp>

* refactor(lane_change): move lane change params

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(avoidance): remove unnecessary param path

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…imes to obtain accurate computation of delay_time (autowarefoundation#5821)

Correct accumulated_delay_times in ekf_localizer so that the delay_step is computed accurately.

Signed-off-by: TaikiYamada4 <taiki.yamada@tier4.jp>

…utowarefoundation#5816)

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

…ndation#5744)

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

…5820)

* refactor(side_shift): separate side shift module

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* refactor(bpp): remove side shift module

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…warefoundation#5689)

fix(avoidance): output invalid avoidance path

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

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

…interpolate (autowarefoundation#5818)

Fixed rejection criteria of SmartPoseBuffer::interpolate

Signed-off-by: Shintaro Sakoda <shintaro.sakoda@tier4.jp>

…oid exceeding max voxel size (autowarefoundation#5824)

…utowarefoundation#5810)

Add jerk and acc limits for slow-down

Signed-off-by: Daniel Sanchez <daniel.sanchez@tier4.jp>

…arefoundation#5819)

* fix(traffic_light): stop if the traffic light signal timed out

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>

* fix(traffic_light): fix README format

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>

---------

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>

…c_time/elapsed_time, tentative objects (autowarefoundation#5762)

* enable debugger in tracker

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* fix uninitialized class variable

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* feat: separate debugger class for simplification

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

---------

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

…utowarefoundation#5830)

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

doc(intersection): add image

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>

…atus (autowarefoundation#5682)

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

)

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

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* update cmakelists

Signed-off-by: N-Eiki <naganagaeichan@gmail.com>

* add z filter param

Signed-off-by: N-Eiki <naganagaeichan@gmail.com>

* isWithin func private -> public

Signed-off-by: N-Eiki <naganagaeichan@gmail.com>

* add test code

Signed-off-by: N-Eiki <naganagaeichan@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: N-Eiki <naganagaeichan@gmail.com>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: Satoshi Tanaka <16330533+scepter914@users.noreply.github.com>

…ion#5836)

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

…oundation#5832)

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

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…n#5848)

Changed landmark_manager to a shared library

Signed-off-by: Shintaro SAKODA <shintaro.sakoda@tier4.jp>

…ar topic (autowarefoundation#5781)

rename lidar topic

Signed-off-by: yamato-ando <Yamato ANDO>
Co-authored-by: yamato-ando <Yamato ANDO>

…ithin diagnostics (autowarefoundation#5840)

* enable debugger in tracker

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* fix uninitialized class variable

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* feat: separate debugger class for simplification

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* enable check topic delay by diagnostics

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* fix: update diagnostics periods and threshold

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

---------

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

…utowarefoundation#5843)

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

…arefoundation#5845)

add publisher to publish auto mode status

Signed-off-by: kyoichi-sugahara <kyoichi.sugahara@tier4.jp>

…tracker folder and namespace to avoid conflicts (autowarefoundation#5837)

* build(detection_by_tracker): move utils.hpp file to the detection_by_tracker folder and namespace to avoid conflicts

Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp>

* style(pre-commit): autofix

---------

Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…refoundation#5831)

refactor(blind_spot_module: boost::optional to std::optional

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

…n to prevent unintended direction update (autowarefoundation#5853)

* fix: add function to check object direction before merging object states

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* refactor: add warning in update whole tracked object

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

---------

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* fix(launch): set null to avoid launch error

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(behavior): check null

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* chore(behavior): add comment

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(launch): set  at the end of list

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(launch): fill empty string at the end of module list

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…stance (autowarefoundation#5799)

* refactor(utils): use drivable bound to calculate road shoulder distance

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(AbLC): set drivable bound

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* feat(avoidance): output road shoulder distance marker

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…oundation#5856)

fix: fix typo in node yaml parameter

Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>

* fix:planning_adapter

Signed-off-by: jack.song <jack.song@autocore.ai>

* fix:planning_adapter

Signed-off-by: jack.song <jack.song@autocore.ai>

* fix:planning_adapter

Signed-off-by: jack.song <jack.song@autocore.ai>

* fix:planning_adapter

Signed-off-by: jack.song <jack.song@autocore.ai>

* fix:add planning adapter

Signed-off-by: jack.song <jack.song@autocore.ai>

* style(pre-commit): autofix

---------

Signed-off-by: jack.song <jack.song@autocore.ai>
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>

…n#5716)

Signed-off-by: badai-nguyen <dai.nguyen@tier4.jp>

…efoundation#5854)

* Fixed ar_tag_based_localizer pub/sub

Signed-off-by: Shintaro SAKODA <shintaro.sakoda@tier4.jp>

* Remove dependency on image_transport

Signed-off-by: Shintaro SAKODA <shintaro.sakoda@tier4.jp>

---------

Signed-off-by: Shintaro SAKODA <shintaro.sakoda@tier4.jp>

…on#5860)

* feat(shape_estimation): add bicycle shape corrector

Signed-off-by: Kaan Çolak <kaancolak95@gmail.com>

* style(pre-commit): autofix

* feat(shape_estimation): add bicycle shape corrector

Signed-off-by: Kaan Çolak <kaancolak95@gmail.com>

---------

Signed-off-by: Kaan Çolak <kaancolak95@gmail.com>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…ndation#5868)

* feat(simple_planning_simulator): add mesurent_steer_bias

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

* style(pre-commit): autofix

---------

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…kage (autowarefoundation#5827)

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

…owarefoundation#5850)

* refactor(lane_change): separate lane change and external request

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

* refactored external request lane change

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

* separate on external request

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

* style(pre-commit): autofix

* delete external request

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

* fix interface

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

* fix external lane change couldn't be initialize

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

* fix documents

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

* fix link in README

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

* fix based on comments

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

* add ament auto package

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

* Update planning/behavior_path_lane_change_module/test/test_behavior_path_planner_node_interface.cpp

Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>

* Update planning/behavior_path_external_request_lane_change_module/test/test_behavior_path_planner_node_interface.cpp

Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>

* fix test

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

* fix AbLC test

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

---------

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Signed-off-by: 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: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>

…arefoundation#5872)

Signed-off-by: Takagi, Isamu <isamu.takagi@tier4.jp>

…rectory to avoid conflicts (autowarefoundation#5851)

* build(detected_object_validation): move header files to a separate directory to avoid conflicts

Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp>

* style(pre-commit): autofix

---------

Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…age name (autowarefoundation#5864)

* fix(traffic_light_visualization): move header directory to match package name

Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp>

* style(pre-commit): autofix

* fix: fix include

Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp>

---------

Signed-off-by: Esteve Fernandez <esteve.fernandez@tier4.jp>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>

…tion#5005)

* refactor the configuration files of the node compare_map_segmentation according to the new ROS node config guideline.

Signed-off-by: yuntianyi-chen <yuntianyichen@outlook.com>

* style(pre-commit): autofix

* Add three parameters

Signed-off-by: yuntianyi-chen <yuntianyichen@outlook.com>

* style(pre-commit): autofix

* Update perception/compare_map_segmentation/config/distance_based_compare_map_filter.param.yaml

Co-authored-by: badai nguyen  <94814556+badai-nguyen@users.noreply.github.com>

* Update perception/compare_map_segmentation/config/voxel_based_approximate_compare_map_filter.param.yaml

Co-authored-by: badai nguyen  <94814556+badai-nguyen@users.noreply.github.com>

* Update perception/compare_map_segmentation/config/voxel_based_compare_map_filter.param.yaml

Co-authored-by: badai nguyen  <94814556+badai-nguyen@users.noreply.github.com>

* Update perception/compare_map_segmentation/config/voxel_distance_based_compare_map_filter.param.yaml

Co-authored-by: badai nguyen  <94814556+badai-nguyen@users.noreply.github.com>

* Update perception/compare_map_segmentation/schema/voxel_based_approximate_compare_map_filter.schema.json

Co-authored-by: badai nguyen  <94814556+badai-nguyen@users.noreply.github.com>

---------

Signed-off-by: yuntianyi-chen <yuntianyichen@outlook.com>
Co-authored-by: pre-commit-ci[bot] <66853113+pre-commit-ci[bot]@users.noreply.github.com>
Co-authored-by: badai nguyen <94814556+badai-nguyen@users.noreply.github.com>

…r_intereface to behavior_velocity_planner (autowarefoundation#5875)

* feat(behavior_velocity_planner_common): add objects_of_interest_marker_intereface to behavior_velocity_planner

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>

* fix(behavior_velocity_planner_common): add functions to publish objects of interest marker

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>

* feat(no_stopping_area): insert object data

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>

* refactor(behavior_velocity_planner_common): rename function

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>

---------

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>

…h_planner_common` package (autowarefoundation#5877)

* refactor(bpp): remove unused header file

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* refactor(bpp, bpp-common): move occ grid based collision detector

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

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

…towarefoundation#5849)

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>

…efault value spefications (autowarefoundation#4902)

* refactor: add JSON Schema and remove default values in `declare_parameter()`

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* refactor: update configuration file

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* refactor: add configuration file and update launcher to load this

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* refactor: update funsion node configuration

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* docs: update the document for roi cluster fusion

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* docs: update documents

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* refactor: move `debug_mode` into `roi_sync.param.yaml`

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* refactor: rework parameters for `roi_pointcloud_fusion`

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* chore: update maintainers

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* refactor: remove debug_mode

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* refactor: rename parameter to avoid failure of spell-check

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

* fix: fix typo and parameters for initialization

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

---------

Signed-off-by: ktro2828 <kotaro.uetake@tier4.jp>

…uver (autowarefoundation#5805)

fix(avoidance): fix sudden deceleration

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…ndation#5886)

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

…#5857)

* fix(avoidance): check far objects during shifting

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(avoidance): update impl

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…tion#5885)

* perf(run_out): improve calculation cost of smoothPath

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

* re-index enum elements

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

---------

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

…ation#5888)

* feat(planning_debug_utils): update_logger_level.sh

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

* add error handling

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

* update README

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

---------

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

…atched road marking (autowarefoundation#5842)

fix(utils): fix drivable area expansion logic for zebra zone

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

…omous control (autowarefoundation#5891)

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

…function (autowarefoundation#5889)

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

…producer (autowarefoundation#5894)

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

* fix(avoidance): unintentional path cut

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(bpp): nouse pointer

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(bpp_common): nouse pointer

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(bpp_side_shift): nouse pointer

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(bpp_avoidance): nouse pointer

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(bpp_lane_change): nouse pointer

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(bpp_goal_planner): nouse pointer

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* fix(bpp_start_planner): nouse pointer

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

---------

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>

* add maintainer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

* modify map_tf_generator's maintainer

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

---------

Signed-off-by: Kento Yabuuchi <kento.yabuuchi.2@tier4.jp>

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>

…y to stopped (autowarefoundation#5892)

chore(pid_longitudinal_controller): change the condition from emergency to stopped

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

…towarefoundation#5897)

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

…es (autowarefoundation#5883)

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>

…efoundation#5899)

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

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

…owarefoundation#5900)

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

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

…ndation#5862)

* suppress on crosswalk

Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp>

…arefoundation#5902)

* fix(dynamic_avoidance): fix drivable area generation during LC

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

* fix

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

---------

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

…l vehicles (autowarefoundation#5901)

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

…#5898)

* add maintainer

Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp>

…arefoundation#5869)

* refactor(avoidance_by_lane_change): update execution condition

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

* fix lc parameter

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

* fix both lane change and avoidance by lane change both are running

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

* trying to set maximum_avoid_distance

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

* fix avoidance param not properly assigned

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

* fixed avoidance not running

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

* fix root lanelet

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

* removed gdb

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

* add debug

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

* fix unnecessary changes

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

* Update planning/behavior_path_avoidance_module/include/behavior_path_avoidance_module/parameter_helper.hpp

Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>

---------

Signed-off-by: Muhammad Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>