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
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
|
/* Copyright (c) 2000 Justin Heyes Jones
*
* Permission is hereby granted, free of charge, to any person
* obtaining a copy of this software and associated documentation
* files (the "Software"), to deal in the Software without
* restriction, including without limitation the rights to use,
* copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the
* Software is furnished to do so, subject to the following
* conditions:
*
* The above copyright notice and this permission notice shall be
* included in all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
* OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
* HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
* WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
* OTHER DEALINGS IN THE SOFTWARE.
*/
/*
* pqueue.h - header file for the priority queue implementation.
*
* Originally written by Justin-Heyes Jones
* Modified by Shlomi Fish, 2000
*
* This file is available under either the MIT/Expat license (see above)
* or the public domain.
*
* Check out Justin-Heyes Jones' A* page from which this code has
* originated:
*
* http://www.heyes-jones.com/astar.html
*/
#pragma once
#ifdef __cplusplus
extern "C" {
#endif
#include "state.h"
#define FC_SOLVE_PQUEUE_MaxRating INT_MAX
typedef int pq_rating;
typedef struct
{
fcs_collectible_state *val;
pq_rating rating;
} pq_element;
static inline pq_rating fcs_pq_rating(const pq_element elem)
{
return elem.rating;
}
typedef struct
{
size_t max_size;
size_t current_size;
pq_element *elems; /* pointer to void pointers */
} pri_queue;
/* given an index to any element in a binary tree stored in a linear array with
the root at 1 and
a "sentinel" value at 0 these macros are useful in making the code clearer */
/* the parent is always given by index/2 */
#define PQ_PARENT_INDEX(i) ((i) >> 1)
#define PQ_FIRST_ENTRY (1)
/* left and right children are index * 2 and (index * 2) +1 respectively */
#define PQ_LEFT_CHILD_INDEX(i) ((i) << 1)
/* initialise the priority queue with a maximum size of maxelements.
maxrating is the highest or lowest value of an entry in the pqueue
depending on whether it is ascending or descending respectively. Finally
the bool32 tells you whether the list is sorted ascending or
descending... */
static inline void fc_solve_pq_init(pri_queue *const pq)
{
pq->current_size = 0;
pq->elems = SMALLOC(pq->elems, (pq->max_size = 1024) + 1);
}
static inline void fc_solve_PQueueFree(pri_queue *const pq)
{
free(pq->elems);
pq->elems = NULL;
}
/* Join a priority queue
"r" is the rating of the item you're adding for sorting purposes */
static inline void fc_solve_pq_push(
pri_queue *const pq, fcs_collectible_state *const val, const pq_rating r)
{
var_AUTO(i, ++(pq->current_size));
if (i > pq->max_size)
{
pq->elems = SREALLOC(pq->elems, (pq->max_size += 256) + 1);
}
const_SLOT(elems, pq);
/* set i to the first unused element and increment current_size */
/* while the parent of the space we're putting the new node into is
worse than
our new node, swap the space with the worse node. We keep doing that
until we
get to a worse node or until we get to the top
note that we also can sort so that the minimum elements bubble up so
we need to loops
with the comparison operator flipped... */
while (
(i == PQ_FIRST_ENTRY ? (FC_SOLVE_PQUEUE_MaxRating) /* return biggest
possible rating if
first element */
: (fcs_pq_rating(elems[PQ_PARENT_INDEX(i)]))) < r)
{
elems[i] = elems[PQ_PARENT_INDEX(i)];
i = PQ_PARENT_INDEX(i);
}
/* then add the element at the space we created. */
elems[i].val = val;
elems[i].rating = r;
}
static inline bool fc_solve_is_pqueue_empty(pri_queue *pq)
{
return (pq->current_size == 0);
}
/* remove the first node from the pqueue and provide a pointer to it
*
* Returns 0 if found.
* Returns 1 if not found.
*
* */
static inline void fc_solve_pq_pop(
pri_queue *const pq, fcs_collectible_state **const val)
{
if (fc_solve_is_pqueue_empty(pq))
{
*val = NULL;
return;
}
const_SLOT(elems, pq);
const_SLOT(current_size, pq);
*val = elems[PQ_FIRST_ENTRY].val;
/* get pointer to last element in tree */
const_AUTO(last_elem, elems[current_size]);
const_AUTO(new_current_size, current_size - 1);
/* code to pop an element from an ascending (top to bottom) pqueue */
/* UNTESTED */
size_t i;
size_t child;
for (i = PQ_FIRST_ENTRY;
(child = PQ_LEFT_CHILD_INDEX(i)) <= new_current_size; i = child)
{
/* set child to the smaller of the two children... */
if ((child != new_current_size) &&
(fcs_pq_rating(elems[child + 1]) > fcs_pq_rating(elems[child])))
{
child++;
}
if (fcs_pq_rating(last_elem) < fcs_pq_rating(elems[child]))
{
elems[i] = elems[child];
}
else
{
break;
}
}
elems[i] = last_elem;
pq->current_size = new_current_size;
}
#ifdef __cplusplus
}
#endif
|
