Lines Matching +full:data +full:- +full:size
1 // SPDX-License-Identifier: GPL-2.0-only
3 * CPU-agnostic ARM page table allocator.
10 #define pr_fmt(fmt) "arm-lpae io-pgtable: " fmt
14 #include <linux/io-pgtable.h>
19 #include <linux/dma-mapping.h>
23 #include "io-pgtable-arm.h"
24 #include "iommu-pages.h"
42 (((ARM_LPAE_MAX_LEVELS - (l)) * (d)->bits_per_level) + \
46 (sizeof(arm_lpae_iopte) << (d)->bits_per_level)
48 (sizeof(arm_lpae_iopte) << (d)->pgd_bits)
58 ((l) == (d)->start_level ? (d)->pgd_bits - (d)->bits_per_level : 0)
62 ((1 << ((d)->bits_per_level + ARM_LPAE_PGD_IDX(l,d))) - 1))
64 /* Calculate the block/page mapping size at level l for pagetable in d. */
95 /* Stage-1 PTE */
105 /* Stage-2 PTE */
113 * 0101 = Normal Non-cachable / Inner Non-cachable
114 * 0001 = Device / Device-nGnRE
117 * 0101 Normal* is forced Normal-NC, Device unchanged
118 * 0001 Force Device-nGnRE
180 if (lvl == (ARM_LPAE_MAX_LEVELS - 1) && fmt != ARM_MALI_LPAE) in iopte_leaf()
188 if (lvl == (ARM_LPAE_MAX_LEVELS - 1)) in iopte_table()
194 struct arm_lpae_io_pgtable *data) in paddr_to_iopte() argument
199 return (pte | (pte >> (48 - 12))) & ARM_LPAE_PTE_ADDR_MASK; in paddr_to_iopte()
203 struct arm_lpae_io_pgtable *data) in iopte_to_paddr() argument
207 if (ARM_LPAE_GRANULE(data) < SZ_64K) in iopte_to_paddr()
210 /* Rotate the packed high-order bits back to the top */ in iopte_to_paddr()
211 return (paddr | (paddr << (48 - 12))) & (ARM_LPAE_PTE_ADDR_MASK << 4); in iopte_to_paddr()
219 static inline int arm_lpae_max_entries(int i, struct arm_lpae_io_pgtable *data) in arm_lpae_max_entries() argument
221 int ptes_per_table = ARM_LPAE_PTES_PER_TABLE(data); in arm_lpae_max_entries()
223 return ptes_per_table - (i & (ptes_per_table - 1)); in arm_lpae_max_entries()
228 * 1) R_DXBSH: For 16KB, and 48-bit input size, use level 1 instead of 0.
229 * 2) R_SRKBC: After de-ciphering the table for PA size and valid initial lookup
230 * a) 40 bits PA size with 4K: use level 1 instead of level 0 (2 tables for ias = oas)
231 * b) 40 bits PA size with 16K: use level 2 instead of level 1 (16 tables for ias = oas)
232 * c) 42 bits PA size with 4K: use level 1 instead of level 0 (8 tables for ias = oas)
233 * d) 48 bits PA size with 16K: use level 1 instead of level 0 (2 tables for ias = oas)
236 struct arm_lpae_io_pgtable *data) in arm_lpae_concat_mandatory() argument
238 unsigned int ias = cfg->ias; in arm_lpae_concat_mandatory()
239 unsigned int oas = cfg->oas; in arm_lpae_concat_mandatory()
242 if ((ARM_LPAE_GRANULE(data) == SZ_16K) && (data->start_level == 0)) in arm_lpae_concat_mandatory()
246 if ((ARM_LPAE_GRANULE(data) == SZ_4K) && (data->start_level == 0)) in arm_lpae_concat_mandatory()
250 return (ARM_LPAE_GRANULE(data) == SZ_16K) && in arm_lpae_concat_mandatory()
251 (data->start_level == 1) && (oas == 40); in arm_lpae_concat_mandatory()
261 static void *__arm_lpae_alloc_pages(size_t size, gfp_t gfp, in __arm_lpae_alloc_pages() argument
265 struct device *dev = cfg->iommu_dev; in __arm_lpae_alloc_pages()
266 int order = get_order(size); in __arm_lpae_alloc_pages()
272 if (cfg->alloc) in __arm_lpae_alloc_pages()
273 pages = cfg->alloc(cookie, size, gfp); in __arm_lpae_alloc_pages()
280 if (!cfg->coherent_walk) { in __arm_lpae_alloc_pages()
281 dma = dma_map_single(dev, pages, size, DMA_TO_DEVICE); in __arm_lpae_alloc_pages()
297 dma_unmap_single(dev, dma, size, DMA_TO_DEVICE); in __arm_lpae_alloc_pages()
300 if (cfg->free) in __arm_lpae_alloc_pages()
301 cfg->free(cookie, pages, size); in __arm_lpae_alloc_pages()
308 static void __arm_lpae_free_pages(void *pages, size_t size, in __arm_lpae_free_pages() argument
312 if (!cfg->coherent_walk) in __arm_lpae_free_pages()
313 dma_unmap_single(cfg->iommu_dev, __arm_lpae_dma_addr(pages), in __arm_lpae_free_pages()
314 size, DMA_TO_DEVICE); in __arm_lpae_free_pages()
316 if (cfg->free) in __arm_lpae_free_pages()
317 cfg->free(cookie, pages, size); in __arm_lpae_free_pages()
319 iommu_free_pages(pages, get_order(size)); in __arm_lpae_free_pages()
325 dma_sync_single_for_device(cfg->iommu_dev, __arm_lpae_dma_addr(ptep), in __arm_lpae_sync_pte()
334 if (!cfg->coherent_walk && num_entries) in __arm_lpae_clear_pte()
338 static size_t __arm_lpae_unmap(struct arm_lpae_io_pgtable *data,
340 unsigned long iova, size_t size, size_t pgcount,
343 static void __arm_lpae_init_pte(struct arm_lpae_io_pgtable *data, in __arm_lpae_init_pte() argument
348 struct io_pgtable_cfg *cfg = &data->iop.cfg; in __arm_lpae_init_pte()
349 size_t sz = ARM_LPAE_BLOCK_SIZE(lvl, data); in __arm_lpae_init_pte()
352 if (data->iop.fmt != ARM_MALI_LPAE && lvl == ARM_LPAE_MAX_LEVELS - 1) in __arm_lpae_init_pte()
358 ptep[i] = pte | paddr_to_iopte(paddr + i * sz, data); in __arm_lpae_init_pte()
360 if (!cfg->coherent_walk) in __arm_lpae_init_pte()
364 static int arm_lpae_init_pte(struct arm_lpae_io_pgtable *data, in arm_lpae_init_pte() argument
372 if (iopte_leaf(ptep[i], lvl, data->iop.fmt)) { in arm_lpae_init_pte()
375 return -EEXIST; in arm_lpae_init_pte()
382 size_t sz = ARM_LPAE_BLOCK_SIZE(lvl, data); in arm_lpae_init_pte()
384 tblp = ptep - ARM_LPAE_LVL_IDX(iova, lvl, data); in arm_lpae_init_pte()
385 if (__arm_lpae_unmap(data, NULL, iova + i * sz, sz, 1, in arm_lpae_init_pte()
388 return -EINVAL; in arm_lpae_init_pte()
392 __arm_lpae_init_pte(data, paddr, prot, lvl, num_entries, ptep); in arm_lpae_init_pte()
399 struct arm_lpae_io_pgtable *data) in arm_lpae_install_table() argument
402 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_install_table()
404 new = paddr_to_iopte(__pa(table), data) | ARM_LPAE_PTE_TYPE_TABLE; in arm_lpae_install_table()
405 if (cfg->quirks & IO_PGTABLE_QUIRK_ARM_NS) in arm_lpae_install_table()
417 if (cfg->coherent_walk || (old & ARM_LPAE_PTE_SW_SYNC)) in arm_lpae_install_table()
428 static int __arm_lpae_map(struct arm_lpae_io_pgtable *data, unsigned long iova, in __arm_lpae_map() argument
429 phys_addr_t paddr, size_t size, size_t pgcount, in __arm_lpae_map() argument
434 size_t block_size = ARM_LPAE_BLOCK_SIZE(lvl, data); in __arm_lpae_map()
435 size_t tblsz = ARM_LPAE_GRANULE(data); in __arm_lpae_map()
436 struct io_pgtable_cfg *cfg = &data->iop.cfg; in __arm_lpae_map()
440 map_idx_start = ARM_LPAE_LVL_IDX(iova, lvl, data); in __arm_lpae_map()
444 if (size == block_size) { in __arm_lpae_map()
445 max_entries = arm_lpae_max_entries(map_idx_start, data); in __arm_lpae_map()
447 ret = arm_lpae_init_pte(data, iova, paddr, prot, lvl, num_entries, ptep); in __arm_lpae_map()
449 *mapped += num_entries * size; in __arm_lpae_map()
455 if (WARN_ON(lvl >= ARM_LPAE_MAX_LEVELS - 1)) in __arm_lpae_map()
456 return -EINVAL; in __arm_lpae_map()
461 cptep = __arm_lpae_alloc_pages(tblsz, gfp, cfg, data->iop.cookie); in __arm_lpae_map()
463 return -ENOMEM; in __arm_lpae_map()
465 pte = arm_lpae_install_table(cptep, ptep, 0, data); in __arm_lpae_map()
467 __arm_lpae_free_pages(cptep, tblsz, cfg, data->iop.cookie); in __arm_lpae_map()
468 } else if (!cfg->coherent_walk && !(pte & ARM_LPAE_PTE_SW_SYNC)) { in __arm_lpae_map()
472 if (pte && !iopte_leaf(pte, lvl, data->iop.fmt)) { in __arm_lpae_map()
473 cptep = iopte_deref(pte, data); in __arm_lpae_map()
477 return -EEXIST; in __arm_lpae_map()
481 return __arm_lpae_map(data, iova, paddr, size, pgcount, prot, lvl + 1, in __arm_lpae_map()
485 static arm_lpae_iopte arm_lpae_prot_to_pte(struct arm_lpae_io_pgtable *data, in arm_lpae_prot_to_pte() argument
490 if (data->iop.fmt == ARM_64_LPAE_S1 || in arm_lpae_prot_to_pte()
491 data->iop.fmt == ARM_32_LPAE_S1) { in arm_lpae_prot_to_pte()
495 else if (data->iop.cfg.quirks & IO_PGTABLE_QUIRK_ARM_HD) in arm_lpae_prot_to_pte()
509 * having stage-1-like attributes but stage-2-like permissions. in arm_lpae_prot_to_pte()
511 if (data->iop.fmt == ARM_64_LPAE_S2 || in arm_lpae_prot_to_pte()
512 data->iop.fmt == ARM_32_LPAE_S2) { in arm_lpae_prot_to_pte()
516 if (data->iop.cfg.quirks & IO_PGTABLE_QUIRK_ARM_S2FWB) in arm_lpae_prot_to_pte()
538 if (prot & IOMMU_CACHE && data->iop.fmt != ARM_MALI_LPAE) in arm_lpae_prot_to_pte()
546 if (data->iop.cfg.quirks & IO_PGTABLE_QUIRK_ARM_NS) in arm_lpae_prot_to_pte()
549 if (data->iop.fmt != ARM_MALI_LPAE) in arm_lpae_prot_to_pte()
559 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_map_pages() local
560 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_map_pages()
561 arm_lpae_iopte *ptep = data->pgd; in arm_lpae_map_pages()
562 int ret, lvl = data->start_level; in arm_lpae_map_pages()
564 long iaext = (s64)iova >> cfg->ias; in arm_lpae_map_pages()
566 if (WARN_ON(!pgsize || (pgsize & cfg->pgsize_bitmap) != pgsize)) in arm_lpae_map_pages()
567 return -EINVAL; in arm_lpae_map_pages()
569 if (cfg->quirks & IO_PGTABLE_QUIRK_ARM_TTBR1) in arm_lpae_map_pages()
571 if (WARN_ON(iaext || paddr >> cfg->oas)) in arm_lpae_map_pages()
572 return -ERANGE; in arm_lpae_map_pages()
575 return -EINVAL; in arm_lpae_map_pages()
577 prot = arm_lpae_prot_to_pte(data, iommu_prot); in arm_lpae_map_pages()
578 ret = __arm_lpae_map(data, iova, paddr, pgsize, pgcount, prot, lvl, in arm_lpae_map_pages()
589 static void __arm_lpae_free_pgtable(struct arm_lpae_io_pgtable *data, int lvl, in __arm_lpae_free_pgtable() argument
595 if (lvl == data->start_level) in __arm_lpae_free_pgtable()
596 table_size = ARM_LPAE_PGD_SIZE(data); in __arm_lpae_free_pgtable()
598 table_size = ARM_LPAE_GRANULE(data); in __arm_lpae_free_pgtable()
603 if (lvl == ARM_LPAE_MAX_LEVELS - 1) in __arm_lpae_free_pgtable()
611 if (!pte || iopte_leaf(pte, lvl, data->iop.fmt)) in __arm_lpae_free_pgtable()
614 __arm_lpae_free_pgtable(data, lvl + 1, iopte_deref(pte, data)); in __arm_lpae_free_pgtable()
617 __arm_lpae_free_pages(start, table_size, &data->iop.cfg, data->iop.cookie); in __arm_lpae_free_pgtable()
622 struct arm_lpae_io_pgtable *data = io_pgtable_to_data(iop); in arm_lpae_free_pgtable() local
624 __arm_lpae_free_pgtable(data, data->start_level, data->pgd); in arm_lpae_free_pgtable()
625 kfree(data); in arm_lpae_free_pgtable()
628 static size_t __arm_lpae_unmap(struct arm_lpae_io_pgtable *data, in __arm_lpae_unmap() argument
630 unsigned long iova, size_t size, size_t pgcount, in __arm_lpae_unmap() argument
634 struct io_pgtable *iop = &data->iop; in __arm_lpae_unmap()
641 unmap_idx_start = ARM_LPAE_LVL_IDX(iova, lvl, data); in __arm_lpae_unmap()
647 /* If the size matches this level, we're in the right place */ in __arm_lpae_unmap()
648 if (size == ARM_LPAE_BLOCK_SIZE(lvl, data)) { in __arm_lpae_unmap()
649 max_entries = arm_lpae_max_entries(unmap_idx_start, data); in __arm_lpae_unmap()
652 /* Find and handle non-leaf entries */ in __arm_lpae_unmap()
658 if (!iopte_leaf(pte, lvl, iop->fmt)) { in __arm_lpae_unmap()
659 __arm_lpae_clear_pte(&ptep[i], &iop->cfg, 1); in __arm_lpae_unmap()
662 io_pgtable_tlb_flush_walk(iop, iova + i * size, size, in __arm_lpae_unmap()
663 ARM_LPAE_GRANULE(data)); in __arm_lpae_unmap()
664 __arm_lpae_free_pgtable(data, lvl + 1, iopte_deref(pte, data)); in __arm_lpae_unmap()
669 __arm_lpae_clear_pte(ptep, &iop->cfg, i); in __arm_lpae_unmap()
673 io_pgtable_tlb_add_page(iop, gather, iova + j * size, size); in __arm_lpae_unmap()
675 return i * size; in __arm_lpae_unmap()
676 } else if (iopte_leaf(pte, lvl, iop->fmt)) { in __arm_lpae_unmap()
682 ptep = iopte_deref(pte, data); in __arm_lpae_unmap()
683 return __arm_lpae_unmap(data, gather, iova, size, pgcount, lvl + 1, ptep); in __arm_lpae_unmap()
690 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_unmap_pages() local
691 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_unmap_pages()
692 arm_lpae_iopte *ptep = data->pgd; in arm_lpae_unmap_pages()
693 long iaext = (s64)iova >> cfg->ias; in arm_lpae_unmap_pages()
695 if (WARN_ON(!pgsize || (pgsize & cfg->pgsize_bitmap) != pgsize || !pgcount)) in arm_lpae_unmap_pages()
698 if (cfg->quirks & IO_PGTABLE_QUIRK_ARM_TTBR1) in arm_lpae_unmap_pages()
703 return __arm_lpae_unmap(data, gather, iova, pgsize, pgcount, in arm_lpae_unmap_pages()
704 data->start_level, ptep); in arm_lpae_unmap_pages()
709 void *data; member
711 arm_lpae_iopte *ptep, size_t size);
717 static int __arm_lpae_iopte_walk(struct arm_lpae_io_pgtable *data,
728 arm_lpae_iopte *ptep, size_t size) in visit_iova_to_phys() argument
730 struct iova_to_phys_data *data = walk_data->data; in visit_iova_to_phys() local
731 data->pte = *ptep; in visit_iova_to_phys()
732 data->lvl = lvl; in visit_iova_to_phys()
739 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_iova_to_phys() local
742 .data = &d, in arm_lpae_iova_to_phys()
749 ret = __arm_lpae_iopte_walk(data, &walk_data, data->pgd, data->start_level); in arm_lpae_iova_to_phys()
753 iova &= (ARM_LPAE_BLOCK_SIZE(d.lvl, data) - 1); in arm_lpae_iova_to_phys()
754 return iopte_to_paddr(d.pte, data) | iova; in arm_lpae_iova_to_phys()
758 arm_lpae_iopte *ptep, size_t size) in visit_pgtable_walk() argument
760 struct arm_lpae_io_pgtable_walk_data *data = walk_data->data; in visit_pgtable_walk() local
761 data->ptes[lvl] = *ptep; in visit_pgtable_walk()
768 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_pgtable_walk() local
770 .data = wd, in arm_lpae_pgtable_walk()
776 return __arm_lpae_iopte_walk(data, &walk_data, data->pgd, data->start_level); in arm_lpae_pgtable_walk()
779 static int io_pgtable_visit(struct arm_lpae_io_pgtable *data, in io_pgtable_visit() argument
783 struct io_pgtable *iop = &data->iop; in io_pgtable_visit()
786 size_t size = ARM_LPAE_BLOCK_SIZE(lvl, data); in io_pgtable_visit() local
787 int ret = walk_data->visit(walk_data, lvl, ptep, size); in io_pgtable_visit()
791 if (iopte_leaf(pte, lvl, iop->fmt)) { in io_pgtable_visit()
792 walk_data->addr += size; in io_pgtable_visit()
797 return -EINVAL; in io_pgtable_visit()
800 ptep = iopte_deref(pte, data); in io_pgtable_visit()
801 return __arm_lpae_iopte_walk(data, walk_data, ptep, lvl + 1); in io_pgtable_visit()
804 static int __arm_lpae_iopte_walk(struct arm_lpae_io_pgtable *data, in __arm_lpae_iopte_walk() argument
813 return -EINVAL; in __arm_lpae_iopte_walk()
815 if (lvl == data->start_level) in __arm_lpae_iopte_walk()
816 max_entries = ARM_LPAE_PGD_SIZE(data) / sizeof(arm_lpae_iopte); in __arm_lpae_iopte_walk()
818 max_entries = ARM_LPAE_PTES_PER_TABLE(data); in __arm_lpae_iopte_walk()
820 for (idx = ARM_LPAE_LVL_IDX(walk_data->addr, lvl, data); in __arm_lpae_iopte_walk()
821 (idx < max_entries) && (walk_data->addr < walk_data->end); ++idx) { in __arm_lpae_iopte_walk()
822 ret = io_pgtable_visit(data, walk_data, ptep + idx, lvl); in __arm_lpae_iopte_walk()
831 arm_lpae_iopte *ptep, size_t size) in visit_dirty() argument
833 struct iommu_dirty_bitmap *dirty = walk_data->data; in visit_dirty()
835 if (!iopte_leaf(*ptep, lvl, walk_data->iop->fmt)) in visit_dirty()
839 iommu_dirty_bitmap_record(dirty, walk_data->addr, size); in visit_dirty()
840 if (!(walk_data->flags & IOMMU_DIRTY_NO_CLEAR)) in visit_dirty()
848 unsigned long iova, size_t size, in arm_lpae_read_and_clear_dirty() argument
852 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_read_and_clear_dirty() local
853 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_read_and_clear_dirty()
855 .iop = &data->iop, in arm_lpae_read_and_clear_dirty()
856 .data = dirty, in arm_lpae_read_and_clear_dirty()
860 .end = iova + size, in arm_lpae_read_and_clear_dirty()
862 arm_lpae_iopte *ptep = data->pgd; in arm_lpae_read_and_clear_dirty()
863 int lvl = data->start_level; in arm_lpae_read_and_clear_dirty()
865 if (WARN_ON(!size)) in arm_lpae_read_and_clear_dirty()
866 return -EINVAL; in arm_lpae_read_and_clear_dirty()
867 if (WARN_ON((iova + size - 1) & ~(BIT(cfg->ias) - 1))) in arm_lpae_read_and_clear_dirty()
868 return -EINVAL; in arm_lpae_read_and_clear_dirty()
869 if (data->iop.fmt != ARM_64_LPAE_S1) in arm_lpae_read_and_clear_dirty()
870 return -EINVAL; in arm_lpae_read_and_clear_dirty()
872 return __arm_lpae_iopte_walk(data, &walk_data, ptep, lvl); in arm_lpae_read_and_clear_dirty()
883 * the CPU page size if possible, otherwise prefer smaller sizes. in arm_lpae_restrict_pgsizes()
887 if (cfg->pgsize_bitmap & PAGE_SIZE) in arm_lpae_restrict_pgsizes()
889 else if (cfg->pgsize_bitmap & ~PAGE_MASK) in arm_lpae_restrict_pgsizes()
890 granule = 1UL << __fls(cfg->pgsize_bitmap & ~PAGE_MASK); in arm_lpae_restrict_pgsizes()
891 else if (cfg->pgsize_bitmap & PAGE_MASK) in arm_lpae_restrict_pgsizes()
892 granule = 1UL << __ffs(cfg->pgsize_bitmap & PAGE_MASK); in arm_lpae_restrict_pgsizes()
906 if (cfg->oas > 48) in arm_lpae_restrict_pgsizes()
913 cfg->pgsize_bitmap &= page_sizes; in arm_lpae_restrict_pgsizes()
914 cfg->ias = min(cfg->ias, max_addr_bits); in arm_lpae_restrict_pgsizes()
915 cfg->oas = min(cfg->oas, max_addr_bits); in arm_lpae_restrict_pgsizes()
921 struct arm_lpae_io_pgtable *data; in arm_lpae_alloc_pgtable() local
926 if (!(cfg->pgsize_bitmap & (SZ_4K | SZ_16K | SZ_64K))) in arm_lpae_alloc_pgtable()
929 if (cfg->ias > ARM_LPAE_MAX_ADDR_BITS) in arm_lpae_alloc_pgtable()
932 if (cfg->oas > ARM_LPAE_MAX_ADDR_BITS) in arm_lpae_alloc_pgtable()
935 data = kmalloc(sizeof(*data), GFP_KERNEL); in arm_lpae_alloc_pgtable()
936 if (!data) in arm_lpae_alloc_pgtable()
939 pg_shift = __ffs(cfg->pgsize_bitmap); in arm_lpae_alloc_pgtable()
940 data->bits_per_level = pg_shift - ilog2(sizeof(arm_lpae_iopte)); in arm_lpae_alloc_pgtable()
942 va_bits = cfg->ias - pg_shift; in arm_lpae_alloc_pgtable()
943 levels = DIV_ROUND_UP(va_bits, data->bits_per_level); in arm_lpae_alloc_pgtable()
944 data->start_level = ARM_LPAE_MAX_LEVELS - levels; in arm_lpae_alloc_pgtable()
946 /* Calculate the actual size of our pgd (without concatenation) */ in arm_lpae_alloc_pgtable()
947 data->pgd_bits = va_bits - (data->bits_per_level * (levels - 1)); in arm_lpae_alloc_pgtable()
949 data->iop.ops = (struct io_pgtable_ops) { in arm_lpae_alloc_pgtable()
957 return data; in arm_lpae_alloc_pgtable()
964 struct arm_lpae_io_pgtable *data; in arm_64_lpae_alloc_pgtable_s1() local
965 typeof(&cfg->arm_lpae_s1_cfg.tcr) tcr = &cfg->arm_lpae_s1_cfg.tcr; in arm_64_lpae_alloc_pgtable_s1()
968 if (cfg->quirks & ~(IO_PGTABLE_QUIRK_ARM_NS | in arm_64_lpae_alloc_pgtable_s1()
974 data = arm_lpae_alloc_pgtable(cfg); in arm_64_lpae_alloc_pgtable_s1()
975 if (!data) in arm_64_lpae_alloc_pgtable_s1()
979 if (cfg->coherent_walk) { in arm_64_lpae_alloc_pgtable_s1()
980 tcr->sh = ARM_LPAE_TCR_SH_IS; in arm_64_lpae_alloc_pgtable_s1()
981 tcr->irgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s1()
982 tcr->orgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s1()
983 if (cfg->quirks & IO_PGTABLE_QUIRK_ARM_OUTER_WBWA) in arm_64_lpae_alloc_pgtable_s1()
986 tcr->sh = ARM_LPAE_TCR_SH_OS; in arm_64_lpae_alloc_pgtable_s1()
987 tcr->irgn = ARM_LPAE_TCR_RGN_NC; in arm_64_lpae_alloc_pgtable_s1()
988 if (!(cfg->quirks & IO_PGTABLE_QUIRK_ARM_OUTER_WBWA)) in arm_64_lpae_alloc_pgtable_s1()
989 tcr->orgn = ARM_LPAE_TCR_RGN_NC; in arm_64_lpae_alloc_pgtable_s1()
991 tcr->orgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s1()
994 tg1 = cfg->quirks & IO_PGTABLE_QUIRK_ARM_TTBR1; in arm_64_lpae_alloc_pgtable_s1()
995 switch (ARM_LPAE_GRANULE(data)) { in arm_64_lpae_alloc_pgtable_s1()
997 tcr->tg = tg1 ? ARM_LPAE_TCR_TG1_4K : ARM_LPAE_TCR_TG0_4K; in arm_64_lpae_alloc_pgtable_s1()
1000 tcr->tg = tg1 ? ARM_LPAE_TCR_TG1_16K : ARM_LPAE_TCR_TG0_16K; in arm_64_lpae_alloc_pgtable_s1()
1003 tcr->tg = tg1 ? ARM_LPAE_TCR_TG1_64K : ARM_LPAE_TCR_TG0_64K; in arm_64_lpae_alloc_pgtable_s1()
1007 switch (cfg->oas) { in arm_64_lpae_alloc_pgtable_s1()
1009 tcr->ips = ARM_LPAE_TCR_PS_32_BIT; in arm_64_lpae_alloc_pgtable_s1()
1012 tcr->ips = ARM_LPAE_TCR_PS_36_BIT; in arm_64_lpae_alloc_pgtable_s1()
1015 tcr->ips = ARM_LPAE_TCR_PS_40_BIT; in arm_64_lpae_alloc_pgtable_s1()
1018 tcr->ips = ARM_LPAE_TCR_PS_42_BIT; in arm_64_lpae_alloc_pgtable_s1()
1021 tcr->ips = ARM_LPAE_TCR_PS_44_BIT; in arm_64_lpae_alloc_pgtable_s1()
1024 tcr->ips = ARM_LPAE_TCR_PS_48_BIT; in arm_64_lpae_alloc_pgtable_s1()
1027 tcr->ips = ARM_LPAE_TCR_PS_52_BIT; in arm_64_lpae_alloc_pgtable_s1()
1033 tcr->tsz = 64ULL - cfg->ias; in arm_64_lpae_alloc_pgtable_s1()
1045 cfg->arm_lpae_s1_cfg.mair = reg; in arm_64_lpae_alloc_pgtable_s1()
1048 data->pgd = __arm_lpae_alloc_pages(ARM_LPAE_PGD_SIZE(data), in arm_64_lpae_alloc_pgtable_s1()
1050 if (!data->pgd) in arm_64_lpae_alloc_pgtable_s1()
1057 cfg->arm_lpae_s1_cfg.ttbr = virt_to_phys(data->pgd); in arm_64_lpae_alloc_pgtable_s1()
1058 return &data->iop; in arm_64_lpae_alloc_pgtable_s1()
1061 kfree(data); in arm_64_lpae_alloc_pgtable_s1()
1069 struct arm_lpae_io_pgtable *data; in arm_64_lpae_alloc_pgtable_s2() local
1070 typeof(&cfg->arm_lpae_s2_cfg.vtcr) vtcr = &cfg->arm_lpae_s2_cfg.vtcr; in arm_64_lpae_alloc_pgtable_s2()
1072 if (cfg->quirks & ~(IO_PGTABLE_QUIRK_ARM_S2FWB)) in arm_64_lpae_alloc_pgtable_s2()
1075 data = arm_lpae_alloc_pgtable(cfg); in arm_64_lpae_alloc_pgtable_s2()
1076 if (!data) in arm_64_lpae_alloc_pgtable_s2()
1079 if (arm_lpae_concat_mandatory(cfg, data)) { in arm_64_lpae_alloc_pgtable_s2()
1080 if (WARN_ON((ARM_LPAE_PGD_SIZE(data) / sizeof(arm_lpae_iopte)) > in arm_64_lpae_alloc_pgtable_s2()
1083 data->pgd_bits += data->bits_per_level; in arm_64_lpae_alloc_pgtable_s2()
1084 data->start_level++; in arm_64_lpae_alloc_pgtable_s2()
1088 if (cfg->coherent_walk) { in arm_64_lpae_alloc_pgtable_s2()
1089 vtcr->sh = ARM_LPAE_TCR_SH_IS; in arm_64_lpae_alloc_pgtable_s2()
1090 vtcr->irgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s2()
1091 vtcr->orgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s2()
1093 vtcr->sh = ARM_LPAE_TCR_SH_OS; in arm_64_lpae_alloc_pgtable_s2()
1094 vtcr->irgn = ARM_LPAE_TCR_RGN_NC; in arm_64_lpae_alloc_pgtable_s2()
1095 vtcr->orgn = ARM_LPAE_TCR_RGN_NC; in arm_64_lpae_alloc_pgtable_s2()
1098 sl = data->start_level; in arm_64_lpae_alloc_pgtable_s2()
1100 switch (ARM_LPAE_GRANULE(data)) { in arm_64_lpae_alloc_pgtable_s2()
1102 vtcr->tg = ARM_LPAE_TCR_TG0_4K; in arm_64_lpae_alloc_pgtable_s2()
1103 sl++; /* SL0 format is different for 4K granule size */ in arm_64_lpae_alloc_pgtable_s2()
1106 vtcr->tg = ARM_LPAE_TCR_TG0_16K; in arm_64_lpae_alloc_pgtable_s2()
1109 vtcr->tg = ARM_LPAE_TCR_TG0_64K; in arm_64_lpae_alloc_pgtable_s2()
1113 switch (cfg->oas) { in arm_64_lpae_alloc_pgtable_s2()
1115 vtcr->ps = ARM_LPAE_TCR_PS_32_BIT; in arm_64_lpae_alloc_pgtable_s2()
1118 vtcr->ps = ARM_LPAE_TCR_PS_36_BIT; in arm_64_lpae_alloc_pgtable_s2()
1121 vtcr->ps = ARM_LPAE_TCR_PS_40_BIT; in arm_64_lpae_alloc_pgtable_s2()
1124 vtcr->ps = ARM_LPAE_TCR_PS_42_BIT; in arm_64_lpae_alloc_pgtable_s2()
1127 vtcr->ps = ARM_LPAE_TCR_PS_44_BIT; in arm_64_lpae_alloc_pgtable_s2()
1130 vtcr->ps = ARM_LPAE_TCR_PS_48_BIT; in arm_64_lpae_alloc_pgtable_s2()
1133 vtcr->ps = ARM_LPAE_TCR_PS_52_BIT; in arm_64_lpae_alloc_pgtable_s2()
1139 vtcr->tsz = 64ULL - cfg->ias; in arm_64_lpae_alloc_pgtable_s2()
1140 vtcr->sl = ~sl & ARM_LPAE_VTCR_SL0_MASK; in arm_64_lpae_alloc_pgtable_s2()
1143 data->pgd = __arm_lpae_alloc_pages(ARM_LPAE_PGD_SIZE(data), in arm_64_lpae_alloc_pgtable_s2()
1145 if (!data->pgd) in arm_64_lpae_alloc_pgtable_s2()
1152 cfg->arm_lpae_s2_cfg.vttbr = virt_to_phys(data->pgd); in arm_64_lpae_alloc_pgtable_s2()
1153 return &data->iop; in arm_64_lpae_alloc_pgtable_s2()
1156 kfree(data); in arm_64_lpae_alloc_pgtable_s2()
1163 if (cfg->ias > 32 || cfg->oas > 40) in arm_32_lpae_alloc_pgtable_s1()
1166 cfg->pgsize_bitmap &= (SZ_4K | SZ_2M | SZ_1G); in arm_32_lpae_alloc_pgtable_s1()
1173 if (cfg->ias > 40 || cfg->oas > 40) in arm_32_lpae_alloc_pgtable_s2()
1176 cfg->pgsize_bitmap &= (SZ_4K | SZ_2M | SZ_1G); in arm_32_lpae_alloc_pgtable_s2()
1183 struct arm_lpae_io_pgtable *data; in arm_mali_lpae_alloc_pgtable() local
1186 if (cfg->quirks) in arm_mali_lpae_alloc_pgtable()
1189 if (cfg->ias > 48 || cfg->oas > 40) in arm_mali_lpae_alloc_pgtable()
1192 cfg->pgsize_bitmap &= (SZ_4K | SZ_2M | SZ_1G); in arm_mali_lpae_alloc_pgtable()
1194 data = arm_lpae_alloc_pgtable(cfg); in arm_mali_lpae_alloc_pgtable()
1195 if (!data) in arm_mali_lpae_alloc_pgtable()
1198 /* Mali seems to need a full 4-level table regardless of IAS */ in arm_mali_lpae_alloc_pgtable()
1199 if (data->start_level > 0) { in arm_mali_lpae_alloc_pgtable()
1200 data->start_level = 0; in arm_mali_lpae_alloc_pgtable()
1201 data->pgd_bits = 0; in arm_mali_lpae_alloc_pgtable()
1204 * MEMATTR: Mali has no actual notion of a non-cacheable type, so the in arm_mali_lpae_alloc_pgtable()
1205 * best we can do is mimic the out-of-tree driver and hope that the in arm_mali_lpae_alloc_pgtable()
1206 * "implementation-defined caching policy" is good enough. Similarly, in arm_mali_lpae_alloc_pgtable()
1210 cfg->arm_mali_lpae_cfg.memattr = in arm_mali_lpae_alloc_pgtable()
1218 data->pgd = __arm_lpae_alloc_pages(ARM_LPAE_PGD_SIZE(data), GFP_KERNEL, in arm_mali_lpae_alloc_pgtable()
1220 if (!data->pgd) in arm_mali_lpae_alloc_pgtable()
1226 cfg->arm_mali_lpae_cfg.transtab = virt_to_phys(data->pgd) | in arm_mali_lpae_alloc_pgtable()
1229 if (cfg->coherent_walk) in arm_mali_lpae_alloc_pgtable()
1230 cfg->arm_mali_lpae_cfg.transtab |= ARM_MALI_LPAE_TTBR_SHARE_OUTER; in arm_mali_lpae_alloc_pgtable()
1232 return &data->iop; in arm_mali_lpae_alloc_pgtable()
1235 kfree(data); in arm_mali_lpae_alloc_pgtable()
1278 static void __init dummy_tlb_flush(unsigned long iova, size_t size, in dummy_tlb_flush() argument
1282 WARN_ON(!(size & cfg_cookie->pgsize_bitmap)); in dummy_tlb_flush()
1300 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_dump_ops() local
1301 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_dump_ops()
1303 pr_err("cfg: pgsize_bitmap 0x%lx, ias %u-bit\n", in arm_lpae_dump_ops()
1304 cfg->pgsize_bitmap, cfg->ias); in arm_lpae_dump_ops()
1305 pr_err("data: %d levels, 0x%zx pgd_size, %u pg_shift, %u bits_per_level, pgd @ %p\n", in arm_lpae_dump_ops()
1306 ARM_LPAE_MAX_LEVELS - data->start_level, ARM_LPAE_PGD_SIZE(data), in arm_lpae_dump_ops()
1307 ilog2(ARM_LPAE_GRANULE(data)), data->bits_per_level, data->pgd); in arm_lpae_dump_ops()
1314 -EFAULT; \
1326 size_t size, mapped; in arm_lpae_run_tests() local
1336 return -ENOMEM; in arm_lpae_run_tests()
1343 if (ops->iova_to_phys(ops, 42)) in arm_lpae_run_tests()
1346 if (ops->iova_to_phys(ops, SZ_1G + 42)) in arm_lpae_run_tests()
1349 if (ops->iova_to_phys(ops, SZ_2G + 42)) in arm_lpae_run_tests()
1356 for_each_set_bit(j, &cfg->pgsize_bitmap, BITS_PER_LONG) { in arm_lpae_run_tests()
1357 size = 1UL << j; in arm_lpae_run_tests()
1359 if (ops->map_pages(ops, iova, iova, size, 1, in arm_lpae_run_tests()
1366 if (!ops->map_pages(ops, iova, iova + size, size, 1, in arm_lpae_run_tests()
1371 if (ops->iova_to_phys(ops, iova + 42) != (iova + 42)) in arm_lpae_run_tests()
1379 for_each_set_bit(j, &cfg->pgsize_bitmap, BITS_PER_LONG) { in arm_lpae_run_tests()
1380 size = 1UL << j; in arm_lpae_run_tests()
1382 if (ops->unmap_pages(ops, iova, size, 1, NULL) != size) in arm_lpae_run_tests()
1385 if (ops->iova_to_phys(ops, iova + 42)) in arm_lpae_run_tests()
1389 if (ops->map_pages(ops, iova, iova, size, 1, in arm_lpae_run_tests()
1393 if (ops->iova_to_phys(ops, iova + 42) != (iova + 42)) in arm_lpae_run_tests()
1404 size = 1UL << __fls(cfg->pgsize_bitmap); in arm_lpae_run_tests()
1405 iova = (1UL << cfg->ias) - size; in arm_lpae_run_tests()
1406 if (ops->map_pages(ops, iova, iova, size, 1, in arm_lpae_run_tests()
1411 if (mapped != size) in arm_lpae_run_tests()
1413 if (ops->unmap_pages(ops, iova, size, 1, NULL) != size) in arm_lpae_run_tests()
1448 /* Don't use ias > oas as it is not valid for stage-2. */ in arm_lpae_do_selftests()
1464 return fail ? -EFAULT : 0; in arm_lpae_do_selftests()