99a2dd955f
There is no reason for the DPDK libraries to all have 'librte_' prefix on the directory names. This prefix makes the directory names longer and also makes it awkward to add features referring to individual libraries in the build - should the lib names be specified with or without the prefix. Therefore, we can just remove the library prefix and use the library's unique name as the directory name, i.e. 'eal' rather than 'librte_eal' Signed-off-by: Bruce Richardson <bruce.richardson@intel.com>
413 lines
8.1 KiB
C
413 lines
8.1 KiB
C
/* SPDX-License-Identifier: BSD-3-Clause
|
|
* Copyright(c) 2010-2014 Intel Corporation.
|
|
* Copyright (c) 2009, Olivier MATZ <zer0@droids-corp.org>
|
|
* All rights reserved.
|
|
*/
|
|
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <stdio.h>
|
|
|
|
#include "cmdline_cirbuf.h"
|
|
|
|
|
|
int
|
|
cirbuf_init(struct cirbuf *cbuf, char *buf, unsigned int start, unsigned int maxlen)
|
|
{
|
|
if (!cbuf || !buf)
|
|
return -EINVAL;
|
|
cbuf->maxlen = maxlen;
|
|
cbuf->len = 0;
|
|
cbuf->start = start;
|
|
cbuf->end = start;
|
|
cbuf->buf = buf;
|
|
return 0;
|
|
}
|
|
|
|
/* multiple add */
|
|
|
|
int
|
|
cirbuf_add_buf_head(struct cirbuf *cbuf, const char *c, unsigned int n)
|
|
{
|
|
unsigned int e;
|
|
|
|
if (!cbuf || !c || !n || n > CIRBUF_GET_FREELEN(cbuf))
|
|
return -EINVAL;
|
|
|
|
e = CIRBUF_IS_EMPTY(cbuf) ? 1 : 0;
|
|
|
|
if (n < cbuf->start + e) {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", 0, cbuf->start - n + e, n);
|
|
memcpy(cbuf->buf + cbuf->start - n + e, c, n);
|
|
}
|
|
else {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", + n - (cbuf->start + e), 0,
|
|
cbuf->start + e);
|
|
dprintf("s[%d] -> d[%d] (%d)\n", cbuf->maxlen - n +
|
|
(cbuf->start + e), 0, n - (cbuf->start + e));
|
|
memcpy(cbuf->buf, c + n - (cbuf->start + e) , cbuf->start + e);
|
|
memcpy(cbuf->buf + cbuf->maxlen - n + (cbuf->start + e), c,
|
|
n - (cbuf->start + e));
|
|
}
|
|
cbuf->len += n;
|
|
cbuf->start += (cbuf->maxlen - n + e);
|
|
cbuf->start %= cbuf->maxlen;
|
|
return n;
|
|
}
|
|
|
|
/* multiple add */
|
|
|
|
int
|
|
cirbuf_add_buf_tail(struct cirbuf *cbuf, const char *c, unsigned int n)
|
|
{
|
|
unsigned int e;
|
|
|
|
if (!cbuf || !c || !n || n > CIRBUF_GET_FREELEN(cbuf))
|
|
return -EINVAL;
|
|
|
|
e = CIRBUF_IS_EMPTY(cbuf) ? 1 : 0;
|
|
|
|
if (n < cbuf->maxlen - cbuf->end - 1 + e) {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", 0, cbuf->end + !e, n);
|
|
memcpy(cbuf->buf + cbuf->end + !e, c, n);
|
|
}
|
|
else {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", cbuf->end + !e, 0,
|
|
cbuf->maxlen - cbuf->end - 1 + e);
|
|
dprintf("s[%d] -> d[%d] (%d)\n", cbuf->maxlen - cbuf->end - 1 +
|
|
e, 0, n - cbuf->maxlen + cbuf->end + 1 - e);
|
|
memcpy(cbuf->buf + cbuf->end + !e, c, cbuf->maxlen -
|
|
cbuf->end - 1 + e);
|
|
memcpy(cbuf->buf, c + cbuf->maxlen - cbuf->end - 1 + e,
|
|
n - cbuf->maxlen + cbuf->end + 1 - e);
|
|
}
|
|
cbuf->len += n;
|
|
cbuf->end += n - e;
|
|
cbuf->end %= cbuf->maxlen;
|
|
return n;
|
|
}
|
|
|
|
/* add at head */
|
|
|
|
static inline void
|
|
__cirbuf_add_head(struct cirbuf * cbuf, char c)
|
|
{
|
|
if (!CIRBUF_IS_EMPTY(cbuf)) {
|
|
cbuf->start += (cbuf->maxlen - 1);
|
|
cbuf->start %= cbuf->maxlen;
|
|
}
|
|
cbuf->buf[cbuf->start] = c;
|
|
cbuf->len ++;
|
|
}
|
|
|
|
int
|
|
cirbuf_add_head_safe(struct cirbuf * cbuf, char c)
|
|
{
|
|
if (cbuf && !CIRBUF_IS_FULL(cbuf)) {
|
|
__cirbuf_add_head(cbuf, c);
|
|
return 0;
|
|
}
|
|
return -EINVAL;
|
|
}
|
|
|
|
void
|
|
cirbuf_add_head(struct cirbuf * cbuf, char c)
|
|
{
|
|
__cirbuf_add_head(cbuf, c);
|
|
}
|
|
|
|
/* add at tail */
|
|
|
|
static inline void
|
|
__cirbuf_add_tail(struct cirbuf * cbuf, char c)
|
|
{
|
|
if (!CIRBUF_IS_EMPTY(cbuf)) {
|
|
cbuf->end ++;
|
|
cbuf->end %= cbuf->maxlen;
|
|
}
|
|
cbuf->buf[cbuf->end] = c;
|
|
cbuf->len ++;
|
|
}
|
|
|
|
int
|
|
cirbuf_add_tail_safe(struct cirbuf * cbuf, char c)
|
|
{
|
|
if (cbuf && !CIRBUF_IS_FULL(cbuf)) {
|
|
__cirbuf_add_tail(cbuf, c);
|
|
return 0;
|
|
}
|
|
return -EINVAL;
|
|
}
|
|
|
|
void
|
|
cirbuf_add_tail(struct cirbuf * cbuf, char c)
|
|
{
|
|
__cirbuf_add_tail(cbuf, c);
|
|
}
|
|
|
|
|
|
static inline void
|
|
__cirbuf_shift_left(struct cirbuf *cbuf)
|
|
{
|
|
unsigned int i;
|
|
char tmp = cbuf->buf[cbuf->start];
|
|
|
|
for (i=0 ; i<cbuf->len ; i++) {
|
|
cbuf->buf[(cbuf->start+i)%cbuf->maxlen] =
|
|
cbuf->buf[(cbuf->start+i+1)%cbuf->maxlen];
|
|
}
|
|
cbuf->buf[(cbuf->start-1+cbuf->maxlen)%cbuf->maxlen] = tmp;
|
|
cbuf->start += (cbuf->maxlen - 1);
|
|
cbuf->start %= cbuf->maxlen;
|
|
cbuf->end += (cbuf->maxlen - 1);
|
|
cbuf->end %= cbuf->maxlen;
|
|
}
|
|
|
|
static inline void
|
|
__cirbuf_shift_right(struct cirbuf *cbuf)
|
|
{
|
|
unsigned int i;
|
|
char tmp = cbuf->buf[cbuf->end];
|
|
|
|
for (i=0 ; i<cbuf->len ; i++) {
|
|
cbuf->buf[(cbuf->end+cbuf->maxlen-i)%cbuf->maxlen] =
|
|
cbuf->buf[(cbuf->end+cbuf->maxlen-i-1)%cbuf->maxlen];
|
|
}
|
|
cbuf->buf[(cbuf->end+1)%cbuf->maxlen] = tmp;
|
|
cbuf->start += 1;
|
|
cbuf->start %= cbuf->maxlen;
|
|
cbuf->end += 1;
|
|
cbuf->end %= cbuf->maxlen;
|
|
}
|
|
|
|
/* XXX we could do a better algorithm here... */
|
|
int
|
|
cirbuf_align_left(struct cirbuf * cbuf)
|
|
{
|
|
if (!cbuf)
|
|
return -EINVAL;
|
|
|
|
if (cbuf->start < cbuf->maxlen/2) {
|
|
while (cbuf->start != 0) {
|
|
__cirbuf_shift_left(cbuf);
|
|
}
|
|
}
|
|
else {
|
|
while (cbuf->start != 0) {
|
|
__cirbuf_shift_right(cbuf);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* XXX we could do a better algorithm here... */
|
|
int
|
|
cirbuf_align_right(struct cirbuf * cbuf)
|
|
{
|
|
if (!cbuf)
|
|
return -EINVAL;
|
|
|
|
if (cbuf->start >= cbuf->maxlen/2) {
|
|
while (cbuf->end != cbuf->maxlen-1) {
|
|
__cirbuf_shift_left(cbuf);
|
|
}
|
|
}
|
|
else {
|
|
while (cbuf->start != cbuf->maxlen-1) {
|
|
__cirbuf_shift_right(cbuf);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* buffer del */
|
|
|
|
int
|
|
cirbuf_del_buf_head(struct cirbuf *cbuf, unsigned int size)
|
|
{
|
|
if (!cbuf || !size || size > CIRBUF_GET_LEN(cbuf))
|
|
return -EINVAL;
|
|
|
|
cbuf->len -= size;
|
|
if (CIRBUF_IS_EMPTY(cbuf)) {
|
|
cbuf->start += size - 1;
|
|
cbuf->start %= cbuf->maxlen;
|
|
}
|
|
else {
|
|
cbuf->start += size;
|
|
cbuf->start %= cbuf->maxlen;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* buffer del */
|
|
|
|
int
|
|
cirbuf_del_buf_tail(struct cirbuf *cbuf, unsigned int size)
|
|
{
|
|
if (!cbuf || !size || size > CIRBUF_GET_LEN(cbuf))
|
|
return -EINVAL;
|
|
|
|
cbuf->len -= size;
|
|
if (CIRBUF_IS_EMPTY(cbuf)) {
|
|
cbuf->end += (cbuf->maxlen - size + 1);
|
|
cbuf->end %= cbuf->maxlen;
|
|
}
|
|
else {
|
|
cbuf->end += (cbuf->maxlen - size);
|
|
cbuf->end %= cbuf->maxlen;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* del at head */
|
|
|
|
static inline void
|
|
__cirbuf_del_head(struct cirbuf * cbuf)
|
|
{
|
|
cbuf->len --;
|
|
if (!CIRBUF_IS_EMPTY(cbuf)) {
|
|
cbuf->start ++;
|
|
cbuf->start %= cbuf->maxlen;
|
|
}
|
|
}
|
|
|
|
int
|
|
cirbuf_del_head_safe(struct cirbuf * cbuf)
|
|
{
|
|
if (cbuf && !CIRBUF_IS_EMPTY(cbuf)) {
|
|
__cirbuf_del_head(cbuf);
|
|
return 0;
|
|
}
|
|
return -EINVAL;
|
|
}
|
|
|
|
void
|
|
cirbuf_del_head(struct cirbuf * cbuf)
|
|
{
|
|
__cirbuf_del_head(cbuf);
|
|
}
|
|
|
|
/* del at tail */
|
|
|
|
static inline void
|
|
__cirbuf_del_tail(struct cirbuf * cbuf)
|
|
{
|
|
cbuf->len --;
|
|
if (!CIRBUF_IS_EMPTY(cbuf)) {
|
|
cbuf->end += (cbuf->maxlen - 1);
|
|
cbuf->end %= cbuf->maxlen;
|
|
}
|
|
}
|
|
|
|
int
|
|
cirbuf_del_tail_safe(struct cirbuf * cbuf)
|
|
{
|
|
if (cbuf && !CIRBUF_IS_EMPTY(cbuf)) {
|
|
__cirbuf_del_tail(cbuf);
|
|
return 0;
|
|
}
|
|
return -EINVAL;
|
|
}
|
|
|
|
void
|
|
cirbuf_del_tail(struct cirbuf * cbuf)
|
|
{
|
|
__cirbuf_del_tail(cbuf);
|
|
}
|
|
|
|
/* convert to buffer */
|
|
|
|
int
|
|
cirbuf_get_buf_head(struct cirbuf *cbuf, char *c, unsigned int size)
|
|
{
|
|
unsigned int n;
|
|
|
|
if (!cbuf || !c)
|
|
return -EINVAL;
|
|
|
|
n = (size < CIRBUF_GET_LEN(cbuf)) ? size : CIRBUF_GET_LEN(cbuf);
|
|
|
|
if (!n)
|
|
return 0;
|
|
|
|
if (cbuf->start <= cbuf->end) {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", cbuf->start, 0, n);
|
|
memcpy(c, cbuf->buf + cbuf->start , n);
|
|
}
|
|
else {
|
|
/* check if we need to go from end to the beginning */
|
|
if (n <= cbuf->maxlen - cbuf->start) {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", 0, cbuf->start, n);
|
|
memcpy(c, cbuf->buf + cbuf->start , n);
|
|
}
|
|
else {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", cbuf->start, 0,
|
|
cbuf->maxlen - cbuf->start);
|
|
dprintf("s[%d] -> d[%d] (%d)\n", 0, cbuf->maxlen - cbuf->start,
|
|
n - cbuf->maxlen + cbuf->start);
|
|
memcpy(c, cbuf->buf + cbuf->start , cbuf->maxlen - cbuf->start);
|
|
memcpy(c + cbuf->maxlen - cbuf->start, cbuf->buf,
|
|
n - cbuf->maxlen + cbuf->start);
|
|
}
|
|
}
|
|
return n;
|
|
}
|
|
|
|
/* convert to buffer */
|
|
|
|
int
|
|
cirbuf_get_buf_tail(struct cirbuf *cbuf, char *c, unsigned int size)
|
|
{
|
|
unsigned int n;
|
|
|
|
if (!cbuf || !c)
|
|
return -EINVAL;
|
|
|
|
n = (size < CIRBUF_GET_LEN(cbuf)) ? size : CIRBUF_GET_LEN(cbuf);
|
|
|
|
if (!n)
|
|
return 0;
|
|
|
|
if (cbuf->start <= cbuf->end) {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", cbuf->end - n + 1, 0, n);
|
|
memcpy(c, cbuf->buf + cbuf->end - n + 1, n);
|
|
}
|
|
else {
|
|
/* check if we need to go from end to the beginning */
|
|
if (n <= cbuf->end + 1) {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", 0, cbuf->end - n + 1, n);
|
|
memcpy(c, cbuf->buf + cbuf->end - n + 1, n);
|
|
}
|
|
else {
|
|
dprintf("s[%d] -> d[%d] (%d)\n", 0,
|
|
cbuf->maxlen - cbuf->start, cbuf->end + 1);
|
|
dprintf("s[%d] -> d[%d] (%d)\n",
|
|
cbuf->maxlen - n + cbuf->end + 1, 0, n - cbuf->end - 1);
|
|
memcpy(c + cbuf->maxlen - cbuf->start,
|
|
cbuf->buf, cbuf->end + 1);
|
|
memcpy(c, cbuf->buf + cbuf->maxlen - n + cbuf->end +1,
|
|
n - cbuf->end - 1);
|
|
}
|
|
}
|
|
return n;
|
|
}
|
|
|
|
/* get head or get tail */
|
|
|
|
char
|
|
cirbuf_get_head(struct cirbuf * cbuf)
|
|
{
|
|
return cbuf->buf[cbuf->start];
|
|
}
|
|
|
|
/* get head or get tail */
|
|
|
|
char
|
|
cirbuf_get_tail(struct cirbuf * cbuf)
|
|
{
|
|
return cbuf->buf[cbuf->end];
|
|
}
|