intio.c revision 1.47.4.1
1 /* $NetBSD: intio.c,v 1.47.4.1 2021/03/20 19:33:39 thorpej 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.47.4.1 2021/03/20 19:33:39 thorpej 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_WAITOK); 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(self, &ia, 179 CFARG_SUBMATCH, intio_search, 180 CFARG_IATTR, "intio", 181 CFARG_EOL); 182 } 183 184 static int 185 intio_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux) 186 { 187 struct intio_softc *sc = device_private(parent); 188 struct intio_attach_args *ia = aux; 189 190 ia->ia_bst = sc->sc_bst; 191 ia->ia_dmat = sc->sc_dmat; 192 ia->ia_name = cf->cf_name; 193 ia->ia_addr = cf->cf_addr; 194 ia->ia_intr = cf->cf_intr; 195 ia->ia_dma = cf->cf_dma; 196 ia->ia_dmaintr = cf->cf_dmaintr; 197 198 if (config_match(parent, cf, ia) > 0) 199 config_attach(parent, cf, ia, intio_print); 200 201 return (0); 202 } 203 204 static int 205 intio_print(void *aux, const char *name) 206 { 207 struct intio_attach_args *ia = aux; 208 209 /* if (ia->ia_addr > 0) */ 210 aprint_normal(" addr 0x%06x", ia->ia_addr); 211 if (ia->ia_intr > 0) 212 aprint_normal(" intr 0x%02x", ia->ia_intr); 213 if (ia->ia_dma >= 0) { 214 aprint_normal(" using DMA ch%d", ia->ia_dma); 215 if (ia->ia_dmaintr > 0) 216 aprint_normal(" intr 0x%02x and 0x%02x", 217 ia->ia_dmaintr, ia->ia_dmaintr+1); 218 } 219 220 return (QUIET); 221 } 222 223 /* 224 * intio memory map manager 225 */ 226 227 int 228 intio_map_allocate_region(device_t parent, struct intio_attach_args *ia, 229 enum intio_map_flag flag) 230 { 231 struct intio_softc *sc = device_private(parent); 232 struct extent *map = sc->sc_map; 233 int r; 234 235 r = extent_alloc_region(map, ia->ia_addr, ia->ia_size, 0); 236 #ifdef DEBUG 237 if (intio_debug) 238 extent_print(map); 239 #endif 240 if (r == 0) { 241 if (flag != INTIO_MAP_ALLOCATE) 242 extent_free(map, ia->ia_addr, ia->ia_size, 0); 243 return 0; 244 } 245 246 return -1; 247 } 248 249 int 250 intio_map_free_region(device_t parent, struct intio_attach_args *ia) 251 { 252 struct intio_softc *sc = device_private(parent); 253 struct extent *map = sc->sc_map; 254 255 extent_free(map, ia->ia_addr, ia->ia_size, 0); 256 #ifdef DEBUG 257 if (intio_debug) 258 extent_print(map); 259 #endif 260 return 0; 261 } 262 263 void 264 intio_alloc_system_ports(struct intio_softc *sc) 265 { 266 extent_alloc_region(sc->sc_map, INTIO_SYSPORT, 16, 0); 267 extent_alloc_region(sc->sc_map, INTIO_SICILIAN, 0x2000, 0); 268 } 269 270 271 /* 272 * intio bus space stuff. 273 */ 274 static int 275 intio_bus_space_map(bus_space_tag_t t, bus_addr_t bpa, bus_size_t size, 276 int flags, bus_space_handle_t *bshp) 277 { 278 /* 279 * Intio bus is mapped permanently. 280 */ 281 *bshp = (bus_space_handle_t)IIOV(bpa); 282 283 /* 284 * Some devices are mapped on odd or even addresses only. 285 */ 286 if ((flags & BUS_SPACE_MAP_SHIFTED_MASK) == BUS_SPACE_MAP_SHIFTED_ODD) 287 *bshp += 0x80000001; 288 if ((flags & BUS_SPACE_MAP_SHIFTED_MASK) == BUS_SPACE_MAP_SHIFTED_EVEN) 289 *bshp += 0x80000000; 290 291 return (0); 292 } 293 294 static void 295 intio_bus_space_unmap(bus_space_tag_t t, bus_space_handle_t bsh, 296 bus_size_t size) 297 { 298 return; 299 } 300 301 static int 302 intio_bus_space_subregion(bus_space_tag_t t, bus_space_handle_t bsh, 303 bus_size_t offset, bus_size_t size, bus_space_handle_t *nbshp) 304 { 305 306 *nbshp = bsh + offset; 307 return (0); 308 } 309 310 311 /* 312 * interrupt handler 313 */ 314 int 315 intio_intr_establish(int vector, const char *name, intio_intr_handler_t handler, 316 void *arg) 317 { 318 319 return intio_intr_establish_ext(vector, name, "intr", handler, arg); 320 } 321 322 int 323 intio_intr_establish_ext(int vector, const char *name1, const char *name2, 324 intio_intr_handler_t handler, void *arg) 325 { 326 struct evcnt *evcnt; 327 328 if (vector < 16) 329 panic("Invalid interrupt vector"); 330 if (iiv[vector].iiv_handler) 331 return EBUSY; 332 333 evcnt = malloc(sizeof(*evcnt), M_DEVBUF, M_WAITOK); 334 evcnt_attach_dynamic(evcnt, EVCNT_TYPE_INTR, NULL, name1, name2); 335 336 iiv[vector].iiv_handler = handler; 337 iiv[vector].iiv_arg = arg; 338 iiv[vector].iiv_evcnt = evcnt; 339 340 return 0; 341 } 342 343 int 344 intio_intr_disestablish(int vector, void *arg) 345 { 346 if (iiv[vector].iiv_handler == 0 || iiv[vector].iiv_arg != arg) 347 return EINVAL; 348 iiv[vector].iiv_handler = 0; 349 iiv[vector].iiv_arg = 0; 350 evcnt_detach(iiv[vector].iiv_evcnt); 351 free(iiv[vector].iiv_evcnt, M_DEVBUF); 352 353 return 0; 354 } 355 356 int 357 intio_intr(struct frame *frame) 358 { 359 int vector = frame->f_vector / 4; 360 361 if (iiv[vector].iiv_handler == 0) { 362 printf("Stray interrupt: %d type %x, pc %x\n", 363 vector, frame->f_format, frame->f_pc); 364 return 0; 365 } 366 367 iiv[vector].iiv_evcnt->ev_count++; 368 369 return (*(iiv[vector].iiv_handler))(iiv[vector].iiv_arg); 370 } 371 372 /* 373 * Intio I/O controller interrupt 374 */ 375 static u_int8_t intio_ivec = 0; 376 377 void 378 intio_set_ivec(int vec) 379 { 380 vec &= 0xfc; 381 382 if (intio_ivec && intio_ivec != (vec & 0xfc)) 383 panic("Wrong interrupt vector for Sicilian."); 384 385 intio_ivec = vec; 386 intio_set_sicilian_ivec(vec); 387 } 388 389 390 /* 391 * intio bus DMA stuff. stolen from arch/i386/isa/isa_machdep.c 392 */ 393 394 /* 395 * Create an INTIO DMA map. 396 */ 397 int 398 _intio_bus_dmamap_create(bus_dma_tag_t t, bus_size_t size, int nsegments, 399 bus_size_t maxsegsz, bus_size_t boundary, int flags, bus_dmamap_t *dmamp) 400 { 401 struct intio_dma_cookie *cookie; 402 bus_dmamap_t map; 403 int error, cookieflags; 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 cookie = malloc(cookiesize, M_DMAMAP, 451 ((flags & BUS_DMA_NOWAIT) ? M_NOWAIT : M_WAITOK) | M_ZERO); 452 if (cookie == NULL) { 453 error = ENOMEM; 454 goto out; 455 } 456 cookie->id_flags = cookieflags; 457 map->x68k_dm_cookie = cookie; 458 459 if (cookieflags & ID_MIGHT_NEED_BOUNCE) { 460 /* 461 * Allocate the bounce pages now if the caller 462 * wishes us to do so. 463 */ 464 if ((flags & BUS_DMA_ALLOCNOW) == 0) 465 goto out; 466 467 error = _intio_dma_alloc_bouncebuf(t, map, size, flags); 468 } 469 470 out: 471 if (error) { 472 if (map->x68k_dm_cookie != NULL) 473 free(map->x68k_dm_cookie, M_DMAMAP); 474 x68k_bus_dmamap_destroy(t, map); 475 } 476 return (error); 477 } 478 479 /* 480 * Destroy an INTIO DMA map. 481 */ 482 void 483 _intio_bus_dmamap_destroy(bus_dma_tag_t t, bus_dmamap_t map) 484 { 485 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 486 487 /* 488 * Free any bounce pages this map might hold. 489 */ 490 if (cookie->id_flags & ID_HAS_BOUNCE) 491 _intio_dma_free_bouncebuf(t, map); 492 493 free(cookie, M_DMAMAP); 494 x68k_bus_dmamap_destroy(t, map); 495 } 496 497 /* 498 * Load an INTIO DMA map with a linear buffer. 499 */ 500 int 501 _intio_bus_dmamap_load(bus_dma_tag_t t, bus_dmamap_t map, void *buf, 502 bus_size_t buflen, struct proc *p, int flags) 503 { 504 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 505 int error; 506 507 /* 508 * Make sure that on error condition we return "no valid mappings." 509 */ 510 map->dm_mapsize = 0; 511 map->dm_nsegs = 0; 512 513 /* 514 * Try to load the map the normal way. If this errors out, 515 * and we can bounce, we will. 516 */ 517 error = x68k_bus_dmamap_load(t, map, buf, buflen, p, flags); 518 if (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 || (cookie->id_flags & ID_MIGHT_NEED_BOUNCE) == 0) 584 return (error); 585 586 /* 587 * Allocate bounce pages, if necessary. 588 */ 589 if ((cookie->id_flags & ID_HAS_BOUNCE) == 0) { 590 error = _intio_dma_alloc_bouncebuf(t, map, m0->m_pkthdr.len, 591 flags); 592 if (error) 593 return (error); 594 } 595 596 /* 597 * Cache a pointer to the caller's buffer and load the DMA map 598 * with the bounce buffer. 599 */ 600 cookie->id_origbuf = m0; 601 cookie->id_origbuflen = m0->m_pkthdr.len; /* not really used */ 602 cookie->id_buftype = ID_BUFTYPE_MBUF; 603 error = x68k_bus_dmamap_load(t, map, cookie->id_bouncebuf, 604 m0->m_pkthdr.len, NULL, flags); 605 if (error) { 606 /* 607 * Free the bounce pages, unless our resources 608 * are reserved for our exclusive use. 609 */ 610 if ((map->x68k_dm_flags & BUS_DMA_ALLOCNOW) == 0) 611 _intio_dma_free_bouncebuf(t, map); 612 return (error); 613 } 614 615 /* ...so _intio_bus_dmamap_sync() knows we're bouncing */ 616 cookie->id_flags |= ID_IS_BOUNCING; 617 return (0); 618 } 619 620 /* 621 * Like _intio_bus_dmamap_load(), but for uios. 622 */ 623 int 624 _intio_bus_dmamap_load_uio(bus_dma_tag_t t, bus_dmamap_t map, struct uio *uio, 625 int flags) 626 { 627 panic("_intio_bus_dmamap_load_uio: not implemented"); 628 } 629 630 /* 631 * Like _intio_bus_dmamap_load(), but for raw memory allocated with 632 * bus_dmamem_alloc(). 633 */ 634 int 635 _intio_bus_dmamap_load_raw(bus_dma_tag_t t, bus_dmamap_t map, 636 bus_dma_segment_t *segs, int nsegs, bus_size_t size, int flags) 637 { 638 639 panic("_intio_bus_dmamap_load_raw: not implemented"); 640 } 641 642 /* 643 * Unload an INTIO DMA map. 644 */ 645 void 646 _intio_bus_dmamap_unload(bus_dma_tag_t t, bus_dmamap_t map) 647 { 648 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 649 650 /* 651 * If we have bounce pages, free them, unless they're 652 * reserved for our exclusive use. 653 */ 654 if ((cookie->id_flags & ID_HAS_BOUNCE) && 655 (map->x68k_dm_flags & BUS_DMA_ALLOCNOW) == 0) 656 _intio_dma_free_bouncebuf(t, map); 657 658 cookie->id_flags &= ~ID_IS_BOUNCING; 659 cookie->id_buftype = ID_BUFTYPE_INVALID; 660 661 /* 662 * Do the generic bits of the unload. 663 */ 664 x68k_bus_dmamap_unload(t, map); 665 } 666 667 /* 668 * Synchronize an INTIO DMA map. 669 */ 670 void 671 _intio_bus_dmamap_sync(bus_dma_tag_t t, bus_dmamap_t map, bus_addr_t offset, 672 bus_size_t len, int ops) 673 { 674 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 675 676 /* 677 * Mixing PRE and POST operations is not allowed. 678 */ 679 if ((ops & (BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE)) != 0 && 680 (ops & (BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE)) != 0) 681 panic("_intio_bus_dmamap_sync: mix PRE and POST"); 682 683 #ifdef DIAGNOSTIC 684 if ((ops & (BUS_DMASYNC_PREWRITE|BUS_DMASYNC_POSTREAD)) != 0) { 685 if (offset >= map->dm_mapsize) 686 panic("_intio_bus_dmamap_sync: bad offset"); 687 if (len == 0 || (offset + len) > map->dm_mapsize) 688 panic("_intio_bus_dmamap_sync: bad length"); 689 } 690 #endif 691 692 /* 693 * If we're not bouncing, just return; nothing to do. 694 */ 695 if ((cookie->id_flags & ID_IS_BOUNCING) == 0) 696 return; 697 698 switch (cookie->id_buftype) { 699 case ID_BUFTYPE_LINEAR: 700 /* 701 * Nothing to do for pre-read. 702 */ 703 704 if (ops & BUS_DMASYNC_PREWRITE) { 705 /* 706 * Copy the caller's buffer to the bounce buffer. 707 */ 708 memcpy((char *)cookie->id_bouncebuf + offset, 709 (char *)cookie->id_origbuf + offset, len); 710 } 711 712 if (ops & BUS_DMASYNC_POSTREAD) { 713 /* 714 * Copy the bounce buffer to the caller's buffer. 715 */ 716 memcpy((char *)cookie->id_origbuf + offset, 717 (char *)cookie->id_bouncebuf + offset, len); 718 } 719 720 /* 721 * Nothing to do for post-write. 722 */ 723 break; 724 725 case ID_BUFTYPE_MBUF: 726 { 727 struct mbuf *m, *m0 = cookie->id_origbuf; 728 bus_size_t minlen, moff; 729 730 /* 731 * Nothing to do for pre-read. 732 */ 733 734 if (ops & BUS_DMASYNC_PREWRITE) { 735 /* 736 * Copy the caller's buffer to the bounce buffer. 737 */ 738 m_copydata(m0, offset, len, 739 (char *)cookie->id_bouncebuf + offset); 740 } 741 742 if (ops & BUS_DMASYNC_POSTREAD) { 743 /* 744 * Copy the bounce buffer to the caller's buffer. 745 */ 746 for (moff = offset, m = m0; m != NULL && len != 0; 747 m = m->m_next) { 748 /* Find the beginning mbuf. */ 749 if (moff >= m->m_len) { 750 moff -= m->m_len; 751 continue; 752 } 753 754 /* 755 * Now at the first mbuf to sync; nail 756 * each one until we have exhausted the 757 * length. 758 */ 759 minlen = len < m->m_len - moff ? 760 len : m->m_len - moff; 761 762 memcpy(mtod(m, char *) + moff, 763 (char *)cookie->id_bouncebuf + offset, 764 minlen); 765 766 moff = 0; 767 len -= minlen; 768 offset += minlen; 769 } 770 } 771 772 /* 773 * Nothing to do for post-write. 774 */ 775 break; 776 } 777 778 case ID_BUFTYPE_UIO: 779 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_UIO"); 780 break; 781 782 case ID_BUFTYPE_RAW: 783 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_RAW"); 784 break; 785 786 case ID_BUFTYPE_INVALID: 787 panic("_intio_bus_dmamap_sync: ID_BUFTYPE_INVALID"); 788 break; 789 790 default: 791 printf("unknown buffer type %d\n", cookie->id_buftype); 792 panic("_intio_bus_dmamap_sync"); 793 } 794 } 795 796 /* 797 * Allocate memory safe for INTIO DMA. 798 */ 799 int 800 _intio_bus_dmamem_alloc(bus_dma_tag_t t, bus_size_t size, bus_size_t alignment, 801 bus_size_t boundary, bus_dma_segment_t *segs, int nsegs, int *rsegs, 802 int flags) 803 { 804 paddr_t high; 805 extern paddr_t avail_end; 806 807 if (avail_end > INTIO_DMA_BOUNCE_THRESHOLD) 808 high = trunc_page(INTIO_DMA_BOUNCE_THRESHOLD); 809 else 810 high = trunc_page(avail_end); 811 812 return (x68k_bus_dmamem_alloc_range(t, size, alignment, boundary, 813 segs, nsegs, rsegs, flags, 0, high)); 814 } 815 816 /********************************************************************** 817 * INTIO DMA utility functions 818 **********************************************************************/ 819 820 int 821 _intio_dma_alloc_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map, bus_size_t size, 822 int flags) 823 { 824 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 825 int error = 0; 826 827 cookie->id_bouncebuflen = round_page(size); 828 error = _intio_bus_dmamem_alloc(t, cookie->id_bouncebuflen, 829 PAGE_SIZE, map->x68k_dm_boundary, cookie->id_bouncesegs, 830 map->x68k_dm_segcnt, &cookie->id_nbouncesegs, flags); 831 if (error) 832 goto out; 833 error = x68k_bus_dmamem_map(t, cookie->id_bouncesegs, 834 cookie->id_nbouncesegs, cookie->id_bouncebuflen, 835 (void **)&cookie->id_bouncebuf, flags); 836 837 out: 838 if (error) { 839 x68k_bus_dmamem_free(t, cookie->id_bouncesegs, 840 cookie->id_nbouncesegs); 841 cookie->id_bouncebuflen = 0; 842 cookie->id_nbouncesegs = 0; 843 } else { 844 cookie->id_flags |= ID_HAS_BOUNCE; 845 } 846 847 return (error); 848 } 849 850 void 851 _intio_dma_free_bouncebuf(bus_dma_tag_t t, bus_dmamap_t map) 852 { 853 struct intio_dma_cookie *cookie = map->x68k_dm_cookie; 854 855 x68k_bus_dmamem_unmap(t, cookie->id_bouncebuf, 856 cookie->id_bouncebuflen); 857 x68k_bus_dmamem_free(t, cookie->id_bouncesegs, 858 cookie->id_nbouncesegs); 859 cookie->id_bouncebuflen = 0; 860 cookie->id_nbouncesegs = 0; 861 cookie->id_flags &= ~ID_HAS_BOUNCE; 862 } 863
Indexes created Thu Oct 02 14:10:14 GMT 2025