最短路问题之dijikstra算法

cpp 复制代码
//根据bfs修改而来
#include<stdio.h>
#include<stdlib.h>
typedef struct queue {
    int data;
    struct queue* next;
}queue, * linklist;
float dist_list[9];
//出发点为0
int forward_point_list[9] = { -1 };
linklist front = NULL;
linklist rear = NULL;
float map_frame[9][9] = { 0,4,-1,-1,-1,-1,-1,8,-1,
                       4,0,8,-1,-1,-1,-1,11,-1,
                       -1,8,0,7,-1,4,-1,-1,2,
                       -1,-1,7,0,9,14,-1,-1,-1,
                       -1,-1,-1,9,0,10,-1,-1,-1,
                       -1,-1,4,14,10,0,2,-1,-1,
                       -1,-1,-1,-1,-1,2,0,1,6,
                       8,11,-1,-1,-1,-1,1,0,7,
                       -1,-1,2,-1,-1,-1,6,7,0 };
void enqueue(int v) {
    linklist node = (linklist)malloc(sizeof(queue));
    node->data = v;
    node->next = NULL;
    if (!front) {
        front = rear = node;
    }
    else {
        rear->next = node;
        rear = node;
    }
}
int dequeue() {
    if (!front) {
        return -1;
    }
    linklist tmp = front;
    int v = front->data;
    front = front->next;
    if (!front) {
        rear = NULL;
    }
    free(tmp);
    return v;
}
bool isEmpty() {
    return front == NULL;
}
void DJSTRA(int v,int search) {
    enqueue(v);
    dist_list[v] = map_frame[v][v];
    forward_point_list[v] = v;
    while (isEmpty() == false) {
        v = dequeue();
        for (int i = 0; i < 9; i++) {
            if (map_frame[v][i] > 0) {
                if (dist_list[i] > dist_list[v] + map_frame[v][i]) {
                    dist_list[i] = dist_list[v] + map_frame[v][i];
                    forward_point_list[i] = v;
                    enqueue(i);
                }
            }
        }
    }
    for (int j = 0; j < 9; j++) {
        printf("%f\n", dist_list[j]);
    }
    while (search != 0) {
        printf("点%d由",search);
        search = forward_point_list[search];
        printf("%d而来\n",search);        
    }
 }
int main() {
    for (int j = 0; j < 9; j++) {
        dist_list[j] = 100.0;
    }
    DJSTRA(0,4);
    return 0;
}

相关推荐
xindafu2 分钟前
代码随想录算法训练营第四十五天|动态规划part12
算法·动态规划
freexyn1 小时前
Matlab自学笔记六十一:快速上手解方程
数据结构·笔记·matlab
ysa0510301 小时前
Dijkstra 算法#图论
数据结构·算法·图论
一定要AK1 小时前
2025—暑期训练一
算法
一定要AK1 小时前
贪心专题练习
算法
森焱森2 小时前
无人机三轴稳定控制(2)____根据目标俯仰角,实现俯仰稳定化控制,计算出升降舵输出
c语言·单片机·算法·架构·无人机
ytttr8733 小时前
matlab通过Q学习算法解决房间路径规划问题
学习·算法·matlab
小张成长计划..3 小时前
数据结构-栈的实现
开发语言·数据结构
go54631584654 小时前
修改Spatial-MLLM项目,使其专注于无人机航拍视频的空间理解
人工智能·算法·机器学习·架构·音视频·无人机
油泼辣子多加4 小时前
【Torch】nn.BatchNorm1d算法详解
算法