RRT* (matlab)

最新推荐文章于 2023-11-25 18:27:08 发布

Ruo_su.

最新推荐文章于 2023-11-25 18:27:08 发布

阅读量1.2k

点赞数

文章标签： matlab 算法开发语言

本文链接：https://blog.youkuaiyun.com/qq_44752711/article/details/125194820

版权

本文详细介绍了快速随机树算法RRT*的MATLAB实现过程，包括路径规划的基本思想、关键步骤及代码解析，帮助读者理解并掌握RRT*在机器人路径规划中的应用。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

%%------------------------
%%2022/06/05
%%matlab
%%rrt star
%%------------------------

clc;
clear all;
close all;

%加载地图
ImpRgb = imread("map.png");
Imp = rgb2gray(ImpRgb);
imshow(Imp);
hold on;
x_l = size(Imp,1)  %row
y_l = size(Imp,2)  %col

% Imp(120,129)
% plot(120,120,'r*');
% hold on;

%参数初始化
start = [1,1];
goal = [450,800];
threshold = 30;
step = 30;
r = 70;
MaxIter = 3000;

T.v(1).x = start(1);
T.v(1).y = start(2);
T.v(1).xPre = start(1);
T.v(1).yPre = start(2);
T.v(1).cost = 0;
T.v(1).indPre = -1;

plot(start(2),start(1),'mo','MarkerSize',10,'MarkerFaceColor','m');
plot(goal(2),goal(1),'go','MarkerSize',10,'MarkerFaceColor','g');

%开始主循环
for iter = 1:MaxIter
   %step1.生成随机点
   n = rand();
   if n < 0.5
        Prand = [unifrnd(0,x_l),unifrnd(0,y_l)];
   else
       Prand = goal;
   en