pccons.c revision 1.14 1 1.14 soda /* $NetBSD: pccons.c,v 1.14 2000/02/22 11:26:00 soda Exp $ */
2 1.14 soda /* $OpenBSD: pccons.c,v 1.22 1999/01/30 22:39:37 imp Exp $ */
3 1.13 soda /* NetBSD: pccons.c,v 1.89 1995/05/04 19:35:20 cgd Exp */
4 1.13 soda /* NetBSD: pms.c,v 1.21 1995/04/18 02:25:18 mycroft Exp */
5 1.1 jonathan
6 1.1 jonathan /*-
7 1.11 mycroft * Copyright (c) 1993, 1994, 1995 Charles M. Hannum. All rights reserved.
8 1.1 jonathan * Copyright (c) 1990 The Regents of the University of California.
9 1.1 jonathan * All rights reserved.
10 1.1 jonathan *
11 1.1 jonathan * This code is derived from software contributed to Berkeley by
12 1.1 jonathan * William Jolitz and Don Ahn.
13 1.1 jonathan *
14 1.11 mycroft * Copyright (c) 1994 Charles M. Hannum.
15 1.1 jonathan * Copyright (c) 1992, 1993 Erik Forsberg.
16 1.1 jonathan *
17 1.1 jonathan * Redistribution and use in source and binary forms, with or without
18 1.1 jonathan * modification, are permitted provided that the following conditions
19 1.1 jonathan * are met:
20 1.1 jonathan * 1. Redistributions of source code must retain the above copyright
21 1.1 jonathan * notice, this list of conditions and the following disclaimer.
22 1.1 jonathan * 2. Redistributions in binary form must reproduce the above copyright
23 1.1 jonathan * notice, this list of conditions and the following disclaimer in the
24 1.1 jonathan * documentation and/or other materials provided with the distribution.
25 1.1 jonathan * 3. All advertising materials mentioning features or use of this software
26 1.1 jonathan * must display the following acknowledgement:
27 1.1 jonathan * This product includes software developed by the University of
28 1.1 jonathan * California, Berkeley and its contributors.
29 1.1 jonathan * 4. Neither the name of the University nor the names of its contributors
30 1.1 jonathan * may be used to endorse or promote products derived from this software
31 1.1 jonathan * without specific prior written permission.
32 1.1 jonathan *
33 1.1 jonathan * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
34 1.1 jonathan * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
35 1.1 jonathan * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
36 1.1 jonathan * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
37 1.1 jonathan * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
38 1.1 jonathan * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
39 1.1 jonathan * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
40 1.1 jonathan * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
41 1.1 jonathan * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
42 1.1 jonathan * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
43 1.1 jonathan * SUCH DAMAGE.
44 1.1 jonathan *
45 1.1 jonathan * @(#)pccons.c 5.11 (Berkeley) 5/21/91
46 1.1 jonathan */
47 1.1 jonathan
48 1.1 jonathan /*
49 1.1 jonathan * code to work keyboard & display for PC-style console
50 1.1 jonathan */
51 1.1 jonathan
52 1.14 soda #include "opt_ddb.h"
53 1.14 soda
54 1.1 jonathan #include <sys/param.h>
55 1.1 jonathan #include <sys/systm.h>
56 1.1 jonathan #include <sys/ioctl.h>
57 1.1 jonathan #include <sys/proc.h>
58 1.1 jonathan #include <sys/user.h>
59 1.1 jonathan #include <sys/select.h>
60 1.1 jonathan #include <sys/tty.h>
61 1.1 jonathan #include <sys/uio.h>
62 1.1 jonathan #include <sys/callout.h>
63 1.1 jonathan #include <sys/syslog.h>
64 1.1 jonathan #include <sys/device.h>
65 1.8 jonathan #include <sys/poll.h>
66 1.13 soda #include <sys/conf.h>
67 1.13 soda #include <sys/vnode.h>
68 1.13 soda #include <sys/fcntl.h>
69 1.13 soda #include <sys/kernel.h>
70 1.13 soda #include <sys/kcore.h>
71 1.1 jonathan
72 1.1 jonathan #include <dev/cons.h>
73 1.1 jonathan
74 1.1 jonathan #include <machine/cpu.h>
75 1.1 jonathan #include <machine/pio.h>
76 1.1 jonathan #include <machine/autoconf.h>
77 1.7 jonathan #include <machine/bus.h>
78 1.1 jonathan #include <machine/display.h>
79 1.1 jonathan #include <machine/pccons.h>
80 1.13 soda #include <arc/arc/arctype.h>
81 1.13 soda #include <arc/arc/arcbios.h>
82 1.13 soda #include <arc/pica/pica.h>
83 1.13 soda #include <arc/dti/desktech.h>
84 1.1 jonathan
85 1.1 jonathan #include <dev/isa/isavar.h>
86 1.13 soda #include <machine/isa_machdep.h>
87 1.1 jonathan #include <machine/kbdreg.h>
88 1.1 jonathan
89 1.13 soda #include <dev/cons.h>
90 1.13 soda
91 1.1 jonathan #define XFREE86_BUG_COMPAT
92 1.1 jonathan
93 1.1 jonathan #ifndef BEEP_FREQ
94 1.1 jonathan #define BEEP_FREQ 1600
95 1.1 jonathan #endif
96 1.1 jonathan #ifndef BEEP_TIME
97 1.1 jonathan #define BEEP_TIME (hz/5)
98 1.1 jonathan #endif
99 1.1 jonathan
100 1.1 jonathan #define PCBURST 128
101 1.1 jonathan
102 1.1 jonathan static u_short *Crtat; /* pointer to backing store */
103 1.1 jonathan static u_short *crtat; /* pointer to current char */
104 1.1 jonathan static u_char async, kernel, polling; /* Really, you don't want to know. */
105 1.1 jonathan static u_char lock_state = 0x00, /* all off */
106 1.1 jonathan old_lock_state = 0xff,
107 1.1 jonathan typematic_rate = 0xff, /* don't update until set by user */
108 1.1 jonathan old_typematic_rate = 0xff;
109 1.1 jonathan static u_short cursor_shape = 0xffff, /* don't update until set by user */
110 1.1 jonathan old_cursor_shape = 0xffff;
111 1.13 soda static pccons_keymap_t scan_codes[KB_NUM_KEYS];/* keyboard translation table */
112 1.1 jonathan int pc_xmode = 0;
113 1.1 jonathan
114 1.13 soda cdev_decl(pc);
115 1.13 soda
116 1.1 jonathan /*
117 1.1 jonathan * Keyboard output queue.
118 1.1 jonathan */
119 1.1 jonathan int kb_oq_put = 0;
120 1.1 jonathan int kb_oq_get = 0;
121 1.1 jonathan u_char kb_oq[8];
122 1.1 jonathan
123 1.1 jonathan #define PCUNIT(x) (minor(x))
124 1.1 jonathan
125 1.1 jonathan static struct video_state {
126 1.1 jonathan int cx, cy; /* escape parameters */
127 1.1 jonathan int row, col; /* current cursor position */
128 1.1 jonathan int nrow, ncol, nchr; /* current screen geometry */
129 1.13 soda int offset; /* Saved cursor pos */
130 1.1 jonathan u_char state; /* parser state */
131 1.1 jonathan #define VSS_ESCAPE 1
132 1.1 jonathan #define VSS_EBRACE 2
133 1.1 jonathan #define VSS_EPARAM 3
134 1.1 jonathan char so; /* in standout mode? */
135 1.1 jonathan char color; /* color or mono display */
136 1.1 jonathan char at; /* normal attributes */
137 1.1 jonathan char so_at; /* standout attributes */
138 1.1 jonathan } vs;
139 1.1 jonathan
140 1.1 jonathan struct pc_softc {
141 1.1 jonathan struct device sc_dev;
142 1.1 jonathan struct tty *sc_tty;
143 1.1 jonathan };
144 1.1 jonathan
145 1.13 soda struct opms_softc { /* driver status information */
146 1.1 jonathan struct device sc_dev;
147 1.1 jonathan
148 1.1 jonathan struct clist sc_q;
149 1.1 jonathan struct selinfo sc_rsel;
150 1.1 jonathan u_char sc_state; /* mouse driver state */
151 1.1 jonathan #define PMS_OPEN 0x01 /* device is open */
152 1.1 jonathan #define PMS_ASLP 0x02 /* waiting for mouse data */
153 1.1 jonathan u_char sc_status; /* mouse button status */
154 1.1 jonathan int sc_x, sc_y; /* accumulated motion in the X,Y axis */
155 1.1 jonathan };
156 1.1 jonathan
157 1.13 soda int pcprobe __P((struct device *, struct cfdata *, void *));
158 1.1 jonathan void pcattach __P((struct device *, struct device *, void *));
159 1.1 jonathan int pcintr __P((void *));
160 1.13 soda void pc_xmode_on __P((void));
161 1.13 soda void pc_xmode_off __P((void));
162 1.13 soda static u_char kbc_get8042cmd __P((void));
163 1.13 soda static int kbc_put8042cmd __P((u_char));
164 1.13 soda int kbc_8042sysreset __P((void));
165 1.13 soda int kbd_cmd __P((u_char, u_char));
166 1.13 soda static __inline int kbd_wait_output __P((void));
167 1.13 soda static __inline int kbd_wait_input __P((void));
168 1.13 soda static __inline void kbd_flush_input __P((void));
169 1.13 soda void set_cursor_shape __P((void));
170 1.13 soda void get_cursor_shape __P((void));
171 1.13 soda void async_update __P((void));
172 1.13 soda void do_async_update __P((u_char));;
173 1.13 soda
174 1.13 soda void pccnattach __P((void));
175 1.13 soda void pccnputc __P((dev_t, int c));
176 1.13 soda int pccngetc __P((dev_t));
177 1.13 soda void pccnpollc __P((dev_t, int));
178 1.1 jonathan
179 1.13 soda extern struct cfdriver pc_cd;
180 1.13 soda
181 1.13 soda struct cfattach pc_pica_ca = {
182 1.13 soda sizeof(struct pc_softc), pcprobe, pcattach
183 1.2 thorpej };
184 1.2 thorpej
185 1.13 soda struct cfattach pc_isa_ca = {
186 1.13 soda sizeof(struct pc_softc), pcprobe, pcattach
187 1.13 soda };
188 1.13 soda int opmsprobe __P((struct device *, struct cfdata *, void *));
189 1.13 soda void opmsattach __P((struct device *, struct device *, void *));
190 1.13 soda int opmsintr __P((void *));
191 1.1 jonathan
192 1.13 soda struct cfattach opms_ca = {
193 1.13 soda sizeof(struct opms_softc), opmsprobe, opmsattach
194 1.13 soda };
195 1.1 jonathan
196 1.13 soda extern struct cfdriver opms_cd;
197 1.2 thorpej
198 1.1 jonathan #define PMSUNIT(dev) (minor(dev))
199 1.1 jonathan
200 1.1 jonathan #define CHR 2
201 1.1 jonathan
202 1.13 soda static unsigned int addr_6845;
203 1.13 soda static unsigned int mono_base = 0x3b4;
204 1.13 soda static unsigned int mono_buf = 0xb0000;
205 1.13 soda static unsigned int cga_base = 0x3d4;
206 1.13 soda static unsigned int cga_buf = 0xb8000;
207 1.13 soda static unsigned int kbd_cmdp = 0x64;
208 1.13 soda static unsigned int kbd_datap = 0x60;
209 1.1 jonathan
210 1.1 jonathan char *sget __P((void));
211 1.1 jonathan void sput __P((u_char *, int));
212 1.1 jonathan
213 1.13 soda void pcstart __P((struct tty *));
214 1.13 soda int pcparam __P((struct tty *, struct termios *));
215 1.13 soda static __inline void wcopy __P((void *, void *, u_int));
216 1.13 soda
217 1.13 soda extern void fillw __P((int, u_int16_t *, int));
218 1.1 jonathan
219 1.1 jonathan #define KBD_DELAY \
220 1.1 jonathan DELAY(10);
221 1.1 jonathan
222 1.13 soda /*
223 1.13 soda * bcopy variant that only moves word-aligned 16-bit entities,
224 1.13 soda * for stupid VGA cards. cnt is required to be an even vale.
225 1.13 soda */
226 1.13 soda static __inline void
227 1.13 soda wcopy(src, tgt, cnt)
228 1.13 soda void *src, *tgt;
229 1.13 soda u_int cnt;
230 1.13 soda {
231 1.13 soda u_int16_t *from = src;
232 1.13 soda u_int16_t *to = tgt;
233 1.13 soda
234 1.13 soda cnt >>= 1;
235 1.13 soda if (to < from || to >= from + cnt)
236 1.13 soda while(cnt--)
237 1.13 soda *to++ = *from++;
238 1.13 soda else {
239 1.13 soda to += cnt;
240 1.13 soda from += cnt;
241 1.13 soda while(cnt--)
242 1.13 soda *--to = *--from;
243 1.13 soda }
244 1.13 soda }
245 1.13 soda
246 1.13 soda static __inline int
247 1.1 jonathan kbd_wait_output()
248 1.1 jonathan {
249 1.1 jonathan u_int i;
250 1.1 jonathan
251 1.1 jonathan for (i = 100000; i; i--)
252 1.13 soda if ((inb(kbd_cmdp) & KBS_IBF) == 0) {
253 1.1 jonathan KBD_DELAY;
254 1.1 jonathan return 1;
255 1.1 jonathan }
256 1.1 jonathan return 0;
257 1.1 jonathan }
258 1.1 jonathan
259 1.13 soda static __inline int
260 1.1 jonathan kbd_wait_input()
261 1.1 jonathan {
262 1.1 jonathan u_int i;
263 1.1 jonathan
264 1.1 jonathan for (i = 100000; i; i--)
265 1.13 soda if ((inb(kbd_cmdp) & KBS_DIB) != 0) {
266 1.1 jonathan KBD_DELAY;
267 1.1 jonathan return 1;
268 1.1 jonathan }
269 1.1 jonathan return 0;
270 1.1 jonathan }
271 1.1 jonathan
272 1.13 soda static __inline void
273 1.1 jonathan kbd_flush_input()
274 1.1 jonathan {
275 1.1 jonathan u_char c;
276 1.1 jonathan
277 1.13 soda while ((c = inb(kbd_cmdp)) & 0x03)
278 1.1 jonathan if ((c & KBS_DIB) == KBS_DIB) {
279 1.1 jonathan /* XXX - delay is needed to prevent some keyboards from
280 1.1 jonathan wedging when the system boots */
281 1.1 jonathan delay(6);
282 1.13 soda (void) inb(kbd_datap);
283 1.1 jonathan }
284 1.1 jonathan }
285 1.1 jonathan
286 1.1 jonathan
287 1.13 soda
288 1.13 soda /*
289 1.13 soda * Pass system reset command to keyboard controller (8042).
290 1.13 soda */
291 1.13 soda int
292 1.13 soda kbc_8042sysreset()
293 1.13 soda {
294 1.13 soda
295 1.13 soda if (!kbd_wait_output())
296 1.13 soda return 0;
297 1.13 soda outb(kbd_cmdp, 0xd1);
298 1.13 soda if (!kbd_wait_output())
299 1.13 soda return 0;
300 1.13 soda outb(kbd_datap, 0); /* ZAP */
301 1.13 soda return 1;
302 1.13 soda }
303 1.13 soda
304 1.1 jonathan #if 1
305 1.1 jonathan /*
306 1.1 jonathan * Get the current command byte.
307 1.1 jonathan */
308 1.1 jonathan static u_char
309 1.1 jonathan kbc_get8042cmd()
310 1.1 jonathan {
311 1.1 jonathan
312 1.1 jonathan if (!kbd_wait_output())
313 1.1 jonathan return -1;
314 1.13 soda outb(kbd_cmdp, K_RDCMDBYTE);
315 1.1 jonathan if (!kbd_wait_input())
316 1.1 jonathan return -1;
317 1.13 soda return inb(kbd_datap);
318 1.1 jonathan }
319 1.1 jonathan #endif
320 1.1 jonathan
321 1.1 jonathan /*
322 1.1 jonathan * Pass command byte to keyboard controller (8042).
323 1.1 jonathan */
324 1.1 jonathan static int
325 1.1 jonathan kbc_put8042cmd(val)
326 1.1 jonathan u_char val;
327 1.1 jonathan {
328 1.1 jonathan
329 1.1 jonathan if (!kbd_wait_output())
330 1.1 jonathan return 0;
331 1.13 soda outb(kbd_cmdp, K_LDCMDBYTE);
332 1.1 jonathan if (!kbd_wait_output())
333 1.1 jonathan return 0;
334 1.13 soda outb(kbd_datap, val);
335 1.1 jonathan return 1;
336 1.1 jonathan }
337 1.1 jonathan
338 1.1 jonathan /*
339 1.1 jonathan * Pass command to keyboard itself
340 1.1 jonathan */
341 1.1 jonathan int
342 1.1 jonathan kbd_cmd(val, polling)
343 1.1 jonathan u_char val;
344 1.1 jonathan u_char polling;
345 1.1 jonathan {
346 1.1 jonathan u_int retries = 3;
347 1.1 jonathan register u_int i;
348 1.1 jonathan
349 1.1 jonathan if(!polling) {
350 1.1 jonathan i = spltty();
351 1.1 jonathan if(kb_oq_get == kb_oq_put) {
352 1.13 soda outb(kbd_datap, val);
353 1.1 jonathan }
354 1.1 jonathan kb_oq[kb_oq_put] = val;
355 1.1 jonathan kb_oq_put = (kb_oq_put + 1) & 7;
356 1.1 jonathan splx(i);
357 1.1 jonathan return(1);
358 1.1 jonathan }
359 1.1 jonathan else do {
360 1.1 jonathan if (!kbd_wait_output())
361 1.1 jonathan return 0;
362 1.13 soda outb(kbd_datap, val);
363 1.1 jonathan for (i = 100000; i; i--) {
364 1.13 soda if (inb(kbd_cmdp) & KBS_DIB) {
365 1.1 jonathan register u_char c;
366 1.1 jonathan
367 1.1 jonathan KBD_DELAY;
368 1.13 soda c = inb(kbd_datap);
369 1.1 jonathan if (c == KBR_ACK || c == KBR_ECHO) {
370 1.1 jonathan return 1;
371 1.1 jonathan }
372 1.1 jonathan if (c == KBR_RESEND) {
373 1.1 jonathan break;
374 1.1 jonathan }
375 1.1 jonathan #ifdef DIAGNOSTIC
376 1.6 christos printf("kbd_cmd: input char %x lost\n", c);
377 1.1 jonathan #endif
378 1.1 jonathan }
379 1.1 jonathan }
380 1.1 jonathan } while (--retries);
381 1.1 jonathan return 0;
382 1.1 jonathan }
383 1.1 jonathan
384 1.1 jonathan void
385 1.1 jonathan set_cursor_shape()
386 1.1 jonathan {
387 1.1 jonathan register int iobase = addr_6845;
388 1.1 jonathan
389 1.1 jonathan outb(iobase, 10);
390 1.1 jonathan outb(iobase+1, cursor_shape >> 8);
391 1.1 jonathan outb(iobase, 11);
392 1.1 jonathan outb(iobase+1, cursor_shape);
393 1.1 jonathan old_cursor_shape = cursor_shape;
394 1.1 jonathan }
395 1.1 jonathan
396 1.1 jonathan void
397 1.1 jonathan get_cursor_shape()
398 1.1 jonathan {
399 1.1 jonathan register int iobase = addr_6845;
400 1.1 jonathan
401 1.1 jonathan outb(iobase, 10);
402 1.1 jonathan cursor_shape = inb(iobase+1) << 8;
403 1.1 jonathan outb(iobase, 11);
404 1.1 jonathan cursor_shape |= inb(iobase+1);
405 1.1 jonathan
406 1.1 jonathan /*
407 1.1 jonathan * real 6845's, as found on, MDA, Hercules or CGA cards, do
408 1.1 jonathan * not support reading the cursor shape registers. the 6845
409 1.1 jonathan * tri-states it's data bus. This is _normally_ read by the
410 1.1 jonathan * cpu as either 0x00 or 0xff.. in which case we just use
411 1.1 jonathan * a line cursor.
412 1.1 jonathan */
413 1.1 jonathan if (cursor_shape == 0x0000 || cursor_shape == 0xffff)
414 1.1 jonathan cursor_shape = 0x0b10;
415 1.1 jonathan else
416 1.1 jonathan cursor_shape &= 0x1f1f;
417 1.1 jonathan }
418 1.1 jonathan
419 1.1 jonathan void
420 1.1 jonathan do_async_update(poll)
421 1.1 jonathan u_char poll;
422 1.1 jonathan {
423 1.1 jonathan int pos;
424 1.1 jonathan static int old_pos = -1;
425 1.1 jonathan
426 1.1 jonathan async = 0;
427 1.1 jonathan
428 1.1 jonathan if (lock_state != old_lock_state) {
429 1.1 jonathan old_lock_state = lock_state;
430 1.1 jonathan if (!kbd_cmd(KBC_MODEIND, poll) ||
431 1.1 jonathan !kbd_cmd(lock_state, poll)) {
432 1.6 christos printf("pc: timeout updating leds\n");
433 1.1 jonathan (void) kbd_cmd(KBC_ENABLE, poll);
434 1.1 jonathan }
435 1.1 jonathan }
436 1.1 jonathan if (typematic_rate != old_typematic_rate) {
437 1.1 jonathan old_typematic_rate = typematic_rate;
438 1.1 jonathan if (!kbd_cmd(KBC_TYPEMATIC, poll) ||
439 1.1 jonathan !kbd_cmd(typematic_rate, poll)) {
440 1.6 christos printf("pc: timeout updating typematic rate\n");
441 1.1 jonathan (void) kbd_cmd(KBC_ENABLE, poll);
442 1.1 jonathan }
443 1.1 jonathan }
444 1.1 jonathan
445 1.1 jonathan if (pc_xmode > 0)
446 1.1 jonathan return;
447 1.1 jonathan
448 1.1 jonathan pos = crtat - Crtat;
449 1.1 jonathan if (pos != old_pos) {
450 1.1 jonathan register int iobase = addr_6845;
451 1.1 jonathan outb(iobase, 14);
452 1.1 jonathan outb(iobase+1, pos >> 8);
453 1.1 jonathan outb(iobase, 15);
454 1.1 jonathan outb(iobase+1, pos);
455 1.1 jonathan old_pos = pos;
456 1.1 jonathan }
457 1.1 jonathan if (cursor_shape != old_cursor_shape)
458 1.1 jonathan set_cursor_shape();
459 1.1 jonathan }
460 1.1 jonathan
461 1.1 jonathan void
462 1.1 jonathan async_update()
463 1.1 jonathan {
464 1.1 jonathan
465 1.1 jonathan if (kernel || polling) {
466 1.1 jonathan if (async)
467 1.13 soda untimeout((void(*)(void *))do_async_update, NULL);
468 1.1 jonathan do_async_update(1);
469 1.1 jonathan } else {
470 1.1 jonathan if (async)
471 1.1 jonathan return;
472 1.1 jonathan async = 1;
473 1.13 soda timeout((void(*)(void *))do_async_update, NULL, 1);
474 1.1 jonathan }
475 1.1 jonathan }
476 1.1 jonathan
477 1.1 jonathan /*
478 1.1 jonathan * these are both bad jokes
479 1.1 jonathan */
480 1.1 jonathan int
481 1.13 soda pcprobe(parent, match, aux)
482 1.1 jonathan struct device *parent;
483 1.13 soda struct cfdata *match;
484 1.13 soda void *aux;
485 1.1 jonathan {
486 1.1 jonathan struct confargs *ca = aux;
487 1.1 jonathan u_int i;
488 1.1 jonathan
489 1.1 jonathan /* Make shure we're looking for this type of device */
490 1.13 soda if(!strcmp((parent)->dv_cfdata->cf_driver->cd_name, "pica")) {
491 1.13 soda if(!BUS_MATCHNAME(ca, "pc"))
492 1.13 soda return(0);
493 1.13 soda }
494 1.1 jonathan
495 1.1 jonathan /* Enable interrupts and keyboard, etc. */
496 1.1 jonathan if (!kbc_put8042cmd(CMDBYTE)) {
497 1.13 soda printf("pcprobe: command error\n");
498 1.1 jonathan return 0;
499 1.1 jonathan }
500 1.1 jonathan
501 1.1 jonathan #if 1
502 1.1 jonathan /* Flush any garbage. */
503 1.1 jonathan kbd_flush_input();
504 1.1 jonathan /* Reset the keyboard. */
505 1.1 jonathan if (!kbd_cmd(KBC_RESET, 1)) {
506 1.13 soda printf("pcprobe: reset error %d\n", 1);
507 1.1 jonathan goto lose;
508 1.1 jonathan }
509 1.1 jonathan for (i = 600000; i; i--)
510 1.13 soda if ((inb(kbd_cmdp) & KBS_DIB) != 0) {
511 1.1 jonathan KBD_DELAY;
512 1.1 jonathan break;
513 1.1 jonathan }
514 1.13 soda if (i == 0 || inb(kbd_datap) != KBR_RSTDONE) {
515 1.13 soda printf("pcprobe: reset error %d\n", 2);
516 1.1 jonathan goto lose;
517 1.1 jonathan }
518 1.1 jonathan /*
519 1.1 jonathan * Some keyboards seem to leave a second ack byte after the reset.
520 1.1 jonathan * This is kind of stupid, but we account for them anyway by just
521 1.1 jonathan * flushing the buffer.
522 1.1 jonathan */
523 1.1 jonathan kbd_flush_input();
524 1.1 jonathan /* Just to be sure. */
525 1.1 jonathan if (!kbd_cmd(KBC_ENABLE, 1)) {
526 1.13 soda printf("pcprobe: reset error %d\n", 3);
527 1.1 jonathan goto lose;
528 1.1 jonathan }
529 1.1 jonathan
530 1.1 jonathan /*
531 1.1 jonathan * Some keyboard/8042 combinations do not seem to work if the keyboard
532 1.1 jonathan * is set to table 1; in fact, it would appear that some keyboards just
533 1.1 jonathan * ignore the command altogether. So by default, we use the AT scan
534 1.1 jonathan * codes and have the 8042 translate them. Unfortunately, this is
535 1.1 jonathan * known to not work on some PS/2 machines. We try desparately to deal
536 1.1 jonathan * with this by checking the (lack of a) translate bit in the 8042 and
537 1.1 jonathan * attempting to set the keyboard to XT mode. If this all fails, well,
538 1.1 jonathan * tough luck.
539 1.1 jonathan *
540 1.1 jonathan * XXX It would perhaps be a better choice to just use AT scan codes
541 1.1 jonathan * and not bother with this.
542 1.1 jonathan */
543 1.1 jonathan if (kbc_get8042cmd() & KC8_TRANS) {
544 1.1 jonathan /* The 8042 is translating for us; use AT codes. */
545 1.1 jonathan if (!kbd_cmd(KBC_SETTABLE, 1) || !kbd_cmd(2, 1)) {
546 1.13 soda printf("pcprobe: reset error %d\n", 4);
547 1.1 jonathan goto lose;
548 1.1 jonathan }
549 1.1 jonathan } else {
550 1.1 jonathan /* Stupid 8042; set keyboard to XT codes. */
551 1.1 jonathan if (!kbd_cmd(KBC_SETTABLE, 1) || !kbd_cmd(1, 1)) {
552 1.13 soda printf("pcprobe: reset error %d\n", 5);
553 1.1 jonathan goto lose;
554 1.1 jonathan }
555 1.1 jonathan }
556 1.1 jonathan
557 1.1 jonathan lose:
558 1.1 jonathan /*
559 1.13 soda * Technically, we should probably fail the probe. But we'll be nice
560 1.1 jonathan * and allow keyboard-less machines to boot with the console.
561 1.1 jonathan */
562 1.1 jonathan #endif
563 1.1 jonathan
564 1.1 jonathan return 1;
565 1.1 jonathan }
566 1.1 jonathan
567 1.1 jonathan void
568 1.1 jonathan pcattach(parent, self, aux)
569 1.1 jonathan struct device *parent, *self;
570 1.1 jonathan void *aux;
571 1.1 jonathan {
572 1.1 jonathan struct confargs *ca = aux;
573 1.13 soda struct isa_attach_args *ia = aux;
574 1.1 jonathan struct pc_softc *sc = (void *)self;
575 1.1 jonathan
576 1.6 christos printf(": %s\n", vs.color ? "color" : "mono");
577 1.1 jonathan do_async_update(1);
578 1.1 jonathan
579 1.13 soda switch(cputype) {
580 1.13 soda case ACER_PICA_61:
581 1.13 soda BUS_INTR_ESTABLISH(ca, pcintr, (void *)(long)sc);
582 1.13 soda break;
583 1.13 soda case DESKSTATION_RPC44: /* XXX ick */
584 1.13 soda case DESKSTATION_TYNE:
585 1.13 soda isa_intr_establish(ia->ia_ic, ia->ia_irq, 1,
586 1.13 soda 2, pcintr, sc); /*XXX ick */
587 1.13 soda break;
588 1.13 soda }
589 1.1 jonathan }
590 1.1 jonathan
591 1.1 jonathan int
592 1.1 jonathan pcopen(dev, flag, mode, p)
593 1.1 jonathan dev_t dev;
594 1.1 jonathan int flag, mode;
595 1.1 jonathan struct proc *p;
596 1.1 jonathan {
597 1.1 jonathan struct pc_softc *sc;
598 1.1 jonathan int unit = PCUNIT(dev);
599 1.1 jonathan struct tty *tp;
600 1.1 jonathan
601 1.2 thorpej if (unit >= pc_cd.cd_ndevs)
602 1.1 jonathan return ENXIO;
603 1.2 thorpej sc = pc_cd.cd_devs[unit];
604 1.1 jonathan if (sc == 0)
605 1.1 jonathan return ENXIO;
606 1.1 jonathan
607 1.1 jonathan if (!sc->sc_tty) {
608 1.1 jonathan tp = sc->sc_tty = ttymalloc();
609 1.1 jonathan }
610 1.1 jonathan else {
611 1.1 jonathan tp = sc->sc_tty;
612 1.1 jonathan }
613 1.1 jonathan
614 1.1 jonathan tp->t_oproc = pcstart;
615 1.1 jonathan tp->t_param = pcparam;
616 1.1 jonathan tp->t_dev = dev;
617 1.1 jonathan if ((tp->t_state & TS_ISOPEN) == 0) {
618 1.1 jonathan ttychars(tp);
619 1.1 jonathan tp->t_iflag = TTYDEF_IFLAG;
620 1.1 jonathan tp->t_oflag = TTYDEF_OFLAG;
621 1.1 jonathan tp->t_cflag = TTYDEF_CFLAG;
622 1.1 jonathan tp->t_lflag = TTYDEF_LFLAG;
623 1.1 jonathan tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
624 1.1 jonathan pcparam(tp, &tp->t_termios);
625 1.1 jonathan ttsetwater(tp);
626 1.1 jonathan } else if (tp->t_state&TS_XCLUDE && p->p_ucred->cr_uid != 0)
627 1.1 jonathan return EBUSY;
628 1.1 jonathan tp->t_state |= TS_CARR_ON;
629 1.1 jonathan
630 1.1 jonathan return ((*linesw[tp->t_line].l_open)(dev, tp));
631 1.1 jonathan }
632 1.1 jonathan
633 1.1 jonathan int
634 1.1 jonathan pcclose(dev, flag, mode, p)
635 1.1 jonathan dev_t dev;
636 1.1 jonathan int flag, mode;
637 1.1 jonathan struct proc *p;
638 1.1 jonathan {
639 1.2 thorpej struct pc_softc *sc = pc_cd.cd_devs[PCUNIT(dev)];
640 1.1 jonathan struct tty *tp = sc->sc_tty;
641 1.1 jonathan
642 1.1 jonathan (*linesw[tp->t_line].l_close)(tp, flag);
643 1.1 jonathan ttyclose(tp);
644 1.1 jonathan #ifdef notyet /* XXX */
645 1.1 jonathan ttyfree(tp);
646 1.1 jonathan #endif
647 1.1 jonathan return(0);
648 1.1 jonathan }
649 1.1 jonathan
650 1.1 jonathan int
651 1.1 jonathan pcread(dev, uio, flag)
652 1.1 jonathan dev_t dev;
653 1.1 jonathan struct uio *uio;
654 1.1 jonathan int flag;
655 1.1 jonathan {
656 1.2 thorpej struct pc_softc *sc = pc_cd.cd_devs[PCUNIT(dev)];
657 1.1 jonathan struct tty *tp = sc->sc_tty;
658 1.1 jonathan
659 1.1 jonathan return ((*linesw[tp->t_line].l_read)(tp, uio, flag));
660 1.1 jonathan }
661 1.1 jonathan
662 1.1 jonathan int
663 1.1 jonathan pcwrite(dev, uio, flag)
664 1.1 jonathan dev_t dev;
665 1.1 jonathan struct uio *uio;
666 1.1 jonathan int flag;
667 1.1 jonathan {
668 1.2 thorpej struct pc_softc *sc = pc_cd.cd_devs[PCUNIT(dev)];
669 1.1 jonathan struct tty *tp = sc->sc_tty;
670 1.1 jonathan
671 1.1 jonathan return ((*linesw[tp->t_line].l_write)(tp, uio, flag));
672 1.1 jonathan }
673 1.1 jonathan
674 1.1 jonathan struct tty *
675 1.1 jonathan pctty(dev)
676 1.1 jonathan dev_t dev;
677 1.1 jonathan {
678 1.2 thorpej struct pc_softc *sc = pc_cd.cd_devs[PCUNIT(dev)];
679 1.1 jonathan struct tty *tp = sc->sc_tty;
680 1.1 jonathan
681 1.1 jonathan return (tp);
682 1.1 jonathan }
683 1.1 jonathan
684 1.1 jonathan /*
685 1.1 jonathan * Got a console receive interrupt -
686 1.1 jonathan * the console processor wants to give us a character.
687 1.1 jonathan * Catch the character, and see who it goes to.
688 1.1 jonathan */
689 1.1 jonathan int
690 1.1 jonathan pcintr(arg)
691 1.1 jonathan void *arg;
692 1.1 jonathan {
693 1.1 jonathan struct pc_softc *sc = arg;
694 1.1 jonathan register struct tty *tp = sc->sc_tty;
695 1.1 jonathan u_char *cp;
696 1.1 jonathan
697 1.13 soda if ((inb(kbd_cmdp) & KBS_DIB) == 0)
698 1.1 jonathan return 0;
699 1.1 jonathan if (polling)
700 1.1 jonathan return 1;
701 1.1 jonathan do {
702 1.1 jonathan cp = sget();
703 1.1 jonathan if (!tp || (tp->t_state & TS_ISOPEN) == 0)
704 1.1 jonathan return 1;
705 1.1 jonathan if (cp)
706 1.1 jonathan do
707 1.1 jonathan (*linesw[tp->t_line].l_rint)(*cp++, tp);
708 1.1 jonathan while (*cp);
709 1.13 soda } while (inb(kbd_cmdp) & KBS_DIB);
710 1.1 jonathan return 1;
711 1.1 jonathan }
712 1.1 jonathan
713 1.1 jonathan int
714 1.1 jonathan pcioctl(dev, cmd, data, flag, p)
715 1.1 jonathan dev_t dev;
716 1.1 jonathan u_long cmd;
717 1.1 jonathan caddr_t data;
718 1.1 jonathan int flag;
719 1.1 jonathan struct proc *p;
720 1.1 jonathan {
721 1.2 thorpej struct pc_softc *sc = pc_cd.cd_devs[PCUNIT(dev)];
722 1.1 jonathan struct tty *tp = sc->sc_tty;
723 1.1 jonathan int error;
724 1.1 jonathan
725 1.1 jonathan error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, p);
726 1.1 jonathan if (error >= 0)
727 1.1 jonathan return error;
728 1.1 jonathan error = ttioctl(tp, cmd, data, flag, p);
729 1.1 jonathan if (error >= 0)
730 1.1 jonathan return error;
731 1.1 jonathan
732 1.1 jonathan switch (cmd) {
733 1.1 jonathan case CONSOLE_X_MODE_ON:
734 1.1 jonathan pc_xmode_on();
735 1.1 jonathan return 0;
736 1.1 jonathan case CONSOLE_X_MODE_OFF:
737 1.1 jonathan pc_xmode_off();
738 1.1 jonathan return 0;
739 1.1 jonathan case CONSOLE_X_BELL:
740 1.1 jonathan /*
741 1.1 jonathan * If set, data is a pointer to a length 2 array of
742 1.1 jonathan * integers. data[0] is the pitch in Hz and data[1]
743 1.1 jonathan * is the duration in msec.
744 1.1 jonathan */
745 1.1 jonathan if (data)
746 1.1 jonathan sysbeep(((int*)data)[0],
747 1.1 jonathan (((int*)data)[1] * hz) / 1000);
748 1.1 jonathan else
749 1.1 jonathan sysbeep(BEEP_FREQ, BEEP_TIME);
750 1.1 jonathan return 0;
751 1.1 jonathan case CONSOLE_SET_TYPEMATIC_RATE: {
752 1.1 jonathan u_char rate;
753 1.1 jonathan
754 1.1 jonathan if (!data)
755 1.1 jonathan return EINVAL;
756 1.1 jonathan rate = *((u_char *)data);
757 1.1 jonathan /*
758 1.1 jonathan * Check that it isn't too big (which would cause it to be
759 1.1 jonathan * confused with a command).
760 1.1 jonathan */
761 1.1 jonathan if (rate & 0x80)
762 1.1 jonathan return EINVAL;
763 1.1 jonathan typematic_rate = rate;
764 1.1 jonathan async_update();
765 1.1 jonathan return 0;
766 1.1 jonathan }
767 1.13 soda case CONSOLE_SET_KEYMAP: {
768 1.13 soda pccons_keymap_t *map = (pccons_keymap_t *) data;
769 1.13 soda int i;
770 1.13 soda
771 1.13 soda if (!data)
772 1.13 soda return EINVAL;
773 1.13 soda for (i = 0; i < KB_NUM_KEYS; i++)
774 1.13 soda if (map[i].unshift[KB_CODE_SIZE-1] ||
775 1.13 soda map[i].shift[KB_CODE_SIZE-1] ||
776 1.13 soda map[i].ctl[KB_CODE_SIZE-1] ||
777 1.13 soda map[i].altgr[KB_CODE_SIZE-1] ||
778 1.13 soda map[i].shift_altgr[KB_CODE_SIZE-1])
779 1.13 soda return EINVAL;
780 1.13 soda
781 1.13 soda bcopy(data, scan_codes, sizeof(pccons_keymap_t[KB_NUM_KEYS]));
782 1.13 soda return 0;
783 1.13 soda }
784 1.13 soda case CONSOLE_GET_KEYMAP:
785 1.13 soda if (!data)
786 1.13 soda return EINVAL;
787 1.13 soda bcopy(scan_codes, data, sizeof(pccons_keymap_t[KB_NUM_KEYS]));
788 1.13 soda return 0;
789 1.13 soda
790 1.1 jonathan default:
791 1.1 jonathan return ENOTTY;
792 1.1 jonathan }
793 1.1 jonathan
794 1.1 jonathan #ifdef DIAGNOSTIC
795 1.1 jonathan panic("pcioctl: impossible");
796 1.1 jonathan #endif
797 1.1 jonathan }
798 1.1 jonathan
799 1.1 jonathan void
800 1.1 jonathan pcstart(tp)
801 1.1 jonathan struct tty *tp;
802 1.1 jonathan {
803 1.1 jonathan struct clist *cl;
804 1.13 soda int s, len;
805 1.1 jonathan u_char buf[PCBURST];
806 1.1 jonathan
807 1.1 jonathan s = spltty();
808 1.1 jonathan if (tp->t_state & (TS_TIMEOUT | TS_BUSY | TS_TTSTOP))
809 1.1 jonathan goto out;
810 1.1 jonathan tp->t_state |= TS_BUSY;
811 1.1 jonathan splx(s);
812 1.1 jonathan /*
813 1.1 jonathan * We need to do this outside spl since it could be fairly
814 1.1 jonathan * expensive and we don't want our serial ports to overflow.
815 1.1 jonathan */
816 1.1 jonathan cl = &tp->t_outq;
817 1.1 jonathan len = q_to_b(cl, buf, PCBURST);
818 1.1 jonathan sput(buf, len);
819 1.1 jonathan s = spltty();
820 1.1 jonathan tp->t_state &= ~TS_BUSY;
821 1.1 jonathan if (cl->c_cc) {
822 1.1 jonathan tp->t_state |= TS_TIMEOUT;
823 1.1 jonathan timeout(ttrstrt, tp, 1);
824 1.1 jonathan }
825 1.1 jonathan if (cl->c_cc <= tp->t_lowat) {
826 1.1 jonathan if (tp->t_state & TS_ASLEEP) {
827 1.1 jonathan tp->t_state &= ~TS_ASLEEP;
828 1.1 jonathan wakeup(cl);
829 1.1 jonathan }
830 1.1 jonathan selwakeup(&tp->t_wsel);
831 1.1 jonathan }
832 1.1 jonathan out:
833 1.1 jonathan splx(s);
834 1.1 jonathan }
835 1.1 jonathan
836 1.1 jonathan void
837 1.1 jonathan pcstop(tp, flag)
838 1.1 jonathan struct tty *tp;
839 1.1 jonathan int flag;
840 1.1 jonathan {
841 1.1 jonathan }
842 1.1 jonathan
843 1.13 soda /* ARGSUSED */
844 1.1 jonathan void
845 1.13 soda pccnattach()
846 1.1 jonathan {
847 1.1 jonathan int maj;
848 1.13 soda static struct consdev pccons = {
849 1.13 soda NULL, NULL, pccngetc, pccnputc, pccnpollc, NODEV, CN_NORMAL
850 1.13 soda };
851 1.13 soda
852 1.13 soda /*
853 1.13 soda * For now, don't screw with it.
854 1.13 soda */
855 1.13 soda /* crtat = 0; */
856 1.13 soda switch(cputype) {
857 1.13 soda
858 1.13 soda case ACER_PICA_61:
859 1.13 soda mono_base += PICA_V_LOCAL_VIDEO_CTRL;
860 1.13 soda mono_buf += PICA_V_LOCAL_VIDEO;
861 1.13 soda cga_base += PICA_V_LOCAL_VIDEO_CTRL;
862 1.13 soda cga_buf += PICA_V_LOCAL_VIDEO;
863 1.13 soda kbd_cmdp = PICA_SYS_KBD + 0x61;
864 1.13 soda kbd_datap = PICA_SYS_KBD + 0x60;
865 1.13 soda break;
866 1.13 soda
867 1.13 soda case DESKSTATION_TYNE:
868 1.14 soda mono_base += arc_bus_io.bus_base;
869 1.14 soda mono_buf += arc_bus_mem.bus_base;
870 1.14 soda cga_base += arc_bus_io.bus_base;
871 1.14 soda cga_buf += arc_bus_mem.bus_base;
872 1.14 soda kbd_cmdp = arc_bus_io.bus_base + 0x64;
873 1.14 soda kbd_datap = arc_bus_io.bus_base + 0x60;
874 1.14 soda outb(arc_bus_io.bus_base + 0x3ce, 6); /* Correct video mode */
875 1.14 soda outb(arc_bus_io.bus_base + 0x3cf,
876 1.14 soda inb(arc_bus_io.bus_base + 0x3cf) | 0xc);
877 1.13 soda kbc_put8042cmd(CMDBYTE); /* Want XT codes.. */
878 1.13 soda break;
879 1.13 soda
880 1.13 soda case DESKSTATION_RPC44:
881 1.13 soda mono_base += arc_bus_io.bus_base;
882 1.13 soda mono_buf += arc_bus_mem.bus_base;
883 1.13 soda cga_base += arc_bus_io.bus_base;
884 1.13 soda cga_buf = arc_bus_mem.bus_base + 0xa0000;
885 1.13 soda kbd_cmdp = arc_bus_io.bus_base + 0x64;
886 1.13 soda kbd_datap = arc_bus_io.bus_base + 0x60;
887 1.13 soda kbc_put8042cmd(CMDBYTE); /* Want XT codes.. */
888 1.13 soda break;
889 1.14 soda
890 1.14 soda case SNI_RM200:
891 1.14 soda mono_base += arc_bus_io.bus_base;
892 1.14 soda mono_buf += arc_bus_mem.bus_base;
893 1.14 soda cga_base += arc_bus_io.bus_base;
894 1.14 soda cga_buf += arc_bus_mem.bus_base;
895 1.14 soda kbd_cmdp = arc_bus_io.bus_base + 0x64;
896 1.14 soda kbd_datap = arc_bus_io.bus_base + 0x60;
897 1.14 soda break;
898 1.13 soda }
899 1.1 jonathan
900 1.1 jonathan /* locate the major number */
901 1.1 jonathan for (maj = 0; maj < nchrdev; maj++)
902 1.1 jonathan if (cdevsw[maj].d_open == pcopen)
903 1.1 jonathan break;
904 1.13 soda pccons.cn_dev = makedev(maj, 0);
905 1.1 jonathan
906 1.13 soda cn_tab = &pccons;
907 1.1 jonathan }
908 1.1 jonathan
909 1.1 jonathan /* ARGSUSED */
910 1.1 jonathan void
911 1.1 jonathan pccnputc(dev, c)
912 1.1 jonathan dev_t dev;
913 1.13 soda int c;
914 1.1 jonathan {
915 1.1 jonathan u_char oldkernel = kernel;
916 1.1 jonathan
917 1.1 jonathan kernel = 1;
918 1.1 jonathan if (c == '\n')
919 1.1 jonathan sput("\r\n", 2);
920 1.1 jonathan else
921 1.1 jonathan sput(&c, 1);
922 1.1 jonathan kernel = oldkernel;
923 1.1 jonathan }
924 1.1 jonathan
925 1.1 jonathan /* ARGSUSED */
926 1.13 soda int
927 1.1 jonathan pccngetc(dev)
928 1.1 jonathan dev_t dev;
929 1.1 jonathan {
930 1.1 jonathan register char *cp;
931 1.1 jonathan
932 1.1 jonathan if (pc_xmode > 0)
933 1.1 jonathan return 0;
934 1.1 jonathan
935 1.1 jonathan do {
936 1.1 jonathan /* wait for byte */
937 1.13 soda while ((inb(kbd_cmdp) & KBS_DIB) == 0);
938 1.1 jonathan /* see if it's worthwhile */
939 1.1 jonathan cp = sget();
940 1.1 jonathan } while (!cp);
941 1.1 jonathan if (*cp == '\r')
942 1.1 jonathan return '\n';
943 1.1 jonathan return *cp;
944 1.1 jonathan }
945 1.1 jonathan
946 1.1 jonathan void
947 1.1 jonathan pccnpollc(dev, on)
948 1.1 jonathan dev_t dev;
949 1.1 jonathan int on;
950 1.1 jonathan {
951 1.1 jonathan
952 1.1 jonathan polling = on;
953 1.1 jonathan if (!on) {
954 1.1 jonathan int unit;
955 1.1 jonathan struct pc_softc *sc;
956 1.1 jonathan int s;
957 1.1 jonathan
958 1.1 jonathan /*
959 1.1 jonathan * If disabling polling on a device that's been configured,
960 1.1 jonathan * make sure there are no bytes left in the FIFO, holding up
961 1.1 jonathan * the interrupt line. Otherwise we won't get any further
962 1.1 jonathan * interrupts.
963 1.1 jonathan */
964 1.1 jonathan unit = PCUNIT(dev);
965 1.2 thorpej if (pc_cd.cd_ndevs > unit) {
966 1.2 thorpej sc = pc_cd.cd_devs[unit];
967 1.1 jonathan if (sc != 0) {
968 1.1 jonathan s = spltty();
969 1.1 jonathan pcintr(sc);
970 1.1 jonathan splx(s);
971 1.1 jonathan }
972 1.1 jonathan }
973 1.1 jonathan }
974 1.1 jonathan }
975 1.1 jonathan
976 1.1 jonathan /*
977 1.1 jonathan * Set line parameters.
978 1.1 jonathan */
979 1.1 jonathan int
980 1.1 jonathan pcparam(tp, t)
981 1.1 jonathan struct tty *tp;
982 1.1 jonathan struct termios *t;
983 1.1 jonathan {
984 1.1 jonathan
985 1.1 jonathan tp->t_ispeed = t->c_ispeed;
986 1.1 jonathan tp->t_ospeed = t->c_ospeed;
987 1.1 jonathan tp->t_cflag = t->c_cflag;
988 1.1 jonathan return 0;
989 1.1 jonathan }
990 1.1 jonathan
991 1.1 jonathan #define wrtchar(c, at) do {\
992 1.1 jonathan char *cp = (char *)crtat; *cp++ = (c); *cp = (at); crtat++; vs.col++; \
993 1.1 jonathan } while (0)
994 1.1 jonathan
995 1.1 jonathan /* translate ANSI color codes to standard pc ones */
996 1.1 jonathan static char fgansitopc[] = {
997 1.1 jonathan FG_BLACK, FG_RED, FG_GREEN, FG_BROWN, FG_BLUE,
998 1.1 jonathan FG_MAGENTA, FG_CYAN, FG_LIGHTGREY
999 1.1 jonathan };
1000 1.1 jonathan
1001 1.1 jonathan static char bgansitopc[] = {
1002 1.1 jonathan BG_BLACK, BG_RED, BG_GREEN, BG_BROWN, BG_BLUE,
1003 1.1 jonathan BG_MAGENTA, BG_CYAN, BG_LIGHTGREY
1004 1.1 jonathan };
1005 1.1 jonathan
1006 1.1 jonathan static u_char iso2ibm437[] =
1007 1.1 jonathan {
1008 1.1 jonathan 0, 0, 0, 0, 0, 0, 0, 0,
1009 1.1 jonathan 0, 0, 0, 0, 0, 0, 0, 0,
1010 1.1 jonathan 0, 0, 0, 0, 0, 0, 0, 0,
1011 1.1 jonathan 0, 0, 0, 0, 0, 0, 0, 0,
1012 1.1 jonathan 0xff, 0xad, 0x9b, 0x9c, 0, 0x9d, 0, 0x40,
1013 1.1 jonathan 0x6f, 0x63, 0x61, 0xae, 0, 0, 0, 0,
1014 1.1 jonathan 0xf8, 0xf1, 0xfd, 0x33, 0, 0xe6, 0, 0xfa,
1015 1.1 jonathan 0, 0x31, 0x6f, 0xaf, 0xac, 0xab, 0, 0xa8,
1016 1.1 jonathan 0x41, 0x41, 0x41, 0x41, 0x8e, 0x8f, 0x92, 0x80,
1017 1.1 jonathan 0x45, 0x90, 0x45, 0x45, 0x49, 0x49, 0x49, 0x49,
1018 1.1 jonathan 0x81, 0xa5, 0x4f, 0x4f, 0x4f, 0x4f, 0x99, 0x4f,
1019 1.1 jonathan 0x4f, 0x55, 0x55, 0x55, 0x9a, 0x59, 0, 0xe1,
1020 1.1 jonathan 0x85, 0xa0, 0x83, 0x61, 0x84, 0x86, 0x91, 0x87,
1021 1.1 jonathan 0x8a, 0x82, 0x88, 0x89, 0x8d, 0xa1, 0x8c, 0x8b,
1022 1.1 jonathan 0, 0xa4, 0x95, 0xa2, 0x93, 0x6f, 0x94, 0x6f,
1023 1.1 jonathan 0x6f, 0x97, 0xa3, 0x96, 0x81, 0x98, 0, 0
1024 1.1 jonathan };
1025 1.1 jonathan
1026 1.1 jonathan /*
1027 1.1 jonathan * `pc3' termcap emulation.
1028 1.1 jonathan */
1029 1.1 jonathan void
1030 1.1 jonathan sput(cp, n)
1031 1.1 jonathan u_char *cp;
1032 1.1 jonathan int n;
1033 1.1 jonathan {
1034 1.1 jonathan u_char c, scroll = 0;
1035 1.1 jonathan
1036 1.1 jonathan if (pc_xmode > 0)
1037 1.1 jonathan return;
1038 1.1 jonathan
1039 1.1 jonathan if (crtat == 0) {
1040 1.13 soda volatile u_short *cp;
1041 1.1 jonathan u_short was;
1042 1.1 jonathan unsigned cursorat;
1043 1.1 jonathan
1044 1.13 soda cp = (volatile u_short *)cga_buf;
1045 1.1 jonathan was = *cp;
1046 1.13 soda *cp = (volatile u_short) 0xA55A;
1047 1.1 jonathan if (*cp != 0xA55A) {
1048 1.13 soda cp = (volatile u_short *)mono_buf;
1049 1.13 soda addr_6845 = mono_base;
1050 1.1 jonathan vs.color = 0;
1051 1.1 jonathan } else {
1052 1.1 jonathan *cp = was;
1053 1.13 soda addr_6845 = cga_base;
1054 1.1 jonathan vs.color = 1;
1055 1.1 jonathan }
1056 1.1 jonathan
1057 1.1 jonathan #ifdef FAT_CURSOR
1058 1.1 jonathan cursor_shape = 0x0012;
1059 1.1 jonathan #else
1060 1.1 jonathan get_cursor_shape();
1061 1.1 jonathan #endif
1062 1.1 jonathan
1063 1.13 soda bios_display_info(&vs.col, &vs.row, &vs.ncol, &vs.nrow);
1064 1.13 soda vs.nchr = vs.ncol * vs.nrow;
1065 1.13 soda vs.col--;
1066 1.13 soda vs.row--;
1067 1.13 soda cursorat = vs.ncol * vs.row + vs.col;
1068 1.13 soda vs.at = FG_LIGHTGREY | BG_BLACK;
1069 1.13 soda
1070 1.1 jonathan Crtat = (u_short *)cp;
1071 1.13 soda crtat = Crtat + cursorat;
1072 1.1 jonathan
1073 1.1 jonathan if (vs.color == 0)
1074 1.1 jonathan vs.so_at = FG_BLACK | BG_LIGHTGREY;
1075 1.1 jonathan else
1076 1.1 jonathan vs.so_at = FG_YELLOW | BG_BLACK;
1077 1.1 jonathan
1078 1.1 jonathan fillw((vs.at << 8) | ' ', crtat, vs.nchr - cursorat);
1079 1.1 jonathan }
1080 1.1 jonathan
1081 1.1 jonathan while (n--) {
1082 1.1 jonathan if (!(c = *cp++))
1083 1.1 jonathan continue;
1084 1.1 jonathan
1085 1.1 jonathan switch (c) {
1086 1.1 jonathan case 0x1B:
1087 1.1 jonathan if (vs.state >= VSS_ESCAPE) {
1088 1.1 jonathan wrtchar(c, vs.so_at);
1089 1.1 jonathan vs.state = 0;
1090 1.1 jonathan goto maybe_scroll;
1091 1.1 jonathan } else
1092 1.1 jonathan vs.state = VSS_ESCAPE;
1093 1.1 jonathan break;
1094 1.1 jonathan
1095 1.13 soda case 0x9B: /* CSI */
1096 1.13 soda vs.cx = vs.cy = 0;
1097 1.13 soda vs.state = VSS_EBRACE;
1098 1.13 soda break;
1099 1.13 soda
1100 1.1 jonathan case '\t': {
1101 1.1 jonathan int inccol = 8 - (vs.col & 7);
1102 1.1 jonathan crtat += inccol;
1103 1.1 jonathan vs.col += inccol;
1104 1.1 jonathan }
1105 1.1 jonathan maybe_scroll:
1106 1.13 soda if (vs.col >= vs.ncol) {
1107 1.13 soda vs.col -= vs.ncol;
1108 1.1 jonathan scroll = 1;
1109 1.1 jonathan }
1110 1.1 jonathan break;
1111 1.1 jonathan
1112 1.13 soda case '\b':
1113 1.1 jonathan if (crtat <= Crtat)
1114 1.1 jonathan break;
1115 1.1 jonathan --crtat;
1116 1.1 jonathan if (--vs.col < 0)
1117 1.13 soda vs.col += vs.ncol; /* non-destructive backspace */
1118 1.1 jonathan break;
1119 1.1 jonathan
1120 1.1 jonathan case '\r':
1121 1.1 jonathan crtat -= vs.col;
1122 1.1 jonathan vs.col = 0;
1123 1.1 jonathan break;
1124 1.1 jonathan
1125 1.1 jonathan case '\n':
1126 1.1 jonathan crtat += vs.ncol;
1127 1.1 jonathan scroll = 1;
1128 1.1 jonathan break;
1129 1.1 jonathan
1130 1.1 jonathan default:
1131 1.1 jonathan switch (vs.state) {
1132 1.1 jonathan case 0:
1133 1.1 jonathan if (c == '\a')
1134 1.1 jonathan sysbeep(BEEP_FREQ, BEEP_TIME);
1135 1.1 jonathan else {
1136 1.1 jonathan /*
1137 1.1 jonathan * If we're outputting multiple printed
1138 1.1 jonathan * characters, just blast them to the
1139 1.1 jonathan * screen until we reach the end of the
1140 1.1 jonathan * buffer or a control character. This
1141 1.1 jonathan * saves time by short-circuiting the
1142 1.1 jonathan * switch.
1143 1.1 jonathan * If we reach the end of the line, we
1144 1.1 jonathan * break to do a scroll check.
1145 1.1 jonathan */
1146 1.1 jonathan for (;;) {
1147 1.1 jonathan if (c & 0x80)
1148 1.1 jonathan c = iso2ibm437[c&0x7f];
1149 1.1 jonathan
1150 1.1 jonathan if (vs.so)
1151 1.1 jonathan wrtchar(c, vs.so_at);
1152 1.1 jonathan else
1153 1.1 jonathan wrtchar(c, vs.at);
1154 1.1 jonathan if (vs.col >= vs.ncol) {
1155 1.1 jonathan vs.col = 0;
1156 1.1 jonathan scroll = 1;
1157 1.1 jonathan break;
1158 1.1 jonathan }
1159 1.1 jonathan if (!n || (c = *cp) < ' ')
1160 1.1 jonathan break;
1161 1.1 jonathan n--, cp++;
1162 1.1 jonathan }
1163 1.1 jonathan }
1164 1.1 jonathan break;
1165 1.1 jonathan case VSS_ESCAPE:
1166 1.13 soda switch (c) {
1167 1.13 soda case '[': /* Start ESC [ sequence */
1168 1.13 soda vs.cx = vs.cy = 0;
1169 1.13 soda vs.state = VSS_EBRACE;
1170 1.13 soda break;
1171 1.13 soda case 'c': /* Create screen & home */
1172 1.13 soda fillw((vs.at << 8) | ' ',
1173 1.13 soda Crtat, vs.nchr);
1174 1.13 soda crtat = Crtat;
1175 1.13 soda vs.col = 0;
1176 1.13 soda vs.state = 0;
1177 1.13 soda break;
1178 1.13 soda case '7': /* save cursor pos */
1179 1.13 soda vs.offset = crtat - Crtat;
1180 1.13 soda vs.state = 0;
1181 1.13 soda break;
1182 1.13 soda case '8': /* restore cursor pos */
1183 1.13 soda crtat = Crtat + vs.offset;
1184 1.13 soda vs.row = vs.offset / vs.ncol;
1185 1.13 soda vs.col = vs.offset % vs.ncol;
1186 1.13 soda vs.state = 0;
1187 1.13 soda break;
1188 1.13 soda default: /* Invalid, clear state */
1189 1.13 soda wrtchar(c, vs.so_at);
1190 1.13 soda vs.state = 0;
1191 1.13 soda goto maybe_scroll;
1192 1.1 jonathan }
1193 1.1 jonathan break;
1194 1.13 soda
1195 1.1 jonathan default: /* VSS_EBRACE or VSS_EPARAM */
1196 1.1 jonathan switch (c) {
1197 1.1 jonathan int pos;
1198 1.1 jonathan case 'm':
1199 1.1 jonathan if (!vs.cx)
1200 1.1 jonathan vs.so = 0;
1201 1.1 jonathan else
1202 1.1 jonathan vs.so = 1;
1203 1.1 jonathan vs.state = 0;
1204 1.1 jonathan break;
1205 1.1 jonathan case 'A': { /* back cx rows */
1206 1.1 jonathan int cx = vs.cx;
1207 1.1 jonathan if (cx <= 0)
1208 1.1 jonathan cx = 1;
1209 1.1 jonathan else
1210 1.1 jonathan cx %= vs.nrow;
1211 1.1 jonathan pos = crtat - Crtat;
1212 1.1 jonathan pos -= vs.ncol * cx;
1213 1.1 jonathan if (pos < 0)
1214 1.1 jonathan pos += vs.nchr;
1215 1.1 jonathan crtat = Crtat + pos;
1216 1.1 jonathan vs.state = 0;
1217 1.1 jonathan break;
1218 1.1 jonathan }
1219 1.1 jonathan case 'B': { /* down cx rows */
1220 1.1 jonathan int cx = vs.cx;
1221 1.1 jonathan if (cx <= 0)
1222 1.1 jonathan cx = 1;
1223 1.1 jonathan else
1224 1.1 jonathan cx %= vs.nrow;
1225 1.1 jonathan pos = crtat - Crtat;
1226 1.1 jonathan pos += vs.ncol * cx;
1227 1.1 jonathan if (pos >= vs.nchr)
1228 1.1 jonathan pos -= vs.nchr;
1229 1.1 jonathan crtat = Crtat + pos;
1230 1.1 jonathan vs.state = 0;
1231 1.1 jonathan break;
1232 1.1 jonathan }
1233 1.1 jonathan case 'C': { /* right cursor */
1234 1.1 jonathan int cx = vs.cx,
1235 1.1 jonathan col = vs.col;
1236 1.1 jonathan if (cx <= 0)
1237 1.1 jonathan cx = 1;
1238 1.1 jonathan else
1239 1.1 jonathan cx %= vs.ncol;
1240 1.1 jonathan pos = crtat - Crtat;
1241 1.1 jonathan pos += cx;
1242 1.1 jonathan col += cx;
1243 1.1 jonathan if (col >= vs.ncol) {
1244 1.1 jonathan pos -= vs.ncol;
1245 1.1 jonathan col -= vs.ncol;
1246 1.1 jonathan }
1247 1.1 jonathan vs.col = col;
1248 1.1 jonathan crtat = Crtat + pos;
1249 1.1 jonathan vs.state = 0;
1250 1.1 jonathan break;
1251 1.1 jonathan }
1252 1.1 jonathan case 'D': { /* left cursor */
1253 1.1 jonathan int cx = vs.cx,
1254 1.1 jonathan col = vs.col;
1255 1.1 jonathan if (cx <= 0)
1256 1.1 jonathan cx = 1;
1257 1.1 jonathan else
1258 1.1 jonathan cx %= vs.ncol;
1259 1.1 jonathan pos = crtat - Crtat;
1260 1.1 jonathan pos -= cx;
1261 1.1 jonathan col -= cx;
1262 1.1 jonathan if (col < 0) {
1263 1.1 jonathan pos += vs.ncol;
1264 1.1 jonathan col += vs.ncol;
1265 1.1 jonathan }
1266 1.1 jonathan vs.col = col;
1267 1.1 jonathan crtat = Crtat + pos;
1268 1.1 jonathan vs.state = 0;
1269 1.1 jonathan break;
1270 1.1 jonathan }
1271 1.1 jonathan case 'J': /* Clear ... */
1272 1.1 jonathan switch (vs.cx) {
1273 1.1 jonathan case 0:
1274 1.1 jonathan /* ... to end of display */
1275 1.13 soda fillw((vs.at << 8) | ' ',
1276 1.13 soda crtat,
1277 1.1 jonathan Crtat + vs.nchr - crtat);
1278 1.1 jonathan break;
1279 1.1 jonathan case 1:
1280 1.1 jonathan /* ... to next location */
1281 1.13 soda fillw((vs.at << 8) | ' ',
1282 1.13 soda Crtat,
1283 1.1 jonathan crtat - Crtat + 1);
1284 1.1 jonathan break;
1285 1.1 jonathan case 2:
1286 1.1 jonathan /* ... whole display */
1287 1.13 soda fillw((vs.at << 8) | ' ',
1288 1.13 soda Crtat,
1289 1.1 jonathan vs.nchr);
1290 1.1 jonathan break;
1291 1.1 jonathan }
1292 1.1 jonathan vs.state = 0;
1293 1.1 jonathan break;
1294 1.1 jonathan case 'K': /* Clear line ... */
1295 1.1 jonathan switch (vs.cx) {
1296 1.1 jonathan case 0:
1297 1.1 jonathan /* ... current to EOL */
1298 1.13 soda fillw((vs.at << 8) | ' ',
1299 1.13 soda crtat,
1300 1.1 jonathan vs.ncol - vs.col);
1301 1.1 jonathan break;
1302 1.1 jonathan case 1:
1303 1.1 jonathan /* ... beginning to next */
1304 1.1 jonathan fillw((vs.at << 8) | ' ',
1305 1.1 jonathan crtat - vs.col,
1306 1.1 jonathan vs.col + 1);
1307 1.1 jonathan break;
1308 1.1 jonathan case 2:
1309 1.1 jonathan /* ... entire line */
1310 1.1 jonathan fillw((vs.at << 8) | ' ',
1311 1.1 jonathan crtat - vs.col, vs.ncol);
1312 1.1 jonathan break;
1313 1.1 jonathan }
1314 1.1 jonathan vs.state = 0;
1315 1.1 jonathan break;
1316 1.1 jonathan case 'f': /* in system V consoles */
1317 1.1 jonathan case 'H': { /* Cursor move */
1318 1.1 jonathan int cx = vs.cx,
1319 1.1 jonathan cy = vs.cy;
1320 1.1 jonathan if (!cx || !cy) {
1321 1.1 jonathan crtat = Crtat;
1322 1.1 jonathan vs.col = 0;
1323 1.1 jonathan } else {
1324 1.1 jonathan if (cx > vs.nrow)
1325 1.1 jonathan cx = vs.nrow;
1326 1.1 jonathan if (cy > vs.ncol)
1327 1.1 jonathan cy = vs.ncol;
1328 1.1 jonathan crtat = Crtat +
1329 1.1 jonathan (cx - 1) * vs.ncol + cy - 1;
1330 1.1 jonathan vs.col = cy - 1;
1331 1.1 jonathan }
1332 1.1 jonathan vs.state = 0;
1333 1.1 jonathan break;
1334 1.1 jonathan }
1335 1.1 jonathan case 'M': { /* delete cx rows */
1336 1.1 jonathan u_short *crtAt = crtat - vs.col;
1337 1.1 jonathan int cx = vs.cx,
1338 1.1 jonathan row = (crtAt - Crtat) / vs.ncol,
1339 1.1 jonathan nrow = vs.nrow - row;
1340 1.1 jonathan if (cx <= 0)
1341 1.1 jonathan cx = 1;
1342 1.1 jonathan else if (cx > nrow)
1343 1.1 jonathan cx = nrow;
1344 1.1 jonathan if (cx < nrow)
1345 1.13 soda #ifdef PCCONS_FORCE_WORD
1346 1.13 soda wcopy(crtAt + vs.ncol * cx,
1347 1.13 soda crtAt, vs.ncol * (nrow -
1348 1.13 soda cx) * CHR);
1349 1.13 soda #else
1350 1.1 jonathan bcopy(crtAt + vs.ncol * cx,
1351 1.1 jonathan crtAt, vs.ncol * (nrow -
1352 1.1 jonathan cx) * CHR);
1353 1.13 soda #endif
1354 1.1 jonathan fillw((vs.at << 8) | ' ',
1355 1.1 jonathan crtAt + vs.ncol * (nrow - cx),
1356 1.1 jonathan vs.ncol * cx);
1357 1.1 jonathan vs.state = 0;
1358 1.1 jonathan break;
1359 1.1 jonathan }
1360 1.1 jonathan case 'S': { /* scroll up cx lines */
1361 1.1 jonathan int cx = vs.cx;
1362 1.1 jonathan if (cx <= 0)
1363 1.1 jonathan cx = 1;
1364 1.1 jonathan else if (cx > vs.nrow)
1365 1.1 jonathan cx = vs.nrow;
1366 1.1 jonathan if (cx < vs.nrow)
1367 1.13 soda #ifdef PCCONS_FORCE_WORD
1368 1.13 soda wcopy(Crtat + vs.ncol * cx,
1369 1.13 soda Crtat, vs.ncol * (vs.nrow -
1370 1.13 soda cx) * CHR);
1371 1.13 soda #else
1372 1.1 jonathan bcopy(Crtat + vs.ncol * cx,
1373 1.1 jonathan Crtat, vs.ncol * (vs.nrow -
1374 1.1 jonathan cx) * CHR);
1375 1.13 soda #endif
1376 1.1 jonathan fillw((vs.at << 8) | ' ',
1377 1.1 jonathan Crtat + vs.ncol * (vs.nrow - cx),
1378 1.1 jonathan vs.ncol * cx);
1379 1.13 soda /* crtat -= vs.ncol * cx; XXX */
1380 1.1 jonathan vs.state = 0;
1381 1.1 jonathan break;
1382 1.1 jonathan }
1383 1.1 jonathan case 'L': { /* insert cx rows */
1384 1.1 jonathan u_short *crtAt = crtat - vs.col;
1385 1.1 jonathan int cx = vs.cx,
1386 1.1 jonathan row = (crtAt - Crtat) / vs.ncol,
1387 1.1 jonathan nrow = vs.nrow - row;
1388 1.1 jonathan if (cx <= 0)
1389 1.1 jonathan cx = 1;
1390 1.1 jonathan else if (cx > nrow)
1391 1.1 jonathan cx = nrow;
1392 1.1 jonathan if (cx < nrow)
1393 1.13 soda #ifdef PCCONS_FORCE_WORD
1394 1.13 soda wcopy(crtAt,
1395 1.13 soda crtAt + vs.ncol * cx,
1396 1.13 soda vs.ncol * (nrow - cx) *
1397 1.13 soda CHR);
1398 1.13 soda #else
1399 1.1 jonathan bcopy(crtAt,
1400 1.1 jonathan crtAt + vs.ncol * cx,
1401 1.1 jonathan vs.ncol * (nrow - cx) *
1402 1.1 jonathan CHR);
1403 1.13 soda #endif
1404 1.1 jonathan fillw((vs.at << 8) | ' ', crtAt,
1405 1.1 jonathan vs.ncol * cx);
1406 1.1 jonathan vs.state = 0;
1407 1.1 jonathan break;
1408 1.1 jonathan }
1409 1.1 jonathan case 'T': { /* scroll down cx lines */
1410 1.1 jonathan int cx = vs.cx;
1411 1.1 jonathan if (cx <= 0)
1412 1.1 jonathan cx = 1;
1413 1.1 jonathan else if (cx > vs.nrow)
1414 1.1 jonathan cx = vs.nrow;
1415 1.1 jonathan if (cx < vs.nrow)
1416 1.13 soda #ifdef PCCONS_FORCE_WORD
1417 1.13 soda wcopy(Crtat,
1418 1.13 soda Crtat + vs.ncol * cx,
1419 1.13 soda vs.ncol * (vs.nrow - cx) *
1420 1.13 soda CHR);
1421 1.13 soda #else
1422 1.1 jonathan bcopy(Crtat,
1423 1.1 jonathan Crtat + vs.ncol * cx,
1424 1.1 jonathan vs.ncol * (vs.nrow - cx) *
1425 1.1 jonathan CHR);
1426 1.13 soda #endif
1427 1.1 jonathan fillw((vs.at << 8) | ' ', Crtat,
1428 1.1 jonathan vs.ncol * cx);
1429 1.13 soda /* crtat += vs.ncol * cx; XXX */
1430 1.1 jonathan vs.state = 0;
1431 1.1 jonathan break;
1432 1.1 jonathan }
1433 1.1 jonathan case ';': /* Switch params in cursor def */
1434 1.1 jonathan vs.state = VSS_EPARAM;
1435 1.1 jonathan break;
1436 1.1 jonathan case 'r':
1437 1.1 jonathan vs.so_at = (vs.cx & FG_MASK) |
1438 1.1 jonathan ((vs.cy << 4) & BG_MASK);
1439 1.1 jonathan vs.state = 0;
1440 1.1 jonathan break;
1441 1.13 soda case 's': /* save cursor pos */
1442 1.13 soda vs.offset = crtat - Crtat;
1443 1.13 soda vs.state = 0;
1444 1.13 soda break;
1445 1.13 soda case 'u': /* restore cursor pos */
1446 1.13 soda crtat = Crtat + vs.offset;
1447 1.13 soda vs.row = vs.offset / vs.ncol;
1448 1.13 soda vs.col = vs.offset % vs.ncol;
1449 1.13 soda vs.state = 0;
1450 1.13 soda break;
1451 1.1 jonathan case 'x': /* set attributes */
1452 1.1 jonathan switch (vs.cx) {
1453 1.1 jonathan case 0:
1454 1.1 jonathan vs.at = FG_LIGHTGREY | BG_BLACK;
1455 1.1 jonathan break;
1456 1.1 jonathan case 1:
1457 1.1 jonathan /* ansi background */
1458 1.1 jonathan if (!vs.color)
1459 1.1 jonathan break;
1460 1.1 jonathan vs.at &= FG_MASK;
1461 1.1 jonathan vs.at |= bgansitopc[vs.cy & 7];
1462 1.1 jonathan break;
1463 1.1 jonathan case 2:
1464 1.1 jonathan /* ansi foreground */
1465 1.1 jonathan if (!vs.color)
1466 1.1 jonathan break;
1467 1.1 jonathan vs.at &= BG_MASK;
1468 1.1 jonathan vs.at |= fgansitopc[vs.cy & 7];
1469 1.1 jonathan break;
1470 1.1 jonathan case 3:
1471 1.1 jonathan /* pc text attribute */
1472 1.1 jonathan if (vs.state >= VSS_EPARAM)
1473 1.1 jonathan vs.at = vs.cy;
1474 1.1 jonathan break;
1475 1.1 jonathan }
1476 1.1 jonathan vs.state = 0;
1477 1.1 jonathan break;
1478 1.1 jonathan
1479 1.1 jonathan default: /* Only numbers valid here */
1480 1.1 jonathan if ((c >= '0') && (c <= '9')) {
1481 1.1 jonathan if (vs.state >= VSS_EPARAM) {
1482 1.1 jonathan vs.cy *= 10;
1483 1.1 jonathan vs.cy += c - '0';
1484 1.1 jonathan } else {
1485 1.1 jonathan vs.cx *= 10;
1486 1.1 jonathan vs.cx += c - '0';
1487 1.1 jonathan }
1488 1.1 jonathan } else
1489 1.1 jonathan vs.state = 0;
1490 1.1 jonathan break;
1491 1.1 jonathan }
1492 1.1 jonathan break;
1493 1.1 jonathan }
1494 1.1 jonathan }
1495 1.1 jonathan if (scroll) {
1496 1.1 jonathan scroll = 0;
1497 1.1 jonathan /* scroll check */
1498 1.1 jonathan if (crtat >= Crtat + vs.nchr) {
1499 1.1 jonathan if (!kernel) {
1500 1.1 jonathan int s = spltty();
1501 1.13 soda if (lock_state & KB_SCROLL)
1502 1.13 soda tsleep(&lock_state,
1503 1.1 jonathan PUSER, "pcputc", 0);
1504 1.1 jonathan splx(s);
1505 1.1 jonathan }
1506 1.13 soda #if PCCONS_FORCE_WORD
1507 1.13 soda wcopy(Crtat + vs.ncol, Crtat,
1508 1.13 soda (vs.nchr - vs.ncol) * CHR);
1509 1.13 soda #else
1510 1.1 jonathan bcopy(Crtat + vs.ncol, Crtat,
1511 1.1 jonathan (vs.nchr - vs.ncol) * CHR);
1512 1.13 soda #endif
1513 1.1 jonathan fillw((vs.at << 8) | ' ',
1514 1.13 soda Crtat + vs.nchr - vs.ncol,
1515 1.13 soda vs.ncol);
1516 1.1 jonathan crtat -= vs.ncol;
1517 1.1 jonathan }
1518 1.1 jonathan }
1519 1.1 jonathan }
1520 1.1 jonathan async_update();
1521 1.1 jonathan }
1522 1.1 jonathan
1523 1.13 soda /* the unshifted code for KB_SHIFT keys is used by X to distinguish between
1524 1.13 soda left and right shift when reading the keyboard map */
1525 1.13 soda static pccons_keymap_t scan_codes[KB_NUM_KEYS] = {
1526 1.13 soda /* type unshift shift control altgr shift_altgr scancode */
1527 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 0 unused */
1528 1.13 soda { KB_ASCII, "\033", "\033", "\033", "", ""}, /* 1 ESCape */
1529 1.13 soda { KB_ASCII, "1", "!", "!", "", ""}, /* 2 1 */
1530 1.13 soda { KB_ASCII, "2", "@", "\000", "", ""}, /* 3 2 */
1531 1.13 soda { KB_ASCII, "3", "#", "#", "", ""}, /* 4 3 */
1532 1.13 soda { KB_ASCII, "4", "$", "$", "", ""}, /* 5 4 */
1533 1.13 soda { KB_ASCII, "5", "%", "%", "", ""}, /* 6 5 */
1534 1.13 soda { KB_ASCII, "6", "^", "\036", "", ""}, /* 7 6 */
1535 1.13 soda { KB_ASCII, "7", "&", "&", "", ""}, /* 8 7 */
1536 1.13 soda { KB_ASCII, "8", "*", "\010", "", ""}, /* 9 8 */
1537 1.13 soda { KB_ASCII, "9", "(", "(", "", ""}, /* 10 9 */
1538 1.13 soda { KB_ASCII, "0", ")", ")", "", ""}, /* 11 0 */
1539 1.13 soda { KB_ASCII, "-", "_", "\037", "", ""}, /* 12 - */
1540 1.13 soda { KB_ASCII, "=", "+", "+", "", ""}, /* 13 = */
1541 1.13 soda { KB_ASCII, "\177", "\177", "\010", "", ""}, /* 14 backspace */
1542 1.13 soda { KB_ASCII, "\t", "\t", "\t", "", ""}, /* 15 tab */
1543 1.13 soda { KB_ASCII, "q", "Q", "\021", "", ""}, /* 16 q */
1544 1.13 soda { KB_ASCII, "w", "W", "\027", "", ""}, /* 17 w */
1545 1.13 soda { KB_ASCII, "e", "E", "\005", "", ""}, /* 18 e */
1546 1.13 soda { KB_ASCII, "r", "R", "\022", "", ""}, /* 19 r */
1547 1.13 soda { KB_ASCII, "t", "T", "\024", "", ""}, /* 20 t */
1548 1.13 soda { KB_ASCII, "y", "Y", "\031", "", ""}, /* 21 y */
1549 1.13 soda { KB_ASCII, "u", "U", "\025", "", ""}, /* 22 u */
1550 1.13 soda { KB_ASCII, "i", "I", "\011", "", ""}, /* 23 i */
1551 1.13 soda { KB_ASCII, "o", "O", "\017", "", ""}, /* 24 o */
1552 1.13 soda { KB_ASCII, "p", "P", "\020", "", ""}, /* 25 p */
1553 1.13 soda { KB_ASCII, "[", "{", "\033", "", ""}, /* 26 [ */
1554 1.13 soda { KB_ASCII, "]", "}", "\035", "", ""}, /* 27 ] */
1555 1.13 soda { KB_ASCII, "\r", "\r", "\n", "", ""}, /* 28 return */
1556 1.13 soda { KB_CTL, "", "", "", "", ""}, /* 29 control */
1557 1.13 soda { KB_ASCII, "a", "A", "\001", "", ""}, /* 30 a */
1558 1.13 soda { KB_ASCII, "s", "S", "\023", "", ""}, /* 31 s */
1559 1.13 soda { KB_ASCII, "d", "D", "\004", "", ""}, /* 32 d */
1560 1.13 soda { KB_ASCII, "f", "F", "\006", "", ""}, /* 33 f */
1561 1.13 soda { KB_ASCII, "g", "G", "\007", "", ""}, /* 34 g */
1562 1.13 soda { KB_ASCII, "h", "H", "\010", "", ""}, /* 35 h */
1563 1.13 soda { KB_ASCII, "j", "J", "\n", "", ""}, /* 36 j */
1564 1.13 soda { KB_ASCII, "k", "K", "\013", "", ""}, /* 37 k */
1565 1.13 soda { KB_ASCII, "l", "L", "\014", "", ""}, /* 38 l */
1566 1.13 soda { KB_ASCII, ";", ":", ";", "", ""}, /* 39 ; */
1567 1.13 soda { KB_ASCII, "'", "\"", "'", "", ""}, /* 40 ' */
1568 1.13 soda { KB_ASCII, "`", "~", "`", "", ""}, /* 41 ` */
1569 1.13 soda { KB_SHIFT, "\001", "", "", "", ""}, /* 42 shift */
1570 1.13 soda { KB_ASCII, "\\", "|", "\034", "", ""}, /* 43 \ */
1571 1.13 soda { KB_ASCII, "z", "Z", "\032", "", ""}, /* 44 z */
1572 1.13 soda { KB_ASCII, "x", "X", "\030", "", ""}, /* 45 x */
1573 1.13 soda { KB_ASCII, "c", "C", "\003", "", ""}, /* 46 c */
1574 1.13 soda { KB_ASCII, "v", "V", "\026", "", ""}, /* 47 v */
1575 1.13 soda { KB_ASCII, "b", "B", "\002", "", ""}, /* 48 b */
1576 1.13 soda { KB_ASCII, "n", "N", "\016", "", ""}, /* 49 n */
1577 1.13 soda { KB_ASCII, "m", "M", "\r", "", ""}, /* 50 m */
1578 1.13 soda { KB_ASCII, ",", "<", "<", "", ""}, /* 51 , */
1579 1.13 soda { KB_ASCII, ".", ">", ">", "", ""}, /* 52 . */
1580 1.13 soda { KB_ASCII, "/", "?", "\037", "", ""}, /* 53 / */
1581 1.13 soda { KB_SHIFT, "\002", "", "", "", ""}, /* 54 shift */
1582 1.13 soda { KB_KP, "*", "*", "*", "", ""}, /* 55 kp * */
1583 1.13 soda { KB_ALT, "", "", "", "", ""}, /* 56 alt */
1584 1.13 soda { KB_ASCII, " ", " ", "\000", "", ""}, /* 57 space */
1585 1.13 soda { KB_CAPS, "", "", "", "", ""}, /* 58 caps */
1586 1.13 soda { KB_FUNC, "\033[M", "\033[Y", "\033[k", "", ""}, /* 59 f1 */
1587 1.13 soda { KB_FUNC, "\033[N", "\033[Z", "\033[l", "", ""}, /* 60 f2 */
1588 1.13 soda { KB_FUNC, "\033[O", "\033[a", "\033[m", "", ""}, /* 61 f3 */
1589 1.13 soda { KB_FUNC, "\033[P", "\033[b", "\033[n", "", ""}, /* 62 f4 */
1590 1.13 soda { KB_FUNC, "\033[Q", "\033[c", "\033[o", "", ""}, /* 63 f5 */
1591 1.13 soda { KB_FUNC, "\033[R", "\033[d", "\033[p", "", ""}, /* 64 f6 */
1592 1.13 soda { KB_FUNC, "\033[S", "\033[e", "\033[q", "", ""}, /* 65 f7 */
1593 1.13 soda { KB_FUNC, "\033[T", "\033[f", "\033[r", "", ""}, /* 66 f8 */
1594 1.13 soda { KB_FUNC, "\033[U", "\033[g", "\033[s", "", ""}, /* 67 f9 */
1595 1.13 soda { KB_FUNC, "\033[V", "\033[h", "\033[t", "", ""}, /* 68 f10 */
1596 1.13 soda { KB_NUM, "", "", "", "", ""}, /* 69 num lock */
1597 1.13 soda { KB_SCROLL, "", "", "", "", ""}, /* 70 scroll lock */
1598 1.13 soda { KB_KP, "7", "\033[H", "7", "", ""}, /* 71 kp 7 */
1599 1.13 soda { KB_KP, "8", "\033[A", "8", "", ""}, /* 72 kp 8 */
1600 1.13 soda { KB_KP, "9", "\033[I", "9", "", ""}, /* 73 kp 9 */
1601 1.13 soda { KB_KP, "-", "-", "-", "", ""}, /* 74 kp - */
1602 1.13 soda { KB_KP, "4", "\033[D", "4", "", ""}, /* 75 kp 4 */
1603 1.13 soda { KB_KP, "5", "\033[E", "5", "", ""}, /* 76 kp 5 */
1604 1.13 soda { KB_KP, "6", "\033[C", "6", "", ""}, /* 77 kp 6 */
1605 1.13 soda { KB_KP, "+", "+", "+", "", ""}, /* 78 kp + */
1606 1.13 soda { KB_KP, "1", "\033[F", "1", "", ""}, /* 79 kp 1 */
1607 1.13 soda { KB_KP, "2", "\033[B", "2", "", ""}, /* 80 kp 2 */
1608 1.13 soda { KB_KP, "3", "\033[G", "3", "", ""}, /* 81 kp 3 */
1609 1.13 soda { KB_KP, "0", "\033[L", "0", "", ""}, /* 82 kp 0 */
1610 1.13 soda { KB_KP, ",", "\177", ",", "", ""}, /* 83 kp , */
1611 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 84 0 */
1612 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 85 0 */
1613 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 86 0 */
1614 1.13 soda { KB_FUNC, "\033[W", "\033[i", "\033[u", "", ""}, /* 87 f11 */
1615 1.13 soda { KB_FUNC, "\033[X", "\033[j", "\033[v", "", ""}, /* 88 f12 */
1616 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 89 0 */
1617 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 90 0 */
1618 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 91 0 */
1619 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 92 0 */
1620 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 93 0 */
1621 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 94 0 */
1622 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 95 0 */
1623 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 96 0 */
1624 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 97 0 */
1625 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 98 0 */
1626 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 99 0 */
1627 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 100 */
1628 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 101 */
1629 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 102 */
1630 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 103 */
1631 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 104 */
1632 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 105 */
1633 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 106 */
1634 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 107 */
1635 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 108 */
1636 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 109 */
1637 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 110 */
1638 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 111 */
1639 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 112 */
1640 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 113 */
1641 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 114 */
1642 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 115 */
1643 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 116 */
1644 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 117 */
1645 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 118 */
1646 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 119 */
1647 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 120 */
1648 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 121 */
1649 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 122 */
1650 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 123 */
1651 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 124 */
1652 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 125 */
1653 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 126 */
1654 1.13 soda { KB_NONE, "", "", "", "", ""} /* 127 */
1655 1.1 jonathan };
1656 1.1 jonathan
1657 1.1 jonathan /*
1658 1.1 jonathan * Get characters from the keyboard. If none are present, return NULL.
1659 1.1 jonathan */
1660 1.1 jonathan char *
1661 1.1 jonathan sget()
1662 1.1 jonathan {
1663 1.1 jonathan u_char dt;
1664 1.1 jonathan static u_char extended = 0, shift_state = 0;
1665 1.1 jonathan static u_char capchar[2];
1666 1.1 jonathan
1667 1.1 jonathan top:
1668 1.1 jonathan KBD_DELAY;
1669 1.13 soda dt = inb(kbd_datap);
1670 1.1 jonathan
1671 1.1 jonathan switch (dt) {
1672 1.1 jonathan case KBR_ACK: case KBR_ECHO:
1673 1.1 jonathan kb_oq_get = (kb_oq_get + 1) & 7;
1674 1.1 jonathan if(kb_oq_get != kb_oq_put) {
1675 1.13 soda outb(kbd_datap, kb_oq[kb_oq_get]);
1676 1.1 jonathan }
1677 1.1 jonathan goto loop;
1678 1.1 jonathan case KBR_RESEND:
1679 1.13 soda outb(kbd_datap, kb_oq[kb_oq_get]);
1680 1.1 jonathan goto loop;
1681 1.1 jonathan }
1682 1.1 jonathan
1683 1.1 jonathan if (pc_xmode > 0) {
1684 1.1 jonathan #if defined(DDB) && defined(XSERVER_DDB)
1685 1.1 jonathan /* F12 enters the debugger while in X mode */
1686 1.1 jonathan if (dt == 88)
1687 1.1 jonathan Debugger();
1688 1.1 jonathan #endif
1689 1.1 jonathan capchar[0] = dt;
1690 1.1 jonathan capchar[1] = 0;
1691 1.1 jonathan /*
1692 1.1 jonathan * Check for locking keys.
1693 1.1 jonathan *
1694 1.1 jonathan * XXX Setting the LEDs this way is a bit bogus. What if the
1695 1.1 jonathan * keyboard has been remapped in X?
1696 1.1 jonathan */
1697 1.13 soda switch (scan_codes[dt & 0x7f].type) {
1698 1.13 soda case KB_NUM:
1699 1.1 jonathan if (dt & 0x80) {
1700 1.13 soda shift_state &= ~KB_NUM;
1701 1.1 jonathan break;
1702 1.1 jonathan }
1703 1.13 soda if (shift_state & KB_NUM)
1704 1.1 jonathan break;
1705 1.13 soda shift_state |= KB_NUM;
1706 1.13 soda lock_state ^= KB_NUM;
1707 1.1 jonathan async_update();
1708 1.1 jonathan break;
1709 1.13 soda case KB_CAPS:
1710 1.1 jonathan if (dt & 0x80) {
1711 1.13 soda shift_state &= ~KB_CAPS;
1712 1.1 jonathan break;
1713 1.1 jonathan }
1714 1.13 soda if (shift_state & KB_CAPS)
1715 1.1 jonathan break;
1716 1.13 soda shift_state |= KB_CAPS;
1717 1.13 soda lock_state ^= KB_CAPS;
1718 1.1 jonathan async_update();
1719 1.1 jonathan break;
1720 1.13 soda case KB_SCROLL:
1721 1.1 jonathan if (dt & 0x80) {
1722 1.13 soda shift_state &= ~KB_SCROLL;
1723 1.1 jonathan break;
1724 1.1 jonathan }
1725 1.13 soda if (shift_state & KB_SCROLL)
1726 1.1 jonathan break;
1727 1.13 soda shift_state |= KB_SCROLL;
1728 1.13 soda lock_state ^= KB_SCROLL;
1729 1.13 soda if ((lock_state & KB_SCROLL) == 0)
1730 1.1 jonathan wakeup((caddr_t)&lock_state);
1731 1.1 jonathan async_update();
1732 1.1 jonathan break;
1733 1.1 jonathan }
1734 1.1 jonathan return capchar;
1735 1.1 jonathan }
1736 1.1 jonathan
1737 1.1 jonathan switch (dt) {
1738 1.1 jonathan case KBR_EXTENDED:
1739 1.1 jonathan extended = 1;
1740 1.1 jonathan goto loop;
1741 1.1 jonathan }
1742 1.1 jonathan
1743 1.13 soda #ifdef DDB
1744 1.1 jonathan /*
1745 1.1 jonathan * Check for cntl-alt-esc.
1746 1.1 jonathan */
1747 1.13 soda if ((dt == 1) && (shift_state & (KB_CTL | KB_ALT)) == (KB_CTL | KB_ALT)) {
1748 1.13 soda /* XXX - check pccons_is_console */
1749 1.13 soda Debugger();
1750 1.1 jonathan dt |= 0x80; /* discard esc (ddb discarded ctl-alt) */
1751 1.1 jonathan }
1752 1.1 jonathan #endif
1753 1.1 jonathan
1754 1.1 jonathan /*
1755 1.1 jonathan * Check for make/break.
1756 1.1 jonathan */
1757 1.1 jonathan if (dt & 0x80) {
1758 1.1 jonathan /*
1759 1.1 jonathan * break
1760 1.1 jonathan */
1761 1.1 jonathan dt &= 0x7f;
1762 1.13 soda switch (scan_codes[dt].type) {
1763 1.13 soda case KB_NUM:
1764 1.13 soda shift_state &= ~KB_NUM;
1765 1.1 jonathan break;
1766 1.13 soda case KB_CAPS:
1767 1.13 soda shift_state &= ~KB_CAPS;
1768 1.1 jonathan break;
1769 1.13 soda case KB_SCROLL:
1770 1.13 soda shift_state &= ~KB_SCROLL;
1771 1.1 jonathan break;
1772 1.13 soda case KB_SHIFT:
1773 1.13 soda shift_state &= ~KB_SHIFT;
1774 1.1 jonathan break;
1775 1.13 soda case KB_ALT:
1776 1.1 jonathan if (extended)
1777 1.13 soda shift_state &= ~KB_ALTGR;
1778 1.1 jonathan else
1779 1.13 soda shift_state &= ~KB_ALT;
1780 1.1 jonathan break;
1781 1.13 soda case KB_CTL:
1782 1.13 soda shift_state &= ~KB_CTL;
1783 1.1 jonathan break;
1784 1.1 jonathan }
1785 1.1 jonathan } else {
1786 1.1 jonathan /*
1787 1.1 jonathan * make
1788 1.1 jonathan */
1789 1.13 soda switch (scan_codes[dt].type) {
1790 1.1 jonathan /*
1791 1.1 jonathan * locking keys
1792 1.1 jonathan */
1793 1.13 soda case KB_NUM:
1794 1.13 soda if (shift_state & KB_NUM)
1795 1.1 jonathan break;
1796 1.13 soda shift_state |= KB_NUM;
1797 1.13 soda lock_state ^= KB_NUM;
1798 1.1 jonathan async_update();
1799 1.1 jonathan break;
1800 1.13 soda case KB_CAPS:
1801 1.13 soda if (shift_state & KB_CAPS)
1802 1.1 jonathan break;
1803 1.13 soda shift_state |= KB_CAPS;
1804 1.13 soda lock_state ^= KB_CAPS;
1805 1.1 jonathan async_update();
1806 1.1 jonathan break;
1807 1.13 soda case KB_SCROLL:
1808 1.13 soda if (shift_state & KB_SCROLL)
1809 1.1 jonathan break;
1810 1.13 soda shift_state |= KB_SCROLL;
1811 1.13 soda lock_state ^= KB_SCROLL;
1812 1.13 soda if ((lock_state & KB_SCROLL) == 0)
1813 1.1 jonathan wakeup((caddr_t)&lock_state);
1814 1.1 jonathan async_update();
1815 1.1 jonathan break;
1816 1.1 jonathan /*
1817 1.1 jonathan * non-locking keys
1818 1.1 jonathan */
1819 1.13 soda case KB_SHIFT:
1820 1.13 soda shift_state |= KB_SHIFT;
1821 1.1 jonathan break;
1822 1.13 soda case KB_ALT:
1823 1.1 jonathan if (extended)
1824 1.13 soda shift_state |= KB_ALTGR;
1825 1.1 jonathan else
1826 1.13 soda shift_state |= KB_ALT;
1827 1.1 jonathan break;
1828 1.13 soda case KB_CTL:
1829 1.13 soda shift_state |= KB_CTL;
1830 1.1 jonathan break;
1831 1.13 soda case KB_ASCII:
1832 1.13 soda /* control has highest priority */
1833 1.13 soda if (shift_state & KB_CTL)
1834 1.13 soda capchar[0] = scan_codes[dt].ctl[0];
1835 1.13 soda else if (shift_state & KB_ALTGR) {
1836 1.13 soda if (shift_state & KB_SHIFT)
1837 1.13 soda capchar[0] = scan_codes[dt].shift_altgr[0];
1838 1.13 soda else
1839 1.13 soda capchar[0] = scan_codes[dt].altgr[0];
1840 1.1 jonathan }
1841 1.13 soda else {
1842 1.13 soda if (shift_state & KB_SHIFT)
1843 1.13 soda capchar[0] = scan_codes[dt].shift[0];
1844 1.13 soda else
1845 1.13 soda capchar[0] = scan_codes[dt].unshift[0];
1846 1.13 soda }
1847 1.13 soda if ((lock_state & KB_CAPS) && capchar[0] >= 'a' &&
1848 1.1 jonathan capchar[0] <= 'z') {
1849 1.1 jonathan capchar[0] -= ('a' - 'A');
1850 1.1 jonathan }
1851 1.13 soda capchar[0] |= (shift_state & KB_ALT);
1852 1.1 jonathan extended = 0;
1853 1.1 jonathan return capchar;
1854 1.13 soda case KB_NONE:
1855 1.6 christos printf("keycode %d\n",dt);
1856 1.1 jonathan break;
1857 1.13 soda case KB_FUNC: {
1858 1.1 jonathan char *more_chars;
1859 1.13 soda if (shift_state & KB_SHIFT)
1860 1.13 soda more_chars = scan_codes[dt].shift;
1861 1.13 soda else if (shift_state & KB_CTL)
1862 1.13 soda more_chars = scan_codes[dt].ctl;
1863 1.1 jonathan else
1864 1.13 soda more_chars = scan_codes[dt].unshift;
1865 1.1 jonathan extended = 0;
1866 1.1 jonathan return more_chars;
1867 1.1 jonathan }
1868 1.13 soda case KB_KP: {
1869 1.1 jonathan char *more_chars;
1870 1.13 soda if (shift_state & (KB_SHIFT | KB_CTL) ||
1871 1.13 soda (lock_state & KB_NUM) == 0 || extended)
1872 1.13 soda more_chars = scan_codes[dt].shift;
1873 1.1 jonathan else
1874 1.13 soda more_chars = scan_codes[dt].unshift;
1875 1.1 jonathan extended = 0;
1876 1.1 jonathan return more_chars;
1877 1.1 jonathan }
1878 1.1 jonathan }
1879 1.1 jonathan }
1880 1.1 jonathan
1881 1.1 jonathan extended = 0;
1882 1.1 jonathan loop:
1883 1.13 soda if ((inb(kbd_cmdp) & KBS_DIB) == 0)
1884 1.1 jonathan return 0;
1885 1.1 jonathan goto top;
1886 1.1 jonathan }
1887 1.1 jonathan
1888 1.1 jonathan int
1889 1.1 jonathan pcmmap(dev, offset, nprot)
1890 1.1 jonathan dev_t dev;
1891 1.1 jonathan int offset;
1892 1.1 jonathan int nprot;
1893 1.1 jonathan {
1894 1.1 jonathan
1895 1.13 soda switch(cputype) {
1896 1.13 soda
1897 1.13 soda case ACER_PICA_61:
1898 1.13 soda if (offset >= 0xa0000 && offset < 0xc0000)
1899 1.13 soda return mips_btop(PICA_P_LOCAL_VIDEO + offset);
1900 1.13 soda if (offset >= 0x0000 && offset < 0x10000)
1901 1.13 soda return mips_btop(PICA_P_LOCAL_VIDEO_CTRL + offset);
1902 1.13 soda if (offset >= 0x40000000 && offset < 0x40800000)
1903 1.13 soda return mips_btop(PICA_P_LOCAL_VIDEO + offset - 0x40000000);
1904 1.14 soda return -1;
1905 1.14 soda
1906 1.14 soda case DESKSTATION_RPC44:
1907 1.14 soda if (offset >= 0xa0000 && offset < 0xc0000)
1908 1.14 soda return mips_btop(RPC44_P_ISA_MEM + offset);
1909 1.14 soda if (offset >= 0x0000 && offset < 0x10000)
1910 1.14 soda return mips_btop(RPC44_P_ISA_IO + offset);
1911 1.14 soda if (offset >= 0x40000000 && offset < 0x40800000)
1912 1.14 soda return mips_btop(RPC44_P_ISA_MEM + offset - 0x40000000);
1913 1.13 soda return -1;
1914 1.13 soda
1915 1.13 soda case DESKSTATION_TYNE:
1916 1.13 soda /* Addresses returned are a fake to be able to handle >32 bit
1917 1.13 soda * physical addresses used by the tyne. The real physical adr
1918 1.13 soda * processing is done in pmap.c. Until we are a real 64 bit
1919 1.13 soda * port this is how it will be done.
1920 1.13 soda */
1921 1.13 soda if (offset >= 0xa0000 && offset < 0xc0000)
1922 1.13 soda return mips_btop(TYNE_V_ISA_MEM + offset);
1923 1.13 soda if (offset >= 0x0000 && offset < 0x10000)
1924 1.13 soda return mips_btop(TYNE_V_ISA_IO + offset);
1925 1.13 soda if (offset >= 0x40000000 && offset < 0x40800000)
1926 1.13 soda return mips_btop(TYNE_V_ISA_MEM + offset - 0x40000000);
1927 1.13 soda return -1;
1928 1.13 soda }
1929 1.1 jonathan return -1;
1930 1.1 jonathan }
1931 1.1 jonathan
1932 1.13 soda void
1933 1.1 jonathan pc_xmode_on()
1934 1.1 jonathan {
1935 1.1 jonathan if (pc_xmode)
1936 1.1 jonathan return;
1937 1.1 jonathan pc_xmode = 1;
1938 1.1 jonathan
1939 1.1 jonathan #ifdef XFREE86_BUG_COMPAT
1940 1.1 jonathan /* If still unchanged, get current shape. */
1941 1.1 jonathan if (cursor_shape == 0xffff)
1942 1.1 jonathan get_cursor_shape();
1943 1.1 jonathan #endif
1944 1.1 jonathan }
1945 1.1 jonathan
1946 1.13 soda void
1947 1.1 jonathan pc_xmode_off()
1948 1.1 jonathan {
1949 1.1 jonathan if (pc_xmode == 0)
1950 1.1 jonathan return;
1951 1.1 jonathan pc_xmode = 0;
1952 1.1 jonathan
1953 1.1 jonathan #ifdef XFREE86_BUG_COMPAT
1954 1.1 jonathan /* XXX It would be hard to justify why the X server doesn't do this. */
1955 1.1 jonathan set_cursor_shape();
1956 1.1 jonathan #endif
1957 1.1 jonathan async_update();
1958 1.1 jonathan }
1959 1.1 jonathan
1960 1.1 jonathan #include <machine/mouse.h>
1961 1.1 jonathan
1962 1.1 jonathan /* status bits */
1963 1.1 jonathan #define PMS_OBUF_FULL 0x01
1964 1.1 jonathan #define PMS_IBUF_FULL 0x02
1965 1.1 jonathan
1966 1.1 jonathan /* controller commands */
1967 1.1 jonathan #define PMS_INT_ENABLE 0x47 /* enable controller interrupts */
1968 1.1 jonathan #define PMS_INT_DISABLE 0x65 /* disable controller interrupts */
1969 1.1 jonathan #define PMS_AUX_ENABLE 0xa7 /* enable auxiliary port */
1970 1.1 jonathan #define PMS_AUX_DISABLE 0xa8 /* disable auxiliary port */
1971 1.1 jonathan #define PMS_MAGIC_1 0xa9 /* XXX */
1972 1.1 jonathan
1973 1.1 jonathan #define PMS_8042_CMD 0x65
1974 1.1 jonathan
1975 1.1 jonathan /* mouse commands */
1976 1.1 jonathan #define PMS_SET_SCALE11 0xe6 /* set scaling 1:1 */
1977 1.1 jonathan #define PMS_SET_SCALE21 0xe7 /* set scaling 2:1 */
1978 1.1 jonathan #define PMS_SET_RES 0xe8 /* set resolution */
1979 1.1 jonathan #define PMS_GET_SCALE 0xe9 /* get scaling factor */
1980 1.1 jonathan #define PMS_SET_STREAM 0xea /* set streaming mode */
1981 1.1 jonathan #define PMS_SET_SAMPLE 0xf3 /* set sampling rate */
1982 1.1 jonathan #define PMS_DEV_ENABLE 0xf4 /* mouse on */
1983 1.1 jonathan #define PMS_DEV_DISABLE 0xf5 /* mouse off */
1984 1.1 jonathan #define PMS_RESET 0xff /* reset */
1985 1.1 jonathan
1986 1.1 jonathan #define PMS_CHUNK 128 /* chunk size for read */
1987 1.1 jonathan #define PMS_BSIZE 1020 /* buffer size */
1988 1.1 jonathan
1989 1.13 soda #define FLUSHQ(q) { if((q)->c_cc) ndflush(q, (q)->c_cc); }
1990 1.13 soda
1991 1.13 soda int opmsopen __P((dev_t, int));
1992 1.13 soda int opmsclose __P((dev_t, int));
1993 1.13 soda int opmsread __P((dev_t, struct uio *, int));
1994 1.13 soda int opmsioctl __P((dev_t, u_long, caddr_t, int));
1995 1.13 soda int opmsselect __P((dev_t, int, struct proc *));
1996 1.13 soda static __inline void pms_dev_cmd __P((u_char));
1997 1.13 soda static __inline void pms_aux_cmd __P((u_char));
1998 1.13 soda static __inline void pms_pit_cmd __P((u_char));
1999 1.1 jonathan
2000 1.13 soda static __inline void
2001 1.1 jonathan pms_dev_cmd(value)
2002 1.1 jonathan u_char value;
2003 1.1 jonathan {
2004 1.1 jonathan kbd_flush_input();
2005 1.13 soda outb(kbd_cmdp, 0xd4);
2006 1.1 jonathan kbd_flush_input();
2007 1.13 soda outb(kbd_datap, value);
2008 1.1 jonathan }
2009 1.1 jonathan
2010 1.13 soda static __inline void
2011 1.1 jonathan pms_aux_cmd(value)
2012 1.1 jonathan u_char value;
2013 1.1 jonathan {
2014 1.1 jonathan kbd_flush_input();
2015 1.13 soda outb(kbd_cmdp, value);
2016 1.1 jonathan }
2017 1.1 jonathan
2018 1.13 soda static __inline void
2019 1.1 jonathan pms_pit_cmd(value)
2020 1.1 jonathan u_char value;
2021 1.1 jonathan {
2022 1.1 jonathan kbd_flush_input();
2023 1.13 soda outb(kbd_cmdp, 0x60);
2024 1.1 jonathan kbd_flush_input();
2025 1.13 soda outb(kbd_datap, value);
2026 1.1 jonathan }
2027 1.1 jonathan
2028 1.1 jonathan int
2029 1.13 soda opmsprobe(parent, match, aux)
2030 1.1 jonathan struct device *parent;
2031 1.13 soda struct cfdata *match;
2032 1.13 soda void *aux;
2033 1.1 jonathan {
2034 1.1 jonathan struct confargs *ca = aux;
2035 1.1 jonathan u_char x;
2036 1.1 jonathan
2037 1.1 jonathan /* Make shure we're looking for this type of device */
2038 1.1 jonathan if(!BUS_MATCHNAME(ca, "pms"))
2039 1.1 jonathan return(0);
2040 1.1 jonathan
2041 1.1 jonathan pms_dev_cmd(KBC_RESET);
2042 1.1 jonathan pms_aux_cmd(PMS_MAGIC_1);
2043 1.1 jonathan delay(10000);
2044 1.13 soda x = inb(kbd_datap);
2045 1.1 jonathan pms_pit_cmd(PMS_INT_DISABLE);
2046 1.1 jonathan if (x & 0x04)
2047 1.1 jonathan return 0;
2048 1.1 jonathan
2049 1.1 jonathan return 1;
2050 1.1 jonathan }
2051 1.1 jonathan
2052 1.1 jonathan void
2053 1.13 soda opmsattach(parent, self, aux)
2054 1.1 jonathan struct device *parent, *self;
2055 1.1 jonathan void *aux;
2056 1.1 jonathan {
2057 1.13 soda struct opms_softc *sc = (void *)self;
2058 1.1 jonathan struct confargs *ca = aux;
2059 1.1 jonathan
2060 1.6 christos printf("\n");
2061 1.1 jonathan
2062 1.13 soda /* Other initialization was done by opmsprobe. */
2063 1.1 jonathan sc->sc_state = 0;
2064 1.1 jonathan
2065 1.13 soda BUS_INTR_ESTABLISH(ca, opmsintr, (void *)(long)sc);
2066 1.1 jonathan }
2067 1.1 jonathan
2068 1.1 jonathan int
2069 1.13 soda opmsopen(dev, flag)
2070 1.1 jonathan dev_t dev;
2071 1.1 jonathan int flag;
2072 1.1 jonathan {
2073 1.1 jonathan int unit = PMSUNIT(dev);
2074 1.13 soda struct opms_softc *sc;
2075 1.1 jonathan
2076 1.13 soda if (unit >= opms_cd.cd_ndevs)
2077 1.1 jonathan return ENXIO;
2078 1.13 soda sc = opms_cd.cd_devs[unit];
2079 1.1 jonathan if (!sc)
2080 1.1 jonathan return ENXIO;
2081 1.1 jonathan
2082 1.1 jonathan if (sc->sc_state & PMS_OPEN)
2083 1.1 jonathan return EBUSY;
2084 1.1 jonathan
2085 1.1 jonathan if (clalloc(&sc->sc_q, PMS_BSIZE, 0) == -1)
2086 1.1 jonathan return ENOMEM;
2087 1.1 jonathan
2088 1.1 jonathan sc->sc_state |= PMS_OPEN;
2089 1.1 jonathan sc->sc_status = 0;
2090 1.1 jonathan sc->sc_x = sc->sc_y = 0;
2091 1.1 jonathan
2092 1.1 jonathan /* Enable interrupts. */
2093 1.1 jonathan pms_dev_cmd(PMS_DEV_ENABLE);
2094 1.1 jonathan pms_aux_cmd(PMS_AUX_ENABLE);
2095 1.1 jonathan pms_dev_cmd(PMS_SET_RES);
2096 1.1 jonathan pms_dev_cmd(3); /* 8 counts/mm */
2097 1.1 jonathan pms_dev_cmd(PMS_SET_SCALE21);
2098 1.1 jonathan #if 0
2099 1.1 jonathan pms_dev_cmd(PMS_SET_SAMPLE);
2100 1.1 jonathan pms_dev_cmd(100); /* 100 samples/sec */
2101 1.1 jonathan pms_dev_cmd(PMS_SET_STREAM);
2102 1.1 jonathan #endif
2103 1.1 jonathan pms_pit_cmd(PMS_INT_ENABLE);
2104 1.1 jonathan
2105 1.1 jonathan return 0;
2106 1.1 jonathan }
2107 1.1 jonathan
2108 1.1 jonathan int
2109 1.13 soda opmsclose(dev, flag)
2110 1.1 jonathan dev_t dev;
2111 1.1 jonathan int flag;
2112 1.1 jonathan {
2113 1.13 soda struct opms_softc *sc = opms_cd.cd_devs[PMSUNIT(dev)];
2114 1.1 jonathan
2115 1.1 jonathan /* Disable interrupts. */
2116 1.1 jonathan pms_dev_cmd(PMS_DEV_DISABLE);
2117 1.1 jonathan pms_pit_cmd(PMS_INT_DISABLE);
2118 1.1 jonathan pms_aux_cmd(PMS_AUX_DISABLE);
2119 1.1 jonathan
2120 1.1 jonathan sc->sc_state &= ~PMS_OPEN;
2121 1.1 jonathan
2122 1.1 jonathan clfree(&sc->sc_q);
2123 1.1 jonathan
2124 1.1 jonathan return 0;
2125 1.1 jonathan }
2126 1.1 jonathan
2127 1.1 jonathan int
2128 1.13 soda opmsread(dev, uio, flag)
2129 1.1 jonathan dev_t dev;
2130 1.1 jonathan struct uio *uio;
2131 1.1 jonathan int flag;
2132 1.1 jonathan {
2133 1.13 soda struct opms_softc *sc = opms_cd.cd_devs[PMSUNIT(dev)];
2134 1.1 jonathan int s;
2135 1.13 soda int error = 0;
2136 1.1 jonathan size_t length;
2137 1.1 jonathan u_char buffer[PMS_CHUNK];
2138 1.1 jonathan
2139 1.1 jonathan /* Block until mouse activity occured. */
2140 1.1 jonathan
2141 1.1 jonathan s = spltty();
2142 1.1 jonathan while (sc->sc_q.c_cc == 0) {
2143 1.1 jonathan if (flag & IO_NDELAY) {
2144 1.1 jonathan splx(s);
2145 1.1 jonathan return EWOULDBLOCK;
2146 1.1 jonathan }
2147 1.1 jonathan sc->sc_state |= PMS_ASLP;
2148 1.13 soda error = tsleep((caddr_t)sc, PZERO | PCATCH, "pmsrea", 0);
2149 1.13 soda if (error) {
2150 1.1 jonathan sc->sc_state &= ~PMS_ASLP;
2151 1.1 jonathan splx(s);
2152 1.1 jonathan return error;
2153 1.1 jonathan }
2154 1.1 jonathan }
2155 1.1 jonathan splx(s);
2156 1.1 jonathan
2157 1.1 jonathan /* Transfer as many chunks as possible. */
2158 1.1 jonathan
2159 1.1 jonathan while (sc->sc_q.c_cc > 0 && uio->uio_resid > 0) {
2160 1.1 jonathan length = min(sc->sc_q.c_cc, uio->uio_resid);
2161 1.1 jonathan if (length > sizeof(buffer))
2162 1.1 jonathan length = sizeof(buffer);
2163 1.1 jonathan
2164 1.1 jonathan /* Remove a small chunk from the input queue. */
2165 1.1 jonathan (void) q_to_b(&sc->sc_q, buffer, length);
2166 1.1 jonathan
2167 1.1 jonathan /* Copy the data to the user process. */
2168 1.13 soda error = uiomove(buffer, length, uio);
2169 1.13 soda if (error)
2170 1.1 jonathan break;
2171 1.1 jonathan }
2172 1.1 jonathan
2173 1.1 jonathan return error;
2174 1.1 jonathan }
2175 1.1 jonathan
2176 1.1 jonathan int
2177 1.13 soda opmsioctl(dev, cmd, addr, flag)
2178 1.1 jonathan dev_t dev;
2179 1.1 jonathan u_long cmd;
2180 1.1 jonathan caddr_t addr;
2181 1.1 jonathan int flag;
2182 1.1 jonathan {
2183 1.13 soda struct opms_softc *sc = opms_cd.cd_devs[PMSUNIT(dev)];
2184 1.1 jonathan struct mouseinfo info;
2185 1.1 jonathan int s;
2186 1.1 jonathan int error;
2187 1.1 jonathan
2188 1.1 jonathan switch (cmd) {
2189 1.1 jonathan case MOUSEIOCREAD:
2190 1.1 jonathan s = spltty();
2191 1.1 jonathan
2192 1.1 jonathan info.status = sc->sc_status;
2193 1.1 jonathan if (sc->sc_x || sc->sc_y)
2194 1.1 jonathan info.status |= MOVEMENT;
2195 1.1 jonathan
2196 1.1 jonathan if (sc->sc_x > 127)
2197 1.1 jonathan info.xmotion = 127;
2198 1.1 jonathan else if (sc->sc_x < -127)
2199 1.1 jonathan /* Bounding at -127 avoids a bug in XFree86. */
2200 1.1 jonathan info.xmotion = -127;
2201 1.1 jonathan else
2202 1.1 jonathan info.xmotion = sc->sc_x;
2203 1.1 jonathan
2204 1.1 jonathan if (sc->sc_y > 127)
2205 1.1 jonathan info.ymotion = 127;
2206 1.1 jonathan else if (sc->sc_y < -127)
2207 1.1 jonathan info.ymotion = -127;
2208 1.1 jonathan else
2209 1.1 jonathan info.ymotion = sc->sc_y;
2210 1.1 jonathan
2211 1.1 jonathan /* Reset historical information. */
2212 1.1 jonathan sc->sc_x = sc->sc_y = 0;
2213 1.1 jonathan sc->sc_status &= ~BUTCHNGMASK;
2214 1.1 jonathan ndflush(&sc->sc_q, sc->sc_q.c_cc);
2215 1.1 jonathan
2216 1.1 jonathan splx(s);
2217 1.1 jonathan error = copyout(&info, addr, sizeof(struct mouseinfo));
2218 1.1 jonathan break;
2219 1.1 jonathan default:
2220 1.1 jonathan error = EINVAL;
2221 1.1 jonathan break;
2222 1.1 jonathan }
2223 1.1 jonathan
2224 1.1 jonathan return error;
2225 1.1 jonathan }
2226 1.1 jonathan
2227 1.1 jonathan /* Masks for the first byte of a packet */
2228 1.1 jonathan #define PS2LBUTMASK 0x01
2229 1.1 jonathan #define PS2RBUTMASK 0x02
2230 1.1 jonathan #define PS2MBUTMASK 0x04
2231 1.1 jonathan
2232 1.1 jonathan int
2233 1.13 soda opmsintr(arg)
2234 1.1 jonathan void *arg;
2235 1.1 jonathan {
2236 1.13 soda struct opms_softc *sc = arg;
2237 1.1 jonathan static int state = 0;
2238 1.1 jonathan static u_char buttons;
2239 1.1 jonathan u_char changed;
2240 1.1 jonathan static char dx, dy;
2241 1.1 jonathan u_char buffer[5];
2242 1.1 jonathan
2243 1.1 jonathan if ((sc->sc_state & PMS_OPEN) == 0) {
2244 1.1 jonathan /* Interrupts are not expected. Discard the byte. */
2245 1.1 jonathan kbd_flush_input();
2246 1.1 jonathan return 0;
2247 1.1 jonathan }
2248 1.1 jonathan
2249 1.1 jonathan switch (state) {
2250 1.1 jonathan
2251 1.1 jonathan case 0:
2252 1.13 soda buttons = inb(kbd_datap);
2253 1.1 jonathan if ((buttons & 0xc0) == 0)
2254 1.1 jonathan ++state;
2255 1.1 jonathan break;
2256 1.1 jonathan
2257 1.1 jonathan case 1:
2258 1.13 soda dx = inb(kbd_datap);
2259 1.1 jonathan /* Bounding at -127 avoids a bug in XFree86. */
2260 1.1 jonathan dx = (dx == -128) ? -127 : dx;
2261 1.1 jonathan ++state;
2262 1.1 jonathan break;
2263 1.1 jonathan
2264 1.1 jonathan case 2:
2265 1.13 soda dy = inb(kbd_datap);
2266 1.1 jonathan dy = (dy == -128) ? -127 : dy;
2267 1.1 jonathan state = 0;
2268 1.1 jonathan
2269 1.1 jonathan buttons = ((buttons & PS2LBUTMASK) << 2) |
2270 1.1 jonathan ((buttons & (PS2RBUTMASK | PS2MBUTMASK)) >> 1);
2271 1.1 jonathan changed = ((buttons ^ sc->sc_status) & BUTSTATMASK) << 3;
2272 1.1 jonathan sc->sc_status = buttons | (sc->sc_status & ~BUTSTATMASK) | changed;
2273 1.1 jonathan
2274 1.1 jonathan if (dx || dy || changed) {
2275 1.1 jonathan /* Update accumulated movements. */
2276 1.1 jonathan sc->sc_x += dx;
2277 1.1 jonathan sc->sc_y += dy;
2278 1.1 jonathan
2279 1.1 jonathan /* Add this event to the queue. */
2280 1.13 soda buffer[0] = 0x80 | (buttons & BUTSTATMASK);
2281 1.1 jonathan if(dx < 0)
2282 1.1 jonathan buffer[0] |= 0x10;
2283 1.1 jonathan buffer[1] = dx & 0x7f;
2284 1.1 jonathan if(dy < 0)
2285 1.1 jonathan buffer[0] |= 0x20;
2286 1.1 jonathan buffer[2] = dy & 0x7f;
2287 1.1 jonathan buffer[3] = buffer[4] = 0;
2288 1.1 jonathan (void) b_to_q(buffer, sizeof buffer, &sc->sc_q);
2289 1.1 jonathan
2290 1.1 jonathan if (sc->sc_state & PMS_ASLP) {
2291 1.1 jonathan sc->sc_state &= ~PMS_ASLP;
2292 1.1 jonathan wakeup((caddr_t)sc);
2293 1.1 jonathan }
2294 1.1 jonathan selwakeup(&sc->sc_rsel);
2295 1.1 jonathan }
2296 1.1 jonathan
2297 1.1 jonathan break;
2298 1.1 jonathan }
2299 1.1 jonathan return -1;
2300 1.1 jonathan }
2301 1.1 jonathan
2302 1.1 jonathan int
2303 1.13 soda opmspoll(dev, events, p)
2304 1.1 jonathan dev_t dev;
2305 1.8 jonathan int events;
2306 1.1 jonathan struct proc *p;
2307 1.1 jonathan {
2308 1.13 soda struct opms_softc *sc = opms_cd.cd_devs[PMSUNIT(dev)];
2309 1.8 jonathan int revents = 0;
2310 1.8 jonathan int s = spltty();
2311 1.1 jonathan
2312 1.8 jonathan if (events & (POLLIN | POLLRDNORM))
2313 1.8 jonathan if (sc->sc_q.c_cc > 0)
2314 1.8 jonathan revents |= events & (POLLIN | POLLRDNORM);
2315 1.8 jonathan else
2316 1.8 jonathan selrecord(p, &sc->sc_rsel);
2317 1.1 jonathan
2318 1.1 jonathan splx(s);
2319 1.8 jonathan return (revents);
2320 1.1 jonathan }
2321