基于QLearning强化学习的较大规模栅格地图机器人路径规划matlab仿真

1.算法仿真效果

matlab2022a仿真结果如下(完整代码运行后无水印):


机器人行驶动作序列:


Action_seqs =


'下下下下右右下下下下下下下下下下下下右右上上上上上上上上上上上右右右下右下下下下下下右右上上上上右右右右右下右下下下下下右下右右上上上上上上上上上上上'


仿真操作步骤可参考程序配套的操作视频。


2.算法涉及理论知识概要

强化学习是机器学习中的一个领域,强调智能体(agent)如何在环境(environment)中采取一系列行动(action),以最大化累积奖励(reward)。智能体通过与环境进行交互,根据环境反馈的奖励信号来学习最优的行为策略。在机器人导航中,状态可以是机器人的位置和姿态,动作可以是不同的运动指令(如前进、后退、转弯等),奖励可以根据机器人是否接近目标位置或者避开障碍物来设定。通过 Q - Learning,机器人可以学习到从初始位置到目标位置的最优路径规划策略。在机器人路径规划问题中,机器人即为智能体,其所处的大规模栅格地图及相关物理规则等构成了环境 。智能体通过传感器感知环境的状态,并根据学习到的策略在环境中执行动作,如向上、向下、向左、向右移动等,环境则根据智能体的动作反馈相应的奖励信号和新的状态。



将大规模栅格地图表示为一个二维矩阵,其中每个元素对应一个栅格。矩阵中的值可以表示不同的含义,如表示可通行的栅格,表示障碍物,表示目标位置等。同时,定义机器人在栅格地图中的初始位置和目标位置。



经过多次训练后,Q 表逐渐收敛,此时可以根据 Q 表中的值为机器人规划从初始位置到目标位置的最优路径。从初始状态开始,每次选择 Q 值最大的动作,直到到达目标位置,所经过的栅格序列即为规划的最优路径。


3.MATLAB核心程序

% 将效用值和状态的配对按照效用值从小到大的顺序进行排序

Idx_state = [1:nstates]';

% 使用sortrows函数对由效用值U和状态索引estados组成的矩阵按照第一列(即效用值)进行排序

Idxss     = sortrows([U Idx_state],1);

Idx_global= [Idx_state,p];

% 获取所有状态在网格上的全局策略

Mat_global= flipdim(reshape(Idx_global(:,2),[Rw1 Cm1]),1);


%输出动作

Action_set     = ['上','右','下','左'];

Action_idx     = sub2ind(size(Ter1{1}),XY0(1),XY0(2));

Ends           = sub2ind(size(Ter1{1}),XY1(1),XY1(2));

Policys        = [];% 初始化用于存储策略序列

Action_idx_set = [Action_idx];

while Action_idx~=Ends

if Action_idx~=find(obstacle==1)

% 获取当前状态下的最优策略p

[c1,c2]=ind2sub([Rw1 Cm1],Action_idx);

pop=p(Action_idx);         

Action_idx=Ter1{pop}(c1,c2);   

% 将本次选择的最优策略添加到策略序列Policys中

Policys        = [Policys pop];

Action_idx_set = [Action_idx_set;Action_idx];

end

end

clc;

% 根据策略序列Policys获取对应的动作序列

disp('机器人行驶动作序列:');

Action_seqs = Action_set(Policys)




figure

% 初始化用于存储坐标序列

Posxy       = [];

% 创建一个与网格世界维度相同的全零矩阵

Mats1       = zeros(Rw1,Cm1);

% 创建一个与障碍物矩阵obstacle维度相同的矩阵

Mats2       =-75*obstacle;

[Rc11,Cw11] = find(Maps==-1);

J5          = 1;

% 遍历状态序列每个状态索引

for i=1:length(Action_idx_set)

% 根据状态索引Action_idx_set计算其在网格世界中的行坐标c1和列坐标c2

[c1,c2]           = ind2sub([Rw1 Cm1],Action_idx_set(i));

% 将当前状态的坐标添加到坐标序列

Posxy             = [Posxy;[c1 c2]];

Mats1(end+1-c1,c2)= J5;

Mats2(c1,c2)      = 90;

J5=J5+1;

end

Mats2(XY0(1),XY0(2))=50;

Mats2(XY1(1),XY1(2))=75;

Mats2(Rc11,Cw11)    =65;

Map_line=[[flipdim(Mats2,1) zeros(Rw1,1)];zeros(1,Cm1+1)];

pcolor(Map_line)


% title(['机器人行驶路线:',Action_seqs]);

0Z_011m

©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 220,137评论 6 511
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 93,824评论 3 396
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 166,465评论 0 357
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 59,131评论 1 295
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 68,140评论 6 397
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,895评论 1 308
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 40,535评论 3 420
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 39,435评论 0 276
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,952评论 1 319
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 38,081评论 3 340
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 40,210评论 1 352
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,896评论 5 347
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 41,552评论 3 331
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 32,089评论 0 23
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 33,198评论 1 272
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 48,531评论 3 375
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 45,209评论 2 357

推荐阅读更多精彩内容