xref: /freebsd/crypto/heimdal/appl/telnet/telnet/ring.c (revision c19800e8)
113e3f4d6SMark Murray /*
213e3f4d6SMark Murray  * Copyright (c) 1988, 1993
313e3f4d6SMark Murray  *	The Regents of the University of California.  All rights reserved.
413e3f4d6SMark Murray  *
513e3f4d6SMark Murray  * Redistribution and use in source and binary forms, with or without
613e3f4d6SMark Murray  * modification, are permitted provided that the following conditions
713e3f4d6SMark Murray  * are met:
813e3f4d6SMark Murray  * 1. Redistributions of source code must retain the above copyright
913e3f4d6SMark Murray  *    notice, this list of conditions and the following disclaimer.
1013e3f4d6SMark Murray  * 2. Redistributions in binary form must reproduce the above copyright
1113e3f4d6SMark Murray  *    notice, this list of conditions and the following disclaimer in the
1213e3f4d6SMark Murray  *    documentation and/or other materials provided with the distribution.
1313e3f4d6SMark Murray  * 3. All advertising materials mentioning features or use of this software
1413e3f4d6SMark Murray  *    must display the following acknowledgement:
1513e3f4d6SMark Murray  *	This product includes software developed by the University of
1613e3f4d6SMark Murray  *	California, Berkeley and its contributors.
1713e3f4d6SMark Murray  * 4. Neither the name of the University nor the names of its contributors
1813e3f4d6SMark Murray  *    may be used to endorse or promote products derived from this software
1913e3f4d6SMark Murray  *    without specific prior written permission.
2013e3f4d6SMark Murray  *
2113e3f4d6SMark Murray  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
2213e3f4d6SMark Murray  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
2313e3f4d6SMark Murray  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
2413e3f4d6SMark Murray  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
2513e3f4d6SMark Murray  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2613e3f4d6SMark Murray  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2713e3f4d6SMark Murray  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2813e3f4d6SMark Murray  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2913e3f4d6SMark Murray  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
3013e3f4d6SMark Murray  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
3113e3f4d6SMark Murray  * SUCH DAMAGE.
3213e3f4d6SMark Murray  */
3313e3f4d6SMark Murray 
3413e3f4d6SMark Murray #include "telnet_locl.h"
3513e3f4d6SMark Murray 
36c19800e8SDoug Rabson RCSID("$Id$");
3713e3f4d6SMark Murray 
3813e3f4d6SMark Murray /*
3913e3f4d6SMark Murray  * This defines a structure for a ring buffer.
4013e3f4d6SMark Murray  *
4113e3f4d6SMark Murray  * The circular buffer has two parts:
4213e3f4d6SMark Murray  *(((
4313e3f4d6SMark Murray  *	full:	[consume, supply)
4413e3f4d6SMark Murray  *	empty:	[supply, consume)
4513e3f4d6SMark Murray  *]]]
4613e3f4d6SMark Murray  *
4713e3f4d6SMark Murray  */
4813e3f4d6SMark Murray 
4913e3f4d6SMark Murray /* Internal macros */
5013e3f4d6SMark Murray 
5113e3f4d6SMark Murray #define	ring_subtract(d,a,b)	(((a)-(b) >= 0)? \
5213e3f4d6SMark Murray 					(a)-(b): (((a)-(b))+(d)->size))
5313e3f4d6SMark Murray 
5413e3f4d6SMark Murray #define	ring_increment(d,a,c)	(((a)+(c) < (d)->top)? \
5513e3f4d6SMark Murray 					(a)+(c) : (((a)+(c))-(d)->size))
5613e3f4d6SMark Murray 
5713e3f4d6SMark Murray #define	ring_decrement(d,a,c)	(((a)-(c) >= (d)->bottom)? \
5813e3f4d6SMark Murray 					(a)-(c) : (((a)-(c))-(d)->size))
5913e3f4d6SMark Murray 
6013e3f4d6SMark Murray 
6113e3f4d6SMark Murray /*
6213e3f4d6SMark Murray  * The following is a clock, used to determine full, empty, etc.
6313e3f4d6SMark Murray  *
6413e3f4d6SMark Murray  * There is some trickiness here.  Since the ring buffers are initialized
6513e3f4d6SMark Murray  * to ZERO on allocation, we need to make sure, when interpreting the
6613e3f4d6SMark Murray  * clock, that when the times are EQUAL, then the buffer is FULL.
6713e3f4d6SMark Murray  */
6813e3f4d6SMark Murray static u_long ring_clock = 0;
6913e3f4d6SMark Murray 
7013e3f4d6SMark Murray 
7113e3f4d6SMark Murray #define	ring_empty(d) (((d)->consume == (d)->supply) && \
7213e3f4d6SMark Murray 				((d)->consumetime >= (d)->supplytime))
7313e3f4d6SMark Murray #define	ring_full(d) (((d)->supply == (d)->consume) && \
7413e3f4d6SMark Murray 				((d)->supplytime > (d)->consumetime))
7513e3f4d6SMark Murray 
7613e3f4d6SMark Murray 
7713e3f4d6SMark Murray 
7813e3f4d6SMark Murray 
7913e3f4d6SMark Murray 
8013e3f4d6SMark Murray /* Buffer state transition routines */
8113e3f4d6SMark Murray 
8213e3f4d6SMark Murray int
ring_init(Ring * ring,unsigned char * buffer,int count)8313e3f4d6SMark Murray ring_init(Ring *ring, unsigned char *buffer, int count)
8413e3f4d6SMark Murray {
8513e3f4d6SMark Murray     memset(ring, 0, sizeof *ring);
8613e3f4d6SMark Murray 
8713e3f4d6SMark Murray     ring->size = count;
8813e3f4d6SMark Murray 
8913e3f4d6SMark Murray     ring->supply = ring->consume = ring->bottom = buffer;
9013e3f4d6SMark Murray 
9113e3f4d6SMark Murray     ring->top = ring->bottom+ring->size;
9213e3f4d6SMark Murray 
9313e3f4d6SMark Murray #if	defined(ENCRYPTION)
9413e3f4d6SMark Murray     ring->clearto = 0;
9513e3f4d6SMark Murray #endif
9613e3f4d6SMark Murray 
9713e3f4d6SMark Murray     return 1;
9813e3f4d6SMark Murray }
9913e3f4d6SMark Murray 
10013e3f4d6SMark Murray /* Mark routines */
10113e3f4d6SMark Murray 
10213e3f4d6SMark Murray /*
10313e3f4d6SMark Murray  * Mark the most recently supplied byte.
10413e3f4d6SMark Murray  */
10513e3f4d6SMark Murray 
10613e3f4d6SMark Murray void
ring_mark(Ring * ring)10713e3f4d6SMark Murray ring_mark(Ring *ring)
10813e3f4d6SMark Murray {
10913e3f4d6SMark Murray     ring->mark = ring_decrement(ring, ring->supply, 1);
11013e3f4d6SMark Murray }
11113e3f4d6SMark Murray 
11213e3f4d6SMark Murray /*
11313e3f4d6SMark Murray  * Is the ring pointing to the mark?
11413e3f4d6SMark Murray  */
11513e3f4d6SMark Murray 
11613e3f4d6SMark Murray int
ring_at_mark(Ring * ring)11713e3f4d6SMark Murray ring_at_mark(Ring *ring)
11813e3f4d6SMark Murray {
11913e3f4d6SMark Murray     if (ring->mark == ring->consume) {
12013e3f4d6SMark Murray 	return 1;
12113e3f4d6SMark Murray     } else {
12213e3f4d6SMark Murray 	return 0;
12313e3f4d6SMark Murray     }
12413e3f4d6SMark Murray }
12513e3f4d6SMark Murray 
12613e3f4d6SMark Murray /*
12713e3f4d6SMark Murray  * Clear any mark set on the ring.
12813e3f4d6SMark Murray  */
12913e3f4d6SMark Murray 
13013e3f4d6SMark Murray void
ring_clear_mark(Ring * ring)13113e3f4d6SMark Murray ring_clear_mark(Ring *ring)
13213e3f4d6SMark Murray {
13313e3f4d6SMark Murray     ring->mark = 0;
13413e3f4d6SMark Murray }
13513e3f4d6SMark Murray 
13613e3f4d6SMark Murray /*
13713e3f4d6SMark Murray  * Add characters from current segment to ring buffer.
13813e3f4d6SMark Murray  */
13913e3f4d6SMark Murray void
ring_supplied(Ring * ring,int count)14013e3f4d6SMark Murray ring_supplied(Ring *ring, int count)
14113e3f4d6SMark Murray {
14213e3f4d6SMark Murray     ring->supply = ring_increment(ring, ring->supply, count);
14313e3f4d6SMark Murray     ring->supplytime = ++ring_clock;
14413e3f4d6SMark Murray }
14513e3f4d6SMark Murray 
14613e3f4d6SMark Murray /*
14713e3f4d6SMark Murray  * We have just consumed "c" bytes.
14813e3f4d6SMark Murray  */
14913e3f4d6SMark Murray void
ring_consumed(Ring * ring,int count)15013e3f4d6SMark Murray ring_consumed(Ring *ring, int count)
15113e3f4d6SMark Murray {
15213e3f4d6SMark Murray     if (count == 0)	/* don't update anything */
15313e3f4d6SMark Murray 	return;
15413e3f4d6SMark Murray 
15513e3f4d6SMark Murray     if (ring->mark &&
15613e3f4d6SMark Murray 		(ring_subtract(ring, ring->mark, ring->consume) < count)) {
15713e3f4d6SMark Murray 	ring->mark = 0;
15813e3f4d6SMark Murray     }
15913e3f4d6SMark Murray #if	defined(ENCRYPTION)
16013e3f4d6SMark Murray     if (ring->consume < ring->clearto &&
16113e3f4d6SMark Murray 		ring->clearto <= ring->consume + count)
16213e3f4d6SMark Murray 	ring->clearto = 0;
16313e3f4d6SMark Murray     else if (ring->consume + count > ring->top &&
16413e3f4d6SMark Murray 		ring->bottom <= ring->clearto &&
16513e3f4d6SMark Murray 		ring->bottom + ((ring->consume + count) - ring->top))
16613e3f4d6SMark Murray 	ring->clearto = 0;
16713e3f4d6SMark Murray #endif
16813e3f4d6SMark Murray     ring->consume = ring_increment(ring, ring->consume, count);
16913e3f4d6SMark Murray     ring->consumetime = ++ring_clock;
17013e3f4d6SMark Murray     /*
17113e3f4d6SMark Murray      * Try to encourage "ring_empty_consecutive()" to be large.
17213e3f4d6SMark Murray      */
17313e3f4d6SMark Murray     if (ring_empty(ring)) {
17413e3f4d6SMark Murray 	ring->consume = ring->supply = ring->bottom;
17513e3f4d6SMark Murray     }
17613e3f4d6SMark Murray }
17713e3f4d6SMark Murray 
17813e3f4d6SMark Murray 
17913e3f4d6SMark Murray 
18013e3f4d6SMark Murray /* Buffer state query routines */
18113e3f4d6SMark Murray 
18213e3f4d6SMark Murray 
18313e3f4d6SMark Murray /* Number of bytes that may be supplied */
18413e3f4d6SMark Murray int
ring_empty_count(Ring * ring)18513e3f4d6SMark Murray ring_empty_count(Ring *ring)
18613e3f4d6SMark Murray {
18713e3f4d6SMark Murray     if (ring_empty(ring)) {	/* if empty */
18813e3f4d6SMark Murray 	    return ring->size;
18913e3f4d6SMark Murray     } else {
19013e3f4d6SMark Murray 	return ring_subtract(ring, ring->consume, ring->supply);
19113e3f4d6SMark Murray     }
19213e3f4d6SMark Murray }
19313e3f4d6SMark Murray 
19413e3f4d6SMark Murray /* number of CONSECUTIVE bytes that may be supplied */
19513e3f4d6SMark Murray int
ring_empty_consecutive(Ring * ring)19613e3f4d6SMark Murray ring_empty_consecutive(Ring *ring)
19713e3f4d6SMark Murray {
19813e3f4d6SMark Murray     if ((ring->consume < ring->supply) || ring_empty(ring)) {
19913e3f4d6SMark Murray 			    /*
20013e3f4d6SMark Murray 			     * if consume is "below" supply, or empty, then
20113e3f4d6SMark Murray 			     * return distance to the top
20213e3f4d6SMark Murray 			     */
20313e3f4d6SMark Murray 	return ring_subtract(ring, ring->top, ring->supply);
20413e3f4d6SMark Murray     } else {
20513e3f4d6SMark Murray 				    /*
20613e3f4d6SMark Murray 				     * else, return what we may.
20713e3f4d6SMark Murray 				     */
20813e3f4d6SMark Murray 	return ring_subtract(ring, ring->consume, ring->supply);
20913e3f4d6SMark Murray     }
21013e3f4d6SMark Murray }
21113e3f4d6SMark Murray 
21213e3f4d6SMark Murray /* Return the number of bytes that are available for consuming
21313e3f4d6SMark Murray  * (but don't give more than enough to get to cross over set mark)
21413e3f4d6SMark Murray  */
21513e3f4d6SMark Murray 
21613e3f4d6SMark Murray int
ring_full_count(Ring * ring)21713e3f4d6SMark Murray ring_full_count(Ring *ring)
21813e3f4d6SMark Murray {
21913e3f4d6SMark Murray     if ((ring->mark == 0) || (ring->mark == ring->consume)) {
22013e3f4d6SMark Murray 	if (ring_full(ring)) {
22113e3f4d6SMark Murray 	    return ring->size;	/* nothing consumed, but full */
22213e3f4d6SMark Murray 	} else {
22313e3f4d6SMark Murray 	    return ring_subtract(ring, ring->supply, ring->consume);
22413e3f4d6SMark Murray 	}
22513e3f4d6SMark Murray     } else {
22613e3f4d6SMark Murray 	return ring_subtract(ring, ring->mark, ring->consume);
22713e3f4d6SMark Murray     }
22813e3f4d6SMark Murray }
22913e3f4d6SMark Murray 
23013e3f4d6SMark Murray /*
23113e3f4d6SMark Murray  * Return the number of CONSECUTIVE bytes available for consuming.
23213e3f4d6SMark Murray  * However, don't return more than enough to cross over set mark.
23313e3f4d6SMark Murray  */
23413e3f4d6SMark Murray int
ring_full_consecutive(Ring * ring)23513e3f4d6SMark Murray ring_full_consecutive(Ring *ring)
23613e3f4d6SMark Murray {
23713e3f4d6SMark Murray     if ((ring->mark == 0) || (ring->mark == ring->consume)) {
23813e3f4d6SMark Murray 	if ((ring->supply < ring->consume) || ring_full(ring)) {
23913e3f4d6SMark Murray 	    return ring_subtract(ring, ring->top, ring->consume);
24013e3f4d6SMark Murray 	} else {
24113e3f4d6SMark Murray 	    return ring_subtract(ring, ring->supply, ring->consume);
24213e3f4d6SMark Murray 	}
24313e3f4d6SMark Murray     } else {
24413e3f4d6SMark Murray 	if (ring->mark < ring->consume) {
24513e3f4d6SMark Murray 	    return ring_subtract(ring, ring->top, ring->consume);
24613e3f4d6SMark Murray 	} else {	/* Else, distance to mark */
24713e3f4d6SMark Murray 	    return ring_subtract(ring, ring->mark, ring->consume);
24813e3f4d6SMark Murray 	}
24913e3f4d6SMark Murray     }
25013e3f4d6SMark Murray }
25113e3f4d6SMark Murray 
25213e3f4d6SMark Murray /*
25313e3f4d6SMark Murray  * Move data into the "supply" portion of of the ring buffer.
25413e3f4d6SMark Murray  */
25513e3f4d6SMark Murray void
ring_supply_data(Ring * ring,unsigned char * buffer,int count)25613e3f4d6SMark Murray ring_supply_data(Ring *ring, unsigned char *buffer, int count)
25713e3f4d6SMark Murray {
25813e3f4d6SMark Murray     int i;
25913e3f4d6SMark Murray 
26013e3f4d6SMark Murray     while (count) {
26113e3f4d6SMark Murray 	i = min(count, ring_empty_consecutive(ring));
26213e3f4d6SMark Murray 	memmove(ring->supply, buffer, i);
26313e3f4d6SMark Murray 	ring_supplied(ring, i);
26413e3f4d6SMark Murray 	count -= i;
26513e3f4d6SMark Murray 	buffer += i;
26613e3f4d6SMark Murray     }
26713e3f4d6SMark Murray }
26813e3f4d6SMark Murray 
26913e3f4d6SMark Murray #ifdef notdef
27013e3f4d6SMark Murray 
27113e3f4d6SMark Murray /*
27213e3f4d6SMark Murray  * Move data from the "consume" portion of the ring buffer
27313e3f4d6SMark Murray  */
27413e3f4d6SMark Murray void
ring_consume_data(Ring * ring,unsigned char * buffer,int count)27513e3f4d6SMark Murray ring_consume_data(Ring *ring, unsigned char *buffer, int count)
27613e3f4d6SMark Murray {
27713e3f4d6SMark Murray     int i;
27813e3f4d6SMark Murray 
27913e3f4d6SMark Murray     while (count) {
28013e3f4d6SMark Murray 	i = min(count, ring_full_consecutive(ring));
28113e3f4d6SMark Murray 	memmove(buffer, ring->consume, i);
28213e3f4d6SMark Murray 	ring_consumed(ring, i);
28313e3f4d6SMark Murray 	count -= i;
28413e3f4d6SMark Murray 	buffer += i;
28513e3f4d6SMark Murray     }
28613e3f4d6SMark Murray }
28713e3f4d6SMark Murray #endif
28813e3f4d6SMark Murray 
28913e3f4d6SMark Murray #if	defined(ENCRYPTION)
29013e3f4d6SMark Murray void
ring_encrypt(Ring * ring,void (* encryptor)(unsigned char *,int))29113e3f4d6SMark Murray ring_encrypt(Ring *ring, void (*encryptor)(unsigned char *, int))
29213e3f4d6SMark Murray {
29313e3f4d6SMark Murray     unsigned char *s, *c;
29413e3f4d6SMark Murray 
29513e3f4d6SMark Murray     if (ring_empty(ring) || ring->clearto == ring->supply)
29613e3f4d6SMark Murray 	return;
29713e3f4d6SMark Murray 
29813e3f4d6SMark Murray     if (!(c = ring->clearto))
29913e3f4d6SMark Murray 	c = ring->consume;
30013e3f4d6SMark Murray 
30113e3f4d6SMark Murray     s = ring->supply;
30213e3f4d6SMark Murray 
30313e3f4d6SMark Murray     if (s <= c) {
30413e3f4d6SMark Murray 	(*encryptor)(c, ring->top - c);
30513e3f4d6SMark Murray 	(*encryptor)(ring->bottom, s - ring->bottom);
30613e3f4d6SMark Murray     } else
30713e3f4d6SMark Murray 	(*encryptor)(c, s - c);
30813e3f4d6SMark Murray 
30913e3f4d6SMark Murray     ring->clearto = ring->supply;
31013e3f4d6SMark Murray }
31113e3f4d6SMark Murray 
31213e3f4d6SMark Murray void
ring_clearto(Ring * ring)31313e3f4d6SMark Murray ring_clearto(Ring *ring)
31413e3f4d6SMark Murray {
31513e3f4d6SMark Murray     if (!ring_empty(ring))
31613e3f4d6SMark Murray 	ring->clearto = ring->supply;
31713e3f4d6SMark Murray     else
31813e3f4d6SMark Murray 	ring->clearto = 0;
31913e3f4d6SMark Murray }
32013e3f4d6SMark Murray #endif
32113e3f4d6SMark Murray 
322