intio.c revision 1.41
1 /* $NetBSD: intio.c,v 1.41 2009/01/18 04:48:53 isaki 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.41 2009/01/18 04:48:53 isaki 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 M_DEVBUF, 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 void *cookiestore; 404 size_t cookiesize; 405 extern paddr_t avail_end; 406 407 /* Call common function to create the basic map. */ 408 error = x68k_bus_dmamap_create(t, size, nsegments, maxsegsz, boundary, 409 flags, dmamp); 410 if (error) 411 return (error); 412 413 map = *dmamp; 414 map->x68k_dm_cookie = NULL; 415 416 cookiesize = sizeof(struct intio_dma_cookie); 417 418 /* 419 * INTIO only has 24-bits of address space. This means 420 * we can't DMA to pages over 16M. In order to DMA to 421 * arbitrary buffers, we use "bounce buffers" - pages 422 * in memory below the 16M boundary. On DMA reads, 423 * DMA happens to the bounce buffers, and is copied into 424 * the caller's buffer. On writes, data is copied into 425 * but bounce buffer, and the DMA happens from those 426 * pages. To software using the DMA mapping interface, 427 * this looks simply like a data cache. 428 * 429 * If we have more than 16M of RAM in the system, we may 430 * need bounce buffers. We check and remember that here. 431 * 432 * ...or, there is an opposite case. The most segments 433 * a transfer will require is (maxxfer / PAGE_SIZE) + 1. If 434 * the caller can't handle that many segments (e.g. the 435 * DMAC), we may have to bounce it as well. 436 */ 437 if (avail_end <= t->_bounce_thresh) 438 /* Bouncing not necessary due to memory size. */ 439 map->x68k_dm_bounce_thresh = 0; 440 cookieflags = 0; 441 if (map->x68k_dm_bounce_thresh != 0 || 442 ((map->x68k_dm_size / PAGE_SIZE) + 1) > map->x68k_dm_segcnt) { 443 cookieflags |= ID_MIGHT_NEED_BOUNCE; 444 cookiesize += (sizeof(bus_dma_segment_t) * map->x68k_dm_segcnt); 445 } 446 447 /* 448 * Allocate our cookie. 449 */ 450 if ((cookiestore = malloc(cookiesize, M_DMAMAP, 451 (flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK)) == NULL) { 452 error = ENOMEM; 453 goto out; 454 } 455 memset(cookiestore, 0, cookiesize); 456 cookie = (struct intio_dma_cookie *)cookiestore; 457 cookie->id_flags = cookieflags; 458 map->x68k_dm_cookie = cookie; 459 460 if (cookieflags & ID_MIGHT_NEED_BOUNCE) { 461 /* 462 * Allocate the bounce pages now if the caller 463 * wishes us to do so. 464 */ 465 if ((flags & BUS_DMA_ALLOCNOW) == 0) 466 goto out; 467 468 error = _intio_dma_alloc_bouncebuf(t, map, size, flags); 469 } 470 471 out: 472 if (error) { 473 if (map->x68k_dm_cookie != NULL) 474 free(map->x68k_dm_cookie, M_DMAMAP); 475 x68k_bus_dmamap_destroy(t, map); 476 } 477 return (error); 478 } 479 480 /* 481 * Destroy an INTIO DMA map. 482 */ 483 void 484 _intio_bus_dmamap_destroy(bus_dma_tag_t t, bus_dmamap_t map) 485 { 486 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 487 488 /* 489 * Free any bounce pages this map might hold. 490 */ 491 if (cookie->id_flags & ID_HAS_BOUNCE) 492 _intio_dma_free_bouncebuf(t, map); 493 494 free(cookie, M_DMAMAP); 495 x68k_bus_dmamap_destroy(t, map); 496 } 497 498 /* 499 * Load an INTIO DMA map with a linear buffer. 500 */ 501 int 502 _intio_bus_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf, 503 bus_size_t buflen, struct proc *p, int flags) 504 { 505 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 506 int error; 507 508 /* 509 * Make sure that on error condition we return "no valid mappings." 510 */ 511 map->dm_mapsize = 0; 512 map->dm_nsegs = 0; 513 514 /* 515 * Try to load the map the normal way. If this errors out, 516 * and we can bounce, we will. 517 */ 518 error = x68k_bus_dmamap_load(t, map, buf, buflen, p, flags); 519 if (error == 0 || 520 (error != 0 && (cookie->id_flags & ID_MIGHT_NEED_BOUNCE) == 0)) 521 return (error); 522 523 /* 524 * Allocate bounce pages, if necessary. 525 */ 526 if ((cookie->id_flags & ID_HAS_BOUNCE) == 0) { 527 error = _intio_dma_alloc_bouncebuf(t, map, buflen, flags); 528 if (error) 529 return (error); 530 } 531 532 /* 533 * Cache a pointer to the caller's buffer and load the DMA map 534 * with the bounce buffer. 535 */ 536 cookie->id_origbuf = buf; 537 cookie->id_origbuflen = buflen; 538 cookie->id_buftype = ID_BUFTYPE_LINEAR; 539 error = x68k_bus_dmamap_load(t, map, cookie->id_bouncebuf, buflen, 540 p, flags); 541 if (error) { 542 /* 543 * Free the bounce pages, unless our resources 544 * are reserved for our exclusive use. 545 */ 546 if ((map->x68k_dm_flags & BUS_DMA_ALLOCNOW) == 0) 547 _intio_dma_free_bouncebuf(t, map); 548 return (error); 549 } 550 551 /* ...so _intio_bus_dmamap_sync() knows we're bouncing */ 552 cookie->id_flags |= ID_IS_BOUNCING; 553 return (0); 554 } 555 556 /* 557 * Like _intio_bus_dmamap_load(), but for mbufs. 558 */ 559 int 560 _intio_bus_dmamap_load_mbuf(bus_dma_tag_t t, bus_dmamap_t map, struct mbuf *m0, 561 int flags) 562 { 563 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 564 int error; 565 566 /* 567 * Make sure on error condition we return "no valid mappings." 568 */ 569 map->dm_mapsize = 0; 570 map->dm_nsegs = 0; 571 572 #ifdef DIAGNOSTIC 573 if ((m0->m_flags & M_PKTHDR) == 0) 574 panic("_intio_bus_dmamap_load_mbuf: no packet header"); 575 #endif 576 577 if (m0->m_pkthdr.len > map->x68k_dm_size) 578 return (EINVAL); 579 580 /* 581 * Try to load the map the normal way. If this errors out, 582 * and we can bounce, we will. 583 */ 584 error = x68k_bus_dmamap_load_mbuf(t, map, m0, flags); 585 if (error == 0 || 586 (error != 0 && (cookie->id_flags & ID_MIGHT_NEED_BOUNCE) == 0)) 587 return (error); 588 589 /* 590 * Allocate bounce pages, if necessary. 591 */ 592 if ((cookie->id_flags & ID_HAS_BOUNCE) == 0) { 593 error = _intio_dma_alloc_bouncebuf(t, map, m0->m_pkthdr.len, 594 flags); 595 if (error) 596 return (error); 597 } 598 599 /* 600 * Cache a pointer to the caller's buffer and load the DMA map 601 * with the bounce buffer. 602 */ 603 cookie->id_origbuf = m0; 604 cookie->id_origbuflen = m0->m_pkthdr.len; /* not really used */ 605 cookie->id_buftype = ID_BUFTYPE_MBUF; 606 error = x68k_bus_dmamap_load(t, map, cookie->id_bouncebuf, 607 m0->m_pkthdr.len, NULL, flags); 608 if (error) { 609 /* 610 * Free the bounce pages, unless our resources 611 * are reserved for our exclusive use. 612 */ 613 if ((map->x68k_dm_flags & BUS_DMA_ALLOCNOW) == 0) 614 _intio_dma_free_bouncebuf(t, map); 615 return (error); 616 } 617 618 /* ...so _intio_bus_dmamap_sync() knows we're bouncing */ 619 cookie->id_flags |= ID_IS_BOUNCING; 620 return (0); 621 } 622 623 /* 624 * Like _intio_bus_dmamap_load(), but for uios. 625 */ 626 int 627 _intio_bus_dmamap_load_uio(bus_dma_tag_t t, bus_dmamap_t map, struct uio *uio, 628 int flags) 629 { 630 panic("_intio_bus_dmamap_load_uio: not implemented"); 631 } 632 633 /* 634 * Like _intio_bus_dmamap_load(), but for raw memory allocated with 635 * bus_dmamem_alloc(). 636 */ 637 int 638 _intio_bus_dmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map, 639 bus_dma_segment_t *segs, int nsegs, bus_size_t size, int flags) 640 { 641 642 panic("_intio_bus_dmamap_load_raw: not implemented"); 643 } 644 645 /* 646 * Unload an INTIO DMA map. 647 */ 648 void 649 _intio_bus_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map) 650 { 651 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 652 653 /* 654 * If we have bounce pages, free them, unless they're 655 * reserved for our exclusive use. 656 */ 657 if ((cookie->id_flags & ID_HAS_BOUNCE) && 658 (map->x68k_dm_flags & BUS_DMA_ALLOCNOW) == 0) 659 _intio_dma_free_bouncebuf(t, map); 660 661 cookie->id_flags &= ~ID_IS_BOUNCING; 662 cookie->id_buftype = ID_BUFTYPE_INVALID; 663 664 /* 665 * Do the generic bits of the unload. 666 */ 667 x68k_bus_dmamap_unload(t, map); 668 } 669 670 /* 671 * Synchronize an INTIO DMA map. 672 */ 673 void 674 _intio_bus_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset, 675 bus_size_t len, int ops) 676 { 677 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 678 679 /* 680 * Mixing PRE and POST operations is not allowed. 681 */ 682 if ((ops & (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE)) != 0 && 683 (ops & (BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE)) != 0) 684 panic("_intio_bus_dmamap_sync: mix PRE and POST"); 685 686 #ifdef DIAGNOSTIC 687 if ((ops & (BUS_DMASYNC_PREWRITE|BUS_DMASYNC_POSTREAD)) != 0) { 688 if (offset >= map->dm_mapsize) 689 panic("_intio_bus_dmamap_sync: bad offset"); 690 if (len == 0 || (offset + len) > map->dm_mapsize) 691 panic("_intio_bus_dmamap_sync: bad length"); 692 } 693 #endif 694 695 /* 696 * If we're not bouncing, just return; nothing to do. 697 */ 698 if ((cookie->id_flags & ID_IS_BOUNCING) == 0) 699 return; 700 701 switch (cookie->id_buftype) { 702 case ID_BUFTYPE_LINEAR: 703 /* 704 * Nothing to do for pre-read. 705 */ 706 707 if (ops & BUS_DMASYNC_PREWRITE) { 708 /* 709 * Copy the caller's buffer to the bounce buffer. 710 */ 711 memcpy((char *)cookie->id_bouncebuf + offset, 712 (char *)cookie->id_origbuf + offset, len); 713 } 714 715 if (ops & BUS_DMASYNC_POSTREAD) { 716 /* 717 * Copy the bounce buffer to the caller's buffer. 718 */ 719 memcpy((char *)cookie->id_origbuf + offset, 720 (char *)cookie->id_bouncebuf + offset, len); 721 } 722 723 /* 724 * Nothing to do for post-write. 725 */ 726 break; 727 728 case ID_BUFTYPE_MBUF: 729 { 730 struct mbuf *m, *m0 = cookie->id_origbuf; 731 bus_size_t minlen, moff; 732 733 /* 734 * Nothing to do for pre-read. 735 */ 736 737 if (ops & BUS_DMASYNC_PREWRITE) { 738 /* 739 * Copy the caller's buffer to the bounce buffer. 740 */ 741 m_copydata(m0, offset, len, 742 (char *)cookie->id_bouncebuf + offset); 743 } 744 745 if (ops & BUS_DMASYNC_POSTREAD) { 746 /* 747 * Copy the bounce buffer to the caller's buffer. 748 */ 749 for (moff = offset, m = m0; m != NULL && len != 0; 750 m = m->m_next) { 751 /* Find the beginning mbuf. */ 752 if (moff >= m->m_len) { 753 moff -= m->m_len; 754 continue; 755 } 756 757 /* 758 * Now at the first mbuf to sync; nail 759 * each one until we have exhausted the 760 * length. 761 */ 762 minlen = len < m->m_len - moff ? 763 len : m->m_len - moff; 764 765 memcpy(mtod(m, char *) + moff, 766 (char *)cookie->id_bouncebuf + offset, 767 minlen); 768 769 moff = 0; 770 len -= minlen; 771 offset += minlen; 772 } 773 } 774 775 /* 776 * Nothing to do for post-write. 777 */ 778 break; 779 } 780 781 case ID_BUFTYPE_UIO: 782 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_UIO"); 783 break; 784 785 case ID_BUFTYPE_RAW: 786 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_RAW"); 787 break; 788 789 case ID_BUFTYPE_INVALID: 790 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_INVALID"); 791 break; 792 793 default: 794 printf("unknown buffer type %d\n", cookie->id_buftype); 795 panic("_intio_bus_dmamap_sync"); 796 } 797 } 798 799 /* 800 * Allocate memory safe for INTIO DMA. 801 */ 802 int 803 _intio_bus_dmamem_alloc(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment, 804 bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs, 805 int flags) 806 { 807 paddr_t high; 808 extern paddr_t avail_end; 809 810 if (avail_end > INTIO_DMA_BOUNCE_THRESHOLD) 811 high = trunc_page(INTIO_DMA_BOUNCE_THRESHOLD); 812 else 813 high = trunc_page(avail_end); 814 815 return (x68k_bus_dmamem_alloc_range(t, size, alignment, boundary, 816 segs, nsegs, rsegs, flags, 0, high)); 817 } 818 819 /********************************************************************** 820 * INTIO DMA utility functions 821 **********************************************************************/ 822 823 int 824 _intio_dma_alloc_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map, bus_size_t size, 825 int flags) 826 { 827 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 828 int error = 0; 829 830 cookie->id_bouncebuflen = round_page(size); 831 error = _intio_bus_dmamem_alloc(t, cookie->id_bouncebuflen, 832 PAGE_SIZE, map->x68k_dm_boundary, cookie->id_bouncesegs, 833 map->x68k_dm_segcnt, &cookie->id_nbouncesegs, flags); 834 if (error) 835 goto out; 836 error = x68k_bus_dmamem_map(t, cookie->id_bouncesegs, 837 cookie->id_nbouncesegs, cookie->id_bouncebuflen, 838 (void **)&cookie->id_bouncebuf, flags); 839 840 out: 841 if (error) { 842 x68k_bus_dmamem_free(t, cookie->id_bouncesegs, 843 cookie->id_nbouncesegs); 844 cookie->id_bouncebuflen = 0; 845 cookie->id_nbouncesegs = 0; 846 } else { 847 cookie->id_flags |= ID_HAS_BOUNCE; 848 } 849 850 return (error); 851 } 852 853 void 854 _intio_dma_free_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map) 855 { 856 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 857 858 x68k_bus_dmamem_unmap(t, cookie->id_bouncebuf, 859 cookie->id_bouncebuflen); 860 x68k_bus_dmamem_free(t, cookie->id_bouncesegs, 861 cookie->id_nbouncesegs); 862 cookie->id_bouncebuflen = 0; 863 cookie->id_nbouncesegs = 0; 864 cookie->id_flags &= ~ID_HAS_BOUNCE; 865 } 866
Indexes created Fri Oct 03 02:09:57 GMT 2025