blob: daa17aeb6c634726381b9617f3b1b003dbc7ef21 [file] [log] [blame]
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -03001/*
2 * Simple pointer stack
3 *
4 * (c) 2010 Arnaldo Carvalho de Melo <acme@redhat.com>
5 */
6
7#include "util.h"
8#include "pstack.h"
9#include <linux/kernel.h>
10#include <stdlib.h>
11
12struct pstack {
13 unsigned short top;
14 unsigned short max_nr_entries;
15 void *entries[0];
16};
17
18struct pstack *pstack__new(unsigned short max_nr_entries)
19{
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030020 struct pstack *pstack = zalloc((sizeof(*pstack) +
21 max_nr_entries * sizeof(void *)));
22 if (pstack != NULL)
23 pstack->max_nr_entries = max_nr_entries;
24 return pstack;
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030025}
26
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030027void pstack__delete(struct pstack *pstack)
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030028{
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030029 free(pstack);
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030030}
31
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030032bool pstack__empty(const struct pstack *pstack)
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030033{
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030034 return pstack->top == 0;
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030035}
36
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030037void pstack__remove(struct pstack *pstack, void *key)
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030038{
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030039 unsigned short i = pstack->top, last_index = pstack->top - 1;
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030040
41 while (i-- != 0) {
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030042 if (pstack->entries[i] == key) {
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030043 if (i < last_index)
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030044 memmove(pstack->entries + i,
45 pstack->entries + i + 1,
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030046 (last_index - i) * sizeof(void *));
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030047 --pstack->top;
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030048 return;
49 }
50 }
51 pr_err("%s: %p not on the pstack!\n", __func__, key);
52}
53
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030054void pstack__push(struct pstack *pstack, void *key)
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030055{
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030056 if (pstack->top == pstack->max_nr_entries) {
57 pr_err("%s: top=%d, overflow!\n", __func__, pstack->top);
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030058 return;
59 }
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030060 pstack->entries[pstack->top++] = key;
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030061}
62
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030063void *pstack__pop(struct pstack *pstack)
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030064{
65 void *ret;
66
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030067 if (pstack->top == 0) {
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030068 pr_err("%s: underflow!\n", __func__);
69 return NULL;
70 }
71
Arnaldo Carvalho de Melo61e94512012-11-10 19:41:15 -030072 ret = pstack->entries[--pstack->top];
73 pstack->entries[pstack->top] = NULL;
Arnaldo Carvalho de Melo3e1bbdc32010-05-14 20:05:21 -030074 return ret;
75}