diff options
Diffstat (limited to 'src/sys/np')
-rw-r--r-- | src/sys/np/core/np_piir.c | 99 |
1 files changed, 99 insertions, 0 deletions
diff --git a/src/sys/np/core/np_piir.c b/src/sys/np/core/np_piir.c new file mode 100644 index 0000000..e139465 --- /dev/null +++ b/src/sys/np/core/np_piir.c @@ -0,0 +1,99 @@ +/* + * Copyright (c) 2025 Ian Marco Moffett and L5 engineers + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of the project nor the names of its + * contributors may be used to endorse or promote products derived from + * this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#include <sys/types.h> +#include <sys/errno.h> +#include <os/np.h> +#include <np/piir.h> +#include <lib/ptrbox.h> +#include <string.h> + +/* + * Allocate a new stack + */ +int +piir_stack_new(struct np_work *work, struct piir_stack **resp) +{ + struct piir_stack *stack; + + if (work == NULL || resp == NULL) { + return -EINVAL; + } + + stack = ptrbox_alloc(sizeof(*stack), work->work_mem); + if (stack == NULL) { + return -ENOMEM; + } + + memset(stack, 0, sizeof(*stack)); + *resp = stack; + return 0; +} + +/* + * Push to the PIIR stack + */ +int +piir_push(struct piir_stack *stack, ir_byte_t byte) +{ + if (stack == NULL) { + return -EINVAL; + } + + if (stack->op_i >= PIIR_STACK_SIZE - 1) { + return -1; + } + + spinlock_acquire(&stack->lock); + stack->opstore[stack->op_i++] = byte; + spinlock_release(&stack->lock); + return 0; +} + +/* + * Pop from the PIIR stack + */ +int +piir_pop(struct piir_stack *stack) +{ + ir_byte_t byte; + + if (stack == NULL) { + return -EINVAL; + } + + if (stack->op_i == 0) { + return -1; + } + + spinlock_acquire(&stack->lock); + byte = stack->opstore[--stack->op_i]; + spinlock_release(&stack->lock); + return byte; +} |