refactor(lane_change): refactor transit failure function

[zulfaqar-azmi-t4]

Description

Refactoring canTransitToFailState function. Reduce similar computation, and reduce nested loop. Also added debug marker for visualizing state and the transitioning reason.

Related links

Parent Issue:

• Link

How was this PR tested?

1. PSIM
2. TIER IV Internal link

Notes for reviewers

None.

Interface changes

None.

Effects on system behavior

None.

[github-actions]

Thank you for contributing to the Autoware project!

🚧 If your pull request is in progress, switch it to draft mode.

Please ensure:

• You've checked our contribution guidelines.
• Your PR follows our pull request guidelines.
• All required CI checks pass before marking the PR ready for review.

[codecov]

Codecov Report

Attention: Patch coverage is 36.73469% with 31 lines in your changes missing coverage. Please review.

Project coverage is 29.62%. Comparing base (7fb4c1b) to head (56fa3ec).
Report is 34 commits behind head on main.

Files with missing lines	Patch %	Lines
...behavior_path_lane_change_module/src/interface.cpp	7.14%	26 Missing ⚠️
...are_behavior_path_lane_change_module/src/scene.cpp	0.00%	3 Missing ⚠️
...vior_path_lane_change_module/src/utils/markers.cpp	88.88%	1 Missing and 1 partial ⚠️

Additional details and impacted files

@@           Coverage Diff           @@
##             main    #9835   +/-   ##
=======================================
  Coverage   29.62%   29.62%           
=======================================
  Files        1452     1454    +2     
  Lines      108921   108917    -4     
  Branches    42577    42575    -2     
=======================================
+ Hits        32265    32272    +7     
+ Misses      73421    73410   -11     
  Partials     3235     3235           

Flag	Coverage Δ		*Carryforward flag
differential	20.93% <36.73%> (?)
total	29.63% <ø> (+0.01%)	⬆️	Carriedforward from 7fb4c1b

*This pull request uses carry forward flags. Click here to find out more.

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

[mkquda]

LGTM.