PathPlanning icon indicating copy to clipboard operation
PathPlanning copied to clipboard

I have a question of "rrt_star.py" in rrt_2D.

Open guest-oo opened this issue 4 months ago • 0 comments

def find_near_neighbor(self, node_new): n = len(self.vertex) + 1 r = min(self.search_radius * math.sqrt((math.log(n) / n)), self.step_len) dist_table = [math.hypot(nd.x - node_new.x, nd.y - node_new.y) for nd in self.vertex] dist_table_index = [ind for ind in range(len(dist_table)) if dist_table[ind] <= r and not self.utils.is_collision(node_new, self.vertex[ind])] return dist_table_index

Is this n plus 1 in the code correct?

guest-oo avatar Feb 26 '24 13:02 guest-oo