sys/dev/serial/sio/sio.c

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