c++最短路径问题

最短路径问题

描述

平面上有n个点（n≤100），每个点的坐标均在-10000~10000之间。其中的一些点之间有连线。若有连线，则表示可从一个点到达另一个点，即两点间有通路，通路的距离为两点间的直线距离。现在的任务是找出从一点到另一点之间的最短路径。

输入

共n+m+3行，其中:第一行为整数n。第2行到第n+1行（共n行） ，每行两个整数x和y，描述了一个点的坐标。第n+2行为一个整数m，表示图中连线的个数。此后的m 行，每行描述一条连线，由两个整数i和j组成，表示第i个点和第j个点之间有连线。最后一行：两个整数s和t，分别表示源点和目标点。

输出

一行，一个实数（保留两位小数），表示从s到t的最短路径长度。

输入样例 1 

5 
0 0
2 0
2 2
0 2
3 1
5 
1 2
1 3
1 4
2 5
3 5
1 5

输出样例 1

3.41

#include <iostream>
#include <iomanip>
#include <cmath>
#include <vector>
using namespace std;

struct Point {
    int x, y;
};

double distance(const Point& a, const Point& b) {
    return sqrt(pow(a.x - b.x, 2) + pow(a.y - b.y, 2));
}

int main() {
    int n, m, s, t;
    cin >> n;
    vector<Point> points(n);
    for (int i = 0; i < n; ++i) {
        cin >> points[i].x >> points[i].y;
    }
    cin >> m;
    vector<vector<double>> graph(n, vector<double>(n, 1e9));
    for (int i = 0; i < n; ++i) {
        graph[i][i] = 0; // Distance to self is 0
    }
    for (int i = 0; i < m; ++i) {
        int u, v;
        cin >> u >> v;
        --u; 
        --v; 
        graph[u][v] = graph[v][u] = distance(points[u], points[v]);
    }
    cin >> s >> t;
    --s; 
    --t; 
    for (int k = 0; k < n; ++k) {
        for (int i = 0; i < n; ++i) {
            for (int j = 0; j < n; ++j) {
                if (graph[i][k] + graph[k][j] < graph[i][j]) {
                    graph[i][j] = graph[i][k] + graph[k][j];
                }
            }
        }
    }
    cout << fixed << setprecision(2);
    cout << graph[s][t] << endl;

    return 0;
}