cnmagic.c revision 1.12 1 1.12 christos /* $NetBSD: cnmagic.c,v 1.12 2011/11/19 16:11:24 christos 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 *
16 1.1 eeh * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 eeh * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 eeh * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 eeh * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 eeh * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 1.1 eeh * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 1.1 eeh * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 1.1 eeh * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 1.1 eeh * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 1.1 eeh * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 1.1 eeh */
27 1.3 lukem
28 1.3 lukem #include <sys/cdefs.h>
29 1.12 christos __KERNEL_RCSID(0, "$NetBSD: cnmagic.c,v 1.12 2011/11/19 16:11:24 christos Exp $");
30 1.1 eeh
31 1.1 eeh #include <sys/param.h>
32 1.1 eeh #include <sys/systm.h>
33 1.2 mrg #include <sys/kernel.h>
34 1.1 eeh
35 1.1 eeh #define ENCODE_STATE(c, n) (short)(((c)&0x1ff)|(((n)&0x7f)<<9))
36 1.1 eeh
37 1.1 eeh static unsigned short cn_magic[CNS_LEN];
38 1.1 eeh
39 1.1 eeh /*
40 1.1 eeh * Initialize a cnm_state_t.
41 1.1 eeh */
42 1.1 eeh void
43 1.5 junyoung cn_init_magic(cnm_state_t *cnm)
44 1.5 junyoung {
45 1.1 eeh cnm->cnm_state = 0;
46 1.1 eeh cnm->cnm_magic = cn_magic;
47 1.1 eeh }
48 1.1 eeh
49 1.1 eeh /*
50 1.1 eeh * Destroy a cnm_state_t.
51 1.1 eeh */
52 1.1 eeh void
53 1.5 junyoung cn_destroy_magic(cnm_state_t *cnm)
54 1.5 junyoung {
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.12 christos cn_set_magic(const char *smagic)
65 1.1 eeh {
66 1.12 christos const unsigned char *magic = (const unsigned char *)smagic;
67 1.12 christos unsigned short i, c, n;
68 1.1 eeh unsigned short m[CNS_LEN];
69 1.1 eeh
70 1.5 junyoung for (i = 0; i < CNS_LEN; i++) {
71 1.12 christos c = *magic++;
72 1.12 christos if (c == '\0')
73 1.12 christos return EINVAL;
74 1.12 christos n = *magic ? i + 1 : CNS_TERM;
75 1.1 eeh switch (c) {
76 1.12 christos case '\0':
77 1.1 eeh /* End of string */
78 1.1 eeh if (i == 0) {
79 1.1 eeh /* empty string? */
80 1.1 eeh cn_magic[0] = 0;
81 1.1 eeh #ifdef DEBUG
82 1.1 eeh printf("cn_set_magic(): empty!\n");
83 1.1 eeh #endif
84 1.12 christos return 0;
85 1.1 eeh }
86 1.12 christos do
87 1.1 eeh cn_magic[i] = m[i];
88 1.12 christos while (i--);
89 1.12 christos return 0;
90 1.12 christos
91 1.12 christos case '\'':
92 1.1 eeh /* Escape sequence */
93 1.12 christos c = *magic++;
94 1.12 christos if (c == '\0')
95 1.12 christos return EINVAL;
96 1.12 christos n = *magic ? i + 1 : CNS_TERM;
97 1.1 eeh switch (c) {
98 1.12 christos case '\'':
99 1.1 eeh break;
100 1.1 eeh case 0x01:
101 1.1 eeh /* BREAK */
102 1.1 eeh c = CNC_BREAK;
103 1.1 eeh break;
104 1.1 eeh case 0x02:
105 1.1 eeh /* NUL */
106 1.12 christos c = '\0';
107 1.1 eeh break;
108 1.1 eeh }
109 1.12 christos /*FALLTHROUGH*/
110 1.1 eeh default:
111 1.1 eeh /* Transition to the next state. */
112 1.1 eeh #ifdef DEBUG
113 1.2 mrg if (!cold)
114 1.11 hubertf aprint_normal("mag %d %x:%x\n", i, c, n);
115 1.1 eeh #endif
116 1.1 eeh m[i] = ENCODE_STATE(c, n);
117 1.1 eeh break;
118 1.1 eeh }
119 1.5 junyoung }
120 1.12 christos return EINVAL;
121 1.1 eeh }
122 1.1 eeh
123 1.1 eeh /*
124 1.1 eeh * Translatea state machine table back to
125 1.1 eeh * a magic string.
126 1.1 eeh */
127 1.5 junyoung int
128 1.9 yamt cn_get_magic(char *magic, size_t maglen)
129 1.5 junyoung {
130 1.6 christos size_t i, c;
131 1.5 junyoung
132 1.5 junyoung for (i = 0; i < CNS_LEN;) {
133 1.1 eeh c = cn_magic[i];
134 1.1 eeh /* Translate a character */
135 1.1 eeh switch (CNS_MAGIC_VAL(c)) {
136 1.1 eeh case CNC_BREAK:
137 1.1 eeh *magic++ = 0x27;
138 1.1 eeh *magic++ = 0x01;
139 1.1 eeh break;
140 1.1 eeh case 0:
141 1.1 eeh *magic++ = 0x27;
142 1.1 eeh *magic++ = 0x02;
143 1.1 eeh break;
144 1.1 eeh case 0x27:
145 1.1 eeh *magic++ = 0x27;
146 1.1 eeh *magic++ = 0x27;
147 1.1 eeh break;
148 1.1 eeh default:
149 1.5 junyoung *magic++ = (c & 0x0ff);
150 1.1 eeh break;
151 1.1 eeh }
152 1.1 eeh /* Now go to the next state */
153 1.1 eeh i = CNS_MAGIC_NEXT(c);
154 1.1 eeh if (i == CNS_TERM || i == 0) {
155 1.1 eeh /* Either termination state or empty machine */
156 1.1 eeh *magic++ = 0;
157 1.1 eeh return (0);
158 1.1 eeh }
159 1.1 eeh }
160 1.1 eeh return (EINVAL);
161 1.1 eeh }
162 1.1 eeh
163