1 /* $NetBSD: armv7_generic_space.c,v 1.3 2016/08/01 19:05:24 jakllsch Exp $ */ 2 3 /*- 4 * Copyright (c) 2012 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by Nick Hudson 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 33 #include <sys/cdefs.h> 34 __KERNEL_RCSID(0, "$NetBSD: armv7_generic_space.c,v 1.3 2016/08/01 19:05:24 jakllsch Exp $"); 35 36 #include <sys/param.h> 37 #include <sys/systm.h> 38 39 #include <uvm/uvm_extern.h> 40 41 #include <sys/bus.h> 42 43 /* Prototypes for all the bus_space structure functions */ 44 bs_protos(armv7_generic); 45 bs_protos(armv7_generic_a4x); 46 bs_protos(a4x); 47 bs_protos(bs_notimpl); 48 bs_protos(generic); 49 bs_protos(generic_armv4); 50 51 #if __ARMEB__ 52 #define NSWAP(n) n ## _swap 53 #else 54 #define NSWAP(n) n 55 #endif 56 57 struct bus_space armv7_generic_bs_tag = { 58 /* cookie */ 59 (void *) 0, 60 61 /* mapping/unmapping */ 62 armv7_generic_bs_map, 63 armv7_generic_bs_unmap, 64 armv7_generic_bs_subregion, 65 66 /* allocation/deallocation */ 67 armv7_generic_bs_alloc, /* not implemented */ 68 armv7_generic_bs_free, /* not implemented */ 69 70 /* get kernel virtual address */ 71 armv7_generic_bs_vaddr, 72 73 /* mmap */ 74 armv7_generic_bs_mmap, 75 76 /* barrier */ 77 armv7_generic_bs_barrier, 78 79 /* read (single) */ 80 generic_bs_r_1, 81 NSWAP(generic_armv4_bs_r_2), 82 NSWAP(generic_bs_r_4), 83 bs_notimpl_bs_r_8, 84 85 /* read multiple */ 86 generic_bs_rm_1, 87 NSWAP(generic_armv4_bs_rm_2), 88 NSWAP(generic_bs_rm_4), 89 bs_notimpl_bs_rm_8, 90 91 /* read region */ 92 generic_bs_rr_1, 93 NSWAP(generic_armv4_bs_rr_2), 94 NSWAP(generic_bs_rr_4), 95 bs_notimpl_bs_rr_8, 96 97 /* write (single) */ 98 generic_bs_w_1, 99 NSWAP(generic_armv4_bs_w_2), 100 NSWAP(generic_bs_w_4), 101 bs_notimpl_bs_w_8, 102 103 /* write multiple */ 104 generic_bs_wm_1, 105 NSWAP(generic_armv4_bs_wm_2), 106 NSWAP(generic_bs_wm_4), 107 bs_notimpl_bs_wm_8, 108 109 /* write region */ 110 generic_bs_wr_1, 111 NSWAP(generic_armv4_bs_wr_2), 112 NSWAP(generic_bs_wr_4), 113 bs_notimpl_bs_wr_8, 114 115 /* set multiple */ 116 bs_notimpl_bs_sm_1, 117 bs_notimpl_bs_sm_2, 118 bs_notimpl_bs_sm_4, 119 bs_notimpl_bs_sm_8, 120 121 /* set region */ 122 generic_bs_sr_1, 123 NSWAP(generic_armv4_bs_sr_2), 124 NSWAP(generic_bs_sr_4), 125 bs_notimpl_bs_sr_8, 126 127 /* copy */ 128 bs_notimpl_bs_c_1, 129 generic_armv4_bs_c_2, 130 bs_notimpl_bs_c_4, 131 bs_notimpl_bs_c_8, 132 133 #ifdef __BUS_SPACE_HAS_STREAM_METHODS 134 /* read (single) */ 135 generic_bs_r_1, 136 NSWAP(generic_armv4_bs_r_2), 137 NSWAP(generic_bs_r_4), 138 bs_notimpl_bs_r_8, 139 140 /* read multiple */ 141 generic_bs_rm_1, 142 NSWAP(generic_armv4_bs_rm_2), 143 NSWAP(generic_bs_rm_4), 144 bs_notimpl_bs_rm_8, 145 146 /* read region */ 147 generic_bs_rr_1, 148 NSWAP(generic_armv4_bs_rr_2), 149 NSWAP(generic_bs_rr_4), 150 bs_notimpl_bs_rr_8, 151 152 /* write (single) */ 153 generic_bs_w_1, 154 NSWAP(generic_armv4_bs_w_2), 155 NSWAP(generic_bs_w_4), 156 bs_notimpl_bs_w_8, 157 158 /* write multiple */ 159 generic_bs_wm_1, 160 NSWAP(generic_armv4_bs_wm_2), 161 NSWAP(generic_bs_wm_4), 162 bs_notimpl_bs_wm_8, 163 164 /* write region */ 165 generic_bs_wr_1, 166 NSWAP(generic_armv4_bs_wr_2), 167 NSWAP(generic_bs_wr_4), 168 bs_notimpl_bs_wr_8, 169 #endif 170 }; 171 172 struct bus_space armv7_generic_a4x_bs_tag = { 173 /* cookie */ 174 (void *) 0, 175 176 /* mapping/unmapping */ 177 armv7_generic_bs_map, 178 armv7_generic_bs_unmap, 179 armv7_generic_a4x_bs_subregion, 180 181 /* allocation/deallocation */ 182 armv7_generic_bs_alloc, /* not implemented */ 183 armv7_generic_bs_free, /* not implemented */ 184 185 /* get kernel virtual address */ 186 armv7_generic_bs_vaddr, 187 188 /* mmap */ 189 armv7_generic_a4x_bs_mmap, 190 191 /* barrier */ 192 armv7_generic_bs_barrier, 193 194 /* read (single) */ 195 a4x_bs_r_1, 196 NSWAP(a4x_bs_r_2), 197 NSWAP(a4x_bs_r_4), 198 bs_notimpl_bs_r_8, 199 200 /* read multiple */ 201 a4x_bs_rm_1, 202 NSWAP(a4x_bs_rm_2), 203 NSWAP(a4x_bs_rm_4), 204 bs_notimpl_bs_rm_8, 205 206 /* read region */ 207 bs_notimpl_bs_rr_1, 208 bs_notimpl_bs_rr_2, 209 bs_notimpl_bs_rr_4, 210 bs_notimpl_bs_rr_8, 211 212 /* write (single) */ 213 a4x_bs_w_1, 214 NSWAP(a4x_bs_w_2), 215 NSWAP(a4x_bs_w_4), 216 bs_notimpl_bs_w_8, 217 218 /* write multiple */ 219 a4x_bs_wm_1, 220 NSWAP(a4x_bs_wm_2), 221 NSWAP(a4x_bs_wm_4), 222 bs_notimpl_bs_wm_8, 223 224 /* write region */ 225 bs_notimpl_bs_wr_1, 226 bs_notimpl_bs_wr_2, 227 bs_notimpl_bs_wr_4, 228 bs_notimpl_bs_wr_8, 229 230 /* set multiple */ 231 bs_notimpl_bs_sm_1, 232 bs_notimpl_bs_sm_2, 233 bs_notimpl_bs_sm_4, 234 bs_notimpl_bs_sm_8, 235 236 /* set region */ 237 bs_notimpl_bs_sr_1, 238 bs_notimpl_bs_sr_2, 239 bs_notimpl_bs_sr_4, 240 bs_notimpl_bs_sr_8, 241 242 /* copy */ 243 bs_notimpl_bs_c_1, 244 bs_notimpl_bs_c_2, 245 bs_notimpl_bs_c_4, 246 bs_notimpl_bs_c_8, 247 248 #ifdef __BUS_SPACE_HAS_STREAM_METHODS 249 /* read (single) */ 250 a4x_bs_r_1, 251 NSWAP(a4x_bs_r_2), 252 NSWAP(a4x_bs_r_4), 253 bs_notimpl_bs_r_8, 254 255 /* read multiple */ 256 a4x_bs_rm_1, 257 NSWAP(a4x_bs_rm_2), 258 NSWAP(a4x_bs_rm_4), 259 bs_notimpl_bs_rm_8, 260 261 /* read region */ 262 bs_notimpl_bs_rr_1, 263 bs_notimpl_bs_rr_2, 264 bs_notimpl_bs_rr_4, 265 bs_notimpl_bs_rr_8, 266 267 /* write (single) */ 268 a4x_bs_w_1, 269 NSWAP(a4x_bs_w_2), 270 NSWAP(a4x_bs_w_4), 271 bs_notimpl_bs_w_8, 272 273 /* write multiple */ 274 a4x_bs_wm_1, 275 NSWAP(a4x_bs_wm_2), 276 NSWAP(a4x_bs_wm_4), 277 bs_notimpl_bs_wm_8, 278 279 /* write region */ 280 bs_notimpl_bs_wr_1, 281 bs_notimpl_bs_wr_2, 282 bs_notimpl_bs_wr_4, 283 bs_notimpl_bs_wr_8, 284 #endif 285 }; 286 287 int 288 armv7_generic_bs_map(void *t, bus_addr_t bpa, bus_size_t size, int flag, 289 bus_space_handle_t *bshp) 290 { 291 u_long startpa, endpa, pa; 292 const struct pmap_devmap *pd; 293 vaddr_t va; 294 295 if ((pd = pmap_devmap_find_pa(bpa, size)) != NULL) { 296 /* Device was statically mapped. */ 297 *bshp = pd->pd_va + (bpa - pd->pd_pa); 298 return 0; 299 } 300 301 startpa = trunc_page(bpa); 302 endpa = round_page(bpa + size); 303 304 /* XXX use extent manager to check duplicate mapping */ 305 306 va = uvm_km_alloc(kernel_map, endpa - startpa, 0, 307 UVM_KMF_VAONLY | UVM_KMF_NOWAIT | UVM_KMF_COLORMATCH); 308 if (!va) 309 return ENOMEM; 310 311 *bshp = (bus_space_handle_t)(va + (bpa - startpa)); 312 313 const int pmapflags = 314 (flag & (BUS_SPACE_MAP_CACHEABLE|BUS_SPACE_MAP_PREFETCHABLE)) 315 ? 0 316 : PMAP_NOCACHE; 317 for (pa = startpa; pa < endpa; pa += PAGE_SIZE, va += PAGE_SIZE) { 318 pmap_kenter_pa(va, pa, VM_PROT_READ | VM_PROT_WRITE, pmapflags); 319 } 320 pmap_update(pmap_kernel()); 321 322 return 0; 323 } 324 325 void 326 armv7_generic_bs_unmap(void *t, bus_space_handle_t bsh, bus_size_t size) 327 { 328 vaddr_t va; 329 vsize_t sz; 330 331 if (pmap_devmap_find_va(bsh, size) != NULL) { 332 /* Device was statically mapped; nothing to do. */ 333 return; 334 } 335 336 va = trunc_page(bsh); 337 sz = round_page(bsh + size) - va; 338 339 pmap_kremove(va, sz); 340 pmap_update(pmap_kernel()); 341 uvm_km_free(kernel_map, va, sz, UVM_KMF_VAONLY); 342 } 343 344 345 int 346 armv7_generic_bs_subregion(void *t, bus_space_handle_t bsh, bus_size_t offset, 347 bus_size_t size, bus_space_handle_t *nbshp) 348 { 349 350 *nbshp = bsh + offset; 351 return (0); 352 } 353 354 int 355 armv7_generic_a4x_bs_subregion(void *t, bus_space_handle_t bsh, bus_size_t offset, 356 bus_size_t size, bus_space_handle_t *nbshp) 357 { 358 359 *nbshp = bsh + 4 * offset; 360 return (0); 361 } 362 363 void 364 armv7_generic_bs_barrier(void *t, bus_space_handle_t bsh, bus_size_t offset, 365 bus_size_t len, int flags) 366 { 367 flags &= BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE; 368 369 if (flags) 370 arm_dsb(); 371 } 372 373 void * 374 armv7_generic_bs_vaddr(void *t, bus_space_handle_t bsh) 375 { 376 377 return (void *)bsh; 378 } 379 380 paddr_t 381 armv7_generic_bs_mmap(void *t, bus_addr_t bpa, off_t offset, int prot, int flags) 382 { 383 paddr_t bus_flags = 0; 384 385 if (flags & BUS_SPACE_MAP_PREFETCHABLE) 386 bus_flags |= ARM32_MMAP_WRITECOMBINE; 387 388 return (arm_btop(bpa + offset) | bus_flags); 389 } 390 391 paddr_t 392 armv7_generic_a4x_bs_mmap(void *t, bus_addr_t bpa, off_t offset, int prot, int flags) 393 { 394 paddr_t bus_flags = 0; 395 396 if (flags & BUS_SPACE_MAP_PREFETCHABLE) 397 bus_flags |= ARM32_MMAP_WRITECOMBINE; 398 399 return (arm_btop(bpa + 4 * offset) | bus_flags); 400 } 401 402 int 403 armv7_generic_bs_alloc(void *t, bus_addr_t rstart, bus_addr_t rend, 404 bus_size_t size, bus_size_t alignment, bus_size_t boundary, int flags, 405 bus_addr_t *bpap, bus_space_handle_t *bshp) 406 { 407 408 panic("%s(): not implemented\n", __func__); 409 } 410 411 void 412 armv7_generic_bs_free(void *t, bus_space_handle_t bsh, bus_size_t size) 413 { 414 415 panic("%s(): not implemented\n", __func__); 416 } 417