Home | History | Annotate | Line # | Download | only in kern
cnmagic.c revision 1.2
      1  1.2  mrg /*	$NetBSD: cnmagic.c,v 1.2 2000/12/19 04:39:19 mrg Exp $	*/
      2  1.1  eeh 
      3  1.1  eeh /*
      4  1.1  eeh  * Copyright (c) 2000 Eduardo Horvath
      5  1.1  eeh  * All rights reserved.
      6  1.1  eeh  *
      7  1.1  eeh  * Redistribution and use in source and binary forms, with or without
      8  1.1  eeh  * modification, are permitted provided that the following conditions
      9  1.1  eeh  * are met:
     10  1.1  eeh  * 1. Redistributions of source code must retain the above copyright
     11  1.1  eeh  *    notice, this list of conditions and the following disclaimer.
     12  1.1  eeh  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  eeh  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  eeh  *    documentation and/or other materials provided with the distribution.
     15  1.1  eeh  * 3. All advertising materials mentioning features or use of this software
     16  1.1  eeh  *    must display the following acknowledgement:
     17  1.1  eeh  *      This product includes software developed by Eduardo Horvath.
     18  1.1  eeh  * 4. The name of the author may not be used to endorse or promote products
     19  1.1  eeh  *    derived from this software without specific prior written permission
     20  1.1  eeh  *
     21  1.1  eeh  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     22  1.1  eeh  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     23  1.1  eeh  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     24  1.1  eeh  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     25  1.1  eeh  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     26  1.1  eeh  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     27  1.1  eeh  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     28  1.1  eeh  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     29  1.1  eeh  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     30  1.1  eeh  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     31  1.1  eeh  */
     32  1.1  eeh 
     33  1.1  eeh #include <sys/param.h>
     34  1.1  eeh #include <sys/systm.h>
     35  1.2  mrg #include <sys/kernel.h>
     36  1.1  eeh 
     37  1.1  eeh #define ENCODE_STATE(c, n) (short)(((c)&0x1ff)|(((n)&0x7f)<<9))
     38  1.1  eeh 
     39  1.1  eeh static unsigned short cn_magic[CNS_LEN];
     40  1.1  eeh 
     41  1.1  eeh /*
     42  1.1  eeh  * Initialize a cnm_state_t.
     43  1.1  eeh  */
     44  1.1  eeh void
     45  1.1  eeh cn_init_magic(cnm_state_t *cnm) {
     46  1.1  eeh 	cnm->cnm_state = 0;
     47  1.1  eeh 	cnm->cnm_magic = cn_magic;
     48  1.1  eeh }
     49  1.1  eeh 
     50  1.1  eeh /*
     51  1.1  eeh  * Destroy a cnm_state_t.
     52  1.1  eeh  */
     53  1.1  eeh void
     54  1.1  eeh cn_destroy_magic(cnm_state_t *cnm) {
     55  1.1  eeh 	cnm->cnm_state = 0;
     56  1.1  eeh 	cnm->cnm_magic = NULL;
     57  1.1  eeh }
     58  1.1  eeh 
     59  1.1  eeh /*
     60  1.1  eeh  * Translate a magic string to a state
     61  1.1  eeh  * machine table.
     62  1.1  eeh  */
     63  1.1  eeh int
     64  1.1  eeh cn_set_magic(char *magic)
     65  1.1  eeh {
     66  1.1  eeh 	unsigned int i, c, n;
     67  1.1  eeh 	unsigned short m[CNS_LEN];
     68  1.1  eeh 
     69  1.1  eeh 	for (i=0; i<CNS_LEN; i++) {
     70  1.1  eeh 		c = (*magic++)&0xff;
     71  1.1  eeh 		n = *magic ? i+1 : CNS_TERM;
     72  1.1  eeh 		switch (c) {
     73  1.1  eeh 		case 0:
     74  1.1  eeh 			/* End of string */
     75  1.1  eeh 			if (i == 0) {
     76  1.1  eeh 				/* empty string? */
     77  1.1  eeh 				cn_magic[0] = 0;
     78  1.1  eeh #ifdef DEBUG
     79  1.1  eeh 				printf("cn_set_magic(): empty!\n");
     80  1.1  eeh #endif
     81  1.1  eeh 				return (0);
     82  1.1  eeh 			}
     83  1.1  eeh 			do {
     84  1.1  eeh 				cn_magic[i] = m[i];
     85  1.1  eeh 			} while (i--);
     86  1.1  eeh 			return(0);
     87  1.1  eeh 		case 0x27:
     88  1.1  eeh 			/* Escape sequence */
     89  1.1  eeh 			c = (*magic++)&0xff;
     90  1.1  eeh 			n = *magic ? i+1 : CNS_TERM;
     91  1.1  eeh 			switch (c) {
     92  1.1  eeh 			case 0x27:
     93  1.1  eeh 				break;
     94  1.1  eeh 			case 0x01:
     95  1.1  eeh 				/* BREAK */
     96  1.1  eeh 				c = CNC_BREAK;
     97  1.1  eeh 				break;
     98  1.1  eeh 			case 0x02:
     99  1.1  eeh 				/* NUL */
    100  1.1  eeh 				c = 0;
    101  1.1  eeh 				break;
    102  1.1  eeh 			}
    103  1.1  eeh 			/* FALLTHROUGH */
    104  1.1  eeh 		default:
    105  1.1  eeh 			/* Transition to the next state. */
    106  1.1  eeh #ifdef DEBUG
    107  1.2  mrg 			if (!cold)
    108  1.2  mrg 				printf("mag %d %x:%x\n", i, c, n);
    109  1.1  eeh #endif
    110  1.1  eeh 			m[i] = ENCODE_STATE(c, n);
    111  1.1  eeh 			break;
    112  1.1  eeh 		}
    113  1.1  eeh 	}
    114  1.1  eeh 	return (EINVAL);
    115  1.1  eeh }
    116  1.1  eeh 
    117  1.1  eeh /*
    118  1.1  eeh  * Translatea state machine table back to
    119  1.1  eeh  * a magic string.
    120  1.1  eeh  */
    121  1.1  eeh int
    122  1.1  eeh cn_get_magic(char *magic, int maglen) {
    123  1.1  eeh 	unsigned int i, c;
    124  1.1  eeh 
    125  1.1  eeh 	for (i=0; i<CNS_LEN; i++) {
    126  1.1  eeh 		c = cn_magic[i];
    127  1.1  eeh 		/* Translate a character */
    128  1.1  eeh 		switch (CNS_MAGIC_VAL(c)) {
    129  1.1  eeh 		case CNC_BREAK:
    130  1.1  eeh 			*magic++ = 0x27;
    131  1.1  eeh 			*magic++ = 0x01;
    132  1.1  eeh 			break;
    133  1.1  eeh 		case 0:
    134  1.1  eeh 			*magic++ = 0x27;
    135  1.1  eeh 			*magic++ = 0x02;
    136  1.1  eeh 			break;
    137  1.1  eeh 		case 0x27:
    138  1.1  eeh 			*magic++ = 0x27;
    139  1.1  eeh 			*magic++ = 0x27;
    140  1.1  eeh 			break;
    141  1.1  eeh 		default:
    142  1.1  eeh 			*magic++ = (c&0x0ff);
    143  1.1  eeh 			break;
    144  1.1  eeh 		}
    145  1.1  eeh 		/* Now go to the next state */
    146  1.1  eeh 		i = CNS_MAGIC_NEXT(c);
    147  1.1  eeh 		if (i == CNS_TERM || i == 0) {
    148  1.1  eeh 			/* Either termination state or empty machine */
    149  1.1  eeh 			*magic++ = 0;
    150  1.1  eeh 			return (0);
    151  1.1  eeh 		}
    152  1.1  eeh 	}
    153  1.1  eeh 	return (EINVAL);
    154  1.1  eeh }
    155  1.1  eeh 
    156