|
Algorithm 2. Post-Processing Method |
Q ← Pruning (T);
S ← Cubic_Bspline (Q);
Return
S
Function Pruning (T)
T ← obtained from DV-RRT;
Var Q1, Q2: Path
Q1 (q0, q1, q2, …, qn) ← Path (T);
qtemp ← q0; Q2 Add_Node (q0);
while qtemp! = qn do
for each node qi ∈ Q1
if Collision (qtemp, qi) then
qtemp ← qi; Q2 Add_Node (qtemp);
break
end if
end for
Q2 Add_Node (qn);
end while
Return
Q2;
|