function cost = compute_cost(mapSize, from, rTo, cTo) % Returns COST, an estimated cost to travel the map, starting FROM and % ending at TO. [rFrom,cFrom] = ind2sub(mapSize, from); cost = sqrt((rFrom - rTo).^2 + (cFrom - cTo).^2); end
时间: 2023-12-02 20:02:48 浏览: 66
这段代码是一个计算两个点之间距离的函数,其中参数`mapSize`是地图的大小,`from`是起点的索引,`rTo`和`cTo`是终点的行列坐标。函数中使用了`ind2sub`函数将起点的索引转换为行列坐标,然后使用欧几里得距离公式计算两点间的距离。这个函数的返回值`cost`是一个估算的从起点到终点的代价。
阅读全文