Correction for curves generated on the radius of curvature. #11
+25
−15
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Hi @AndrewWalker ,
I found out that if the goal point is on the radius of curvature as follows:
Then sometimes the path returned is:
But what is expected is:
.
I added a simple check, that checks if the straight path length is zero, if so it calculates the difference in orientation between the start and goal orientations and normalizes it within 0,2*pi, and sets to out[0] and out[1] and out[2] are set to 0.
Please let me know if there is anything wrong with this implementation.
Thanks,
Jacob