Home | History | Annotate | Line # | Download | only in telnet
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