洛谷P4822-冻结(分层图最短路dijk堆优化)

题意:洛谷P4822

给一张图,你有 k k k次机会将某些边边权减半,问从点 1 1 1到点 n n n最小权值。

分析:

经典分层图题…用 u u u表示当前点, t o to to表示终点, d i s [ t o ] [ k k ] dis[to][kk] dis[to][kk]表示从 u u u走到 t o to to点时用了 k k kk kk次机会,
那么当图是同一层时,就有 d i s [ t o ] [ k k ] = m i n ( d i s [ t o ] [ k k ] , d i s [ u ] [ k k ] + e d g e [ i ] . v a l ) dis[to][kk]=min(dis[to][kk],dis[u][kk]+edge[i].val) dis[to][k<

  • 0
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
这段代码是一个基于A*算法的路径规划算法的实现。下面逐行解释: ``` if astar == false ``` 如果不使用A*算法,则执行以下代码。 ``` while (~all(unvisited(:)==inf)) ``` 当存在未访问的节点时,执行以下代码。 ``` dist_unvisited = dist.*unvisited; [~, id] = min(dist_unvisited(:)); unvisited(id) = inf; ``` 计算未访问节点的距离,并选择距离最短的节点作为当前节点,将其标记为已访问。 ``` num_expanded = num_expanded + 1; [i,j,k] = ind2sub([map.nx,map.ny,map.nz],id); ``` 将当前节点的索引转化为三维坐标。 ``` for d = 1:size(dijk,1) nijk = bsxfun(@plus, int32([i,j,k]), int32(dijk(d,:))); if all(nijk > 0) & all(int32([map.nx, map.ny, map.nz]) >= int32(nijk)) ... & unvisited(nijk(1),nijk(2),nijk(3)) == 1 ... & map.occ_map(nijk(1),nijk(2),nijk(3)) ~= 1 alt = dist(id) + sqrt(sum(dijk(d,:).^2)); nid = (nijk(3)-1)*map.nx*map.ny + (nijk(2)-1)*map.nx + nijk(1); if alt < dist(nid) dist(nid) = alt; prev(nijk(1), nijk(2), nijk(3),:) = [i,j,k]; end end end ``` 遍历当前节点的所有相邻节点,并计算其到起始点的距离和到目标点的估计距离,称为启发式距离。如果相邻节点的距离小于当前距离,则更新相邻节点的距离和前驱节点。这里的`dijk`是一个3x3x3的矩阵,表示相邻节点的相对位置。 ``` if id == (goal(3)-1)*map.nx*map.ny + (goal(2)-1)*map.nx + goal(1); break end ``` 如果当前节点是目标节点,则退出循环。最终的路径可以通过`prev`数组回溯得到。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值