37 lines
832 B
Matlab
37 lines
832 B
Matlab
## Author: adril <adril@LAPTOP-EJ1AIJHT>
|
|
## Created: 2023-01-10
|
|
|
|
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
|
|
%function buildPRM (rangeQ1Q2, nbPoints, L1, L2, MapFilename)
|
|
%
|
|
% Task:
|
|
%
|
|
% Inputs:
|
|
% -
|
|
%
|
|
% Outputs:
|
|
% - None
|
|
%
|
|
% Adrien Lasserre (adrien.lasserre@ecam.fr) & Gwenn Durpoix-Espinasson (g.durpoix-espinasson@ecam.fr)
|
|
% 10/01/2023
|
|
%
|
|
% Check library matgeom: https://octave.sourceforge.io/matgeom/overview.html
|
|
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
|
|
|
|
function qGraph (Q, nbPoints, mat)
|
|
hold off;
|
|
figure 2
|
|
for i=1:nbPoints
|
|
for j=1:nbPoints
|
|
drawPoint(Q(1,i), Q(2,i));
|
|
current_point=[Q(1, i), Q(2, i)];
|
|
previous_point=[Q(1, j), Q(2, j)];
|
|
if mat(i, j)==1 & mat(j, i)==1
|
|
L = createEdge(current_point, previous_point);
|
|
hold on;
|
|
drawEdge(L);
|
|
endif
|
|
endfor
|
|
endfor
|
|
endfunction
|