162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Simple pointer stack 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * (c) 2010 Arnaldo Carvalho de Melo <acme@redhat.com> 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include "pstack.h" 962306a36Sopenharmony_ci#include "debug.h" 1062306a36Sopenharmony_ci#include <linux/kernel.h> 1162306a36Sopenharmony_ci#include <linux/zalloc.h> 1262306a36Sopenharmony_ci#include <stdlib.h> 1362306a36Sopenharmony_ci#include <string.h> 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_cistruct pstack { 1662306a36Sopenharmony_ci unsigned short top; 1762306a36Sopenharmony_ci unsigned short max_nr_entries; 1862306a36Sopenharmony_ci void *entries[]; 1962306a36Sopenharmony_ci}; 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_cistruct pstack *pstack__new(unsigned short max_nr_entries) 2262306a36Sopenharmony_ci{ 2362306a36Sopenharmony_ci struct pstack *pstack = zalloc((sizeof(*pstack) + 2462306a36Sopenharmony_ci max_nr_entries * sizeof(void *))); 2562306a36Sopenharmony_ci if (pstack != NULL) 2662306a36Sopenharmony_ci pstack->max_nr_entries = max_nr_entries; 2762306a36Sopenharmony_ci return pstack; 2862306a36Sopenharmony_ci} 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_civoid pstack__delete(struct pstack *pstack) 3162306a36Sopenharmony_ci{ 3262306a36Sopenharmony_ci free(pstack); 3362306a36Sopenharmony_ci} 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_cibool pstack__empty(const struct pstack *pstack) 3662306a36Sopenharmony_ci{ 3762306a36Sopenharmony_ci return pstack->top == 0; 3862306a36Sopenharmony_ci} 3962306a36Sopenharmony_ci 4062306a36Sopenharmony_civoid pstack__remove(struct pstack *pstack, void *key) 4162306a36Sopenharmony_ci{ 4262306a36Sopenharmony_ci unsigned short i = pstack->top, last_index = pstack->top - 1; 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci while (i-- != 0) { 4562306a36Sopenharmony_ci if (pstack->entries[i] == key) { 4662306a36Sopenharmony_ci if (i < last_index) 4762306a36Sopenharmony_ci memmove(pstack->entries + i, 4862306a36Sopenharmony_ci pstack->entries + i + 1, 4962306a36Sopenharmony_ci (last_index - i) * sizeof(void *)); 5062306a36Sopenharmony_ci --pstack->top; 5162306a36Sopenharmony_ci return; 5262306a36Sopenharmony_ci } 5362306a36Sopenharmony_ci } 5462306a36Sopenharmony_ci pr_err("%s: %p not on the pstack!\n", __func__, key); 5562306a36Sopenharmony_ci} 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_civoid pstack__push(struct pstack *pstack, void *key) 5862306a36Sopenharmony_ci{ 5962306a36Sopenharmony_ci if (pstack->top == pstack->max_nr_entries) { 6062306a36Sopenharmony_ci pr_err("%s: top=%d, overflow!\n", __func__, pstack->top); 6162306a36Sopenharmony_ci return; 6262306a36Sopenharmony_ci } 6362306a36Sopenharmony_ci pstack->entries[pstack->top++] = key; 6462306a36Sopenharmony_ci} 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_civoid *pstack__pop(struct pstack *pstack) 6762306a36Sopenharmony_ci{ 6862306a36Sopenharmony_ci void *ret; 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci if (pstack->top == 0) { 7162306a36Sopenharmony_ci pr_err("%s: underflow!\n", __func__); 7262306a36Sopenharmony_ci return NULL; 7362306a36Sopenharmony_ci } 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_ci ret = pstack->entries[--pstack->top]; 7662306a36Sopenharmony_ci pstack->entries[pstack->top] = NULL; 7762306a36Sopenharmony_ci return ret; 7862306a36Sopenharmony_ci} 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_civoid *pstack__peek(struct pstack *pstack) 8162306a36Sopenharmony_ci{ 8262306a36Sopenharmony_ci if (pstack->top == 0) 8362306a36Sopenharmony_ci return NULL; 8462306a36Sopenharmony_ci return pstack->entries[pstack->top - 1]; 8562306a36Sopenharmony_ci} 86