xref: /netbsd-src/sys/arch/sparc64/dev/sab.c (revision b1c86f5f087524e68db12794ee9c3e3da1ab17a0)
1 /*	$NetBSD: sab.c,v 1.45 2010/03/11 04:19:56 mrg Exp $	*/
2 /*	$OpenBSD: sab.c,v 1.7 2002/04/08 17:49:42 jason Exp $	*/
3 
4 /*
5  * Copyright (c) 2001 Jason L. Wright (jason@thought.net)
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  * 3. All advertising materials mentioning features or use of this software
17  *    must display the following acknowledgement:
18  *	This product includes software developed by Jason L. Wright
19  * 4. The name of the author may not be used to endorse or promote products
20  *    derived from this software without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
24  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
25  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
26  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
27  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
28  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
30  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32  * POSSIBILITY OF SUCH DAMAGE.
33  *
34  * Effort sponsored in part by the Defense Advanced Research Projects
35  * Agency (DARPA) and Air Force Research Laboratory, Air Force
36  * Materiel Command, USAF, under agreement number F30602-01-2-0537.
37  *
38  */
39 
40 /*
41  * SAB82532 Dual UART driver
42  */
43 
44 #include <sys/cdefs.h>
45 __KERNEL_RCSID(0, "$NetBSD: sab.c,v 1.45 2010/03/11 04:19:56 mrg Exp $");
46 
47 #include "opt_kgdb.h"
48 #include <sys/types.h>
49 #include <sys/param.h>
50 #include <sys/systm.h>
51 #include <sys/device.h>
52 #include <sys/conf.h>
53 #include <sys/file.h>
54 #include <sys/ioctl.h>
55 #include <sys/kernel.h>
56 #include <sys/proc.h>
57 #include <sys/tty.h>
58 #include <sys/syslog.h>
59 #include <sys/kauth.h>
60 #include <sys/kgdb.h>
61 #include <sys/intr.h>
62 
63 #include <machine/autoconf.h>
64 #include <machine/openfirm.h>
65 
66 #include <dev/cons.h>
67 
68 #include <dev/ebus/ebusreg.h>
69 #include <dev/ebus/ebusvar.h>
70 #include <sparc64/dev/sab82532reg.h>
71 
72 #include "locators.h"
73 
74 #define SABUNIT(x)		(minor(x) & 0x7ffff)
75 #define SABDIALOUT(x)		(minor(x) & 0x80000)
76 
77 #define	SABTTY_RBUF_SIZE	1024	/* must be divisible by 2 */
78 
79 struct sab_softc {
80 	struct device		sc_dv;
81 	struct intrhand *	sc_ih;
82 	bus_space_tag_t		sc_bt;
83 	bus_space_handle_t	sc_bh;
84 	struct sabtty_softc *	sc_child[SAB_NCHAN];
85 	u_int			sc_nchild;
86 	void *			sc_softintr;
87 	int			sc_node;
88 };
89 
90 struct sabtty_attach_args {
91 	u_int sbt_portno;
92 };
93 
94 struct sabtty_softc {
95 	struct device		sc_dv;
96 	struct sab_softc *	sc_parent;
97 	bus_space_tag_t		sc_bt;
98 	bus_space_handle_t	sc_bh;
99 	struct tty *		sc_tty;
100 	u_int			sc_portno;
101 	uint8_t			sc_pvr_dtr, sc_pvr_dsr;
102 	uint8_t			sc_imr0, sc_imr1;
103 	int			sc_openflags;
104 	u_char *		sc_txp;
105 	int			sc_txc;
106 	int			sc_flags;
107 #define SABTTYF_STOP		0x0001
108 #define	SABTTYF_DONE		0x0002
109 #define	SABTTYF_RINGOVERFLOW	0x0004
110 #define	SABTTYF_CDCHG		0x0008
111 #define	SABTTYF_CONS_IN		0x0010
112 #define	SABTTYF_CONS_OUT	0x0020
113 #define	SABTTYF_TXDRAIN		0x0040
114 #define	SABTTYF_DONTDDB		0x0080
115 #define SABTTYF_IS_RSC		0x0100
116 	uint8_t			sc_rbuf[SABTTY_RBUF_SIZE];
117 	uint8_t			*sc_rend, *sc_rput, *sc_rget;
118 	uint8_t			sc_polling, sc_pollrfc;
119 };
120 
121 struct sabtty_softc *sabtty_cons_input;
122 struct sabtty_softc *sabtty_cons_output;
123 
124 #define	SAB_READ(sc,r)		\
125     bus_space_read_1((sc)->sc_bt, (sc)->sc_bh, (r))
126 #define	SAB_WRITE(sc,r,v)	\
127     bus_space_write_1((sc)->sc_bt, (sc)->sc_bh, (r), (v))
128 #define	SAB_WRITE_BLOCK(sc,r,p,c)	\
129     bus_space_write_region_1((sc)->sc_bt, (sc)->sc_bh, (r), (p), (c))
130 
131 int sab_match(struct device *, struct cfdata *, void *);
132 void sab_attach(struct device *, struct device *, void *);
133 int sab_print(void *, const char *);
134 int sab_intr(void *);
135 
136 void sab_softintr(void *);
137 void sab_cnputc(dev_t, int);
138 int sab_cngetc(dev_t);
139 void sab_cnpollc(dev_t, int);
140 
141 int sabtty_match(struct device *, struct cfdata *, void *);
142 void sabtty_attach(struct device *, struct device *, void *);
143 void sabtty_start(struct tty *);
144 int sabtty_param(struct tty *, struct termios *);
145 int sabtty_intr(struct sabtty_softc *, int *);
146 void sabtty_softintr(struct sabtty_softc *);
147 int sabtty_mdmctrl(struct sabtty_softc *, int, int);
148 void sabtty_cec_wait(struct sabtty_softc *);
149 void sabtty_tec_wait(struct sabtty_softc *);
150 void sabtty_reset(struct sabtty_softc *);
151 void sabtty_flush(struct sabtty_softc *);
152 int sabtty_speed(int);
153 void sabtty_console_flags(struct sabtty_softc *);
154 void sabtty_cnpollc(struct sabtty_softc *, int);
155 void sabtty_shutdown(void *);
156 int sabttyparam(struct sabtty_softc *, struct tty *, struct termios *);
157 
158 #ifdef KGDB
159 int sab_kgdb_check(struct sabtty_softc *);
160 void sab_kgdb_init(struct sabtty_softc *);
161 #endif
162 
163 void sabtty_cnputc(struct sabtty_softc *, int);
164 int sabtty_cngetc(struct sabtty_softc *);
165 
166 CFATTACH_DECL(sab, sizeof(struct sab_softc),
167     sab_match, sab_attach, NULL, NULL);
168 
169 extern struct cfdriver sab_cd;
170 
171 CFATTACH_DECL(sabtty, sizeof(struct sabtty_softc),
172     sabtty_match, sabtty_attach, NULL, NULL);
173 
174 extern struct cfdriver sabtty_cd;
175 
176 dev_type_open(sabopen);
177 dev_type_close(sabclose);
178 dev_type_read(sabread);
179 dev_type_write(sabwrite);
180 dev_type_ioctl(sabioctl);
181 dev_type_stop(sabstop);
182 dev_type_tty(sabtty);
183 dev_type_poll(sabpoll);
184 
185 static struct cnm_state sabtty_cnm_state;
186 
187 const struct cdevsw sabtty_cdevsw = {
188 	sabopen, sabclose, sabread, sabwrite, sabioctl,
189 	sabstop, sabtty, sabpoll, nommap, ttykqfilter, D_TTY
190 };
191 
192 struct sabtty_rate {
193 	int baud;
194 	int n, m;
195 };
196 
197 struct sabtty_rate sabtty_baudtable[] = {
198 	{      50,	35,     10 },
199 	{      75,	47,	9 },
200 	{     110,	32,	9 },
201 	{     134,	53,	8 },
202 	{     150,	47,	8 },
203 	{     200,	35,	8 },
204 	{     300,	47,	7 },
205 	{     600,	47,	6 },
206 	{    1200,	47,	5 },
207 	{    1800,	31,	5 },
208 	{    2400,	47,	4 },
209 	{    4800,	47,	3 },
210 	{    9600,	47,	2 },
211 	{   19200,	47,	1 },
212 	{   38400,	23,	1 },
213 	{   57600,	15,	1 },
214 	{  115200,	 7,	1 },
215 	{  230400,	 3,	1 },
216 	{  460800,	 1,	1 },
217 	{   76800,	11,	1 },
218 	{  153600,	 5,	1 },
219 	{  307200,	 3,	1 },
220 	{  614400,	 3,	0 },
221 	{  921600,	 0,	1 },
222 };
223 
224 int
225 sab_match(struct device *parent, struct cfdata *match, void *aux)
226 {
227 	struct ebus_attach_args *ea = aux;
228 	char *compat;
229 
230 	if (strcmp(ea->ea_name, "se") == 0)
231 		return (1);
232 
233 	compat = prom_getpropstring(ea->ea_node, "compatible");
234 	if (compat != NULL && !strcmp(compat, "sab82532"))
235 		return (1);
236 
237 	return (0);
238 }
239 
240 void
241 sab_attach(struct device *parent, struct device *self, void *aux)
242 {
243 	struct sab_softc *sc = (struct sab_softc *)self;
244 	struct ebus_attach_args *ea = aux;
245 	uint8_t r;
246 	u_int i;
247 	int locs[SABCF_NLOCS];
248 
249 	sc->sc_bt = ea->ea_bustag;
250 	sc->sc_node = ea->ea_node;
251 
252 	/* Use prom mapping, if available. */
253 	if (ea->ea_nvaddr)
254 		sparc_promaddr_to_handle(sc->sc_bt, ea->ea_vaddr[0],
255 		    &sc->sc_bh);
256 	else if (bus_space_map(sc->sc_bt, EBUS_ADDR_FROM_REG(&ea->ea_reg[0]),
257 				 ea->ea_reg[0].size, 0, &sc->sc_bh) != 0) {
258 		printf(": can't map register space\n");
259 		return;
260 	}
261 
262 	sc->sc_ih = bus_intr_establish(ea->ea_bustag, ea->ea_intr[0],
263 	    IPL_TTY, sab_intr, sc);
264 	if (sc->sc_ih == NULL) {
265 		printf(": can't map interrupt\n");
266 		return;
267 	}
268 
269 	sc->sc_softintr = softint_establish(SOFTINT_SERIAL, sab_softintr, sc);
270 	if (sc->sc_softintr == NULL) {
271 		printf(": can't get soft intr\n");
272 		return;
273 	}
274 
275 	aprint_normal(": rev ");
276 	r = SAB_READ(sc, SAB_VSTR) & SAB_VSTR_VMASK;
277 	switch (r) {
278 	case SAB_VSTR_V_1:
279 		aprint_normal("1");
280 		break;
281 	case SAB_VSTR_V_2:
282 		aprint_normal("2");
283 		break;
284 	case SAB_VSTR_V_32:
285 		aprint_normal("3.2");
286 		break;
287 	default:
288 		aprint_normal("unknown(0x%x)", r);
289 		break;
290 	}
291 	aprint_normal("\n");
292 	aprint_naive(": Serial controller\n");
293 
294 	/* Let current output drain */
295 	DELAY(100000);
296 
297 	/* Set all pins, except DTR pins to be inputs */
298 	SAB_WRITE(sc, SAB_PCR, ~(SAB_PVR_DTR_A | SAB_PVR_DTR_B));
299 	/* Disable port interrupts */
300 	SAB_WRITE(sc, SAB_PIM, 0xff);
301 	SAB_WRITE(sc, SAB_PVR, SAB_PVR_DTR_A | SAB_PVR_DTR_B | SAB_PVR_MAGIC);
302 	SAB_WRITE(sc, SAB_IPC, SAB_IPC_ICPL);
303 
304 	for (i = 0; i < SAB_NCHAN; i++) {
305 		struct sabtty_attach_args stax;
306 
307 		stax.sbt_portno = i;
308 
309 		locs[SABCF_CHANNEL] = i;
310 
311 		sc->sc_child[i] =
312 		    (struct sabtty_softc *)config_found_sm_loc(self,
313 		     "sab", locs, &stax, sab_print, config_stdsubmatch);
314 		if (sc->sc_child[i] != NULL)
315 			sc->sc_nchild++;
316 	}
317 }
318 
319 int
320 sab_print(void *args, const char *name)
321 {
322 	struct sabtty_attach_args *sa = args;
323 
324 	if (name)
325 		aprint_normal("sabtty at %s", name);
326 	aprint_normal(" port %u", sa->sbt_portno);
327 	return (UNCONF);
328 }
329 
330 int
331 sab_intr(void *vsc)
332 {
333 	struct sab_softc *sc = vsc;
334 	int r = 0, needsoft = 0;
335 	uint8_t gis;
336 
337 	gis = SAB_READ(sc, SAB_GIS);
338 
339 	/* channel A */
340 	if ((gis & (SAB_GIS_ISA1 | SAB_GIS_ISA0)) && sc->sc_child[0] &&
341 	    sc->sc_child[0]->sc_tty)
342 		r |= sabtty_intr(sc->sc_child[0], &needsoft);
343 
344 	/* channel B */
345 	if ((gis & (SAB_GIS_ISB1 | SAB_GIS_ISB0)) && sc->sc_child[1] &&
346 	    sc->sc_child[1]->sc_tty)
347 		r |= sabtty_intr(sc->sc_child[1], &needsoft);
348 
349 	if (needsoft)
350 		softint_schedule(sc->sc_softintr);
351 
352 	return (r);
353 }
354 
355 void
356 sab_softintr(void *vsc)
357 {
358 	struct sab_softc *sc = vsc;
359 
360 	if (sc->sc_child[0] && sc->sc_child[0]->sc_tty)
361 		sabtty_softintr(sc->sc_child[0]);
362 	if (sc->sc_child[1] && sc->sc_child[1]->sc_tty)
363 		sabtty_softintr(sc->sc_child[1]);
364 }
365 
366 int
367 sabtty_match(struct device *parent, struct cfdata *match, void *aux)
368 {
369 
370 	return (1);
371 }
372 
373 void
374 sabtty_attach(struct device *parent, struct device *self, void *aux)
375 {
376 	struct sabtty_softc *sc = (struct sabtty_softc *)self;
377 	struct sabtty_attach_args *sa = aux;
378 	int r;
379 	int maj;
380 	int is_kgdb = 0;
381 
382 #ifdef KGDB
383 	is_kgdb = sab_kgdb_check(sc);
384 #endif
385 
386 	if (!is_kgdb) {
387 		sc->sc_tty = ttymalloc();
388 		if (sc->sc_tty == NULL) {
389 			aprint_normal(": failed to allocate tty\n");
390 			return;
391 		}
392 		tty_attach(sc->sc_tty);
393 		sc->sc_tty->t_oproc = sabtty_start;
394 		sc->sc_tty->t_param = sabtty_param;
395 	}
396 
397 	sc->sc_parent = (struct sab_softc *)parent;
398 	sc->sc_bt = sc->sc_parent->sc_bt;
399 	sc->sc_portno = sa->sbt_portno;
400 	sc->sc_rend = sc->sc_rbuf + SABTTY_RBUF_SIZE;
401 
402 	switch (sa->sbt_portno) {
403 	case 0:	/* port A */
404 		sc->sc_pvr_dtr = SAB_PVR_DTR_A;
405 		sc->sc_pvr_dsr = SAB_PVR_DSR_A;
406 		r = bus_space_subregion(sc->sc_bt, sc->sc_parent->sc_bh,
407 		    SAB_CHAN_A, SAB_CHANLEN, &sc->sc_bh);
408 		break;
409 	case 1:	/* port B */
410 		sc->sc_pvr_dtr = SAB_PVR_DTR_B;
411 		sc->sc_pvr_dsr = SAB_PVR_DSR_B;
412 		r = bus_space_subregion(sc->sc_bt, sc->sc_parent->sc_bh,
413 		    SAB_CHAN_B, SAB_CHANLEN, &sc->sc_bh);
414 		break;
415 	default:
416 		aprint_normal(": invalid channel: %u\n", sa->sbt_portno);
417 		return;
418 	}
419 	if (r != 0) {
420 		aprint_normal(": failed to allocate register subregion\n");
421 		return;
422 	}
423 
424 	sabtty_console_flags(sc);
425 
426 	if (sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) {
427 		struct termios t;
428 		const char *acc;
429 
430 		/* Let residual prom output drain */
431 		DELAY(100000);
432 
433 		switch (sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) {
434 		case SABTTYF_CONS_IN:
435 			acc = "input";
436 			break;
437 		case SABTTYF_CONS_OUT:
438 			acc = "output";
439 			break;
440 		case SABTTYF_CONS_IN|SABTTYF_CONS_OUT:
441 		default:
442 			acc = "i/o";
443 			break;
444 		}
445 
446 		t.c_ispeed= 0;
447 		if (sc->sc_flags & SABTTYF_IS_RSC)
448 			t.c_ospeed = 115200;
449 		else
450 			t.c_ospeed = 9600;
451 		t.c_cflag = CREAD | CS8 | HUPCL;
452 		sc->sc_tty->t_ospeed = 0;
453 		sabttyparam(sc, sc->sc_tty, &t);
454 
455 		if (sc->sc_flags & SABTTYF_CONS_IN) {
456 			sabtty_cons_input = sc;
457 			cn_tab->cn_pollc = sab_cnpollc;
458 			cn_tab->cn_getc = sab_cngetc;
459 			maj = cdevsw_lookup_major(&sabtty_cdevsw);
460 			cn_tab->cn_dev = makedev(maj, device_unit(self));
461 			shutdownhook_establish(sabtty_shutdown, sc);
462 			cn_init_magic(&sabtty_cnm_state);
463 			cn_set_magic("\047\001"); /* default magic is BREAK */
464 		}
465 
466 		if (sc->sc_flags & SABTTYF_CONS_OUT) {
467 			sabtty_tec_wait(sc);
468 			sabtty_cons_output = sc;
469 			cn_tab->cn_putc = sab_cnputc;
470 			maj = cdevsw_lookup_major(&sabtty_cdevsw);
471 			cn_tab->cn_dev = makedev(maj, device_unit(self));
472 		}
473 		aprint_normal(": console %s", acc);
474 	} else {
475 		/* Not a console... */
476 		sabtty_reset(sc);
477 
478 #ifdef KGDB
479 		if (is_kgdb) {
480 			sab_kgdb_init(sc);
481 			aprint_normal(": kgdb");
482 		}
483 #endif
484 	}
485 
486 	aprint_normal("\n");
487 	aprint_naive(": Serial port\n");
488 }
489 
490 int
491 sabtty_intr(struct sabtty_softc *sc, int *needsoftp)
492 {
493 	uint8_t isr0, isr1;
494 	int i, len = 0, needsoft = 0, r = 0, clearfifo = 0;
495 
496 	isr0 = SAB_READ(sc, SAB_ISR0);
497 	isr1 = SAB_READ(sc, SAB_ISR1);
498 
499 	if (isr0 || isr1)
500 		r = 1;
501 
502 	if (isr0 & SAB_ISR0_RPF) {
503 		len = 32;
504 		clearfifo = 1;
505 	}
506 	if (isr0 & SAB_ISR0_TCD) {
507 		len = (32 - 1) & SAB_READ(sc, SAB_RBCL);
508 		clearfifo = 1;
509 	}
510 	if (isr0 & SAB_ISR0_TIME) {
511 		sabtty_cec_wait(sc);
512 		SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RFRD);
513 	}
514 	if (isr0 & SAB_ISR0_RFO) {
515 		sc->sc_flags |= SABTTYF_RINGOVERFLOW;
516 		clearfifo = 1;
517 	}
518 	if (len != 0) {
519 		uint8_t *ptr, b;
520 
521 		ptr = sc->sc_rput;
522 		for (i = 0; i < len; i++) {
523 			b = SAB_READ(sc, SAB_RFIFO);
524 			if (i % 2 == 0) /* skip status byte */
525 				cn_check_magic(sc->sc_tty->t_dev,
526 					       b, sabtty_cnm_state);
527 			*ptr++ = b;
528 			if (ptr == sc->sc_rend)
529 				ptr = sc->sc_rbuf;
530 			if (ptr == sc->sc_rget) {
531 				if (ptr == sc->sc_rbuf)
532 					ptr = sc->sc_rend;
533 				ptr--;
534 				sc->sc_flags |= SABTTYF_RINGOVERFLOW;
535 			}
536 		}
537 		sc->sc_rput = ptr;
538 		needsoft = 1;
539 	}
540 
541 	if (clearfifo) {
542 		sabtty_cec_wait(sc);
543 		SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RMC);
544 	}
545 
546 	if (isr0 & SAB_ISR0_CDSC) {
547 		sc->sc_flags |= SABTTYF_CDCHG;
548 		needsoft = 1;
549 	}
550 
551 	if (isr1 & SAB_ISR1_BRKT)
552 		cn_check_magic(sc->sc_tty->t_dev,
553 			       CNC_BREAK, sabtty_cnm_state);
554 
555 	if (isr1 & (SAB_ISR1_XPR | SAB_ISR1_ALLS)) {
556 		if ((SAB_READ(sc, SAB_STAR) & SAB_STAR_XFW) &&
557 		    (sc->sc_flags & SABTTYF_STOP) == 0) {
558 			if (sc->sc_txc < 32)
559 				len = sc->sc_txc;
560 			else
561 				len = 32;
562 
563 			if (len > 0) {
564 				SAB_WRITE_BLOCK(sc, SAB_XFIFO, sc->sc_txp, len);
565 				sc->sc_txp += len;
566 				sc->sc_txc -= len;
567 
568 				sabtty_cec_wait(sc);
569 				SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_XF);
570 
571 				/*
572 				 * Prevent the false end of xmit from
573 				 * confusing things below.
574 				 */
575 				isr1 &= ~SAB_ISR1_ALLS;
576 			}
577 		}
578 
579 		if ((sc->sc_txc == 0) || (sc->sc_flags & SABTTYF_STOP)) {
580 			if ((sc->sc_imr1 & SAB_IMR1_XPR) == 0) {
581 				sc->sc_imr1 |= SAB_IMR1_XPR;
582 				sc->sc_imr1 &= ~SAB_IMR1_ALLS;
583 				SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
584 			}
585 		}
586 	}
587 
588 	if ((isr1 & SAB_ISR1_ALLS) && ((sc->sc_txc == 0) ||
589 	    (sc->sc_flags & SABTTYF_STOP))) {
590 		if (sc->sc_flags & SABTTYF_TXDRAIN)
591 			wakeup(sc);
592 		sc->sc_flags &= ~SABTTYF_STOP;
593 		sc->sc_flags |= SABTTYF_DONE;
594 		sc->sc_imr1 |= SAB_IMR1_ALLS;
595 		SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
596 		needsoft = 1;
597 	}
598 
599 	if (needsoft)
600 		*needsoftp = needsoft;
601 	return (r);
602 }
603 
604 void
605 sabtty_softintr(struct sabtty_softc *sc)
606 {
607 	struct tty *tp = sc->sc_tty;
608 	int s, flags;
609 	uint8_t r;
610 
611 	if (tp == NULL)
612 		return;
613 
614 	if ((tp->t_state & TS_ISOPEN) == 0)
615 		return;
616 
617 	while (sc->sc_rget != sc->sc_rput) {
618 		int data;
619 		uint8_t stat;
620 
621 		data = sc->sc_rget[0];
622 		stat = sc->sc_rget[1];
623 		sc->sc_rget += 2;
624 		if (stat & SAB_RSTAT_PE)
625 			data |= TTY_PE;
626 		if (stat & SAB_RSTAT_FE)
627 			data |= TTY_FE;
628 		if (sc->sc_rget == sc->sc_rend)
629 			sc->sc_rget = sc->sc_rbuf;
630 
631 		(*tp->t_linesw->l_rint)(data, tp);
632 	}
633 
634 	s = splhigh();
635 	flags = sc->sc_flags;
636 	sc->sc_flags &= ~(SABTTYF_DONE|SABTTYF_CDCHG|SABTTYF_RINGOVERFLOW);
637 	splx(s);
638 
639 	if (flags & SABTTYF_CDCHG) {
640 		s = spltty();
641 		r = SAB_READ(sc, SAB_VSTR) & SAB_VSTR_CD;
642 		splx(s);
643 
644 		(*tp->t_linesw->l_modem)(tp, r);
645 	}
646 
647 	if (flags & SABTTYF_RINGOVERFLOW)
648 		log(LOG_WARNING, "%s: ring overflow\n",
649 		    device_xname(&sc->sc_dv));
650 
651 	if (flags & SABTTYF_DONE) {
652 		ndflush(&tp->t_outq, sc->sc_txp - tp->t_outq.c_cf);
653 		tp->t_state &= ~TS_BUSY;
654 		(*tp->t_linesw->l_start)(tp);
655 	}
656 }
657 
658 int
659 sabopen(dev_t dev, int flags, int mode, struct lwp *l)
660 {
661 	struct sabtty_softc *sc;
662 	struct tty *tp;
663 	struct proc *p;
664 	int s, s1;
665 
666 	sc = device_lookup_private(&sabtty_cd, SABUNIT(dev));
667 	if (sc == NULL)
668 		return (ENXIO);
669 
670 	tp = sc->sc_tty;
671 	tp->t_dev = dev;
672 	p = l->l_proc;
673 
674 	if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp))
675 		return (EBUSY);
676 
677 	mutex_spin_enter(&tty_lock);
678 	if ((tp->t_state & TS_ISOPEN) == 0) {
679 		ttychars(tp);
680 		tp->t_iflag = TTYDEF_IFLAG;
681 		tp->t_oflag = TTYDEF_OFLAG;
682 		tp->t_cflag = TTYDEF_CFLAG;
683 		if (sc->sc_openflags & TIOCFLAG_CLOCAL)
684 			tp->t_cflag |= CLOCAL;
685 		if (sc->sc_openflags & TIOCFLAG_CRTSCTS)
686 			tp->t_cflag |= CRTSCTS;
687 		if (sc->sc_openflags & TIOCFLAG_MDMBUF)
688 			tp->t_cflag |= MDMBUF;
689 		tp->t_lflag = TTYDEF_LFLAG;
690 		tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
691 
692 		sc->sc_rput = sc->sc_rget = sc->sc_rbuf;
693 
694 		ttsetwater(tp);
695 
696 		s1 = splhigh();
697 		sabtty_reset(sc);
698 		sabtty_param(tp, &tp->t_termios);
699 		sc->sc_imr0 = SAB_IMR0_PERR | SAB_IMR0_FERR | SAB_IMR0_PLLA;
700 		SAB_WRITE(sc, SAB_IMR0, sc->sc_imr0);
701 		sc->sc_imr1 = SAB_IMR1_BRK | SAB_IMR1_ALLS | SAB_IMR1_XDU |
702 		    SAB_IMR1_TIN | SAB_IMR1_CSC | SAB_IMR1_XMR | SAB_IMR1_XPR;
703 		SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
704 		SAB_WRITE(sc, SAB_CCR0, SAB_READ(sc, SAB_CCR0) | SAB_CCR0_PU);
705 		sabtty_cec_wait(sc);
706 		SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_XRES);
707 		sabtty_cec_wait(sc);
708 		SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
709 		sabtty_cec_wait(sc);
710 		splx(s1);
711 
712 		sabtty_flush(sc);
713 
714 		if ((sc->sc_openflags & TIOCFLAG_SOFTCAR) ||
715 		    (SAB_READ(sc, SAB_VSTR) & SAB_VSTR_CD))
716 			tp->t_state |= TS_CARR_ON;
717 		else
718 			tp->t_state &= ~TS_CARR_ON;
719 	}
720 
721 	if ((flags & O_NONBLOCK) == 0) {
722 		while ((tp->t_cflag & CLOCAL) == 0 &&
723 		    (tp->t_state & TS_CARR_ON) == 0) {
724 			int error;
725 
726 			error = ttysleep(tp, &tp->t_rawcv, true, 0);
727 			if (error != 0) {
728 				mutex_spin_exit(&tty_lock);
729 				return (error);
730 			}
731 		}
732 	}
733 
734 	mutex_spin_exit(&tty_lock);
735 
736 	s = (*tp->t_linesw->l_open)(dev, tp);
737 	if (s != 0) {
738 		mutex_spin_enter(&tty_lock);
739 		if (tp->t_state & TS_ISOPEN) {
740 			mutex_spin_exit(&tty_lock);
741 			return (s);
742 		}
743 		if (tp->t_cflag & HUPCL) {
744 			sabtty_mdmctrl(sc, 0, DMSET);
745 			cv_wait(&lbolt, &tty_lock);
746 		}
747 
748 		if ((sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) == 0) {
749 			/* Flush and power down if we're not the console */
750 			sabtty_flush(sc);
751 			sabtty_reset(sc);
752 		}
753 		mutex_spin_exit(&tty_lock);
754 	}
755 	return (s);
756 }
757 
758 int
759 sabclose(dev_t dev, int flags, int mode, struct lwp *l)
760 {
761 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(dev));
762 	struct sab_softc *bc = sc->sc_parent;
763 	struct tty *tp = sc->sc_tty;
764 	int s;
765 
766 	(*tp->t_linesw->l_close)(tp, flags);
767 
768 	s = spltty();
769 
770 	if ((tp->t_state & TS_ISOPEN) == 0) {
771 		/* Wait for output drain */
772 		sc->sc_imr1 &= ~SAB_IMR1_ALLS;
773 		SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
774 		sc->sc_flags |= SABTTYF_TXDRAIN;
775 		(void)tsleep(sc, TTIPRI, ttclos, 5 * hz);
776 		sc->sc_imr1 |= SAB_IMR1_ALLS;
777 		SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
778 		sc->sc_flags &= ~SABTTYF_TXDRAIN;
779 
780 		if (tp->t_cflag & HUPCL) {
781 			sabtty_mdmctrl(sc, 0, DMSET);
782 			(void)tsleep(bc, TTIPRI, ttclos, hz);
783 		}
784 
785 		if ((sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) == 0) {
786 			/* Flush and power down if we're not the console */
787 			sabtty_flush(sc);
788 			sabtty_reset(sc);
789 		}
790 	}
791 
792 	ttyclose(tp);
793 	splx(s);
794 
795 	return (0);
796 }
797 
798 int
799 sabread(dev_t dev, struct uio *uio, int flags)
800 {
801 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(dev));
802 	struct tty *tp = sc->sc_tty;
803 
804 	return ((*tp->t_linesw->l_read)(tp, uio, flags));
805 }
806 
807 int
808 sabwrite(dev_t dev, struct uio *uio, int flags)
809 {
810 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(dev));
811 	struct tty *tp = sc->sc_tty;
812 
813 	return ((*tp->t_linesw->l_write)(tp, uio, flags));
814 }
815 
816 int
817 sabioctl(dev_t dev, u_long cmd, void *data, int flags, struct lwp *l)
818 {
819 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(dev));
820 	struct tty *tp = sc->sc_tty;
821 	int error;
822 
823 	error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flags, l);
824 	if (error >= 0)
825 		return (error);
826 
827 	error = ttioctl(tp, cmd, data, flags, l);
828 	if (error >= 0)
829 		return (error);
830 
831 	error = 0;
832 
833 	switch (cmd) {
834 	case TIOCSBRK:
835 		SAB_WRITE(sc, SAB_DAFO,
836 		    SAB_READ(sc, SAB_DAFO) | SAB_DAFO_XBRK);
837 		break;
838 	case TIOCCBRK:
839 		SAB_WRITE(sc, SAB_DAFO,
840 		    SAB_READ(sc, SAB_DAFO) & ~SAB_DAFO_XBRK);
841 		break;
842 	case TIOCSDTR:
843 		sabtty_mdmctrl(sc, TIOCM_DTR, DMBIS);
844 		break;
845 	case TIOCCDTR:
846 		sabtty_mdmctrl(sc, TIOCM_DTR, DMBIC);
847 		break;
848 	case TIOCMBIS:
849 		sabtty_mdmctrl(sc, *((int *)data), DMBIS);
850 		break;
851 	case TIOCMBIC:
852 		sabtty_mdmctrl(sc, *((int *)data), DMBIC);
853 		break;
854 	case TIOCMGET:
855 		*((int *)data) = sabtty_mdmctrl(sc, 0, DMGET);
856 		break;
857 	case TIOCMSET:
858 		sabtty_mdmctrl(sc, *((int *)data), DMSET);
859 		break;
860 	case TIOCGFLAGS:
861 		*((int *)data) = sc->sc_openflags;
862 		break;
863 	case TIOCSFLAGS:
864 		if (kauth_authorize_device_tty(l->l_cred,
865 		    KAUTH_DEVICE_TTY_PRIVSET, tp))
866 			error = EPERM;
867 		else
868 			sc->sc_openflags = *((int *)data) &
869 			    (TIOCFLAG_SOFTCAR | TIOCFLAG_CLOCAL |
870 			     TIOCFLAG_CRTSCTS | TIOCFLAG_MDMBUF);
871 		break;
872 	default:
873 		error = ENOTTY;
874 	}
875 
876 	return (error);
877 }
878 
879 struct tty *
880 sabtty(dev_t dev)
881 {
882 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(dev));
883 
884 	return (sc->sc_tty);
885 }
886 
887 void
888 sabstop(struct tty *tp, int flag)
889 {
890 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(tp->t_dev));
891 	int s;
892 
893 	s = spltty();
894 	if (tp->t_state & TS_BUSY) {
895 		if ((tp->t_state & TS_TTSTOP) == 0)
896 			tp->t_state |= TS_FLUSH;
897 		sc->sc_flags |= SABTTYF_STOP;
898 		sc->sc_imr1 &= ~SAB_IMR1_ALLS;
899 		SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
900 	}
901 	splx(s);
902 }
903 
904 int
905 sabpoll(dev_t dev, int events, struct lwp *l)
906 {
907 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(dev));
908 	struct tty *tp = sc->sc_tty;
909 
910 	return ((*tp->t_linesw->l_poll)(tp, events, l));
911 }
912 
913 int
914 sabtty_mdmctrl(struct sabtty_softc *sc, int bits, int how)
915 {
916 	uint8_t r;
917 	int s;
918 
919 	s = spltty();
920 	switch (how) {
921 	case DMGET:
922 		bits = 0;
923 		if (SAB_READ(sc, SAB_STAR) & SAB_STAR_CTS)
924 			bits |= TIOCM_CTS;
925 		if ((SAB_READ(sc, SAB_VSTR) & SAB_VSTR_CD) == 0)
926 			bits |= TIOCM_CD;
927 
928 		r = SAB_READ(sc, SAB_PVR);
929 		if ((r & sc->sc_pvr_dtr) == 0)
930 			bits |= TIOCM_DTR;
931 		if ((r & sc->sc_pvr_dsr) == 0)
932 			bits |= TIOCM_DSR;
933 
934 		r = SAB_READ(sc, SAB_MODE);
935 		if ((r & (SAB_MODE_RTS|SAB_MODE_FRTS)) == SAB_MODE_RTS)
936 			bits |= TIOCM_RTS;
937 		break;
938 	case DMSET:
939 		r = SAB_READ(sc, SAB_MODE);
940 		if (bits & TIOCM_RTS) {
941 			r &= ~SAB_MODE_FRTS;
942 			r |= SAB_MODE_RTS;
943 		} else
944 			r |= SAB_MODE_FRTS | SAB_MODE_RTS;
945 		SAB_WRITE(sc, SAB_MODE, r);
946 
947 		r = SAB_READ(sc, SAB_PVR);
948 		if (bits & TIOCM_DTR)
949 			r &= ~sc->sc_pvr_dtr;
950 		else
951 			r |= sc->sc_pvr_dtr;
952 		SAB_WRITE(sc, SAB_PVR, r);
953 		break;
954 	case DMBIS:
955 		if (bits & TIOCM_RTS) {
956 			r = SAB_READ(sc, SAB_MODE);
957 			r &= ~SAB_MODE_FRTS;
958 			r |= SAB_MODE_RTS;
959 			SAB_WRITE(sc, SAB_MODE, r);
960 		}
961 		if (bits & TIOCM_DTR) {
962 			r = SAB_READ(sc, SAB_PVR);
963 			r &= ~sc->sc_pvr_dtr;
964 			SAB_WRITE(sc, SAB_PVR, r);
965 		}
966 		break;
967 	case DMBIC:
968 		if (bits & TIOCM_RTS) {
969 			r = SAB_READ(sc, SAB_MODE);
970 			r |= SAB_MODE_FRTS | SAB_MODE_RTS;
971 			SAB_WRITE(sc, SAB_MODE, r);
972 		}
973 		if (bits & TIOCM_DTR) {
974 			r = SAB_READ(sc, SAB_PVR);
975 			r |= sc->sc_pvr_dtr;
976 			SAB_WRITE(sc, SAB_PVR, r);
977 		}
978 		break;
979 	}
980 	splx(s);
981 	return (bits);
982 }
983 
984 int
985 sabttyparam(struct sabtty_softc *sc, struct tty *tp, struct termios *t)
986 {
987 	int s, ospeed;
988 	tcflag_t cflag;
989 	uint8_t dafo, r;
990 
991 	ospeed = sabtty_speed(t->c_ospeed);
992 	if (ospeed < 0 || (t->c_ispeed && t->c_ispeed != t->c_ospeed))
993 		return (EINVAL);
994 
995 	s = spltty();
996 
997 	/* hang up line if ospeed is zero, otherwise raise dtr */
998 	sabtty_mdmctrl(sc, TIOCM_DTR,
999 	    (t->c_ospeed == 0) ? DMBIC : DMBIS);
1000 
1001 	dafo = SAB_READ(sc, SAB_DAFO);
1002 
1003 	cflag = t->c_cflag;
1004 
1005 	if (sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) {
1006 		cflag |= CLOCAL;
1007 		cflag &= ~HUPCL;
1008 	}
1009 
1010 	if (cflag & CSTOPB)
1011 		dafo |= SAB_DAFO_STOP;
1012 	else
1013 		dafo &= ~SAB_DAFO_STOP;
1014 
1015 	dafo &= ~SAB_DAFO_CHL_CSIZE;
1016 	switch (cflag & CSIZE) {
1017 	case CS5:
1018 		dafo |= SAB_DAFO_CHL_CS5;
1019 		break;
1020 	case CS6:
1021 		dafo |= SAB_DAFO_CHL_CS6;
1022 		break;
1023 	case CS7:
1024 		dafo |= SAB_DAFO_CHL_CS7;
1025 		break;
1026 	default:
1027 		dafo |= SAB_DAFO_CHL_CS8;
1028 		break;
1029 	}
1030 
1031 	dafo &= ~SAB_DAFO_PARMASK;
1032 	if (cflag & PARENB) {
1033 		if (cflag & PARODD)
1034 			dafo |= SAB_DAFO_PAR_ODD;
1035 		else
1036 			dafo |= SAB_DAFO_PAR_EVEN;
1037 	} else
1038 		dafo |= SAB_DAFO_PAR_NONE;
1039 	SAB_WRITE(sc, SAB_DAFO, dafo);
1040 
1041 	if (!(sc->sc_flags & SABTTYF_IS_RSC) && ospeed != 0) {
1042 		SAB_WRITE(sc, SAB_BGR, ospeed & 0xff);
1043 		r = SAB_READ(sc, SAB_CCR2);
1044 		r &= ~(SAB_CCR2_BR9 | SAB_CCR2_BR8);
1045 		r |= (ospeed >> 2) & (SAB_CCR2_BR9 | SAB_CCR2_BR8);
1046 		SAB_WRITE(sc, SAB_CCR2, r);
1047 	}
1048 
1049 	r = SAB_READ(sc, SAB_MODE);
1050 	r |= SAB_MODE_RAC;
1051 	if (cflag & CRTSCTS) {
1052 		r &= ~(SAB_MODE_RTS | SAB_MODE_FCTS);
1053 		r |= SAB_MODE_FRTS;
1054 		sc->sc_imr1 &= ~SAB_IMR1_CSC;
1055 	} else {
1056 		r |= SAB_MODE_RTS | SAB_MODE_FCTS;
1057 		r &= ~SAB_MODE_FRTS;
1058 		sc->sc_imr1 |= SAB_IMR1_CSC;
1059 	}
1060 	SAB_WRITE(sc, SAB_MODE, r);
1061 	SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
1062 
1063 	tp->t_cflag = cflag;
1064 
1065 	splx(s);
1066 	return (0);
1067 }
1068 
1069 int
1070 sabtty_param(struct tty *tp, struct termios *t)
1071 {
1072 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(tp->t_dev));
1073 
1074 	return (sabttyparam(sc, tp, t));
1075 }
1076 
1077 void
1078 sabtty_start(struct tty *tp)
1079 {
1080 	struct sabtty_softc *sc = device_lookup_private(&sabtty_cd, SABUNIT(tp->t_dev));
1081 	int s;
1082 
1083 	s = spltty();
1084 	if ((tp->t_state & (TS_TTSTOP | TS_TIMEOUT | TS_BUSY)) == 0) {
1085 		if (ttypull(tp)) {
1086 			sc->sc_txc = ndqb(&tp->t_outq, 0);
1087 			sc->sc_txp = tp->t_outq.c_cf;
1088 			tp->t_state |= TS_BUSY;
1089 			sc->sc_imr1 &= ~(SAB_ISR1_XPR | SAB_ISR1_ALLS);
1090 			SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
1091 		}
1092 	}
1093 	splx(s);
1094 }
1095 
1096 void
1097 sabtty_cec_wait(struct sabtty_softc *sc)
1098 {
1099 	int i = 50000;
1100 
1101 	for (;;) {
1102 		if ((SAB_READ(sc, SAB_STAR) & SAB_STAR_CEC) == 0)
1103 			return;
1104 		if (--i == 0)
1105 			break;
1106 		DELAY(1);
1107 	}
1108 }
1109 
1110 void
1111 sabtty_tec_wait(struct sabtty_softc *sc)
1112 {
1113 	int i = 200000;
1114 
1115 	for (;;) {
1116 		if ((SAB_READ(sc, SAB_STAR) & SAB_STAR_TEC) == 0)
1117 			return;
1118 		if (--i == 0)
1119 			break;
1120 		DELAY(1);
1121 	}
1122 }
1123 
1124 void
1125 sabtty_reset(struct sabtty_softc *sc)
1126 {
1127 	/* power down */
1128 	SAB_WRITE(sc, SAB_CCR0, 0);
1129 
1130 	/* set basic configuration */
1131 	SAB_WRITE(sc, SAB_CCR0,
1132 	    SAB_CCR0_MCE | SAB_CCR0_SC_NRZ | SAB_CCR0_SM_ASYNC);
1133 	SAB_WRITE(sc, SAB_CCR1, SAB_CCR1_ODS | SAB_CCR1_BCR | SAB_CCR1_CM_7);
1134 	SAB_WRITE(sc, SAB_CCR2, SAB_CCR2_BDF | SAB_CCR2_SSEL | SAB_CCR2_TOE);
1135 	SAB_WRITE(sc, SAB_CCR3, 0);
1136 	SAB_WRITE(sc, SAB_CCR4, SAB_CCR4_MCK4 | SAB_CCR4_EBRG | SAB_CCR4_ICD);
1137 	SAB_WRITE(sc, SAB_MODE, SAB_MODE_RTS | SAB_MODE_FCTS | SAB_MODE_RAC);
1138 	SAB_WRITE(sc, SAB_RFC,
1139 	    SAB_RFC_DPS | SAB_RFC_RFDF | SAB_RFC_RFTH_32CHAR);
1140 
1141 	/* clear interrupts */
1142 	sc->sc_imr0 = sc->sc_imr1 = 0xff;
1143 	SAB_WRITE(sc, SAB_IMR0, sc->sc_imr0);
1144 	SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
1145 	(void)SAB_READ(sc, SAB_ISR0);
1146 	(void)SAB_READ(sc, SAB_ISR1);
1147 }
1148 
1149 void
1150 sabtty_flush(struct sabtty_softc *sc)
1151 {
1152 	/* clear rx fifo */
1153 	sabtty_cec_wait(sc);
1154 	SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
1155 
1156 	/* clear tx fifo */
1157 	sabtty_cec_wait(sc);
1158 	SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_XRES);
1159 }
1160 
1161 int
1162 sabtty_speed(int rate)
1163 {
1164 	int i, len, r;
1165 
1166 	if (rate == 0)
1167 		return (0);
1168 	len = sizeof(sabtty_baudtable)/sizeof(sabtty_baudtable[0]);
1169 	for (i = 0; i < len; i++) {
1170 		if (rate == sabtty_baudtable[i].baud) {
1171 			r = sabtty_baudtable[i].n |
1172 			    (sabtty_baudtable[i].m << 6);
1173 			return (r);
1174 		}
1175 	}
1176 	return (-1);
1177 }
1178 
1179 void
1180 sabtty_cnputc(struct sabtty_softc *sc, int c)
1181 {
1182 	sabtty_tec_wait(sc);
1183 	SAB_WRITE(sc, SAB_TIC, c);
1184 	sabtty_tec_wait(sc);
1185 }
1186 
1187 int
1188 sabtty_cngetc(struct sabtty_softc *sc)
1189 {
1190 	uint8_t r, len;
1191 
1192 again:
1193 	do {
1194 		r = SAB_READ(sc, SAB_STAR);
1195 	} while ((r & SAB_STAR_RFNE) == 0);
1196 
1197 	/*
1198 	 * Ok, at least one byte in RFIFO, ask for permission to access RFIFO
1199 	 * (I hate this chip... hate hate hate).
1200 	 */
1201 	sabtty_cec_wait(sc);
1202 	SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RFRD);
1203 
1204 	/* Wait for RFIFO to come ready */
1205 	do {
1206 		r = SAB_READ(sc, SAB_ISR0);
1207 	} while ((r & SAB_ISR0_TCD) == 0);
1208 
1209 	len = SAB_READ(sc, SAB_RBCL) & (32 - 1);
1210 	if (len == 0)
1211 		goto again;	/* Shouldn't happen... */
1212 
1213 	r = SAB_READ(sc, SAB_RFIFO);
1214 
1215 	/*
1216 	 * Blow away everything left in the FIFO...
1217 	 */
1218 	sabtty_cec_wait(sc);
1219 	SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RMC);
1220 	return (r);
1221 }
1222 
1223 void
1224 sabtty_cnpollc(struct sabtty_softc *sc, int on)
1225 {
1226 	uint8_t r;
1227 
1228 	if (on) {
1229 		if (sc->sc_polling)
1230 			return;
1231 		SAB_WRITE(sc, SAB_IPC, SAB_READ(sc, SAB_IPC) | SAB_IPC_VIS);
1232 		r = sc->sc_pollrfc = SAB_READ(sc, SAB_RFC);
1233 		r &= ~(SAB_RFC_RFDF);
1234 		SAB_WRITE(sc, SAB_RFC, r);
1235 		sabtty_cec_wait(sc);
1236 		SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
1237 		sc->sc_polling = 1;
1238 	} else {
1239 		if (!sc->sc_polling)
1240 			return;
1241 		SAB_WRITE(sc, SAB_IPC, SAB_READ(sc, SAB_IPC) & ~SAB_IPC_VIS);
1242 		SAB_WRITE(sc, SAB_RFC, sc->sc_pollrfc);
1243 		sabtty_cec_wait(sc);
1244 		SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
1245 		sc->sc_polling = 0;
1246 	}
1247 }
1248 
1249 void
1250 sab_cnputc(dev_t dev, int c)
1251 {
1252 	struct sabtty_softc *sc = sabtty_cons_output;
1253 
1254 	if (sc == NULL)
1255 		return;
1256 	sabtty_cnputc(sc, c);
1257 }
1258 
1259 void
1260 sab_cnpollc(dev_t dev, int on)
1261 {
1262 	struct sabtty_softc *sc = sabtty_cons_input;
1263 
1264 	sabtty_cnpollc(sc, on);
1265 }
1266 
1267 int
1268 sab_cngetc(dev_t dev)
1269 {
1270 	struct sabtty_softc *sc = sabtty_cons_input;
1271 
1272 	if (sc == NULL)
1273 		return (-1);
1274 	return (sabtty_cngetc(sc));
1275 }
1276 
1277 void
1278 sabtty_console_flags(struct sabtty_softc *sc)
1279 {
1280 	int node, channel, cookie;
1281 	char buf[255];
1282 
1283 	node = sc->sc_parent->sc_node;
1284 	channel = sc->sc_portno;
1285 
1286 	/* Default to channel 0 if there are no explicit prom args */
1287 	cookie = 0;
1288 
1289 	if (node == prom_instance_to_package(prom_stdin())) {
1290 		if (prom_getoption("input-device", buf, sizeof buf) == 0 &&
1291 			strcmp("ttyb", buf) == 0)
1292 				cookie = 1;
1293 
1294 		if (channel == cookie)
1295 			sc->sc_flags |= SABTTYF_CONS_IN;
1296 	}
1297 
1298 	/* Default to same channel if there are no explicit prom args */
1299 
1300 	if (node == prom_instance_to_package(prom_stdout())) {
1301 		if (prom_getoption("output-device", buf, sizeof buf) == 0 &&
1302 			strcmp("ttyb", buf) == 0)
1303 				cookie = 1;
1304 
1305 		if (channel == cookie)
1306 			sc->sc_flags |= SABTTYF_CONS_OUT;
1307 	}
1308 	/* Are we connected to an E250 RSC? */
1309 	if (channel == prom_getpropint(node, "ssp-console", -1) ||
1310 	    channel == prom_getpropint(node, "ssp-control", -1))
1311 		sc->sc_flags |= SABTTYF_IS_RSC;
1312 }
1313 
1314 void
1315 sabtty_shutdown(void *vsc)
1316 {
1317 	struct sabtty_softc *sc = vsc;
1318 
1319 	/* Have to put the chip back into single char mode */
1320 	sc->sc_flags |= SABTTYF_DONTDDB;
1321 	SAB_WRITE(sc, SAB_RFC, SAB_READ(sc, SAB_RFC) & ~SAB_RFC_RFDF);
1322 	sabtty_cec_wait(sc);
1323 	SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
1324 	sabtty_cec_wait(sc);
1325 }
1326 
1327 #ifdef KGDB
1328 static int
1329 sab_kgdb_getc(void *arg)
1330 {
1331 	struct sabtty_softc *sc = arg;
1332 
1333 	return sabtty_cngetc(sc);
1334 }
1335 
1336 static void
1337 sab_kgdb_putc(void *arg, int c)
1338 {
1339 	struct sabtty_softc *sc = arg;
1340 
1341 	return sabtty_cnputc(sc, c);
1342 }
1343 
1344 #ifndef KGDB_DEVRATE
1345 #define KGDB_DEVRATE    9600
1346 #endif
1347 
1348 int
1349 sab_kgdb_check(struct sabtty_softc *sc)
1350 {
1351 	return strcmp(device_xname(&sc->sc_dv), KGDB_DEVNAME) == 0;
1352 }
1353 
1354 void
1355 sab_kgdb_init(struct sabtty_softc *sc)
1356 {
1357 	int sp;
1358 	uint8_t dafo, r;
1359 	extern int kgdb_break_at_attach;
1360 
1361 	kgdb_attach(sab_kgdb_getc, sab_kgdb_putc, sc);
1362 	kgdb_dev = 123;	/* not used, but checked against NODEV */
1363 
1364 	/*
1365 	 * Configure the port to speed/8n1
1366 	 */
1367 	dafo = SAB_READ(sc, SAB_DAFO);
1368 	dafo &= ~(SAB_DAFO_STOP|SAB_DAFO_CHL_CSIZE|SAB_DAFO_PARMASK);
1369 	dafo |= SAB_DAFO_CHL_CS8|SAB_DAFO_PAR_NONE;
1370 	SAB_WRITE(sc, SAB_DAFO, dafo);
1371 	sp = sabtty_speed(KGDB_DEVRATE);
1372 	SAB_WRITE(sc, SAB_BGR, sp & 0xff);
1373 	r = SAB_READ(sc, SAB_CCR2);
1374 	r &= ~(SAB_CCR2_BR9 | SAB_CCR2_BR8);
1375 	r |= (sp >> 2) & (SAB_CCR2_BR9 | SAB_CCR2_BR8);
1376 	SAB_WRITE(sc, SAB_CCR2, r);
1377 
1378 	/*
1379 	 * If we are booting with -d, break into kgdb now
1380 	 */
1381 	if (kgdb_break_at_attach)
1382 		kgdb_connect(1);
1383 }
1384 #endif
1385