yading@11
|
1 /*
|
yading@11
|
2 * a very simple circular buffer FIFO implementation
|
yading@11
|
3 * Copyright (c) 2000, 2001, 2002 Fabrice Bellard
|
yading@11
|
4 * Copyright (c) 2006 Roman Shaposhnik
|
yading@11
|
5 *
|
yading@11
|
6 * This file is part of FFmpeg.
|
yading@11
|
7 *
|
yading@11
|
8 * FFmpeg is free software; you can redistribute it and/or
|
yading@11
|
9 * modify it under the terms of the GNU Lesser General Public
|
yading@11
|
10 * License as published by the Free Software Foundation; either
|
yading@11
|
11 * version 2.1 of the License, or (at your option) any later version.
|
yading@11
|
12 *
|
yading@11
|
13 * FFmpeg is distributed in the hope that it will be useful,
|
yading@11
|
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
yading@11
|
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
yading@11
|
16 * Lesser General Public License for more details.
|
yading@11
|
17 *
|
yading@11
|
18 * You should have received a copy of the GNU Lesser General Public
|
yading@11
|
19 * License along with FFmpeg; if not, write to the Free Software
|
yading@11
|
20 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
yading@11
|
21 */
|
yading@11
|
22 #include "common.h"
|
yading@11
|
23 #include "fifo.h"
|
yading@11
|
24
|
yading@11
|
25 AVFifoBuffer *av_fifo_alloc(unsigned int size)
|
yading@11
|
26 {
|
yading@11
|
27 AVFifoBuffer *f= av_mallocz(sizeof(AVFifoBuffer));
|
yading@11
|
28 if (!f)
|
yading@11
|
29 return NULL;
|
yading@11
|
30 f->buffer = av_malloc(size);
|
yading@11
|
31 f->end = f->buffer + size;
|
yading@11
|
32 av_fifo_reset(f);
|
yading@11
|
33 if (!f->buffer)
|
yading@11
|
34 av_freep(&f);
|
yading@11
|
35 return f;
|
yading@11
|
36 }
|
yading@11
|
37
|
yading@11
|
38 void av_fifo_free(AVFifoBuffer *f)
|
yading@11
|
39 {
|
yading@11
|
40 if (f) {
|
yading@11
|
41 av_freep(&f->buffer);
|
yading@11
|
42 av_free(f);
|
yading@11
|
43 }
|
yading@11
|
44 }
|
yading@11
|
45
|
yading@11
|
46 void av_fifo_reset(AVFifoBuffer *f)
|
yading@11
|
47 {
|
yading@11
|
48 f->wptr = f->rptr = f->buffer;
|
yading@11
|
49 f->wndx = f->rndx = 0;
|
yading@11
|
50 }
|
yading@11
|
51
|
yading@11
|
52 int av_fifo_size(AVFifoBuffer *f)
|
yading@11
|
53 {
|
yading@11
|
54 return (uint32_t)(f->wndx - f->rndx);
|
yading@11
|
55 }
|
yading@11
|
56
|
yading@11
|
57 int av_fifo_space(AVFifoBuffer *f)
|
yading@11
|
58 {
|
yading@11
|
59 return f->end - f->buffer - av_fifo_size(f);
|
yading@11
|
60 }
|
yading@11
|
61
|
yading@11
|
62 int av_fifo_realloc2(AVFifoBuffer *f, unsigned int new_size)
|
yading@11
|
63 {
|
yading@11
|
64 unsigned int old_size = f->end - f->buffer;
|
yading@11
|
65
|
yading@11
|
66 if (old_size < new_size) {
|
yading@11
|
67 int len = av_fifo_size(f);
|
yading@11
|
68 AVFifoBuffer *f2 = av_fifo_alloc(new_size);
|
yading@11
|
69
|
yading@11
|
70 if (!f2)
|
yading@11
|
71 return AVERROR(ENOMEM);
|
yading@11
|
72 av_fifo_generic_read(f, f2->buffer, len, NULL);
|
yading@11
|
73 f2->wptr += len;
|
yading@11
|
74 f2->wndx += len;
|
yading@11
|
75 av_free(f->buffer);
|
yading@11
|
76 *f = *f2;
|
yading@11
|
77 av_free(f2);
|
yading@11
|
78 }
|
yading@11
|
79 return 0;
|
yading@11
|
80 }
|
yading@11
|
81
|
yading@11
|
82 int av_fifo_grow(AVFifoBuffer *f, unsigned int size)
|
yading@11
|
83 {
|
yading@11
|
84 unsigned int old_size = f->end - f->buffer;
|
yading@11
|
85 if(size + (unsigned)av_fifo_size(f) < size)
|
yading@11
|
86 return AVERROR(EINVAL);
|
yading@11
|
87
|
yading@11
|
88 size += av_fifo_size(f);
|
yading@11
|
89
|
yading@11
|
90 if (old_size < size)
|
yading@11
|
91 return av_fifo_realloc2(f, FFMAX(size, 2*size));
|
yading@11
|
92 return 0;
|
yading@11
|
93 }
|
yading@11
|
94
|
yading@11
|
95 // src must NOT be const as it can be a context for func that may need updating (like a pointer or byte counter)
|
yading@11
|
96 int av_fifo_generic_write(AVFifoBuffer *f, void *src, int size, int (*func)(void*, void*, int))
|
yading@11
|
97 {
|
yading@11
|
98 int total = size;
|
yading@11
|
99 uint32_t wndx= f->wndx;
|
yading@11
|
100 uint8_t *wptr= f->wptr;
|
yading@11
|
101
|
yading@11
|
102 do {
|
yading@11
|
103 int len = FFMIN(f->end - wptr, size);
|
yading@11
|
104 if (func) {
|
yading@11
|
105 if (func(src, wptr, len) <= 0)
|
yading@11
|
106 break;
|
yading@11
|
107 } else {
|
yading@11
|
108 memcpy(wptr, src, len);
|
yading@11
|
109 src = (uint8_t*)src + len;
|
yading@11
|
110 }
|
yading@11
|
111 // Write memory barrier needed for SMP here in theory
|
yading@11
|
112 wptr += len;
|
yading@11
|
113 if (wptr >= f->end)
|
yading@11
|
114 wptr = f->buffer;
|
yading@11
|
115 wndx += len;
|
yading@11
|
116 size -= len;
|
yading@11
|
117 } while (size > 0);
|
yading@11
|
118 f->wndx= wndx;
|
yading@11
|
119 f->wptr= wptr;
|
yading@11
|
120 return total - size;
|
yading@11
|
121 }
|
yading@11
|
122
|
yading@11
|
123
|
yading@11
|
124 int av_fifo_generic_read(AVFifoBuffer *f, void *dest, int buf_size, void (*func)(void*, void*, int))
|
yading@11
|
125 {
|
yading@11
|
126 // Read memory barrier needed for SMP here in theory
|
yading@11
|
127 do {
|
yading@11
|
128 int len = FFMIN(f->end - f->rptr, buf_size);
|
yading@11
|
129 if(func) func(dest, f->rptr, len);
|
yading@11
|
130 else{
|
yading@11
|
131 memcpy(dest, f->rptr, len);
|
yading@11
|
132 dest = (uint8_t*)dest + len;
|
yading@11
|
133 }
|
yading@11
|
134 // memory barrier needed for SMP here in theory
|
yading@11
|
135 av_fifo_drain(f, len);
|
yading@11
|
136 buf_size -= len;
|
yading@11
|
137 } while (buf_size > 0);
|
yading@11
|
138 return 0;
|
yading@11
|
139 }
|
yading@11
|
140
|
yading@11
|
141 /** Discard data from the FIFO. */
|
yading@11
|
142 void av_fifo_drain(AVFifoBuffer *f, int size)
|
yading@11
|
143 {
|
yading@11
|
144 f->rptr += size;
|
yading@11
|
145 if (f->rptr >= f->end)
|
yading@11
|
146 f->rptr -= f->end - f->buffer;
|
yading@11
|
147 f->rndx += size;
|
yading@11
|
148 }
|
yading@11
|
149
|
yading@11
|
150 #ifdef TEST
|
yading@11
|
151
|
yading@11
|
152 int main(void)
|
yading@11
|
153 {
|
yading@11
|
154 /* create a FIFO buffer */
|
yading@11
|
155 AVFifoBuffer *fifo = av_fifo_alloc(13 * sizeof(int));
|
yading@11
|
156 int i, j, n;
|
yading@11
|
157
|
yading@11
|
158 /* fill data */
|
yading@11
|
159 for (i = 0; av_fifo_space(fifo) >= sizeof(int); i++)
|
yading@11
|
160 av_fifo_generic_write(fifo, &i, sizeof(int), NULL);
|
yading@11
|
161
|
yading@11
|
162 /* peek at FIFO */
|
yading@11
|
163 n = av_fifo_size(fifo)/sizeof(int);
|
yading@11
|
164 for (i = -n+1; i < n; i++) {
|
yading@11
|
165 int *v = (int *)av_fifo_peek2(fifo, i*sizeof(int));
|
yading@11
|
166 printf("%d: %d\n", i, *v);
|
yading@11
|
167 }
|
yading@11
|
168 printf("\n");
|
yading@11
|
169
|
yading@11
|
170 /* read data */
|
yading@11
|
171 for (i = 0; av_fifo_size(fifo) >= sizeof(int); i++) {
|
yading@11
|
172 av_fifo_generic_read(fifo, &j, sizeof(int), NULL);
|
yading@11
|
173 printf("%d ", j);
|
yading@11
|
174 }
|
yading@11
|
175 printf("\n");
|
yading@11
|
176
|
yading@11
|
177 av_fifo_free(fifo);
|
yading@11
|
178
|
yading@11
|
179 return 0;
|
yading@11
|
180 }
|
yading@11
|
181
|
yading@11
|
182 #endif
|