KD-tree attempt #494
Draft
KD-tree attempt #494
Conversation
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
* add new test for histogram compression * fix elevation cropping at compression
* use fsm in local planner waypoint generator * add direct state to local planner fsm * adapt local planner waypoint generator tests to the state machine * remove unused code * clean up state machine in local planner * modify cost function to get back on the prev to current waypoint line after the obstacle is avoided * init state machine in loiter state and uncomment code * fix tests for new cost function and state machine initialization * fix uninitialized variables and remove unused variables * SLPState -> PlannerState for local planner state machine * improve cost function to go back to the line previous-current goal only if there aren't any obstacle in the direction of the goal. This prevents indecision when avoiding wide obstacles
This commit changes the star planner to distinguish between setpoints sent to the position controller and the actual positions we would then end up in.
- penalize for big angular changes between parent-child nodes in the tree - penalize for big angular changes at the tree root between iteration
…int in that direction, rather than nearest distance in that direction
jkflying
reviewed
Oct 2, 2019
| * ------------------------------------------------------------------- | ||
| * | ||
| * This Source Code Form is subject to the terms of the Mozilla Public License, v. 2.0. If a copy of the MPL was not | ||
| * distributed with this file, you can obtain one at http://mozilla.org/MPL/2.0/. |
There was a problem hiding this comment.
Remind me to make a BSD license of this when this is closer to being merged
Sign up for free
to join this conversation on GitHub.
Already have an account?
Sign in to comment
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.
This is a hacking branch that attempts to replace the histogram with a KD-tree for nearest-neighbor searches.
Doesn't work well at all right now, I just wanted to share my findings if somebody is interested.
May be most useful if looked at on a commit-by-commit basis, I tried to keep them functionally separate