三维最短路

即求解在三维空间中从一个点到另一个的最短距离

传送门:Jelly
题意:在n * n * n的三维空间中每个点上都有一个好果冻或一个坏果冻。计算在不吃坏果冻的前提下,从(1,1,1)到(n,n,n)最少需要吃多少好果冻。
做法:每个有好果冻的点与上下左右前后有好果冻的点有可达边。用spfa即可。

#include<bits/stdc++.h>
using namespace std;
const int maxn=110;
const int inf=0x3f3f3f3f;
char g[maxn][maxn][maxn];
bool vis[maxn][maxn][maxn];
int d[maxn][maxn][maxn];
int X[]={
   1,-1,0,0,0,0};
int Y[]={
   0,0,1,-1,0,0};
int Z[]={
   0,0,0,0,1,-1};
int n;
bool check(int x,int y,int z){
   
    if((0<x&&x<=n&&0<y&&y<=n&&0<z&&z<=n))
        return true;
    else return false;
}
struct ac{
   
    int x,y,z;int d;
};
int inq[maxn][maxn][maxn];
void SPFA(){
   
    memset(inq,false,sizeof inq);
    memset(d,0x3f,sizeof d);
    queue<ac> Q;
    Q.push((ac){
   1,1,1,1});
    inq[1]
  • 1
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
计算三维点云数据中每个点到起点的最短路径可以使用Dijkstra算法。以下是C++代码示例: ```c++ #include <iostream> #include <vector> #include <queue> #include <cmath> using namespace std; struct Point { double x, y, z; }; struct Edge { int to; double weight; }; const int MAXN = 100000; const double INF = 1e9; vector<Edge> edges[MAXN]; double dist[MAXN]; bool vis[MAXN]; void addEdge(int from, int to, double weight) { edges[from].push_back({to, weight}); } void dijkstra(int start) { priority_queue<pair<double, int>, vector<pair<double, int>>, greater<pair<double, int>>> pq; pq.push({0, start}); dist[start] = 0; while (!pq.empty()) { int u = pq.top().second; pq.pop(); if (vis[u]) continue; vis[u] = true; for (Edge e : edges[u]) { int v = e.to; double w = e.weight; if (dist[v] > dist[u] + w) { dist[v] = dist[u] + w; pq.push({dist[v], v}); } } } } int main() { int n, m, start; cin >> n >> m >> start; vector<Point> points(n); for (int i = 0; i < n; i++) { cin >> points[i].x >> points[i].y >> points[i].z; dist[i] = INF; } for (int i = 0; i < m; i++) { int u, v; cin >> u >> v; double weight = sqrt(pow(points[u].x - points[v].x, 2) + pow(points[u].y - points[v].y, 2) + pow(points[u].z - points[v].z, 2)); addEdge(u, v, weight); } dijkstra(start); for (int i = 0; i < n; i++) cout << "Shortest distance from point " << start << " to point " << i << " is " << dist[i] << endl; return 0; } ``` 该程序先读入点云数据,然后根据输入的边构建图,每个边的权值为其两个端点之间的欧几里得距离。最后使用Dijkstra算法计算每个点到起点的最短路径,并输出结果。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值