comments
This commit is contained in:
parent
20d20cdf11
commit
ef81f8fc4e
|
|
@ -2,7 +2,7 @@
|
|||
## Created: 2023-01-08
|
||||
|
||||
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
|
||||
%function buildRRT (rangeQ1Q2, nbPoints, L1, L2, MapFilename)
|
||||
%function buildRRT(rangeQ1Q2, nbPoints, L1, L2, fixedLength, start, goal)
|
||||
%
|
||||
% Task: Use the RRT method to reach a desired goal on the cartesian space
|
||||
%
|
||||
|
|
@ -120,11 +120,7 @@ function buildRRT(rangeQ1Q2, nbPoints, L1, L2, fixedLength, start, goal)
|
|||
endif
|
||||
endwhile
|
||||
|
||||
## Write the path planning here
|
||||
|
||||
## Start from goal, towards start, going to the previous point each time
|
||||
## check everytime if the start is not already accessible, and if so draw a line
|
||||
## prendre le goal, trouver le point auquel il est attach, y aller
|
||||
##Path planning
|
||||
|
||||
index_goal = columns(MatrixOfLinks);
|
||||
index = index_goal;
|
||||
|
|
|
|||
Loading…
Reference in New Issue