ring.c revision 1.6 1 1.1 cgd /*
2 1.3 cgd * Copyright (c) 1988, 1993
3 1.3 cgd * The Regents of the University of California. All rights reserved.
4 1.1 cgd *
5 1.1 cgd * Redistribution and use in source and binary forms, with or without
6 1.1 cgd * modification, are permitted provided that the following conditions
7 1.1 cgd * are met:
8 1.1 cgd * 1. Redistributions of source code must retain the above copyright
9 1.1 cgd * notice, this list of conditions and the following disclaimer.
10 1.1 cgd * 2. Redistributions in binary form must reproduce the above copyright
11 1.1 cgd * notice, this list of conditions and the following disclaimer in the
12 1.1 cgd * documentation and/or other materials provided with the distribution.
13 1.1 cgd * 3. All advertising materials mentioning features or use of this software
14 1.1 cgd * must display the following acknowledgement:
15 1.1 cgd * This product includes software developed by the University of
16 1.1 cgd * California, Berkeley and its contributors.
17 1.1 cgd * 4. Neither the name of the University nor the names of its contributors
18 1.1 cgd * may be used to endorse or promote products derived from this software
19 1.1 cgd * without specific prior written permission.
20 1.1 cgd *
21 1.1 cgd * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22 1.1 cgd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23 1.1 cgd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24 1.1 cgd * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25 1.1 cgd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26 1.1 cgd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27 1.1 cgd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28 1.1 cgd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29 1.1 cgd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30 1.1 cgd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31 1.1 cgd * SUCH DAMAGE.
32 1.1 cgd */
33 1.1 cgd
34 1.1 cgd #ifndef lint
35 1.5 jtk /* from: static char sccsid[] = "@(#)ring.c 8.2 (Berkeley) 5/30/95"; */
36 1.6 jtk static char rcsid[] = "$NetBSD: ring.c,v 1.6 1996/02/24 18:43:37 jtk Exp $";
37 1.1 cgd #endif /* not lint */
38 1.1 cgd
39 1.1 cgd /*
40 1.1 cgd * This defines a structure for a ring buffer.
41 1.1 cgd *
42 1.1 cgd * The circular buffer has two parts:
43 1.1 cgd *(((
44 1.1 cgd * full: [consume, supply)
45 1.1 cgd * empty: [supply, consume)
46 1.1 cgd *]]]
47 1.1 cgd *
48 1.1 cgd */
49 1.1 cgd
50 1.1 cgd #include <stdio.h>
51 1.6 jtk #ifndef NO_STRING_H
52 1.6 jtk #include <string.h>
53 1.6 jtk #endif
54 1.6 jtk #include <strings.h>
55 1.1 cgd #include <errno.h>
56 1.1 cgd
57 1.1 cgd #ifdef size_t
58 1.1 cgd #undef size_t
59 1.1 cgd #endif
60 1.1 cgd
61 1.1 cgd #include <sys/types.h>
62 1.1 cgd #ifndef FILIO_H
63 1.1 cgd #include <sys/ioctl.h>
64 1.1 cgd #endif
65 1.1 cgd #include <sys/socket.h>
66 1.1 cgd
67 1.1 cgd #include "ring.h"
68 1.1 cgd #include "general.h"
69 1.1 cgd
70 1.1 cgd /* Internal macros */
71 1.1 cgd
72 1.1 cgd #if !defined(MIN)
73 1.1 cgd #define MIN(a,b) (((a)<(b))? (a):(b))
74 1.1 cgd #endif /* !defined(MIN) */
75 1.1 cgd
76 1.1 cgd #define ring_subtract(d,a,b) (((a)-(b) >= 0)? \
77 1.1 cgd (a)-(b): (((a)-(b))+(d)->size))
78 1.1 cgd
79 1.1 cgd #define ring_increment(d,a,c) (((a)+(c) < (d)->top)? \
80 1.1 cgd (a)+(c) : (((a)+(c))-(d)->size))
81 1.1 cgd
82 1.1 cgd #define ring_decrement(d,a,c) (((a)-(c) >= (d)->bottom)? \
83 1.1 cgd (a)-(c) : (((a)-(c))-(d)->size))
84 1.1 cgd
85 1.1 cgd
86 1.1 cgd /*
87 1.1 cgd * The following is a clock, used to determine full, empty, etc.
88 1.1 cgd *
89 1.1 cgd * There is some trickiness here. Since the ring buffers are initialized
90 1.1 cgd * to ZERO on allocation, we need to make sure, when interpreting the
91 1.1 cgd * clock, that when the times are EQUAL, then the buffer is FULL.
92 1.1 cgd */
93 1.1 cgd static u_long ring_clock = 0;
94 1.1 cgd
95 1.1 cgd
96 1.1 cgd #define ring_empty(d) (((d)->consume == (d)->supply) && \
97 1.1 cgd ((d)->consumetime >= (d)->supplytime))
98 1.1 cgd #define ring_full(d) (((d)->supply == (d)->consume) && \
99 1.1 cgd ((d)->supplytime > (d)->consumetime))
100 1.1 cgd
101 1.1 cgd
102 1.1 cgd
103 1.1 cgd
104 1.1 cgd
105 1.1 cgd /* Buffer state transition routines */
106 1.1 cgd
107 1.1 cgd ring_init(ring, buffer, count)
108 1.1 cgd Ring *ring;
109 1.1 cgd unsigned char *buffer;
110 1.1 cgd int count;
111 1.1 cgd {
112 1.1 cgd memset((char *)ring, 0, sizeof *ring);
113 1.1 cgd
114 1.1 cgd ring->size = count;
115 1.1 cgd
116 1.1 cgd ring->supply = ring->consume = ring->bottom = buffer;
117 1.1 cgd
118 1.1 cgd ring->top = ring->bottom+ring->size;
119 1.1 cgd
120 1.1 cgd
121 1.1 cgd return 1;
122 1.1 cgd }
123 1.1 cgd
124 1.1 cgd /* Mark routines */
125 1.1 cgd
126 1.1 cgd /*
127 1.1 cgd * Mark the most recently supplied byte.
128 1.1 cgd */
129 1.1 cgd
130 1.1 cgd void
131 1.1 cgd ring_mark(ring)
132 1.1 cgd Ring *ring;
133 1.1 cgd {
134 1.1 cgd ring->mark = ring_decrement(ring, ring->supply, 1);
135 1.1 cgd }
136 1.1 cgd
137 1.1 cgd /*
138 1.1 cgd * Is the ring pointing to the mark?
139 1.1 cgd */
140 1.1 cgd
141 1.1 cgd int
142 1.1 cgd ring_at_mark(ring)
143 1.1 cgd Ring *ring;
144 1.1 cgd {
145 1.1 cgd if (ring->mark == ring->consume) {
146 1.1 cgd return 1;
147 1.1 cgd } else {
148 1.1 cgd return 0;
149 1.1 cgd }
150 1.1 cgd }
151 1.1 cgd
152 1.1 cgd /*
153 1.1 cgd * Clear any mark set on the ring.
154 1.1 cgd */
155 1.1 cgd
156 1.1 cgd void
157 1.1 cgd ring_clear_mark(ring)
158 1.1 cgd Ring *ring;
159 1.1 cgd {
160 1.1 cgd ring->mark = 0;
161 1.1 cgd }
162 1.1 cgd
163 1.1 cgd /*
164 1.1 cgd * Add characters from current segment to ring buffer.
165 1.1 cgd */
166 1.1 cgd void
167 1.1 cgd ring_supplied(ring, count)
168 1.1 cgd Ring *ring;
169 1.1 cgd int count;
170 1.1 cgd {
171 1.1 cgd ring->supply = ring_increment(ring, ring->supply, count);
172 1.1 cgd ring->supplytime = ++ring_clock;
173 1.1 cgd }
174 1.1 cgd
175 1.1 cgd /*
176 1.1 cgd * We have just consumed "c" bytes.
177 1.1 cgd */
178 1.1 cgd void
179 1.1 cgd ring_consumed(ring, count)
180 1.1 cgd Ring *ring;
181 1.1 cgd int count;
182 1.1 cgd {
183 1.1 cgd if (count == 0) /* don't update anything */
184 1.1 cgd return;
185 1.1 cgd
186 1.1 cgd if (ring->mark &&
187 1.1 cgd (ring_subtract(ring, ring->mark, ring->consume) < count)) {
188 1.1 cgd ring->mark = 0;
189 1.1 cgd }
190 1.1 cgd ring->consume = ring_increment(ring, ring->consume, count);
191 1.1 cgd ring->consumetime = ++ring_clock;
192 1.1 cgd /*
193 1.1 cgd * Try to encourage "ring_empty_consecutive()" to be large.
194 1.1 cgd */
195 1.1 cgd if (ring_empty(ring)) {
196 1.1 cgd ring->consume = ring->supply = ring->bottom;
197 1.1 cgd }
198 1.1 cgd }
199 1.1 cgd
200 1.1 cgd
201 1.1 cgd
202 1.1 cgd /* Buffer state query routines */
203 1.1 cgd
204 1.1 cgd
205 1.1 cgd /* Number of bytes that may be supplied */
206 1.1 cgd int
207 1.1 cgd ring_empty_count(ring)
208 1.1 cgd Ring *ring;
209 1.1 cgd {
210 1.1 cgd if (ring_empty(ring)) { /* if empty */
211 1.1 cgd return ring->size;
212 1.1 cgd } else {
213 1.1 cgd return ring_subtract(ring, ring->consume, ring->supply);
214 1.1 cgd }
215 1.1 cgd }
216 1.1 cgd
217 1.1 cgd /* number of CONSECUTIVE bytes that may be supplied */
218 1.1 cgd int
219 1.1 cgd ring_empty_consecutive(ring)
220 1.1 cgd Ring *ring;
221 1.1 cgd {
222 1.1 cgd if ((ring->consume < ring->supply) || ring_empty(ring)) {
223 1.1 cgd /*
224 1.1 cgd * if consume is "below" supply, or empty, then
225 1.1 cgd * return distance to the top
226 1.1 cgd */
227 1.1 cgd return ring_subtract(ring, ring->top, ring->supply);
228 1.1 cgd } else {
229 1.1 cgd /*
230 1.1 cgd * else, return what we may.
231 1.1 cgd */
232 1.1 cgd return ring_subtract(ring, ring->consume, ring->supply);
233 1.1 cgd }
234 1.1 cgd }
235 1.1 cgd
236 1.1 cgd /* Return the number of bytes that are available for consuming
237 1.1 cgd * (but don't give more than enough to get to cross over set mark)
238 1.1 cgd */
239 1.1 cgd
240 1.1 cgd int
241 1.1 cgd ring_full_count(ring)
242 1.1 cgd Ring *ring;
243 1.1 cgd {
244 1.1 cgd if ((ring->mark == 0) || (ring->mark == ring->consume)) {
245 1.1 cgd if (ring_full(ring)) {
246 1.1 cgd return ring->size; /* nothing consumed, but full */
247 1.1 cgd } else {
248 1.1 cgd return ring_subtract(ring, ring->supply, ring->consume);
249 1.1 cgd }
250 1.1 cgd } else {
251 1.1 cgd return ring_subtract(ring, ring->mark, ring->consume);
252 1.1 cgd }
253 1.1 cgd }
254 1.1 cgd
255 1.1 cgd /*
256 1.1 cgd * Return the number of CONSECUTIVE bytes available for consuming.
257 1.1 cgd * However, don't return more than enough to cross over set mark.
258 1.1 cgd */
259 1.1 cgd int
260 1.1 cgd ring_full_consecutive(ring)
261 1.1 cgd Ring *ring;
262 1.1 cgd {
263 1.1 cgd if ((ring->mark == 0) || (ring->mark == ring->consume)) {
264 1.1 cgd if ((ring->supply < ring->consume) || ring_full(ring)) {
265 1.1 cgd return ring_subtract(ring, ring->top, ring->consume);
266 1.1 cgd } else {
267 1.1 cgd return ring_subtract(ring, ring->supply, ring->consume);
268 1.1 cgd }
269 1.1 cgd } else {
270 1.1 cgd if (ring->mark < ring->consume) {
271 1.1 cgd return ring_subtract(ring, ring->top, ring->consume);
272 1.1 cgd } else { /* Else, distance to mark */
273 1.1 cgd return ring_subtract(ring, ring->mark, ring->consume);
274 1.1 cgd }
275 1.1 cgd }
276 1.1 cgd }
277 1.1 cgd
278 1.1 cgd /*
279 1.1 cgd * Move data into the "supply" portion of of the ring buffer.
280 1.1 cgd */
281 1.1 cgd void
282 1.1 cgd ring_supply_data(ring, buffer, count)
283 1.1 cgd Ring *ring;
284 1.1 cgd unsigned char *buffer;
285 1.1 cgd int count;
286 1.1 cgd {
287 1.1 cgd int i;
288 1.1 cgd
289 1.1 cgd while (count) {
290 1.1 cgd i = MIN(count, ring_empty_consecutive(ring));
291 1.5 jtk memmove(ring->supply, buffer, i);
292 1.1 cgd ring_supplied(ring, i);
293 1.1 cgd count -= i;
294 1.1 cgd buffer += i;
295 1.1 cgd }
296 1.1 cgd }
297 1.1 cgd
298 1.1 cgd #ifdef notdef
299 1.1 cgd
300 1.1 cgd /*
301 1.1 cgd * Move data from the "consume" portion of the ring buffer
302 1.1 cgd */
303 1.1 cgd void
304 1.1 cgd ring_consume_data(ring, buffer, count)
305 1.1 cgd Ring *ring;
306 1.1 cgd unsigned char *buffer;
307 1.1 cgd int count;
308 1.1 cgd {
309 1.1 cgd int i;
310 1.1 cgd
311 1.1 cgd while (count) {
312 1.1 cgd i = MIN(count, ring_full_consecutive(ring));
313 1.5 jtk memmove(buffer, ring->consume, i);
314 1.1 cgd ring_consumed(ring, i);
315 1.1 cgd count -= i;
316 1.1 cgd buffer += i;
317 1.1 cgd }
318 1.1 cgd }
319 1.1 cgd #endif
320 1.1 cgd
321