xref: /dragonfly/sys/dev/serial/sio/sio.c (revision 82730a9c)
1 /*-
2  * (MPSAFE)
3  *
4  * Copyright (c) 1991 The Regents of the University of California.
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  * 3. All advertising materials mentioning features or use of this software
16  *    must display the following acknowledgement:
17  *	This product includes software developed by the University of
18  *	California, Berkeley and its contributors.
19  * 4. Neither the name of the University nor the names of its contributors
20  *    may be used to endorse or promote products derived from this software
21  *    without specific prior written permission.
22  *
23  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
24  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
25  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
26  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
27  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
28  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
29  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
32  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
33  * SUCH DAMAGE.
34  *
35  * $FreeBSD: src/sys/isa/sio.c,v 1.291.2.35 2003/05/18 08:51:15 murray Exp $
36  *	from: @(#)com.c	7.5 (Berkeley) 5/16/91
37  *	from: i386/isa sio.c,v 1.234
38  */
39 
40 #include "opt_comconsole.h"
41 #include "opt_compat.h"
42 #include "opt_ddb.h"
43 #include "opt_sio.h"
44 #include "use_pci.h"
45 #include "use_puc.h"
46 
47 /*
48  * Serial driver, based on 386BSD-0.1 com driver.
49  * Mostly rewritten to use pseudo-DMA.
50  * Works for National Semiconductor NS8250-NS16550AF UARTs.
51  * COM driver, based on HP dca driver.
52  *
53  * Changes for PC-Card integration:
54  *	- Added PC-Card driver table and handlers
55  */
56 #include <sys/param.h>
57 #include <sys/systm.h>
58 #include <sys/reboot.h>
59 #include <sys/malloc.h>
60 #include <sys/tty.h>
61 #include <sys/proc.h>
62 #include <sys/priv.h>
63 #include <sys/module.h>
64 #include <sys/conf.h>
65 #include <sys/dkstat.h>
66 #include <sys/fcntl.h>
67 #include <sys/interrupt.h>
68 #include <sys/kernel.h>
69 #include <sys/syslog.h>
70 #include <sys/sysctl.h>
71 #include <sys/bus.h>
72 #include <sys/rman.h>
73 #include <sys/timepps.h>
74 #include <sys/thread2.h>
75 #include <sys/devfs.h>
76 #include <sys/consio.h>
77 
78 #include <machine/limits.h>
79 
80 #include <bus/isa/isareg.h>
81 #include <bus/isa/isavar.h>
82 #if NPCI > 0
83 #include <bus/pci/pcireg.h>
84 #include <bus/pci/pcivar.h>
85 #endif
86 #if NPUC > 0
87 #include <dev/misc/puc/pucvar.h>
88 #endif
89 #include <machine/lock.h>
90 
91 #include <machine/clock.h>
92 
93 #include "sioreg.h"
94 #include "sio_private.h"
95 
96 #ifdef COM_ESP
97 #include "../ic_layer/esp.h"
98 #endif
99 
100 #define	LOTS_OF_EVENTS	64	/* helps separate urgent events from input */
101 
102 #define	CALLOUT_MASK		0x80
103 #define	CONTROL_MASK		0x60
104 #define	CONTROL_INIT_STATE	0x20
105 #define	CONTROL_LOCK_STATE	0x40
106 #define	DEV_TO_UNIT(dev)	(MINOR_TO_UNIT(minor(dev)))
107 #define	MINOR_TO_UNIT(mynor)	((((mynor) & ~0xffffU) >> (8 + 3)) \
108 				 | ((mynor) & 0x1f))
109 #define	UNIT_TO_MINOR(unit)	((((unit) & ~0x1fU) << (8 + 3)) \
110 				 | ((unit) & 0x1f))
111 
112 #define	com_scr		7	/* scratch register for 16450-16550 (R/W) */
113 
114 #define	sio_getreg(com, off) \
115 	(bus_space_read_1((com)->bst, (com)->bsh, (off)))
116 #define	sio_setreg(com, off, value) \
117 	(bus_space_write_1((com)->bst, (com)->bsh, (off), (value)))
118 
119 /*
120  * com state bits.
121  * (CS_BUSY | CS_TTGO) and (CS_BUSY | CS_TTGO | CS_ODEVREADY) must be higher
122  * than the other bits so that they can be tested as a group without masking
123  * off the low bits.
124  *
125  * The following com and tty flags correspond closely:
126  *	CS_BUSY		= TS_BUSY (maintained by comstart(), siopoll() and
127  *				   comstop())
128  *	CS_TTGO		= ~TS_TTSTOP (maintained by comparam() and comstart())
129  *	CS_CTS_OFLOW	= CCTS_OFLOW (maintained by comparam())
130  *	CS_RTS_IFLOW	= CRTS_IFLOW (maintained by comparam())
131  * TS_FLUSH is not used.
132  * XXX I think TIOCSETA doesn't clear TS_TTSTOP when it clears IXON.
133  * XXX CS_*FLOW should be CF_*FLOW in com->flags (control flags not state).
134  */
135 #define	CS_BUSY		0x80	/* output in progress */
136 #define	CS_TTGO		0x40	/* output not stopped by XOFF */
137 #define	CS_ODEVREADY	0x20	/* external device h/w ready (CTS) */
138 #define	CS_CHECKMSR	1	/* check of MSR scheduled */
139 #define	CS_CTS_OFLOW	2	/* use CTS output flow control */
140 #define	CS_DTR_OFF	0x10	/* DTR held off */
141 #define	CS_ODONE	4	/* output completed */
142 #define	CS_RTS_IFLOW	8	/* use RTS input flow control */
143 #define	CSE_BUSYCHECK	1	/* siobusycheck() scheduled */
144 
145 static	char const * const	error_desc[] = {
146 #define	CE_OVERRUN			0
147 	"silo overflow",
148 #define	CE_INTERRUPT_BUF_OVERFLOW	1
149 	"interrupt-level buffer overflow",
150 #define	CE_TTY_BUF_OVERFLOW		2
151 	"tty-level buffer overflow",
152 };
153 
154 #ifdef COM_ESP
155 static	int	espattach	(struct com_s *com, Port_t esp_port);
156 #endif
157 static	int	sio_isa_attach	(device_t dev);
158 
159 static	timeout_t siobusycheck;
160 static	u_int	siodivisor	(u_long rclk, speed_t speed);
161 static	timeout_t siodtrwakeup;
162 static	void	comhardclose	(struct com_s *com);
163 static	void	sioinput	(struct com_s *com);
164 static	void	siointr1	(struct com_s *com);
165 static	void	siointr		(void *arg);
166 static	int	commctl		(struct com_s *com, int bits, int how);
167 static	int	comparam	(struct tty *tp, struct termios *t);
168 static	inthand2_t siopoll;
169 static	int	sio_isa_probe	(device_t dev);
170 static	void	siosettimeout	(void);
171 static	int	siosetwater	(struct com_s *com, speed_t speed);
172 static	void	comstart	(struct tty *tp);
173 static	void	comstop		(struct tty *tp, int rw);
174 static	timeout_t comwakeup;
175 static	void	disc_optim	(struct tty	*tp, struct termios *t,
176 				     struct com_s *com);
177 
178 #if NPCI > 0
179 static	int	sio_pci_attach (device_t dev);
180 static	void	sio_pci_kludge_unit (device_t dev);
181 static	int	sio_pci_probe (device_t dev);
182 #endif /* NPCI > 0 */
183 
184 #if NPUC > 0
185 static	int	sio_puc_attach (device_t dev);
186 static	int	sio_puc_probe (device_t dev);
187 #endif /* NPUC > 0 */
188 
189 static char driver_name[] = "sio";
190 
191 /* table and macro for fast conversion from a unit number to its com struct */
192 devclass_t	sio_devclass;
193 #define	com_addr(unit)	((struct com_s *) \
194 			 devclass_get_softc(sio_devclass, unit))
195 
196 static device_method_t sio_isa_methods[] = {
197 	/* Device interface */
198 	DEVMETHOD(device_probe,		sio_isa_probe),
199 	DEVMETHOD(device_attach,	sio_isa_attach),
200 
201 	DEVMETHOD_END
202 };
203 
204 static driver_t sio_isa_driver = {
205 	driver_name,
206 	sio_isa_methods,
207 	sizeof(struct com_s),
208 };
209 
210 #if NPCI > 0
211 static device_method_t sio_pci_methods[] = {
212 	/* Device interface */
213 	DEVMETHOD(device_probe,		sio_pci_probe),
214 	DEVMETHOD(device_attach,	sio_pci_attach),
215 
216 	DEVMETHOD_END
217 };
218 
219 static driver_t sio_pci_driver = {
220 	driver_name,
221 	sio_pci_methods,
222 	sizeof(struct com_s),
223 };
224 #endif /* NPCI > 0 */
225 
226 #if NPUC > 0
227 static device_method_t sio_puc_methods[] = {
228 	/* Device interface */
229 	DEVMETHOD(device_probe,		sio_puc_probe),
230 	DEVMETHOD(device_attach,	sio_puc_attach),
231 
232 	DEVMETHOD_END
233 };
234 
235 static driver_t sio_puc_driver = {
236 	driver_name,
237 	sio_puc_methods,
238 	sizeof(struct com_s),
239 };
240 #endif /* NPUC > 0 */
241 
242 static	d_open_t	sioopen;
243 static	d_close_t	sioclose;
244 static	d_read_t	sioread;
245 static	d_write_t	siowrite;
246 static	d_ioctl_t	sioioctl;
247 
248 static struct dev_ops sio_ops = {
249 	{ driver_name, 0, D_TTY },
250 	.d_open =	sioopen,
251 	.d_close =	sioclose,
252 	.d_read =	sioread,
253 	.d_write =	siowrite,
254 	.d_ioctl =	sioioctl,
255 	.d_kqfilter =	ttykqfilter,
256 	.d_revoke =	ttyrevoke
257 };
258 
259 int	comconsole = -1;
260 static	volatile speed_t	comdefaultrate = CONSPEED;
261 static	u_long			comdefaultrclk = DEFAULT_RCLK;
262 SYSCTL_ULONG(_machdep, OID_AUTO, conrclk, CTLFLAG_RW, &comdefaultrclk, 0, "");
263 static	u_int	com_events;	/* input chars + weighted output completions */
264 static	Port_t	siocniobase;
265 static	int	siocnunit;
266 static	Port_t	siogdbiobase;
267 static	int	siogdbunit = -1;
268 static	bool_t	sio_registered;
269 static	int	sio_timeout;
270 static	int	sio_timeouts_until_log;
271 static	struct	callout	sio_timeout_handle;
272 static	int	sio_numunits;
273 
274 #ifdef COM_ESP
275 /* XXX configure this properly. */
276 static	Port_t	likely_com_ports[] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, };
277 static	Port_t	likely_esp_ports[] = { 0x140, 0x180, 0x280, 0 };
278 #endif
279 
280 /*
281  * handle sysctl read/write requests for console speed
282  *
283  * In addition to setting comdefaultrate for I/O through /dev/console,
284  * also set the initial and lock values for the /dev/ttyXX device
285  * if there is one associated with the console.  Finally, if the /dev/tty
286  * device has already been open, change the speed on the open running port
287  * itself.
288  */
289 
290 static int
291 sysctl_machdep_comdefaultrate(SYSCTL_HANDLER_ARGS)
292 {
293 	int error;
294 	speed_t newspeed;
295 	struct com_s *com;
296 	struct tty *tp;
297 
298 	lwkt_gettoken(&tty_token);
299 	newspeed = comdefaultrate;
300 
301 	error = sysctl_handle_opaque(oidp, &newspeed, sizeof newspeed, req);
302 	if (error || !req->newptr) {
303 		lwkt_reltoken(&tty_token);
304 		return (error);
305 	}
306 
307 	comdefaultrate = newspeed;
308 
309 	if (comconsole < 0) {	/* serial console not selected? */
310 		lwkt_reltoken(&tty_token);
311 		return (0);
312 	}
313 
314 	com = com_addr(comconsole);
315 	if (com == NULL) {
316 		lwkt_reltoken(&tty_token);
317 		return (ENXIO);
318 	}
319 
320 	/*
321 	 * set the initial and lock rates for /dev/ttydXX and /dev/cuaXX
322 	 * (note, the lock rates really are boolean -- if non-zero, disallow
323 	 *  speed changes)
324 	 */
325 	com->it_in.c_ispeed  = com->it_in.c_ospeed =
326 	com->lt_in.c_ispeed  = com->lt_in.c_ospeed =
327 	com->it_out.c_ispeed = com->it_out.c_ospeed =
328 	com->lt_out.c_ispeed = com->lt_out.c_ospeed = comdefaultrate;
329 
330 	/*
331 	 * if we're open, change the running rate too
332 	 */
333 	tp = com->tp;
334 	if (tp && (tp->t_state & TS_ISOPEN)) {
335 		tp->t_termios.c_ispeed =
336 		tp->t_termios.c_ospeed = comdefaultrate;
337 		crit_enter();
338 		error = comparam(tp, &tp->t_termios);
339 		crit_exit();
340 	}
341 	lwkt_reltoken(&tty_token);
342 	return error;
343 }
344 
345 SYSCTL_PROC(_machdep, OID_AUTO, conspeed, CTLTYPE_INT | CTLFLAG_RW,
346 	    0, 0, sysctl_machdep_comdefaultrate, "I", "");
347 
348 #if NPCI > 0
349 struct pci_ids {
350 	u_int32_t	type;
351 	const char	*desc;
352 	int		rid;
353 };
354 
355 static struct pci_ids pci_ids[] = {
356 	{ 0x100812b9, "3COM PCI FaxModem", 0x10 },
357 	{ 0x2000131f, "CyberSerial (1-port) 16550", 0x10 },
358 	{ 0x01101407, "Koutech IOFLEX-2S PCI Dual Port Serial", 0x10 },
359 	{ 0x01111407, "Koutech IOFLEX-2S PCI Dual Port Serial", 0x10 },
360 	{ 0x048011c1, "Lucent kermit based PCI Modem", 0x14 },
361 	{ 0x95211415, "Oxford Semiconductor PCI Dual Port Serial", 0x10 },
362 	{ 0x7101135e, "SeaLevel Ultra 530.PCI Single Port Serial", 0x18 },
363 	{ 0x0000151f, "SmartLink 5634PCV SurfRider", 0x10 },
364 	{ 0x98459710, "Netmos Nm9845 PCI Bridge with Dual UART", 0x10 },
365 	{ 0x00000000, NULL, 0 }
366 };
367 
368 static int
369 sio_pci_attach(device_t dev)
370 {
371 	u_int32_t	type;
372 	struct pci_ids	*id;
373 
374 	type = pci_get_devid(dev);
375 	id = pci_ids;
376 	while (id->type && id->type != type)
377 		id++;
378 	if (id->desc == NULL)
379 		return (ENXIO);
380 	sio_pci_kludge_unit(dev);
381 	return (sioattach(dev, id->rid, 0UL));
382 }
383 
384 /*
385  * Don't cut and paste this to other drivers.  It is a horrible kludge
386  * which will fail to work and also be unnecessary in future versions.
387  */
388 static void
389 sio_pci_kludge_unit(device_t dev)
390 {
391 	devclass_t	dc;
392 	int		err;
393 	int		start;
394 	int		unit;
395 
396 	unit = 0;
397 	start = 0;
398 	while (resource_int_value("sio", unit, "port", &start) == 0 &&
399 	    start > 0)
400 		unit++;
401 	if (device_get_unit(dev) < unit) {
402 		dc = device_get_devclass(dev);
403 		while (devclass_get_device(dc, unit))
404 			unit++;
405 		device_printf(dev, "moving to sio%d\n", unit);
406 		err = device_set_unit(dev, unit);	/* EVIL DO NOT COPY */
407 		if (err)
408 			device_printf(dev, "error moving device %d\n", err);
409 	}
410 }
411 
412 static int
413 sio_pci_probe(device_t dev)
414 {
415 	u_int32_t	type;
416 	struct pci_ids	*id;
417 
418 	type = pci_get_devid(dev);
419 	id = pci_ids;
420 	while (id->type && id->type != type)
421 		id++;
422 	if (id->desc == NULL)
423 		return (ENXIO);
424 	device_set_desc(dev, id->desc);
425 	return (sioprobe(dev, id->rid, 0UL));
426 }
427 #endif /* NPCI > 0 */
428 
429 #if NPUC > 0
430 static int
431 sio_puc_attach(device_t dev)
432 {
433 	uintptr_t rclk;
434 
435 	if (BUS_READ_IVAR(device_get_parent(dev), dev, PUC_IVAR_FREQ,
436 	    &rclk) != 0)
437 		rclk = DEFAULT_RCLK;
438 	return (sioattach(dev, 0, rclk));
439 }
440 
441 static int
442 sio_puc_probe(device_t dev)
443 {
444 	uintptr_t rclk;
445 
446 	if (BUS_READ_IVAR(device_get_parent(dev), dev, PUC_IVAR_FREQ,
447 	    &rclk) != 0)
448 		rclk = DEFAULT_RCLK;
449 	return (sioprobe(dev, 0, rclk));
450 }
451 #endif /* NPUC */
452 
453 static struct isa_pnp_id sio_ids[] = {
454 	{0x0005d041, "Standard PC COM port"},	/* PNP0500 */
455 	{0x0105d041, "16550A-compatible COM port"},	/* PNP0501 */
456 	{0x0205d041, "Multiport serial device (non-intelligent 16550)"}, /* PNP0502 */
457 	{0x1005d041, "Generic IRDA-compatible device"},	/* PNP0510 */
458 	{0x1105d041, "Generic IRDA-compatible device"},	/* PNP0511 */
459 	/* Devices that do not have a compatid */
460 	{0x12206804, NULL},     /* ACH2012 - 5634BTS 56K Video Ready Modem */
461 	{0x7602a904, NULL},	/* AEI0276 - 56K v.90 Fax Modem (LKT) */
462 	{0x00007905, NULL},	/* AKY0000 - 56K Plug&Play Modem */
463 	{0x21107905, NULL},	/* AKY1021 - 56K Plug&Play Modem */
464 	{0x01405407, NULL},	/* AZT4001 - AZT3000 PnP SOUND DEVICE, MODEM */
465 	{0x56039008, NULL},	/* BDP0356 - Best Data 56x2 */
466 	{0x56159008, NULL},	/* BDP1556 - B.D. Smart One 56SPS,Voice Modem*/
467 	{0x36339008, NULL},	/* BDP3336 - Best Data Prods. 336F */
468 	{0x0014490a, NULL},	/* BRI1400 - Boca 33.6 PnP */
469 	{0x0015490a, NULL},	/* BRI1500 - Internal Fax Data */
470 	{0x0034490a, NULL},	/* BRI3400 - Internal ACF Modem */
471 	{0x0094490a, NULL},	/* BRI9400 - Boca K56Flex PnP */
472 	{0x00b4490a, NULL},	/* BRIB400 - Boca 56k PnP */
473 	{0x0030320d, NULL},	/* CIR3000 - Cirrus Logic V43 */
474 	{0x0100440e, NULL},	/* CRD0001 - Cardinal MVP288IV ? */
475 	{0x01308c0e, NULL},	/* CTL3001 - Creative Labs Phoneblaster */
476 	{0x36033610, NULL},     /* DAV0336 - DAVICOM 336PNP MODEM */
477 	{0x01009416, NULL},     /* ETT0001 - E-Tech Bullet 33k6 PnP */
478 	{0x0000aa1a, NULL},	/* FUJ0000 - FUJITSU Modem 33600 PNP/I2 */
479 	{0x1200c31e, NULL},	/* GVC0012 - VF1128HV-R9 (win modem?) */
480 	{0x0303c31e, NULL},	/* GVC0303 - MaxTech 33.6 PnP D/F/V */
481 	{0x0505c31e, NULL},	/* GVC0505 - GVC 56k Faxmodem */
482 	{0x0116c31e, NULL},	/* GVC1601 - Rockwell V.34 Plug & Play Modem */
483 	{0x0050c31e, NULL},	/* GVC5000 - some GVC modem */
484 	{0x3800f91e, NULL},	/* GWY0038 - Telepath with v.90 */
485 	{0x9062f91e, NULL},	/* GWY6290 - Telepath with x2 Technology */
486 	{0x8100e425, NULL},	/* IOD0081 - I-O DATA DEVICE,INC. IFML-560 */
487 	{0x21002534, NULL},	/* MAE0021 - Jetstream Int V.90 56k Voice Series 2*/
488 	{0x0000f435, NULL},	/* MOT0000 - Motorola ModemSURFR 33.6 Intern */
489 	{0x5015f435, NULL},	/* MOT1550 - Motorola ModemSURFR 56K Modem */
490 	{0xf015f435, NULL},	/* MOT15F0 - Motorola VoiceSURFR 56K Modem */
491 	{0x6045f435, NULL},	/* MOT4560 - Motorola ? */
492 	{0x61e7a338, NULL},	/* NECE761 - 33.6Modem */
493  	{0x08804f3f, NULL},	/* OZO8008 - Zoom  (33.6k Modem) */
494 	{0x0f804f3f, NULL},	/* OZO800f - Zoom 2812 (56k Modem) */
495 	{0x39804f3f, NULL},	/* OZO8039 - Zoom 56k flex */
496 	{0x00914f3f, NULL},	/* OZO9100 - Zoom 2919 (K56 Faxmodem) */
497 	{0x3024a341, NULL},	/* PMC2430 - Pace 56 Voice Internal Modem */
498 	{0x1000eb49, NULL},	/* ROK0010 - Rockwell ? */
499 	{0x1200b23d, NULL},     /* RSS0012 - OMRON ME5614ISA */
500 	{0x5002734a, NULL},	/* RSS0250 - 5614Jx3(G) Internal Modem */
501 	{0x6202734a, NULL},	/* RSS0262 - 5614Jx3[G] V90+K56Flex Modem */
502 	{0x1010104d, NULL},	/* SHP1010 - Rockwell 33600bps Modem */
503 	{0xc100ad4d, NULL},	/* SMM00C1 - Leopard 56k PnP */
504 	{0x9012b04e, NULL},	/* SUP1290 - Supra ? */
505 	{0x1013b04e, NULL},	/* SUP1310 - SupraExpress 336i PnP */
506 	{0x8013b04e, NULL},	/* SUP1380 - SupraExpress 288i PnP Voice */
507 	{0x8113b04e, NULL},	/* SUP1381 - SupraExpress 336i PnP Voice */
508 	{0x5016b04e, NULL},	/* SUP1650 - Supra 336i Sp Intl */
509 	{0x7016b04e, NULL},	/* SUP1670 - Supra 336i V+ Intl */
510 	{0x7420b04e, NULL},	/* SUP2070 - Supra ? */
511 	{0x8020b04e, NULL},	/* SUP2080 - Supra ? */
512 	{0x8420b04e, NULL},	/* SUP2084 - SupraExpress 56i PnP */
513 	{0x7121b04e, NULL},	/* SUP2171 - SupraExpress 56i Sp? */
514 	{0x8024b04e, NULL},	/* SUP2480 - Supra ? */
515 	{0x01007256, NULL},	/* USR0001 - U.S. Robotics Inc., Sportster W */
516 	{0x02007256, NULL},	/* USR0002 - U.S. Robotics Inc. Sportster 33. */
517 	{0x04007256, NULL},	/* USR0004 - USR Sportster 14.4k */
518 	{0x06007256, NULL},	/* USR0006 - USR Sportster 33.6k */
519 	{0x11007256, NULL},	/* USR0011 - USR ? */
520 	{0x01017256, NULL},	/* USR0101 - USR ? */
521 	{0x30207256, NULL},	/* USR2030 - U.S.Robotics Inc. Sportster 560 */
522 	{0x50207256, NULL},	/* USR2050 - U.S.Robotics Inc. Sportster 33. */
523 	{0x70207256, NULL},	/* USR2070 - U.S.Robotics Inc. Sportster 560 */
524 	{0x30307256, NULL},	/* USR3030 - U.S. Robotics 56K FAX INT */
525 	{0x31307256, NULL},	/* USR3031 - U.S. Robotics 56K FAX INT */
526 	{0x50307256, NULL},	/* USR3050 - U.S. Robotics 56K FAX INT */
527 	{0x70307256, NULL},	/* USR3070 - U.S. Robotics 56K Voice INT */
528 	{0x90307256, NULL},	/* USR3090 - USR ? */
529 	{0x70917256, NULL},	/* USR9170 - U.S. Robotics 56K FAX INT */
530 	{0x90917256, NULL},	/* USR9190 - USR 56k Voice INT */
531 	{0x0300695c, NULL},	/* WCI0003 - Fax/Voice/Modem/Speakphone/Asvd */
532 	{0x01a0896a, NULL},	/* ZTIA001 - Zoom Internal V90 Faxmodem */
533 	{0x61f7896a, NULL},	/* ZTIF761 - Zoom ComStar 33.6 */
534 	{0}
535 };
536 
537 
538 
539 static int
540 sio_isa_probe(device_t dev)
541 {
542 	/* Check isapnp ids */
543 	if (ISA_PNP_PROBE(device_get_parent(dev), dev, sio_ids) == ENXIO)
544 		return (ENXIO);
545 	return (sioprobe(dev, 0, 0UL));
546 }
547 
548 int
549 sioprobe(device_t dev, int xrid, u_long rclk)
550 {
551 #if 0
552 	static bool_t	already_init;
553 	device_t	xdev;
554 #endif
555 	struct com_s	*com;
556 	u_int		divisor;
557 	bool_t		failures[10];
558 	int		fn;
559 	device_t	idev;
560 	Port_t		iobase;
561 	intrmask_t	irqmap[4];
562 	intrmask_t	irqs;
563 	u_char		mcr_image;
564 	int		result;
565 	u_long		xirq;
566 	u_int		flags = device_get_flags(dev);
567 	int		rid;
568 	struct resource *port;
569 
570 	rid = xrid;
571 	port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
572 				  0, ~0, IO_COMSIZE, RF_ACTIVE);
573 	if (!port)
574 		return (ENXIO);
575 
576 	lwkt_gettoken(&tty_token);
577 	com = device_get_softc(dev);
578 	com->bst = rman_get_bustag(port);
579 	com->bsh = rman_get_bushandle(port);
580 	if (rclk == 0)
581 		rclk = DEFAULT_RCLK;
582 	com->rclk = rclk;
583 
584 #if 0
585 	/*
586 	 * XXX this is broken - when we are first called, there are no
587 	 * previously configured IO ports.  We could hard code
588 	 * 0x3f8, 0x2f8, 0x3e8, 0x2e8 etc but that's probably worse.
589 	 * This code has been doing nothing since the conversion since
590 	 * "count" is zero the first time around.
591 	 */
592 	if (!already_init) {
593 		/*
594 		 * Turn off MCR_IENABLE for all likely serial ports.  An unused
595 		 * port with its MCR_IENABLE gate open will inhibit interrupts
596 		 * from any used port that shares the interrupt vector.
597 		 * XXX the gate enable is elsewhere for some multiports.
598 		 */
599 		device_t *devs;
600 		int count, i, xioport;
601 
602 		devclass_get_devices(sio_devclass, &devs, &count);
603 		for (i = 0; i < count; i++) {
604 			xdev = devs[i];
605 			if (device_is_enabled(xdev) &&
606 			    bus_get_resource(xdev, SYS_RES_IOPORT, 0, &xioport,
607 					     NULL) == 0)
608 				outb(xioport + com_mcr, 0);
609 		}
610 		kfree(devs, M_TEMP);
611 		already_init = TRUE;
612 	}
613 #endif
614 
615 	if (COM_LLCONSOLE(flags)) {
616 		kprintf("sio%d: reserved for low-level i/o\n",
617 		       device_get_unit(dev));
618 		bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
619 		lwkt_reltoken(&tty_token);
620 		return (ENXIO);
621 	}
622 
623 	/*
624 	 * If the device is on a multiport card and has an AST/4
625 	 * compatible interrupt control register, initialize this
626 	 * register and prepare to leave MCR_IENABLE clear in the mcr.
627 	 * Otherwise, prepare to set MCR_IENABLE in the mcr.
628 	 * Point idev to the device struct giving the correct id_irq.
629 	 * This is the struct for the master device if there is one.
630 	 */
631 	idev = dev;
632 	mcr_image = MCR_IENABLE;
633 #ifdef COM_MULTIPORT
634 	if (COM_ISMULTIPORT(flags)) {
635 		Port_t xiobase;
636 		u_long io;
637 
638 		idev = devclass_get_device(sio_devclass, COM_MPMASTER(flags));
639 		if (idev == NULL) {
640 			kprintf("sio%d: master device %d not configured\n",
641 			       device_get_unit(dev), COM_MPMASTER(flags));
642 			idev = dev;
643 		}
644 		if (!COM_NOTAST4(flags)) {
645 			if (bus_get_resource(idev, SYS_RES_IOPORT, 0, &io,
646 					     NULL) == 0) {
647 				xiobase = io;
648 				if (bus_get_resource(idev, SYS_RES_IRQ, 0,
649 				    NULL, NULL) == 0)
650 					outb(xiobase + com_scr, 0x80);
651 				else
652 					outb(xiobase + com_scr, 0);
653 			}
654 			mcr_image = 0;
655 		}
656 	}
657 #endif /* COM_MULTIPORT */
658 	if (bus_get_resource(idev, SYS_RES_IRQ, 0, NULL, NULL) != 0)
659 		mcr_image = 0;
660 
661 	bzero(failures, sizeof failures);
662 	iobase = rman_get_start(port);
663 
664 	/*
665 	 * We don't want to get actual interrupts, just masked ones.
666 	 * Interrupts from this line should already be masked in the ICU,
667 	 * but mask them in the processor as well in case there are some
668 	 * (misconfigured) shared interrupts.
669 	 */
670 	com_lock();
671 /* EXTRA DELAY? */
672 
673 	/*
674 	 * For the TI16754 chips, set prescaler to 1 (4 is often the
675 	 * default after-reset value) as otherwise it's impossible to
676 	 * get highest baudrates.
677 	 */
678 	if (COM_TI16754(flags)) {
679 		u_char cfcr, efr;
680 
681 		cfcr = sio_getreg(com, com_cfcr);
682 		sio_setreg(com, com_cfcr, CFCR_EFR_ENABLE);
683 		efr = sio_getreg(com, com_efr);
684 		/* Unlock extended features to turn off prescaler. */
685 		sio_setreg(com, com_efr, efr | EFR_EFE);
686 		/* Disable EFR. */
687 		sio_setreg(com, com_cfcr, (cfcr != CFCR_EFR_ENABLE) ? cfcr : 0);
688 		/* Turn off prescaler. */
689 		sio_setreg(com, com_mcr,
690 			   sio_getreg(com, com_mcr) & ~MCR_PRESCALE);
691 		sio_setreg(com, com_cfcr, CFCR_EFR_ENABLE);
692 		sio_setreg(com, com_efr, efr);
693 		sio_setreg(com, com_cfcr, cfcr);
694 	}
695 
696 	/*
697 	 * Initialize the speed and the word size and wait long enough to
698 	 * drain the maximum of 16 bytes of junk in device output queues.
699 	 * The speed is undefined after a master reset and must be set
700 	 * before relying on anything related to output.  There may be
701 	 * junk after a (very fast) soft reboot and (apparently) after
702 	 * master reset.
703 	 * XXX what about the UART bug avoided by waiting in comparam()?
704 	 * We don't want to to wait long enough to drain at 2 bps.
705 	 */
706 	if (iobase == siocniobase) {
707 		DELAY((16 + 1) * 1000000 / (comdefaultrate / 10));
708 	} else {
709 		sio_setreg(com, com_cfcr, CFCR_DLAB | CFCR_8BITS);
710 		divisor = siodivisor(rclk, SIO_TEST_SPEED);
711 		sio_setreg(com, com_dlbl, divisor & 0xff);
712 		sio_setreg(com, com_dlbh, divisor >> 8);
713 		sio_setreg(com, com_cfcr, CFCR_8BITS);
714 		DELAY((16 + 1) * 1000000 / (SIO_TEST_SPEED / 10));
715 	}
716 
717 	/*
718 	 * Make sure we can drain the receiver.  If we can't, the serial
719 	 * port may not exist.
720 	 */
721 	for (fn = 0; fn < 256; ++fn) {
722 		if ((sio_getreg(com, com_lsr) & LSR_RXRDY) == 0)
723 			break;
724 		(void)sio_getreg(com, com_data);
725 	}
726 	if (fn == 256) {
727 		com_unlock();
728 		lwkt_reltoken(&tty_token);
729 		kprintf("sio%d: can't drain, serial port might "
730 			"not exist, disabling\n", device_get_unit(dev));
731 		return (ENXIO);
732 	}
733 
734 	/*
735 	 * Enable the interrupt gate and disable device interupts.  This
736 	 * should leave the device driving the interrupt line low and
737 	 * guarantee an edge trigger if an interrupt can be generated.
738 	 */
739 /* EXTRA DELAY? */
740 	sio_setreg(com, com_mcr, mcr_image);
741 	sio_setreg(com, com_ier, 0);
742 	DELAY(1000);		/* XXX */
743 	irqmap[0] = isa_irq_pending();
744 
745 	/*
746 	 * Attempt to set loopback mode so that we can send a null byte
747 	 * without annoying any external device.
748 	 */
749 /* EXTRA DELAY? */
750 	sio_setreg(com, com_mcr, mcr_image | MCR_LOOPBACK);
751 
752 	/*
753 	 * Attempt to generate an output interrupt.  On 8250's, setting
754 	 * IER_ETXRDY generates an interrupt independent of the current
755 	 * setting and independent of whether the THR is empty.  On 16450's,
756 	 * setting IER_ETXRDY generates an interrupt independent of the
757 	 * current setting.  On 16550A's, setting IER_ETXRDY only
758 	 * generates an interrupt when IER_ETXRDY is not already set.
759 	 */
760 	sio_setreg(com, com_ier, IER_ETXRDY);
761 
762 	/*
763 	 * On some 16x50 incompatibles, setting IER_ETXRDY doesn't generate
764 	 * an interrupt.  They'd better generate one for actually doing
765 	 * output.  Loopback may be broken on the same incompatibles but
766 	 * it's unlikely to do more than allow the null byte out.
767 	 */
768 	sio_setreg(com, com_data, 0);
769 	DELAY((1 + 2) * 1000000 / (SIO_TEST_SPEED / 10));
770 
771 	/*
772 	 * Turn off loopback mode so that the interrupt gate works again
773 	 * (MCR_IENABLE was hidden).  This should leave the device driving
774 	 * an interrupt line high.  It doesn't matter if the interrupt
775 	 * line oscillates while we are not looking at it, since interrupts
776 	 * are disabled.
777 	 */
778 /* EXTRA DELAY? */
779 	sio_setreg(com, com_mcr, mcr_image);
780 
781 	/*
782 	 * Some pcmcia cards have the "TXRDY bug", so we check everyone
783 	 * for IIR_TXRDY implementation ( Palido 321s, DC-1S... )
784 	 */
785 	if (COM_NOPROBE(flags)) {
786 		/* Reading IIR register twice */
787 		for (fn = 0; fn < 2; fn ++) {
788 			DELAY(10000);
789 			failures[6] = sio_getreg(com, com_iir);
790 		}
791 		/* Check IIR_TXRDY clear ? */
792 		result = 0;
793 		if (failures[6] & IIR_TXRDY) {
794 			/* Nop, Double check with clearing IER */
795 			sio_setreg(com, com_ier, 0);
796 			if (sio_getreg(com, com_iir) & IIR_NOPEND) {
797 				/* Ok. we're familia this gang */
798 				SET_FLAG(dev, COM_C_IIR_TXRDYBUG);
799 			} else {
800 				/* Unknown, Just omit this chip.. XXX */
801 				result = ENXIO;
802 				sio_setreg(com, com_mcr, 0);
803 			}
804 		} else {
805 			/* OK. this is well-known guys */
806 			CLR_FLAG(dev, COM_C_IIR_TXRDYBUG);
807 		}
808 		sio_setreg(com, com_ier, 0);
809 		sio_setreg(com, com_cfcr, CFCR_8BITS);
810 		com_unlock();
811 		bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
812 		lwkt_reltoken(&tty_token);
813 		return (iobase == siocniobase ? 0 : result);
814 	}
815 
816 	/*
817 	 * Check that
818 	 *	o the CFCR, IER and MCR in UART hold the values written to them
819 	 *	  (the values happen to be all distinct - this is good for
820 	 *	  avoiding false positive tests from bus echoes).
821 	 *	o an output interrupt is generated and its vector is correct.
822 	 *	o the interrupt goes away when the IIR in the UART is read.
823 	 */
824 /* EXTRA DELAY? */
825 	failures[0] = sio_getreg(com, com_cfcr) - CFCR_8BITS;
826 	failures[1] = sio_getreg(com, com_ier) - IER_ETXRDY;
827 	failures[2] = sio_getreg(com, com_mcr) - mcr_image;
828 	DELAY(10000);		/* Some internal modems need this time */
829 	irqmap[1] = isa_irq_pending();
830 	failures[4] = (sio_getreg(com, com_iir) & IIR_IMASK) - IIR_TXRDY;
831 	DELAY(1000);		/* XXX */
832 	irqmap[2] = isa_irq_pending();
833 	failures[6] = (sio_getreg(com, com_iir) & IIR_IMASK) - IIR_NOPEND;
834 
835 	/*
836 	 * Turn off all device interrupts and check that they go off properly.
837 	 * Leave MCR_IENABLE alone.  For ports without a master port, it gates
838 	 * the OUT2 output of the UART to
839 	 * the ICU input.  Closing the gate would give a floating ICU input
840 	 * (unless there is another device driving it) and spurious interrupts.
841 	 * (On the system that this was first tested on, the input floats high
842 	 * and gives a (masked) interrupt as soon as the gate is closed.)
843 	 */
844 	sio_setreg(com, com_ier, 0);
845 	sio_setreg(com, com_cfcr, CFCR_8BITS);	/* dummy to avoid bus echo */
846 	failures[7] = sio_getreg(com, com_ier);
847 	DELAY(1000);		/* XXX */
848 	irqmap[3] = isa_irq_pending();
849 	failures[9] = (sio_getreg(com, com_iir) & IIR_IMASK) - IIR_NOPEND;
850 
851 	com_unlock();
852 
853 	irqs = irqmap[1] & ~irqmap[0];
854 	if (bus_get_resource(idev, SYS_RES_IRQ, 0, &xirq, NULL) == 0 &&
855 	    ((1 << xirq) & irqs) == 0)
856 		kprintf(
857 		"sio%d: configured irq %ld not in bitmap of probed irqs %#x\n",
858 		    device_get_unit(dev), xirq, irqs);
859 	if (bootverbose)
860 		kprintf("sio%d: irq maps: %#x %#x %#x %#x\n",
861 		    device_get_unit(dev),
862 		    irqmap[0], irqmap[1], irqmap[2], irqmap[3]);
863 
864 	result = 0;
865 	for (fn = 0; fn < sizeof failures; ++fn)
866 		if (failures[fn]) {
867 			sio_setreg(com, com_mcr, 0);
868 			result = ENXIO;
869 			if (bootverbose) {
870 				kprintf("sio%d: probe failed test(s):",
871 				    device_get_unit(dev));
872 				for (fn = 0; fn < sizeof failures; ++fn)
873 					if (failures[fn])
874 						kprintf(" %d", fn);
875 				kprintf("\n");
876 			}
877 			break;
878 		}
879 	bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
880 	lwkt_reltoken(&tty_token);
881 	return (iobase == siocniobase ? 0 : result);
882 }
883 
884 #ifdef COM_ESP
885 static int
886 espattach(struct com_s *com, Port_t esp_port)
887 {
888 	u_char	dips;
889 	u_char	val;
890 
891 	/*
892 	 * Check the ESP-specific I/O port to see if we're an ESP
893 	 * card.  If not, return failure immediately.
894 	 */
895 	if ((inb(esp_port) & 0xf3) == 0) {
896 		kprintf(" port 0x%x is not an ESP board?\n", esp_port);
897 		return (0);
898 	}
899 
900 	lwkt_gettoken(&tty_token);
901 	/*
902 	 * We've got something that claims to be a Hayes ESP card.
903 	 * Let's hope so.
904 	 */
905 
906 	/* Get the dip-switch configuration */
907 	outb(esp_port + ESP_CMD1, ESP_GETDIPS);
908 	dips = inb(esp_port + ESP_STATUS1);
909 
910 	/*
911 	 * Bits 0,1 of dips say which COM port we are.
912 	 */
913 	if (rman_get_start(com->ioportres) == likely_com_ports[dips & 0x03])
914 		kprintf(" : ESP");
915 	else {
916 		kprintf(" esp_port has com %d\n", dips & 0x03);
917 		lwkt_reltoken(&tty_token);
918 		return (0);
919 	}
920 
921 	/*
922 	 * Check for ESP version 2.0 or later:  bits 4,5,6 = 010.
923 	 */
924 	outb(esp_port + ESP_CMD1, ESP_GETTEST);
925 	val = inb(esp_port + ESP_STATUS1);	/* clear reg 1 */
926 	val = inb(esp_port + ESP_STATUS2);
927 	if ((val & 0x70) < 0x20) {
928 		kprintf("-old (%o)", val & 0x70);
929 		lwkt_reltoken(&tty_token);
930 		return (0);
931 	}
932 
933 	/*
934 	 * Check for ability to emulate 16550:  bit 7 == 1
935 	 */
936 	if ((dips & 0x80) == 0) {
937 		kprintf(" slave");
938 		lwkt_reltoken(&tty_token);
939 		return (0);
940 	}
941 
942 	/*
943 	 * Okay, we seem to be a Hayes ESP card.  Whee.
944 	 */
945 	com->esp = TRUE;
946 	com->esp_port = esp_port;
947 	lwkt_reltoken(&tty_token);
948 	return (1);
949 }
950 #endif /* COM_ESP */
951 
952 static int
953 sio_isa_attach(device_t dev)
954 {
955 	return (sioattach(dev, 0, 0UL));
956 }
957 
958 int
959 sioattach(device_t dev, int xrid, u_long rclk)
960 {
961 	struct com_s	*com;
962 #ifdef COM_ESP
963 	Port_t		*espp;
964 #endif
965 	Port_t		iobase;
966 	int		minorbase;
967 	int		unit;
968 	u_int		flags;
969 	int		rid;
970 	struct resource *port;
971 	int		ret;
972 	static int	did_init;
973 
974 	lwkt_gettoken(&tty_token);
975 	if (did_init == 0) {
976 		did_init = 1;
977 		callout_init_mp(&sio_timeout_handle);
978 	}
979 
980 	rid = xrid;
981 	port = bus_alloc_resource(dev, SYS_RES_IOPORT, &rid,
982 				  0, ~0, IO_COMSIZE, RF_ACTIVE);
983 	if (!port) {
984 		lwkt_reltoken(&tty_token);
985 		return (ENXIO);
986 	}
987 
988 	iobase = rman_get_start(port);
989 	unit = device_get_unit(dev);
990 	com = device_get_softc(dev);
991 	flags = device_get_flags(dev);
992 
993 	if (unit >= sio_numunits)
994 		sio_numunits = unit + 1;
995 	/*
996 	 * sioprobe() has initialized the device registers as follows:
997 	 *	o cfcr = CFCR_8BITS.
998 	 *	  It is most important that CFCR_DLAB is off, so that the
999 	 *	  data port is not hidden when we enable interrupts.
1000 	 *	o ier = 0.
1001 	 *	  Interrupts are only enabled when the line is open.
1002 	 *	o mcr = MCR_IENABLE, or 0 if the port has AST/4 compatible
1003 	 *	  interrupt control register or the config specifies no irq.
1004 	 *	  Keeping MCR_DTR and MCR_RTS off might stop the external
1005 	 *	  device from sending before we are ready.
1006 	 */
1007 	bzero(com, sizeof *com);
1008 	com->unit = unit;
1009 	com->ioportres = port;
1010 	com->bst = rman_get_bustag(port);
1011 	com->bsh = rman_get_bushandle(port);
1012 	com->cfcr_image = CFCR_8BITS;
1013 	com->dtr_wait = 3 * hz;
1014 	callout_init_mp(&com->dtr_ch);
1015 	callout_init_mp(&com->busy_ch);
1016 	com->loses_outints = COM_LOSESOUTINTS(flags) != 0;
1017 	com->no_irq = bus_get_resource(dev, SYS_RES_IRQ, 0, NULL, NULL) != 0;
1018 	com->tx_fifo_size = 1;
1019 	com->obufs[0].l_head = com->obuf1;
1020 	com->obufs[1].l_head = com->obuf2;
1021 
1022 	com->data_port = iobase + com_data;
1023 	com->int_id_port = iobase + com_iir;
1024 	com->modem_ctl_port = iobase + com_mcr;
1025 	com->mcr_image = inb(com->modem_ctl_port);
1026 	com->line_status_port = iobase + com_lsr;
1027 	com->modem_status_port = iobase + com_msr;
1028 	com->intr_ctl_port = iobase + com_ier;
1029 
1030 	if (rclk == 0)
1031 		rclk = DEFAULT_RCLK;
1032 	com->rclk = rclk;
1033 
1034 	/*
1035 	 * We don't use all the flags from <sys/ttydefaults.h> since they
1036 	 * are only relevant for logins.  It's important to have echo off
1037 	 * initially so that the line doesn't start blathering before the
1038 	 * echo flag can be turned off.
1039 	 */
1040 	com->it_in.c_iflag = 0;
1041 	com->it_in.c_oflag = 0;
1042 	com->it_in.c_cflag = TTYDEF_CFLAG;
1043 	com->it_in.c_lflag = 0;
1044 	if (unit == comconsole) {
1045 		com->it_in.c_iflag = TTYDEF_IFLAG;
1046 		com->it_in.c_oflag = TTYDEF_OFLAG;
1047 		com->it_in.c_cflag = TTYDEF_CFLAG | CLOCAL;
1048 		com->it_in.c_lflag = TTYDEF_LFLAG;
1049 		com->lt_out.c_cflag = com->lt_in.c_cflag = CLOCAL;
1050 		com->lt_out.c_ispeed = com->lt_out.c_ospeed =
1051 		com->lt_in.c_ispeed = com->lt_in.c_ospeed =
1052 		com->it_in.c_ispeed = com->it_in.c_ospeed = comdefaultrate;
1053 	} else
1054 		com->it_in.c_ispeed = com->it_in.c_ospeed = TTYDEF_SPEED;
1055 	if (siosetwater(com, com->it_in.c_ispeed) != 0) {
1056 		/*
1057 		 * Leave i/o resources allocated if this is a `cn'-level
1058 		 * console, so that other devices can't snarf them.
1059 		 */
1060 		if (iobase != siocniobase)
1061 			bus_release_resource(dev, SYS_RES_IOPORT, rid, port);
1062 		lwkt_reltoken(&tty_token);
1063 		return (ENOMEM);
1064 	}
1065 	termioschars(&com->it_in);
1066 	com->it_out = com->it_in;
1067 
1068 	/* attempt to determine UART type */
1069 	kprintf("sio%d: type", unit);
1070 
1071 
1072 #ifdef COM_MULTIPORT
1073 	if (!COM_ISMULTIPORT(flags) && !COM_IIR_TXRDYBUG(flags))
1074 #else
1075 	if (!COM_IIR_TXRDYBUG(flags))
1076 #endif
1077 	{
1078 		u_char	scr;
1079 		u_char	scr1;
1080 		u_char	scr2;
1081 
1082 		scr = sio_getreg(com, com_scr);
1083 		sio_setreg(com, com_scr, 0xa5);
1084 		scr1 = sio_getreg(com, com_scr);
1085 		sio_setreg(com, com_scr, 0x5a);
1086 		scr2 = sio_getreg(com, com_scr);
1087 		sio_setreg(com, com_scr, scr);
1088 		if (scr1 != 0xa5 || scr2 != 0x5a) {
1089 			kprintf(" 8250");
1090 			goto determined_type;
1091 		}
1092 	}
1093 	sio_setreg(com, com_fifo, FIFO_ENABLE | FIFO_RX_HIGH);
1094 	DELAY(100);
1095 	com->st16650a = 0;
1096 	switch (inb(com->int_id_port) & IIR_FIFO_MASK) {
1097 	case FIFO_RX_LOW:
1098 		kprintf(" 16450");
1099 		break;
1100 	case FIFO_RX_MEDL:
1101 		kprintf(" 16450?");
1102 		break;
1103 	case FIFO_RX_MEDH:
1104 		kprintf(" 16550?");
1105 		break;
1106 	case FIFO_RX_HIGH:
1107 		if (COM_NOFIFO(flags)) {
1108 			kprintf(" 16550A fifo disabled");
1109 		} else {
1110 			com->hasfifo = TRUE;
1111 			if (COM_ST16650A(flags)) {
1112 				com->st16650a = 1;
1113 				com->tx_fifo_size = 32;
1114 				kprintf(" ST16650A");
1115 			} else if (COM_TI16754(flags)) {
1116 				com->tx_fifo_size = 64;
1117 				kprintf(" TI16754");
1118 			} else {
1119 				com->tx_fifo_size = COM_FIFOSIZE(flags);
1120 				kprintf(" 16550A");
1121 			}
1122 		}
1123 #ifdef COM_ESP
1124 		for (espp = likely_esp_ports; *espp != 0; espp++)
1125 			if (espattach(com, *espp)) {
1126 				com->tx_fifo_size = 1024;
1127 				break;
1128 			}
1129 #endif
1130 		if (!com->st16650a && !COM_TI16754(flags)) {
1131 			if (!com->tx_fifo_size)
1132 				com->tx_fifo_size = 16;
1133 			else
1134 				kprintf(" lookalike with %d bytes FIFO",
1135 				    com->tx_fifo_size);
1136 		}
1137 
1138 		break;
1139 	}
1140 
1141 #ifdef COM_ESP
1142 	if (com->esp) {
1143 		/*
1144 		 * Set 16550 compatibility mode.
1145 		 * We don't use the ESP_MODE_SCALE bit to increase the
1146 		 * fifo trigger levels because we can't handle large
1147 		 * bursts of input.
1148 		 * XXX flow control should be set in comparam(), not here.
1149 		 */
1150 		outb(com->esp_port + ESP_CMD1, ESP_SETMODE);
1151 		outb(com->esp_port + ESP_CMD2, ESP_MODE_RTS | ESP_MODE_FIFO);
1152 
1153 		/* Set RTS/CTS flow control. */
1154 		outb(com->esp_port + ESP_CMD1, ESP_SETFLOWTYPE);
1155 		outb(com->esp_port + ESP_CMD2, ESP_FLOW_RTS);
1156 		outb(com->esp_port + ESP_CMD2, ESP_FLOW_CTS);
1157 
1158 		/* Set flow-control levels. */
1159 		outb(com->esp_port + ESP_CMD1, ESP_SETRXFLOW);
1160 		outb(com->esp_port + ESP_CMD2, HIBYTE(768));
1161 		outb(com->esp_port + ESP_CMD2, LOBYTE(768));
1162 		outb(com->esp_port + ESP_CMD2, HIBYTE(512));
1163 		outb(com->esp_port + ESP_CMD2, LOBYTE(512));
1164 	}
1165 #endif /* COM_ESP */
1166 	sio_setreg(com, com_fifo, 0);
1167 determined_type: ;
1168 
1169 #ifdef COM_MULTIPORT
1170 	if (COM_ISMULTIPORT(flags)) {
1171 		device_t masterdev;
1172 
1173 		com->multiport = TRUE;
1174 		kprintf(" (multiport");
1175 		if (unit == COM_MPMASTER(flags))
1176 			kprintf(" master");
1177 		kprintf(")");
1178 		masterdev = devclass_get_device(sio_devclass,
1179 		    COM_MPMASTER(flags));
1180 		com->no_irq = (masterdev == NULL || bus_get_resource(masterdev,
1181 		    SYS_RES_IRQ, 0, NULL, NULL) != 0);
1182 	 }
1183 #endif /* COM_MULTIPORT */
1184 	if (unit == comconsole)
1185 		kprintf(", console");
1186 	if (COM_IIR_TXRDYBUG(flags))
1187 		kprintf(" with a bogus IIR_TXRDY register");
1188 	kprintf("\n");
1189 
1190 	if (!sio_registered) {
1191 		register_swi(SWI_TTY, siopoll, NULL ,"swi_siopoll", NULL, -1);
1192 		sio_registered = TRUE;
1193 	}
1194 	minorbase = UNIT_TO_MINOR(unit);
1195 	make_dev(&sio_ops, minorbase,
1196 	    UID_ROOT, GID_WHEEL, 0600, "ttyd%r", unit);
1197 	make_dev(&sio_ops, minorbase | CONTROL_INIT_STATE,
1198 	    UID_ROOT, GID_WHEEL, 0600, "ttyid%r", unit);
1199 	make_dev(&sio_ops, minorbase | CONTROL_LOCK_STATE,
1200 	    UID_ROOT, GID_WHEEL, 0600, "ttyld%r", unit);
1201 	make_dev(&sio_ops, minorbase | CALLOUT_MASK,
1202 	    UID_UUCP, GID_DIALER, 0660, "cuaa%r", unit);
1203 	make_dev(&sio_ops, minorbase | CALLOUT_MASK | CONTROL_INIT_STATE,
1204 	    UID_UUCP, GID_DIALER, 0660, "cuaia%r", unit);
1205 	make_dev(&sio_ops, minorbase | CALLOUT_MASK | CONTROL_LOCK_STATE,
1206 	    UID_UUCP, GID_DIALER, 0660, "cuala%r", unit);
1207 	com->flags = flags;
1208 	com->pps.ppscap = PPS_CAPTUREASSERT | PPS_CAPTURECLEAR;
1209 	pps_init(&com->pps);
1210 
1211 	rid = 0;
1212 	com->irqres = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0ul, ~0ul, 1,
1213 	    RF_ACTIVE);
1214 	if (com->irqres) {
1215 		ret = BUS_SETUP_INTR(device_get_parent(dev), dev,
1216 				     com->irqres, INTR_MPSAFE, siointr, com,
1217 				     &com->cookie, NULL, NULL);
1218 		if (ret)
1219 			device_printf(dev, "could not activate interrupt\n");
1220 #if defined(DDB)
1221 		/*
1222 		 * Enable interrupts for early break-to-debugger support
1223 		 * on the console.
1224 		 */
1225 		if (ret == 0 && unit == comconsole &&
1226 		    (break_to_debugger || alt_break_to_debugger)) {
1227 			inb(siocniobase + com_data);
1228 			outb(siocniobase + com_ier,
1229 			     IER_ERXRDY | IER_ERLS | IER_EMSC);
1230 		}
1231 #endif
1232 	}
1233 
1234 	lwkt_reltoken(&tty_token);
1235 	return (0);
1236 }
1237 
1238 static int
1239 sioopen(struct dev_open_args *ap)
1240 {
1241 	cdev_t dev = ap->a_head.a_dev;
1242 	struct com_s	*com;
1243 	int		error;
1244 	int		mynor;
1245 	struct tty	*tp;
1246 	int		unit;
1247 
1248 	mynor = minor(dev);
1249 	unit = MINOR_TO_UNIT(mynor);
1250 	com = com_addr(unit);
1251 	if (com == NULL)
1252 		return (ENXIO);
1253 	if (com->gone)
1254 		return (ENXIO);
1255 	if (mynor & CONTROL_MASK)
1256 		return (0);
1257 	lwkt_gettoken(&tty_token);
1258 	tp = dev->si_tty = com->tp = ttymalloc(com->tp);
1259 	crit_enter();
1260 	/*
1261 	 * We jump to this label after all non-interrupted sleeps to pick
1262 	 * up any changes of the device state.
1263 	 */
1264 open_top:
1265 	while (com->state & CS_DTR_OFF) {
1266 		error = tsleep(&com->dtr_wait, PCATCH, "siodtr", 0);
1267 		if (com_addr(unit) == NULL) {
1268 			crit_exit();
1269 			lwkt_reltoken(&tty_token);
1270 			return (ENXIO);
1271 		}
1272 		if (error != 0 || com->gone)
1273 			goto out;
1274 	}
1275 	if (tp->t_state & TS_ISOPEN) {
1276 		/*
1277 		 * The device is open, so everything has been initialized.
1278 		 * Handle conflicts.
1279 		 */
1280 		if (mynor & CALLOUT_MASK) {
1281 			if (!com->active_out) {
1282 				error = EBUSY;
1283 				goto out;
1284 			}
1285 		} else {
1286 			if (com->active_out) {
1287 				if (ap->a_oflags & O_NONBLOCK) {
1288 					error = EBUSY;
1289 					goto out;
1290 				}
1291 				error =	tsleep(&com->active_out,
1292 					       PCATCH, "siobi", 0);
1293 				if (com_addr(unit) == NULL) {
1294 					crit_exit();
1295 					lwkt_reltoken(&tty_token);
1296 					return (ENXIO);
1297 				}
1298 				if (error != 0 || com->gone)
1299 					goto out;
1300 				goto open_top;
1301 			}
1302 		}
1303 		if (tp->t_state & TS_XCLUDE && priv_check_cred(ap->a_cred, PRIV_ROOT, 0)) {
1304 			error = EBUSY;
1305 			goto out;
1306 		}
1307 	} else {
1308 		/*
1309 		 * The device isn't open, so there are no conflicts.
1310 		 * Initialize it.  Initialization is done twice in many
1311 		 * cases: to preempt sleeping callin opens if we are
1312 		 * callout, and to complete a callin open after DCD rises.
1313 		 */
1314 		tp->t_oproc = comstart;
1315 		tp->t_param = comparam;
1316 		tp->t_stop = comstop;
1317 		tp->t_dev = dev;
1318 		tp->t_termios = mynor & CALLOUT_MASK
1319 				? com->it_out : com->it_in;
1320 		(void)commctl(com, TIOCM_DTR | TIOCM_RTS, DMSET);
1321 		com->poll = com->no_irq;
1322 		com->poll_output = com->loses_outints;
1323 		++com->wopeners;
1324 		error = comparam(tp, &tp->t_termios);
1325 		--com->wopeners;
1326 		if (error != 0)
1327 			goto out;
1328 		/*
1329 		 * XXX we should goto open_top if comparam() slept.
1330 		 */
1331 		if (com->hasfifo) {
1332 			/*
1333 			 * (Re)enable and drain fifos.
1334 			 *
1335 			 * Certain SMC chips cause problems if the fifos
1336 			 * are enabled while input is ready.  Turn off the
1337 			 * fifo if necessary to clear the input.  We test
1338 			 * the input ready bit after enabling the fifos
1339 			 * since we've already enabled them in comparam()
1340 			 * and to handle races between enabling and fresh
1341 			 * input.
1342 			 */
1343 			while (TRUE) {
1344 				sio_setreg(com, com_fifo,
1345 					   FIFO_RCV_RST | FIFO_XMT_RST
1346 					   | com->fifo_image);
1347 				/*
1348 				 * XXX the delays are for superstitious
1349 				 * historical reasons.  It must be less than
1350 				 * the character time at the maximum
1351 				 * supported speed (87 usec at 115200 bps
1352 				 * 8N1).  Otherwise we might loop endlessly
1353 				 * if data is streaming in.  We used to use
1354 				 * delays of 100.  That usually worked
1355 				 * because DELAY(100) used to usually delay
1356 				 * for about 85 usec instead of 100.
1357 				 */
1358 				DELAY(50);
1359 				if (!(inb(com->line_status_port) & LSR_RXRDY))
1360 					break;
1361 				sio_setreg(com, com_fifo, 0);
1362 				DELAY(50);
1363 				(void) inb(com->data_port);
1364 			}
1365 		}
1366 
1367 		com_lock();
1368 		(void) inb(com->line_status_port);
1369 		(void) inb(com->data_port);
1370 		com->prev_modem_status = com->last_modem_status
1371 		    = inb(com->modem_status_port);
1372 		if (COM_IIR_TXRDYBUG(com->flags)) {
1373 			outb(com->intr_ctl_port, IER_ERXRDY | IER_ERLS
1374 						| IER_EMSC);
1375 		} else {
1376 			outb(com->intr_ctl_port, IER_ERXRDY | IER_ETXRDY
1377 						| IER_ERLS | IER_EMSC);
1378 		}
1379 		com_unlock();
1380 		/*
1381 		 * Handle initial DCD.  Callout devices get a fake initial
1382 		 * DCD (trapdoor DCD).  If we are callout, then any sleeping
1383 		 * callin opens get woken up and resume sleeping on "siobi"
1384 		 * instead of "siodcd".
1385 		 */
1386 		/*
1387 		 * XXX `mynor & CALLOUT_MASK' should be
1388 		 * `tp->t_cflag & (SOFT_CARRIER | TRAPDOOR_CARRIER) where
1389 		 * TRAPDOOR_CARRIER is the default initial state for callout
1390 		 * devices and SOFT_CARRIER is like CLOCAL except it hides
1391 		 * the true carrier.
1392 		 */
1393 		if (com->prev_modem_status & MSR_DCD || mynor & CALLOUT_MASK)
1394 			(*linesw[tp->t_line].l_modem)(tp, 1);
1395 	}
1396 	/*
1397 	 * Wait for DCD if necessary.
1398 	 */
1399 	if (!(tp->t_state & TS_CARR_ON) && !(mynor & CALLOUT_MASK)
1400 	    && !(tp->t_cflag & CLOCAL) && !(ap->a_oflags & O_NONBLOCK)) {
1401 		++com->wopeners;
1402 		error = tsleep(TSA_CARR_ON(tp), PCATCH, "siodcd", 0);
1403 		if (com_addr(unit) == NULL) {
1404 			crit_exit();
1405 			lwkt_reltoken(&tty_token);
1406 			return (ENXIO);
1407 		}
1408 		--com->wopeners;
1409 		if (error != 0 || com->gone)
1410 			goto out;
1411 		goto open_top;
1412 	}
1413 	error =	(*linesw[tp->t_line].l_open)(dev, tp);
1414 	disc_optim(tp, &tp->t_termios, com);
1415 	if (tp->t_state & TS_ISOPEN && mynor & CALLOUT_MASK)
1416 		com->active_out = TRUE;
1417 	siosettimeout();
1418 out:
1419 	crit_exit();
1420 	if (!(tp->t_state & TS_ISOPEN) && com->wopeners == 0)
1421 		comhardclose(com);
1422 	lwkt_reltoken(&tty_token);
1423 	return (error);
1424 }
1425 
1426 static int
1427 sioclose(struct dev_close_args *ap)
1428 {
1429 	cdev_t dev = ap->a_head.a_dev;
1430 	struct com_s	*com;
1431 	int		mynor;
1432 	struct tty	*tp;
1433 
1434 	mynor = minor(dev);
1435 	if (mynor & CONTROL_MASK)
1436 		return (0);
1437 	lwkt_gettoken(&tty_token);
1438 	com = com_addr(MINOR_TO_UNIT(mynor));
1439 	if (com == NULL) {
1440 		lwkt_reltoken(&tty_token);
1441 		return (ENODEV);
1442 	}
1443 	tp = com->tp;
1444 	crit_enter();
1445 	(*linesw[tp->t_line].l_close)(tp, ap->a_fflag);
1446 	disc_optim(tp, &tp->t_termios, com);
1447 	comstop(tp, FREAD | FWRITE);
1448 	comhardclose(com);
1449 	ttyclose(tp);
1450 	siosettimeout();
1451 	crit_exit();
1452 	if (com->gone) {
1453 		kprintf("sio%d: gone\n", com->unit);
1454 		crit_enter();
1455 		if (com->ibuf != NULL)
1456 			kfree(com->ibuf, M_DEVBUF);
1457 		bzero(tp, sizeof *tp);
1458 		crit_exit();
1459 	}
1460 	lwkt_reltoken(&tty_token);
1461 	return (0);
1462 }
1463 
1464 static void
1465 comhardclose(struct com_s *com)
1466 {
1467 	struct tty	*tp;
1468 	crit_enter();
1469 	lwkt_gettoken(&tty_token);
1470 	com->poll = FALSE;
1471 	com->poll_output = FALSE;
1472 	com->do_timestamp = FALSE;
1473 	com->do_dcd_timestamp = FALSE;
1474 	com->pps.ppsparam.mode = 0;
1475 	sio_setreg(com, com_cfcr, com->cfcr_image &= ~CFCR_SBREAK);
1476 	tp = com->tp;
1477 
1478 #if defined(DDB)
1479 	/*
1480 	 * Leave interrupts enabled and don't clear DTR if this is the
1481 	 * console. This allows us to detect break-to-debugger events
1482 	 * while the console device is closed.
1483 	 */
1484 	if (com->unit != comconsole ||
1485 	    (break_to_debugger == 0 && alt_break_to_debugger == 0))
1486 #endif
1487 	{
1488 		sio_setreg(com, com_ier, 0);
1489 		if (tp->t_cflag & HUPCL
1490 		    /*
1491 		     * XXX we will miss any carrier drop between here and the
1492 		     * next open.  Perhaps we should watch DCD even when the
1493 		     * port is closed; it is not sufficient to check it at
1494 		     * the next open because it might go up and down while
1495 		     * we're not watching.
1496 		     */
1497 		    || (!com->active_out
1498 		        && !(com->prev_modem_status & MSR_DCD)
1499 		        && !(com->it_in.c_cflag & CLOCAL))
1500 		    || !(tp->t_state & TS_ISOPEN)) {
1501 			(void)commctl(com, TIOCM_DTR, DMBIC);
1502 			if (com->dtr_wait != 0 && !(com->state & CS_DTR_OFF)) {
1503 				callout_reset(&com->dtr_ch, com->dtr_wait,
1504 						siodtrwakeup, com);
1505 				com->state |= CS_DTR_OFF;
1506 			}
1507 		}
1508 	}
1509 	if (com->hasfifo) {
1510 		/*
1511 		 * Disable fifos so that they are off after controlled
1512 		 * reboots.  Some BIOSes fail to detect 16550s when the
1513 		 * fifos are enabled.
1514 		 */
1515 		sio_setreg(com, com_fifo, 0);
1516 	}
1517 	com->active_out = FALSE;
1518 	wakeup(&com->active_out);
1519 	wakeup(TSA_CARR_ON(tp));	/* restart any wopeners */
1520 	lwkt_reltoken(&tty_token);
1521 	crit_exit();
1522 }
1523 
1524 static int
1525 sioread(struct dev_read_args *ap)
1526 {
1527 	cdev_t dev = ap->a_head.a_dev;
1528 	int		mynor, ret;
1529 	struct com_s	*com;
1530 
1531 	lwkt_gettoken(&tty_token);
1532 	mynor = minor(dev);
1533 	if (mynor & CONTROL_MASK) {
1534 		lwkt_reltoken(&tty_token);
1535 		return (ENODEV);
1536 	}
1537 	com = com_addr(MINOR_TO_UNIT(mynor));
1538 	if (com == NULL || com->gone) {
1539 		lwkt_reltoken(&tty_token);
1540 		return (ENODEV);
1541 	}
1542 	ret = ((*linesw[com->tp->t_line].l_read)(com->tp, ap->a_uio, ap->a_ioflag));
1543 	lwkt_reltoken(&tty_token);
1544 	return ret;
1545 }
1546 
1547 static int
1548 siowrite(struct dev_write_args *ap)
1549 {
1550 	cdev_t dev = ap->a_head.a_dev;
1551 	int		mynor;
1552 	struct com_s	*com;
1553 	int		unit, ret;
1554 
1555 	lwkt_gettoken(&tty_token);
1556 	mynor = minor(dev);
1557 	if (mynor & CONTROL_MASK) {
1558 		lwkt_reltoken(&tty_token);
1559 		return (ENODEV);
1560 	}
1561 
1562 	unit = MINOR_TO_UNIT(mynor);
1563 	com = com_addr(unit);
1564 	if (com == NULL || com->gone) {
1565 		lwkt_reltoken(&tty_token);
1566 		return (ENODEV);
1567 	}
1568 	/*
1569 	 * (XXX) We disallow virtual consoles if the physical console is
1570 	 * a serial port.  This is in case there is a display attached that
1571 	 * is not the console.  In that situation we don't need/want the X
1572 	 * server taking over the console.
1573 	 */
1574 	if (constty != NULL && unit == comconsole)
1575 		constty = NULL;
1576 	ret = ((*linesw[com->tp->t_line].l_write)(com->tp, ap->a_uio, ap->a_ioflag));
1577 	lwkt_reltoken(&tty_token);
1578 	return ret;
1579 }
1580 
1581 static void
1582 siobusycheck(void *chan)
1583 {
1584 	struct com_s	*com;
1585 
1586 	lwkt_gettoken(&tty_token);
1587 	com = (struct com_s *)chan;
1588 
1589 	/*
1590 	 * Clear TS_BUSY if low-level output is complete.
1591 	 * spl locking is sufficient because siointr1() does not set CS_BUSY.
1592 	 * If siointr1() clears CS_BUSY after we look at it, then we'll get
1593 	 * called again.  Reading the line status port outside of siointr1()
1594 	 * is safe because CS_BUSY is clear so there are no output interrupts
1595 	 * to lose.
1596 	 */
1597 	crit_enter();
1598 	if (com->state & CS_BUSY)
1599 		com->extra_state &= ~CSE_BUSYCHECK;	/* False alarm. */
1600 	else if ((inb(com->line_status_port) & (LSR_TSRE | LSR_TXRDY))
1601 	    == (LSR_TSRE | LSR_TXRDY)) {
1602 		com->tp->t_state &= ~TS_BUSY;
1603 		ttwwakeup(com->tp);
1604 		com->extra_state &= ~CSE_BUSYCHECK;
1605 	} else {
1606 		callout_reset(&com->busy_ch, hz / 100, siobusycheck, com);
1607 	}
1608 	crit_exit();
1609 	lwkt_reltoken(&tty_token);
1610 }
1611 
1612 static u_int
1613 siodivisor(u_long rclk, speed_t speed)
1614 {
1615 	long	actual_speed;
1616 	u_int	divisor;
1617 	int	error;
1618 
1619 	if (speed == 0 || speed > ((speed_t)-1 - 1) / 8)
1620 		return (0);
1621 	divisor = (rclk / (8UL * speed) + 1) / 2;
1622 	if (divisor == 0 || divisor >= 65536)
1623 		return (0);
1624 	actual_speed = rclk / (16UL * divisor);
1625 
1626 	/* 10 times error in percent: */
1627 	error = ((actual_speed - (long)speed) * 2000 / (long)speed + 1) / 2;
1628 
1629 	/* 3.0% maximum error tolerance: */
1630 	if (error < -30 || error > 30)
1631 		return (0);
1632 
1633 	return (divisor);
1634 }
1635 
1636 static void
1637 siodtrwakeup(void *chan)
1638 {
1639 	struct com_s	*com;
1640 
1641 	lwkt_gettoken(&tty_token);
1642 	com = (struct com_s *)chan;
1643 	com->state &= ~CS_DTR_OFF;
1644 	wakeup(&com->dtr_wait);
1645 	lwkt_reltoken(&tty_token);
1646 }
1647 
1648 /*
1649  * NOTE: Normally called with tty_token held but might not be when
1650  *	 operating as the console.
1651  *
1652  *	 Must be called with com_lock
1653  */
1654 static void
1655 sioinput(struct com_s *com)
1656 {
1657 	u_char		*buf;
1658 	int		incc;
1659 	u_char		line_status;
1660 	int		recv_data;
1661 	struct tty	*tp;
1662 
1663 	buf = com->ibuf;
1664 	tp = com->tp;
1665 	if (!(tp->t_state & TS_ISOPEN) || !(tp->t_cflag & CREAD)) {
1666 		com_events -= (com->iptr - com->ibuf);
1667 		com->iptr = com->ibuf;
1668 		return;
1669 	}
1670 	if (tp->t_state & TS_CAN_BYPASS_L_RINT) {
1671 		/*
1672 		 * Avoid the grotesquely inefficient lineswitch routine
1673 		 * (ttyinput) in "raw" mode.  It usually takes about 450
1674 		 * instructions (that's without canonical processing or echo!).
1675 		 * slinput is reasonably fast (usually 40 instructions plus
1676 		 * call overhead).
1677 		 */
1678 		do {
1679 			com_unlock();
1680 			incc = com->iptr - buf;
1681 			if (tp->t_rawq.c_cc + incc > tp->t_ihiwat
1682 			    && (com->state & CS_RTS_IFLOW
1683 				|| tp->t_iflag & IXOFF)
1684 			    && !(tp->t_state & TS_TBLOCK))
1685 				ttyblock(tp);
1686 			com->delta_error_counts[CE_TTY_BUF_OVERFLOW]
1687 				+= b_to_q((char *)buf, incc, &tp->t_rawq);
1688 			buf += incc;
1689 			tk_nin += incc;
1690 			tk_rawcc += incc;
1691 			tp->t_rawcc += incc;
1692 			ttwakeup(tp);
1693 			if (tp->t_state & TS_TTSTOP
1694 			    && (tp->t_iflag & IXANY
1695 				|| tp->t_cc[VSTART] == tp->t_cc[VSTOP])) {
1696 				tp->t_state &= ~TS_TTSTOP;
1697 				tp->t_lflag &= ~FLUSHO;
1698 				comstart(tp);
1699 			}
1700 			com_lock();
1701 		} while (buf < com->iptr);
1702 	} else {
1703 		do {
1704 			com_unlock();
1705 			line_status = buf[com->ierroff];
1706 			recv_data = *buf++;
1707 			if (line_status
1708 			    & (LSR_BI | LSR_FE | LSR_OE | LSR_PE)) {
1709 				if (line_status & LSR_BI)
1710 					recv_data |= TTY_BI;
1711 				if (line_status & LSR_FE)
1712 					recv_data |= TTY_FE;
1713 				if (line_status & LSR_OE)
1714 					recv_data |= TTY_OE;
1715 				if (line_status & LSR_PE)
1716 					recv_data |= TTY_PE;
1717 			}
1718 			(*linesw[tp->t_line].l_rint)(recv_data, tp);
1719 			com_lock();
1720 		} while (buf < com->iptr);
1721 	}
1722 	com_events -= (com->iptr - com->ibuf);
1723 	com->iptr = com->ibuf;
1724 
1725 	/*
1726 	 * There is now room for another low-level buffer full of input,
1727 	 * so enable RTS if it is now disabled and there is room in the
1728 	 * high-level buffer.
1729 	 */
1730 	if ((com->state & CS_RTS_IFLOW) && !(com->mcr_image & MCR_RTS) &&
1731 	    !(tp->t_state & TS_TBLOCK))
1732 		outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
1733 }
1734 
1735 void
1736 siointr(void *arg)
1737 {
1738 	lwkt_gettoken(&tty_token);
1739 #ifndef COM_MULTIPORT
1740 	com_lock();
1741 	siointr1((struct com_s *) arg);
1742 	com_unlock();
1743 #else /* COM_MULTIPORT */
1744 	bool_t		possibly_more_intrs;
1745 	int		unit;
1746 	struct com_s	*com;
1747 
1748 	/*
1749 	 * Loop until there is no activity on any port.  This is necessary
1750 	 * to get an interrupt edge more than to avoid another interrupt.
1751 	 * If the IRQ signal is just an OR of the IRQ signals from several
1752 	 * devices, then the edge from one may be lost because another is
1753 	 * on.
1754 	 */
1755 	com_lock();
1756 	do {
1757 		possibly_more_intrs = FALSE;
1758 		for (unit = 0; unit < sio_numunits; ++unit) {
1759 			com = com_addr(unit);
1760 			/*
1761 			 * XXX com_lock();
1762 			 * would it work here, or be counter-productive?
1763 			 */
1764 			if (com != NULL
1765 			    && !com->gone
1766 			    && (inb(com->int_id_port) & IIR_IMASK)
1767 			       != IIR_NOPEND) {
1768 				siointr1(com);
1769 				possibly_more_intrs = TRUE;
1770 			}
1771 			/* XXX com_unlock(); */
1772 		}
1773 	} while (possibly_more_intrs);
1774 	com_unlock();
1775 #endif /* COM_MULTIPORT */
1776 	lwkt_reltoken(&tty_token);
1777 }
1778 
1779 /*
1780  * Called with tty_token held and com_lock held.
1781  */
1782 static void
1783 siointr1(struct com_s *com)
1784 {
1785 	u_char	line_status;
1786 	u_char	modem_status;
1787 	u_char	*ioptr;
1788 	u_char	recv_data;
1789 	u_char	int_ctl;
1790 	u_char	int_ctl_new;
1791 	sysclock_t count;
1792 
1793 	int_ctl = inb(com->intr_ctl_port);
1794 	int_ctl_new = int_ctl;
1795 
1796 	while (!com->gone) {
1797 		if (com->pps.ppsparam.mode & PPS_CAPTUREBOTH) {
1798 			modem_status = inb(com->modem_status_port);
1799 		        if ((modem_status ^ com->last_modem_status) & MSR_DCD) {
1800 				count = sys_cputimer->count();
1801 				pps_event(&com->pps, count,
1802 				    (modem_status & MSR_DCD) ?
1803 				    PPS_CAPTUREASSERT : PPS_CAPTURECLEAR);
1804 			}
1805 		}
1806 		line_status = inb(com->line_status_port);
1807 
1808 		/* input event? (check first to help avoid overruns) */
1809 		while (line_status & LSR_RCV_MASK) {
1810 			/* break/unnattached error bits or real input? */
1811 			if (!(line_status & LSR_RXRDY))
1812 				recv_data = 0;
1813 			else
1814 				recv_data = inb(com->data_port);
1815 #if defined(DDB)
1816 			/*
1817 			 * Solaris implements a new BREAK which is initiated
1818 			 * by a character sequence CR ~ ^b which is similar
1819 			 * to a familiar pattern used on Sun servers by the
1820 			 * Remote Console.
1821 			 */
1822 #define	KEY_CRTLB	2	/* ^B */
1823 #define	KEY_CR		13	/* CR '\r' */
1824 #define	KEY_TILDE	126	/* ~ */
1825 
1826 			if (com->unit == comconsole && alt_break_to_debugger) {
1827 				static int brk_state1 = 0, brk_state2 = 0;
1828 				if (recv_data == KEY_CR) {
1829 					brk_state1 = recv_data;
1830 					brk_state2 = 0;
1831 				} else if (brk_state1 == KEY_CR && (recv_data == KEY_TILDE || recv_data == KEY_CRTLB)) {
1832 					if (recv_data == KEY_TILDE)
1833 						brk_state2 = recv_data;
1834 					else if (brk_state2 == KEY_TILDE && recv_data == KEY_CRTLB) {
1835 							com_unlock();
1836 							breakpoint();
1837 							com_lock();
1838 							brk_state1 = brk_state2 = 0;
1839 							goto cont;
1840 					} else
1841 						brk_state2 = 0;
1842 				} else
1843 					brk_state1 = 0;
1844 			}
1845 #endif
1846 			if (line_status & (LSR_BI | LSR_FE | LSR_PE)) {
1847 				/*
1848 				 * Don't store BI if IGNBRK or FE/PE if IGNPAR.
1849 				 * Otherwise, push the work to a higher level
1850 				 * (to handle PARMRK) if we're bypassing.
1851 				 * Otherwise, convert BI/FE and PE+INPCK to 0.
1852 				 *
1853 				 * This makes bypassing work right in the
1854 				 * usual "raw" case (IGNBRK set, and IGNPAR
1855 				 * and INPCK clear).
1856 				 *
1857 				 * Note: BI together with FE/PE means just BI.
1858 				 */
1859 				if (line_status & LSR_BI) {
1860 #if defined(DDB)
1861 					if (com->unit == comconsole &&
1862 					    break_to_debugger) {
1863 						com_unlock();
1864 						breakpoint();
1865 						com_lock();
1866 						goto cont;
1867 					}
1868 #endif
1869 					if (com->tp == NULL
1870 					    || com->tp->t_iflag & IGNBRK)
1871 						goto cont;
1872 				} else {
1873 					if (com->tp == NULL
1874 					    || com->tp->t_iflag & IGNPAR)
1875 						goto cont;
1876 				}
1877 				if (com->tp->t_state & TS_CAN_BYPASS_L_RINT
1878 				    && (line_status & (LSR_BI | LSR_FE)
1879 					|| com->tp->t_iflag & INPCK))
1880 					recv_data = 0;
1881 			}
1882 			++com->bytes_in;
1883 			if (com->hotchar != 0 && recv_data == com->hotchar)
1884 				setsofttty();
1885 			ioptr = com->iptr;
1886 			if (ioptr >= com->ibufend)
1887 				CE_RECORD(com, CE_INTERRUPT_BUF_OVERFLOW);
1888 			else {
1889 				if (com->do_timestamp)
1890 					microtime(&com->timestamp);
1891 				++com_events;
1892 				schedsofttty();
1893 #if 0 /* for testing input latency vs efficiency */
1894 if (com->iptr - com->ibuf == 8)
1895 	setsofttty();
1896 #endif
1897 				ioptr[0] = recv_data;
1898 				ioptr[com->ierroff] = line_status;
1899 				com->iptr = ++ioptr;
1900 				if (ioptr == com->ihighwater
1901 				    && com->state & CS_RTS_IFLOW)
1902 					outb(com->modem_ctl_port,
1903 					     com->mcr_image &= ~MCR_RTS);
1904 				if (line_status & LSR_OE)
1905 					CE_RECORD(com, CE_OVERRUN);
1906 			}
1907 cont:
1908 			/*
1909 			 * "& 0x7F" is to avoid the gcc-1.40 generating a slow
1910 			 * jump from the top of the loop to here
1911 			 */
1912 			line_status = inb(com->line_status_port) & 0x7F;
1913 		}
1914 
1915 		/* modem status change? (always check before doing output) */
1916 		modem_status = inb(com->modem_status_port);
1917 		if (modem_status != com->last_modem_status) {
1918 			if (com->do_dcd_timestamp
1919 			    && !(com->last_modem_status & MSR_DCD)
1920 			    && modem_status & MSR_DCD)
1921 				microtime(&com->dcd_timestamp);
1922 
1923 			/*
1924 			 * Schedule high level to handle DCD changes.  Note
1925 			 * that we don't use the delta bits anywhere.  Some
1926 			 * UARTs mess them up, and it's easy to remember the
1927 			 * previous bits and calculate the delta.
1928 			 */
1929 			com->last_modem_status = modem_status;
1930 			if (!(com->state & CS_CHECKMSR)) {
1931 				com_events += LOTS_OF_EVENTS;
1932 				com->state |= CS_CHECKMSR;
1933 				setsofttty();
1934 			}
1935 
1936 			/* handle CTS change immediately for crisp flow ctl */
1937 			if (com->state & CS_CTS_OFLOW) {
1938 				if (modem_status & MSR_CTS)
1939 					com->state |= CS_ODEVREADY;
1940 				else
1941 					com->state &= ~CS_ODEVREADY;
1942 			}
1943 		}
1944 
1945 		/* output queued and everything ready? */
1946 		if ((line_status & LSR_TXRDY)
1947 		    && com->state >= (CS_BUSY | CS_TTGO | CS_ODEVREADY)) {
1948 			ioptr = com->obufq.l_head;
1949 			if (com->tx_fifo_size > 1) {
1950 				u_int	ocount;
1951 
1952 				ocount = com->obufq.l_tail - ioptr;
1953 				if (ocount > com->tx_fifo_size)
1954 					ocount = com->tx_fifo_size;
1955 				com->bytes_out += ocount;
1956 				do
1957 					outb(com->data_port, *ioptr++);
1958 				while (--ocount != 0);
1959 			} else {
1960 				outb(com->data_port, *ioptr++);
1961 				++com->bytes_out;
1962 			}
1963 			com->obufq.l_head = ioptr;
1964 			if (COM_IIR_TXRDYBUG(com->flags)) {
1965 				int_ctl_new = int_ctl | IER_ETXRDY;
1966 			}
1967 			if (ioptr >= com->obufq.l_tail) {
1968 				struct lbq	*qp;
1969 
1970 				qp = com->obufq.l_next;
1971 				qp->l_queued = FALSE;
1972 				qp = qp->l_next;
1973 				if (qp != NULL) {
1974 					com->obufq.l_head = qp->l_head;
1975 					com->obufq.l_tail = qp->l_tail;
1976 					com->obufq.l_next = qp;
1977 				} else {
1978 					/* output just completed */
1979 					if (COM_IIR_TXRDYBUG(com->flags)) {
1980 						int_ctl_new = int_ctl & ~IER_ETXRDY;
1981 					}
1982 					com->state &= ~CS_BUSY;
1983 				}
1984 				if (!(com->state & CS_ODONE)) {
1985 					com_events += LOTS_OF_EVENTS;
1986 					com->state |= CS_ODONE;
1987 					setsofttty();	/* handle at high level ASAP */
1988 				}
1989 			}
1990 			if (COM_IIR_TXRDYBUG(com->flags) && (int_ctl != int_ctl_new)) {
1991 				outb(com->intr_ctl_port, int_ctl_new);
1992 			}
1993 		}
1994 
1995 		/* finished? */
1996 #ifdef COM_MULTIPORT
1997 		return;
1998 #else
1999 		if (inb(com->int_id_port) & IIR_NOPEND)
2000 			return;
2001 #endif
2002 	}
2003 }
2004 
2005 static int
2006 sioioctl(struct dev_ioctl_args *ap)
2007 {
2008 	cdev_t dev = ap->a_head.a_dev;
2009 	caddr_t data = ap->a_data;
2010 	struct com_s	*com;
2011 	int		error;
2012 	int		mynor;
2013 	struct tty	*tp;
2014 #if defined(COMPAT_43)
2015 	u_long		oldcmd;
2016 	struct termios	term;
2017 #endif
2018 	lwkt_gettoken(&tty_token);
2019 	mynor = minor(dev);
2020 
2021 	com = com_addr(MINOR_TO_UNIT(mynor));
2022 	if (com == NULL || com->gone) {
2023 		lwkt_reltoken(&tty_token);
2024 		return (ENODEV);
2025 	}
2026 	if (mynor & CONTROL_MASK) {
2027 		struct termios	*ct;
2028 
2029 		switch (mynor & CONTROL_MASK) {
2030 		case CONTROL_INIT_STATE:
2031 			ct = mynor & CALLOUT_MASK ? &com->it_out : &com->it_in;
2032 			break;
2033 		case CONTROL_LOCK_STATE:
2034 			ct = mynor & CALLOUT_MASK ? &com->lt_out : &com->lt_in;
2035 			break;
2036 		default:
2037 			lwkt_reltoken(&tty_token);
2038 			return (ENODEV);	/* /dev/nodev */
2039 		}
2040 		switch (ap->a_cmd) {
2041 		case TIOCSETA:
2042 			error = priv_check_cred(ap->a_cred, PRIV_ROOT, 0);
2043 			if (error != 0)
2044 				return (error);
2045 			*ct = *(struct termios *)data;
2046 			lwkt_reltoken(&tty_token);
2047 			return (0);
2048 		case TIOCGETA:
2049 			*(struct termios *)data = *ct;
2050 			lwkt_reltoken(&tty_token);
2051 			return (0);
2052 		case TIOCGETD:
2053 			*(int *)data = TTYDISC;
2054 			lwkt_reltoken(&tty_token);
2055 			return (0);
2056 		case TIOCGWINSZ:
2057 			bzero(data, sizeof(struct winsize));
2058 			lwkt_reltoken(&tty_token);
2059 			return (0);
2060 		default:
2061 			lwkt_reltoken(&tty_token);
2062 			return (ENOTTY);
2063 		}
2064 	}
2065 	tp = com->tp;
2066 #if defined(COMPAT_43)
2067 	term = tp->t_termios;
2068 	oldcmd = ap->a_cmd;
2069 	error = ttsetcompat(tp, &ap->a_cmd, data, &term);
2070 	if (error != 0) {
2071 		lwkt_reltoken(&tty_token);
2072 		return (error);
2073 	}
2074 	if (ap->a_cmd != oldcmd)
2075 		data = (caddr_t)&term;
2076 #endif
2077 	if (ap->a_cmd == TIOCSETA || ap->a_cmd == TIOCSETAW ||
2078 	    ap->a_cmd == TIOCSETAF) {
2079 		int	cc;
2080 		struct termios *dt = (struct termios *)data;
2081 		struct termios *lt = mynor & CALLOUT_MASK
2082 				     ? &com->lt_out : &com->lt_in;
2083 
2084 		dt->c_iflag = (tp->t_iflag & lt->c_iflag)
2085 			      | (dt->c_iflag & ~lt->c_iflag);
2086 		dt->c_oflag = (tp->t_oflag & lt->c_oflag)
2087 			      | (dt->c_oflag & ~lt->c_oflag);
2088 		dt->c_cflag = (tp->t_cflag & lt->c_cflag)
2089 			      | (dt->c_cflag & ~lt->c_cflag);
2090 		dt->c_lflag = (tp->t_lflag & lt->c_lflag)
2091 			      | (dt->c_lflag & ~lt->c_lflag);
2092 		for (cc = 0; cc < NCCS; ++cc)
2093 			if (lt->c_cc[cc] != 0)
2094 				dt->c_cc[cc] = tp->t_cc[cc];
2095 		if (lt->c_ispeed != 0)
2096 			dt->c_ispeed = tp->t_ispeed;
2097 		if (lt->c_ospeed != 0)
2098 			dt->c_ospeed = tp->t_ospeed;
2099 	}
2100 	error = (*linesw[tp->t_line].l_ioctl)(tp, ap->a_cmd, data, ap->a_fflag, ap->a_cred);
2101 	if (error != ENOIOCTL) {
2102 		lwkt_reltoken(&tty_token);
2103 		return (error);
2104 	}
2105 	crit_enter();
2106 	error = ttioctl(tp, ap->a_cmd, data, ap->a_fflag);
2107 	disc_optim(tp, &tp->t_termios, com);
2108 	if (error != ENOIOCTL) {
2109 		crit_exit();
2110 		lwkt_reltoken(&tty_token);
2111 		return (error);
2112 	}
2113 	switch (ap->a_cmd) {
2114 	case TIOCSBRK:
2115 		sio_setreg(com, com_cfcr, com->cfcr_image |= CFCR_SBREAK);
2116 		break;
2117 	case TIOCCBRK:
2118 		sio_setreg(com, com_cfcr, com->cfcr_image &= ~CFCR_SBREAK);
2119 		break;
2120 	case TIOCSDTR:
2121 		(void)commctl(com, TIOCM_DTR, DMBIS);
2122 		break;
2123 	case TIOCCDTR:
2124 		(void)commctl(com, TIOCM_DTR, DMBIC);
2125 		break;
2126 	/*
2127 	 * XXX should disallow changing MCR_RTS if CS_RTS_IFLOW is set.  The
2128 	 * changes get undone on the next call to comparam().
2129 	 */
2130 	case TIOCMSET:
2131 		(void)commctl(com, *(int *)data, DMSET);
2132 		break;
2133 	case TIOCMBIS:
2134 		(void)commctl(com, *(int *)data, DMBIS);
2135 		break;
2136 	case TIOCMBIC:
2137 		(void)commctl(com, *(int *)data, DMBIC);
2138 		break;
2139 	case TIOCMGET:
2140 		*(int *)data = commctl(com, 0, DMGET);
2141 		break;
2142 	case TIOCMSDTRWAIT:
2143 		/* must be root since the wait applies to following logins */
2144 		error = priv_check_cred(ap->a_cred, PRIV_ROOT, 0);
2145 		if (error != 0) {
2146 			crit_exit();
2147 			lwkt_reltoken(&tty_token);
2148 			return (error);
2149 		}
2150 		com->dtr_wait = *(int *)data * hz / 100;
2151 		break;
2152 	case TIOCMGDTRWAIT:
2153 		*(int *)data = com->dtr_wait * 100 / hz;
2154 		break;
2155 	case TIOCTIMESTAMP:
2156 		com->do_timestamp = TRUE;
2157 		*(struct timeval *)data = com->timestamp;
2158 		break;
2159 	case TIOCDCDTIMESTAMP:
2160 		com->do_dcd_timestamp = TRUE;
2161 		*(struct timeval *)data = com->dcd_timestamp;
2162 		break;
2163 	default:
2164 		crit_exit();
2165 		error = pps_ioctl(ap->a_cmd, data, &com->pps);
2166 		if (error == ENODEV)
2167 			error = ENOTTY;
2168 		lwkt_reltoken(&tty_token);
2169 		return (error);
2170 	}
2171 	crit_exit();
2172 	lwkt_reltoken(&tty_token);
2173 	return (0);
2174 }
2175 
2176 static void
2177 siopoll(void *dummy, void *frame)
2178 {
2179 	int		unit;
2180 
2181 	lwkt_gettoken(&tty_token);
2182 	if (com_events == 0) {
2183 		lwkt_reltoken(&tty_token);
2184 		return;
2185 	}
2186 
2187 repeat:
2188 	for (unit = 0; unit < sio_numunits; ++unit) {
2189 		struct com_s	*com;
2190 		int		incc;
2191 		struct tty	*tp;
2192 
2193 		com = com_addr(unit);
2194 		if (com == NULL)
2195 			continue;
2196 		tp = com->tp;
2197 		if (tp == NULL || com->gone) {
2198 			/*
2199 			 * Discard any events related to never-opened or
2200 			 * going-away devices.
2201 			 */
2202 			com_lock();
2203 			incc = com->iptr - com->ibuf;
2204 			com->iptr = com->ibuf;
2205 			if (com->state & CS_CHECKMSR) {
2206 				incc += LOTS_OF_EVENTS;
2207 				com->state &= ~CS_CHECKMSR;
2208 			}
2209 			com_events -= incc;
2210 			com_unlock();
2211 			continue;
2212 		}
2213 		if (com->iptr != com->ibuf) {
2214 			com_lock();
2215 			sioinput(com);
2216 			com_unlock();
2217 		}
2218 		if (com->state & CS_CHECKMSR) {
2219 			u_char	delta_modem_status;
2220 
2221 			com_lock();
2222 			delta_modem_status = com->last_modem_status
2223 					     ^ com->prev_modem_status;
2224 			com->prev_modem_status = com->last_modem_status;
2225 			com_events -= LOTS_OF_EVENTS;
2226 			com->state &= ~CS_CHECKMSR;
2227 			com_unlock();
2228 			if (delta_modem_status & MSR_DCD)
2229 				(*linesw[tp->t_line].l_modem)
2230 					(tp, com->prev_modem_status & MSR_DCD);
2231 		}
2232 		if (com->state & CS_ODONE) {
2233 			com_lock();
2234 			com_events -= LOTS_OF_EVENTS;
2235 			com->state &= ~CS_ODONE;
2236 			com_unlock();
2237 			if (!(com->state & CS_BUSY)
2238 			    && !(com->extra_state & CSE_BUSYCHECK)) {
2239 				callout_reset(&com->busy_ch, hz / 100,
2240 						siobusycheck, com);
2241 				com->extra_state |= CSE_BUSYCHECK;
2242 			}
2243 			(*linesw[tp->t_line].l_start)(tp);
2244 		}
2245 		if (com_events == 0)
2246 			break;
2247 	}
2248 	if (com_events >= LOTS_OF_EVENTS)
2249 		goto repeat;
2250 	lwkt_reltoken(&tty_token);
2251 }
2252 
2253 /*
2254  * Called with tty_token held but no com_lock
2255  */
2256 static int
2257 comparam(struct tty *tp, struct termios *t)
2258 {
2259 	u_int		cfcr;
2260 	int		cflag;
2261 	struct com_s	*com;
2262 	u_int		divisor;
2263 	u_char		dlbh;
2264 	u_char		dlbl;
2265 	int		unit;
2266 
2267 	unit = DEV_TO_UNIT(tp->t_dev);
2268 	com = com_addr(unit);
2269 	if (com == NULL) {
2270 		return (ENODEV);
2271 	}
2272 
2273 	/* do historical conversions */
2274 	if (t->c_ispeed == 0)
2275 		t->c_ispeed = t->c_ospeed;
2276 
2277 	/* check requested parameters */
2278 	if (t->c_ospeed == 0)
2279 		divisor = 0;
2280 	else {
2281 		if (t->c_ispeed != t->c_ospeed)
2282 			return (EINVAL);
2283 		divisor = siodivisor(com->rclk, t->c_ispeed);
2284 		if (divisor == 0)
2285 			return (EINVAL);
2286 	}
2287 
2288 	/* parameters are OK, convert them to the com struct and the device */
2289 	crit_enter();
2290 	if (divisor == 0)
2291 		(void)commctl(com, TIOCM_DTR, DMBIC);	/* hang up line */
2292 	else
2293 		(void)commctl(com, TIOCM_DTR, DMBIS);
2294 	cflag = t->c_cflag;
2295 	switch (cflag & CSIZE) {
2296 	case CS5:
2297 		cfcr = CFCR_5BITS;
2298 		break;
2299 	case CS6:
2300 		cfcr = CFCR_6BITS;
2301 		break;
2302 	case CS7:
2303 		cfcr = CFCR_7BITS;
2304 		break;
2305 	default:
2306 		cfcr = CFCR_8BITS;
2307 		break;
2308 	}
2309 	if (cflag & PARENB) {
2310 		cfcr |= CFCR_PENAB;
2311 		if (!(cflag & PARODD))
2312 			cfcr |= CFCR_PEVEN;
2313 	}
2314 	if (cflag & CSTOPB)
2315 		cfcr |= CFCR_STOPB;
2316 
2317 	if (com->hasfifo && divisor != 0) {
2318 		/*
2319 		 * Use a fifo trigger level low enough so that the input
2320 		 * latency from the fifo is less than about 16 msec and
2321 		 * the total latency is less than about 30 msec.  These
2322 		 * latencies are reasonable for humans.  Serial comms
2323 		 * protocols shouldn't expect anything better since modem
2324 		 * latencies are larger.
2325 		 *
2326 		 * Interrupts can be held up for long periods of time
2327 		 * due to inefficiencies in other parts of the kernel,
2328 		 * certain video cards, etc.  Setting the FIFO trigger
2329 		 * point to MEDH instead of HIGH gives us 694uS of slop
2330 		 * (8 character times) instead of 173uS (2 character times)
2331 		 * @ 115200 bps.
2332 		 */
2333 		com->fifo_image = t->c_ospeed <= 4800
2334 				  ? FIFO_ENABLE : FIFO_ENABLE | FIFO_RX_MEDH;
2335 #ifdef COM_ESP
2336 		/*
2337 		 * The Hayes ESP card needs the fifo DMA mode bit set
2338 		 * in compatibility mode.  If not, it will interrupt
2339 		 * for each character received.
2340 		 */
2341 		if (com->esp)
2342 			com->fifo_image |= FIFO_DMA_MODE;
2343 #endif
2344 		sio_setreg(com, com_fifo, com->fifo_image);
2345 	}
2346 
2347 	/*
2348 	 * This returns with interrupts disabled so that we can complete
2349 	 * the speed change atomically.  Keeping interrupts disabled is
2350 	 * especially important while com_data is hidden.
2351 	 */
2352 	(void) siosetwater(com, t->c_ispeed);
2353 
2354 	if (divisor != 0) {
2355 		sio_setreg(com, com_cfcr, cfcr | CFCR_DLAB);
2356 		/*
2357 		 * Only set the divisor registers if they would change,
2358 		 * since on some 16550 incompatibles (UMC8669F), setting
2359 		 * them while input is arriving them loses sync until
2360 		 * data stops arriving.
2361 		 */
2362 		dlbl = divisor & 0xFF;
2363 		if (sio_getreg(com, com_dlbl) != dlbl)
2364 			sio_setreg(com, com_dlbl, dlbl);
2365 		dlbh = divisor >> 8;
2366 		if (sio_getreg(com, com_dlbh) != dlbh)
2367 			sio_setreg(com, com_dlbh, dlbh);
2368 	}
2369 
2370 	sio_setreg(com, com_cfcr, com->cfcr_image = cfcr);
2371 
2372 	if (!(tp->t_state & TS_TTSTOP))
2373 		com->state |= CS_TTGO;
2374 
2375 	if (cflag & CRTS_IFLOW) {
2376 		if (com->st16650a) {
2377 			sio_setreg(com, com_cfcr, 0xbf);
2378 			sio_setreg(com, com_fifo,
2379 				   sio_getreg(com, com_fifo) | 0x40);
2380 		}
2381 		com->state |= CS_RTS_IFLOW;
2382 		/*
2383 		 * If CS_RTS_IFLOW just changed from off to on, the change
2384 		 * needs to be propagated to MCR_RTS.  This isn't urgent,
2385 		 * so do it later by calling comstart() instead of repeating
2386 		 * a lot of code from comstart() here.
2387 		 */
2388 	} else if (com->state & CS_RTS_IFLOW) {
2389 		com->state &= ~CS_RTS_IFLOW;
2390 		/*
2391 		 * CS_RTS_IFLOW just changed from on to off.  Force MCR_RTS
2392 		 * on here, since comstart() won't do it later.
2393 		 */
2394 		outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
2395 		if (com->st16650a) {
2396 			sio_setreg(com, com_cfcr, 0xbf);
2397 			sio_setreg(com, com_fifo,
2398 				   sio_getreg(com, com_fifo) & ~0x40);
2399 		}
2400 	}
2401 
2402 
2403 	/*
2404 	 * Set up state to handle output flow control.
2405 	 * XXX - worth handling MDMBUF (DCD) flow control at the lowest level?
2406 	 * Now has 10+ msec latency, while CTS flow has 50- usec latency.
2407 	 */
2408 	com->state |= CS_ODEVREADY;
2409 	com->state &= ~CS_CTS_OFLOW;
2410 	if (cflag & CCTS_OFLOW) {
2411 		com->state |= CS_CTS_OFLOW;
2412 		if (!(com->last_modem_status & MSR_CTS))
2413 			com->state &= ~CS_ODEVREADY;
2414 		if (com->st16650a) {
2415 			sio_setreg(com, com_cfcr, 0xbf);
2416 			sio_setreg(com, com_fifo,
2417 				   sio_getreg(com, com_fifo) | 0x80);
2418 		}
2419 	} else {
2420 		if (com->st16650a) {
2421 			sio_setreg(com, com_cfcr, 0xbf);
2422 			sio_setreg(com, com_fifo,
2423 				   sio_getreg(com, com_fifo) & ~0x80);
2424 		}
2425 	}
2426 
2427 	sio_setreg(com, com_cfcr, com->cfcr_image);
2428 
2429 	/* XXX shouldn't call functions while intrs are disabled. */
2430 	disc_optim(tp, t, com);
2431 	/*
2432 	 * Recover from fiddling with CS_TTGO.  We used to call siointr1()
2433 	 * unconditionally, but that defeated the careful discarding of
2434 	 * stale input in sioopen().
2435 	 */
2436 	if (com->state >= (CS_BUSY | CS_TTGO)) {
2437 		com_lock();
2438 		siointr1(com);
2439 		com_unlock();
2440 	}
2441 	crit_exit();
2442 	comstart(tp);
2443 	if (com->ibufold != NULL) {
2444 		kfree(com->ibufold, M_DEVBUF);
2445 		com->ibufold = NULL;
2446 	}
2447 	return (0);
2448 }
2449 
2450 /*
2451  * called with tty_token held
2452  */
2453 static int
2454 siosetwater(struct com_s *com, speed_t speed)
2455 {
2456 	int		cp4ticks;
2457 	u_char		*ibuf;
2458 	int		ibufsize;
2459 	struct tty	*tp;
2460 
2461 	/*
2462 	 * Make the buffer size large enough to handle a softtty interrupt
2463 	 * latency of about 2 ticks without loss of throughput or data
2464 	 * (about 3 ticks if input flow control is not used or not honoured,
2465 	 * but a bit less for CS5-CS7 modes).
2466 	 */
2467 	cp4ticks = speed / 10 / hz * 4;
2468 	for (ibufsize = 128; ibufsize < cp4ticks;)
2469 		ibufsize <<= 1;
2470 	if (ibufsize == com->ibufsize)
2471 		return (0);
2472 
2473 	/*
2474 	 * Allocate input buffer.  The extra factor of 2 in the size is
2475 	 * to allow for an error byte for each input byte.
2476 	 */
2477 	ibuf = kmalloc(2 * ibufsize, M_DEVBUF, M_WAITOK | M_ZERO);
2478 
2479 	/* Initialize non-critical variables. */
2480 	com->ibufold = com->ibuf;
2481 	com->ibufsize = ibufsize;
2482 	tp = com->tp;
2483 	if (tp != NULL) {
2484 		tp->t_ififosize = 2 * ibufsize;
2485 		tp->t_ispeedwat = (speed_t)-1;
2486 		tp->t_ospeedwat = (speed_t)-1;
2487 	}
2488 
2489 	/*
2490 	 * Read current input buffer.
2491 	 */
2492 	com_lock();
2493 	if (com->iptr != com->ibuf)
2494 		sioinput(com);
2495 
2496 	/*-
2497 	 * Initialize critical variables, including input buffer watermarks.
2498 	 * The external device is asked to stop sending when the buffer
2499 	 * exactly reaches high water, or when the high level requests it.
2500 	 * The high level is notified immediately (rather than at a later
2501 	 * clock tick) when this watermark is reached.
2502 	 * The buffer size is chosen so the watermark should almost never
2503 	 * be reached.
2504 	 * The low watermark is invisibly 0 since the buffer is always
2505 	 * emptied all at once.
2506 	 */
2507 	com->iptr = com->ibuf = ibuf;
2508 	com->ibufend = ibuf + ibufsize;
2509 	com->ierroff = ibufsize;
2510 	com->ihighwater = ibuf + 3 * ibufsize / 4;
2511 	com_unlock();
2512 	return (0);
2513 }
2514 
2515 static void
2516 comstart(struct tty *tp)
2517 {
2518 	struct com_s	*com;
2519 	int		unit;
2520 
2521 	lwkt_gettoken(&tty_token);
2522 	unit = DEV_TO_UNIT(tp->t_dev);
2523 	com = com_addr(unit);
2524 	if (com == NULL) {
2525 		lwkt_reltoken(&tty_token);
2526 		return;
2527 	}
2528 	crit_enter();
2529 	com_lock();
2530 	if (tp->t_state & TS_TTSTOP)
2531 		com->state &= ~CS_TTGO;
2532 	else
2533 		com->state |= CS_TTGO;
2534 	if (tp->t_state & TS_TBLOCK) {
2535 		if (com->mcr_image & MCR_RTS && com->state & CS_RTS_IFLOW)
2536 			outb(com->modem_ctl_port, com->mcr_image &= ~MCR_RTS);
2537 	} else {
2538 		if (!(com->mcr_image & MCR_RTS) && com->iptr < com->ihighwater
2539 		    && com->state & CS_RTS_IFLOW)
2540 			outb(com->modem_ctl_port, com->mcr_image |= MCR_RTS);
2541 	}
2542 	com_unlock();
2543 	if (tp->t_state & (TS_TIMEOUT | TS_TTSTOP)) {
2544 		ttwwakeup(tp);
2545 		crit_exit();
2546 		lwkt_reltoken(&tty_token);
2547 		return;
2548 	}
2549 	if (tp->t_outq.c_cc != 0) {
2550 		struct lbq	*qp;
2551 		struct lbq	*next;
2552 
2553 		if (!com->obufs[0].l_queued) {
2554 			com->obufs[0].l_tail
2555 			    = com->obuf1 + q_to_b(&tp->t_outq, com->obuf1,
2556 						  sizeof com->obuf1);
2557 			com->obufs[0].l_next = NULL;
2558 			com->obufs[0].l_queued = TRUE;
2559 			com_lock();
2560 			if (com->state & CS_BUSY) {
2561 				qp = com->obufq.l_next;
2562 				while ((next = qp->l_next) != NULL)
2563 					qp = next;
2564 				qp->l_next = &com->obufs[0];
2565 			} else {
2566 				com->obufq.l_head = com->obufs[0].l_head;
2567 				com->obufq.l_tail = com->obufs[0].l_tail;
2568 				com->obufq.l_next = &com->obufs[0];
2569 				com->state |= CS_BUSY;
2570 			}
2571 			com_unlock();
2572 		}
2573 		if (tp->t_outq.c_cc != 0 && !com->obufs[1].l_queued) {
2574 			com->obufs[1].l_tail
2575 			    = com->obuf2 + q_to_b(&tp->t_outq, com->obuf2,
2576 						  sizeof com->obuf2);
2577 			com->obufs[1].l_next = NULL;
2578 			com->obufs[1].l_queued = TRUE;
2579 			com_lock();
2580 			if (com->state & CS_BUSY) {
2581 				qp = com->obufq.l_next;
2582 				while ((next = qp->l_next) != NULL)
2583 					qp = next;
2584 				qp->l_next = &com->obufs[1];
2585 			} else {
2586 				com->obufq.l_head = com->obufs[1].l_head;
2587 				com->obufq.l_tail = com->obufs[1].l_tail;
2588 				com->obufq.l_next = &com->obufs[1];
2589 				com->state |= CS_BUSY;
2590 			}
2591 			com_unlock();
2592 		}
2593 		tp->t_state |= TS_BUSY;
2594 	}
2595 	com_lock();
2596 	if (com->state >= (CS_BUSY | CS_TTGO))
2597 		siointr1(com);	/* fake interrupt to start output */
2598 	com_unlock();
2599 	ttwwakeup(tp);
2600 	crit_exit();
2601 	lwkt_reltoken(&tty_token);
2602 }
2603 
2604 static void
2605 comstop(struct tty *tp, int rw)
2606 {
2607 	struct com_s	*com;
2608 
2609 	lwkt_gettoken(&tty_token);
2610 	com = com_addr(DEV_TO_UNIT(tp->t_dev));
2611 	if (com == NULL || com->gone) {
2612 		lwkt_reltoken(&tty_token);
2613 		return;
2614 	}
2615 	com_lock();
2616 	if (rw & FWRITE) {
2617 		if (com->hasfifo)
2618 #ifdef COM_ESP
2619 		    /* XXX avoid h/w bug. */
2620 		    if (!com->esp)
2621 #endif
2622 			sio_setreg(com, com_fifo,
2623 				   FIFO_XMT_RST | com->fifo_image);
2624 		com->obufs[0].l_queued = FALSE;
2625 		com->obufs[1].l_queued = FALSE;
2626 		if (com->state & CS_ODONE)
2627 			com_events -= LOTS_OF_EVENTS;
2628 		com->state &= ~(CS_ODONE | CS_BUSY);
2629 		com->tp->t_state &= ~TS_BUSY;
2630 	}
2631 	if (rw & FREAD) {
2632 		if (com->hasfifo)
2633 #ifdef COM_ESP
2634 		    /* XXX avoid h/w bug. */
2635 		    if (!com->esp)
2636 #endif
2637 			sio_setreg(com, com_fifo,
2638 				   FIFO_RCV_RST | com->fifo_image);
2639 		com_events -= (com->iptr - com->ibuf);
2640 		com->iptr = com->ibuf;
2641 	}
2642 	com_unlock();
2643 	comstart(tp);
2644 	lwkt_reltoken(&tty_token);
2645 }
2646 
2647 static int
2648 commctl(struct com_s *com, int bits, int how)
2649 {
2650 	int	mcr;
2651 	int	msr;
2652 
2653 	lwkt_gettoken(&tty_token);
2654 	if (how == DMGET) {
2655 		bits = TIOCM_LE;	/* XXX - always enabled while open */
2656 		mcr = com->mcr_image;
2657 		if (mcr & MCR_DTR)
2658 			bits |= TIOCM_DTR;
2659 		if (mcr & MCR_RTS)
2660 			bits |= TIOCM_RTS;
2661 		msr = com->prev_modem_status;
2662 		if (msr & MSR_CTS)
2663 			bits |= TIOCM_CTS;
2664 		if (msr & MSR_DCD)
2665 			bits |= TIOCM_CD;
2666 		if (msr & MSR_DSR)
2667 			bits |= TIOCM_DSR;
2668 		/*
2669 		 * XXX - MSR_RI is naturally volatile, and we make MSR_TERI
2670 		 * more volatile by reading the modem status a lot.  Perhaps
2671 		 * we should latch both bits until the status is read here.
2672 		 */
2673 		if (msr & (MSR_RI | MSR_TERI))
2674 			bits |= TIOCM_RI;
2675 		lwkt_reltoken(&tty_token);
2676 		return (bits);
2677 	}
2678 	mcr = 0;
2679 	if (bits & TIOCM_DTR)
2680 		mcr |= MCR_DTR;
2681 	if (bits & TIOCM_RTS)
2682 		mcr |= MCR_RTS;
2683 	if (com->gone) {
2684 		lwkt_reltoken(&tty_token);
2685 		return(0);
2686 	}
2687 	com_lock();
2688 	switch (how) {
2689 	case DMSET:
2690 		outb(com->modem_ctl_port,
2691 		     com->mcr_image = mcr | (com->mcr_image & MCR_IENABLE));
2692 		break;
2693 	case DMBIS:
2694 		outb(com->modem_ctl_port, com->mcr_image |= mcr);
2695 		break;
2696 	case DMBIC:
2697 		outb(com->modem_ctl_port, com->mcr_image &= ~mcr);
2698 		break;
2699 	}
2700 	com_unlock();
2701 	lwkt_reltoken(&tty_token);
2702 	return (0);
2703 }
2704 
2705 /*
2706  * NOTE: Must be called with tty_token held
2707  */
2708 static void
2709 siosettimeout(void)
2710 {
2711 	struct com_s	*com;
2712 	bool_t		someopen;
2713 	int		unit;
2714 
2715 	ASSERT_LWKT_TOKEN_HELD(&tty_token);
2716 	/*
2717 	 * Set our timeout period to 1 second if no polled devices are open.
2718 	 * Otherwise set it to max(1/200, 1/hz).
2719 	 * Enable timeouts iff some device is open.
2720 	 */
2721 	callout_stop(&sio_timeout_handle);
2722 	sio_timeout = hz;
2723 	someopen = FALSE;
2724 	for (unit = 0; unit < sio_numunits; ++unit) {
2725 		com = com_addr(unit);
2726 		if (com != NULL && com->tp != NULL
2727 		    && com->tp->t_state & TS_ISOPEN && !com->gone) {
2728 			someopen = TRUE;
2729 			if (com->poll || com->poll_output) {
2730 				sio_timeout = hz > 200 ? hz / 200 : 1;
2731 				break;
2732 			}
2733 		}
2734 	}
2735 	if (someopen) {
2736 		sio_timeouts_until_log = hz / sio_timeout;
2737 		callout_reset(&sio_timeout_handle, sio_timeout,
2738 				comwakeup, NULL);
2739 	} else {
2740 		/* Flush error messages, if any. */
2741 		sio_timeouts_until_log = 1;
2742 		comwakeup(NULL);
2743 		callout_stop(&sio_timeout_handle);
2744 	}
2745 }
2746 
2747 /*
2748  * NOTE: Must be called with tty_token held
2749  */
2750 static void
2751 comwakeup(void *chan)
2752 {
2753 	struct com_s	*com;
2754 	int		unit;
2755 
2756 	/*
2757 	 * Can be called from a callout too so just get the token
2758 	 */
2759 	lwkt_gettoken(&tty_token);
2760 	callout_reset(&sio_timeout_handle, sio_timeout, comwakeup, NULL);
2761 
2762 	/*
2763 	 * Recover from lost output interrupts.
2764 	 * Poll any lines that don't use interrupts.
2765 	 */
2766 	for (unit = 0; unit < sio_numunits; ++unit) {
2767 		com = com_addr(unit);
2768 		if (com != NULL && !com->gone
2769 		    && (com->state >= (CS_BUSY | CS_TTGO) || com->poll)) {
2770 			com_lock();
2771 			siointr1(com);
2772 			com_unlock();
2773 		}
2774 	}
2775 
2776 	/*
2777 	 * Check for and log errors, but not too often.
2778 	 */
2779 	if (--sio_timeouts_until_log > 0) {
2780 		lwkt_reltoken(&tty_token);
2781 		return;
2782 	}
2783 	sio_timeouts_until_log = hz / sio_timeout;
2784 	for (unit = 0; unit < sio_numunits; ++unit) {
2785 		int	errnum;
2786 
2787 		com = com_addr(unit);
2788 		if (com == NULL)
2789 			continue;
2790 		if (com->gone)
2791 			continue;
2792 		for (errnum = 0; errnum < CE_NTYPES; ++errnum) {
2793 			u_int	delta;
2794 			u_long	total;
2795 
2796 			com_lock();
2797 			delta = com->delta_error_counts[errnum];
2798 			com->delta_error_counts[errnum] = 0;
2799 			com_unlock();
2800 			if (delta == 0)
2801 				continue;
2802 			total = com->error_counts[errnum] += delta;
2803 			log(LOG_ERR, "sio%d: %u more %s%s (total %lu)\n",
2804 			    unit, delta, error_desc[errnum],
2805 			    delta == 1 ? "" : "s", total);
2806 		}
2807 	}
2808 	lwkt_reltoken(&tty_token);
2809 }
2810 
2811 static void
2812 disc_optim(struct tty *tp, struct termios *t, struct com_s *com)
2813 {
2814 	lwkt_gettoken(&tty_token);
2815 	if (!(t->c_iflag & (ICRNL | IGNCR | IMAXBEL | INLCR | ISTRIP | IXON))
2816 	    && (!(t->c_iflag & BRKINT) || (t->c_iflag & IGNBRK))
2817 	    && (!(t->c_iflag & PARMRK)
2818 		|| (t->c_iflag & (IGNPAR | IGNBRK)) == (IGNPAR | IGNBRK))
2819 	    && !(t->c_lflag & (ECHO | ICANON | IEXTEN | ISIG | PENDIN))
2820 	    && linesw[tp->t_line].l_rint == ttyinput)
2821 		tp->t_state |= TS_CAN_BYPASS_L_RINT;
2822 	else
2823 		tp->t_state &= ~TS_CAN_BYPASS_L_RINT;
2824 	com->hotchar = linesw[tp->t_line].l_hotchar;
2825 	lwkt_reltoken(&tty_token);
2826 }
2827 
2828 /*
2829  * Following are all routines needed for SIO to act as console
2830  */
2831 #include <sys/cons.h>
2832 
2833 struct siocnstate {
2834 	u_char	dlbl;
2835 	u_char	dlbh;
2836 	u_char	ier;
2837 	u_char	cfcr;
2838 	u_char	mcr;
2839 };
2840 
2841 static speed_t siocngetspeed (Port_t, u_long rclk);
2842 #if 0
2843 static void siocnclose	(struct siocnstate *sp, Port_t iobase);
2844 #endif
2845 static void siocnopen	(struct siocnstate *sp, Port_t iobase, int speed);
2846 static void siocntxwait	(Port_t iobase);
2847 
2848 static cn_probe_t siocnprobe;
2849 static cn_init_t siocninit;
2850 static cn_init_fini_t siocninit_fini;
2851 static cn_checkc_t siocncheckc;
2852 static cn_getc_t siocngetc;
2853 static cn_putc_t siocnputc;
2854 
2855 #if defined(__i386__) || defined(__x86_64__)
2856 CONS_DRIVER(sio, siocnprobe, siocninit, siocninit_fini,
2857 	    NULL, siocngetc, siocncheckc, siocnputc, NULL);
2858 #endif
2859 
2860 /* To get the GDB related variables */
2861 #if DDB > 0
2862 #include <ddb/ddb.h>
2863 #endif
2864 
2865 static void
2866 siocntxwait(Port_t iobase)
2867 {
2868 	int	timo;
2869 
2870 	/*
2871 	 * Wait for any pending transmission to finish.  Required to avoid
2872 	 * the UART lockup bug when the speed is changed, and for normal
2873 	 * transmits.
2874 	 */
2875 	timo = 100000;
2876 	while ((inb(iobase + com_lsr) & (LSR_TSRE | LSR_TXRDY))
2877 	       != (LSR_TSRE | LSR_TXRDY) && --timo != 0)
2878 		;
2879 }
2880 
2881 /*
2882  * Read the serial port specified and try to figure out what speed
2883  * it's currently running at.  We're assuming the serial port has
2884  * been initialized and is basicly idle.  This routine is only intended
2885  * to be run at system startup.
2886  *
2887  * If the value read from the serial port doesn't make sense, return 0.
2888  */
2889 /*
2890  * NOTE: Must be called with tty_token held
2891  */
2892 static speed_t
2893 siocngetspeed(Port_t iobase, u_long rclk)
2894 {
2895 	u_int	divisor;
2896 	u_char	dlbh;
2897 	u_char	dlbl;
2898 	u_char  cfcr;
2899 
2900 	cfcr = inb(iobase + com_cfcr);
2901 	outb(iobase + com_cfcr, CFCR_DLAB | cfcr);
2902 
2903 	dlbl = inb(iobase + com_dlbl);
2904 	dlbh = inb(iobase + com_dlbh);
2905 
2906 	outb(iobase + com_cfcr, cfcr);
2907 
2908 	divisor = dlbh << 8 | dlbl;
2909 
2910 	/* XXX there should be more sanity checking. */
2911 	if (divisor == 0)
2912 		return (CONSPEED);
2913 	return (rclk / (16UL * divisor));
2914 }
2915 
2916 static void
2917 siocnopen(struct siocnstate *sp, Port_t iobase, int speed)
2918 {
2919 	u_int	divisor;
2920 	u_char	dlbh;
2921 	u_char	dlbl;
2922 
2923 	/*
2924 	 * Save all the device control registers except the fifo register
2925 	 * and set our default ones (cs8 -parenb speed=comdefaultrate).
2926 	 * We can't save the fifo register since it is read-only.
2927 	 */
2928 	sp->ier = inb(iobase + com_ier);
2929 	outb(iobase + com_ier, 0);	/* spltty() doesn't stop siointr() */
2930 	siocntxwait(iobase);
2931 	sp->cfcr = inb(iobase + com_cfcr);
2932 	outb(iobase + com_cfcr, CFCR_DLAB | CFCR_8BITS);
2933 	sp->dlbl = inb(iobase + com_dlbl);
2934 	sp->dlbh = inb(iobase + com_dlbh);
2935 	/*
2936 	 * Only set the divisor registers if they would change, since on
2937 	 * some 16550 incompatibles (Startech), setting them clears the
2938 	 * data input register.  This also reduces the effects of the
2939 	 * UMC8669F bug.
2940 	 */
2941 	divisor = siodivisor(comdefaultrclk, speed);
2942 	dlbl = divisor & 0xFF;
2943 	if (sp->dlbl != dlbl)
2944 		outb(iobase + com_dlbl, dlbl);
2945 	dlbh = divisor >> 8;
2946 	if (sp->dlbh != dlbh)
2947 		outb(iobase + com_dlbh, dlbh);
2948 	outb(iobase + com_cfcr, CFCR_8BITS);
2949 	sp->mcr = inb(iobase + com_mcr);
2950 	/*
2951 	 * We don't want interrupts, but must be careful not to "disable"
2952 	 * them by clearing the MCR_IENABLE bit, since that might cause
2953 	 * an interrupt by floating the IRQ line.
2954 	 */
2955 	outb(iobase + com_mcr, (sp->mcr & MCR_IENABLE) | MCR_DTR | MCR_RTS);
2956 }
2957 
2958 #if 0
2959 static void
2960 siocnclose(struct siocnstate *sp, Port_t iobase)
2961 {
2962 	/*
2963 	 * Restore the device control registers.
2964 	 */
2965 	siocntxwait(iobase);
2966 	outb(iobase + com_cfcr, CFCR_DLAB | CFCR_8BITS);
2967 	if (sp->dlbl != inb(iobase + com_dlbl))
2968 		outb(iobase + com_dlbl, sp->dlbl);
2969 	if (sp->dlbh != inb(iobase + com_dlbh))
2970 		outb(iobase + com_dlbh, sp->dlbh);
2971 	outb(iobase + com_cfcr, sp->cfcr);
2972 	/*
2973 	 * XXX damp oscillations of MCR_DTR and MCR_RTS by not restoring them.
2974 	 */
2975 	outb(iobase + com_mcr, sp->mcr | MCR_DTR | MCR_RTS);
2976 	outb(iobase + com_ier, sp->ier);
2977 }
2978 #endif
2979 
2980 static void
2981 siocnprobe(struct consdev *cp)
2982 {
2983 	u_char			cfcr;
2984 	u_int			divisor;
2985 	int			unit;
2986 	struct siocnstate	sp;
2987 
2988 	/*
2989 	 * Find our first enabled console, if any.  If it is a high-level
2990 	 * console device, then initialize it and return successfully.
2991 	 * If it is a low-level console device, then initialize it and
2992 	 * return unsuccessfully.  It must be initialized in both cases
2993 	 * for early use by console drivers and debuggers.  Initializing
2994 	 * the hardware is not necessary in all cases, since the i/o
2995 	 * routines initialize it on the fly, but it is necessary if
2996 	 * input might arrive while the hardware is switched back to an
2997 	 * uninitialized state.  We can't handle multiple console devices
2998 	 * yet because our low-level routines don't take a device arg.
2999 	 * We trust the user to set the console flags properly so that we
3000 	 * don't need to probe.
3001 	 */
3002 	cp->cn_pri = CN_DEAD;
3003 
3004 	for (unit = 0; unit < 16; unit++) { /* XXX need to know how many */
3005 		int flags;
3006 		int disabled;
3007 		if (resource_int_value("sio", unit, "disabled", &disabled) == 0) {
3008 			if (disabled)
3009 				continue;
3010 		}
3011 		if (resource_int_value("sio", unit, "flags", &flags))
3012 			continue;
3013 		if (COM_CONSOLE(flags) || COM_DEBUGGER(flags)) {
3014 			int port;
3015 			int baud;
3016 			Port_t iobase;
3017 			speed_t boot_speed;
3018 
3019 			if (resource_int_value("sio", unit, "port", &port))
3020 				continue;
3021 			if (resource_int_value("sio", unit, "baud", &baud) == 0)
3022 				boot_speed = baud;
3023 			else
3024 				boot_speed = 0;
3025 			iobase = port;
3026 			crit_enter();
3027 			if (boothowto & RB_SERIAL) {
3028 				if (boot_speed == 0) {
3029 					boot_speed = siocngetspeed(iobase,
3030 								comdefaultrclk);
3031 				}
3032 				if (boot_speed)
3033 					comdefaultrate = boot_speed;
3034 			}
3035 
3036 			/*
3037 			 * Initialize the divisor latch.  We can't rely on
3038 			 * siocnopen() to do this the first time, since it
3039 			 * avoids writing to the latch if the latch appears
3040 			 * to have the correct value.  Also, if we didn't
3041 			 * just read the speed from the hardware, then we
3042 			 * need to set the speed in hardware so that
3043 			 * switching it later is null.
3044 			 */
3045 			com_lock();
3046 			cfcr = inb(iobase + com_cfcr);
3047 			outb(iobase + com_cfcr, CFCR_DLAB | cfcr);
3048 			divisor = siodivisor(comdefaultrclk, comdefaultrate);
3049 			outb(iobase + com_dlbl, divisor & 0xff);
3050 			outb(iobase + com_dlbh, divisor >> 8);
3051 			outb(iobase + com_cfcr, cfcr);
3052 
3053 			siocnopen(&sp, iobase, comdefaultrate);
3054 			com_unlock();
3055 
3056 			crit_exit();
3057 			if (COM_CONSOLE(flags) && !COM_LLCONSOLE(flags)) {
3058 				cp->cn_probegood = 1;
3059 				cp->cn_private = (void *)(intptr_t)unit;
3060 				cp->cn_pri = COM_FORCECONSOLE(flags)
3061 					     || boothowto & RB_SERIAL
3062 					     ? CN_REMOTE : CN_NORMAL;
3063 				siocniobase = iobase;
3064 				siocnunit = unit;
3065 			}
3066 			if (COM_DEBUGGER(flags) && gdb_tab == NULL) {
3067 				kprintf("sio%d: gdb debugging port\n", unit);
3068 				siogdbiobase = iobase;
3069 				siogdbunit = unit;
3070 #if DDB > 0
3071 				cp->cn_gdbprivate = (void *)(intptr_t)unit;
3072 				gdb_tab = cp;
3073 #endif
3074 			}
3075 		}
3076 	}
3077 #if defined(__i386__) || defined(__x86_64__)
3078 #if DDB > 0
3079 	/*
3080 	 * XXX Ugly Compatability.
3081 	 * If no gdb port has been specified, set it to be the console
3082 	 * as some configuration files don't specify the gdb port.
3083 	 */
3084 	if (gdb_tab == NULL && (boothowto & RB_GDB)) {
3085 		kprintf("Warning: no GDB port specified. Defaulting to sio%d.\n",
3086 			siocnunit);
3087 		kprintf("Set flag 0x80 on desired GDB port in your\n");
3088 		kprintf("configuration file (currently sio only).\n");
3089 		siogdbiobase = siocniobase;
3090 		siogdbunit = siocnunit;
3091 		cp->cn_gdbprivate = (void *)(intptr_t)siocnunit;
3092 		gdb_tab = cp;
3093 	}
3094 #endif
3095 #endif
3096 }
3097 
3098 static void
3099 siocninit(struct consdev *cp)
3100 {
3101 	comconsole = (int)(intptr_t)cp->cn_private;
3102 }
3103 
3104 static void
3105 siocninit_fini(struct consdev *cp)
3106 {
3107 	cdev_t dev;
3108 	int unit;
3109 
3110 	if (cp->cn_probegood) {
3111 		unit = (int)(intptr_t)cp->cn_private;
3112 		/*
3113 		 * Call devfs_find_device_by_name on ttydX to find the correct device,
3114 		 * as it should have been created already at this point by the
3115 		 * attach routine.
3116 		 * If it isn't found, the serial port was not attached at all and we
3117 		 * shouldn't be here, so assert this case.
3118 		 */
3119 		dev = devfs_find_device_by_name("ttyd%r", unit);
3120 
3121 		KKASSERT(dev != NULL);
3122 		cp->cn_dev = dev;
3123 	}
3124 }
3125 
3126 static int
3127 siocncheckc(void *private)
3128 {
3129 	int	c;
3130 	int	unit = (int)(intptr_t)private;
3131 	Port_t	iobase;
3132 #if 0
3133 	struct siocnstate	sp;
3134 #endif
3135 
3136 	if (unit == siogdbunit)
3137 		iobase = siogdbiobase;
3138 	else
3139 		iobase = siocniobase;
3140 	com_lock();
3141 	crit_enter();
3142 #if 0
3143 	siocnopen(&sp, iobase, comdefaultrate);
3144 #endif
3145 	if (inb(iobase + com_lsr) & LSR_RXRDY)
3146 		c = inb(iobase + com_data);
3147 	else
3148 		c = -1;
3149 #if 0
3150 	siocnclose(&sp, iobase);
3151 #endif
3152 	crit_exit();
3153 	com_unlock();
3154 	return (c);
3155 }
3156 
3157 
3158 int
3159 siocngetc(void *private)
3160 {
3161 	int	c;
3162 	int	unit = (int)(intptr_t)private;
3163 	Port_t	iobase;
3164 #if 0
3165 	struct siocnstate	sp;
3166 #endif
3167 
3168 	if (unit == siogdbunit)
3169 		iobase = siogdbiobase;
3170 	else
3171 		iobase = siocniobase;
3172 	com_lock();
3173 	crit_enter();
3174 #if 0
3175 	siocnopen(&sp, iobase, comdefaultrate);
3176 #endif
3177 	while (!(inb(iobase + com_lsr) & LSR_RXRDY))
3178 		;
3179 	c = inb(iobase + com_data);
3180 #if 0
3181 	siocnclose(&sp, iobase);
3182 #endif
3183 	crit_exit();
3184 	com_unlock();
3185 	return (c);
3186 }
3187 
3188 void
3189 siocnputc(void *private, int c)
3190 {
3191 	int	unit = (int)(intptr_t)private;
3192 #if 0
3193 	struct siocnstate	sp;
3194 #endif
3195 	Port_t	iobase;
3196 
3197 	if (unit == siogdbunit)
3198 		iobase = siogdbiobase;
3199 	else
3200 		iobase = siocniobase;
3201 	com_lock();
3202 	crit_enter();
3203 #if 0
3204 	siocnopen(&sp, iobase, comdefaultrate);
3205 #endif
3206 	siocntxwait(iobase);
3207 	outb(iobase + com_data, c);
3208 #if 0
3209 	siocnclose(&sp, iobase);
3210 #endif
3211 	crit_exit();
3212 	com_unlock();
3213 }
3214 
3215 DRIVER_MODULE(sio, isa, sio_isa_driver, sio_devclass, NULL, NULL);
3216 DRIVER_MODULE(sio, acpi, sio_isa_driver, sio_devclass, NULL, NULL);
3217 #if NPCI > 0
3218 DRIVER_MODULE(sio, pci, sio_pci_driver, sio_devclass, NULL, NULL);
3219 #endif
3220 #if NPUC > 0
3221 DRIVER_MODULE(sio, puc, sio_puc_driver, sio_devclass, NULL, NULL);
3222 #endif
3223