85 lines
		
	
	
		
			1.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			85 lines
		
	
	
		
			1.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
// SPDX-License-Identifier: GPL-2.0
 | 
						|
/*
 | 
						|
 * Simple pointer stack
 | 
						|
 *
 | 
						|
 * (c) 2010 Arnaldo Carvalho de Melo <acme@redhat.com>
 | 
						|
 */
 | 
						|
 | 
						|
#include "util.h"
 | 
						|
#include "pstack.h"
 | 
						|
#include "debug.h"
 | 
						|
#include <linux/kernel.h>
 | 
						|
#include <stdlib.h>
 | 
						|
 | 
						|
struct pstack {
 | 
						|
	unsigned short	top;
 | 
						|
	unsigned short	max_nr_entries;
 | 
						|
	void		*entries[0];
 | 
						|
};
 | 
						|
 | 
						|
struct pstack *pstack__new(unsigned short max_nr_entries)
 | 
						|
{
 | 
						|
	struct pstack *pstack = zalloc((sizeof(*pstack) +
 | 
						|
				       max_nr_entries * sizeof(void *)));
 | 
						|
	if (pstack != NULL)
 | 
						|
		pstack->max_nr_entries = max_nr_entries;
 | 
						|
	return pstack;
 | 
						|
}
 | 
						|
 | 
						|
void pstack__delete(struct pstack *pstack)
 | 
						|
{
 | 
						|
	free(pstack);
 | 
						|
}
 | 
						|
 | 
						|
bool pstack__empty(const struct pstack *pstack)
 | 
						|
{
 | 
						|
	return pstack->top == 0;
 | 
						|
}
 | 
						|
 | 
						|
void pstack__remove(struct pstack *pstack, void *key)
 | 
						|
{
 | 
						|
	unsigned short i = pstack->top, last_index = pstack->top - 1;
 | 
						|
 | 
						|
	while (i-- != 0) {
 | 
						|
		if (pstack->entries[i] == key) {
 | 
						|
			if (i < last_index)
 | 
						|
				memmove(pstack->entries + i,
 | 
						|
					pstack->entries + i + 1,
 | 
						|
					(last_index - i) * sizeof(void *));
 | 
						|
			--pstack->top;
 | 
						|
			return;
 | 
						|
		}
 | 
						|
	}
 | 
						|
	pr_err("%s: %p not on the pstack!\n", __func__, key);
 | 
						|
}
 | 
						|
 | 
						|
void pstack__push(struct pstack *pstack, void *key)
 | 
						|
{
 | 
						|
	if (pstack->top == pstack->max_nr_entries) {
 | 
						|
		pr_err("%s: top=%d, overflow!\n", __func__, pstack->top);
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	pstack->entries[pstack->top++] = key;
 | 
						|
}
 | 
						|
 | 
						|
void *pstack__pop(struct pstack *pstack)
 | 
						|
{
 | 
						|
	void *ret;
 | 
						|
 | 
						|
	if (pstack->top == 0) {
 | 
						|
		pr_err("%s: underflow!\n", __func__);
 | 
						|
		return NULL;
 | 
						|
	}
 | 
						|
 | 
						|
	ret = pstack->entries[--pstack->top];
 | 
						|
	pstack->entries[pstack->top] = NULL;
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
void *pstack__peek(struct pstack *pstack)
 | 
						|
{
 | 
						|
	if (pstack->top == 0)
 | 
						|
		return NULL;
 | 
						|
	return pstack->entries[pstack->top - 1];
 | 
						|
}
 |