This commit is contained in:
Adrien LASSERRE 2023-01-19 17:30:19 +01:00
parent 20d20cdf11
commit ef81f8fc4e
1 changed files with 2 additions and 6 deletions

View File

@ -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;