Skip to main content
. 2022 Nov 26;22(23):9203. doi: 10.3390/s22239203
Algorithm 1 RRT*
1: G ← (V, E); Vxinit;
2: for i = 1 to n do
3: xrandSample(i);
4: xnearestNearest(V, xrand);
5:  (xnew, σ) ← Steer(xnearest, xrand);
6: if CollisionFree(σ) then
7:   XnearNear(V, xnew);
8:   (xparent, σparent) ← ChooseParent(Xnear, xnearest, xnew, σ);
9:   VAddVertex(xnew);
10:   EAddEdge(xparent, xnew);
11:   GRewire(G, xnew, Xnear);
12: end if
13: end for
14: return G;