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