kd.c revision 1.1 1 1.1 eeh /* $NetBSD: kd.c,v 1.1 1998/06/20 04:58:51 eeh Exp $ */
2 1.1 eeh
3 1.1 eeh /*-
4 1.1 eeh * Copyright (c) 1996 The NetBSD Foundation, Inc.
5 1.1 eeh * All rights reserved.
6 1.1 eeh *
7 1.1 eeh * This code is derived from software contributed to The NetBSD Foundation
8 1.1 eeh * by Gordon W. Ross.
9 1.1 eeh *
10 1.1 eeh * Redistribution and use in source and binary forms, with or without
11 1.1 eeh * modification, are permitted provided that the following conditions
12 1.1 eeh * are met:
13 1.1 eeh * 1. Redistributions of source code must retain the above copyright
14 1.1 eeh * notice, this list of conditions and the following disclaimer.
15 1.1 eeh * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 eeh * notice, this list of conditions and the following disclaimer in the
17 1.1 eeh * documentation and/or other materials provided with the distribution.
18 1.1 eeh * 3. All advertising materials mentioning features or use of this software
19 1.1 eeh * must display the following acknowledgement:
20 1.1 eeh * This product includes software developed by the NetBSD
21 1.1 eeh * Foundation, Inc. and its contributors.
22 1.1 eeh * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 eeh * contributors may be used to endorse or promote products derived
24 1.1 eeh * from this software without specific prior written permission.
25 1.1 eeh *
26 1.1 eeh * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 eeh * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 eeh * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 eeh * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 eeh * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 eeh * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 eeh * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 eeh * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 eeh * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 eeh * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 eeh * POSSIBILITY OF SUCH DAMAGE.
37 1.1 eeh */
38 1.1 eeh
39 1.1 eeh /*
40 1.1 eeh * Keyboard/Display device.
41 1.1 eeh *
42 1.1 eeh * This driver exists simply to provide a tty device that
43 1.1 eeh * the indirect console driver can point to.
44 1.1 eeh * The kbd driver sends its input here.
45 1.1 eeh * Output goes to the screen via PROM printf.
46 1.1 eeh */
47 1.1 eeh
48 1.1 eeh #include <sys/param.h>
49 1.1 eeh #include <sys/proc.h>
50 1.1 eeh #include <sys/systm.h>
51 1.1 eeh #include <sys/ioctl.h>
52 1.1 eeh #include <sys/tty.h>
53 1.1 eeh #include <sys/file.h>
54 1.1 eeh #include <sys/conf.h>
55 1.1 eeh #include <sys/device.h>
56 1.1 eeh
57 1.1 eeh #include <machine/openfirm.h>
58 1.1 eeh #include <machine/eeprom.h>
59 1.1 eeh #include <machine/psl.h>
60 1.1 eeh #include <machine/cpu.h>
61 1.1 eeh #include <machine/kbd.h>
62 1.1 eeh #include <machine/autoconf.h>
63 1.1 eeh #include <machine/conf.h>
64 1.1 eeh
65 1.1 eeh #ifdef RASTERCONSOLE
66 1.1 eeh #include <machine/fbio.h>
67 1.1 eeh #include <machine/fbvar.h>
68 1.1 eeh #endif
69 1.1 eeh
70 1.1 eeh
71 1.1 eeh #include <dev/cons.h>
72 1.1 eeh #include <dev/sun/kbd_xlate.h>
73 1.1 eeh #include <sparc64/dev/cons.h>
74 1.1 eeh
75 1.1 eeh struct tty *fbconstty = 0; /* tty structure for frame buffer console */
76 1.1 eeh int cnrom __P((void));
77 1.1 eeh void cnrint __P((void));
78 1.1 eeh
79 1.1 eeh #define KDMAJOR 1
80 1.1 eeh #define PUT_WSIZE 64
81 1.1 eeh
82 1.1 eeh struct kd_softc {
83 1.1 eeh struct device kd_dev; /* required first: base device */
84 1.1 eeh struct tty *kd_tty;
85 1.1 eeh int rows, cols;
86 1.1 eeh };
87 1.1 eeh
88 1.1 eeh /*
89 1.1 eeh * There is no point in pretending there might be
90 1.1 eeh * more than one keyboard/display device.
91 1.1 eeh */
92 1.1 eeh static struct kd_softc kd_softc;
93 1.1 eeh static int kd_is_console;
94 1.1 eeh
95 1.1 eeh static int kdparam(struct tty *, struct termios *);
96 1.1 eeh static void kdstart(struct tty *);
97 1.1 eeh
98 1.1 eeh int rom_console_input; /* when set, hardclock calls cnrom() */
99 1.1 eeh int cons_ocount; /* output byte count */
100 1.1 eeh
101 1.1 eeh /* Now talking directly to the zs, so this is not needed. */
102 1.1 eeh int
103 1.1 eeh cnrom()
104 1.1 eeh {
105 1.1 eeh return (0);
106 1.1 eeh }
107 1.1 eeh void
108 1.1 eeh cnrint()
109 1.1 eeh {
110 1.1 eeh }
111 1.1 eeh
112 1.1 eeh /*
113 1.1 eeh * This is called by kbd_attach()
114 1.1 eeh * XXX - Make this a proper child of kbd?
115 1.1 eeh */
116 1.1 eeh void
117 1.1 eeh kd_init(unit)
118 1.1 eeh int unit;
119 1.1 eeh {
120 1.1 eeh struct kd_softc *kd;
121 1.1 eeh struct tty *tp;
122 1.1 eeh
123 1.1 eeh if (unit != 0)
124 1.1 eeh return;
125 1.1 eeh kd = &kd_softc; /* XXX */
126 1.1 eeh
127 1.1 eeh tp = ttymalloc();
128 1.1 eeh tp->t_oproc = kdstart;
129 1.1 eeh tp->t_param = kdparam;
130 1.1 eeh tp->t_dev = makedev(KDMAJOR, unit);
131 1.1 eeh
132 1.1 eeh #if 1 /* XXX - Why? */
133 1.1 eeh clalloc(&tp->t_rawq, 1024, 1);
134 1.1 eeh clalloc(&tp->t_canq, 1024, 1);
135 1.1 eeh /* output queue doesn't need quoting */
136 1.1 eeh clalloc(&tp->t_outq, 1024, 0);
137 1.1 eeh #endif
138 1.1 eeh
139 1.1 eeh tty_attach(tp);
140 1.1 eeh kd->kd_tty = tp;
141 1.1 eeh
142 1.1 eeh /*
143 1.1 eeh * get the console struct winsize.
144 1.1 eeh */
145 1.1 eeh if (kd_is_console) {
146 1.1 eeh fbconstty = tp;
147 1.1 eeh #ifdef RASTERCONSOLE
148 1.1 eeh kd->rows = fbrcons_rows();
149 1.1 eeh kd->cols = fbrcons_cols();
150 1.1 eeh #endif
151 1.1 eeh }
152 1.1 eeh
153 1.1 eeh if (CPU_ISSUN4COR4M) {
154 1.1 eeh int i;
155 1.1 eeh char *prop;
156 1.1 eeh
157 1.1 eeh if (kd->rows == 0 &&
158 1.1 eeh (prop = getpropstring(optionsnode, "screen-#rows"))) {
159 1.1 eeh i = 0;
160 1.1 eeh while (*prop != '\0')
161 1.1 eeh i = i * 10 + *prop++ - '0';
162 1.1 eeh kd->rows = (unsigned short)i;
163 1.1 eeh }
164 1.1 eeh if (kd->cols == 0 &&
165 1.1 eeh (prop = getpropstring(optionsnode, "screen-#columns"))) {
166 1.1 eeh i = 0;
167 1.1 eeh while (*prop != '\0')
168 1.1 eeh i = i * 10 + *prop++ - '0';
169 1.1 eeh kd->cols = (unsigned short)i;
170 1.1 eeh }
171 1.1 eeh }
172 1.1 eeh if (CPU_ISSUN4) {
173 1.1 eeh struct eeprom *ep = (struct eeprom *)eeprom_va;
174 1.1 eeh
175 1.1 eeh if (ep) {
176 1.1 eeh if (kd->rows == 0)
177 1.1 eeh kd->rows = (u_short)ep->eeTtyRows;
178 1.1 eeh if (kd->cols == 0)
179 1.1 eeh kd->cols = (u_short)ep->eeTtyCols;
180 1.1 eeh }
181 1.1 eeh }
182 1.1 eeh
183 1.1 eeh return;
184 1.1 eeh }
185 1.1 eeh
186 1.1 eeh struct tty *
187 1.1 eeh kdtty(dev)
188 1.1 eeh dev_t dev;
189 1.1 eeh {
190 1.1 eeh struct kd_softc *kd;
191 1.1 eeh
192 1.1 eeh kd = &kd_softc; /* XXX */
193 1.1 eeh return (kd->kd_tty);
194 1.1 eeh }
195 1.1 eeh
196 1.1 eeh int
197 1.1 eeh kdopen(dev, flag, mode, p)
198 1.1 eeh dev_t dev;
199 1.1 eeh int flag, mode;
200 1.1 eeh struct proc *p;
201 1.1 eeh {
202 1.1 eeh struct kd_softc *kd;
203 1.1 eeh int error, s, unit;
204 1.1 eeh struct tty *tp;
205 1.1 eeh
206 1.1 eeh unit = minor(dev);
207 1.1 eeh if (unit != 0)
208 1.1 eeh return ENXIO;
209 1.1 eeh kd = &kd_softc; /* XXX */
210 1.1 eeh tp = kd->kd_tty;
211 1.1 eeh
212 1.1 eeh if ((error = kbd_iopen(unit)) != 0) {
213 1.1 eeh #ifdef DIAGNOSTIC
214 1.1 eeh printf("kd: kbd_iopen, error=%d\n", error);
215 1.1 eeh #endif
216 1.1 eeh return (error);
217 1.1 eeh }
218 1.1 eeh
219 1.1 eeh /* It's simpler to do this up here. */
220 1.1 eeh if (((tp->t_state & (TS_ISOPEN | TS_XCLUDE))
221 1.1 eeh == (TS_ISOPEN | TS_XCLUDE))
222 1.1 eeh && (p->p_ucred->cr_uid != 0) )
223 1.1 eeh {
224 1.1 eeh return (EBUSY);
225 1.1 eeh }
226 1.1 eeh
227 1.1 eeh s = spltty();
228 1.1 eeh
229 1.1 eeh if ((tp->t_state & TS_ISOPEN) == 0) {
230 1.1 eeh /* First open. */
231 1.1 eeh ttychars(tp);
232 1.1 eeh tp->t_iflag = TTYDEF_IFLAG;
233 1.1 eeh tp->t_oflag = TTYDEF_OFLAG;
234 1.1 eeh tp->t_cflag = TTYDEF_CFLAG;
235 1.1 eeh tp->t_lflag = TTYDEF_LFLAG;
236 1.1 eeh tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
237 1.1 eeh (void) kdparam(tp, &tp->t_termios);
238 1.1 eeh ttsetwater(tp);
239 1.1 eeh tp->t_winsize.ws_row = kd->rows;
240 1.1 eeh tp->t_winsize.ws_col = kd->cols;
241 1.1 eeh /* Flush pending input? Clear translator? */
242 1.1 eeh /* This (pseudo)device always has SOFTCAR */
243 1.1 eeh tp->t_state |= TS_CARR_ON;
244 1.1 eeh }
245 1.1 eeh
246 1.1 eeh splx(s);
247 1.1 eeh
248 1.1 eeh return ((*linesw[tp->t_line].l_open)(dev, tp));
249 1.1 eeh }
250 1.1 eeh
251 1.1 eeh int
252 1.1 eeh kdclose(dev, flag, mode, p)
253 1.1 eeh dev_t dev;
254 1.1 eeh int flag, mode;
255 1.1 eeh struct proc *p;
256 1.1 eeh {
257 1.1 eeh struct kd_softc *kd;
258 1.1 eeh struct tty *tp;
259 1.1 eeh
260 1.1 eeh kd = &kd_softc; /* XXX */
261 1.1 eeh tp = kd->kd_tty;
262 1.1 eeh
263 1.1 eeh /* XXX This is for cons.c. */
264 1.1 eeh if ((tp->t_state & TS_ISOPEN) == 0)
265 1.1 eeh return 0;
266 1.1 eeh
267 1.1 eeh (*linesw[tp->t_line].l_close)(tp, flag);
268 1.1 eeh ttyclose(tp);
269 1.1 eeh return (0);
270 1.1 eeh }
271 1.1 eeh
272 1.1 eeh int
273 1.1 eeh kdread(dev, uio, flag)
274 1.1 eeh dev_t dev;
275 1.1 eeh struct uio *uio;
276 1.1 eeh int flag;
277 1.1 eeh {
278 1.1 eeh struct kd_softc *kd;
279 1.1 eeh struct tty *tp;
280 1.1 eeh
281 1.1 eeh kd = &kd_softc; /* XXX */
282 1.1 eeh tp = kd->kd_tty;
283 1.1 eeh
284 1.1 eeh return ((*linesw[tp->t_line].l_read)(tp, uio, flag));
285 1.1 eeh }
286 1.1 eeh
287 1.1 eeh int
288 1.1 eeh kdwrite(dev, uio, flag)
289 1.1 eeh dev_t dev;
290 1.1 eeh struct uio *uio;
291 1.1 eeh int flag;
292 1.1 eeh {
293 1.1 eeh struct kd_softc *kd;
294 1.1 eeh struct tty *tp;
295 1.1 eeh
296 1.1 eeh kd = &kd_softc; /* XXX */
297 1.1 eeh tp = kd->kd_tty;
298 1.1 eeh
299 1.1 eeh return ((*linesw[tp->t_line].l_write)(tp, uio, flag));
300 1.1 eeh }
301 1.1 eeh
302 1.1 eeh int
303 1.1 eeh kdioctl(dev, cmd, data, flag, p)
304 1.1 eeh dev_t dev;
305 1.1 eeh u_long cmd;
306 1.1 eeh caddr_t data;
307 1.1 eeh int flag;
308 1.1 eeh struct proc *p;
309 1.1 eeh {
310 1.1 eeh struct kd_softc *kd;
311 1.1 eeh struct tty *tp;
312 1.1 eeh int error;
313 1.1 eeh
314 1.1 eeh kd = &kd_softc; /* XXX */
315 1.1 eeh tp = kd->kd_tty;
316 1.1 eeh
317 1.1 eeh error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, p);
318 1.1 eeh if (error >= 0)
319 1.1 eeh return error;
320 1.1 eeh error = ttioctl(tp, cmd, data, flag, p);
321 1.1 eeh if (error >= 0)
322 1.1 eeh return error;
323 1.1 eeh
324 1.1 eeh /* Handle any ioctl commands specific to kbd/display. */
325 1.1 eeh /* XXX - Send KB* ioctls to kbd module? */
326 1.1 eeh /* XXX - Send FB* ioctls to fb module? */
327 1.1 eeh
328 1.1 eeh return ENOTTY;
329 1.1 eeh }
330 1.1 eeh
331 1.1 eeh void
332 1.1 eeh kdstop(tp, flag)
333 1.1 eeh struct tty *tp;
334 1.1 eeh int flag;
335 1.1 eeh {
336 1.1 eeh
337 1.1 eeh }
338 1.1 eeh
339 1.1 eeh
340 1.1 eeh static int
341 1.1 eeh kdparam(tp, t)
342 1.1 eeh struct tty *tp;
343 1.1 eeh struct termios *t;
344 1.1 eeh {
345 1.1 eeh /* XXX - These are ignored... */
346 1.1 eeh tp->t_ispeed = t->c_ispeed;
347 1.1 eeh tp->t_ospeed = t->c_ospeed;
348 1.1 eeh tp->t_cflag = t->c_cflag;
349 1.1 eeh return 0;
350 1.1 eeh }
351 1.1 eeh
352 1.1 eeh
353 1.1 eeh static void kd_later(void*);
354 1.1 eeh static void kd_putfb(struct tty *);
355 1.1 eeh
356 1.1 eeh static void
357 1.1 eeh kdstart(tp)
358 1.1 eeh struct tty *tp;
359 1.1 eeh {
360 1.1 eeh struct clist *cl;
361 1.1 eeh register int s;
362 1.1 eeh
363 1.1 eeh s = spltty();
364 1.1 eeh if (tp->t_state & (TS_BUSY|TS_TTSTOP|TS_TIMEOUT))
365 1.1 eeh goto out;
366 1.1 eeh
367 1.1 eeh cl = &tp->t_outq;
368 1.1 eeh if (cl->c_cc) {
369 1.1 eeh if (kd_is_console) {
370 1.1 eeh tp->t_state |= TS_BUSY;
371 1.1 eeh if ((s & PSR_PIL) == 0) {
372 1.1 eeh /* called at level zero - update screen now. */
373 1.1 eeh (void) splsoftclock();
374 1.1 eeh kd_putfb(tp);
375 1.1 eeh (void) spltty();
376 1.1 eeh tp->t_state &= ~TS_BUSY;
377 1.1 eeh } else {
378 1.1 eeh /* called at interrupt level - do it later */
379 1.1 eeh timeout(kd_later, (void*)tp, 0);
380 1.1 eeh }
381 1.1 eeh } else {
382 1.1 eeh /*
383 1.1 eeh * This driver uses the PROM for writing the screen,
384 1.1 eeh * and that only works if this is the console device.
385 1.1 eeh * If this is not the console, just flush the output.
386 1.1 eeh * Sorry. (In that case, use xdm instead of getty.)
387 1.1 eeh */
388 1.1 eeh ndflush(cl, cl->c_cc);
389 1.1 eeh }
390 1.1 eeh }
391 1.1 eeh if (cl->c_cc <= tp->t_lowat) {
392 1.1 eeh if (tp->t_state & TS_ASLEEP) {
393 1.1 eeh tp->t_state &= ~TS_ASLEEP;
394 1.1 eeh wakeup((caddr_t)cl);
395 1.1 eeh }
396 1.1 eeh selwakeup(&tp->t_wsel);
397 1.1 eeh }
398 1.1 eeh out:
399 1.1 eeh splx(s);
400 1.1 eeh }
401 1.1 eeh
402 1.1 eeh /*
403 1.1 eeh * Timeout function to do delayed writes to the screen.
404 1.1 eeh * Called at splsoftclock when requested by kdstart.
405 1.1 eeh */
406 1.1 eeh static void
407 1.1 eeh kd_later(tpaddr)
408 1.1 eeh void *tpaddr;
409 1.1 eeh {
410 1.1 eeh struct tty *tp = tpaddr;
411 1.1 eeh register int s;
412 1.1 eeh
413 1.1 eeh kd_putfb(tp);
414 1.1 eeh
415 1.1 eeh s = spltty();
416 1.1 eeh tp->t_state &= ~TS_BUSY;
417 1.1 eeh (*linesw[tp->t_line].l_start)(tp);
418 1.1 eeh splx(s);
419 1.1 eeh }
420 1.1 eeh
421 1.1 eeh /*
422 1.1 eeh * Put text on the screen using the PROM monitor.
423 1.1 eeh * This can take a while, so to avoid missing
424 1.1 eeh * interrupts, this is called at splsoftclock.
425 1.1 eeh */
426 1.1 eeh static void
427 1.1 eeh kd_putfb(tp)
428 1.1 eeh struct tty *tp;
429 1.1 eeh {
430 1.1 eeh char buf[PUT_WSIZE];
431 1.1 eeh struct clist *cl = &tp->t_outq;
432 1.1 eeh char *p, *end;
433 1.1 eeh int len;
434 1.1 eeh
435 1.1 eeh while ((len = q_to_b(cl, buf, PUT_WSIZE-1)) > 0) {
436 1.1 eeh /* PROM will barf if high bits are set. */
437 1.1 eeh p = buf;
438 1.1 eeh end = buf + len;
439 1.1 eeh while (p < end)
440 1.1 eeh *p++ &= 0x7f;
441 1.1 eeh /* Now let the PROM print it. */
442 1.1 eeh OF_write(OF_stdout(), buf, len);
443 1.1 eeh }
444 1.1 eeh }
445 1.1 eeh
446 1.1 eeh /*
447 1.1 eeh * Our "interrupt" routine for input. This is called by
448 1.1 eeh * the keyboard driver (dev/sun/kbd.c) at spltty.
449 1.1 eeh */
450 1.1 eeh void
451 1.1 eeh kd_input(c)
452 1.1 eeh int c;
453 1.1 eeh {
454 1.1 eeh struct kd_softc *kd = &kd_softc;
455 1.1 eeh struct tty *tp;
456 1.1 eeh
457 1.1 eeh /* XXX: Make sure the device is open. */
458 1.1 eeh tp = kd->kd_tty;
459 1.1 eeh if (tp == NULL)
460 1.1 eeh return;
461 1.1 eeh if ((tp->t_state & TS_ISOPEN) == 0)
462 1.1 eeh return;
463 1.1 eeh
464 1.1 eeh (*linesw[tp->t_line].l_rint)(c, tp);
465 1.1 eeh }
466 1.1 eeh
467 1.1 eeh
468 1.1 eeh /****************************************************************
469 1.1 eeh * kd console support
470 1.1 eeh ****************************************************************/
471 1.1 eeh
472 1.1 eeh /* The debugger gets its own key translation state. */
473 1.1 eeh static struct kbd_state kdcn_state;
474 1.1 eeh
475 1.1 eeh static void kdcnprobe __P((struct consdev *));
476 1.1 eeh static void kdcninit __P((struct consdev *));
477 1.1 eeh static int kdcngetc __P((dev_t));
478 1.1 eeh static void kdcnputc __P((dev_t, int));
479 1.1 eeh static void kdcnpollc __P((dev_t, int));
480 1.1 eeh
481 1.1 eeh struct consdev consdev_kd = {
482 1.1 eeh kdcnprobe,
483 1.1 eeh kdcninit,
484 1.1 eeh kdcngetc,
485 1.1 eeh kdcnputc,
486 1.1 eeh kdcnpollc,
487 1.1 eeh };
488 1.1 eeh
489 1.1 eeh /* We never call this. */
490 1.1 eeh static void
491 1.1 eeh kdcnprobe(cn)
492 1.1 eeh struct consdev *cn;
493 1.1 eeh {
494 1.1 eeh }
495 1.1 eeh
496 1.1 eeh static void
497 1.1 eeh kdcninit(cn)
498 1.1 eeh struct consdev *cn;
499 1.1 eeh {
500 1.1 eeh struct kbd_state *ks = &kdcn_state;
501 1.1 eeh
502 1.1 eeh cn->cn_dev = makedev(KDMAJOR, 0);
503 1.1 eeh cn->cn_pri = CN_INTERNAL;
504 1.1 eeh
505 1.1 eeh /* This prepares kbd_translate() */
506 1.1 eeh ks->kbd_id = KBD_MIN_TYPE;
507 1.1 eeh kbd_xlate_init(ks);
508 1.1 eeh
509 1.1 eeh /* Indicate that it is OK to use the PROM fbwrite */
510 1.1 eeh kd_is_console = 1;
511 1.1 eeh }
512 1.1 eeh
513 1.1 eeh static int
514 1.1 eeh kdcngetc(dev)
515 1.1 eeh dev_t dev;
516 1.1 eeh {
517 1.1 eeh struct kbd_state *ks = &kdcn_state;
518 1.1 eeh int code, class, data, keysym;
519 1.1 eeh
520 1.1 eeh for (;;) {
521 1.1 eeh code = zs_getc(zs_conschan);
522 1.1 eeh keysym = kbd_code_to_keysym(ks, code);
523 1.1 eeh class = KEYSYM_CLASS(keysym);
524 1.1 eeh
525 1.1 eeh switch (class) {
526 1.1 eeh case KEYSYM_ASCII:
527 1.1 eeh goto out;
528 1.1 eeh
529 1.1 eeh case KEYSYM_CLRMOD:
530 1.1 eeh case KEYSYM_SETMOD:
531 1.1 eeh data = (keysym & 0x1F);
532 1.1 eeh /* Only allow ctrl or shift. */
533 1.1 eeh if (data > KBMOD_SHIFT_R)
534 1.1 eeh break;
535 1.1 eeh data = 1 << data;
536 1.1 eeh if (class == KEYSYM_SETMOD)
537 1.1 eeh ks->kbd_modbits |= data;
538 1.1 eeh else
539 1.1 eeh ks->kbd_modbits &= ~data;
540 1.1 eeh break;
541 1.1 eeh
542 1.1 eeh case KEYSYM_ALL_UP:
543 1.1 eeh /* No toggle keys here. */
544 1.1 eeh ks->kbd_modbits = 0;
545 1.1 eeh break;
546 1.1 eeh
547 1.1 eeh default: /* ignore all other keysyms */
548 1.1 eeh break;
549 1.1 eeh }
550 1.1 eeh }
551 1.1 eeh out:
552 1.1 eeh return (keysym);
553 1.1 eeh }
554 1.1 eeh
555 1.1 eeh static void
556 1.1 eeh kdcnputc(dev, c)
557 1.1 eeh dev_t dev;
558 1.1 eeh int c;
559 1.1 eeh {
560 1.1 eeh char c0 = (c & 0x7f);
561 1.1 eeh
562 1.1 eeh OF_write(OF_stdout(), &c0, sizeof(c0));
563 1.1 eeh }
564 1.1 eeh
565 1.1 eeh static void
566 1.1 eeh kdcnpollc(dev, on)
567 1.1 eeh dev_t dev;
568 1.1 eeh int on;
569 1.1 eeh {
570 1.1 eeh struct kbd_state *ks = &kdcn_state;
571 1.1 eeh
572 1.1 eeh if (on) {
573 1.1 eeh /* Entering debugger. */
574 1.1 eeh #if NFB > 0
575 1.1 eeh fb_unblank();
576 1.1 eeh #endif
577 1.1 eeh /* Clear shift keys too. */
578 1.1 eeh ks->kbd_modbits = 0;
579 1.1 eeh } else {
580 1.1 eeh /* Resuming kernel. */
581 1.1 eeh }
582 1.1 eeh }
583 1.1 eeh
584