Skip to content

RSDK-13382: Velocity Switching Point Search Updates#175

Open
nfranczak wants to merge 14 commits intoviam-modules:mainfrom
nfranczak:20260209-RSDK-13382-velocity-switching-point-search
Open

RSDK-13382: Velocity Switching Point Search Updates#175
nfranczak wants to merge 14 commits intoviam-modules:mainfrom
nfranczak:20260209-RSDK-13382-velocity-switching-point-search

Conversation

@nfranczak
Copy link
Contributor

Refactored the original find_velocity_switching_point since it was rather large into sub-functions.
Previously it seems that wrt equation 40 we were blatantly looking for when LHS = RHS.
This does not consider two things.

  1. since we advance by some value we could skip over this equality and miss the first fulfillment of it
  2. LHS = RHS is not enough, it should be LHS-RHS = 0 and we should make sure that LHS(s_previous) - RHS(s_previous) > 0 and LHS(s_previous) - RHS(s_previous) <= 0

The method of searching for the fulfillment of equations 41 and 42 is largely not changed.

We also had Claude add plenty of tests and asked Claude to validate that the changes made to trajectory.cpp are sane.

@nfranczak nfranczak requested a review from acmorrow February 13, 2026 22:13
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

1 participant