2006-09-21 09:31:53 +02:00
|
|
|
/*
|
2009-01-28 01:16:05 +01:00
|
|
|
* a very simple circular buffer FIFO implementation
|
2006-09-21 09:31:53 +02:00
|
|
|
* Copyright (c) 2000, 2001, 2002 Fabrice Bellard
|
|
|
|
* Copyright (c) 2006 Roman Shaposhnik
|
|
|
|
*
|
2006-10-07 17:30:46 +02:00
|
|
|
* This file is part of FFmpeg.
|
|
|
|
*
|
|
|
|
* FFmpeg is free software; you can redistribute it and/or
|
2006-09-21 09:31:53 +02:00
|
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
|
|
* License as published by the Free Software Foundation; either
|
2006-10-07 17:30:46 +02:00
|
|
|
* version 2.1 of the License, or (at your option) any later version.
|
2006-09-21 09:31:53 +02:00
|
|
|
*
|
2006-10-07 17:30:46 +02:00
|
|
|
* FFmpeg is distributed in the hope that it will be useful,
|
2006-09-21 09:31:53 +02:00
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
* Lesser General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU Lesser General Public
|
2006-10-07 17:30:46 +02:00
|
|
|
* License along with FFmpeg; if not, write to the Free Software
|
2006-09-21 09:31:53 +02:00
|
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
|
|
*/
|
2013-09-03 03:05:41 +02:00
|
|
|
|
|
|
|
#include "avassert.h"
|
2006-09-21 09:31:53 +02:00
|
|
|
#include "common.h"
|
|
|
|
#include "fifo.h"
|
|
|
|
|
2014-05-10 08:06:53 +02:00
|
|
|
static AVFifoBuffer *fifo_alloc_common(void *buffer, size_t size)
|
2006-09-21 09:31:53 +02:00
|
|
|
{
|
2014-05-10 08:06:53 +02:00
|
|
|
AVFifoBuffer *f;
|
|
|
|
if (!buffer)
|
|
|
|
return NULL;
|
|
|
|
f = av_mallocz(sizeof(AVFifoBuffer));
|
|
|
|
if (!f) {
|
|
|
|
av_free(buffer);
|
2009-03-08 15:16:55 +01:00
|
|
|
return NULL;
|
2014-05-10 08:06:53 +02:00
|
|
|
}
|
|
|
|
f->buffer = buffer;
|
2013-07-06 12:05:27 +02:00
|
|
|
f->end = f->buffer + size;
|
2009-03-09 10:26:32 +01:00
|
|
|
av_fifo_reset(f);
|
2009-03-08 15:16:55 +01:00
|
|
|
return f;
|
2006-09-21 09:31:53 +02:00
|
|
|
}
|
|
|
|
|
2014-05-10 08:06:53 +02:00
|
|
|
AVFifoBuffer *av_fifo_alloc(unsigned int size)
|
|
|
|
{
|
|
|
|
void *buffer = av_malloc(size);
|
|
|
|
return fifo_alloc_common(buffer, size);
|
|
|
|
}
|
|
|
|
|
|
|
|
AVFifoBuffer *av_fifo_alloc_array(size_t nmemb, size_t size)
|
|
|
|
{
|
|
|
|
void *buffer = av_malloc_array(nmemb, size);
|
|
|
|
return fifo_alloc_common(buffer, nmemb * size);
|
|
|
|
}
|
|
|
|
|
2006-09-21 09:31:53 +02:00
|
|
|
void av_fifo_free(AVFifoBuffer *f)
|
|
|
|
{
|
2011-08-13 19:10:05 +02:00
|
|
|
if (f) {
|
2011-05-09 21:23:45 +02:00
|
|
|
av_freep(&f->buffer);
|
2009-03-09 04:39:58 +01:00
|
|
|
av_free(f);
|
2009-03-08 15:16:55 +01:00
|
|
|
}
|
2006-09-21 09:31:53 +02:00
|
|
|
}
|
|
|
|
|
2014-05-06 21:28:51 +02:00
|
|
|
void av_fifo_freep(AVFifoBuffer **f)
|
|
|
|
{
|
|
|
|
if (f) {
|
|
|
|
av_fifo_free(*f);
|
|
|
|
*f = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2009-03-09 10:26:32 +01:00
|
|
|
void av_fifo_reset(AVFifoBuffer *f)
|
|
|
|
{
|
|
|
|
f->wptr = f->rptr = f->buffer;
|
|
|
|
f->wndx = f->rndx = 0;
|
|
|
|
}
|
|
|
|
|
2014-11-24 02:10:45 +01:00
|
|
|
int av_fifo_size(const AVFifoBuffer *f)
|
2006-09-21 09:31:53 +02:00
|
|
|
{
|
2009-03-07 22:02:08 +01:00
|
|
|
return (uint32_t)(f->wndx - f->rndx);
|
2006-09-21 09:31:53 +02:00
|
|
|
}
|
|
|
|
|
2014-11-24 02:10:45 +01:00
|
|
|
int av_fifo_space(const AVFifoBuffer *f)
|
2009-04-03 01:22:19 +02:00
|
|
|
{
|
|
|
|
return f->end - f->buffer - av_fifo_size(f);
|
|
|
|
}
|
|
|
|
|
2011-08-13 19:10:05 +02:00
|
|
|
int av_fifo_realloc2(AVFifoBuffer *f, unsigned int new_size)
|
|
|
|
{
|
|
|
|
unsigned int old_size = f->end - f->buffer;
|
2006-09-21 09:31:53 +02:00
|
|
|
|
2011-08-13 19:10:05 +02:00
|
|
|
if (old_size < new_size) {
|
2013-07-06 12:05:27 +02:00
|
|
|
int len = av_fifo_size(f);
|
2011-08-13 19:10:05 +02:00
|
|
|
AVFifoBuffer *f2 = av_fifo_alloc(new_size);
|
2006-09-21 09:31:53 +02:00
|
|
|
|
2009-03-08 15:16:55 +01:00
|
|
|
if (!f2)
|
2011-08-13 19:11:05 +02:00
|
|
|
return AVERROR(ENOMEM);
|
2009-03-09 18:47:47 +01:00
|
|
|
av_fifo_generic_read(f, f2->buffer, len, NULL);
|
2009-03-08 15:16:55 +01:00
|
|
|
f2->wptr += len;
|
|
|
|
f2->wndx += len;
|
2007-01-17 21:05:31 +01:00
|
|
|
av_free(f->buffer);
|
2011-08-13 19:10:05 +02:00
|
|
|
*f = *f2;
|
2009-03-08 15:16:55 +01:00
|
|
|
av_free(f2);
|
2006-09-21 09:31:53 +02:00
|
|
|
}
|
2008-08-19 20:43:34 +02:00
|
|
|
return 0;
|
2006-09-21 09:31:53 +02:00
|
|
|
}
|
|
|
|
|
2012-05-14 19:54:36 +02:00
|
|
|
int av_fifo_grow(AVFifoBuffer *f, unsigned int size)
|
|
|
|
{
|
|
|
|
unsigned int old_size = f->end - f->buffer;
|
|
|
|
if(size + (unsigned)av_fifo_size(f) < size)
|
|
|
|
return AVERROR(EINVAL);
|
|
|
|
|
|
|
|
size += av_fifo_size(f);
|
|
|
|
|
|
|
|
if (old_size < size)
|
|
|
|
return av_fifo_realloc2(f, FFMAX(size, 2*size));
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-07-06 12:05:27 +02:00
|
|
|
/* src must NOT be const as it can be a context for func that may need
|
|
|
|
* updating (like a pointer or byte counter) */
|
|
|
|
int av_fifo_generic_write(AVFifoBuffer *f, void *src, int size,
|
|
|
|
int (*func)(void *, void *, int))
|
2008-04-09 13:35:16 +02:00
|
|
|
{
|
|
|
|
int total = size;
|
2011-12-23 00:18:36 +01:00
|
|
|
uint32_t wndx= f->wndx;
|
|
|
|
uint8_t *wptr= f->wptr;
|
|
|
|
|
2007-01-18 01:22:24 +01:00
|
|
|
do {
|
2011-12-23 00:18:36 +01:00
|
|
|
int len = FFMIN(f->end - wptr, size);
|
2011-08-13 19:10:05 +02:00
|
|
|
if (func) {
|
2015-07-14 08:47:26 +02:00
|
|
|
len = func(src, wptr, len);
|
|
|
|
if (len <= 0)
|
2008-04-09 13:35:16 +02:00
|
|
|
break;
|
|
|
|
} else {
|
2011-12-23 00:18:36 +01:00
|
|
|
memcpy(wptr, src, len);
|
2013-07-06 12:05:27 +02:00
|
|
|
src = (uint8_t *)src + len;
|
2008-04-09 13:35:16 +02:00
|
|
|
}
|
2009-03-08 01:45:45 +01:00
|
|
|
// Write memory barrier needed for SMP here in theory
|
2011-12-23 00:18:36 +01:00
|
|
|
wptr += len;
|
|
|
|
if (wptr >= f->end)
|
|
|
|
wptr = f->buffer;
|
2013-07-07 11:26:28 +02:00
|
|
|
wndx += len;
|
2013-07-06 12:05:27 +02:00
|
|
|
size -= len;
|
2007-01-18 01:22:24 +01:00
|
|
|
} while (size > 0);
|
2011-12-23 00:18:36 +01:00
|
|
|
f->wndx= wndx;
|
|
|
|
f->wptr= wptr;
|
2008-04-09 13:35:16 +02:00
|
|
|
return total - size;
|
2006-09-21 09:31:53 +02:00
|
|
|
}
|
|
|
|
|
2015-08-04 14:41:35 +02:00
|
|
|
int av_fifo_generic_peek(AVFifoBuffer *f, void *dest, int buf_size,
|
|
|
|
void (*func)(void *, void *, int))
|
|
|
|
{
|
|
|
|
// Read memory barrier needed for SMP here in theory
|
|
|
|
uint8_t *rptr = f->rptr;
|
|
|
|
|
|
|
|
do {
|
2015-10-13 18:29:04 +02:00
|
|
|
int len = FFMIN(f->end - rptr, buf_size);
|
2015-08-04 14:41:35 +02:00
|
|
|
if (func)
|
2015-10-13 18:29:04 +02:00
|
|
|
func(dest, rptr, len);
|
2015-08-04 14:41:35 +02:00
|
|
|
else {
|
2015-10-13 18:29:04 +02:00
|
|
|
memcpy(dest, rptr, len);
|
2015-08-04 14:41:35 +02:00
|
|
|
dest = (uint8_t *)dest + len;
|
|
|
|
}
|
|
|
|
// memory barrier needed for SMP here in theory
|
2015-10-13 18:29:04 +02:00
|
|
|
rptr += len;
|
|
|
|
if (rptr >= f->end)
|
|
|
|
rptr -= f->end - f->buffer;
|
2015-08-04 14:41:35 +02:00
|
|
|
buf_size -= len;
|
|
|
|
} while (buf_size > 0);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-07-06 12:05:27 +02:00
|
|
|
int av_fifo_generic_read(AVFifoBuffer *f, void *dest, int buf_size,
|
|
|
|
void (*func)(void *, void *, int))
|
2006-09-21 09:31:53 +02:00
|
|
|
{
|
2009-03-08 01:45:45 +01:00
|
|
|
// Read memory barrier needed for SMP here in theory
|
2007-01-18 01:22:24 +01:00
|
|
|
do {
|
2007-01-17 20:30:23 +01:00
|
|
|
int len = FFMIN(f->end - f->rptr, buf_size);
|
2013-07-06 12:05:27 +02:00
|
|
|
if (func)
|
|
|
|
func(dest, f->rptr, len);
|
|
|
|
else {
|
2007-01-17 20:46:33 +01:00
|
|
|
memcpy(dest, f->rptr, len);
|
2013-07-06 12:05:27 +02:00
|
|
|
dest = (uint8_t *)dest + len;
|
2007-01-17 20:46:33 +01:00
|
|
|
}
|
2009-03-08 01:45:45 +01:00
|
|
|
// memory barrier needed for SMP here in theory
|
2007-01-17 21:11:23 +01:00
|
|
|
av_fifo_drain(f, len);
|
2006-09-21 09:31:53 +02:00
|
|
|
buf_size -= len;
|
2007-01-18 01:22:24 +01:00
|
|
|
} while (buf_size > 0);
|
2006-09-21 09:31:53 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2009-01-28 01:16:05 +01:00
|
|
|
/** Discard data from the FIFO. */
|
2006-09-21 09:31:53 +02:00
|
|
|
void av_fifo_drain(AVFifoBuffer *f, int size)
|
|
|
|
{
|
2013-09-03 03:05:41 +02:00
|
|
|
av_assert2(av_fifo_size(f) >= size);
|
2006-09-21 09:31:53 +02:00
|
|
|
f->rptr += size;
|
|
|
|
if (f->rptr >= f->end)
|
|
|
|
f->rptr -= f->end - f->buffer;
|
2009-03-07 22:02:08 +01:00
|
|
|
f->rndx += size;
|
2006-09-21 09:31:53 +02:00
|
|
|
}
|
2011-07-16 09:49:42 +02:00
|
|
|
|
|
|
|
#ifdef TEST
|
|
|
|
|
|
|
|
int main(void)
|
|
|
|
{
|
|
|
|
/* create a FIFO buffer */
|
|
|
|
AVFifoBuffer *fifo = av_fifo_alloc(13 * sizeof(int));
|
|
|
|
int i, j, n;
|
|
|
|
|
|
|
|
/* fill data */
|
|
|
|
for (i = 0; av_fifo_space(fifo) >= sizeof(int); i++)
|
|
|
|
av_fifo_generic_write(fifo, &i, sizeof(int), NULL);
|
|
|
|
|
|
|
|
/* peek at FIFO */
|
2013-07-06 12:05:27 +02:00
|
|
|
n = av_fifo_size(fifo) / sizeof(int);
|
|
|
|
for (i = -n + 1; i < n; i++) {
|
|
|
|
int *v = (int *)av_fifo_peek2(fifo, i * sizeof(int));
|
2011-07-16 09:49:42 +02:00
|
|
|
printf("%d: %d\n", i, *v);
|
|
|
|
}
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
/* read data */
|
|
|
|
for (i = 0; av_fifo_size(fifo) >= sizeof(int); i++) {
|
|
|
|
av_fifo_generic_read(fifo, &j, sizeof(int), NULL);
|
|
|
|
printf("%d ", j);
|
|
|
|
}
|
|
|
|
printf("\n");
|
|
|
|
|
|
|
|
av_fifo_free(fifo);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|