rrtsanwei

仿真利用RRT算法实现了三维状态下的航迹规划

function c;
clc
clear all
close all
%map1 随机地表。
% a=10;
% b=0.2;
% c=0.1;
% d=0.6;
% e=1;
% f=0.1;
% g=0.1;
% for x=1:80
%     for y=1:80
% Z1=sin（y+a）+b*sin（x）+cos（d*（x^2+y^2）^（1/2））+e*cos（y）+f*sin（f*（x^2+y^2）^（1/2））+g*cos（y）;
% % Z1=SquareDiamond（628）;
%  figure（1）;
%  surf（Z1）; %画出三维曲面 
%  shading flat; %各小曲面之间不要网格 
% %map2 山峰图
tic;
h=[203525382025];
x0=[104045602020];
y0=[102550304510];
xi=[5.5854.55.53.5];
yi=[5765.564.5];
Z2=CeatHill（6hx0y0xiyi80）; 
figure（2）;
surf（Z2）; %画出三维曲面 
shading flat; %各小曲面之间不要网格 
%map3 合成图
%  Z3=max（Z1Z2）;
%  figure（3）;
%  surf（Z3）; %画出三维曲面 
%  shading flat; %各小曲面之间不要网格 
segmentLength =5;
start_node =  [5705000];
end_node   =[803010100];
hold on
plot3（start_node（:1）start_nod

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     文件        4925  2014-02-27 16:56  rrtsanwei.m