Dijkstra Shortest Path in C++

Algorithms: Graph Algorithms November 15, 2026 C++

Dijkstra repeatedly settles the unsettled vertex with smallest tentative distance.

cpp
  1
  2
  3
  4
  5
  6
  7
  8
  9
 10
 11
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
#include <stdio.h>
#include <vector>
#include <algorithm>
#include <stdexcept>
#include <cstdint>
#include <limits>
// Dijkstra Shortest Path in C++
//
// PURPOSE
// Dijkstra repeatedly settles the unsettled vertex with smallest tentative distance.
// Nonnegative edge weights ensure that distance can never improve later.
//
// METHOD
// Initialize source distance zero. Select the unused minimum-distance vertex by scanning,
// stop if none is reachable, and relax all its outgoing edges.
//
// COMPLEXITY
// O(n squared) time and O(n) auxiliary space for this dense-graph matrix version. A heap
// plus adjacency lists gives a different bound.
//
// CONTRACT
// Flattened n by n weight matrix; -1 means no edge, other weights >= 0. n >= 1. Every finite
// path must be < 1,000,000,000; additions must fit. Returns -1 if unreachable.
// Public APIs infer array lengths except in C, which accepts pointer/length pairs. Vertex
// counts and matrix dimensions remain explicit. Arrays must contain signed 32-bit integers.
// Sorted order, correct tree topology, and caller-owned data-structure invariants are
// preconditions; checking them on every query would change query complexity.
// Scalar and shape checks are included. Value-range checks are included where needed to
// prevent invalid indexing or nontermination. Allocation sizes are capped at 4,000,000
// workspace entries. Arithmetic outside Python raises an error on 32-bit overflow; Python
// uses arbitrary precision. Native allocation failures propagate. In-place outputs may be
// partly updated after arithmetic failure. These are single-threaded, in-memory
// implementations.
//
// LANGUAGE DETAILS
// C++17: const vector references for inputs, mutable references for outputs, RAII workspace,
// standard lower_bound for LIS. Invalid inputs throw invalid_argument; overflow throws
// overflow_error; allocation failure propagates bad_alloc.
//
// EXAMPLE
// Expected return: 6.
// Run: g++ -std=c++17 -O2 example.cpp -o example && ./example
// Tests for this exact source artifact run before publication. The accompanying source
// archive includes unit cases, runtime results, and source hashes.

static int alg_min(int a, int b) { return a < b ? a : b; }
static int alg_max(int a, int b) { return a > b ? a : b; }
static void alg_require(bool valid) { if (!valid) throw std::invalid_argument("invalid algorithm input"); }
static int alg_checked(int64_t v) { if (v < INT32_MIN || v > INT32_MAX) throw std::overflow_error("32-bit result overflow"); return (int)v; }
static int alg_add(int a,int b) { return alg_checked((int64_t)a+b); }
static int alg_sub(int a,int b) { return alg_checked((int64_t)a-b); }
static int alg_mul(int a,int b) { return alg_checked((int64_t)a*b); }
static size_t alg_size(int n) { alg_require(n>=0 && n<=4000000); return (size_t)n; }

int dijkstra(const std::vector<int>& graph, int n, int source, int target) {
    alg_require(graph.size() <= 1000000);
    alg_require(((n >= 0) && (n <= 1000000)));
    alg_require(((int)graph.size() == alg_mul(n, n)));
    alg_require(((n >= 1) && (source >= 0) && (source < n)));
    alg_require(((target >= 0) && (target < n)));
    alg_require((n >= 1));
    for (int alg_i = 0; alg_i < (int)graph.size(); alg_i++) {
        int alg_value = graph[alg_i];
        alg_require(((alg_value >= alg_sub(0, 1)) && (alg_value < 1000000000)));
    }
    std::vector<int> distance(alg_size(n), 0);
    std::vector<int> used(alg_size(n), 0);
    int i = 0;
    int v = 0;
    int u = 0;
    int best = 0;
    while ((i < n)) {
        distance[i] = 1000000000;
        i = alg_add(i, 1);
    }
    distance[source] = 0;
    i = 0;
    while ((i < n)) {
        u = alg_sub(0, 1);
        best = 1000000000;
        v = 0;
        while ((v < n)) {
            if (((used[v] == 0) && (distance[v] < best))) {
                best = distance[v];
                u = v;
            }
            v = alg_add(v, 1);
        }
        if ((u == alg_sub(0, 1))) {
            break;
        }
        used[u] = 1;
        v = 0;
        while ((v < n)) {
            if ((graph[alg_add(alg_mul(u, n), v)] >= 0)) {
                distance[v] = alg_min(distance[v], alg_add(distance[u], graph[alg_add(alg_mul(u, n), v)]));
            }
            v = alg_add(v, 1);
        }
        i = alg_add(i, 1);
    }
    if ((distance[target] == 1000000000)) {
        return alg_sub(0, 1);
    }
    return distance[target];
}

int main(void) {
    std::vector<int> graph = {0, 4, 10, -1, 0, 2, -1, -1, 0};
    int n = 3;
    int source = 0;
    int target = 2;
    int result = dijkstra(graph, n, source, target);
    printf("%d\n", result);
    return 0;
}