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
|
#include <stdio.h>
#include <curses.h>
#include "priority_queue.h"
#include "error.h"
PositionPQ *ppq_new(Position pos, size_t priority) {
PositionPQ *ppq = malloc(sizeof(PositionPQ));
ppq->pos = pos;
ppq->priority = priority;
ppq->prev = NULL;
ppq->next = NULL;
return ppq;
}
/* FIXME: insted of `return n` introduce some defines with error codes,
* or an enum I don't care */
int ppq_insert(PositionPQ **ppq, Position pos, size_t priority) {
//printf("Inserting %zu %zu\n", pos.x, pos.y);
PositionPQ *start = *ppq;
if ((*ppq) == NULL) {
(*ppq) = ppq_new(pos, priority);
return 1;
}
PositionPQ *n = ppq_new(pos, priority);
if (start->priority > priority) {
n->next = start;
start = n;
return 2;
}
PositionPQ *temp = *ppq;
while(temp->next != NULL && temp->next->priority <= priority) {
if (temp->pos.x == pos.x && temp->pos.y == pos.y && temp->priority <= priority) {
return 3; /* pos is already in ppq with a fine priority */
}
temp = temp->next;
}
if (temp->pos.x == pos.x && temp->pos.y == pos.y && temp->priority <= priority) {
return 3; /* pos is already in ppq with a fine priority */
}
n->next = temp->next;
temp->next = n;
return 4;
}
Position ppq_pop(PositionPQ **ppq) {
if (*ppq == NULL) {
error("Tried to pop a NULL PositionPQ\n");
}
Position pos = (*ppq)->pos;
if ((*ppq)->next != NULL) { /* If there's a next node */
(*ppq)->next->prev = NULL;
PositionPQ *next = (*ppq)->next;
free((*ppq));
(*ppq) = next;
} else { /* No next node */
free((*ppq));
(*ppq) = NULL;
}
return pos;
}
void ppq_reprioritize(PositionPQ *ppq, Position pos, size_t priority) {
(void)ppq, (void)pos, (void)priority;
todo();
}
void ppq_print(PositionPQ *ppq) {
if (ppq == NULL) {
printf("ppq is NULL\n");
return;
}
int i = 0;
while (ppq->next != NULL) {
printf("%i - %li: %li, %li\n", i++, ppq->priority, ppq->pos.x, ppq->pos.y);
ppq = ppq->next;
}
printf("%i - %li: %li, %li\n", i++, ppq->priority, ppq->pos.x, ppq->pos.y);
}
|
