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