vtr3
vtr3 copied to clipboard
path tracker: may not command the robot to the end of a cusp when distance between keyframes is large
The path tracker should not look past the cusp until the robot is close enough to it.