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