Quelle  ptr_ring.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
#define _GNU_SOURCE
#include "main.h"
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <pthread.h>
#include <malloc.h>
#include <assert.h>
#include <errno.h>
#include <limits.h>

#define SMP_CACHE_BYTES 64
#define cache_line_size() SMP_CACHE_BYTES
#define ____cacheline_aligned_in_smp __attribute__ ((aligned (SMP_CACHE_BYTES)))
#define unlikely(x)    (__builtin_expect(!!(x), 0))
#define likely(x)    (__builtin_expect(!!(x), 1))
#define ALIGN(x, a) (((x) + (a) - 1) / (a) * (a))
#define SIZE_MAX        (~(size_t)0)
#define KMALLOC_MAX_SIZE SIZE_MAX

typedef pthread_spinlock_t  spinlock_t;

typedef int gfp_t;
#define __GFP_ZERO 0x1

static void *kmalloc(unsigned size, gfp_t gfp)
{
 void *p = memalign(64, size);
 if (!p)
  return p;

 if (gfp & __GFP_ZERO)
  memset(p, 0, size);
 return p;
}

static inline void *kzalloc(unsigned size, gfp_t flags)
{
 return kmalloc(size, flags | __GFP_ZERO);
}

static inline void *kmalloc_array(size_t n, size_t size, gfp_t flags)
{
 if (size != 0 && n > SIZE_MAX / size)
  return NULL;
 return kmalloc(n * size, flags);
}

static inline void *kcalloc(size_t n, size_t size, gfp_t flags)
{
 return kmalloc_array(n, size, flags | __GFP_ZERO);
}

static void kfree(void *p)
{
 if (p)
  free(p);
}

#define kvmalloc_array kmalloc_array
#define kvfree kfree

static void spin_lock_init(spinlock_t *lock)
{
 int r = pthread_spin_init(lock, 0);
 assert(!r);
}

static void spin_lock(spinlock_t *lock)
{
 int ret = pthread_spin_lock(lock);
 assert(!ret);
}

static void spin_unlock(spinlock_t *lock)
{
 int ret = pthread_spin_unlock(lock);
 assert(!ret);
}

static void spin_lock_bh(spinlock_t *lock)
{
 spin_lock(lock);
}

static void spin_unlock_bh(spinlock_t *lock)
{
 spin_unlock(lock);
}

static void spin_lock_irq(spinlock_t *lock)
{
 spin_lock(lock);
}

static void spin_unlock_irq(spinlock_t *lock)
{
 spin_unlock(lock);
}

static void spin_lock_irqsave(spinlock_t *lock, unsigned long f)
{
 spin_lock(lock);
}

static void spin_unlock_irqrestore(spinlock_t *lock, unsigned long f)
{
 spin_unlock(lock);
}

#include "../../../include/linux/ptr_ring.h"

static unsigned long long headcnt, tailcnt;
static struct ptr_ring array ____cacheline_aligned_in_smp;

/* implemented by ring */
void alloc_ring(void)
{
 int ret = ptr_ring_init(&array, ring_size, 0);
 assert(!ret);
 /* Hacky way to poke at ring internals. Useful for testing though. */
 if (param)
  array.batch = param;
}

/* guest side */
int add_inbuf(unsigned len, void *buf, void *datap)
{
 int ret;

 ret = __ptr_ring_produce(&array, buf);
 if (ret >= 0) {
  ret = 0;
  headcnt++;
 }

 return ret;
}

/*
 * ptr_ring API provides no way for producer to find out whether a given
 * buffer was consumed.  Our tests merely require that a successful get_buf
 * implies that add_inbuf succeed in the past, and that add_inbuf will succeed,
 * fake it accordingly.
 */
void *get_buf(unsigned *lenp, void **bufp)
{
 void *datap;

 if (tailcnt == headcnt || __ptr_ring_full(&array))
  datap = NULL;
 else {
  datap = "Buffer\n";
  ++tailcnt;
 }

 return datap;
}

bool used_empty()
{
 return (tailcnt == headcnt || __ptr_ring_full(&array));
}

void disable_call()
{
 assert(0);
}

bool enable_call()
{
 assert(0);
}

void kick_available(void)
{
 assert(0);
}

/* host side */
void disable_kick()
{
 assert(0);
}

bool enable_kick()
{
 assert(0);
}

bool avail_empty()
{
 return __ptr_ring_empty(&array);
}

bool use_buf(unsigned *lenp, void **bufp)
{
 void *ptr;

 ptr = __ptr_ring_consume(&array);

 return ptr;
}

void call_used(void)
{
 assert(0);
}