Skip to content

Comments

feat(trajectory_safety_filter): boundary departure prevention filter with diagnostics#2699

Merged
zulfaqar-azmi-t4 merged 8 commits intofeat/v0.48/e2efrom
cp-unmerged-commit-safety-filter-bdp
Feb 20, 2026
Merged

feat(trajectory_safety_filter): boundary departure prevention filter with diagnostics#2699
zulfaqar-azmi-t4 merged 8 commits intofeat/v0.48/e2efrom
cp-unmerged-commit-safety-filter-bdp

Conversation

@zulfaqar-azmi-t4
Copy link

@zulfaqar-azmi-t4 zulfaqar-azmi-t4 commented Feb 19, 2026

Adding boundary departure filter plus diagnostics in the trajectory safety filter.
Note that the filter is in debug mode, so it will be running, but doesn't affect autoware_trajectory_safety_filter result.

Require: https://github.com/tier4/autoware_launch.x2/pull/1934

Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>
if (!plugin->is_debug_mode()) {
is_feasible = false;
}
RCLCPP_WARN(get_logger(), "Not feasible: %s", res.error().c_str());

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

@zulfaqar-azmi-t4 Thank you, I got your idea. I guess using throttle here will be more robust? And will that affect your MOB investigation later on?

Copy link
Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

I am thinking of throttling, but I'm no so sure how long should i throttle.
I guess one second throttle should be fine. 🤔
What do you think?

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

@zulfaqar-azmi-t4 I think so. My expectation is at least 1 second. Since not many nodes are doing similar things now, for our experiment 1s is fine.

Copy link
Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

added the throttle
d4e55d1

i changed the message to error since it makes more sense.

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

Copy link

@Owen-Liuyuxuan Owen-Liuyuxuan left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

LGTM

@zulfaqar-azmi-t4 zulfaqar-azmi-t4 merged commit 2eb7f8b into feat/v0.48/e2e Feb 20, 2026
23 of 26 checks passed
@zulfaqar-azmi-t4 zulfaqar-azmi-t4 deleted the cp-unmerged-commit-safety-filter-bdp branch February 20, 2026 04:32
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

beta/v0.48 Base branch: beta/v0.48 e2e Product: e2e run:build-and-test-differential After beta/v0.41

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants