p(1) = current;

在 MATLAB 中，数组的下标索引从 1 开始，因此 `p(1)` 表示数组 `p` 的第一个元素。

在上面的代码中，`p` 数组的初始值都被赋值为 NaN，因此需要在最后将起点存储在 `p` 数组的第一个元素中，表示起点是最短路径上的第一个节点。

具体实现过程可以参考以下代码：

function p = get_path(cameFrom, current)
    inds = find_nonempty(cameFrom);
    p = nan(1, length(inds));
    i = length(inds);
    while isKey(cameFrom, current)
        p(i) = current;
        current = cameFrom(current);
        i = i - 1;
    end
    p(1) = current;
end

该函数会首先调用 `find_nonempty` 函数获取非空元素的索引，然后利用 `nan` 函数创建一个初始值为 NaN 的数组 `p`，用于存储最短路径上的节点。

接着，从终点开始倒序遍历每个节点的前驱节点，将它们存储在 `p` 数组中，并返回最短路径。在存储节点时，需要注意数组 `p` 的索引与字典 `cameFrom` 中节点的索引是反向的，因此需要从数组末尾开始存储节点。最后，需要将起点存储在 `p` 数组的第一个元素中，表示起点是最短路径上的第一个节点。