Найти длину кратчайшего пути из А в B для взвешенного неориентированного графа

#include <iostream>
#include <vector>
#include <set>
#include <list>
 
class IGraph
{
public:
    virtual ~IGraph() {}
    virtual int size() const = 0;
    virtual void AddArc(int from, int to, int weight) = 0;
    virtual void GetArc(int vertex, std::vector<std::pair<int, int>> &vertices) const = 0;
};
 
class Graph : public IGraph {
public:
    Graph(int n);
    ~Graph() {};
 
    void AddArc(int from, int to, int weight);
    void GetArc(int vertex, std::vector<std::pair<int, int>> &vertices) const;
 
    int size() const {
        return vertexNumber;
    }
 
private:
    int vertexNumber;
    std::vector<std::list<std::pair<int, int>>> graph;
};
 
 
Graph::Graph(int size) : vertexNumber(size), graph(vertexNumber, std::list<std::pair<int, int>>()) {}
 
 
void Graph::AddArc(int from, int to, int weight)
{
    graph[from].push_back(std::make_pair(to, weight));
    graph[to].push_back(std::make_pair(from, weight));
}
 
 
void Graph::GetArc(int vertex, std::vector<std::pair<int, int>> &vertices) const
{
    vertices.clear();
    for (const std::pair<int, int> &i : graph[vertex]) {
        vertices.push_back(i);
    }
}
 
 
void build1(Graph const &graph, int from, int to) {
    std::vector<bool> used(graph.size(), false);
    std::vector<int> dlina(graph.size(), 10001);
    dlina[from] = 0;
    std::set<std::pair<int, int>> queue;
    queue.emplace(std::make_pair(0, from));
 
    while (!queue.empty()) {
        int v = (queue.begin())->second;
        queue.erase(queue.begin());
        used[v] = true;
 
        std::vector<std::pair<int, int>> a;
        graph.GetArc(v, a);
 
        for (std::pair<int, int> c : a) {
            if (dlina[c.first] > dlina[v] + c.second) {
                if (dlina[c.first] != 10001)
                    queue.erase(std::make_pair(dlina[c.first], c.first));
                dlina[c.first] = dlina[v] + c.second;
                queue.emplace(std::pair<int, int>(dlina[c.first], c.first));
            }
        }
    }
 
    if (dlina[to] != 10001) {
        std::cout << dlina[to];
    }
    else {
        std::cout << "0";
    }
}
 
 
int main() {
    int N, M, k, l, w;
    std::cin >> N >> M;
    if (N != 0 && M != 0) {
        Graph graph(N);
        for (int i = 0; i < M; i++) {
            std::cin >> k >> l >> w;
            graph.AddArc(k, l, w);
        }
        int from, to;
        std::cin >> from >> to;
 
        build1(graph, from, to);
    }
    else {
        std::cout << "0";
    }
    return 0;
}