Sampling is done along the Dubins path between a start point (16.2953, 0.12524, 0.575959) and and endpoint (17.2329, 2.0764, 2.28307). As the samples get closer to the endpoint, the distance between the current sample to the endpoint jumps at some point. Below is the test code, followed by the test output.
Sampling is done along the Dubins path between a start point
(16.2953, 0.12524, 0.575959)
and and endpoint(17.2329, 2.0764, 2.28307)
. As the samples get closer to the endpoint, the distance between the current sample to the endpoint jumps at some point. Below is the test code, followed by the test output.Test output:
The distance spikes from sample 8 to 9, not sure if this can be considered expected behavior.