Good day and welcome to the FIRM XMALLOC*() macros. These macros are provided for...
[libfirm] / ir / adt / pqueue.c
1 /*
2  * Copyright (C) 1995-2008 University of Karlsruhe.  All right reserved.
3  *
4  * This file is part of libFirm.
5  *
6  * This file may be distributed and/or modified under the terms of the
7  * GNU General Public License version 2 as published by the Free Software
8  * Foundation and appearing in the file LICENSE.GPL included in the
9  * packaging of this file.
10  *
11  * Licensees holding valid libFirm Professional Edition licenses may use
12  * this file in accordance with the libFirm Commercial License.
13  * Agreement provided with the Software.
14  *
15  * This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
16  * WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR
17  * PURPOSE.
18  */
19
20 /**
21  * @file
22  * @author  Christian Wuerdig, Matthias Braun
23  * @brief   Priority Queue implementation based on the heap datastructure
24  * @version $Id$
25  */
26 #include "array.h"
27 #include "pqueue.h"
28
29 /*
30  * Implements a heap.
31  *
32  * Implementation note: It might seem strange that we start indexing at 0
33  * but use 2*i and 2*i+1 to find the left and right sucessor of an index.
34  * The trick is that for index 0 the left successor is 0 again, and the
35  * right successor is 1 in this scheme. For the right successor 1 everything
36  * works like usual. We simply took care in the algorithms that they still
37  * work with the left child of 0 being 0 again. This was possible without
38  * any extra ifs or arithmetic.
39  * Thus we can save the wastage of 1 array position you can see in other
40  * implementations or the ugly (i+1)*2 - 1 and (i+1)*2 for calculating the
41  * left and right child. (At the expense that stuff easily breaks when you make
42  * changes and don't think that the left child of 0 is 0 :-/)
43  *
44  */
45
46 typedef struct _pqueue_el_t {
47         void *data;
48         int  priority;
49 } pqueue_el_t;
50
51 struct _pqueue_t {
52         pqueue_el_t *elems;
53 };
54
55 /**
56  * Enforces the heap characteristics if the queue
57  * starting from element at position @p pos.
58  */
59 static void pqueue_heapify(pqueue_t *q, unsigned pos) {
60         unsigned len = ARR_LEN(q->elems);
61
62         while (pos * 2 < len) {
63                 pqueue_el_t tmp;
64                 unsigned    exchange = pos;
65
66                 if (q->elems[exchange].priority < q->elems[pos * 2].priority) {
67                         exchange = pos * 2;
68                 }
69
70                 if ((pos * 2 + 1) < len
71                                 && q->elems[exchange].priority < q->elems[pos * 2 + 1].priority) {
72                         exchange = pos * 2 + 1;
73                 }
74
75                 if (exchange == pos)
76                         break;
77
78                 tmp                = q->elems[pos];
79                 q->elems[pos]      = q->elems[exchange];
80                 q->elems[exchange] = tmp;
81
82                 pos = exchange;
83         }
84 }
85
86 /**
87  * Sifts up a newly inserted element at position @p pos.
88  */
89 static void pqueue_sift_up(pqueue_t *q, unsigned pos) {
90         while(q->elems[pos].priority > q->elems[pos / 2].priority) {
91                 pqueue_el_t tmp;
92
93                 tmp               = q->elems[pos];
94                 q->elems[pos]     = q->elems[pos / 2];
95                 q->elems[pos / 2] = tmp;
96
97                 pos /= 2;
98         }
99 }
100
101 pqueue_t *new_pqueue(void) {
102         pqueue_t *res = XMALLOC(pqueue_t);
103         res->elems = NEW_ARR_F(pqueue_el_t, 0);
104         return res;
105 }
106
107 void del_pqueue(pqueue_t *q) {
108         DEL_ARR_F(q->elems);
109         free(q);
110 }
111
112 void pqueue_put(pqueue_t *q, void *data, int priority) {
113         pqueue_el_t el;
114
115         el.data     = data;
116         el.priority = priority;
117
118         ARR_APP1(pqueue_el_t, q->elems, el);
119
120         pqueue_sift_up(q, ARR_LEN(q->elems) - 1);
121 }
122
123 void *pqueue_pop_front(pqueue_t *q) {
124         switch(ARR_LEN(q->elems)) {
125                 case 0:
126                         assert(0 && "Attempt to retrieve element from empty priority queue.");
127                         return NULL;
128                         break;
129                 case 1:
130                         ARR_SHRINKLEN(q->elems, 0);
131                         return q->elems[0].data;
132                         break;
133                 default: {
134                         void *data = q->elems[0].data;
135                         int  len   = ARR_LEN(q->elems) - 1;
136
137                         q->elems[0] = q->elems[len];
138                         ARR_SHRINKLEN(q->elems, len);
139                         pqueue_heapify(q, 0);
140
141                         return data;
142                 }
143         }
144 }
145
146 int pqueue_length(const pqueue_t *q) {
147         return ARR_LEN(q->elems);
148 }
149
150 int pqueue_empty(const pqueue_t *q) {
151         return ARR_LEN(q->elems) == 0;
152 }