1 /* $NetBSD: ucbsnd.c,v 1.26 2020/11/21 21:23:48 thorpej Exp $ */ 2 3 /*- 4 * Copyright (c) 2000 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by UCHIYAMA Yasushi. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 /* 33 * Device driver for PHILIPS UCB1200 Advanced modem/audio analog front-end 34 * Audio codec part. 35 * 36 * /dev/ucbsnd0 : sampling rate 22.154kHz monoral 16bit straight PCM device. 37 */ 38 39 #include <sys/cdefs.h> 40 __KERNEL_RCSID(0, "$NetBSD: ucbsnd.c,v 1.26 2020/11/21 21:23:48 thorpej Exp $"); 41 42 #include "opt_use_poll.h" 43 44 #include <sys/param.h> 45 #include <sys/systm.h> 46 #include <sys/conf.h> 47 #include <sys/kmem.h> 48 #include <sys/device.h> 49 #include <sys/proc.h> 50 #include <sys/endian.h> 51 #include <sys/bus.h> 52 #include <sys/intr.h> 53 54 #include <mips/locore.h> 55 #include <mips/cache.h> 56 57 #include <hpcmips/tx/tx39var.h> 58 #include <hpcmips/tx/tx39sibvar.h> 59 #include <hpcmips/tx/tx39sibreg.h> 60 #include <hpcmips/tx/tx39icureg.h> 61 #include <hpcmips/tx/txsnd.h> 62 63 #include <hpcmips/dev/ucb1200var.h> 64 #include <hpcmips/dev/ucb1200reg.h> 65 66 #define AUDIOUNIT(x) (minor(x)&0x0f) 67 #define AUDIODEV(x) (minor(x)&0xf0) 68 69 #ifdef UCBSNDDEBUG 70 int ucbsnd_debug = 1; 71 #define DPRINTF(arg) if (ucbsnd_debug) printf arg; 72 #define DPRINTFN(n, arg) if (ucbsnd_debug > (n)) printf arg; 73 #else 74 #define DPRINTF(arg) 75 #define DPRINTFN(n, arg) 76 #endif 77 78 #define UCBSND_BUFBLOCK 5 79 /* 80 * XXX temporary DMA buffer 81 */ 82 static u_int8_t dmabuf_static[TX39_SIBDMA_SIZE * UCBSND_BUFBLOCK] __attribute__((__aligned__(16))); /* XXX */ 83 static size_t dmabufcnt_static[UCBSND_BUFBLOCK]; /* XXX */ 84 85 enum ucbsnd_state { 86 /* 0 */ UCBSND_IDLE, 87 /* 1 */ UCBSND_INIT, 88 /* 2 */ UCBSND_ENABLE_SAMPLERATE, 89 /* 3 */ UCBSND_ENABLE_OUTPUTPATH, 90 /* 4 */ UCBSND_ENABLE_SETVOLUME, 91 /* 5 */ UCBSND_ENABLE_SPEAKER0, 92 /* 6 */ UCBSND_ENABLE_SPEAKER1, 93 /* 7 */ UCBSND_TRANSITION_PIO, 94 /* 8 */ UCBSND_PIO, 95 /* 9 */ UCBSND_TRANSITION_DISABLE, 96 /*10 */ UCBSND_DISABLE_OUTPUTPATH, 97 /*11 */ UCBSND_DISABLE_SPEAKER0, 98 /*12 */ UCBSND_DISABLE_SPEAKER1, 99 /*13 */ UCBSND_DISABLE_SIB, 100 /*14 */ UCBSND_DMASTART, 101 /*15 */ UCBSND_DMAEND, 102 }; 103 104 struct ring_buf { 105 u_int32_t rb_buf; /* buffer start address */ 106 size_t *rb_bufcnt; /* effective data count (max rb_blksize)*/ 107 108 size_t rb_bufsize; /* total amount of buffer */ 109 int rb_blksize; /* DMA block size */ 110 int rb_maxblks; /* # of blocks in ring */ 111 112 int rb_inp; /* start of input (to buffer) */ 113 int rb_outp; /* output pointer */ 114 }; 115 116 struct ucbsnd_softc { 117 device_t sc_dev; 118 device_t sc_sib; /* parent (TX39 SIB module) */ 119 device_t sc_ucb; /* parent (UCB1200 module) */ 120 tx_chipset_tag_t sc_tc; 121 122 struct tx_sound_tag sc_tag; 123 int sc_mute; 124 125 /* 126 * audio codec state machine 127 */ 128 int sa_transfer_mode; 129 #define UCBSND_TRANSFERMODE_DMA 0 130 #define UCBSND_TRANSFERMODE_PIO 1 131 enum ucbsnd_state sa_state; 132 int sa_snd_attenuation; 133 #define UCBSND_DEFAULT_ATTENUATION 0 /* Full volume */ 134 int sa_snd_rate; /* passed down from SIB module */ 135 int sa_tel_rate; 136 void* sa_sf0ih; 137 void* sa_sndih; 138 int sa_retry; 139 int sa_cnt; /* misc counter */ 140 141 /* 142 * input buffer 143 */ 144 size_t sa_dmacnt; 145 struct ring_buf sc_rb; 146 }; 147 148 int ucbsnd_match(device_t, cfdata_t, void *); 149 void ucbsnd_attach(device_t, device_t, void *); 150 151 int ucbsnd_exec_output(void *); 152 int ucbsnd_busy(void *); 153 154 void ucbsnd_sound_init(struct ucbsnd_softc *); 155 void __ucbsnd_sound_click(tx_sound_tag_t); 156 void __ucbsnd_sound_mute(tx_sound_tag_t, int); 157 158 int ucbsndwrite_subr(struct ucbsnd_softc *, u_int32_t *, size_t, 159 struct uio *); 160 161 int ringbuf_allocate(struct ring_buf *, size_t, int); 162 void ringbuf_deallocate(struct ring_buf *); 163 void ringbuf_reset(struct ring_buf *); 164 int ringbuf_full(struct ring_buf *); 165 void *ringbuf_producer_get(struct ring_buf *); 166 void ringbuf_producer_return(struct ring_buf *, size_t); 167 void *ringbuf_consumer_get(struct ring_buf *, size_t *); 168 void ringbuf_consumer_return(struct ring_buf *); 169 170 CFATTACH_DECL_NEW(ucbsnd, sizeof(struct ucbsnd_softc), 171 ucbsnd_match, ucbsnd_attach, NULL, NULL); 172 173 dev_type_open(ucbsndopen); 174 dev_type_close(ucbsndclose); 175 dev_type_read(ucbsndread); 176 dev_type_write(ucbsndwrite); 177 178 const struct cdevsw ucbsnd_cdevsw = { 179 .d_open = ucbsndopen, 180 .d_close = ucbsndclose, 181 .d_read = ucbsndread, 182 .d_write = ucbsndwrite, 183 .d_ioctl = nullioctl, 184 .d_stop = nostop, 185 .d_tty = notty, 186 .d_poll = nopoll, 187 .d_mmap = nommap, 188 .d_kqfilter = nokqfilter, 189 .d_discard = nodiscard, 190 .d_flag = 0 191 }; 192 193 int 194 ucbsnd_match(device_t parent, cfdata_t cf, void *aux) 195 { 196 197 return (1); 198 } 199 200 void 201 ucbsnd_attach(device_t parent, device_t self, void *aux) 202 { 203 struct ucb1200_attach_args *ucba = aux; 204 struct ucbsnd_softc *sc = device_private(self); 205 tx_chipset_tag_t tc; 206 207 sc->sc_dev = self; 208 tc = sc->sc_tc = ucba->ucba_tc; 209 sc->sc_sib = ucba->ucba_sib; 210 sc->sc_ucb = ucba->ucba_ucb; 211 212 /* register sound functions */ 213 ucbsnd_sound_init(sc); 214 215 sc->sa_snd_rate = ucba->ucba_snd_rate; 216 sc->sa_tel_rate = ucba->ucba_tel_rate; 217 218 sc->sa_snd_attenuation = UCBSND_DEFAULT_ATTENUATION; 219 #define KHZ(a) ((a) / 1000), (((a) % 1000)) 220 printf(": audio %d.%03d kHz telecom %d.%03d kHz", 221 KHZ((tx39sib_clock(sc->sc_sib) * 2) / 222 (sc->sa_snd_rate * 64)), 223 KHZ((tx39sib_clock(sc->sc_sib) * 2) / 224 (sc->sa_tel_rate * 64))); 225 226 ucb1200_state_install(parent, ucbsnd_busy, self, 227 UCB1200_SND_MODULE); 228 229 ringbuf_allocate(&sc->sc_rb, TX39_SIBDMA_SIZE, UCBSND_BUFBLOCK); 230 231 printf("\n"); 232 } 233 234 int 235 ucbsnd_busy(void *arg) 236 { 237 struct ucbsnd_softc *sc = arg; 238 239 return (sc->sa_state != UCBSND_IDLE); 240 } 241 242 int 243 ucbsnd_exec_output(void *arg) 244 { 245 struct ucbsnd_softc *sc = arg; 246 tx_chipset_tag_t tc = sc->sc_tc; 247 txreg_t reg; 248 u_int32_t *buf; 249 size_t bufcnt; 250 251 switch (sc->sa_state) { 252 default: 253 panic("ucbsnd_exec_output: invalid state %d", sc->sa_state); 254 /* NOTREACHED */ 255 break; 256 257 case UCBSND_IDLE: 258 /* nothing to do */ 259 return (0); 260 261 case UCBSND_INIT: 262 sc->sa_sf0ih = tx_intr_establish( 263 tc, MAKEINTR(1, TX39_INTRSTATUS1_SIBSF0INT), 264 IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc); 265 266 sc->sa_state = UCBSND_ENABLE_SAMPLERATE; 267 return (0); 268 269 case UCBSND_ENABLE_SAMPLERATE: 270 /* Enable UCB1200 side sample rate */ 271 reg = TX39_SIBSF0_WRITE; 272 reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLA_REG); 273 reg = TX39_SIBSF0_REGDATA_SET(reg, sc->sa_snd_rate); 274 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg); 275 276 sc->sa_state = UCBSND_ENABLE_OUTPUTPATH; 277 return (0); 278 279 case UCBSND_ENABLE_OUTPUTPATH: 280 /* Enable UCB1200 side */ 281 reg = TX39_SIBSF0_WRITE; 282 reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLB_REG); 283 reg = TX39_SIBSF0_REGDATA_SET(reg, sc->sa_snd_attenuation | 284 UCB1200_AUDIOCTRLB_OUTEN); 285 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg); 286 287 /* Enable SIB side */ 288 reg = tx_conf_read(tc, TX39_SIBCTRL_REG); 289 tx_conf_write(tc, TX39_SIBCTRL_REG, 290 reg | TX39_SIBCTRL_ENSND); 291 292 sc->sa_state = UCBSND_ENABLE_SPEAKER0; 293 sc->sa_retry = 10; 294 return (0); 295 case UCBSND_ENABLE_SPEAKER0: 296 /* Speaker on */ 297 298 reg = TX39_SIBSF0_REGADDR_SET(0, UCB1200_IO_DATA_REG); 299 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg); 300 301 sc->sa_state = UCBSND_ENABLE_SPEAKER1; 302 return (0); 303 304 case UCBSND_ENABLE_SPEAKER1: 305 reg = tx_conf_read(tc, TX39_SIBSF0STAT_REG); 306 if ((TX39_SIBSF0_REGADDR(reg) != UCB1200_IO_DATA_REG) && 307 --sc->sa_retry > 0) { 308 309 sc->sa_state = UCBSND_ENABLE_SPEAKER0; 310 return (0); 311 } 312 313 if (sc->sa_retry <= 0) { 314 printf("ucbsnd_exec_output: subframe0 busy\n"); 315 316 sc->sa_state = UCBSND_IDLE; 317 return (0); 318 } 319 320 reg |= TX39_SIBSF0_WRITE; 321 reg |= UCB1200_IO_DATA_SPEAKER; 322 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg); 323 324 /* 325 * Begin to transfer. 326 */ 327 switch (sc->sa_transfer_mode) { 328 case UCBSND_TRANSFERMODE_DMA: 329 sc->sa_state = UCBSND_DMASTART; 330 sc->sa_dmacnt = 0; 331 break; 332 case UCBSND_TRANSFERMODE_PIO: 333 sc->sa_state = UCBSND_TRANSITION_PIO; 334 break; 335 } 336 337 return (0); 338 case UCBSND_DMASTART: 339 /* get data */ 340 if (sc->sa_dmacnt) /* return previous buffer */ 341 ringbuf_consumer_return(&sc->sc_rb); 342 buf = ringbuf_consumer_get(&sc->sc_rb, &bufcnt); 343 if (buf == 0) { 344 sc->sa_state = UCBSND_DMAEND; 345 return (0); 346 } 347 348 if (sc->sa_dmacnt == 0) { 349 /* change interrupt source */ 350 if (sc->sa_sf0ih) { 351 tx_intr_disestablish(tc, sc->sa_sf0ih); 352 sc->sa_sf0ih = 0; 353 } 354 sc->sa_sndih = tx_intr_establish( 355 tc, MAKEINTR(1, TX39_INTRSTATUS1_SND1_0INT), 356 IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc); 357 } else { 358 wakeup(&sc->sc_rb); 359 } 360 361 /* set DMA buffer address */ 362 tx_conf_write(tc, TX39_SIBSNDTXSTART_REG, 363 MIPS_KSEG0_TO_PHYS(buf)); 364 365 /* set DMA buffer size */ 366 tx_conf_write(tc, TX39_SIBSIZE_REG, 367 TX39_SIBSIZE_SNDSIZE_SET(0, bufcnt)); 368 369 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, TX39_SIBSF0_SNDVALID); 370 371 /* kick DMA */ 372 reg = tx_conf_read(tc, TX39_SIBDMACTRL_REG); 373 reg |= TX39_SIBDMACTRL_ENDMATXSND; 374 tx_conf_write(tc, TX39_SIBDMACTRL_REG, reg); 375 376 /* set next */ 377 sc->sa_dmacnt += bufcnt; 378 379 break; 380 381 case UCBSND_DMAEND: 382 sc->sa_state = UCBSND_TRANSITION_DISABLE; 383 break; 384 case UCBSND_TRANSITION_PIO: 385 /* change interrupt source */ 386 if (sc->sa_sf0ih) { 387 tx_intr_disestablish(tc, sc->sa_sf0ih); 388 sc->sa_sf0ih = 0; 389 } 390 sc->sa_sndih = tx_intr_establish( 391 tc, MAKEINTR(1, TX39_INTRSTATUS1_SNDININT), 392 IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc); 393 394 sc->sa_state = UCBSND_PIO; 395 sc->sa_cnt = 0; 396 return (0); 397 398 case UCBSND_PIO: 399 { 400 /* PIO test routine */ 401 int dummy_data = sc->sa_cnt * 3; 402 tx_conf_write(tc, TX39_SIBSNDHOLD_REG, 403 dummy_data << 16 | dummy_data); 404 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, TX39_SIBSF0_SNDVALID); 405 if (sc->sa_cnt++ > 50) { 406 sc->sa_state = UCBSND_TRANSITION_DISABLE; 407 } 408 return (0); 409 } 410 case UCBSND_TRANSITION_DISABLE: 411 /* change interrupt source */ 412 if (sc->sa_sndih) { 413 tx_intr_disestablish(tc, sc->sa_sndih); 414 sc->sa_sndih = 0; 415 } 416 sc->sa_sf0ih = tx_intr_establish( 417 tc, MAKEINTR(1, TX39_INTRSTATUS1_SIBSF0INT), 418 IST_EDGE, IPL_TTY, ucbsnd_exec_output, sc); 419 420 sc->sa_state = UCBSND_DISABLE_OUTPUTPATH; 421 return (0); 422 423 case UCBSND_DISABLE_OUTPUTPATH: 424 /* disable codec output path and mute */ 425 reg = TX39_SIBSF0_WRITE; 426 reg = TX39_SIBSF0_REGADDR_SET(reg, UCB1200_AUDIOCTRLB_REG); 427 reg = TX39_SIBSF0_REGDATA_SET(reg, UCB1200_AUDIOCTRLB_MUTE); 428 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg); 429 430 sc->sa_state = UCBSND_DISABLE_SPEAKER0; 431 sc->sa_retry = 10; 432 return (0); 433 434 case UCBSND_DISABLE_SPEAKER0: 435 /* Speaker off */ 436 reg = TX39_SIBSF0_REGADDR_SET(0, UCB1200_IO_DATA_REG); 437 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg); 438 439 sc->sa_state = UCBSND_DISABLE_SPEAKER1; 440 return (0); 441 442 case UCBSND_DISABLE_SPEAKER1: 443 reg = tx_conf_read(tc, TX39_SIBSF0STAT_REG); 444 if ((TX39_SIBSF0_REGADDR(reg) != UCB1200_IO_DATA_REG) && 445 --sc->sa_retry > 0) { 446 447 sc->sa_state = UCBSND_DISABLE_SPEAKER0; 448 return (0); 449 } 450 451 if (sc->sa_retry <= 0) { 452 printf("ucbsnd_exec_output: subframe0 busy\n"); 453 454 sc->sa_state = UCBSND_IDLE; 455 return (0); 456 } 457 458 reg |= TX39_SIBSF0_WRITE; 459 reg &= ~UCB1200_IO_DATA_SPEAKER; 460 tx_conf_write(tc, TX39_SIBSF0CTRL_REG, reg); 461 462 sc->sa_state = UCBSND_DISABLE_SIB; 463 return (0); 464 465 case UCBSND_DISABLE_SIB: 466 /* Disable SIB side */ 467 reg = tx_conf_read(tc, TX39_SIBCTRL_REG); 468 reg &= ~TX39_SIBCTRL_ENSND; 469 tx_conf_write(tc, TX39_SIBCTRL_REG, reg); 470 471 /* end audio disable sequence */ 472 if (sc->sa_sf0ih) { 473 tx_intr_disestablish(tc, sc->sa_sf0ih); 474 sc->sa_sf0ih = 0; 475 } 476 sc->sa_state = UCBSND_IDLE; 477 478 return (0); 479 } 480 481 return (0); 482 } 483 484 /* 485 * global sound interface. 486 */ 487 void 488 ucbsnd_sound_init(struct ucbsnd_softc *sc) 489 { 490 tx_sound_tag_t ts = &sc->sc_tag; 491 tx_chipset_tag_t tc = sc->sc_tc; 492 493 ts->ts_v = sc; 494 ts->ts_click = __ucbsnd_sound_click; 495 ts->ts_mute = __ucbsnd_sound_mute; 496 497 tx_conf_register_sound(tc, ts); 498 } 499 500 void 501 __ucbsnd_sound_click(tx_sound_tag_t arg) 502 { 503 struct ucbsnd_softc *sc = (void*)arg; 504 505 if (!sc->sc_mute && sc->sa_state == UCBSND_IDLE) { 506 sc->sa_transfer_mode = UCBSND_TRANSFERMODE_PIO; 507 sc->sa_state = UCBSND_INIT; 508 ucbsnd_exec_output((void*)sc); 509 } 510 } 511 512 void 513 __ucbsnd_sound_mute(tx_sound_tag_t arg, int onoff) 514 { 515 struct ucbsnd_softc *sc = (void*)arg; 516 517 sc->sc_mute = onoff; 518 } 519 520 /* 521 * device access 522 */ 523 extern struct cfdriver ucbsnd_cd; 524 525 int 526 ucbsndopen(dev_t dev, int flags, int ifmt, struct lwp *l) 527 { 528 int unit = AUDIOUNIT(dev); 529 struct ucbsnd_softc *sc; 530 int s; 531 532 sc = device_lookup_private(&ucbsnd_cd, unit); 533 if (sc == NULL) 534 return (ENXIO); 535 536 s = splvm(); 537 ringbuf_reset(&sc->sc_rb); 538 splx(s); 539 540 return (0); 541 } 542 543 int 544 ucbsndclose(dev_t dev, int flags, int ifmt, struct lwp *l) 545 { 546 int unit = AUDIOUNIT(dev); 547 struct ucbsnd_softc *sc; 548 549 sc = device_lookup_private(&ucbsnd_cd, unit); 550 if (sc == NULL) 551 return (ENXIO); 552 553 return (0); 554 } 555 556 int 557 ucbsndread(dev_t dev, struct uio *uio, int ioflag) 558 { 559 int unit = AUDIOUNIT(dev); 560 struct ucbsnd_softc *sc; 561 int error = 0; 562 563 sc = device_lookup_private(&ucbsnd_cd, unit); 564 if (sc == NULL) 565 return (ENXIO); 566 /* not supported yet */ 567 568 return (error); 569 } 570 571 int 572 ucbsndwrite_subr(struct ucbsnd_softc *sc, u_int32_t *buf, size_t bufsize, 573 struct uio *uio) 574 { 575 int i, s, error; 576 577 error = uiomove(buf, bufsize, uio); 578 /* 579 * inverse endian for UCB1200 580 */ 581 for (i = 0; i < bufsize / sizeof(int); i++) 582 buf[i] = htobe32(buf[i]); 583 mips_dcache_wbinv_range((vaddr_t)buf, bufsize); 584 585 ringbuf_producer_return(&sc->sc_rb, bufsize); 586 587 s = splvm(); 588 if (sc->sa_state == UCBSND_IDLE && ringbuf_full(&sc->sc_rb)) { 589 sc->sa_transfer_mode = UCBSND_TRANSFERMODE_DMA; 590 sc->sa_state = UCBSND_INIT; 591 ucbsnd_exec_output((void*)sc); 592 } 593 splx(s); 594 595 return (error); 596 } 597 598 int 599 ucbsndwrite(dev_t dev, struct uio *uio, int ioflag) 600 { 601 int unit = AUDIOUNIT(dev); 602 struct ucbsnd_softc *sc; 603 int len, error = 0; 604 int i, n, s, rest; 605 void *buf; 606 607 sc = device_lookup_private(&ucbsnd_cd, unit); 608 if (sc == NULL) 609 return (ENXIO); 610 611 len = uio->uio_resid; 612 n = (len + TX39_SIBDMA_SIZE - 1) / TX39_SIBDMA_SIZE; 613 rest = len % TX39_SIBDMA_SIZE; 614 615 if (rest) 616 --n; 617 618 for (i = 0; i < n; i++) { 619 while (!(buf = ringbuf_producer_get(&sc->sc_rb))) { 620 error = tsleep(&sc->sc_rb, PRIBIO, "ucbsnd", 1000); 621 if (error) 622 goto errout; 623 } 624 625 error = ucbsndwrite_subr(sc, buf, TX39_SIBDMA_SIZE, uio); 626 if (error) 627 goto out; 628 } 629 630 if (rest) { 631 while (!(buf = ringbuf_producer_get(&sc->sc_rb))) { 632 error = tsleep(&sc->sc_rb, PRIBIO, "ucbsnd", 1000); 633 if (error) 634 goto errout; 635 } 636 637 error = ucbsndwrite_subr(sc, buf, rest, uio); 638 } 639 640 out: 641 return (error); 642 errout: 643 printf("%s: timeout. reset ring-buffer.\n", device_xname(sc->sc_dev)); 644 s = splvm(); 645 ringbuf_reset(&sc->sc_rb); 646 splx(s); 647 648 return (error); 649 } 650 651 /* 652 * Ring buffer. 653 */ 654 int 655 ringbuf_allocate(struct ring_buf *rb, size_t blksize, int maxblk) 656 { 657 rb->rb_bufsize = blksize * maxblk; 658 rb->rb_blksize = blksize; 659 rb->rb_maxblks = maxblk; 660 #if notyet 661 rb->rb_buf = (u_int32_t)kmem_alloc(rb->rb_bufsize, KM_SLEEP); 662 #else 663 rb->rb_buf = (u_int32_t)dmabuf_static; 664 #endif 665 if (rb->rb_buf == 0) { 666 printf("ringbuf_allocate: can't allocate buffer\n"); 667 return (1); 668 } 669 memset((char*)rb->rb_buf, 0, rb->rb_bufsize); 670 #if notyet 671 rb->rb_bufcnt = kmem_alloc(rb->rb_maxblks * sizeof(size_t), KM_SLEEP); 672 #else 673 rb->rb_bufcnt = dmabufcnt_static; 674 #endif 675 if (rb->rb_bufcnt == 0) { 676 printf("ringbuf_allocate: can't allocate buffer\n"); 677 return (1); 678 } 679 memset((char*)rb->rb_bufcnt, 0, rb->rb_maxblks * sizeof(size_t)); 680 681 ringbuf_reset(rb); 682 683 return (0); 684 } 685 686 void 687 ringbuf_deallocate(struct ring_buf *rb) 688 { 689 #if notyet 690 kmem_free((void*)rb->rb_buf, rb->rb_bufsize); 691 kmem_free(rb->rb_bufcnt, rb->rb_maxblks * sizeof(size_t)); 692 #endif 693 } 694 695 void 696 ringbuf_reset(struct ring_buf *rb) 697 { 698 rb->rb_outp = 0; 699 rb->rb_inp = 0; 700 } 701 702 int 703 ringbuf_full(struct ring_buf *rb) 704 { 705 int ret; 706 707 ret = rb->rb_outp == rb->rb_maxblks; 708 709 return (ret); 710 } 711 712 void* 713 ringbuf_producer_get(struct ring_buf *rb) 714 { 715 u_int32_t ret; 716 int s; 717 718 s = splvm(); 719 ret = ringbuf_full(rb) ? 0 : 720 rb->rb_buf + rb->rb_inp * rb->rb_blksize; 721 splx(s); 722 723 return (void *)ret; 724 } 725 726 void 727 ringbuf_producer_return(struct ring_buf *rb, size_t cnt) 728 { 729 int s; 730 731 assert(cnt <= rb->rb_blksize); 732 733 s = splvm(); 734 rb->rb_outp++; 735 736 rb->rb_bufcnt[rb->rb_inp] = cnt; 737 rb->rb_inp = (rb->rb_inp + 1) % rb->rb_maxblks; 738 splx(s); 739 } 740 741 void* 742 ringbuf_consumer_get(struct ring_buf *rb, size_t *cntp) 743 { 744 u_int32_t p; 745 int idx; 746 747 if (rb->rb_outp == 0) 748 return (0); 749 750 idx = (rb->rb_inp - rb->rb_outp + rb->rb_maxblks) % rb->rb_maxblks; 751 752 p = rb->rb_buf + idx * rb->rb_blksize; 753 *cntp = rb->rb_bufcnt[idx]; 754 755 return (void *)p; 756 } 757 758 void 759 ringbuf_consumer_return(struct ring_buf *rb) 760 { 761 762 if (rb->rb_outp > 0) 763 rb->rb_outp--; 764 } 765
Indexes created Sat Sep 20 22:09:52 GMT 2025