To check: `generate_vel_cmd()` scales motion commands, but they should *not* be scaled if computed to slow down exactly towards a target point.
To check:
generate_vel_cmd()scales motion commands, but they should not be scaled if computed to slow down exactly towards a target point.