1*2139Sjp161948 /* crypto/pqueue/pqueue.c */
2*2139Sjp161948 /*
3*2139Sjp161948 * DTLS implementation written by Nagendra Modadugu
4*2139Sjp161948 * (nagendra@cs.stanford.edu) for the OpenSSL project 2005.
5*2139Sjp161948 */
6*2139Sjp161948 /* ====================================================================
7*2139Sjp161948 * Copyright (c) 1999-2005 The OpenSSL Project. All rights reserved.
8*2139Sjp161948 *
9*2139Sjp161948 * Redistribution and use in source and binary forms, with or without
10*2139Sjp161948 * modification, are permitted provided that the following conditions
11*2139Sjp161948 * are met:
12*2139Sjp161948 *
13*2139Sjp161948 * 1. Redistributions of source code must retain the above copyright
14*2139Sjp161948 * notice, this list of conditions and the following disclaimer.
15*2139Sjp161948 *
16*2139Sjp161948 * 2. Redistributions in binary form must reproduce the above copyright
17*2139Sjp161948 * notice, this list of conditions and the following disclaimer in
18*2139Sjp161948 * the documentation and/or other materials provided with the
19*2139Sjp161948 * distribution.
20*2139Sjp161948 *
21*2139Sjp161948 * 3. All advertising materials mentioning features or use of this
22*2139Sjp161948 * software must display the following acknowledgment:
23*2139Sjp161948 * "This product includes software developed by the OpenSSL Project
24*2139Sjp161948 * for use in the OpenSSL Toolkit. (http://www.OpenSSL.org/)"
25*2139Sjp161948 *
26*2139Sjp161948 * 4. The names "OpenSSL Toolkit" and "OpenSSL Project" must not be used to
27*2139Sjp161948 * endorse or promote products derived from this software without
28*2139Sjp161948 * prior written permission. For written permission, please contact
29*2139Sjp161948 * openssl-core@OpenSSL.org.
30*2139Sjp161948 *
31*2139Sjp161948 * 5. Products derived from this software may not be called "OpenSSL"
32*2139Sjp161948 * nor may "OpenSSL" appear in their names without prior written
33*2139Sjp161948 * permission of the OpenSSL Project.
34*2139Sjp161948 *
35*2139Sjp161948 * 6. Redistributions of any form whatsoever must retain the following
36*2139Sjp161948 * acknowledgment:
37*2139Sjp161948 * "This product includes software developed by the OpenSSL Project
38*2139Sjp161948 * for use in the OpenSSL Toolkit (http://www.OpenSSL.org/)"
39*2139Sjp161948 *
40*2139Sjp161948 * THIS SOFTWARE IS PROVIDED BY THE OpenSSL PROJECT ``AS IS'' AND ANY
41*2139Sjp161948 * EXPRESSED OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
42*2139Sjp161948 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
43*2139Sjp161948 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE OpenSSL PROJECT OR
44*2139Sjp161948 * ITS CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
45*2139Sjp161948 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
46*2139Sjp161948 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
47*2139Sjp161948 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
48*2139Sjp161948 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
49*2139Sjp161948 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
50*2139Sjp161948 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
51*2139Sjp161948 * OF THE POSSIBILITY OF SUCH DAMAGE.
52*2139Sjp161948 * ====================================================================
53*2139Sjp161948 *
54*2139Sjp161948 * This product includes cryptographic software written by Eric Young
55*2139Sjp161948 * (eay@cryptsoft.com). This product includes software written by Tim
56*2139Sjp161948 * Hudson (tjh@cryptsoft.com).
57*2139Sjp161948 *
58*2139Sjp161948 */
59*2139Sjp161948
60*2139Sjp161948 #include "cryptlib.h"
61*2139Sjp161948 #include <openssl/bn.h>
62*2139Sjp161948 #include "pqueue.h"
63*2139Sjp161948
64*2139Sjp161948 typedef struct _pqueue
65*2139Sjp161948 {
66*2139Sjp161948 pitem *items;
67*2139Sjp161948 int count;
68*2139Sjp161948 } pqueue_s;
69*2139Sjp161948
70*2139Sjp161948 pitem *
pitem_new(PQ_64BIT priority,void * data)71*2139Sjp161948 pitem_new(PQ_64BIT priority, void *data)
72*2139Sjp161948 {
73*2139Sjp161948 pitem *item = (pitem *) OPENSSL_malloc(sizeof(pitem));
74*2139Sjp161948 if (item == NULL) return NULL;
75*2139Sjp161948
76*2139Sjp161948 pq_64bit_init(&(item->priority));
77*2139Sjp161948 pq_64bit_assign(&item->priority, &priority);
78*2139Sjp161948
79*2139Sjp161948 item->data = data;
80*2139Sjp161948 item->next = NULL;
81*2139Sjp161948
82*2139Sjp161948 return item;
83*2139Sjp161948 }
84*2139Sjp161948
85*2139Sjp161948 void
pitem_free(pitem * item)86*2139Sjp161948 pitem_free(pitem *item)
87*2139Sjp161948 {
88*2139Sjp161948 if (item == NULL) return;
89*2139Sjp161948
90*2139Sjp161948 pq_64bit_free(&(item->priority));
91*2139Sjp161948 OPENSSL_free(item);
92*2139Sjp161948 }
93*2139Sjp161948
94*2139Sjp161948 pqueue_s *
pqueue_new()95*2139Sjp161948 pqueue_new()
96*2139Sjp161948 {
97*2139Sjp161948 pqueue_s *pq = (pqueue_s *) OPENSSL_malloc(sizeof(pqueue_s));
98*2139Sjp161948 if (pq == NULL) return NULL;
99*2139Sjp161948
100*2139Sjp161948 memset(pq, 0x00, sizeof(pqueue_s));
101*2139Sjp161948 return pq;
102*2139Sjp161948 }
103*2139Sjp161948
104*2139Sjp161948 void
pqueue_free(pqueue_s * pq)105*2139Sjp161948 pqueue_free(pqueue_s *pq)
106*2139Sjp161948 {
107*2139Sjp161948 if (pq == NULL) return;
108*2139Sjp161948
109*2139Sjp161948 OPENSSL_free(pq);
110*2139Sjp161948 }
111*2139Sjp161948
112*2139Sjp161948 pitem *
pqueue_insert(pqueue_s * pq,pitem * item)113*2139Sjp161948 pqueue_insert(pqueue_s *pq, pitem *item)
114*2139Sjp161948 {
115*2139Sjp161948 pitem *curr, *next;
116*2139Sjp161948
117*2139Sjp161948 if (pq->items == NULL)
118*2139Sjp161948 {
119*2139Sjp161948 pq->items = item;
120*2139Sjp161948 return item;
121*2139Sjp161948 }
122*2139Sjp161948
123*2139Sjp161948 for(curr = NULL, next = pq->items;
124*2139Sjp161948 next != NULL;
125*2139Sjp161948 curr = next, next = next->next)
126*2139Sjp161948 {
127*2139Sjp161948 if (pq_64bit_gt(&(next->priority), &(item->priority)))
128*2139Sjp161948 {
129*2139Sjp161948 item->next = next;
130*2139Sjp161948
131*2139Sjp161948 if (curr == NULL)
132*2139Sjp161948 pq->items = item;
133*2139Sjp161948 else
134*2139Sjp161948 curr->next = item;
135*2139Sjp161948
136*2139Sjp161948 return item;
137*2139Sjp161948 }
138*2139Sjp161948 /* duplicates not allowed */
139*2139Sjp161948 if (pq_64bit_eq(&(item->priority), &(next->priority)))
140*2139Sjp161948 return NULL;
141*2139Sjp161948 }
142*2139Sjp161948
143*2139Sjp161948 item->next = NULL;
144*2139Sjp161948 curr->next = item;
145*2139Sjp161948
146*2139Sjp161948 return item;
147*2139Sjp161948 }
148*2139Sjp161948
149*2139Sjp161948 pitem *
pqueue_peek(pqueue_s * pq)150*2139Sjp161948 pqueue_peek(pqueue_s *pq)
151*2139Sjp161948 {
152*2139Sjp161948 return pq->items;
153*2139Sjp161948 }
154*2139Sjp161948
155*2139Sjp161948 pitem *
pqueue_pop(pqueue_s * pq)156*2139Sjp161948 pqueue_pop(pqueue_s *pq)
157*2139Sjp161948 {
158*2139Sjp161948 pitem *item = pq->items;
159*2139Sjp161948
160*2139Sjp161948 if (pq->items != NULL)
161*2139Sjp161948 pq->items = pq->items->next;
162*2139Sjp161948
163*2139Sjp161948 return item;
164*2139Sjp161948 }
165*2139Sjp161948
166*2139Sjp161948 pitem *
pqueue_find(pqueue_s * pq,PQ_64BIT priority)167*2139Sjp161948 pqueue_find(pqueue_s *pq, PQ_64BIT priority)
168*2139Sjp161948 {
169*2139Sjp161948 pitem *next, *prev = NULL;
170*2139Sjp161948 pitem *found = NULL;
171*2139Sjp161948
172*2139Sjp161948 if ( pq->items == NULL)
173*2139Sjp161948 return NULL;
174*2139Sjp161948
175*2139Sjp161948 for ( next = pq->items; next->next != NULL;
176*2139Sjp161948 prev = next, next = next->next)
177*2139Sjp161948 {
178*2139Sjp161948 if ( pq_64bit_eq(&(next->priority), &priority))
179*2139Sjp161948 {
180*2139Sjp161948 found = next;
181*2139Sjp161948 break;
182*2139Sjp161948 }
183*2139Sjp161948 }
184*2139Sjp161948
185*2139Sjp161948 /* check the one last node */
186*2139Sjp161948 if ( pq_64bit_eq(&(next->priority), &priority))
187*2139Sjp161948 found = next;
188*2139Sjp161948
189*2139Sjp161948 if ( ! found)
190*2139Sjp161948 return NULL;
191*2139Sjp161948
192*2139Sjp161948 #if 0 /* find works in peek mode */
193*2139Sjp161948 if ( prev == NULL)
194*2139Sjp161948 pq->items = next->next;
195*2139Sjp161948 else
196*2139Sjp161948 prev->next = next->next;
197*2139Sjp161948 #endif
198*2139Sjp161948
199*2139Sjp161948 return found;
200*2139Sjp161948 }
201*2139Sjp161948
202*2139Sjp161948 #if PQ_64BIT_IS_INTEGER
203*2139Sjp161948 void
pqueue_print(pqueue_s * pq)204*2139Sjp161948 pqueue_print(pqueue_s *pq)
205*2139Sjp161948 {
206*2139Sjp161948 pitem *item = pq->items;
207*2139Sjp161948
208*2139Sjp161948 while(item != NULL)
209*2139Sjp161948 {
210*2139Sjp161948 printf("item\t" PQ_64BIT_PRINT "\n", item->priority);
211*2139Sjp161948 item = item->next;
212*2139Sjp161948 }
213*2139Sjp161948 }
214*2139Sjp161948 #endif
215*2139Sjp161948
216*2139Sjp161948 pitem *
pqueue_iterator(pqueue_s * pq)217*2139Sjp161948 pqueue_iterator(pqueue_s *pq)
218*2139Sjp161948 {
219*2139Sjp161948 return pqueue_peek(pq);
220*2139Sjp161948 }
221*2139Sjp161948
222*2139Sjp161948 pitem *
pqueue_next(pitem ** item)223*2139Sjp161948 pqueue_next(pitem **item)
224*2139Sjp161948 {
225*2139Sjp161948 pitem *ret;
226*2139Sjp161948
227*2139Sjp161948 if ( item == NULL || *item == NULL)
228*2139Sjp161948 return NULL;
229*2139Sjp161948
230*2139Sjp161948
231*2139Sjp161948 /* *item != NULL */
232*2139Sjp161948 ret = *item;
233*2139Sjp161948 *item = (*item)->next;
234*2139Sjp161948
235*2139Sjp161948 return ret;
236*2139Sjp161948 }
237