Нужно заполнить матрицу подобным образом, для поиска кратчайшего пути

Хотел бы спросить, а если обычный BFS пройтись и заполнять числовыми коэффециентами, все норм получиться?