RRT、RRT-Connect、LazyRRT、RRTextend、RRT*的2D和3D算法（Matlab）

基于RRT，通过对RRT-Connect、LazyRRT、RRTextend以及RRT*的2D和3D算法，在Matlab进行仿真，更有利于对算法的理解甚至后续的改进。

% ==============================================================================
%
%    Software License Agreement （BSD License）
%    Copyright （c） 2019
%    （www.aimlab.wpi.edu）
%
%    All rights reserved.
%
%    Redistribution and use in source and binary forms with or without
%    modification are permitted provided that the following conditions
%    are met:
%
%    * Redistributions of source code must retain the above copyright
%    notice this list of conditions and the following disclaimer.
%
%    * Redistributions in binary form must reproduce the above
%    copyright notice this list of conditions and the following
%    disclaimer in the documentation and/or other materials provided
%    with the distribution.
%
%    * Neither the name of authors nor the names of its contributors may
%    be used to endorse or promote products derived from this software
%    without specific prior written permission.
%
%    THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
%    “AS IS“ AND ANY EXPRESS OR IMPLIED WARRANTIES INCLUDING BUT NOT
%    LIMITED TO THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
%    FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
%    COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT INDIRECT
%    INCIDENTAL SPECIAL EXEMPLARY OR CONSEQUENTIAL DAMAGES （INCLUDING
%    BUT NOT LIMITED TO PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
%    LOSS OF USE DATA OR PROFITS; OR BUSINESS INTERRUPTION） HOWEVER
%    CAUSED AND ON ANY THEORY OF LIABILITY WHETHER IN CONTRACT STRICT
%    LIABILITY OR TORT （INCLUDING NEGLIGENCE OR OTHERWISE） ARISING IN
%    ANY WAY OUT OF THE USE OF THIS SOFTWARE EVEN IF ADVISED OF THE
%    POSSIBILITY OF SUCH DAMAGE.
%
%    \author:    
%    \author:    
%    \author:    Adnan Munawar
%    \version:   0.1$
% ==============================================================================

function benchmarkRRT

clc;
close all;
clear all;


num_of_runs =1;
run_RRTconnect =0;
run_RRTextend = 0;
run_LazyRRT = 0;
run_RRTstar = 1;

dim = 2;
stepsize = [5];

random_world = 0;
radius = 10;
samples = 4000;

show_output = 1;
show_benchmark_results = 0;


%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%%%%%

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2020-03-31 14:33  matlab-rrt-variants-master\
     文件        6148  2020-03-31 14:33  matlab-rrt-variants-master\.DS_Store
     文件       18527  2020-03-31 14:33  matlab-rrt-variants-master\LazyRRT3D.m
     文件        1097  2020-03-31 14:33  matlab-rrt-variants-master\README.md
     文件       18414  2020-03-31 14:33  matlab-rrt-variants-master\RRTconnect3D.m
     文件       18113  2020-03-31 14:33  matlab-rrt-variants-master\RRTextend3D.m
     文件       21517  2020-03-31 14:33  matlab-rrt-variants-master\RRTstar3D.m
     文件       10433  2020-03-31 14:33  matlab-rrt-variants-master\benchmarkRRT.m