pccons.c revision 1.16 1 1.16 thorpej /* $NetBSD: pccons.c,v 1.16 2000/03/06 21:36:06 thorpej 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.16 thorpej NULL, NULL, pccngetc, pccnputc, pccnpollc, NULL,
850 1.16 thorpej NODEV, CN_NORMAL
851 1.13 soda };
852 1.13 soda
853 1.13 soda /*
854 1.13 soda * For now, don't screw with it.
855 1.13 soda */
856 1.13 soda /* crtat = 0; */
857 1.13 soda switch(cputype) {
858 1.13 soda
859 1.13 soda case ACER_PICA_61:
860 1.13 soda mono_base += PICA_V_LOCAL_VIDEO_CTRL;
861 1.13 soda mono_buf += PICA_V_LOCAL_VIDEO;
862 1.13 soda cga_base += PICA_V_LOCAL_VIDEO_CTRL;
863 1.13 soda cga_buf += PICA_V_LOCAL_VIDEO;
864 1.13 soda kbd_cmdp = PICA_SYS_KBD + 0x61;
865 1.13 soda kbd_datap = PICA_SYS_KBD + 0x60;
866 1.13 soda break;
867 1.13 soda
868 1.13 soda case DESKSTATION_TYNE:
869 1.14 soda mono_base += arc_bus_io.bus_base;
870 1.14 soda mono_buf += arc_bus_mem.bus_base;
871 1.14 soda cga_base += arc_bus_io.bus_base;
872 1.14 soda cga_buf += arc_bus_mem.bus_base;
873 1.14 soda kbd_cmdp = arc_bus_io.bus_base + 0x64;
874 1.14 soda kbd_datap = arc_bus_io.bus_base + 0x60;
875 1.14 soda outb(arc_bus_io.bus_base + 0x3ce, 6); /* Correct video mode */
876 1.14 soda outb(arc_bus_io.bus_base + 0x3cf,
877 1.14 soda inb(arc_bus_io.bus_base + 0x3cf) | 0xc);
878 1.13 soda kbc_put8042cmd(CMDBYTE); /* Want XT codes.. */
879 1.13 soda break;
880 1.13 soda
881 1.13 soda case DESKSTATION_RPC44:
882 1.13 soda mono_base += arc_bus_io.bus_base;
883 1.13 soda mono_buf += arc_bus_mem.bus_base;
884 1.13 soda cga_base += arc_bus_io.bus_base;
885 1.13 soda cga_buf = arc_bus_mem.bus_base + 0xa0000;
886 1.13 soda kbd_cmdp = arc_bus_io.bus_base + 0x64;
887 1.13 soda kbd_datap = arc_bus_io.bus_base + 0x60;
888 1.13 soda kbc_put8042cmd(CMDBYTE); /* Want XT codes.. */
889 1.13 soda break;
890 1.14 soda
891 1.14 soda case SNI_RM200:
892 1.14 soda mono_base += arc_bus_io.bus_base;
893 1.14 soda mono_buf += arc_bus_mem.bus_base;
894 1.14 soda cga_base += arc_bus_io.bus_base;
895 1.14 soda cga_buf += arc_bus_mem.bus_base;
896 1.14 soda kbd_cmdp = arc_bus_io.bus_base + 0x64;
897 1.14 soda kbd_datap = arc_bus_io.bus_base + 0x60;
898 1.14 soda break;
899 1.13 soda }
900 1.1 jonathan
901 1.1 jonathan /* locate the major number */
902 1.1 jonathan for (maj = 0; maj < nchrdev; maj++)
903 1.1 jonathan if (cdevsw[maj].d_open == pcopen)
904 1.1 jonathan break;
905 1.13 soda pccons.cn_dev = makedev(maj, 0);
906 1.1 jonathan
907 1.13 soda cn_tab = &pccons;
908 1.1 jonathan }
909 1.1 jonathan
910 1.1 jonathan /* ARGSUSED */
911 1.1 jonathan void
912 1.1 jonathan pccnputc(dev, c)
913 1.1 jonathan dev_t dev;
914 1.13 soda int c;
915 1.1 jonathan {
916 1.15 soda u_char cc, oldkernel = kernel;
917 1.1 jonathan
918 1.1 jonathan kernel = 1;
919 1.15 soda if (c == '\n') {
920 1.1 jonathan sput("\r\n", 2);
921 1.15 soda } else {
922 1.15 soda cc = c;
923 1.15 soda sput(&cc, 1);
924 1.15 soda }
925 1.1 jonathan kernel = oldkernel;
926 1.1 jonathan }
927 1.1 jonathan
928 1.1 jonathan /* ARGSUSED */
929 1.13 soda int
930 1.1 jonathan pccngetc(dev)
931 1.1 jonathan dev_t dev;
932 1.1 jonathan {
933 1.1 jonathan register char *cp;
934 1.1 jonathan
935 1.1 jonathan if (pc_xmode > 0)
936 1.1 jonathan return 0;
937 1.1 jonathan
938 1.1 jonathan do {
939 1.1 jonathan /* wait for byte */
940 1.13 soda while ((inb(kbd_cmdp) & KBS_DIB) == 0);
941 1.1 jonathan /* see if it's worthwhile */
942 1.1 jonathan cp = sget();
943 1.1 jonathan } while (!cp);
944 1.1 jonathan if (*cp == '\r')
945 1.1 jonathan return '\n';
946 1.1 jonathan return *cp;
947 1.1 jonathan }
948 1.1 jonathan
949 1.1 jonathan void
950 1.1 jonathan pccnpollc(dev, on)
951 1.1 jonathan dev_t dev;
952 1.1 jonathan int on;
953 1.1 jonathan {
954 1.1 jonathan
955 1.1 jonathan polling = on;
956 1.1 jonathan if (!on) {
957 1.1 jonathan int unit;
958 1.1 jonathan struct pc_softc *sc;
959 1.1 jonathan int s;
960 1.1 jonathan
961 1.1 jonathan /*
962 1.1 jonathan * If disabling polling on a device that's been configured,
963 1.1 jonathan * make sure there are no bytes left in the FIFO, holding up
964 1.1 jonathan * the interrupt line. Otherwise we won't get any further
965 1.1 jonathan * interrupts.
966 1.1 jonathan */
967 1.1 jonathan unit = PCUNIT(dev);
968 1.2 thorpej if (pc_cd.cd_ndevs > unit) {
969 1.2 thorpej sc = pc_cd.cd_devs[unit];
970 1.1 jonathan if (sc != 0) {
971 1.1 jonathan s = spltty();
972 1.1 jonathan pcintr(sc);
973 1.1 jonathan splx(s);
974 1.1 jonathan }
975 1.1 jonathan }
976 1.1 jonathan }
977 1.1 jonathan }
978 1.1 jonathan
979 1.1 jonathan /*
980 1.1 jonathan * Set line parameters.
981 1.1 jonathan */
982 1.1 jonathan int
983 1.1 jonathan pcparam(tp, t)
984 1.1 jonathan struct tty *tp;
985 1.1 jonathan struct termios *t;
986 1.1 jonathan {
987 1.1 jonathan
988 1.1 jonathan tp->t_ispeed = t->c_ispeed;
989 1.1 jonathan tp->t_ospeed = t->c_ospeed;
990 1.1 jonathan tp->t_cflag = t->c_cflag;
991 1.1 jonathan return 0;
992 1.1 jonathan }
993 1.1 jonathan
994 1.1 jonathan #define wrtchar(c, at) do {\
995 1.1 jonathan char *cp = (char *)crtat; *cp++ = (c); *cp = (at); crtat++; vs.col++; \
996 1.1 jonathan } while (0)
997 1.1 jonathan
998 1.1 jonathan /* translate ANSI color codes to standard pc ones */
999 1.1 jonathan static char fgansitopc[] = {
1000 1.1 jonathan FG_BLACK, FG_RED, FG_GREEN, FG_BROWN, FG_BLUE,
1001 1.1 jonathan FG_MAGENTA, FG_CYAN, FG_LIGHTGREY
1002 1.1 jonathan };
1003 1.1 jonathan
1004 1.1 jonathan static char bgansitopc[] = {
1005 1.1 jonathan BG_BLACK, BG_RED, BG_GREEN, BG_BROWN, BG_BLUE,
1006 1.1 jonathan BG_MAGENTA, BG_CYAN, BG_LIGHTGREY
1007 1.1 jonathan };
1008 1.1 jonathan
1009 1.1 jonathan static u_char iso2ibm437[] =
1010 1.1 jonathan {
1011 1.1 jonathan 0, 0, 0, 0, 0, 0, 0, 0,
1012 1.1 jonathan 0, 0, 0, 0, 0, 0, 0, 0,
1013 1.1 jonathan 0, 0, 0, 0, 0, 0, 0, 0,
1014 1.1 jonathan 0, 0, 0, 0, 0, 0, 0, 0,
1015 1.1 jonathan 0xff, 0xad, 0x9b, 0x9c, 0, 0x9d, 0, 0x40,
1016 1.1 jonathan 0x6f, 0x63, 0x61, 0xae, 0, 0, 0, 0,
1017 1.1 jonathan 0xf8, 0xf1, 0xfd, 0x33, 0, 0xe6, 0, 0xfa,
1018 1.1 jonathan 0, 0x31, 0x6f, 0xaf, 0xac, 0xab, 0, 0xa8,
1019 1.1 jonathan 0x41, 0x41, 0x41, 0x41, 0x8e, 0x8f, 0x92, 0x80,
1020 1.1 jonathan 0x45, 0x90, 0x45, 0x45, 0x49, 0x49, 0x49, 0x49,
1021 1.1 jonathan 0x81, 0xa5, 0x4f, 0x4f, 0x4f, 0x4f, 0x99, 0x4f,
1022 1.1 jonathan 0x4f, 0x55, 0x55, 0x55, 0x9a, 0x59, 0, 0xe1,
1023 1.1 jonathan 0x85, 0xa0, 0x83, 0x61, 0x84, 0x86, 0x91, 0x87,
1024 1.1 jonathan 0x8a, 0x82, 0x88, 0x89, 0x8d, 0xa1, 0x8c, 0x8b,
1025 1.1 jonathan 0, 0xa4, 0x95, 0xa2, 0x93, 0x6f, 0x94, 0x6f,
1026 1.1 jonathan 0x6f, 0x97, 0xa3, 0x96, 0x81, 0x98, 0, 0
1027 1.1 jonathan };
1028 1.1 jonathan
1029 1.1 jonathan /*
1030 1.1 jonathan * `pc3' termcap emulation.
1031 1.1 jonathan */
1032 1.1 jonathan void
1033 1.1 jonathan sput(cp, n)
1034 1.1 jonathan u_char *cp;
1035 1.1 jonathan int n;
1036 1.1 jonathan {
1037 1.1 jonathan u_char c, scroll = 0;
1038 1.1 jonathan
1039 1.1 jonathan if (pc_xmode > 0)
1040 1.1 jonathan return;
1041 1.1 jonathan
1042 1.1 jonathan if (crtat == 0) {
1043 1.13 soda volatile u_short *cp;
1044 1.1 jonathan u_short was;
1045 1.1 jonathan unsigned cursorat;
1046 1.1 jonathan
1047 1.13 soda cp = (volatile u_short *)cga_buf;
1048 1.1 jonathan was = *cp;
1049 1.13 soda *cp = (volatile u_short) 0xA55A;
1050 1.1 jonathan if (*cp != 0xA55A) {
1051 1.13 soda cp = (volatile u_short *)mono_buf;
1052 1.13 soda addr_6845 = mono_base;
1053 1.1 jonathan vs.color = 0;
1054 1.1 jonathan } else {
1055 1.1 jonathan *cp = was;
1056 1.13 soda addr_6845 = cga_base;
1057 1.1 jonathan vs.color = 1;
1058 1.1 jonathan }
1059 1.1 jonathan
1060 1.1 jonathan #ifdef FAT_CURSOR
1061 1.1 jonathan cursor_shape = 0x0012;
1062 1.1 jonathan #else
1063 1.1 jonathan get_cursor_shape();
1064 1.1 jonathan #endif
1065 1.1 jonathan
1066 1.13 soda bios_display_info(&vs.col, &vs.row, &vs.ncol, &vs.nrow);
1067 1.13 soda vs.nchr = vs.ncol * vs.nrow;
1068 1.13 soda vs.col--;
1069 1.13 soda vs.row--;
1070 1.13 soda cursorat = vs.ncol * vs.row + vs.col;
1071 1.13 soda vs.at = FG_LIGHTGREY | BG_BLACK;
1072 1.13 soda
1073 1.1 jonathan Crtat = (u_short *)cp;
1074 1.13 soda crtat = Crtat + cursorat;
1075 1.1 jonathan
1076 1.1 jonathan if (vs.color == 0)
1077 1.1 jonathan vs.so_at = FG_BLACK | BG_LIGHTGREY;
1078 1.1 jonathan else
1079 1.1 jonathan vs.so_at = FG_YELLOW | BG_BLACK;
1080 1.1 jonathan
1081 1.1 jonathan fillw((vs.at << 8) | ' ', crtat, vs.nchr - cursorat);
1082 1.1 jonathan }
1083 1.1 jonathan
1084 1.1 jonathan while (n--) {
1085 1.1 jonathan if (!(c = *cp++))
1086 1.1 jonathan continue;
1087 1.1 jonathan
1088 1.1 jonathan switch (c) {
1089 1.1 jonathan case 0x1B:
1090 1.1 jonathan if (vs.state >= VSS_ESCAPE) {
1091 1.1 jonathan wrtchar(c, vs.so_at);
1092 1.1 jonathan vs.state = 0;
1093 1.1 jonathan goto maybe_scroll;
1094 1.1 jonathan } else
1095 1.1 jonathan vs.state = VSS_ESCAPE;
1096 1.1 jonathan break;
1097 1.1 jonathan
1098 1.13 soda case 0x9B: /* CSI */
1099 1.13 soda vs.cx = vs.cy = 0;
1100 1.13 soda vs.state = VSS_EBRACE;
1101 1.13 soda break;
1102 1.13 soda
1103 1.1 jonathan case '\t': {
1104 1.1 jonathan int inccol = 8 - (vs.col & 7);
1105 1.1 jonathan crtat += inccol;
1106 1.1 jonathan vs.col += inccol;
1107 1.1 jonathan }
1108 1.1 jonathan maybe_scroll:
1109 1.13 soda if (vs.col >= vs.ncol) {
1110 1.13 soda vs.col -= vs.ncol;
1111 1.1 jonathan scroll = 1;
1112 1.1 jonathan }
1113 1.1 jonathan break;
1114 1.1 jonathan
1115 1.13 soda case '\b':
1116 1.1 jonathan if (crtat <= Crtat)
1117 1.1 jonathan break;
1118 1.1 jonathan --crtat;
1119 1.1 jonathan if (--vs.col < 0)
1120 1.13 soda vs.col += vs.ncol; /* non-destructive backspace */
1121 1.1 jonathan break;
1122 1.1 jonathan
1123 1.1 jonathan case '\r':
1124 1.1 jonathan crtat -= vs.col;
1125 1.1 jonathan vs.col = 0;
1126 1.1 jonathan break;
1127 1.1 jonathan
1128 1.1 jonathan case '\n':
1129 1.1 jonathan crtat += vs.ncol;
1130 1.1 jonathan scroll = 1;
1131 1.1 jonathan break;
1132 1.1 jonathan
1133 1.1 jonathan default:
1134 1.1 jonathan switch (vs.state) {
1135 1.1 jonathan case 0:
1136 1.1 jonathan if (c == '\a')
1137 1.1 jonathan sysbeep(BEEP_FREQ, BEEP_TIME);
1138 1.1 jonathan else {
1139 1.1 jonathan /*
1140 1.1 jonathan * If we're outputting multiple printed
1141 1.1 jonathan * characters, just blast them to the
1142 1.1 jonathan * screen until we reach the end of the
1143 1.1 jonathan * buffer or a control character. This
1144 1.1 jonathan * saves time by short-circuiting the
1145 1.1 jonathan * switch.
1146 1.1 jonathan * If we reach the end of the line, we
1147 1.1 jonathan * break to do a scroll check.
1148 1.1 jonathan */
1149 1.1 jonathan for (;;) {
1150 1.1 jonathan if (c & 0x80)
1151 1.1 jonathan c = iso2ibm437[c&0x7f];
1152 1.1 jonathan
1153 1.1 jonathan if (vs.so)
1154 1.1 jonathan wrtchar(c, vs.so_at);
1155 1.1 jonathan else
1156 1.1 jonathan wrtchar(c, vs.at);
1157 1.1 jonathan if (vs.col >= vs.ncol) {
1158 1.1 jonathan vs.col = 0;
1159 1.1 jonathan scroll = 1;
1160 1.1 jonathan break;
1161 1.1 jonathan }
1162 1.1 jonathan if (!n || (c = *cp) < ' ')
1163 1.1 jonathan break;
1164 1.1 jonathan n--, cp++;
1165 1.1 jonathan }
1166 1.1 jonathan }
1167 1.1 jonathan break;
1168 1.1 jonathan case VSS_ESCAPE:
1169 1.13 soda switch (c) {
1170 1.13 soda case '[': /* Start ESC [ sequence */
1171 1.13 soda vs.cx = vs.cy = 0;
1172 1.13 soda vs.state = VSS_EBRACE;
1173 1.13 soda break;
1174 1.13 soda case 'c': /* Create screen & home */
1175 1.13 soda fillw((vs.at << 8) | ' ',
1176 1.13 soda Crtat, vs.nchr);
1177 1.13 soda crtat = Crtat;
1178 1.13 soda vs.col = 0;
1179 1.13 soda vs.state = 0;
1180 1.13 soda break;
1181 1.13 soda case '7': /* save cursor pos */
1182 1.13 soda vs.offset = crtat - Crtat;
1183 1.13 soda vs.state = 0;
1184 1.13 soda break;
1185 1.13 soda case '8': /* restore cursor pos */
1186 1.13 soda crtat = Crtat + vs.offset;
1187 1.13 soda vs.row = vs.offset / vs.ncol;
1188 1.13 soda vs.col = vs.offset % vs.ncol;
1189 1.13 soda vs.state = 0;
1190 1.13 soda break;
1191 1.13 soda default: /* Invalid, clear state */
1192 1.13 soda wrtchar(c, vs.so_at);
1193 1.13 soda vs.state = 0;
1194 1.13 soda goto maybe_scroll;
1195 1.1 jonathan }
1196 1.1 jonathan break;
1197 1.13 soda
1198 1.1 jonathan default: /* VSS_EBRACE or VSS_EPARAM */
1199 1.1 jonathan switch (c) {
1200 1.1 jonathan int pos;
1201 1.1 jonathan case 'm':
1202 1.1 jonathan if (!vs.cx)
1203 1.1 jonathan vs.so = 0;
1204 1.1 jonathan else
1205 1.1 jonathan vs.so = 1;
1206 1.1 jonathan vs.state = 0;
1207 1.1 jonathan break;
1208 1.1 jonathan case 'A': { /* back cx rows */
1209 1.1 jonathan int cx = vs.cx;
1210 1.1 jonathan if (cx <= 0)
1211 1.1 jonathan cx = 1;
1212 1.1 jonathan else
1213 1.1 jonathan cx %= vs.nrow;
1214 1.1 jonathan pos = crtat - Crtat;
1215 1.1 jonathan pos -= vs.ncol * cx;
1216 1.1 jonathan if (pos < 0)
1217 1.1 jonathan pos += vs.nchr;
1218 1.1 jonathan crtat = Crtat + pos;
1219 1.1 jonathan vs.state = 0;
1220 1.1 jonathan break;
1221 1.1 jonathan }
1222 1.1 jonathan case 'B': { /* down cx rows */
1223 1.1 jonathan int cx = vs.cx;
1224 1.1 jonathan if (cx <= 0)
1225 1.1 jonathan cx = 1;
1226 1.1 jonathan else
1227 1.1 jonathan cx %= vs.nrow;
1228 1.1 jonathan pos = crtat - Crtat;
1229 1.1 jonathan pos += vs.ncol * cx;
1230 1.1 jonathan if (pos >= vs.nchr)
1231 1.1 jonathan pos -= vs.nchr;
1232 1.1 jonathan crtat = Crtat + pos;
1233 1.1 jonathan vs.state = 0;
1234 1.1 jonathan break;
1235 1.1 jonathan }
1236 1.1 jonathan case 'C': { /* right cursor */
1237 1.1 jonathan int cx = vs.cx,
1238 1.1 jonathan col = vs.col;
1239 1.1 jonathan if (cx <= 0)
1240 1.1 jonathan cx = 1;
1241 1.1 jonathan else
1242 1.1 jonathan cx %= vs.ncol;
1243 1.1 jonathan pos = crtat - Crtat;
1244 1.1 jonathan pos += cx;
1245 1.1 jonathan col += cx;
1246 1.1 jonathan if (col >= vs.ncol) {
1247 1.1 jonathan pos -= vs.ncol;
1248 1.1 jonathan col -= vs.ncol;
1249 1.1 jonathan }
1250 1.1 jonathan vs.col = col;
1251 1.1 jonathan crtat = Crtat + pos;
1252 1.1 jonathan vs.state = 0;
1253 1.1 jonathan break;
1254 1.1 jonathan }
1255 1.1 jonathan case 'D': { /* left cursor */
1256 1.1 jonathan int cx = vs.cx,
1257 1.1 jonathan col = vs.col;
1258 1.1 jonathan if (cx <= 0)
1259 1.1 jonathan cx = 1;
1260 1.1 jonathan else
1261 1.1 jonathan cx %= vs.ncol;
1262 1.1 jonathan pos = crtat - Crtat;
1263 1.1 jonathan pos -= cx;
1264 1.1 jonathan col -= cx;
1265 1.1 jonathan if (col < 0) {
1266 1.1 jonathan pos += vs.ncol;
1267 1.1 jonathan col += vs.ncol;
1268 1.1 jonathan }
1269 1.1 jonathan vs.col = col;
1270 1.1 jonathan crtat = Crtat + pos;
1271 1.1 jonathan vs.state = 0;
1272 1.1 jonathan break;
1273 1.1 jonathan }
1274 1.1 jonathan case 'J': /* Clear ... */
1275 1.1 jonathan switch (vs.cx) {
1276 1.1 jonathan case 0:
1277 1.1 jonathan /* ... to end of display */
1278 1.13 soda fillw((vs.at << 8) | ' ',
1279 1.13 soda crtat,
1280 1.1 jonathan Crtat + vs.nchr - crtat);
1281 1.1 jonathan break;
1282 1.1 jonathan case 1:
1283 1.1 jonathan /* ... to next location */
1284 1.13 soda fillw((vs.at << 8) | ' ',
1285 1.13 soda Crtat,
1286 1.1 jonathan crtat - Crtat + 1);
1287 1.1 jonathan break;
1288 1.1 jonathan case 2:
1289 1.1 jonathan /* ... whole display */
1290 1.13 soda fillw((vs.at << 8) | ' ',
1291 1.13 soda Crtat,
1292 1.1 jonathan vs.nchr);
1293 1.1 jonathan break;
1294 1.1 jonathan }
1295 1.1 jonathan vs.state = 0;
1296 1.1 jonathan break;
1297 1.1 jonathan case 'K': /* Clear line ... */
1298 1.1 jonathan switch (vs.cx) {
1299 1.1 jonathan case 0:
1300 1.1 jonathan /* ... current to EOL */
1301 1.13 soda fillw((vs.at << 8) | ' ',
1302 1.13 soda crtat,
1303 1.1 jonathan vs.ncol - vs.col);
1304 1.1 jonathan break;
1305 1.1 jonathan case 1:
1306 1.1 jonathan /* ... beginning to next */
1307 1.1 jonathan fillw((vs.at << 8) | ' ',
1308 1.1 jonathan crtat - vs.col,
1309 1.1 jonathan vs.col + 1);
1310 1.1 jonathan break;
1311 1.1 jonathan case 2:
1312 1.1 jonathan /* ... entire line */
1313 1.1 jonathan fillw((vs.at << 8) | ' ',
1314 1.1 jonathan crtat - vs.col, vs.ncol);
1315 1.1 jonathan break;
1316 1.1 jonathan }
1317 1.1 jonathan vs.state = 0;
1318 1.1 jonathan break;
1319 1.1 jonathan case 'f': /* in system V consoles */
1320 1.1 jonathan case 'H': { /* Cursor move */
1321 1.1 jonathan int cx = vs.cx,
1322 1.1 jonathan cy = vs.cy;
1323 1.1 jonathan if (!cx || !cy) {
1324 1.1 jonathan crtat = Crtat;
1325 1.1 jonathan vs.col = 0;
1326 1.1 jonathan } else {
1327 1.1 jonathan if (cx > vs.nrow)
1328 1.1 jonathan cx = vs.nrow;
1329 1.1 jonathan if (cy > vs.ncol)
1330 1.1 jonathan cy = vs.ncol;
1331 1.1 jonathan crtat = Crtat +
1332 1.1 jonathan (cx - 1) * vs.ncol + cy - 1;
1333 1.1 jonathan vs.col = cy - 1;
1334 1.1 jonathan }
1335 1.1 jonathan vs.state = 0;
1336 1.1 jonathan break;
1337 1.1 jonathan }
1338 1.1 jonathan case 'M': { /* delete cx rows */
1339 1.1 jonathan u_short *crtAt = crtat - vs.col;
1340 1.1 jonathan int cx = vs.cx,
1341 1.1 jonathan row = (crtAt - Crtat) / vs.ncol,
1342 1.1 jonathan nrow = vs.nrow - row;
1343 1.1 jonathan if (cx <= 0)
1344 1.1 jonathan cx = 1;
1345 1.1 jonathan else if (cx > nrow)
1346 1.1 jonathan cx = nrow;
1347 1.1 jonathan if (cx < nrow)
1348 1.13 soda #ifdef PCCONS_FORCE_WORD
1349 1.13 soda wcopy(crtAt + vs.ncol * cx,
1350 1.13 soda crtAt, vs.ncol * (nrow -
1351 1.13 soda cx) * CHR);
1352 1.13 soda #else
1353 1.1 jonathan bcopy(crtAt + vs.ncol * cx,
1354 1.1 jonathan crtAt, vs.ncol * (nrow -
1355 1.1 jonathan cx) * CHR);
1356 1.13 soda #endif
1357 1.1 jonathan fillw((vs.at << 8) | ' ',
1358 1.1 jonathan crtAt + vs.ncol * (nrow - cx),
1359 1.1 jonathan vs.ncol * cx);
1360 1.1 jonathan vs.state = 0;
1361 1.1 jonathan break;
1362 1.1 jonathan }
1363 1.1 jonathan case 'S': { /* scroll up cx lines */
1364 1.1 jonathan int cx = vs.cx;
1365 1.1 jonathan if (cx <= 0)
1366 1.1 jonathan cx = 1;
1367 1.1 jonathan else if (cx > vs.nrow)
1368 1.1 jonathan cx = vs.nrow;
1369 1.1 jonathan if (cx < vs.nrow)
1370 1.13 soda #ifdef PCCONS_FORCE_WORD
1371 1.13 soda wcopy(Crtat + vs.ncol * cx,
1372 1.13 soda Crtat, vs.ncol * (vs.nrow -
1373 1.13 soda cx) * CHR);
1374 1.13 soda #else
1375 1.1 jonathan bcopy(Crtat + vs.ncol * cx,
1376 1.1 jonathan Crtat, vs.ncol * (vs.nrow -
1377 1.1 jonathan cx) * CHR);
1378 1.13 soda #endif
1379 1.1 jonathan fillw((vs.at << 8) | ' ',
1380 1.1 jonathan Crtat + vs.ncol * (vs.nrow - cx),
1381 1.1 jonathan vs.ncol * cx);
1382 1.13 soda /* crtat -= vs.ncol * cx; XXX */
1383 1.1 jonathan vs.state = 0;
1384 1.1 jonathan break;
1385 1.1 jonathan }
1386 1.1 jonathan case 'L': { /* insert cx rows */
1387 1.1 jonathan u_short *crtAt = crtat - vs.col;
1388 1.1 jonathan int cx = vs.cx,
1389 1.1 jonathan row = (crtAt - Crtat) / vs.ncol,
1390 1.1 jonathan nrow = vs.nrow - row;
1391 1.1 jonathan if (cx <= 0)
1392 1.1 jonathan cx = 1;
1393 1.1 jonathan else if (cx > nrow)
1394 1.1 jonathan cx = nrow;
1395 1.1 jonathan if (cx < nrow)
1396 1.13 soda #ifdef PCCONS_FORCE_WORD
1397 1.13 soda wcopy(crtAt,
1398 1.13 soda crtAt + vs.ncol * cx,
1399 1.13 soda vs.ncol * (nrow - cx) *
1400 1.13 soda CHR);
1401 1.13 soda #else
1402 1.1 jonathan bcopy(crtAt,
1403 1.1 jonathan crtAt + vs.ncol * cx,
1404 1.1 jonathan vs.ncol * (nrow - cx) *
1405 1.1 jonathan CHR);
1406 1.13 soda #endif
1407 1.1 jonathan fillw((vs.at << 8) | ' ', crtAt,
1408 1.1 jonathan vs.ncol * cx);
1409 1.1 jonathan vs.state = 0;
1410 1.1 jonathan break;
1411 1.1 jonathan }
1412 1.1 jonathan case 'T': { /* scroll down cx lines */
1413 1.1 jonathan int cx = vs.cx;
1414 1.1 jonathan if (cx <= 0)
1415 1.1 jonathan cx = 1;
1416 1.1 jonathan else if (cx > vs.nrow)
1417 1.1 jonathan cx = vs.nrow;
1418 1.1 jonathan if (cx < vs.nrow)
1419 1.13 soda #ifdef PCCONS_FORCE_WORD
1420 1.13 soda wcopy(Crtat,
1421 1.13 soda Crtat + vs.ncol * cx,
1422 1.13 soda vs.ncol * (vs.nrow - cx) *
1423 1.13 soda CHR);
1424 1.13 soda #else
1425 1.1 jonathan bcopy(Crtat,
1426 1.1 jonathan Crtat + vs.ncol * cx,
1427 1.1 jonathan vs.ncol * (vs.nrow - cx) *
1428 1.1 jonathan CHR);
1429 1.13 soda #endif
1430 1.1 jonathan fillw((vs.at << 8) | ' ', Crtat,
1431 1.1 jonathan vs.ncol * cx);
1432 1.13 soda /* crtat += vs.ncol * cx; XXX */
1433 1.1 jonathan vs.state = 0;
1434 1.1 jonathan break;
1435 1.1 jonathan }
1436 1.1 jonathan case ';': /* Switch params in cursor def */
1437 1.1 jonathan vs.state = VSS_EPARAM;
1438 1.1 jonathan break;
1439 1.1 jonathan case 'r':
1440 1.1 jonathan vs.so_at = (vs.cx & FG_MASK) |
1441 1.1 jonathan ((vs.cy << 4) & BG_MASK);
1442 1.1 jonathan vs.state = 0;
1443 1.1 jonathan break;
1444 1.13 soda case 's': /* save cursor pos */
1445 1.13 soda vs.offset = crtat - Crtat;
1446 1.13 soda vs.state = 0;
1447 1.13 soda break;
1448 1.13 soda case 'u': /* restore cursor pos */
1449 1.13 soda crtat = Crtat + vs.offset;
1450 1.13 soda vs.row = vs.offset / vs.ncol;
1451 1.13 soda vs.col = vs.offset % vs.ncol;
1452 1.13 soda vs.state = 0;
1453 1.13 soda break;
1454 1.1 jonathan case 'x': /* set attributes */
1455 1.1 jonathan switch (vs.cx) {
1456 1.1 jonathan case 0:
1457 1.1 jonathan vs.at = FG_LIGHTGREY | BG_BLACK;
1458 1.1 jonathan break;
1459 1.1 jonathan case 1:
1460 1.1 jonathan /* ansi background */
1461 1.1 jonathan if (!vs.color)
1462 1.1 jonathan break;
1463 1.1 jonathan vs.at &= FG_MASK;
1464 1.1 jonathan vs.at |= bgansitopc[vs.cy & 7];
1465 1.1 jonathan break;
1466 1.1 jonathan case 2:
1467 1.1 jonathan /* ansi foreground */
1468 1.1 jonathan if (!vs.color)
1469 1.1 jonathan break;
1470 1.1 jonathan vs.at &= BG_MASK;
1471 1.1 jonathan vs.at |= fgansitopc[vs.cy & 7];
1472 1.1 jonathan break;
1473 1.1 jonathan case 3:
1474 1.1 jonathan /* pc text attribute */
1475 1.1 jonathan if (vs.state >= VSS_EPARAM)
1476 1.1 jonathan vs.at = vs.cy;
1477 1.1 jonathan break;
1478 1.1 jonathan }
1479 1.1 jonathan vs.state = 0;
1480 1.1 jonathan break;
1481 1.1 jonathan
1482 1.1 jonathan default: /* Only numbers valid here */
1483 1.1 jonathan if ((c >= '0') && (c <= '9')) {
1484 1.1 jonathan if (vs.state >= VSS_EPARAM) {
1485 1.1 jonathan vs.cy *= 10;
1486 1.1 jonathan vs.cy += c - '0';
1487 1.1 jonathan } else {
1488 1.1 jonathan vs.cx *= 10;
1489 1.1 jonathan vs.cx += c - '0';
1490 1.1 jonathan }
1491 1.1 jonathan } else
1492 1.1 jonathan vs.state = 0;
1493 1.1 jonathan break;
1494 1.1 jonathan }
1495 1.1 jonathan break;
1496 1.1 jonathan }
1497 1.1 jonathan }
1498 1.1 jonathan if (scroll) {
1499 1.1 jonathan scroll = 0;
1500 1.1 jonathan /* scroll check */
1501 1.1 jonathan if (crtat >= Crtat + vs.nchr) {
1502 1.1 jonathan if (!kernel) {
1503 1.1 jonathan int s = spltty();
1504 1.13 soda if (lock_state & KB_SCROLL)
1505 1.13 soda tsleep(&lock_state,
1506 1.1 jonathan PUSER, "pcputc", 0);
1507 1.1 jonathan splx(s);
1508 1.1 jonathan }
1509 1.13 soda #if PCCONS_FORCE_WORD
1510 1.13 soda wcopy(Crtat + vs.ncol, Crtat,
1511 1.13 soda (vs.nchr - vs.ncol) * CHR);
1512 1.13 soda #else
1513 1.1 jonathan bcopy(Crtat + vs.ncol, Crtat,
1514 1.1 jonathan (vs.nchr - vs.ncol) * CHR);
1515 1.13 soda #endif
1516 1.1 jonathan fillw((vs.at << 8) | ' ',
1517 1.13 soda Crtat + vs.nchr - vs.ncol,
1518 1.13 soda vs.ncol);
1519 1.1 jonathan crtat -= vs.ncol;
1520 1.1 jonathan }
1521 1.1 jonathan }
1522 1.1 jonathan }
1523 1.1 jonathan async_update();
1524 1.1 jonathan }
1525 1.1 jonathan
1526 1.13 soda /* the unshifted code for KB_SHIFT keys is used by X to distinguish between
1527 1.13 soda left and right shift when reading the keyboard map */
1528 1.13 soda static pccons_keymap_t scan_codes[KB_NUM_KEYS] = {
1529 1.13 soda /* type unshift shift control altgr shift_altgr scancode */
1530 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 0 unused */
1531 1.13 soda { KB_ASCII, "\033", "\033", "\033", "", ""}, /* 1 ESCape */
1532 1.13 soda { KB_ASCII, "1", "!", "!", "", ""}, /* 2 1 */
1533 1.13 soda { KB_ASCII, "2", "@", "\000", "", ""}, /* 3 2 */
1534 1.13 soda { KB_ASCII, "3", "#", "#", "", ""}, /* 4 3 */
1535 1.13 soda { KB_ASCII, "4", "$", "$", "", ""}, /* 5 4 */
1536 1.13 soda { KB_ASCII, "5", "%", "%", "", ""}, /* 6 5 */
1537 1.13 soda { KB_ASCII, "6", "^", "\036", "", ""}, /* 7 6 */
1538 1.13 soda { KB_ASCII, "7", "&", "&", "", ""}, /* 8 7 */
1539 1.13 soda { KB_ASCII, "8", "*", "\010", "", ""}, /* 9 8 */
1540 1.13 soda { KB_ASCII, "9", "(", "(", "", ""}, /* 10 9 */
1541 1.13 soda { KB_ASCII, "0", ")", ")", "", ""}, /* 11 0 */
1542 1.13 soda { KB_ASCII, "-", "_", "\037", "", ""}, /* 12 - */
1543 1.13 soda { KB_ASCII, "=", "+", "+", "", ""}, /* 13 = */
1544 1.13 soda { KB_ASCII, "\177", "\177", "\010", "", ""}, /* 14 backspace */
1545 1.13 soda { KB_ASCII, "\t", "\t", "\t", "", ""}, /* 15 tab */
1546 1.13 soda { KB_ASCII, "q", "Q", "\021", "", ""}, /* 16 q */
1547 1.13 soda { KB_ASCII, "w", "W", "\027", "", ""}, /* 17 w */
1548 1.13 soda { KB_ASCII, "e", "E", "\005", "", ""}, /* 18 e */
1549 1.13 soda { KB_ASCII, "r", "R", "\022", "", ""}, /* 19 r */
1550 1.13 soda { KB_ASCII, "t", "T", "\024", "", ""}, /* 20 t */
1551 1.13 soda { KB_ASCII, "y", "Y", "\031", "", ""}, /* 21 y */
1552 1.13 soda { KB_ASCII, "u", "U", "\025", "", ""}, /* 22 u */
1553 1.13 soda { KB_ASCII, "i", "I", "\011", "", ""}, /* 23 i */
1554 1.13 soda { KB_ASCII, "o", "O", "\017", "", ""}, /* 24 o */
1555 1.13 soda { KB_ASCII, "p", "P", "\020", "", ""}, /* 25 p */
1556 1.13 soda { KB_ASCII, "[", "{", "\033", "", ""}, /* 26 [ */
1557 1.13 soda { KB_ASCII, "]", "}", "\035", "", ""}, /* 27 ] */
1558 1.13 soda { KB_ASCII, "\r", "\r", "\n", "", ""}, /* 28 return */
1559 1.13 soda { KB_CTL, "", "", "", "", ""}, /* 29 control */
1560 1.13 soda { KB_ASCII, "a", "A", "\001", "", ""}, /* 30 a */
1561 1.13 soda { KB_ASCII, "s", "S", "\023", "", ""}, /* 31 s */
1562 1.13 soda { KB_ASCII, "d", "D", "\004", "", ""}, /* 32 d */
1563 1.13 soda { KB_ASCII, "f", "F", "\006", "", ""}, /* 33 f */
1564 1.13 soda { KB_ASCII, "g", "G", "\007", "", ""}, /* 34 g */
1565 1.13 soda { KB_ASCII, "h", "H", "\010", "", ""}, /* 35 h */
1566 1.13 soda { KB_ASCII, "j", "J", "\n", "", ""}, /* 36 j */
1567 1.13 soda { KB_ASCII, "k", "K", "\013", "", ""}, /* 37 k */
1568 1.13 soda { KB_ASCII, "l", "L", "\014", "", ""}, /* 38 l */
1569 1.13 soda { KB_ASCII, ";", ":", ";", "", ""}, /* 39 ; */
1570 1.13 soda { KB_ASCII, "'", "\"", "'", "", ""}, /* 40 ' */
1571 1.13 soda { KB_ASCII, "`", "~", "`", "", ""}, /* 41 ` */
1572 1.13 soda { KB_SHIFT, "\001", "", "", "", ""}, /* 42 shift */
1573 1.13 soda { KB_ASCII, "\\", "|", "\034", "", ""}, /* 43 \ */
1574 1.13 soda { KB_ASCII, "z", "Z", "\032", "", ""}, /* 44 z */
1575 1.13 soda { KB_ASCII, "x", "X", "\030", "", ""}, /* 45 x */
1576 1.13 soda { KB_ASCII, "c", "C", "\003", "", ""}, /* 46 c */
1577 1.13 soda { KB_ASCII, "v", "V", "\026", "", ""}, /* 47 v */
1578 1.13 soda { KB_ASCII, "b", "B", "\002", "", ""}, /* 48 b */
1579 1.13 soda { KB_ASCII, "n", "N", "\016", "", ""}, /* 49 n */
1580 1.13 soda { KB_ASCII, "m", "M", "\r", "", ""}, /* 50 m */
1581 1.13 soda { KB_ASCII, ",", "<", "<", "", ""}, /* 51 , */
1582 1.13 soda { KB_ASCII, ".", ">", ">", "", ""}, /* 52 . */
1583 1.13 soda { KB_ASCII, "/", "?", "\037", "", ""}, /* 53 / */
1584 1.13 soda { KB_SHIFT, "\002", "", "", "", ""}, /* 54 shift */
1585 1.13 soda { KB_KP, "*", "*", "*", "", ""}, /* 55 kp * */
1586 1.13 soda { KB_ALT, "", "", "", "", ""}, /* 56 alt */
1587 1.13 soda { KB_ASCII, " ", " ", "\000", "", ""}, /* 57 space */
1588 1.13 soda { KB_CAPS, "", "", "", "", ""}, /* 58 caps */
1589 1.13 soda { KB_FUNC, "\033[M", "\033[Y", "\033[k", "", ""}, /* 59 f1 */
1590 1.13 soda { KB_FUNC, "\033[N", "\033[Z", "\033[l", "", ""}, /* 60 f2 */
1591 1.13 soda { KB_FUNC, "\033[O", "\033[a", "\033[m", "", ""}, /* 61 f3 */
1592 1.13 soda { KB_FUNC, "\033[P", "\033[b", "\033[n", "", ""}, /* 62 f4 */
1593 1.13 soda { KB_FUNC, "\033[Q", "\033[c", "\033[o", "", ""}, /* 63 f5 */
1594 1.13 soda { KB_FUNC, "\033[R", "\033[d", "\033[p", "", ""}, /* 64 f6 */
1595 1.13 soda { KB_FUNC, "\033[S", "\033[e", "\033[q", "", ""}, /* 65 f7 */
1596 1.13 soda { KB_FUNC, "\033[T", "\033[f", "\033[r", "", ""}, /* 66 f8 */
1597 1.13 soda { KB_FUNC, "\033[U", "\033[g", "\033[s", "", ""}, /* 67 f9 */
1598 1.13 soda { KB_FUNC, "\033[V", "\033[h", "\033[t", "", ""}, /* 68 f10 */
1599 1.13 soda { KB_NUM, "", "", "", "", ""}, /* 69 num lock */
1600 1.13 soda { KB_SCROLL, "", "", "", "", ""}, /* 70 scroll lock */
1601 1.13 soda { KB_KP, "7", "\033[H", "7", "", ""}, /* 71 kp 7 */
1602 1.13 soda { KB_KP, "8", "\033[A", "8", "", ""}, /* 72 kp 8 */
1603 1.13 soda { KB_KP, "9", "\033[I", "9", "", ""}, /* 73 kp 9 */
1604 1.13 soda { KB_KP, "-", "-", "-", "", ""}, /* 74 kp - */
1605 1.13 soda { KB_KP, "4", "\033[D", "4", "", ""}, /* 75 kp 4 */
1606 1.13 soda { KB_KP, "5", "\033[E", "5", "", ""}, /* 76 kp 5 */
1607 1.13 soda { KB_KP, "6", "\033[C", "6", "", ""}, /* 77 kp 6 */
1608 1.13 soda { KB_KP, "+", "+", "+", "", ""}, /* 78 kp + */
1609 1.13 soda { KB_KP, "1", "\033[F", "1", "", ""}, /* 79 kp 1 */
1610 1.13 soda { KB_KP, "2", "\033[B", "2", "", ""}, /* 80 kp 2 */
1611 1.13 soda { KB_KP, "3", "\033[G", "3", "", ""}, /* 81 kp 3 */
1612 1.13 soda { KB_KP, "0", "\033[L", "0", "", ""}, /* 82 kp 0 */
1613 1.13 soda { KB_KP, ",", "\177", ",", "", ""}, /* 83 kp , */
1614 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 84 0 */
1615 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 85 0 */
1616 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 86 0 */
1617 1.13 soda { KB_FUNC, "\033[W", "\033[i", "\033[u", "", ""}, /* 87 f11 */
1618 1.13 soda { KB_FUNC, "\033[X", "\033[j", "\033[v", "", ""}, /* 88 f12 */
1619 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 89 0 */
1620 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 90 0 */
1621 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 91 0 */
1622 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 92 0 */
1623 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 93 0 */
1624 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 94 0 */
1625 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 95 0 */
1626 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 96 0 */
1627 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 97 0 */
1628 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 98 0 */
1629 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 99 0 */
1630 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 100 */
1631 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 101 */
1632 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 102 */
1633 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 103 */
1634 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 104 */
1635 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 105 */
1636 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 106 */
1637 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 107 */
1638 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 108 */
1639 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 109 */
1640 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 110 */
1641 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 111 */
1642 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 112 */
1643 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 113 */
1644 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 114 */
1645 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 115 */
1646 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 116 */
1647 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 117 */
1648 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 118 */
1649 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 119 */
1650 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 120 */
1651 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 121 */
1652 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 122 */
1653 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 123 */
1654 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 124 */
1655 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 125 */
1656 1.13 soda { KB_NONE, "", "", "", "", ""}, /* 126 */
1657 1.13 soda { KB_NONE, "", "", "", "", ""} /* 127 */
1658 1.1 jonathan };
1659 1.1 jonathan
1660 1.1 jonathan /*
1661 1.1 jonathan * Get characters from the keyboard. If none are present, return NULL.
1662 1.1 jonathan */
1663 1.1 jonathan char *
1664 1.1 jonathan sget()
1665 1.1 jonathan {
1666 1.1 jonathan u_char dt;
1667 1.1 jonathan static u_char extended = 0, shift_state = 0;
1668 1.1 jonathan static u_char capchar[2];
1669 1.1 jonathan
1670 1.1 jonathan top:
1671 1.1 jonathan KBD_DELAY;
1672 1.13 soda dt = inb(kbd_datap);
1673 1.1 jonathan
1674 1.1 jonathan switch (dt) {
1675 1.1 jonathan case KBR_ACK: case KBR_ECHO:
1676 1.1 jonathan kb_oq_get = (kb_oq_get + 1) & 7;
1677 1.1 jonathan if(kb_oq_get != kb_oq_put) {
1678 1.13 soda outb(kbd_datap, kb_oq[kb_oq_get]);
1679 1.1 jonathan }
1680 1.1 jonathan goto loop;
1681 1.1 jonathan case KBR_RESEND:
1682 1.13 soda outb(kbd_datap, kb_oq[kb_oq_get]);
1683 1.1 jonathan goto loop;
1684 1.1 jonathan }
1685 1.1 jonathan
1686 1.1 jonathan if (pc_xmode > 0) {
1687 1.1 jonathan #if defined(DDB) && defined(XSERVER_DDB)
1688 1.1 jonathan /* F12 enters the debugger while in X mode */
1689 1.1 jonathan if (dt == 88)
1690 1.1 jonathan Debugger();
1691 1.1 jonathan #endif
1692 1.1 jonathan capchar[0] = dt;
1693 1.1 jonathan capchar[1] = 0;
1694 1.1 jonathan /*
1695 1.1 jonathan * Check for locking keys.
1696 1.1 jonathan *
1697 1.1 jonathan * XXX Setting the LEDs this way is a bit bogus. What if the
1698 1.1 jonathan * keyboard has been remapped in X?
1699 1.1 jonathan */
1700 1.13 soda switch (scan_codes[dt & 0x7f].type) {
1701 1.13 soda case KB_NUM:
1702 1.1 jonathan if (dt & 0x80) {
1703 1.13 soda shift_state &= ~KB_NUM;
1704 1.1 jonathan break;
1705 1.1 jonathan }
1706 1.13 soda if (shift_state & KB_NUM)
1707 1.1 jonathan break;
1708 1.13 soda shift_state |= KB_NUM;
1709 1.13 soda lock_state ^= KB_NUM;
1710 1.1 jonathan async_update();
1711 1.1 jonathan break;
1712 1.13 soda case KB_CAPS:
1713 1.1 jonathan if (dt & 0x80) {
1714 1.13 soda shift_state &= ~KB_CAPS;
1715 1.1 jonathan break;
1716 1.1 jonathan }
1717 1.13 soda if (shift_state & KB_CAPS)
1718 1.1 jonathan break;
1719 1.13 soda shift_state |= KB_CAPS;
1720 1.13 soda lock_state ^= KB_CAPS;
1721 1.1 jonathan async_update();
1722 1.1 jonathan break;
1723 1.13 soda case KB_SCROLL:
1724 1.1 jonathan if (dt & 0x80) {
1725 1.13 soda shift_state &= ~KB_SCROLL;
1726 1.1 jonathan break;
1727 1.1 jonathan }
1728 1.13 soda if (shift_state & KB_SCROLL)
1729 1.1 jonathan break;
1730 1.13 soda shift_state |= KB_SCROLL;
1731 1.13 soda lock_state ^= KB_SCROLL;
1732 1.13 soda if ((lock_state & KB_SCROLL) == 0)
1733 1.1 jonathan wakeup((caddr_t)&lock_state);
1734 1.1 jonathan async_update();
1735 1.1 jonathan break;
1736 1.1 jonathan }
1737 1.1 jonathan return capchar;
1738 1.1 jonathan }
1739 1.1 jonathan
1740 1.1 jonathan switch (dt) {
1741 1.1 jonathan case KBR_EXTENDED:
1742 1.1 jonathan extended = 1;
1743 1.1 jonathan goto loop;
1744 1.1 jonathan }
1745 1.1 jonathan
1746 1.13 soda #ifdef DDB
1747 1.1 jonathan /*
1748 1.1 jonathan * Check for cntl-alt-esc.
1749 1.1 jonathan */
1750 1.13 soda if ((dt == 1) && (shift_state & (KB_CTL | KB_ALT)) == (KB_CTL | KB_ALT)) {
1751 1.13 soda /* XXX - check pccons_is_console */
1752 1.13 soda Debugger();
1753 1.1 jonathan dt |= 0x80; /* discard esc (ddb discarded ctl-alt) */
1754 1.1 jonathan }
1755 1.1 jonathan #endif
1756 1.1 jonathan
1757 1.1 jonathan /*
1758 1.1 jonathan * Check for make/break.
1759 1.1 jonathan */
1760 1.1 jonathan if (dt & 0x80) {
1761 1.1 jonathan /*
1762 1.1 jonathan * break
1763 1.1 jonathan */
1764 1.1 jonathan dt &= 0x7f;
1765 1.13 soda switch (scan_codes[dt].type) {
1766 1.13 soda case KB_NUM:
1767 1.13 soda shift_state &= ~KB_NUM;
1768 1.1 jonathan break;
1769 1.13 soda case KB_CAPS:
1770 1.13 soda shift_state &= ~KB_CAPS;
1771 1.1 jonathan break;
1772 1.13 soda case KB_SCROLL:
1773 1.13 soda shift_state &= ~KB_SCROLL;
1774 1.1 jonathan break;
1775 1.13 soda case KB_SHIFT:
1776 1.13 soda shift_state &= ~KB_SHIFT;
1777 1.1 jonathan break;
1778 1.13 soda case KB_ALT:
1779 1.1 jonathan if (extended)
1780 1.13 soda shift_state &= ~KB_ALTGR;
1781 1.1 jonathan else
1782 1.13 soda shift_state &= ~KB_ALT;
1783 1.1 jonathan break;
1784 1.13 soda case KB_CTL:
1785 1.13 soda shift_state &= ~KB_CTL;
1786 1.1 jonathan break;
1787 1.1 jonathan }
1788 1.1 jonathan } else {
1789 1.1 jonathan /*
1790 1.1 jonathan * make
1791 1.1 jonathan */
1792 1.13 soda switch (scan_codes[dt].type) {
1793 1.1 jonathan /*
1794 1.1 jonathan * locking keys
1795 1.1 jonathan */
1796 1.13 soda case KB_NUM:
1797 1.13 soda if (shift_state & KB_NUM)
1798 1.1 jonathan break;
1799 1.13 soda shift_state |= KB_NUM;
1800 1.13 soda lock_state ^= KB_NUM;
1801 1.1 jonathan async_update();
1802 1.1 jonathan break;
1803 1.13 soda case KB_CAPS:
1804 1.13 soda if (shift_state & KB_CAPS)
1805 1.1 jonathan break;
1806 1.13 soda shift_state |= KB_CAPS;
1807 1.13 soda lock_state ^= KB_CAPS;
1808 1.1 jonathan async_update();
1809 1.1 jonathan break;
1810 1.13 soda case KB_SCROLL:
1811 1.13 soda if (shift_state & KB_SCROLL)
1812 1.1 jonathan break;
1813 1.13 soda shift_state |= KB_SCROLL;
1814 1.13 soda lock_state ^= KB_SCROLL;
1815 1.13 soda if ((lock_state & KB_SCROLL) == 0)
1816 1.1 jonathan wakeup((caddr_t)&lock_state);
1817 1.1 jonathan async_update();
1818 1.1 jonathan break;
1819 1.1 jonathan /*
1820 1.1 jonathan * non-locking keys
1821 1.1 jonathan */
1822 1.13 soda case KB_SHIFT:
1823 1.13 soda shift_state |= KB_SHIFT;
1824 1.1 jonathan break;
1825 1.13 soda case KB_ALT:
1826 1.1 jonathan if (extended)
1827 1.13 soda shift_state |= KB_ALTGR;
1828 1.1 jonathan else
1829 1.13 soda shift_state |= KB_ALT;
1830 1.1 jonathan break;
1831 1.13 soda case KB_CTL:
1832 1.13 soda shift_state |= KB_CTL;
1833 1.1 jonathan break;
1834 1.13 soda case KB_ASCII:
1835 1.13 soda /* control has highest priority */
1836 1.13 soda if (shift_state & KB_CTL)
1837 1.13 soda capchar[0] = scan_codes[dt].ctl[0];
1838 1.13 soda else if (shift_state & KB_ALTGR) {
1839 1.13 soda if (shift_state & KB_SHIFT)
1840 1.13 soda capchar[0] = scan_codes[dt].shift_altgr[0];
1841 1.13 soda else
1842 1.13 soda capchar[0] = scan_codes[dt].altgr[0];
1843 1.1 jonathan }
1844 1.13 soda else {
1845 1.13 soda if (shift_state & KB_SHIFT)
1846 1.13 soda capchar[0] = scan_codes[dt].shift[0];
1847 1.13 soda else
1848 1.13 soda capchar[0] = scan_codes[dt].unshift[0];
1849 1.13 soda }
1850 1.13 soda if ((lock_state & KB_CAPS) && capchar[0] >= 'a' &&
1851 1.1 jonathan capchar[0] <= 'z') {
1852 1.1 jonathan capchar[0] -= ('a' - 'A');
1853 1.1 jonathan }
1854 1.13 soda capchar[0] |= (shift_state & KB_ALT);
1855 1.1 jonathan extended = 0;
1856 1.1 jonathan return capchar;
1857 1.13 soda case KB_NONE:
1858 1.6 christos printf("keycode %d\n",dt);
1859 1.1 jonathan break;
1860 1.13 soda case KB_FUNC: {
1861 1.1 jonathan char *more_chars;
1862 1.13 soda if (shift_state & KB_SHIFT)
1863 1.13 soda more_chars = scan_codes[dt].shift;
1864 1.13 soda else if (shift_state & KB_CTL)
1865 1.13 soda more_chars = scan_codes[dt].ctl;
1866 1.1 jonathan else
1867 1.13 soda more_chars = scan_codes[dt].unshift;
1868 1.1 jonathan extended = 0;
1869 1.1 jonathan return more_chars;
1870 1.1 jonathan }
1871 1.13 soda case KB_KP: {
1872 1.1 jonathan char *more_chars;
1873 1.13 soda if (shift_state & (KB_SHIFT | KB_CTL) ||
1874 1.13 soda (lock_state & KB_NUM) == 0 || extended)
1875 1.13 soda more_chars = scan_codes[dt].shift;
1876 1.1 jonathan else
1877 1.13 soda more_chars = scan_codes[dt].unshift;
1878 1.1 jonathan extended = 0;
1879 1.1 jonathan return more_chars;
1880 1.1 jonathan }
1881 1.1 jonathan }
1882 1.1 jonathan }
1883 1.1 jonathan
1884 1.1 jonathan extended = 0;
1885 1.1 jonathan loop:
1886 1.13 soda if ((inb(kbd_cmdp) & KBS_DIB) == 0)
1887 1.1 jonathan return 0;
1888 1.1 jonathan goto top;
1889 1.1 jonathan }
1890 1.1 jonathan
1891 1.1 jonathan int
1892 1.1 jonathan pcmmap(dev, offset, nprot)
1893 1.1 jonathan dev_t dev;
1894 1.1 jonathan int offset;
1895 1.1 jonathan int nprot;
1896 1.1 jonathan {
1897 1.1 jonathan
1898 1.13 soda switch(cputype) {
1899 1.13 soda
1900 1.13 soda case ACER_PICA_61:
1901 1.13 soda if (offset >= 0xa0000 && offset < 0xc0000)
1902 1.13 soda return mips_btop(PICA_P_LOCAL_VIDEO + offset);
1903 1.13 soda if (offset >= 0x0000 && offset < 0x10000)
1904 1.13 soda return mips_btop(PICA_P_LOCAL_VIDEO_CTRL + offset);
1905 1.13 soda if (offset >= 0x40000000 && offset < 0x40800000)
1906 1.13 soda return mips_btop(PICA_P_LOCAL_VIDEO + offset - 0x40000000);
1907 1.14 soda return -1;
1908 1.14 soda
1909 1.14 soda case DESKSTATION_RPC44:
1910 1.14 soda if (offset >= 0xa0000 && offset < 0xc0000)
1911 1.14 soda return mips_btop(RPC44_P_ISA_MEM + offset);
1912 1.14 soda if (offset >= 0x0000 && offset < 0x10000)
1913 1.14 soda return mips_btop(RPC44_P_ISA_IO + offset);
1914 1.14 soda if (offset >= 0x40000000 && offset < 0x40800000)
1915 1.14 soda return mips_btop(RPC44_P_ISA_MEM + offset - 0x40000000);
1916 1.13 soda return -1;
1917 1.13 soda
1918 1.13 soda case DESKSTATION_TYNE:
1919 1.13 soda /* Addresses returned are a fake to be able to handle >32 bit
1920 1.13 soda * physical addresses used by the tyne. The real physical adr
1921 1.13 soda * processing is done in pmap.c. Until we are a real 64 bit
1922 1.13 soda * port this is how it will be done.
1923 1.13 soda */
1924 1.15 soda /* XXX - the above is not supported merged pmap, yet */
1925 1.13 soda if (offset >= 0xa0000 && offset < 0xc0000)
1926 1.13 soda return mips_btop(TYNE_V_ISA_MEM + offset);
1927 1.13 soda if (offset >= 0x0000 && offset < 0x10000)
1928 1.13 soda return mips_btop(TYNE_V_ISA_IO + offset);
1929 1.13 soda if (offset >= 0x40000000 && offset < 0x40800000)
1930 1.13 soda return mips_btop(TYNE_V_ISA_MEM + offset - 0x40000000);
1931 1.13 soda return -1;
1932 1.13 soda }
1933 1.1 jonathan return -1;
1934 1.1 jonathan }
1935 1.1 jonathan
1936 1.13 soda void
1937 1.1 jonathan pc_xmode_on()
1938 1.1 jonathan {
1939 1.1 jonathan if (pc_xmode)
1940 1.1 jonathan return;
1941 1.1 jonathan pc_xmode = 1;
1942 1.1 jonathan
1943 1.1 jonathan #ifdef XFREE86_BUG_COMPAT
1944 1.1 jonathan /* If still unchanged, get current shape. */
1945 1.1 jonathan if (cursor_shape == 0xffff)
1946 1.1 jonathan get_cursor_shape();
1947 1.1 jonathan #endif
1948 1.1 jonathan }
1949 1.1 jonathan
1950 1.13 soda void
1951 1.1 jonathan pc_xmode_off()
1952 1.1 jonathan {
1953 1.1 jonathan if (pc_xmode == 0)
1954 1.1 jonathan return;
1955 1.1 jonathan pc_xmode = 0;
1956 1.1 jonathan
1957 1.1 jonathan #ifdef XFREE86_BUG_COMPAT
1958 1.1 jonathan /* XXX It would be hard to justify why the X server doesn't do this. */
1959 1.1 jonathan set_cursor_shape();
1960 1.1 jonathan #endif
1961 1.1 jonathan async_update();
1962 1.1 jonathan }
1963 1.1 jonathan
1964 1.1 jonathan #include <machine/mouse.h>
1965 1.1 jonathan
1966 1.1 jonathan /* status bits */
1967 1.1 jonathan #define PMS_OBUF_FULL 0x01
1968 1.1 jonathan #define PMS_IBUF_FULL 0x02
1969 1.1 jonathan
1970 1.1 jonathan /* controller commands */
1971 1.1 jonathan #define PMS_INT_ENABLE 0x47 /* enable controller interrupts */
1972 1.1 jonathan #define PMS_INT_DISABLE 0x65 /* disable controller interrupts */
1973 1.1 jonathan #define PMS_AUX_ENABLE 0xa7 /* enable auxiliary port */
1974 1.1 jonathan #define PMS_AUX_DISABLE 0xa8 /* disable auxiliary port */
1975 1.1 jonathan #define PMS_MAGIC_1 0xa9 /* XXX */
1976 1.1 jonathan
1977 1.1 jonathan #define PMS_8042_CMD 0x65
1978 1.1 jonathan
1979 1.1 jonathan /* mouse commands */
1980 1.1 jonathan #define PMS_SET_SCALE11 0xe6 /* set scaling 1:1 */
1981 1.1 jonathan #define PMS_SET_SCALE21 0xe7 /* set scaling 2:1 */
1982 1.1 jonathan #define PMS_SET_RES 0xe8 /* set resolution */
1983 1.1 jonathan #define PMS_GET_SCALE 0xe9 /* get scaling factor */
1984 1.1 jonathan #define PMS_SET_STREAM 0xea /* set streaming mode */
1985 1.1 jonathan #define PMS_SET_SAMPLE 0xf3 /* set sampling rate */
1986 1.1 jonathan #define PMS_DEV_ENABLE 0xf4 /* mouse on */
1987 1.1 jonathan #define PMS_DEV_DISABLE 0xf5 /* mouse off */
1988 1.1 jonathan #define PMS_RESET 0xff /* reset */
1989 1.1 jonathan
1990 1.1 jonathan #define PMS_CHUNK 128 /* chunk size for read */
1991 1.1 jonathan #define PMS_BSIZE 1020 /* buffer size */
1992 1.1 jonathan
1993 1.13 soda #define FLUSHQ(q) { if((q)->c_cc) ndflush(q, (q)->c_cc); }
1994 1.13 soda
1995 1.13 soda int opmsopen __P((dev_t, int));
1996 1.13 soda int opmsclose __P((dev_t, int));
1997 1.13 soda int opmsread __P((dev_t, struct uio *, int));
1998 1.13 soda int opmsioctl __P((dev_t, u_long, caddr_t, int));
1999 1.13 soda int opmsselect __P((dev_t, int, struct proc *));
2000 1.15 soda int opmspoll __P((dev_t, int, struct proc *));
2001 1.13 soda static __inline void pms_dev_cmd __P((u_char));
2002 1.13 soda static __inline void pms_aux_cmd __P((u_char));
2003 1.13 soda static __inline void pms_pit_cmd __P((u_char));
2004 1.1 jonathan
2005 1.13 soda static __inline void
2006 1.1 jonathan pms_dev_cmd(value)
2007 1.1 jonathan u_char value;
2008 1.1 jonathan {
2009 1.1 jonathan kbd_flush_input();
2010 1.13 soda outb(kbd_cmdp, 0xd4);
2011 1.1 jonathan kbd_flush_input();
2012 1.13 soda outb(kbd_datap, value);
2013 1.1 jonathan }
2014 1.1 jonathan
2015 1.13 soda static __inline void
2016 1.1 jonathan pms_aux_cmd(value)
2017 1.1 jonathan u_char value;
2018 1.1 jonathan {
2019 1.1 jonathan kbd_flush_input();
2020 1.13 soda outb(kbd_cmdp, value);
2021 1.1 jonathan }
2022 1.1 jonathan
2023 1.13 soda static __inline void
2024 1.1 jonathan pms_pit_cmd(value)
2025 1.1 jonathan u_char value;
2026 1.1 jonathan {
2027 1.1 jonathan kbd_flush_input();
2028 1.13 soda outb(kbd_cmdp, 0x60);
2029 1.1 jonathan kbd_flush_input();
2030 1.13 soda outb(kbd_datap, value);
2031 1.1 jonathan }
2032 1.1 jonathan
2033 1.1 jonathan int
2034 1.13 soda opmsprobe(parent, match, aux)
2035 1.1 jonathan struct device *parent;
2036 1.13 soda struct cfdata *match;
2037 1.13 soda void *aux;
2038 1.1 jonathan {
2039 1.1 jonathan struct confargs *ca = aux;
2040 1.1 jonathan u_char x;
2041 1.1 jonathan
2042 1.1 jonathan /* Make shure we're looking for this type of device */
2043 1.1 jonathan if(!BUS_MATCHNAME(ca, "pms"))
2044 1.1 jonathan return(0);
2045 1.1 jonathan
2046 1.1 jonathan pms_dev_cmd(KBC_RESET);
2047 1.1 jonathan pms_aux_cmd(PMS_MAGIC_1);
2048 1.1 jonathan delay(10000);
2049 1.13 soda x = inb(kbd_datap);
2050 1.1 jonathan pms_pit_cmd(PMS_INT_DISABLE);
2051 1.1 jonathan if (x & 0x04)
2052 1.1 jonathan return 0;
2053 1.1 jonathan
2054 1.1 jonathan return 1;
2055 1.1 jonathan }
2056 1.1 jonathan
2057 1.1 jonathan void
2058 1.13 soda opmsattach(parent, self, aux)
2059 1.1 jonathan struct device *parent, *self;
2060 1.1 jonathan void *aux;
2061 1.1 jonathan {
2062 1.13 soda struct opms_softc *sc = (void *)self;
2063 1.1 jonathan struct confargs *ca = aux;
2064 1.1 jonathan
2065 1.6 christos printf("\n");
2066 1.1 jonathan
2067 1.13 soda /* Other initialization was done by opmsprobe. */
2068 1.1 jonathan sc->sc_state = 0;
2069 1.1 jonathan
2070 1.13 soda BUS_INTR_ESTABLISH(ca, opmsintr, (void *)(long)sc);
2071 1.1 jonathan }
2072 1.1 jonathan
2073 1.1 jonathan int
2074 1.13 soda opmsopen(dev, flag)
2075 1.1 jonathan dev_t dev;
2076 1.1 jonathan int flag;
2077 1.1 jonathan {
2078 1.1 jonathan int unit = PMSUNIT(dev);
2079 1.13 soda struct opms_softc *sc;
2080 1.1 jonathan
2081 1.13 soda if (unit >= opms_cd.cd_ndevs)
2082 1.1 jonathan return ENXIO;
2083 1.13 soda sc = opms_cd.cd_devs[unit];
2084 1.1 jonathan if (!sc)
2085 1.1 jonathan return ENXIO;
2086 1.1 jonathan
2087 1.1 jonathan if (sc->sc_state & PMS_OPEN)
2088 1.1 jonathan return EBUSY;
2089 1.1 jonathan
2090 1.1 jonathan if (clalloc(&sc->sc_q, PMS_BSIZE, 0) == -1)
2091 1.1 jonathan return ENOMEM;
2092 1.1 jonathan
2093 1.1 jonathan sc->sc_state |= PMS_OPEN;
2094 1.1 jonathan sc->sc_status = 0;
2095 1.1 jonathan sc->sc_x = sc->sc_y = 0;
2096 1.1 jonathan
2097 1.1 jonathan /* Enable interrupts. */
2098 1.1 jonathan pms_dev_cmd(PMS_DEV_ENABLE);
2099 1.1 jonathan pms_aux_cmd(PMS_AUX_ENABLE);
2100 1.1 jonathan pms_dev_cmd(PMS_SET_RES);
2101 1.1 jonathan pms_dev_cmd(3); /* 8 counts/mm */
2102 1.1 jonathan pms_dev_cmd(PMS_SET_SCALE21);
2103 1.1 jonathan #if 0
2104 1.1 jonathan pms_dev_cmd(PMS_SET_SAMPLE);
2105 1.1 jonathan pms_dev_cmd(100); /* 100 samples/sec */
2106 1.1 jonathan pms_dev_cmd(PMS_SET_STREAM);
2107 1.1 jonathan #endif
2108 1.1 jonathan pms_pit_cmd(PMS_INT_ENABLE);
2109 1.1 jonathan
2110 1.1 jonathan return 0;
2111 1.1 jonathan }
2112 1.1 jonathan
2113 1.1 jonathan int
2114 1.13 soda opmsclose(dev, flag)
2115 1.1 jonathan dev_t dev;
2116 1.1 jonathan int flag;
2117 1.1 jonathan {
2118 1.13 soda struct opms_softc *sc = opms_cd.cd_devs[PMSUNIT(dev)];
2119 1.1 jonathan
2120 1.1 jonathan /* Disable interrupts. */
2121 1.1 jonathan pms_dev_cmd(PMS_DEV_DISABLE);
2122 1.1 jonathan pms_pit_cmd(PMS_INT_DISABLE);
2123 1.1 jonathan pms_aux_cmd(PMS_AUX_DISABLE);
2124 1.1 jonathan
2125 1.1 jonathan sc->sc_state &= ~PMS_OPEN;
2126 1.1 jonathan
2127 1.1 jonathan clfree(&sc->sc_q);
2128 1.1 jonathan
2129 1.1 jonathan return 0;
2130 1.1 jonathan }
2131 1.1 jonathan
2132 1.1 jonathan int
2133 1.13 soda opmsread(dev, uio, flag)
2134 1.1 jonathan dev_t dev;
2135 1.1 jonathan struct uio *uio;
2136 1.1 jonathan int flag;
2137 1.1 jonathan {
2138 1.13 soda struct opms_softc *sc = opms_cd.cd_devs[PMSUNIT(dev)];
2139 1.1 jonathan int s;
2140 1.13 soda int error = 0;
2141 1.1 jonathan size_t length;
2142 1.1 jonathan u_char buffer[PMS_CHUNK];
2143 1.1 jonathan
2144 1.1 jonathan /* Block until mouse activity occured. */
2145 1.1 jonathan
2146 1.1 jonathan s = spltty();
2147 1.1 jonathan while (sc->sc_q.c_cc == 0) {
2148 1.1 jonathan if (flag & IO_NDELAY) {
2149 1.1 jonathan splx(s);
2150 1.1 jonathan return EWOULDBLOCK;
2151 1.1 jonathan }
2152 1.1 jonathan sc->sc_state |= PMS_ASLP;
2153 1.13 soda error = tsleep((caddr_t)sc, PZERO | PCATCH, "pmsrea", 0);
2154 1.13 soda if (error) {
2155 1.1 jonathan sc->sc_state &= ~PMS_ASLP;
2156 1.1 jonathan splx(s);
2157 1.1 jonathan return error;
2158 1.1 jonathan }
2159 1.1 jonathan }
2160 1.1 jonathan splx(s);
2161 1.1 jonathan
2162 1.1 jonathan /* Transfer as many chunks as possible. */
2163 1.1 jonathan
2164 1.1 jonathan while (sc->sc_q.c_cc > 0 && uio->uio_resid > 0) {
2165 1.1 jonathan length = min(sc->sc_q.c_cc, uio->uio_resid);
2166 1.1 jonathan if (length > sizeof(buffer))
2167 1.1 jonathan length = sizeof(buffer);
2168 1.1 jonathan
2169 1.1 jonathan /* Remove a small chunk from the input queue. */
2170 1.1 jonathan (void) q_to_b(&sc->sc_q, buffer, length);
2171 1.1 jonathan
2172 1.1 jonathan /* Copy the data to the user process. */
2173 1.13 soda error = uiomove(buffer, length, uio);
2174 1.13 soda if (error)
2175 1.1 jonathan break;
2176 1.1 jonathan }
2177 1.1 jonathan
2178 1.1 jonathan return error;
2179 1.1 jonathan }
2180 1.1 jonathan
2181 1.1 jonathan int
2182 1.13 soda opmsioctl(dev, cmd, addr, flag)
2183 1.1 jonathan dev_t dev;
2184 1.1 jonathan u_long cmd;
2185 1.1 jonathan caddr_t addr;
2186 1.1 jonathan int flag;
2187 1.1 jonathan {
2188 1.13 soda struct opms_softc *sc = opms_cd.cd_devs[PMSUNIT(dev)];
2189 1.1 jonathan struct mouseinfo info;
2190 1.1 jonathan int s;
2191 1.1 jonathan int error;
2192 1.1 jonathan
2193 1.1 jonathan switch (cmd) {
2194 1.1 jonathan case MOUSEIOCREAD:
2195 1.1 jonathan s = spltty();
2196 1.1 jonathan
2197 1.1 jonathan info.status = sc->sc_status;
2198 1.1 jonathan if (sc->sc_x || sc->sc_y)
2199 1.1 jonathan info.status |= MOVEMENT;
2200 1.1 jonathan
2201 1.1 jonathan if (sc->sc_x > 127)
2202 1.1 jonathan info.xmotion = 127;
2203 1.1 jonathan else if (sc->sc_x < -127)
2204 1.1 jonathan /* Bounding at -127 avoids a bug in XFree86. */
2205 1.1 jonathan info.xmotion = -127;
2206 1.1 jonathan else
2207 1.1 jonathan info.xmotion = sc->sc_x;
2208 1.1 jonathan
2209 1.1 jonathan if (sc->sc_y > 127)
2210 1.1 jonathan info.ymotion = 127;
2211 1.1 jonathan else if (sc->sc_y < -127)
2212 1.1 jonathan info.ymotion = -127;
2213 1.1 jonathan else
2214 1.1 jonathan info.ymotion = sc->sc_y;
2215 1.1 jonathan
2216 1.1 jonathan /* Reset historical information. */
2217 1.1 jonathan sc->sc_x = sc->sc_y = 0;
2218 1.1 jonathan sc->sc_status &= ~BUTCHNGMASK;
2219 1.1 jonathan ndflush(&sc->sc_q, sc->sc_q.c_cc);
2220 1.1 jonathan
2221 1.1 jonathan splx(s);
2222 1.1 jonathan error = copyout(&info, addr, sizeof(struct mouseinfo));
2223 1.1 jonathan break;
2224 1.1 jonathan default:
2225 1.1 jonathan error = EINVAL;
2226 1.1 jonathan break;
2227 1.1 jonathan }
2228 1.1 jonathan
2229 1.1 jonathan return error;
2230 1.1 jonathan }
2231 1.1 jonathan
2232 1.1 jonathan /* Masks for the first byte of a packet */
2233 1.1 jonathan #define PS2LBUTMASK 0x01
2234 1.1 jonathan #define PS2RBUTMASK 0x02
2235 1.1 jonathan #define PS2MBUTMASK 0x04
2236 1.1 jonathan
2237 1.1 jonathan int
2238 1.13 soda opmsintr(arg)
2239 1.1 jonathan void *arg;
2240 1.1 jonathan {
2241 1.13 soda struct opms_softc *sc = arg;
2242 1.1 jonathan static int state = 0;
2243 1.1 jonathan static u_char buttons;
2244 1.1 jonathan u_char changed;
2245 1.1 jonathan static char dx, dy;
2246 1.1 jonathan u_char buffer[5];
2247 1.1 jonathan
2248 1.1 jonathan if ((sc->sc_state & PMS_OPEN) == 0) {
2249 1.1 jonathan /* Interrupts are not expected. Discard the byte. */
2250 1.1 jonathan kbd_flush_input();
2251 1.1 jonathan return 0;
2252 1.1 jonathan }
2253 1.1 jonathan
2254 1.1 jonathan switch (state) {
2255 1.1 jonathan
2256 1.1 jonathan case 0:
2257 1.13 soda buttons = inb(kbd_datap);
2258 1.1 jonathan if ((buttons & 0xc0) == 0)
2259 1.1 jonathan ++state;
2260 1.1 jonathan break;
2261 1.1 jonathan
2262 1.1 jonathan case 1:
2263 1.13 soda dx = inb(kbd_datap);
2264 1.1 jonathan /* Bounding at -127 avoids a bug in XFree86. */
2265 1.1 jonathan dx = (dx == -128) ? -127 : dx;
2266 1.1 jonathan ++state;
2267 1.1 jonathan break;
2268 1.1 jonathan
2269 1.1 jonathan case 2:
2270 1.13 soda dy = inb(kbd_datap);
2271 1.1 jonathan dy = (dy == -128) ? -127 : dy;
2272 1.1 jonathan state = 0;
2273 1.1 jonathan
2274 1.1 jonathan buttons = ((buttons & PS2LBUTMASK) << 2) |
2275 1.1 jonathan ((buttons & (PS2RBUTMASK | PS2MBUTMASK)) >> 1);
2276 1.1 jonathan changed = ((buttons ^ sc->sc_status) & BUTSTATMASK) << 3;
2277 1.1 jonathan sc->sc_status = buttons | (sc->sc_status & ~BUTSTATMASK) | changed;
2278 1.1 jonathan
2279 1.1 jonathan if (dx || dy || changed) {
2280 1.1 jonathan /* Update accumulated movements. */
2281 1.1 jonathan sc->sc_x += dx;
2282 1.1 jonathan sc->sc_y += dy;
2283 1.1 jonathan
2284 1.1 jonathan /* Add this event to the queue. */
2285 1.13 soda buffer[0] = 0x80 | (buttons & BUTSTATMASK);
2286 1.1 jonathan if(dx < 0)
2287 1.1 jonathan buffer[0] |= 0x10;
2288 1.1 jonathan buffer[1] = dx & 0x7f;
2289 1.1 jonathan if(dy < 0)
2290 1.1 jonathan buffer[0] |= 0x20;
2291 1.1 jonathan buffer[2] = dy & 0x7f;
2292 1.1 jonathan buffer[3] = buffer[4] = 0;
2293 1.1 jonathan (void) b_to_q(buffer, sizeof buffer, &sc->sc_q);
2294 1.1 jonathan
2295 1.1 jonathan if (sc->sc_state & PMS_ASLP) {
2296 1.1 jonathan sc->sc_state &= ~PMS_ASLP;
2297 1.1 jonathan wakeup((caddr_t)sc);
2298 1.1 jonathan }
2299 1.1 jonathan selwakeup(&sc->sc_rsel);
2300 1.1 jonathan }
2301 1.1 jonathan
2302 1.1 jonathan break;
2303 1.1 jonathan }
2304 1.1 jonathan return -1;
2305 1.1 jonathan }
2306 1.1 jonathan
2307 1.1 jonathan int
2308 1.13 soda opmspoll(dev, events, p)
2309 1.1 jonathan dev_t dev;
2310 1.8 jonathan int events;
2311 1.1 jonathan struct proc *p;
2312 1.1 jonathan {
2313 1.13 soda struct opms_softc *sc = opms_cd.cd_devs[PMSUNIT(dev)];
2314 1.8 jonathan int revents = 0;
2315 1.8 jonathan int s = spltty();
2316 1.1 jonathan
2317 1.8 jonathan if (events & (POLLIN | POLLRDNORM))
2318 1.8 jonathan if (sc->sc_q.c_cc > 0)
2319 1.8 jonathan revents |= events & (POLLIN | POLLRDNORM);
2320 1.8 jonathan else
2321 1.8 jonathan selrecord(p, &sc->sc_rsel);
2322 1.1 jonathan
2323 1.1 jonathan splx(s);
2324 1.8 jonathan return (revents);
2325 1.1 jonathan }
2326