fix: seems to fix the issue

[robertik10]

Description

Fixed the frequent unstuck routine trigger even if not unstuck

Fixes #226

Type of change

• Bug fix (non-breaking change which fixes an issue)

Does this PR introduce a breaking change?

no

Most important changes

TRIGGER_UNSTUCK_SPEED in behaviors

Checklist:

• [x] My code follows the style guidelines of this project
• [x] I have performed a self-review of my own code
• [x] I have commented my code, particularly in hard-to-understand areas
• [x] I have made corresponding changes to the documentation
• [x] My changes generate no new warnings
• [x] I have added tests that prove my fix is effective or that my feature works (might be obsolete with CI later on)
• [x] New and existing unit tests pass locally with my changes (might be obsolete with CI later on)

[github-actions[bot]]

Simulation results

Metric	Value
Avg. driving score	0.003538
Avg. route completion	18.39
Avg. infraction penalty	0.000275
Collisions with pedestrians	0.716
Collisions with vehicles	10.387
Collisions with layout	3.224
Red lights infractions	0.0
Stop sign infractions	0.358
Off-road infractions	0.175
Route deviations	0.358
Route timeouts	0.0
Agent blocked	0.358
Yield emergency vehicles infractions	0.0
Scenario timeouts	0.358
Min speed infractions	0.0

[github-actions[bot]]

Simulation results

Metric	Value
Avg. driving score	0.020204
Avg. route completion	9.925
Avg. infraction penalty	0.00278
Collisions with pedestrians	0.701
Collisions with vehicles	12.613
Collisions with layout	4.905
Red lights infractions	0.0
Stop sign infractions	0.701
Off-road infractions	0.052
Route deviations	0.701
Route timeouts	0.0
Agent blocked	0.701
Yield emergency vehicles infractions	0.0
Scenario timeouts	0.701
Min speed infractions	0.0

[github-actions[bot]]

Simulation results

Metric	Value
Avg. driving score	0.000482
Avg. route completion	16.06
Avg. infraction penalty	3.5e-05
Collisions with pedestrians	0.0
Collisions with vehicles	11.224
Collisions with layout	7.067
Red lights infractions	0.831
Stop sign infractions	0.831
Off-road infractions	0.085
Route deviations	0.0
Route timeouts	0.0
Agent blocked	0.831
Yield emergency vehicles infractions	0.0
Scenario timeouts	1.247
Min speed infractions	0.0

[github-actions[bot]]

Simulation results

Metric	Value
Avg. driving score	0.005632
Avg. route completion	37.465
Avg. infraction penalty	0.000557
Collisions with pedestrians	0.169
Collisions with vehicles	10.671
Collisions with layout	5.42
Red lights infractions	0.0
Stop sign infractions	0.508
Off-road infractions	0.241
Route deviations	0.0
Route timeouts	0.0
Agent blocked	0.339
Yield emergency vehicles infractions	0.0
Scenario timeouts	1.186
Min speed infractions	0.339

[github-actions[bot]]

Simulation results

Metric	Value
Avg. driving score	0.008243
Avg. route completion	37.295
Avg. infraction penalty	0.000843
Collisions with pedestrians	0.85
Collisions with vehicles	9.692
Collisions with layout	3.911
Red lights infractions	0.34
Stop sign infractions	0.17
Off-road infractions	0.207
Route deviations	0.0
Route timeouts	0.0
Agent blocked	0.34
Yield emergency vehicles infractions	0.0
Scenario timeouts	0.68
Min speed infractions	0.34

[github-actions[bot]]

Simulation results

Metric	Value
Avg. driving score	0.003584
Avg. route completion	37.94
Avg. infraction penalty	0.000366
Collisions with pedestrians	0.0
Collisions with vehicles	9.858
Collisions with layout	6.683
Red lights infractions	0.167
Stop sign infractions	0.501
Off-road infractions	0.39
Route deviations	0.167
Route timeouts	0.0
Agent blocked	0.167
Yield emergency vehicles infractions	0.0
Scenario timeouts	0.501
Min speed infractions	0.334

[github-actions[bot]]

Simulation results

Metric	Value
Avg. driving score	0.036293
Avg. route completion	35.72
Avg. infraction penalty	0.003625
Collisions with pedestrians	0.178
Collisions with vehicles	7.112
Collisions with layout	4.445
Red lights infractions	0.178
Stop sign infractions	0.356
Off-road infractions	0.253
Route deviations	0.0
Route timeouts	0.0
Agent blocked	0.356
Yield emergency vehicles infractions	0.0
Scenario timeouts	0.356
Min speed infractions	0.356

[github-actions[bot]]

Simulation results

Metric	Value
Avg. driving score	0.001287
Avg. route completion	38.845
Avg. infraction penalty	0.0001
Collisions with pedestrians	0.164
Collisions with vehicles	9.689
Collisions with layout	3.613
Red lights infractions	0.328
Stop sign infractions	0.328
Off-road infractions	0.261
Route deviations	0.0
Route timeouts	0.0
Agent blocked	0.328
Yield emergency vehicles infractions	0.0
Scenario timeouts	0.493
Min speed infractions	0.328