intio.c revision 1.43
1 /* $NetBSD: intio.c,v 1.43 2012/01/27 18:53:06 para Exp $ */ 2 3 /*- 4 * Copyright (c) 1998 The NetBSD Foundation, Inc. 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 * 16 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 * POSSIBILITY OF SUCH DAMAGE. 27 */ 28 29 /* 30 * NetBSD/x68k internal I/O virtual bus. 31 */ 32 33 #include <sys/cdefs.h> 34 __KERNEL_RCSID(0, "$NetBSD: intio.c,v 1.43 2012/01/27 18:53:06 para Exp $"); 35 36 #include <sys/param.h> 37 #include <sys/systm.h> 38 #include <sys/device.h> 39 #include <sys/malloc.h> 40 #include <sys/mbuf.h> 41 #include <sys/extent.h> 42 #include <uvm/uvm_extern.h> 43 44 #include <machine/bus.h> 45 #include <machine/cpu.h> 46 #include <machine/frame.h> 47 48 #include <arch/x68k/dev/intiovar.h> 49 50 51 /* 52 * bus_space(9) interface 53 */ 54 static int intio_bus_space_map(bus_space_tag_t, bus_addr_t, bus_size_t, int, bus_space_handle_t *); 55 static void intio_bus_space_unmap(bus_space_tag_t, bus_space_handle_t, bus_size_t); 56 static int intio_bus_space_subregion(bus_space_tag_t, bus_space_handle_t, bus_size_t, bus_size_t, bus_space_handle_t *); 57 58 static struct x68k_bus_space intio_bus = { 59 #if 0 60 X68K_INTIO_BUS, 61 #endif 62 intio_bus_space_map, intio_bus_space_unmap, intio_bus_space_subregion, 63 x68k_bus_space_alloc, x68k_bus_space_free, 64 #if 0 65 x68k_bus_space_barrier, 66 #endif 67 68 0 69 }; 70 71 /* 72 * bus_dma(9) interface 73 */ 74 #define INTIO_DMA_BOUNCE_THRESHOLD (16 * 1024 * 1024) 75 int _intio_bus_dmamap_create(bus_dma_tag_t, bus_size_t, int, 76 bus_size_t, bus_size_t, int, bus_dmamap_t *); 77 void _intio_bus_dmamap_destroy(bus_dma_tag_t, bus_dmamap_t); 78 int _intio_bus_dmamap_load(bus_dma_tag_t, bus_dmamap_t, void *, 79 bus_size_t, struct proc *, int); 80 int _intio_bus_dmamap_load_mbuf(bus_dma_tag_t, bus_dmamap_t, 81 struct mbuf *, int); 82 int _intio_bus_dmamap_load_uio(bus_dma_tag_t, bus_dmamap_t, 83 struct uio *, int); 84 int _intio_bus_dmamap_load_raw(bus_dma_tag_t, bus_dmamap_t, 85 bus_dma_segment_t *, int, bus_size_t, int); 86 void _intio_bus_dmamap_unload(bus_dma_tag_t, bus_dmamap_t); 87 void _intio_bus_dmamap_sync(bus_dma_tag_t, bus_dmamap_t, 88 bus_addr_t, bus_size_t, int); 89 90 int _intio_bus_dmamem_alloc(bus_dma_tag_t, bus_size_t, bus_size_t, 91 bus_size_t, bus_dma_segment_t *, int, int *, int); 92 93 int _intio_dma_alloc_bouncebuf(bus_dma_tag_t, bus_dmamap_t, 94 bus_size_t, int); 95 void _intio_dma_free_bouncebuf(bus_dma_tag_t, bus_dmamap_t); 96 97 struct x68k_bus_dma intio_bus_dma = { 98 INTIO_DMA_BOUNCE_THRESHOLD, 99 _intio_bus_dmamap_create, 100 _intio_bus_dmamap_destroy, 101 _intio_bus_dmamap_load, 102 _intio_bus_dmamap_load_mbuf, 103 _intio_bus_dmamap_load_uio, 104 _intio_bus_dmamap_load_raw, 105 _intio_bus_dmamap_unload, 106 _intio_bus_dmamap_sync, 107 _intio_bus_dmamem_alloc, 108 x68k_bus_dmamem_free, 109 x68k_bus_dmamem_map, 110 x68k_bus_dmamem_unmap, 111 x68k_bus_dmamem_mmap, 112 }; 113 114 /* 115 * autoconf stuff 116 */ 117 static int intio_match(device_t, cfdata_t, void *); 118 static void intio_attach(device_t, device_t, void *); 119 static int intio_search(device_t, cfdata_t, const int *, void *); 120 static int intio_print(void *, const char *); 121 static void intio_alloc_system_ports(struct intio_softc*); 122 123 CFATTACH_DECL_NEW(intio, sizeof(struct intio_softc), 124 intio_match, intio_attach, NULL, NULL); 125 126 extern struct cfdriver intio_cd; 127 128 static int intio_attached; 129 130 static struct intio_interrupt_vector { 131 intio_intr_handler_t iiv_handler; 132 void *iiv_arg; 133 struct evcnt *iiv_evcnt; 134 } iiv[256] = {{0,},}; 135 136 #ifdef DEBUG 137 int intio_debug = 0; 138 #endif 139 140 static int 141 intio_match(device_t parent, cfdata_t cf, void *aux) 142 { 143 144 if (strcmp(aux, intio_cd.cd_name) != 0) 145 return (0); 146 if (intio_attached) 147 return (0); 148 149 return (1); 150 } 151 152 static void 153 intio_attach(device_t parent, device_t self, void *aux) 154 { 155 struct intio_softc *sc = device_private(self); 156 struct intio_attach_args ia; 157 158 intio_attached = 1; 159 160 aprint_normal(" mapped at %8p\n", intiobase); 161 162 sc->sc_map = extent_create("intiomap", 163 INTIOBASE, 164 INTIOBASE + 0x400000, 165 NULL, 0, EX_NOWAIT); 166 intio_alloc_system_ports(sc); 167 168 sc->sc_bst = &intio_bus; 169 sc->sc_bst->x68k_bus_device = self; 170 sc->sc_dmat = &intio_bus_dma; 171 sc->sc_dmac = 0; 172 173 memset(iiv, 0, sizeof(struct intio_interrupt_vector) * 256); 174 175 ia.ia_bst = sc->sc_bst; 176 ia.ia_dmat = sc->sc_dmat; 177 178 config_search_ia(intio_search, self, "intio", &ia); 179 } 180 181 static int 182 intio_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux) 183 { 184 struct intio_softc *sc = device_private(parent); 185 struct intio_attach_args *ia = aux; 186 187 ia->ia_bst = sc->sc_bst; 188 ia->ia_dmat = sc->sc_dmat; 189 ia->ia_name = cf->cf_name; 190 ia->ia_addr = cf->cf_addr; 191 ia->ia_intr = cf->cf_intr; 192 ia->ia_dma = cf->cf_dma; 193 ia->ia_dmaintr = cf->cf_dmaintr; 194 195 if (config_match(parent, cf, ia) > 0) 196 config_attach(parent, cf, ia, intio_print); 197 198 return (0); 199 } 200 201 static int 202 intio_print(void *aux, const char *name) 203 { 204 struct intio_attach_args *ia = aux; 205 206 /* if (ia->ia_addr > 0) */ 207 aprint_normal(" addr 0x%06x", ia->ia_addr); 208 if (ia->ia_intr > 0) 209 aprint_normal(" intr 0x%02x", ia->ia_intr); 210 if (ia->ia_dma >= 0) { 211 aprint_normal(" using DMA ch%d", ia->ia_dma); 212 if (ia->ia_dmaintr > 0) 213 aprint_normal(" intr 0x%02x and 0x%02x", 214 ia->ia_dmaintr, ia->ia_dmaintr+1); 215 } 216 217 return (QUIET); 218 } 219 220 /* 221 * intio memory map manager 222 */ 223 224 int 225 intio_map_allocate_region(device_t parent, struct intio_attach_args *ia, 226 enum intio_map_flag flag) 227 { 228 struct intio_softc *sc = device_private(parent); 229 struct extent *map = sc->sc_map; 230 int r; 231 232 r = extent_alloc_region(map, ia->ia_addr, ia->ia_size, 0); 233 #ifdef DEBUG 234 if (intio_debug) 235 extent_print(map); 236 #endif 237 if (r == 0) { 238 if (flag != INTIO_MAP_ALLOCATE) 239 extent_free(map, ia->ia_addr, ia->ia_size, 0); 240 return 0; 241 } 242 243 return -1; 244 } 245 246 int 247 intio_map_free_region(device_t parent, struct intio_attach_args *ia) 248 { 249 struct intio_softc *sc = device_private(parent); 250 struct extent *map = sc->sc_map; 251 252 extent_free(map, ia->ia_addr, ia->ia_size, 0); 253 #ifdef DEBUG 254 if (intio_debug) 255 extent_print(map); 256 #endif 257 return 0; 258 } 259 260 void 261 intio_alloc_system_ports(struct intio_softc *sc) 262 { 263 extent_alloc_region(sc->sc_map, INTIO_SYSPORT, 16, 0); 264 extent_alloc_region(sc->sc_map, INTIO_SICILIAN, 0x2000, 0); 265 } 266 267 268 /* 269 * intio bus space stuff. 270 */ 271 static int 272 intio_bus_space_map(bus_space_tag_t t, bus_addr_t bpa, bus_size_t size, 273 int flags, bus_space_handle_t *bshp) 274 { 275 /* 276 * Intio bus is mapped permanently. 277 */ 278 *bshp = (bus_space_handle_t)IIOV(bpa); 279 280 /* 281 * Some devices are mapped on odd or even addresses only. 282 */ 283 if ((flags & BUS_SPACE_MAP_SHIFTED_MASK) == BUS_SPACE_MAP_SHIFTED_ODD) 284 *bshp += 0x80000001; 285 if ((flags & BUS_SPACE_MAP_SHIFTED_MASK) == BUS_SPACE_MAP_SHIFTED_EVEN) 286 *bshp += 0x80000000; 287 288 return (0); 289 } 290 291 static void 292 intio_bus_space_unmap(bus_space_tag_t t, bus_space_handle_t bsh, 293 bus_size_t size) 294 { 295 return; 296 } 297 298 static int 299 intio_bus_space_subregion(bus_space_tag_t t, bus_space_handle_t bsh, 300 bus_size_t offset, bus_size_t size, bus_space_handle_t *nbshp) 301 { 302 303 *nbshp = bsh + offset; 304 return (0); 305 } 306 307 308 /* 309 * interrupt handler 310 */ 311 int 312 intio_intr_establish(int vector, const char *name, intio_intr_handler_t handler, 313 void *arg) 314 { 315 316 return intio_intr_establish_ext(vector, name, "intr", handler, arg); 317 } 318 319 int 320 intio_intr_establish_ext(int vector, const char *name1, const char *name2, 321 intio_intr_handler_t handler, void *arg) 322 { 323 struct evcnt *evcnt; 324 325 if (vector < 16) 326 panic("Invalid interrupt vector"); 327 if (iiv[vector].iiv_handler) 328 return EBUSY; 329 330 evcnt = malloc(sizeof(*evcnt), M_DEVBUF, M_NOWAIT); 331 if (evcnt == NULL) 332 return ENOMEM; 333 evcnt_attach_dynamic(evcnt, EVCNT_TYPE_INTR, NULL, name1, name2); 334 335 iiv[vector].iiv_handler = handler; 336 iiv[vector].iiv_arg = arg; 337 iiv[vector].iiv_evcnt = evcnt; 338 339 return 0; 340 } 341 342 int 343 intio_intr_disestablish(int vector, void *arg) 344 { 345 if (iiv[vector].iiv_handler == 0 || iiv[vector].iiv_arg != arg) 346 return EINVAL; 347 iiv[vector].iiv_handler = 0; 348 iiv[vector].iiv_arg = 0; 349 evcnt_detach(iiv[vector].iiv_evcnt); 350 free(iiv[vector].iiv_evcnt, M_DEVBUF); 351 352 return 0; 353 } 354 355 int 356 intio_intr(struct frame *frame) 357 { 358 int vector = frame->f_vector / 4; 359 360 if (iiv[vector].iiv_handler == 0) { 361 printf("Stray interrupt: %d type %x, pc %x\n", 362 vector, frame->f_format, frame->f_pc); 363 return 0; 364 } 365 366 iiv[vector].iiv_evcnt->ev_count++; 367 368 return (*(iiv[vector].iiv_handler))(iiv[vector].iiv_arg); 369 } 370 371 /* 372 * Intio I/O controller interrupt 373 */ 374 static u_int8_t intio_ivec = 0; 375 376 void 377 intio_set_ivec(int vec) 378 { 379 vec &= 0xfc; 380 381 if (intio_ivec && intio_ivec != (vec & 0xfc)) 382 panic("Wrong interrupt vector for Sicilian."); 383 384 intio_ivec = vec; 385 intio_set_sicilian_ivec(vec); 386 } 387 388 389 /* 390 * intio bus DMA stuff. stolen from arch/i386/isa/isa_machdep.c 391 */ 392 393 /* 394 * Create an INTIO DMA map. 395 */ 396 int 397 _intio_bus_dmamap_create(bus_dma_tag_t t, bus_size_t size, int nsegments, 398 bus_size_t maxsegsz, bus_size_t boundary, int flags, bus_dmamap_t *dmamp) 399 { 400 struct intio_dma_cookie *cookie; 401 bus_dmamap_t map; 402 int error, cookieflags; 403 size_t cookiesize; 404 extern paddr_t avail_end; 405 406 /* Call common function to create the basic map. */ 407 error = x68k_bus_dmamap_create(t, size, nsegments, maxsegsz, boundary, 408 flags, dmamp); 409 if (error) 410 return (error); 411 412 map = *dmamp; 413 map->x68k_dm_cookie = NULL; 414 415 cookiesize = sizeof(struct intio_dma_cookie); 416 417 /* 418 * INTIO only has 24-bits of address space. This means 419 * we can't DMA to pages over 16M. In order to DMA to 420 * arbitrary buffers, we use "bounce buffers" - pages 421 * in memory below the 16M boundary. On DMA reads, 422 * DMA happens to the bounce buffers, and is copied into 423 * the caller's buffer. On writes, data is copied into 424 * but bounce buffer, and the DMA happens from those 425 * pages. To software using the DMA mapping interface, 426 * this looks simply like a data cache. 427 * 428 * If we have more than 16M of RAM in the system, we may 429 * need bounce buffers. We check and remember that here. 430 * 431 * ...or, there is an opposite case. The most segments 432 * a transfer will require is (maxxfer / PAGE_SIZE) + 1. If 433 * the caller can't handle that many segments (e.g. the 434 * DMAC), we may have to bounce it as well. 435 */ 436 if (avail_end <= t->_bounce_thresh) 437 /* Bouncing not necessary due to memory size. */ 438 map->x68k_dm_bounce_thresh = 0; 439 cookieflags = 0; 440 if (map->x68k_dm_bounce_thresh != 0 || 441 ((map->x68k_dm_size / PAGE_SIZE) + 1) > map->x68k_dm_segcnt) { 442 cookieflags |= ID_MIGHT_NEED_BOUNCE; 443 cookiesize += (sizeof(bus_dma_segment_t) * map->x68k_dm_segcnt); 444 } 445 446 /* 447 * Allocate our cookie. 448 */ 449 cookie = malloc(cookiesize, M_DMAMAP, 450 ((flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK) | M_ZERO); 451 if (cookie == NULL) { 452 error = ENOMEM; 453 goto out; 454 } 455 cookie->id_flags = cookieflags; 456 map->x68k_dm_cookie = cookie; 457 458 if (cookieflags & ID_MIGHT_NEED_BOUNCE) { 459 /* 460 * Allocate the bounce pages now if the caller 461 * wishes us to do so. 462 */ 463 if ((flags & BUS_DMA_ALLOCNOW) == 0) 464 goto out; 465 466 error = _intio_dma_alloc_bouncebuf(t, map, size, flags); 467 } 468 469 out: 470 if (error) { 471 if (map->x68k_dm_cookie != NULL) 472 free(map->x68k_dm_cookie, M_DMAMAP); 473 x68k_bus_dmamap_destroy(t, map); 474 } 475 return (error); 476 } 477 478 /* 479 * Destroy an INTIO DMA map. 480 */ 481 void 482 _intio_bus_dmamap_destroy(bus_dma_tag_t t, bus_dmamap_t map) 483 { 484 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 485 486 /* 487 * Free any bounce pages this map might hold. 488 */ 489 if (cookie->id_flags & ID_HAS_BOUNCE) 490 _intio_dma_free_bouncebuf(t, map); 491 492 free(cookie, M_DMAMAP); 493 x68k_bus_dmamap_destroy(t, map); 494 } 495 496 /* 497 * Load an INTIO DMA map with a linear buffer. 498 */ 499 int 500 _intio_bus_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf, 501 bus_size_t buflen, struct proc *p, int flags) 502 { 503 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 504 int error; 505 506 /* 507 * Make sure that on error condition we return "no valid mappings." 508 */ 509 map->dm_mapsize = 0; 510 map->dm_nsegs = 0; 511 512 /* 513 * Try to load the map the normal way. If this errors out, 514 * and we can bounce, we will. 515 */ 516 error = x68k_bus_dmamap_load(t, map, buf, buflen, p, flags); 517 if (error == 0 || 518 (error != 0 && (cookie->id_flags & ID_MIGHT_NEED_BOUNCE) == 0)) 519 return (error); 520 521 /* 522 * Allocate bounce pages, if necessary. 523 */ 524 if ((cookie->id_flags & ID_HAS_BOUNCE) == 0) { 525 error = _intio_dma_alloc_bouncebuf(t, map, buflen, flags); 526 if (error) 527 return (error); 528 } 529 530 /* 531 * Cache a pointer to the caller's buffer and load the DMA map 532 * with the bounce buffer. 533 */ 534 cookie->id_origbuf = buf; 535 cookie->id_origbuflen = buflen; 536 cookie->id_buftype = ID_BUFTYPE_LINEAR; 537 error = x68k_bus_dmamap_load(t, map, cookie->id_bouncebuf, buflen, 538 p, flags); 539 if (error) { 540 /* 541 * Free the bounce pages, unless our resources 542 * are reserved for our exclusive use. 543 */ 544 if ((map->x68k_dm_flags & BUS_DMA_ALLOCNOW) == 0) 545 _intio_dma_free_bouncebuf(t, map); 546 return (error); 547 } 548 549 /* ...so _intio_bus_dmamap_sync() knows we're bouncing */ 550 cookie->id_flags |= ID_IS_BOUNCING; 551 return (0); 552 } 553 554 /* 555 * Like _intio_bus_dmamap_load(), but for mbufs. 556 */ 557 int 558 _intio_bus_dmamap_load_mbuf(bus_dma_tag_t t, bus_dmamap_t map, struct mbuf *m0, 559 int flags) 560 { 561 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 562 int error; 563 564 /* 565 * Make sure on error condition we return "no valid mappings." 566 */ 567 map->dm_mapsize = 0; 568 map->dm_nsegs = 0; 569 570 #ifdef DIAGNOSTIC 571 if ((m0->m_flags & M_PKTHDR) == 0) 572 panic("_intio_bus_dmamap_load_mbuf: no packet header"); 573 #endif 574 575 if (m0->m_pkthdr.len > map->x68k_dm_size) 576 return (EINVAL); 577 578 /* 579 * Try to load the map the normal way. If this errors out, 580 * and we can bounce, we will. 581 */ 582 error = x68k_bus_dmamap_load_mbuf(t, map, m0, flags); 583 if (error == 0 || 584 (error != 0 && (cookie->id_flags & ID_MIGHT_NEED_BOUNCE) == 0)) 585 return (error); 586 587 /* 588 * Allocate bounce pages, if necessary. 589 */ 590 if ((cookie->id_flags & ID_HAS_BOUNCE) == 0) { 591 error = _intio_dma_alloc_bouncebuf(t, map, m0->m_pkthdr.len, 592 flags); 593 if (error) 594 return (error); 595 } 596 597 /* 598 * Cache a pointer to the caller's buffer and load the DMA map 599 * with the bounce buffer. 600 */ 601 cookie->id_origbuf = m0; 602 cookie->id_origbuflen = m0->m_pkthdr.len; /* not really used */ 603 cookie->id_buftype = ID_BUFTYPE_MBUF; 604 error = x68k_bus_dmamap_load(t, map, cookie->id_bouncebuf, 605 m0->m_pkthdr.len, NULL, flags); 606 if (error) { 607 /* 608 * Free the bounce pages, unless our resources 609 * are reserved for our exclusive use. 610 */ 611 if ((map->x68k_dm_flags & BUS_DMA_ALLOCNOW) == 0) 612 _intio_dma_free_bouncebuf(t, map); 613 return (error); 614 } 615 616 /* ...so _intio_bus_dmamap_sync() knows we're bouncing */ 617 cookie->id_flags |= ID_IS_BOUNCING; 618 return (0); 619 } 620 621 /* 622 * Like _intio_bus_dmamap_load(), but for uios. 623 */ 624 int 625 _intio_bus_dmamap_load_uio(bus_dma_tag_t t, bus_dmamap_t map, struct uio *uio, 626 int flags) 627 { 628 panic("_intio_bus_dmamap_load_uio: not implemented"); 629 } 630 631 /* 632 * Like _intio_bus_dmamap_load(), but for raw memory allocated with 633 * bus_dmamem_alloc(). 634 */ 635 int 636 _intio_bus_dmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map, 637 bus_dma_segment_t *segs, int nsegs, bus_size_t size, int flags) 638 { 639 640 panic("_intio_bus_dmamap_load_raw: not implemented"); 641 } 642 643 /* 644 * Unload an INTIO DMA map. 645 */ 646 void 647 _intio_bus_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map) 648 { 649 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 650 651 /* 652 * If we have bounce pages, free them, unless they're 653 * reserved for our exclusive use. 654 */ 655 if ((cookie->id_flags & ID_HAS_BOUNCE) && 656 (map->x68k_dm_flags & BUS_DMA_ALLOCNOW) == 0) 657 _intio_dma_free_bouncebuf(t, map); 658 659 cookie->id_flags &= ~ID_IS_BOUNCING; 660 cookie->id_buftype = ID_BUFTYPE_INVALID; 661 662 /* 663 * Do the generic bits of the unload. 664 */ 665 x68k_bus_dmamap_unload(t, map); 666 } 667 668 /* 669 * Synchronize an INTIO DMA map. 670 */ 671 void 672 _intio_bus_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset, 673 bus_size_t len, int ops) 674 { 675 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 676 677 /* 678 * Mixing PRE and POST operations is not allowed. 679 */ 680 if ((ops & (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE)) != 0 && 681 (ops & (BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE)) != 0) 682 panic("_intio_bus_dmamap_sync: mix PRE and POST"); 683 684 #ifdef DIAGNOSTIC 685 if ((ops & (BUS_DMASYNC_PREWRITE|BUS_DMASYNC_POSTREAD)) != 0) { 686 if (offset >= map->dm_mapsize) 687 panic("_intio_bus_dmamap_sync: bad offset"); 688 if (len == 0 || (offset + len) > map->dm_mapsize) 689 panic("_intio_bus_dmamap_sync: bad length"); 690 } 691 #endif 692 693 /* 694 * If we're not bouncing, just return; nothing to do. 695 */ 696 if ((cookie->id_flags & ID_IS_BOUNCING) == 0) 697 return; 698 699 switch (cookie->id_buftype) { 700 case ID_BUFTYPE_LINEAR: 701 /* 702 * Nothing to do for pre-read. 703 */ 704 705 if (ops & BUS_DMASYNC_PREWRITE) { 706 /* 707 * Copy the caller's buffer to the bounce buffer. 708 */ 709 memcpy((char *)cookie->id_bouncebuf + offset, 710 (char *)cookie->id_origbuf + offset, len); 711 } 712 713 if (ops & BUS_DMASYNC_POSTREAD) { 714 /* 715 * Copy the bounce buffer to the caller's buffer. 716 */ 717 memcpy((char *)cookie->id_origbuf + offset, 718 (char *)cookie->id_bouncebuf + offset, len); 719 } 720 721 /* 722 * Nothing to do for post-write. 723 */ 724 break; 725 726 case ID_BUFTYPE_MBUF: 727 { 728 struct mbuf *m, *m0 = cookie->id_origbuf; 729 bus_size_t minlen, moff; 730 731 /* 732 * Nothing to do for pre-read. 733 */ 734 735 if (ops & BUS_DMASYNC_PREWRITE) { 736 /* 737 * Copy the caller's buffer to the bounce buffer. 738 */ 739 m_copydata(m0, offset, len, 740 (char *)cookie->id_bouncebuf + offset); 741 } 742 743 if (ops & BUS_DMASYNC_POSTREAD) { 744 /* 745 * Copy the bounce buffer to the caller's buffer. 746 */ 747 for (moff = offset, m = m0; m != NULL && len != 0; 748 m = m->m_next) { 749 /* Find the beginning mbuf. */ 750 if (moff >= m->m_len) { 751 moff -= m->m_len; 752 continue; 753 } 754 755 /* 756 * Now at the first mbuf to sync; nail 757 * each one until we have exhausted the 758 * length. 759 */ 760 minlen = len < m->m_len - moff ? 761 len : m->m_len - moff; 762 763 memcpy(mtod(m, char *) + moff, 764 (char *)cookie->id_bouncebuf + offset, 765 minlen); 766 767 moff = 0; 768 len -= minlen; 769 offset += minlen; 770 } 771 } 772 773 /* 774 * Nothing to do for post-write. 775 */ 776 break; 777 } 778 779 case ID_BUFTYPE_UIO: 780 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_UIO"); 781 break; 782 783 case ID_BUFTYPE_RAW: 784 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_RAW"); 785 break; 786 787 case ID_BUFTYPE_INVALID: 788 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_INVALID"); 789 break; 790 791 default: 792 printf("unknown buffer type %d\n", cookie->id_buftype); 793 panic("_intio_bus_dmamap_sync"); 794 } 795 } 796 797 /* 798 * Allocate memory safe for INTIO DMA. 799 */ 800 int 801 _intio_bus_dmamem_alloc(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment, 802 bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs, 803 int flags) 804 { 805 paddr_t high; 806 extern paddr_t avail_end; 807 808 if (avail_end > INTIO_DMA_BOUNCE_THRESHOLD) 809 high = trunc_page(INTIO_DMA_BOUNCE_THRESHOLD); 810 else 811 high = trunc_page(avail_end); 812 813 return (x68k_bus_dmamem_alloc_range(t, size, alignment, boundary, 814 segs, nsegs, rsegs, flags, 0, high)); 815 } 816 817 /********************************************************************** 818 * INTIO DMA utility functions 819 **********************************************************************/ 820 821 int 822 _intio_dma_alloc_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map, bus_size_t size, 823 int flags) 824 { 825 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 826 int error = 0; 827 828 cookie->id_bouncebuflen = round_page(size); 829 error = _intio_bus_dmamem_alloc(t, cookie->id_bouncebuflen, 830 PAGE_SIZE, map->x68k_dm_boundary, cookie->id_bouncesegs, 831 map->x68k_dm_segcnt, &cookie->id_nbouncesegs, flags); 832 if (error) 833 goto out; 834 error = x68k_bus_dmamem_map(t, cookie->id_bouncesegs, 835 cookie->id_nbouncesegs, cookie->id_bouncebuflen, 836 (void **)&cookie->id_bouncebuf, flags); 837 838 out: 839 if (error) { 840 x68k_bus_dmamem_free(t, cookie->id_bouncesegs, 841 cookie->id_nbouncesegs); 842 cookie->id_bouncebuflen = 0; 843 cookie->id_nbouncesegs = 0; 844 } else { 845 cookie->id_flags |= ID_HAS_BOUNCE; 846 } 847 848 return (error); 849 } 850 851 void 852 _intio_dma_free_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map) 853 { 854 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 855 856 x68k_bus_dmamem_unmap(t, cookie->id_bouncebuf, 857 cookie->id_bouncebuflen); 858 x68k_bus_dmamem_free(t, cookie->id_bouncesegs, 859 cookie->id_nbouncesegs); 860 cookie->id_bouncebuflen = 0; 861 cookie->id_nbouncesegs = 0; 862 cookie->id_flags &= ~ID_HAS_BOUNCE; 863 } 864
Indexes created Mon Sep 22 21:09:42 GMT 2025