rrt3D fin, prep A*

2026-08-30 00:50:46 +08:00 · 2020-06-25 18:55:55 -07:00
parent c398cefee7
commit 2ce2a01b24
5 changed files with 198 additions and 18 deletions
@@ -102,7 +102,7 @@ def near(initparams, x):
    if initparams.done: r = 1
    V = np.array(initparams.V)
    if initparams.i == 0:
-        return initparams.V[0]
+        return [initparams.V[0]]
    xr = repmat(x, len(V), 1)
    inside = np.linalg.norm(xr - V, axis=1) < r
    nearpoints = V[inside]