mirror of
https://gitea.osmocom.org/sim-card/simtrace2.git
synced 2026-03-16 21:28:33 +03:00
7abdb51f8f
We have to temporarily disable nterrupts when performing rinbuffer operations, as the ring buffer is used both from IRQ as well as process context.
71 lines
1.2 KiB
C
71 lines
1.2 KiB
C
#include "ringbuffer.h"
|
|
#include "trace.h"
|
|
#include "utils.h"
|
|
|
|
void rbuf_reset(volatile ringbuf * rb)
|
|
{
|
|
unsigned long state;
|
|
|
|
local_irq_save(state);
|
|
rb->ird = 0;
|
|
rb->iwr = 0;
|
|
local_irq_restore(state);
|
|
}
|
|
|
|
uint8_t rbuf_read(volatile ringbuf * rb)
|
|
{
|
|
unsigned long state;
|
|
uint8_t val;
|
|
|
|
local_irq_save(state);
|
|
val = rb->buf[rb->ird];
|
|
rb->ird = (rb->ird + 1) % RING_BUFLEN;
|
|
local_irq_restore(state);
|
|
|
|
return val;
|
|
}
|
|
|
|
uint8_t rbuf_peek(volatile ringbuf * rb)
|
|
{
|
|
return rb->buf[rb->ird];
|
|
}
|
|
|
|
bool rbuf_is_empty(volatile ringbuf * rb)
|
|
{
|
|
return rb->ird == rb->iwr;
|
|
}
|
|
|
|
static bool __rbuf_is_full(volatile ringbuf * rb)
|
|
{
|
|
return rb->ird == (rb->iwr + 1) % RING_BUFLEN;
|
|
}
|
|
|
|
bool rbuf_is_full(volatile ringbuf * rb)
|
|
{
|
|
unsigned long state;
|
|
bool rc;
|
|
|
|
local_irq_save(state);
|
|
rc = rb->ird == (rb->iwr + 1) % RING_BUFLEN;
|
|
local_irq_restore(state);
|
|
|
|
return rc;
|
|
}
|
|
|
|
void rbuf_write(volatile volatile ringbuf * rb, uint8_t item)
|
|
{
|
|
unsigned long state;
|
|
|
|
local_irq_save(state);
|
|
if (!__rbuf_is_full(rb)) {
|
|
rb->buf[rb->iwr] = item;
|
|
rb->iwr = (rb->iwr + 1) % RING_BUFLEN;
|
|
local_irq_restore(state);
|
|
} else {
|
|
local_irq_restore(state);
|
|
TRACE_ERROR("Ringbuffer full, losing bytes!");
|
|
}
|
|
}
|
|
|
|
|