obio.c revision 1.5
1 /* $NetBSD: obio.c,v 1.5 2008/03/27 02:26:34 uwe Exp $ */ 2 3 /*- 4 * Copyright (c) 1998 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Charles M. Hannum. 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 * 3. All advertising materials mentioning features or use of this software 19 * must display the following acknowledgement: 20 * This product includes software developed by the NetBSD 21 * Foundation, Inc. and its contributors. 22 * 4. Neither the name of The NetBSD Foundation nor the names of its 23 * contributors may be used to endorse or promote products derived 24 * from this software without specific prior written permission. 25 * 26 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 27 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 * POSSIBILITY OF SUCH DAMAGE. 37 */ 38 39 #include <sys/cdefs.h> 40 __KERNEL_RCSID(0, "$NetBSD: obio.c,v 1.5 2008/03/27 02:26:34 uwe Exp $"); 41 42 #include "btn_obio.h" 43 #include "pwrsw_obio.h" 44 45 #include <sys/param.h> 46 #include <sys/systm.h> 47 #include <sys/device.h> 48 49 #include <uvm/uvm_extern.h> 50 51 #include <sh3/devreg.h> 52 #include <sh3/mmu.h> 53 #include <sh3/pmap.h> 54 #include <sh3/pte.h> 55 56 #include <machine/bus.h> 57 #include <machine/cpu.h> 58 #include <machine/intr.h> 59 60 #include <landisk/dev/obiovar.h> 61 62 #if (NPWRSW_OBIO > 0) || (NBTN_OBIO > 0) 63 #include <dev/sysmon/sysmonvar.h> 64 #include <dev/sysmon/sysmon_taskq.h> 65 #endif 66 67 #include "locators.h" 68 69 70 struct obio_softc { 71 device_t sc_dev; 72 73 bus_space_tag_t sc_iot; /* io space tag */ 74 bus_space_tag_t sc_memt; /* mem space tag */ 75 }; 76 77 static int obio_match(device_t, cfdata_t, void *); 78 static void obio_attach(device_t, device_t, void *); 79 static int obio_print(void *, const char *); 80 static int obio_search(device_t, cfdata_t, const int *, void *); 81 82 CFATTACH_DECL_NEW(obio, sizeof(struct obio_softc), 83 obio_match, obio_attach, NULL, NULL); 84 85 static int 86 obio_match(device_t parent, cfdata_t cf, void *aux) 87 { 88 struct obiobus_attach_args *oba = aux; 89 90 if (strcmp(oba->oba_busname, cf->cf_name)) 91 return (0); 92 93 return (1); 94 } 95 96 static void 97 obio_attach(device_t parent, device_t self, void *aux) 98 { 99 struct obio_softc *sc = device_private(self); 100 struct obiobus_attach_args *oba = aux; 101 102 aprint_naive("\n"); 103 aprint_normal("\n"); 104 105 sc->sc_dev = self; 106 107 sc->sc_iot = oba->oba_iot; 108 sc->sc_memt = oba->oba_memt; 109 110 #if (NPWRSW_OBIO > 0) || (NBTN_OBIO > 0) 111 sysmon_power_settype("landisk"); 112 sysmon_task_queue_init(); 113 #endif 114 115 config_search_ia(obio_search, self, "obio", NULL); 116 } 117 118 static int 119 obio_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux) 120 { 121 struct obio_io res_io[1]; 122 struct obio_iomem res_mem[1]; 123 struct obio_irq res_irq[1]; 124 struct obio_softc *sc = device_private(parent); 125 struct obio_attach_args oa; 126 int tryagain; 127 128 do { 129 oa.oa_iot = sc->sc_iot; 130 oa.oa_memt = sc->sc_memt; 131 132 res_io[0].or_addr = cf->cf_iobase; 133 res_io[0].or_size = cf->cf_iosize; 134 135 res_mem[0].or_addr = cf->cf_maddr; 136 res_mem[0].or_size = cf->cf_msize; 137 138 res_irq[0].or_irq = cf->cf_irq; 139 140 oa.oa_io = res_io; 141 oa.oa_nio = 1; 142 143 oa.oa_iomem = res_mem; 144 oa.oa_niomem = 1; 145 146 oa.oa_irq = res_irq; 147 oa.oa_nirq = 1; 148 149 tryagain = 0; 150 if (config_match(parent, cf, &oa) > 0) { 151 config_attach(parent, cf, &oa, obio_print); 152 tryagain = (cf->cf_fstate == FSTATE_STAR); 153 } 154 } while (tryagain); 155 156 return (0); 157 } 158 159 static int 160 obio_print(void *args, const char *name) 161 { 162 struct obio_attach_args *oa = args; 163 const char *sep; 164 int i; 165 166 if (oa->oa_nio) { 167 sep = ""; 168 aprint_normal(" port "); 169 for (i = 0; i < oa->oa_nio; i++) { 170 if (oa->oa_io[i].or_size == 0) 171 continue; 172 aprint_normal("%s0x%x", sep, oa->oa_io[i].or_addr); 173 if (oa->oa_io[i].or_size > 1) 174 aprint_normal("-0x%x", oa->oa_io[i].or_addr + 175 oa->oa_io[i].or_size - 1); 176 sep = ","; 177 } 178 } 179 180 if (oa->oa_niomem) { 181 sep = ""; 182 aprint_normal(" iomem "); 183 for (i = 0; i < oa->oa_niomem; i++) { 184 if (oa->oa_iomem[i].or_size == 0) 185 continue; 186 aprint_normal("%s0x%x", sep, oa->oa_iomem[i].or_addr); 187 if (oa->oa_iomem[i].or_size > 1) 188 aprint_normal("-0x%x", oa->oa_iomem[i].or_addr + 189 oa->oa_iomem[i].or_size - 1); 190 sep = ","; 191 } 192 } 193 194 if (oa->oa_nirq) { 195 sep = ""; 196 aprint_normal(" irq "); 197 for (i = 0; i < oa->oa_nirq; i++) { 198 if (oa->oa_irq[i].or_irq == IRQUNK) 199 continue; 200 aprint_normal("%s%d", sep, oa->oa_irq[i].or_irq); 201 sep = ","; 202 } 203 } 204 205 return (UNCONF); 206 } 207 208 /* 209 * Set up an interrupt handler to start being called. 210 */ 211 void * 212 obio_intr_establish(int irq, int level, int (*ih_fun)(void *), void *ih_arg) 213 { 214 215 return extintr_establish(irq, level, ih_fun, ih_arg); 216 } 217 218 /* 219 * Deregister an interrupt handler. 220 */ 221 void 222 obio_intr_disestablish(void *arg) 223 { 224 225 extintr_disestablish(arg); 226 } 227 228 /* 229 * on-board I/O bus space 230 */ 231 #define OBIO_IOMEM_IO 0 /* space is i/o space */ 232 #define OBIO_IOMEM_MEM 1 /* space is mem space */ 233 #define OBIO_IOMEM_PCMCIA_IO 2 /* PCMCIA IO space */ 234 #define OBIO_IOMEM_PCMCIA_MEM 3 /* PCMCIA Mem space */ 235 #define OBIO_IOMEM_PCMCIA_ATT 4 /* PCMCIA Attr space */ 236 #define OBIO_IOMEM_PCMCIA_8BIT 0x8000 /* PCMCIA BUS 8 BIT WIDTH */ 237 #define OBIO_IOMEM_PCMCIA_IO8 \ 238 (OBIO_IOMEM_PCMCIA_IO|OBIO_IOMEM_PCMCIA_8BIT) 239 #define OBIO_IOMEM_PCMCIA_MEM8 \ 240 (OBIO_IOMEM_PCMCIA_MEM|OBIO_IOMEM_PCMCIA_8BIT) 241 #define OBIO_IOMEM_PCMCIA_ATT8 \ 242 (OBIO_IOMEM_PCMCIA_ATT|OBIO_IOMEM_PCMCIA_8BIT) 243 244 int obio_iomem_map(void *v, bus_addr_t bpa, bus_size_t size, int flags, 245 bus_space_handle_t *bshp); 246 void obio_iomem_unmap(void *v, bus_space_handle_t bsh, bus_size_t size); 247 int obio_iomem_subregion(void *v, bus_space_handle_t bsh, 248 bus_size_t offset, bus_size_t size, bus_space_handle_t *nbshp); 249 int obio_iomem_alloc(void *v, bus_addr_t rstart, bus_addr_t rend, 250 bus_size_t size, bus_size_t alignment, bus_size_t boundary, int flags, 251 bus_addr_t *bpap, bus_space_handle_t *bshp); 252 void obio_iomem_free(void *v, bus_space_handle_t bsh, bus_size_t size); 253 254 static int obio_iomem_add_mapping(bus_addr_t, bus_size_t, int, 255 bus_space_handle_t *); 256 257 static int 258 obio_iomem_add_mapping(bus_addr_t bpa, bus_size_t size, int type, 259 bus_space_handle_t *bshp) 260 { 261 u_long pa, endpa; 262 vaddr_t va; 263 pt_entry_t *pte; 264 unsigned int m = 0; 265 int io_type = type & ~OBIO_IOMEM_PCMCIA_8BIT; 266 267 pa = sh3_trunc_page(bpa); 268 endpa = sh3_round_page(bpa + size); 269 270 #ifdef DIAGNOSTIC 271 if (endpa <= pa) 272 panic("obio_iomem_add_mapping: overflow"); 273 #endif 274 275 va = uvm_km_alloc(kernel_map, endpa - pa, 0, UVM_KMF_VAONLY); 276 if (va == 0){ 277 printf("obio_iomem_add_mapping: nomem\n"); 278 return (ENOMEM); 279 } 280 281 *bshp = (bus_space_handle_t)(va + (bpa & PGOFSET)); 282 283 #define MODE(t, s) \ 284 ((t) & OBIO_IOMEM_PCMCIA_8BIT) ? \ 285 _PG_PCMCIA_ ## s ## 8 : \ 286 _PG_PCMCIA_ ## s ## 16 287 switch (io_type) { 288 default: 289 panic("unknown pcmcia space."); 290 /* NOTREACHED */ 291 case OBIO_IOMEM_PCMCIA_IO: 292 m = MODE(type, IO); 293 break; 294 case OBIO_IOMEM_PCMCIA_MEM: 295 m = MODE(type, MEM); 296 break; 297 case OBIO_IOMEM_PCMCIA_ATT: 298 m = MODE(type, ATTR); 299 break; 300 } 301 #undef MODE 302 303 for (; pa < endpa; pa += PAGE_SIZE, va += PAGE_SIZE) { 304 pmap_kenter_pa(va, pa, VM_PROT_READ | VM_PROT_WRITE); 305 pte = __pmap_kpte_lookup(va); 306 KDASSERT(pte); 307 *pte |= m; /* PTEA PCMCIA assistant bit */ 308 sh_tlb_update(0, va, *pte); 309 } 310 311 return (0); 312 } 313 314 int 315 obio_iomem_map(void *v, bus_addr_t bpa, bus_size_t size, 316 int flags, bus_space_handle_t *bshp) 317 { 318 bus_addr_t addr = SH3_PHYS_TO_P2SEG(bpa); 319 int error; 320 321 KASSERT((bpa & SH3_PHYS_MASK) == bpa); 322 323 if (bpa < 0x14000000 || bpa >= 0x1c000000) { 324 /* CS0,1,2,3,4,7 */ 325 *bshp = (bus_space_handle_t)addr; 326 return (0); 327 } 328 329 /* CS5,6 */ 330 error = obio_iomem_add_mapping(addr, size, (int)(u_long)v, bshp); 331 332 return (error); 333 } 334 335 void 336 obio_iomem_unmap(void *v, bus_space_handle_t bsh, bus_size_t size) 337 { 338 u_long va, endva; 339 bus_addr_t bpa; 340 341 if (bsh >= SH3_P2SEG_BASE && bsh <= SH3_P2SEG_END) { 342 /* maybe CS0,1,2,3,4,7 */ 343 return; 344 } 345 346 /* CS5,6 */ 347 va = sh3_trunc_page(bsh); 348 endva = sh3_round_page(bsh + size); 349 350 #ifdef DIAGNOSTIC 351 if (endva <= va) 352 panic("obio_io_unmap: overflow"); 353 #endif 354 355 pmap_extract(pmap_kernel(), va, &bpa); 356 bpa += bsh & PGOFSET; 357 358 pmap_kremove(va, endva - va); 359 360 /* 361 * Free the kernel virtual mapping. 362 */ 363 uvm_km_free(kernel_map, va, endva - va, UVM_KMF_VAONLY); 364 } 365 366 int 367 obio_iomem_subregion(void *v, bus_space_handle_t bsh, 368 bus_size_t offset, bus_size_t size, bus_space_handle_t *nbshp) 369 { 370 371 *nbshp = bsh + offset; 372 373 return (0); 374 } 375 376 int 377 obio_iomem_alloc(void *v, bus_addr_t rstart, bus_addr_t rend, 378 bus_size_t size, bus_size_t alignment, bus_size_t boundary, int flags, 379 bus_addr_t *bpap, bus_space_handle_t *bshp) 380 { 381 382 *bshp = *bpap = rstart; 383 384 return (0); 385 } 386 387 void 388 obio_iomem_free(void *v, bus_space_handle_t bsh, bus_size_t size) 389 { 390 391 obio_iomem_unmap(v, bsh, size); 392 } 393 394 /* 395 * on-board I/O bus space read/write 396 */ 397 uint8_t obio_iomem_read_1(void *v, bus_space_handle_t bsh, bus_size_t offset); 398 uint16_t obio_iomem_read_2(void *v, bus_space_handle_t bsh, bus_size_t offset); 399 uint32_t obio_iomem_read_4(void *v, bus_space_handle_t bsh, bus_size_t offset); 400 void obio_iomem_read_multi_1(void *v, bus_space_handle_t bsh, 401 bus_size_t offset, uint8_t *addr, bus_size_t count); 402 void obio_iomem_read_multi_2(void *v, bus_space_handle_t bsh, 403 bus_size_t offset, uint16_t *addr, bus_size_t count); 404 void obio_iomem_read_multi_4(void *v, bus_space_handle_t bsh, 405 bus_size_t offset, uint32_t *addr, bus_size_t count); 406 void obio_iomem_read_region_1(void *v, bus_space_handle_t bsh, 407 bus_size_t offset, uint8_t *addr, bus_size_t count); 408 void obio_iomem_read_region_2(void *v, bus_space_handle_t bsh, 409 bus_size_t offset, uint16_t *addr, bus_size_t count); 410 void obio_iomem_read_region_4(void *v, bus_space_handle_t bsh, 411 bus_size_t offset, uint32_t *addr, bus_size_t count); 412 void obio_iomem_write_1(void *v, bus_space_handle_t bsh, bus_size_t offset, 413 uint8_t value); 414 void obio_iomem_write_2(void *v, bus_space_handle_t bsh, bus_size_t offset, 415 uint16_t value); 416 void obio_iomem_write_4(void *v, bus_space_handle_t bsh, bus_size_t offset, 417 uint32_t value); 418 void obio_iomem_write_multi_1(void *v, bus_space_handle_t bsh, 419 bus_size_t offset, const uint8_t *addr, bus_size_t count); 420 void obio_iomem_write_multi_2(void *v, bus_space_handle_t bsh, 421 bus_size_t offset, const uint16_t *addr, bus_size_t count); 422 void obio_iomem_write_multi_4(void *v, bus_space_handle_t bsh, 423 bus_size_t offset, const uint32_t *addr, bus_size_t count); 424 void obio_iomem_write_region_1(void *v, bus_space_handle_t bsh, 425 bus_size_t offset, const uint8_t *addr, bus_size_t count); 426 void obio_iomem_write_region_2(void *v, bus_space_handle_t bsh, 427 bus_size_t offset, const uint16_t *addr, bus_size_t count); 428 void obio_iomem_write_region_4(void *v, bus_space_handle_t bsh, 429 bus_size_t offset, const uint32_t *addr, bus_size_t count); 430 void obio_iomem_set_multi_1(void *v, bus_space_handle_t bsh, bus_size_t offset, 431 uint8_t val, bus_size_t count); 432 void obio_iomem_set_multi_2(void *v, bus_space_handle_t bsh, bus_size_t offset, 433 uint16_t val, bus_size_t count); 434 void obio_iomem_set_multi_4(void *v, bus_space_handle_t bsh, bus_size_t offset, 435 uint32_t val, bus_size_t count); 436 void obio_iomem_set_region_1(void *v, bus_space_handle_t bsh, 437 bus_size_t offset, uint8_t val, bus_size_t count); 438 void obio_iomem_set_region_2(void *v, bus_space_handle_t bsh, 439 bus_size_t offset, uint16_t val, bus_size_t count); 440 void obio_iomem_set_region_4(void *v, bus_space_handle_t bsh, 441 bus_size_t offset, uint32_t val, bus_size_t count); 442 void obio_iomem_copy_region_1(void *v, bus_space_handle_t h1, bus_size_t o1, 443 bus_space_handle_t h2, bus_size_t o2, bus_size_t count); 444 void obio_iomem_copy_region_2(void *v, bus_space_handle_t h1, bus_size_t o1, 445 bus_space_handle_t h2, bus_size_t o2, bus_size_t count); 446 void obio_iomem_copy_region_4(void *v, bus_space_handle_t h1, bus_size_t o1, 447 bus_space_handle_t h2, bus_size_t o2, bus_size_t count); 448 449 struct _bus_space obio_bus_io = 450 { 451 .bs_cookie = (void *)OBIO_IOMEM_PCMCIA_IO, 452 453 .bs_map = obio_iomem_map, 454 .bs_unmap = obio_iomem_unmap, 455 .bs_subregion = obio_iomem_subregion, 456 457 .bs_alloc = obio_iomem_alloc, 458 .bs_free = obio_iomem_free, 459 460 .bs_r_1 = obio_iomem_read_1, 461 .bs_r_2 = obio_iomem_read_2, 462 .bs_r_4 = obio_iomem_read_4, 463 464 .bs_rm_1 = obio_iomem_read_multi_1, 465 .bs_rm_2 = obio_iomem_read_multi_2, 466 .bs_rm_4 = obio_iomem_read_multi_4, 467 468 .bs_rr_1 = obio_iomem_read_region_1, 469 .bs_rr_2 = obio_iomem_read_region_2, 470 .bs_rr_4 = obio_iomem_read_region_4, 471 472 .bs_w_1 = obio_iomem_write_1, 473 .bs_w_2 = obio_iomem_write_2, 474 .bs_w_4 = obio_iomem_write_4, 475 476 .bs_wm_1 = obio_iomem_write_multi_1, 477 .bs_wm_2 = obio_iomem_write_multi_2, 478 .bs_wm_4 = obio_iomem_write_multi_4, 479 480 .bs_wr_1 = obio_iomem_write_region_1, 481 .bs_wr_2 = obio_iomem_write_region_2, 482 .bs_wr_4 = obio_iomem_write_region_4, 483 484 .bs_sm_1 = obio_iomem_set_multi_1, 485 .bs_sm_2 = obio_iomem_set_multi_2, 486 .bs_sm_4 = obio_iomem_set_multi_4, 487 488 .bs_sr_1 = obio_iomem_set_region_1, 489 .bs_sr_2 = obio_iomem_set_region_2, 490 .bs_sr_4 = obio_iomem_set_region_4, 491 492 .bs_c_1 = obio_iomem_copy_region_1, 493 .bs_c_2 = obio_iomem_copy_region_2, 494 .bs_c_4 = obio_iomem_copy_region_4, 495 }; 496 497 struct _bus_space obio_bus_mem = 498 { 499 .bs_cookie = (void *)OBIO_IOMEM_PCMCIA_MEM, 500 501 .bs_map = obio_iomem_map, 502 .bs_unmap = obio_iomem_unmap, 503 .bs_subregion = obio_iomem_subregion, 504 505 .bs_alloc = obio_iomem_alloc, 506 .bs_free = obio_iomem_free, 507 508 .bs_r_1 = obio_iomem_read_1, 509 .bs_r_2 = obio_iomem_read_2, 510 .bs_r_4 = obio_iomem_read_4, 511 512 .bs_rm_1 = obio_iomem_read_multi_1, 513 .bs_rm_2 = obio_iomem_read_multi_2, 514 .bs_rm_4 = obio_iomem_read_multi_4, 515 516 .bs_rr_1 = obio_iomem_read_region_1, 517 .bs_rr_2 = obio_iomem_read_region_2, 518 .bs_rr_4 = obio_iomem_read_region_4, 519 520 .bs_w_1 = obio_iomem_write_1, 521 .bs_w_2 = obio_iomem_write_2, 522 .bs_w_4 = obio_iomem_write_4, 523 524 .bs_wm_1 = obio_iomem_write_multi_1, 525 .bs_wm_2 = obio_iomem_write_multi_2, 526 .bs_wm_4 = obio_iomem_write_multi_4, 527 528 .bs_wr_1 = obio_iomem_write_region_1, 529 .bs_wr_2 = obio_iomem_write_region_2, 530 .bs_wr_4 = obio_iomem_write_region_4, 531 532 .bs_sm_1 = obio_iomem_set_multi_1, 533 .bs_sm_2 = obio_iomem_set_multi_2, 534 .bs_sm_4 = obio_iomem_set_multi_4, 535 536 .bs_sr_1 = obio_iomem_set_region_1, 537 .bs_sr_2 = obio_iomem_set_region_2, 538 .bs_sr_4 = obio_iomem_set_region_4, 539 540 .bs_c_1 = obio_iomem_copy_region_1, 541 .bs_c_2 = obio_iomem_copy_region_2, 542 .bs_c_4 = obio_iomem_copy_region_4, 543 }; 544 545 /* read */ 546 uint8_t 547 obio_iomem_read_1(void *v, bus_space_handle_t bsh, bus_size_t offset) 548 { 549 550 return *(volatile uint8_t *)(bsh + offset); 551 } 552 553 uint16_t 554 obio_iomem_read_2(void *v, bus_space_handle_t bsh, bus_size_t offset) 555 { 556 557 return *(volatile uint16_t *)(bsh + offset); 558 } 559 560 uint32_t 561 obio_iomem_read_4(void *v, bus_space_handle_t bsh, bus_size_t offset) 562 { 563 564 return *(volatile uint32_t *)(bsh + offset); 565 } 566 567 void 568 obio_iomem_read_multi_1(void *v, bus_space_handle_t bsh, 569 bus_size_t offset, uint8_t *addr, bus_size_t count) 570 { 571 volatile uint8_t *p = (void *)(bsh + offset); 572 573 while (count--) { 574 *addr++ = *p; 575 } 576 } 577 578 void 579 obio_iomem_read_multi_2(void *v, bus_space_handle_t bsh, 580 bus_size_t offset, uint16_t *addr, bus_size_t count) 581 { 582 volatile uint16_t *p = (void *)(bsh + offset); 583 584 while (count--) { 585 *addr++ = *p; 586 } 587 } 588 589 void 590 obio_iomem_read_multi_4(void *v, bus_space_handle_t bsh, 591 bus_size_t offset, uint32_t *addr, bus_size_t count) 592 { 593 volatile uint32_t *p = (void *)(bsh + offset); 594 595 while (count--) { 596 *addr++ = *p; 597 } 598 } 599 600 void 601 obio_iomem_read_region_1(void *v, bus_space_handle_t bsh, 602 bus_size_t offset, uint8_t *addr, bus_size_t count) 603 { 604 volatile uint8_t *p = (void *)(bsh + offset); 605 606 while (count--) { 607 *addr++ = *p++; 608 } 609 } 610 611 void 612 obio_iomem_read_region_2(void *v, bus_space_handle_t bsh, 613 bus_size_t offset, uint16_t *addr, bus_size_t count) 614 { 615 volatile uint16_t *p = (void *)(bsh + offset); 616 617 while (count--) { 618 *addr++ = *p++; 619 } 620 } 621 622 void 623 obio_iomem_read_region_4(void *v, bus_space_handle_t bsh, 624 bus_size_t offset, uint32_t *addr, bus_size_t count) 625 { 626 volatile uint32_t *p = (void *)(bsh + offset); 627 628 while (count--) { 629 *addr++ = *p++; 630 } 631 } 632 633 /* write */ 634 void 635 obio_iomem_write_1(void *v, bus_space_handle_t bsh, bus_size_t offset, 636 uint8_t value) 637 { 638 639 *(volatile uint8_t *)(bsh + offset) = value; 640 } 641 642 void 643 obio_iomem_write_2(void *v, bus_space_handle_t bsh, bus_size_t offset, 644 uint16_t value) 645 { 646 647 *(volatile uint16_t *)(bsh + offset) = value; 648 } 649 650 void 651 obio_iomem_write_4(void *v, bus_space_handle_t bsh, bus_size_t offset, 652 uint32_t value) 653 { 654 655 *(volatile uint32_t *)(bsh + offset) = value; 656 } 657 658 void 659 obio_iomem_write_multi_1(void *v, bus_space_handle_t bsh, 660 bus_size_t offset, const uint8_t *addr, bus_size_t count) 661 { 662 volatile uint8_t *p = (void *)(bsh + offset); 663 664 while (count--) { 665 *p = *addr++; 666 } 667 } 668 669 void 670 obio_iomem_write_multi_2(void *v, bus_space_handle_t bsh, 671 bus_size_t offset, const uint16_t *addr, bus_size_t count) 672 { 673 volatile uint16_t *p = (void *)(bsh + offset); 674 675 while (count--) { 676 *p = *addr++; 677 } 678 } 679 680 void 681 obio_iomem_write_multi_4(void *v, bus_space_handle_t bsh, 682 bus_size_t offset, const uint32_t *addr, bus_size_t count) 683 { 684 volatile uint32_t *p = (void *)(bsh + offset); 685 686 while (count--) { 687 *p = *addr++; 688 } 689 } 690 691 void 692 obio_iomem_write_region_1(void *v, bus_space_handle_t bsh, 693 bus_size_t offset, const uint8_t *addr, bus_size_t count) 694 { 695 volatile uint8_t *p = (void *)(bsh + offset); 696 697 while (count--) { 698 *p++ = *addr++; 699 } 700 } 701 702 void 703 obio_iomem_write_region_2(void *v, bus_space_handle_t bsh, 704 bus_size_t offset, const uint16_t *addr, bus_size_t count) 705 { 706 volatile uint16_t *p = (void *)(bsh + offset); 707 708 while (count--) { 709 *p++ = *addr++; 710 } 711 } 712 713 void 714 obio_iomem_write_region_4(void *v, bus_space_handle_t bsh, 715 bus_size_t offset, const uint32_t *addr, bus_size_t count) 716 { 717 volatile uint32_t *p = (void *)(bsh + offset); 718 719 while (count--) { 720 *p++ = *addr++; 721 } 722 } 723 724 void 725 obio_iomem_set_multi_1(void *v, bus_space_handle_t bsh, 726 bus_size_t offset, uint8_t val, bus_size_t count) 727 { 728 volatile uint8_t *p = (void *)(bsh + offset); 729 730 while (count--) { 731 *p = val; 732 } 733 } 734 735 void 736 obio_iomem_set_multi_2(void *v, bus_space_handle_t bsh, 737 bus_size_t offset, uint16_t val, bus_size_t count) 738 { 739 volatile uint16_t *p = (void *)(bsh + offset); 740 741 while (count--) { 742 *p = val; 743 } 744 } 745 746 void 747 obio_iomem_set_multi_4(void *v, bus_space_handle_t bsh, 748 bus_size_t offset, uint32_t val, bus_size_t count) 749 { 750 volatile uint32_t *p = (void *)(bsh + offset); 751 752 while (count--) { 753 *p = val; 754 } 755 } 756 757 void 758 obio_iomem_set_region_1(void *v, bus_space_handle_t bsh, 759 bus_size_t offset, uint8_t val, bus_size_t count) 760 { 761 volatile uint8_t *addr = (void *)(bsh + offset); 762 763 while (count--) { 764 *addr++ = val; 765 } 766 } 767 768 void 769 obio_iomem_set_region_2(void *v, bus_space_handle_t bsh, 770 bus_size_t offset, uint16_t val, bus_size_t count) 771 { 772 volatile uint16_t *addr = (void *)(bsh + offset); 773 774 while (count--) { 775 *addr++ = val; 776 } 777 } 778 779 void 780 obio_iomem_set_region_4(void *v, bus_space_handle_t bsh, 781 bus_size_t offset, uint32_t val, bus_size_t count) 782 { 783 volatile uint32_t *addr = (void *)(bsh + offset); 784 785 while (count--) { 786 *addr++ = val; 787 } 788 } 789 790 void 791 obio_iomem_copy_region_1(void *v, bus_space_handle_t h1, bus_size_t o1, 792 bus_space_handle_t h2, bus_size_t o2, bus_size_t count) 793 { 794 volatile uint8_t *addr1 = (void *)(h1 + o1); 795 volatile uint8_t *addr2 = (void *)(h2 + o2); 796 797 if (addr1 >= addr2) { /* src after dest: copy forward */ 798 while (count--) { 799 *addr2++ = *addr1++; 800 } 801 } else { /* dest after src: copy backwards */ 802 addr1 += count - 1; 803 addr2 += count - 1; 804 while (count--) { 805 *addr2-- = *addr1--; 806 } 807 } 808 } 809 810 void 811 obio_iomem_copy_region_2(void *v, bus_space_handle_t h1, bus_size_t o1, 812 bus_space_handle_t h2, bus_size_t o2, bus_size_t count) 813 { 814 volatile uint16_t *addr1 = (void *)(h1 + o1); 815 volatile uint16_t *addr2 = (void *)(h2 + o2); 816 817 if (addr1 >= addr2) { /* src after dest: copy forward */ 818 while (count--) { 819 *addr2++ = *addr1++; 820 } 821 } else { /* dest after src: copy backwards */ 822 addr1 += count - 1; 823 addr2 += count - 1; 824 while (count--) { 825 *addr2-- = *addr1--; 826 } 827 } 828 } 829 830 void 831 obio_iomem_copy_region_4(void *v, bus_space_handle_t h1, bus_size_t o1, 832 bus_space_handle_t h2, bus_size_t o2, bus_size_t count) 833 { 834 volatile uint32_t *addr1 = (void *)(h1 + o1); 835 volatile uint32_t *addr2 = (void *)(h2 + o2); 836 837 if (addr1 >= addr2) { /* src after dest: copy forward */ 838 while (count--) { 839 *addr2++ = *addr1++; 840 } 841 } else { /* dest after src: copy backwards */ 842 addr1 += count - 1; 843 addr2 += count - 1; 844 while (count--) { 845 *addr2-- = *addr1--; 846 } 847 } 848 } 849
Indexes created Fri Sep 26 20:09:58 GMT 2025