oboe.c revision 1.40
150276Speter/* $NetBSD: oboe.c,v 1.40 2014/03/20 20:41:11 christos Exp $ */ 276726Speter 350276Speter/* XXXXFVDL THIS DRIVER IS BROKEN FOR NON-i386 -- vtophys() usage */ 450276Speter 550276Speter/*- 650276Speter * Copyright (c) 2001 The NetBSD Foundation, Inc. 750276Speter * All rights reserved. 850276Speter * 950276Speter * This code is derived from software contributed to The NetBSD Foundation 1050276Speter * by Jan Sparud. 1150276Speter * 1250276Speter * Redistribution and use in source and binary forms, with or without 1350276Speter * modification, are permitted provided that the following conditions 1450276Speter * are met: 1550276Speter * 1. Redistributions of source code must retain the above copyright 1650276Speter * notice, this list of conditions and the following disclaimer. 1750276Speter * 2. Redistributions in binary form must reproduce the above copyright 1850276Speter * notice, this list of conditions and the following disclaimer in the 1950276Speter * documentation and/or other materials provided with the distribution. 2050276Speter * 2150276Speter * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 2250276Speter * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 2350276Speter * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 2450276Speter * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 2550276Speter * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 2650276Speter * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 2750276Speter * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 2850276Speter * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 2950276Speter * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 3050276Speter * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 3150276Speter * POSSIBILITY OF SUCH DAMAGE. 3250276Speter */ 3350276Speter 3450276Speter/* 3576726Speter * Toshiba OBOE IrDA SIR/FIR driver. 3650276Speter * 3750276Speter * Based on information from the Linux driver, thus the magic hex numbers. 3850276Speter */ 3950276Speter 4050276Speter#include <sys/cdefs.h> 4150276Speter__KERNEL_RCSID(0, "$NetBSD: oboe.c,v 1.40 2014/03/20 20:41:11 christos Exp $"); 4250276Speter 4350276Speter#include <sys/param.h> 4450276Speter#include <sys/systm.h> 4550276Speter#include <sys/kernel.h> 4650276Speter#include <sys/device.h> 4750276Speter#include <sys/malloc.h> 4850276Speter#include <sys/tty.h> 4950276Speter#include <sys/vnode.h> 5050276Speter#include <sys/poll.h> 5176726Speter#include <sys/proc.h> 5276726Speter 5350276Speter#include <dev/ir/ir.h> 5450276Speter#include <dev/ir/irdaio.h> 5550276Speter#include <dev/ir/irframevar.h> 5650276Speter#include <dev/ir/sir.h> 5750276Speter 5850276Speter#include <dev/pci/pcidevs.h> 5950276Speter#include <dev/pci/pcivar.h> 6050276Speter 6150276Speter#include <sys/bus.h> 6250276Speter#include <sys/intr.h> 6350276Speter 6450276Speter#include <dev/pci/oboereg.h> 6550276Speter 6650276Speterstatic int oboe_match(device_t parent, cfdata_t match, void *aux); 6750276Speterstatic void oboe_attach(device_t parent, device_t self, void *aux); 6850276Speterstatic int oboe_detach(device_t self, int flags); 6950276Speter 7050276Speterstatic int oboe_open(void *h, int flag, int mode, struct lwp *l); 7150276Speterstatic int oboe_close(void *h, int flag, int mode, struct lwp *l); 7250276Speterstatic int oboe_read(void *h, struct uio *uio, int flag); 7350276Speterstatic int oboe_write(void *h, struct uio *uio, int flag); 7450276Speterstatic int oboe_set_params(void *h, struct irda_params *params); 7550276Speterstatic int oboe_get_speeds(void *h, int *speeds); 7650276Speterstatic int oboe_get_turnarounds(void *h, int *times); 7750276Speterstatic int oboe_poll(void *h, int events, struct lwp *l); 7850276Speterstatic int oboe_kqfilter(void *h, struct knote *kn); 7950276Speter 8050276Speter#ifdef OBOE_DEBUG 8150276Speter#define DPRINTF(x) if (oboedebug) printf x 8250276Speterint oboedebug = 1; 8350276Speter#else 8450276Speter#define DPRINTF(x) 8550276Speter#endif 8650276Speter 8750276Speterstruct oboe_dma; 8850276Speter 8950276Speterstruct oboe_softc { 9050276Speter device_t sc_child; 9150276Speter struct pci_attach_args sc_pa; 92 pci_intr_handle_t * sc_ih; 93 unsigned int sc_revision; /* PCI Revision ID */ 94 /* I/O Base device */ 95 bus_space_tag_t sc_iot; 96 bus_space_handle_t sc_ioh; 97 bus_dma_tag_t sc_dmatag; 98 struct selinfo sc_rsel; 99 struct selinfo sc_wsel; 100 101 int sc_state; 102#define OBOE_RSLP 0x01 /* waiting for data (read) */ 103#define OBOE_WSLP 0x02 /* waiting for data (write) */ 104#define OBOE_CLOSING 0x04 /* waiting for output to drain */ 105 106 int sc_speeds; 107 int sc_flags; 108 int sc_speed; 109 int sc_ebofs; 110 111 struct oboe_dma *sc_dmas; 112 struct OboeTaskFile *sc_taskfile; /* The taskfile */ 113 u_char * sc_xmit_bufs[TX_SLOTS]; 114 u_char * sc_recv_bufs[RX_SLOTS]; 115 void * sc_xmit_stores[TX_SLOTS]; 116 void * sc_recv_stores[RX_SLOTS]; 117 int sc_txs; /* Current transmit slot number */ 118 int sc_rxs; /* Current receive slot number */ 119 int sc_saved; /* number of saved frames */ 120 int sc_lens[RX_SLOTS]; 121 122 int sc_txpending; 123 124 /* Statistics */ 125 int sc_txpackets; 126 int sc_rxpackets; 127 int sc_txerrors; 128 int sc_rxerrors; 129}; 130 131static int oboe_intr(void *handle); 132static int oboe_reset(struct oboe_softc *); 133 134struct oboe_dma { 135 bus_dmamap_t map; 136 void *addr; 137 bus_dma_segment_t segs[1]; 138 int nsegs; 139 size_t size; 140 struct oboe_dma *next; 141}; 142 143#define DMAADDR(p) ((p)->map->dm_segs[0].ds_addr) 144#define KERNADDR(p) ((void *)((p)->addr)) 145 146static int oboe_alloc_taskfile(struct oboe_softc *); 147static void oboe_init_taskfile(struct oboe_softc *); 148static void oboe_startchip(struct oboe_softc *); 149static void oboe_stopchip(struct oboe_softc *); 150static int oboe_setbaud(struct oboe_softc *, int); 151 152CFATTACH_DECL_NEW(oboe, sizeof(struct oboe_softc), 153 oboe_match, oboe_attach, oboe_detach, NULL); 154 155static struct irframe_methods oboe_methods = { 156 oboe_open, oboe_close, oboe_read, oboe_write, oboe_poll, 157 oboe_kqfilter, oboe_set_params, oboe_get_speeds, oboe_get_turnarounds 158}; 159 160static int 161oboe_match(device_t parent, cfdata_t match, void *aux) 162{ 163 struct pci_attach_args *pa = aux; 164 165 if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_TOSHIBA2 && 166 (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_TOSHIBA2_OBOE || 167 PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_TOSHIBA2_DONAUOBOE)) 168 return (1); 169 return 0; 170} 171 172static void 173oboe_attach(device_t parent, device_t self, void *aux) 174{ 175 struct oboe_softc *sc = device_private(self); 176 struct pci_attach_args *pa = aux; 177 pci_intr_handle_t ih; 178 struct ir_attach_args ia; 179 const char *intrstring; 180 181 sc->sc_revision = PCI_REVISION(pa->pa_class); 182 printf(": Toshiba Fast Infrared Type O, revision %d\n", 183 sc->sc_revision); 184 185 /* Map I/O registers. */ 186 if (pci_mapreg_map(pa, IO_BAR, PCI_MAPREG_TYPE_IO, 0, 187 &sc->sc_iot, &sc->sc_ioh, NULL, NULL)) { 188 aprint_error_dev(self, "can't map I/O space\n"); 189 return; 190 } 191 192 sc->sc_dmatag = pa->pa_dmat; 193 194 ia.ia_type = IR_TYPE_IRFRAME; 195 ia.ia_methods = &oboe_methods; 196 ia.ia_handle = sc; 197 198 sc->sc_state = 0; 199 sc->sc_speed = IRDA_SPEED_9600; 200 201 /* Enable the device */ 202 pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, 203 pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG) | 204 PCI_COMMAND_MASTER_ENABLE); 205 206 /* Reset the device; bail out upon failure. */ 207 if (oboe_reset(sc) != 0) { 208 aprint_error_dev(self, "can't reset\n"); 209 return; 210 } 211 /* Map and establish the interrupt. */ 212 if (pci_intr_map(pa, &ih)) { 213 aprint_error_dev(self, "couldn't map interrupt\n"); 214 return; 215 } 216 intrstring = pci_intr_string(pa->pa_pc, ih); 217 sc->sc_ih = pci_intr_establish(pa->pa_pc, ih, IPL_IR, oboe_intr, sc); 218 if (sc->sc_ih == NULL) { 219 aprint_error_dev(self, "couldn't establish interrupt"); 220 if (intrstring != NULL) 221 aprint_error(" at %s", intrstring); 222 aprint_error("\n"); 223 return; 224 } 225 aprint_normal_dev(self, "interrupting at %s\n", intrstring); 226 227 selinit(&sc->sc_rsel); 228 selinit(&sc->sc_wsel); 229 230 sc->sc_txs = 0; 231 sc->sc_rxs = 0; 232 233 sc->sc_speeds = 234 IRDA_SPEED_2400 | IRDA_SPEED_9600 | IRDA_SPEED_19200 | 235 IRDA_SPEED_38400 | IRDA_SPEED_57600 | IRDA_SPEED_115200 | 236 IRDA_SPEED_576000 | IRDA_SPEED_1152000 | IRDA_SPEED_4000000; 237 238 oboe_alloc_taskfile(sc); 239 240 sc->sc_child = config_found((void *)sc, &ia, ir_print); 241} 242 243static int 244oboe_detach(device_t self, int flags) 245{ 246 struct oboe_softc *sc = device_private(self); 247 248#ifdef OBOE_DEBUG 249 /* XXX needs reference counting for proper detach. */ 250 DPRINTF(("%s: sc=%p\n", __func__, sc)); 251#endif 252 seldestroy(&sc->sc_rsel); 253 seldestroy(&sc->sc_wsel); 254 return (0); 255} 256 257static int 258oboe_open(void *h, int flag, int mode, struct lwp *l) 259{ 260 struct oboe_softc *sc = h; 261 262 DPRINTF(("%s: sc=%p\n", __func__, sc)); 263 264 sc->sc_state = 0; 265 sc->sc_saved = 0; 266 oboe_init_taskfile(sc); 267 oboe_startchip(sc); 268 269 return (0); 270} 271 272static int 273oboe_close(void *h, int flag, int mode, 274 struct lwp *l) 275{ 276 struct oboe_softc *sc = h; 277 int error = 0; 278 int s = splir(); 279 280 DPRINTF(("%s: sc=%p\n", __func__, sc)); 281 /* Wait for output to drain */ 282 283 if (sc->sc_txpending > 0) { 284 sc->sc_state |= OBOE_CLOSING; 285 error = tsleep(&sc->sc_state, PZERO | PCATCH, "oboecl", hz/10); 286 } 287 splx(s); 288 289 oboe_stopchip(sc); 290 return (error); 291} 292 293static int 294oboe_read(void *h, struct uio *uio, int flag) 295{ 296 struct oboe_softc *sc = h; 297 int error = 0; 298 int s; 299 int slot; 300 301 DPRINTF(("%s: resid=%zu, iovcnt=%d, offset=%td\n", 302 __func__, uio->uio_resid, uio->uio_iovcnt, 303 uio->uio_offset)); 304 305 s = splir(); 306 while (sc->sc_saved == 0) { 307 if (flag & IO_NDELAY) { 308 splx(s); 309 return (EWOULDBLOCK); 310 } 311 sc->sc_state |= OBOE_RSLP; 312 DPRINTF(("oboe_read: sleep\n")); 313 error = tsleep(&sc->sc_rxs, PZERO | PCATCH, "oboerd", 0); 314 DPRINTF(("oboe_read: woke, error=%d\n", error)); 315 if (error) { 316 sc->sc_state &= ~OBOE_RSLP; 317 break; 318 } 319 } 320 321 /* Do just one frame transfer per read */ 322 323 if (!error) { 324 slot = (sc->sc_rxs - sc->sc_saved + RX_SLOTS) % RX_SLOTS; 325 if (uio->uio_resid < sc->sc_lens[slot]) { 326 DPRINTF(("oboe_read: uio buffer smaller than frame size" 327 "(%zu < %d)\n", uio->uio_resid, sc->sc_lens[slot])); 328 error = EINVAL; 329 } else { 330 DPRINTF(("oboe_read: moving %d bytes from %p\n", 331 sc->sc_lens[slot], 332 sc->sc_recv_stores[slot])); 333 error = uiomove(sc->sc_recv_stores[slot], 334 sc->sc_lens[slot], uio); 335 } 336 } 337 sc->sc_saved--; 338 splx(s); 339 340 return (error); 341} 342 343static int 344oboe_write(void *h, struct uio *uio, int flag) 345{ 346 struct oboe_softc *sc = h; 347 int error = 0; 348 int n; 349 int s = splir(); 350 351 DPRINTF(("%s: sc=%p\n", __func__, sc)); 352 while (sc->sc_txpending == TX_SLOTS) { 353 if (flag & IO_NDELAY) { 354 splx(s); 355 return (EWOULDBLOCK); 356 } 357 sc->sc_state |= OBOE_WSLP; 358 DPRINTF(("oboe_write: sleep\n")); 359 error = tsleep(&sc->sc_txs, PZERO | PCATCH, "oboewr", 0); 360 DPRINTF(("oboe_write: woke up, error=%d\n", error)); 361 if (error) { 362 sc->sc_state &= ~OBOE_WSLP; 363 break; 364 } 365 } 366 if (error) 367 goto err; 368 if (sc->sc_taskfile->xmit[sc->sc_txs].control) { 369 DPRINTF(("oboe_write: slot overrun\n")); 370 } 371 372 n = irda_sir_frame(sc->sc_xmit_bufs[sc->sc_txs], TX_BUF_SZ, uio, 373 sc->sc_ebofs); 374 if (n < 0) { 375 error = -n; 376 goto err; 377 } 378 sc->sc_taskfile->xmit[sc->sc_txs].len = n; 379 380 OUTB(sc, 0, OBOE_RST); 381 OUTB(sc, 0x1e, OBOE_REG_11); 382 383 sc->sc_taskfile->xmit[sc->sc_txs].control = 0x84; 384 385 /* XXX Need delay here??? */ 386 delay(1000); 387 388 sc->sc_txpending++; 389 OUTB(sc, 0x80, OBOE_RST); 390 OUTB(sc, 1, OBOE_REG_9); 391 sc->sc_txs++; 392 sc->sc_txs %= TX_SLOTS; 393 394 err: 395 splx(s); 396 return (error); 397} 398 399static int 400oboe_set_params(void *h, struct irda_params *p) 401{ 402 struct oboe_softc *sc = h; 403 int error; 404 405 if (p->speed > 0) { 406 error = oboe_setbaud(sc, p->speed); 407 if (error) 408 return (error); 409 } 410 sc->sc_ebofs = p->ebofs; 411 412 /* XXX ignore ebofs and maxsize for now */ 413 return (0); 414} 415 416static int 417oboe_get_speeds(void *h, int *speeds) 418{ 419 struct oboe_softc *sc = h; 420 *speeds = sc->sc_speeds; 421 return (0); 422} 423 424static int 425oboe_get_turnarounds(void *h, int *turnarounds) 426{ 427#ifdef OBOE_DEBUG 428 struct oboe_softc *sc = h; 429 DPRINTF(("%s: sc=%p\n", __func__, sc)); 430#endif 431 432 /* XXX Linux driver sets all bits */ 433 *turnarounds = IRDA_TURNT_10000; /* 10ms */ 434 435 return (0); 436} 437 438static int 439oboe_poll(void *h, int events, struct lwp *l) 440{ 441 struct oboe_softc *sc = h; 442 int revents = 0; 443 int s; 444 445 DPRINTF(("%s: sc=%p\n", __func__, sc)); 446 447 s = splir(); 448 if (events & (POLLOUT | POLLWRNORM)) 449 revents |= events & (POLLOUT | POLLWRNORM); 450 if (events & (POLLIN | POLLRDNORM)) { 451 if (sc->sc_saved > 0) { 452 DPRINTF(("%s: have data\n", __func__)); 453 revents |= events & (POLLIN | POLLRDNORM); 454 } else { 455 DPRINTF(("%s: recording select\n", __func__)); 456 selrecord(l, &sc->sc_rsel); 457 } 458 } 459 splx(s); 460 461 return (revents); 462} 463 464static void 465filt_oboerdetach(struct knote *kn) 466{ 467 struct oboe_softc *sc = kn->kn_hook; 468 int s; 469 470 s = splir(); 471 SLIST_REMOVE(&sc->sc_rsel.sel_klist, kn, knote, kn_selnext); 472 splx(s); 473} 474 475static int 476filt_oboeread(struct knote *kn, long hint) 477{ 478 struct oboe_softc *sc = kn->kn_hook; 479 480 kn->kn_data = sc->sc_saved; 481 return (kn->kn_data > 0); 482} 483 484static void 485filt_oboewdetach(struct knote *kn) 486{ 487 struct oboe_softc *sc = kn->kn_hook; 488 int s; 489 490 s = splir(); 491 SLIST_REMOVE(&sc->sc_wsel.sel_klist, kn, knote, kn_selnext); 492 splx(s); 493} 494 495static const struct filterops oboeread_filtops = 496 { 1, NULL, filt_oboerdetach, filt_oboeread }; 497static const struct filterops oboewrite_filtops = 498 { 1, NULL, filt_oboewdetach, filt_seltrue }; 499 500static int 501oboe_kqfilter(void *h, struct knote *kn) 502{ 503 struct oboe_softc *sc = h; 504 struct klist *klist; 505 int s; 506 507 switch (kn->kn_filter) { 508 case EVFILT_READ: 509 klist = &sc->sc_rsel.sel_klist; 510 kn->kn_fop = &oboeread_filtops; 511 break; 512 case EVFILT_WRITE: 513 klist = &sc->sc_wsel.sel_klist; 514 kn->kn_fop = &oboewrite_filtops; 515 break; 516 default: 517 return (EINVAL); 518 } 519 520 kn->kn_hook = sc; 521 522 s = splir(); 523 SLIST_INSERT_HEAD(klist, kn, kn_selnext); 524 splx(s); 525 526 return (0); 527} 528 529static int 530oboe_reset(struct oboe_softc *sc) 531{ 532#if 0 533 OUTB(sc, 0x00, OBOE_RST); 534 OUTB(sc, 0x80, OBOE_RST); 535#endif 536 return 0; 537} 538 539static int 540oboe_intr(void *p) 541{ 542 struct oboe_softc *sc = p; 543 uint8_t irqstat = INB(sc, OBOE_ISR); 544 545 if (!(irqstat & 0xf8)) 546 return (0); /* Not for me? */ 547 548 DPRINTF(("oboe_intr stat=0x%x\n", irqstat)); 549 550 OUTB(sc, irqstat, OBOE_ISR); 551 552 if (irqstat & OBOE_ISR_RXDONE) { 553 while (sc->sc_taskfile->recv[sc->sc_rxs].control == 0) { 554 int len = sc->sc_taskfile->recv[sc->sc_rxs].len; 555 if (sc->sc_saved == RX_SLOTS) { 556 DPRINTF(("oboe_intr: all buffers filled\n")); 557 return 0; 558 } 559 560 if (len > 2) 561 len -= 2; /* JSP: skip check sum? */ 562 563 DPRINTF(("oboe_intr: moving %d bytes to %p\n", len, 564 sc->sc_recv_stores[sc->sc_rxs])); 565 memcpy(sc->sc_recv_stores[sc->sc_rxs], 566 sc->sc_recv_bufs[sc->sc_rxs], 567 len); 568 sc->sc_lens[sc->sc_rxs] = len; 569 sc->sc_saved++; 570#if 0 571 (void)b_to_q(sc->sc_recv_bufs[sc->sc_rxs], 572 len, &sc->sc_q); 573#endif 574 sc->sc_taskfile->recv[sc->sc_rxs].control = 0x83; 575 sc->sc_taskfile->recv[sc->sc_rxs].len = 0x0; 576 sc->sc_rxs = (sc->sc_rxs + 1) % RX_SLOTS; 577 DPRINTF(("oboe_intr new rxs=%d\n", sc->sc_rxs)); 578 } 579 DPRINTF(("oboe_intr no more frames available\n")); 580 if (sc->sc_state & OBOE_RSLP) { 581 DPRINTF(("oboe_intr changing state to ~OBOE_RSLP\n")); 582 sc->sc_state &= ~OBOE_RSLP; 583 DPRINTF(("oboe_intr: waking up reader\n")); 584 wakeup(&sc->sc_rxs); 585 } 586 selnotify(&sc->sc_rsel, 0, 0); 587 DPRINTF(("oboe_intr returning\n")); 588 } 589 if (irqstat & OBOE_ISR_TXDONE) { 590 DPRINTF(("oboe_intr: write done\n")); 591 sc->sc_txpending--; 592 sc->sc_txpackets++; 593 594 if ((sc->sc_state & OBOE_CLOSING) && sc->sc_txpending == 0) { 595 wakeup(&sc->sc_state); 596 return 1; 597 } 598 599 if (sc->sc_state & OBOE_WSLP) { 600 DPRINTF(("oboe_intr changing state to ~OBOE_WSLP\n")); 601 sc->sc_state &= ~OBOE_WSLP; 602 DPRINTF(("oboe_intr: waking up writer\n")); 603 wakeup(&sc->sc_txs); 604 } 605 selnotify(&sc->sc_wsel, 0, 0); 606 } 607 return (1); 608} 609 610/* XXX vtophys must go! */ 611static void 612oboe_init_taskfile(struct oboe_softc *sc) 613{ 614 int i; 615 int s = splir(); 616 617 for (i = 0; i < TX_SLOTS; ++i) { 618 sc->sc_taskfile->xmit[i].len = 0; 619 sc->sc_taskfile->xmit[i].control = 0x00; 620 sc->sc_taskfile->xmit[i].buffer = 621 vtophys((uintptr_t)sc->sc_xmit_bufs[i]); 622 } 623 624 for (i = 0; i < RX_SLOTS; ++i) { 625 sc->sc_taskfile->recv[i].len = 0; 626 sc->sc_taskfile->recv[i].control = 0x83; 627 sc->sc_taskfile->recv[i].buffer = 628 vtophys((uintptr_t)sc->sc_recv_bufs[i]); 629 } 630 631 sc->sc_txpending = 0; 632 633 splx(s); 634} 635 636static int 637oboe_alloc_taskfile(struct oboe_softc *sc) 638{ 639 int i; 640 /* XXX */ 641 uintptr_t addr = 642 (uintptr_t)malloc(OBOE_TASK_BUF_LEN, M_DEVBUF, M_WAITOK); 643 if (addr == 0) { 644 goto bad; 645 } 646 addr &= ~(sizeof (struct OboeTaskFile) - 1); 647 addr += sizeof (struct OboeTaskFile); 648 sc->sc_taskfile = (struct OboeTaskFile *) addr; 649 650 for (i = 0; i < TX_SLOTS; ++i) { 651 sc->sc_xmit_bufs[i] = 652 malloc(TX_BUF_SZ, M_DEVBUF, M_WAITOK); 653 sc->sc_xmit_stores[i] = 654 malloc(TX_BUF_SZ, M_DEVBUF, M_WAITOK); 655 if (sc->sc_xmit_bufs[i] == NULL || 656 sc->sc_xmit_stores[i] == NULL) { 657 goto bad; 658 } 659 } 660 for (i = 0; i < RX_SLOTS; ++i) { 661 sc->sc_recv_bufs[i] = 662 malloc(RX_BUF_SZ, M_DEVBUF, M_WAITOK); 663 sc->sc_recv_stores[i] = 664 malloc(RX_BUF_SZ, M_DEVBUF, M_WAITOK); 665 if (sc->sc_recv_bufs[i] == NULL || 666 sc->sc_recv_stores[i] == NULL) { 667 goto bad; 668 } 669 } 670 671 return 0; 672bad: 673 printf("oboe: malloc for buffers failed()\n"); 674 return 1; 675} 676 677static void 678oboe_startchip (struct oboe_softc *sc) 679{ 680 uint32_t physaddr; 681 682 OUTB(sc, 0, OBOE_LOCK); 683 OUTB(sc, 0, OBOE_RST); 684 OUTB(sc, OBOE_NTR_VAL, OBOE_NTR); 685 OUTB(sc, 0xf0, OBOE_REG_D); 686 OUTB(sc, 0xff, OBOE_ISR); 687 OUTB(sc, 0x0f, OBOE_REG_1A); 688 OUTB(sc, 0xff, OBOE_REG_1B); 689 690 physaddr = vtophys((uintptr_t)sc->sc_taskfile); 691 692 OUTB(sc, (physaddr >> 0x0a) & 0xff, OBOE_TFP0); 693 OUTB(sc, (physaddr >> 0x12) & 0xff, OBOE_TFP1); 694 OUTB(sc, (physaddr >> 0x1a) & 0x3f, OBOE_TFP2); 695 696 OUTB(sc, 0x0e, OBOE_REG_11); 697 OUTB(sc, 0x80, OBOE_RST); 698 699 (void)oboe_setbaud(sc, 9600); 700 701 sc->sc_rxs = INB(sc, OBOE_RCVT); 702 if (sc->sc_rxs < 0 || sc->sc_rxs >= RX_SLOTS) 703 sc->sc_rxs = 0; 704 sc->sc_txs = INB(sc, OBOE_XMTT) - OBOE_XMTT_OFFSET; 705 if (sc->sc_txs < 0 || sc->sc_txs >= TX_SLOTS) 706 sc->sc_txs = 0; 707} 708 709static void 710oboe_stopchip (struct oboe_softc *sc) 711{ 712 OUTB(sc, 0x0e, OBOE_REG_11); 713 OUTB(sc, 0x00, OBOE_RST); 714 OUTB(sc, 0x3f, OBOE_TFP2); /* Write the taskfile address */ 715 OUTB(sc, 0xff, OBOE_TFP1); 716 OUTB(sc, 0xff, OBOE_TFP0); 717 OUTB(sc, 0x0f, OBOE_REG_1B); 718 OUTB(sc, 0xff, OBOE_REG_1A); 719 OUTB(sc, 0x00, OBOE_ISR); /* XXX: should i do this to disable ints? */ 720 OUTB(sc, 0x80, OBOE_RST); 721 OUTB(sc, 0x0e, OBOE_LOCK); 722} 723 724#define SPEEDCASE(speed, type, divisor) \ 725case speed: \ 726OUTB(sc, OBOE_PMDL_##type, OBOE_PMDL); \ 727OUTB(sc, OBOE_SMDL_##type, OBOE_SMDL); \ 728OUTB(sc, divisor, OBOE_UDIV); \ 729break 730 731static int 732oboe_setbaud(struct oboe_softc *sc, int baud) 733{ 734 int s; 735 736 DPRINTF(("oboe: setting baud to %d\n", baud)); 737 738 s = splir(); 739 740 switch (baud) { 741 SPEEDCASE( 2400, SIR, 0xbf); 742 SPEEDCASE( 9600, SIR, 0x2f); 743 SPEEDCASE( 19200, SIR, 0x17); 744 SPEEDCASE( 38400, SIR, 0x0b); 745 SPEEDCASE( 57600, SIR, 0x07); 746 SPEEDCASE( 115200, SIR, 0x03); 747 SPEEDCASE(1152000, MIR, 0x01); 748 SPEEDCASE(4000000, FIR, 0x00); 749 default: 750 DPRINTF(("oboe: cannot set speed to %d\n", baud)); 751 splx(s); 752 return (EINVAL); 753 } 754 755 OUTB(sc, 0x00, OBOE_RST); 756 OUTB(sc, 0x80, OBOE_RST); 757 OUTB(sc, 0x01, OBOE_REG_9); 758 759 sc->sc_speed = baud; 760 761 splx(s); 762 763 return (0); 764} 765