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"
41 (((ARM_LPAE_MAX_LEVELS - (l)) * (d)->bits_per_level) + \
45 (sizeof(arm_lpae_iopte) << (d)->bits_per_level)
47 (sizeof(arm_lpae_iopte) << (d)->pgd_bits)
57 ((l) == (d)->start_level ? (d)->pgd_bits - (d)->bits_per_level : 0)
61 ((1 << ((d)->bits_per_level + ARM_LPAE_PGD_IDX(l,d))) - 1))
63 /* Calculate the block/page mapping size at level l for pagetable in d. */
93 /* Stage-1 PTE */
99 /* Stage-2 PTE */
156 if (lvl == (ARM_LPAE_MAX_LEVELS - 1) && fmt != ARM_MALI_LPAE) in iopte_leaf()
163 struct arm_lpae_io_pgtable *data) in paddr_to_iopte() argument
168 return (pte | (pte >> (48 - 12))) & ARM_LPAE_PTE_ADDR_MASK; in paddr_to_iopte()
172 struct arm_lpae_io_pgtable *data) in iopte_to_paddr() argument
176 if (ARM_LPAE_GRANULE(data) < SZ_64K) in iopte_to_paddr()
179 /* Rotate the packed high-order bits back to the top */ in iopte_to_paddr()
180 return (paddr | (paddr << (48 - 12))) & (ARM_LPAE_PTE_ADDR_MASK << 4); in iopte_to_paddr()
190 static void *__arm_lpae_alloc_pages(size_t size, gfp_t gfp, in __arm_lpae_alloc_pages() argument
194 struct device *dev = cfg->iommu_dev; in __arm_lpae_alloc_pages()
195 int order = get_order(size); in __arm_lpae_alloc_pages()
201 if (cfg->alloc) { in __arm_lpae_alloc_pages()
202 pages = cfg->alloc(cookie, size, gfp); in __arm_lpae_alloc_pages()
213 if (!cfg->coherent_walk) { in __arm_lpae_alloc_pages()
214 dma = dma_map_single(dev, pages, size, DMA_TO_DEVICE); in __arm_lpae_alloc_pages()
230 dma_unmap_single(dev, dma, size, DMA_TO_DEVICE); in __arm_lpae_alloc_pages()
233 if (cfg->free) in __arm_lpae_alloc_pages()
234 cfg->free(cookie, pages, size); in __arm_lpae_alloc_pages()
241 static void __arm_lpae_free_pages(void *pages, size_t size, in __arm_lpae_free_pages() argument
245 if (!cfg->coherent_walk) in __arm_lpae_free_pages()
246 dma_unmap_single(cfg->iommu_dev, __arm_lpae_dma_addr(pages), in __arm_lpae_free_pages()
247 size, DMA_TO_DEVICE); in __arm_lpae_free_pages()
249 if (cfg->free) in __arm_lpae_free_pages()
250 cfg->free(cookie, pages, size); in __arm_lpae_free_pages()
252 free_pages((unsigned long)pages, get_order(size)); in __arm_lpae_free_pages()
258 dma_sync_single_for_device(cfg->iommu_dev, __arm_lpae_dma_addr(ptep), in __arm_lpae_sync_pte()
267 if (!cfg->coherent_walk) in __arm_lpae_clear_pte()
271 static size_t __arm_lpae_unmap(struct arm_lpae_io_pgtable *data,
273 unsigned long iova, size_t size, size_t pgcount,
276 static void __arm_lpae_init_pte(struct arm_lpae_io_pgtable *data, in __arm_lpae_init_pte() argument
281 struct io_pgtable_cfg *cfg = &data->iop.cfg; in __arm_lpae_init_pte()
282 size_t sz = ARM_LPAE_BLOCK_SIZE(lvl, data); in __arm_lpae_init_pte()
285 if (data->iop.fmt != ARM_MALI_LPAE && lvl == ARM_LPAE_MAX_LEVELS - 1) in __arm_lpae_init_pte()
291 ptep[i] = pte | paddr_to_iopte(paddr + i * sz, data); in __arm_lpae_init_pte()
293 if (!cfg->coherent_walk) in __arm_lpae_init_pte()
297 static int arm_lpae_init_pte(struct arm_lpae_io_pgtable *data, in arm_lpae_init_pte() argument
305 if (iopte_leaf(ptep[i], lvl, data->iop.fmt)) { in arm_lpae_init_pte()
308 return -EEXIST; in arm_lpae_init_pte()
315 size_t sz = ARM_LPAE_BLOCK_SIZE(lvl, data); in arm_lpae_init_pte()
317 tblp = ptep - ARM_LPAE_LVL_IDX(iova, lvl, data); in arm_lpae_init_pte()
318 if (__arm_lpae_unmap(data, NULL, iova + i * sz, sz, 1, in arm_lpae_init_pte()
321 return -EINVAL; in arm_lpae_init_pte()
325 __arm_lpae_init_pte(data, paddr, prot, lvl, num_entries, ptep); in arm_lpae_init_pte()
332 struct arm_lpae_io_pgtable *data) in arm_lpae_install_table() argument
335 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_install_table()
337 new = paddr_to_iopte(__pa(table), data) | ARM_LPAE_PTE_TYPE_TABLE; in arm_lpae_install_table()
338 if (cfg->quirks & IO_PGTABLE_QUIRK_ARM_NS) in arm_lpae_install_table()
350 if (cfg->coherent_walk || (old & ARM_LPAE_PTE_SW_SYNC)) in arm_lpae_install_table()
361 static int __arm_lpae_map(struct arm_lpae_io_pgtable *data, unsigned long iova, in __arm_lpae_map() argument
362 phys_addr_t paddr, size_t size, size_t pgcount, in __arm_lpae_map() argument
367 size_t block_size = ARM_LPAE_BLOCK_SIZE(lvl, data); in __arm_lpae_map()
368 size_t tblsz = ARM_LPAE_GRANULE(data); in __arm_lpae_map()
369 struct io_pgtable_cfg *cfg = &data->iop.cfg; in __arm_lpae_map()
373 map_idx_start = ARM_LPAE_LVL_IDX(iova, lvl, data); in __arm_lpae_map()
377 if (size == block_size) { in __arm_lpae_map()
378 max_entries = ARM_LPAE_PTES_PER_TABLE(data) - map_idx_start; in __arm_lpae_map()
380 ret = arm_lpae_init_pte(data, iova, paddr, prot, lvl, num_entries, ptep); in __arm_lpae_map()
382 *mapped += num_entries * size; in __arm_lpae_map()
388 if (WARN_ON(lvl >= ARM_LPAE_MAX_LEVELS - 1)) in __arm_lpae_map()
389 return -EINVAL; in __arm_lpae_map()
394 cptep = __arm_lpae_alloc_pages(tblsz, gfp, cfg, data->iop.cookie); in __arm_lpae_map()
396 return -ENOMEM; in __arm_lpae_map()
398 pte = arm_lpae_install_table(cptep, ptep, 0, data); in __arm_lpae_map()
400 __arm_lpae_free_pages(cptep, tblsz, cfg, data->iop.cookie); in __arm_lpae_map()
401 } else if (!cfg->coherent_walk && !(pte & ARM_LPAE_PTE_SW_SYNC)) { in __arm_lpae_map()
405 if (pte && !iopte_leaf(pte, lvl, data->iop.fmt)) { in __arm_lpae_map()
406 cptep = iopte_deref(pte, data); in __arm_lpae_map()
410 return -EEXIST; in __arm_lpae_map()
414 return __arm_lpae_map(data, iova, paddr, size, pgcount, prot, lvl + 1, in __arm_lpae_map()
418 static arm_lpae_iopte arm_lpae_prot_to_pte(struct arm_lpae_io_pgtable *data, in arm_lpae_prot_to_pte() argument
423 if (data->iop.fmt == ARM_64_LPAE_S1 || in arm_lpae_prot_to_pte()
424 data->iop.fmt == ARM_32_LPAE_S1) { in arm_lpae_prot_to_pte()
440 * having stage-1-like attributes but stage-2-like permissions. in arm_lpae_prot_to_pte()
442 if (data->iop.fmt == ARM_64_LPAE_S2 || in arm_lpae_prot_to_pte()
443 data->iop.fmt == ARM_32_LPAE_S2) { in arm_lpae_prot_to_pte()
465 if (prot & IOMMU_CACHE && data->iop.fmt != ARM_MALI_LPAE) in arm_lpae_prot_to_pte()
473 if (data->iop.cfg.quirks & IO_PGTABLE_QUIRK_ARM_NS) in arm_lpae_prot_to_pte()
476 if (data->iop.fmt != ARM_MALI_LPAE) in arm_lpae_prot_to_pte()
486 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_map_pages() local
487 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_map_pages()
488 arm_lpae_iopte *ptep = data->pgd; in arm_lpae_map_pages()
489 int ret, lvl = data->start_level; in arm_lpae_map_pages()
491 long iaext = (s64)iova >> cfg->ias; in arm_lpae_map_pages()
493 if (WARN_ON(!pgsize || (pgsize & cfg->pgsize_bitmap) != pgsize)) in arm_lpae_map_pages()
494 return -EINVAL; in arm_lpae_map_pages()
496 if (cfg->quirks & IO_PGTABLE_QUIRK_ARM_TTBR1) in arm_lpae_map_pages()
498 if (WARN_ON(iaext || paddr >> cfg->oas)) in arm_lpae_map_pages()
499 return -ERANGE; in arm_lpae_map_pages()
505 prot = arm_lpae_prot_to_pte(data, iommu_prot); in arm_lpae_map_pages()
506 ret = __arm_lpae_map(data, iova, paddr, pgsize, pgcount, prot, lvl, in arm_lpae_map_pages()
517 static void __arm_lpae_free_pgtable(struct arm_lpae_io_pgtable *data, int lvl, in __arm_lpae_free_pgtable() argument
523 if (lvl == data->start_level) in __arm_lpae_free_pgtable()
524 table_size = ARM_LPAE_PGD_SIZE(data); in __arm_lpae_free_pgtable()
526 table_size = ARM_LPAE_GRANULE(data); in __arm_lpae_free_pgtable()
531 if (lvl == ARM_LPAE_MAX_LEVELS - 1) in __arm_lpae_free_pgtable()
539 if (!pte || iopte_leaf(pte, lvl, data->iop.fmt)) in __arm_lpae_free_pgtable()
542 __arm_lpae_free_pgtable(data, lvl + 1, iopte_deref(pte, data)); in __arm_lpae_free_pgtable()
545 __arm_lpae_free_pages(start, table_size, &data->iop.cfg, data->iop.cookie); in __arm_lpae_free_pgtable()
550 struct arm_lpae_io_pgtable *data = io_pgtable_to_data(iop); in arm_lpae_free_pgtable() local
552 __arm_lpae_free_pgtable(data, data->start_level, data->pgd); in arm_lpae_free_pgtable()
553 kfree(data); in arm_lpae_free_pgtable()
556 static size_t arm_lpae_split_blk_unmap(struct arm_lpae_io_pgtable *data, in arm_lpae_split_blk_unmap() argument
558 unsigned long iova, size_t size, in arm_lpae_split_blk_unmap() argument
562 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_split_blk_unmap()
565 size_t tablesz = ARM_LPAE_GRANULE(data); in arm_lpae_split_blk_unmap()
566 size_t split_sz = ARM_LPAE_BLOCK_SIZE(lvl, data); in arm_lpae_split_blk_unmap()
567 int ptes_per_table = ARM_LPAE_PTES_PER_TABLE(data); in arm_lpae_split_blk_unmap()
568 int i, unmap_idx_start = -1, num_entries = 0, max_entries; in arm_lpae_split_blk_unmap()
573 tablep = __arm_lpae_alloc_pages(tablesz, GFP_ATOMIC, cfg, data->iop.cookie); in arm_lpae_split_blk_unmap()
577 if (size == split_sz) { in arm_lpae_split_blk_unmap()
578 unmap_idx_start = ARM_LPAE_LVL_IDX(iova, lvl, data); in arm_lpae_split_blk_unmap()
579 max_entries = ptes_per_table - unmap_idx_start; in arm_lpae_split_blk_unmap()
583 blk_paddr = iopte_to_paddr(blk_pte, data); in arm_lpae_split_blk_unmap()
591 __arm_lpae_init_pte(data, blk_paddr, pte, lvl, 1, &tablep[i]); in arm_lpae_split_blk_unmap()
594 pte = arm_lpae_install_table(tablep, ptep, blk_pte, data); in arm_lpae_split_blk_unmap()
596 __arm_lpae_free_pages(tablep, tablesz, cfg, data->iop.cookie); in arm_lpae_split_blk_unmap()
605 tablep = iopte_deref(pte, data); in arm_lpae_split_blk_unmap()
608 io_pgtable_tlb_add_page(&data->iop, gather, iova + i * size, size); in arm_lpae_split_blk_unmap()
610 return num_entries * size; in arm_lpae_split_blk_unmap()
613 return __arm_lpae_unmap(data, gather, iova, size, pgcount, lvl, tablep); in arm_lpae_split_blk_unmap()
616 static size_t __arm_lpae_unmap(struct arm_lpae_io_pgtable *data, in __arm_lpae_unmap() argument
618 unsigned long iova, size_t size, size_t pgcount, in __arm_lpae_unmap() argument
622 struct io_pgtable *iop = &data->iop; in __arm_lpae_unmap()
629 unmap_idx_start = ARM_LPAE_LVL_IDX(iova, lvl, data); in __arm_lpae_unmap()
635 /* If the size matches this level, we're in the right place */ in __arm_lpae_unmap()
636 if (size == ARM_LPAE_BLOCK_SIZE(lvl, data)) { in __arm_lpae_unmap()
637 max_entries = ARM_LPAE_PTES_PER_TABLE(data) - unmap_idx_start; in __arm_lpae_unmap()
645 __arm_lpae_clear_pte(ptep, &iop->cfg); in __arm_lpae_unmap()
647 if (!iopte_leaf(pte, lvl, iop->fmt)) { in __arm_lpae_unmap()
649 io_pgtable_tlb_flush_walk(iop, iova + i * size, size, in __arm_lpae_unmap()
650 ARM_LPAE_GRANULE(data)); in __arm_lpae_unmap()
651 __arm_lpae_free_pgtable(data, lvl + 1, iopte_deref(pte, data)); in __arm_lpae_unmap()
653 io_pgtable_tlb_add_page(iop, gather, iova + i * size, size); in __arm_lpae_unmap()
660 return i * size; in __arm_lpae_unmap()
661 } else if (iopte_leaf(pte, lvl, iop->fmt)) { in __arm_lpae_unmap()
666 return arm_lpae_split_blk_unmap(data, gather, iova, size, pte, in __arm_lpae_unmap()
671 ptep = iopte_deref(pte, data); in __arm_lpae_unmap()
672 return __arm_lpae_unmap(data, gather, iova, size, pgcount, lvl + 1, ptep); in __arm_lpae_unmap()
679 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_unmap_pages() local
680 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_unmap_pages()
681 arm_lpae_iopte *ptep = data->pgd; in arm_lpae_unmap_pages()
682 long iaext = (s64)iova >> cfg->ias; in arm_lpae_unmap_pages()
684 if (WARN_ON(!pgsize || (pgsize & cfg->pgsize_bitmap) != pgsize || !pgcount)) in arm_lpae_unmap_pages()
687 if (cfg->quirks & IO_PGTABLE_QUIRK_ARM_TTBR1) in arm_lpae_unmap_pages()
692 return __arm_lpae_unmap(data, gather, iova, pgsize, pgcount, in arm_lpae_unmap_pages()
693 data->start_level, ptep); in arm_lpae_unmap_pages()
699 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_iova_to_phys() local
700 arm_lpae_iopte pte, *ptep = data->pgd; in arm_lpae_iova_to_phys()
701 int lvl = data->start_level; in arm_lpae_iova_to_phys()
709 ptep += ARM_LPAE_LVL_IDX(iova, lvl, data); in arm_lpae_iova_to_phys()
717 if (iopte_leaf(pte, lvl, data->iop.fmt)) in arm_lpae_iova_to_phys()
721 ptep = iopte_deref(pte, data); in arm_lpae_iova_to_phys()
728 iova &= (ARM_LPAE_BLOCK_SIZE(lvl, data) - 1); in arm_lpae_iova_to_phys()
729 return iopte_to_paddr(pte, data) | iova; in arm_lpae_iova_to_phys()
740 * the CPU page size if possible, otherwise prefer smaller sizes. in arm_lpae_restrict_pgsizes()
744 if (cfg->pgsize_bitmap & PAGE_SIZE) in arm_lpae_restrict_pgsizes()
746 else if (cfg->pgsize_bitmap & ~PAGE_MASK) in arm_lpae_restrict_pgsizes()
747 granule = 1UL << __fls(cfg->pgsize_bitmap & ~PAGE_MASK); in arm_lpae_restrict_pgsizes()
748 else if (cfg->pgsize_bitmap & PAGE_MASK) in arm_lpae_restrict_pgsizes()
749 granule = 1UL << __ffs(cfg->pgsize_bitmap & PAGE_MASK); in arm_lpae_restrict_pgsizes()
763 if (cfg->oas > 48) in arm_lpae_restrict_pgsizes()
770 cfg->pgsize_bitmap &= page_sizes; in arm_lpae_restrict_pgsizes()
771 cfg->ias = min(cfg->ias, max_addr_bits); in arm_lpae_restrict_pgsizes()
772 cfg->oas = min(cfg->oas, max_addr_bits); in arm_lpae_restrict_pgsizes()
778 struct arm_lpae_io_pgtable *data; in arm_lpae_alloc_pgtable() local
783 if (!(cfg->pgsize_bitmap & (SZ_4K | SZ_16K | SZ_64K))) in arm_lpae_alloc_pgtable()
786 if (cfg->ias > ARM_LPAE_MAX_ADDR_BITS) in arm_lpae_alloc_pgtable()
789 if (cfg->oas > ARM_LPAE_MAX_ADDR_BITS) in arm_lpae_alloc_pgtable()
792 data = kmalloc(sizeof(*data), GFP_KERNEL); in arm_lpae_alloc_pgtable()
793 if (!data) in arm_lpae_alloc_pgtable()
796 pg_shift = __ffs(cfg->pgsize_bitmap); in arm_lpae_alloc_pgtable()
797 data->bits_per_level = pg_shift - ilog2(sizeof(arm_lpae_iopte)); in arm_lpae_alloc_pgtable()
799 va_bits = cfg->ias - pg_shift; in arm_lpae_alloc_pgtable()
800 levels = DIV_ROUND_UP(va_bits, data->bits_per_level); in arm_lpae_alloc_pgtable()
801 data->start_level = ARM_LPAE_MAX_LEVELS - levels; in arm_lpae_alloc_pgtable()
803 /* Calculate the actual size of our pgd (without concatenation) */ in arm_lpae_alloc_pgtable()
804 data->pgd_bits = va_bits - (data->bits_per_level * (levels - 1)); in arm_lpae_alloc_pgtable()
806 data->iop.ops = (struct io_pgtable_ops) { in arm_lpae_alloc_pgtable()
812 return data; in arm_lpae_alloc_pgtable()
819 struct arm_lpae_io_pgtable *data; in arm_64_lpae_alloc_pgtable_s1() local
820 typeof(&cfg->arm_lpae_s1_cfg.tcr) tcr = &cfg->arm_lpae_s1_cfg.tcr; in arm_64_lpae_alloc_pgtable_s1()
823 if (cfg->quirks & ~(IO_PGTABLE_QUIRK_ARM_NS | in arm_64_lpae_alloc_pgtable_s1()
828 data = arm_lpae_alloc_pgtable(cfg); in arm_64_lpae_alloc_pgtable_s1()
829 if (!data) in arm_64_lpae_alloc_pgtable_s1()
833 if (cfg->coherent_walk) { in arm_64_lpae_alloc_pgtable_s1()
834 tcr->sh = ARM_LPAE_TCR_SH_IS; in arm_64_lpae_alloc_pgtable_s1()
835 tcr->irgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s1()
836 tcr->orgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s1()
837 if (cfg->quirks & IO_PGTABLE_QUIRK_ARM_OUTER_WBWA) in arm_64_lpae_alloc_pgtable_s1()
840 tcr->sh = ARM_LPAE_TCR_SH_OS; in arm_64_lpae_alloc_pgtable_s1()
841 tcr->irgn = ARM_LPAE_TCR_RGN_NC; in arm_64_lpae_alloc_pgtable_s1()
842 if (!(cfg->quirks & IO_PGTABLE_QUIRK_ARM_OUTER_WBWA)) in arm_64_lpae_alloc_pgtable_s1()
843 tcr->orgn = ARM_LPAE_TCR_RGN_NC; in arm_64_lpae_alloc_pgtable_s1()
845 tcr->orgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s1()
848 tg1 = cfg->quirks & IO_PGTABLE_QUIRK_ARM_TTBR1; in arm_64_lpae_alloc_pgtable_s1()
849 switch (ARM_LPAE_GRANULE(data)) { in arm_64_lpae_alloc_pgtable_s1()
851 tcr->tg = tg1 ? ARM_LPAE_TCR_TG1_4K : ARM_LPAE_TCR_TG0_4K; in arm_64_lpae_alloc_pgtable_s1()
854 tcr->tg = tg1 ? ARM_LPAE_TCR_TG1_16K : ARM_LPAE_TCR_TG0_16K; in arm_64_lpae_alloc_pgtable_s1()
857 tcr->tg = tg1 ? ARM_LPAE_TCR_TG1_64K : ARM_LPAE_TCR_TG0_64K; in arm_64_lpae_alloc_pgtable_s1()
861 switch (cfg->oas) { in arm_64_lpae_alloc_pgtable_s1()
863 tcr->ips = ARM_LPAE_TCR_PS_32_BIT; in arm_64_lpae_alloc_pgtable_s1()
866 tcr->ips = ARM_LPAE_TCR_PS_36_BIT; in arm_64_lpae_alloc_pgtable_s1()
869 tcr->ips = ARM_LPAE_TCR_PS_40_BIT; in arm_64_lpae_alloc_pgtable_s1()
872 tcr->ips = ARM_LPAE_TCR_PS_42_BIT; in arm_64_lpae_alloc_pgtable_s1()
875 tcr->ips = ARM_LPAE_TCR_PS_44_BIT; in arm_64_lpae_alloc_pgtable_s1()
878 tcr->ips = ARM_LPAE_TCR_PS_48_BIT; in arm_64_lpae_alloc_pgtable_s1()
881 tcr->ips = ARM_LPAE_TCR_PS_52_BIT; in arm_64_lpae_alloc_pgtable_s1()
887 tcr->tsz = 64ULL - cfg->ias; in arm_64_lpae_alloc_pgtable_s1()
899 cfg->arm_lpae_s1_cfg.mair = reg; in arm_64_lpae_alloc_pgtable_s1()
902 data->pgd = __arm_lpae_alloc_pages(ARM_LPAE_PGD_SIZE(data), in arm_64_lpae_alloc_pgtable_s1()
904 if (!data->pgd) in arm_64_lpae_alloc_pgtable_s1()
911 cfg->arm_lpae_s1_cfg.ttbr = virt_to_phys(data->pgd); in arm_64_lpae_alloc_pgtable_s1()
912 return &data->iop; in arm_64_lpae_alloc_pgtable_s1()
915 kfree(data); in arm_64_lpae_alloc_pgtable_s1()
923 struct arm_lpae_io_pgtable *data; in arm_64_lpae_alloc_pgtable_s2() local
924 typeof(&cfg->arm_lpae_s2_cfg.vtcr) vtcr = &cfg->arm_lpae_s2_cfg.vtcr; in arm_64_lpae_alloc_pgtable_s2()
927 if (cfg->quirks) in arm_64_lpae_alloc_pgtable_s2()
930 data = arm_lpae_alloc_pgtable(cfg); in arm_64_lpae_alloc_pgtable_s2()
931 if (!data) in arm_64_lpae_alloc_pgtable_s2()
936 * the depth of the stage-2 walk. in arm_64_lpae_alloc_pgtable_s2()
938 if (data->start_level == 0) { in arm_64_lpae_alloc_pgtable_s2()
941 pgd_pages = ARM_LPAE_PGD_SIZE(data) / sizeof(arm_lpae_iopte); in arm_64_lpae_alloc_pgtable_s2()
943 data->pgd_bits += data->bits_per_level; in arm_64_lpae_alloc_pgtable_s2()
944 data->start_level++; in arm_64_lpae_alloc_pgtable_s2()
949 if (cfg->coherent_walk) { in arm_64_lpae_alloc_pgtable_s2()
950 vtcr->sh = ARM_LPAE_TCR_SH_IS; in arm_64_lpae_alloc_pgtable_s2()
951 vtcr->irgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s2()
952 vtcr->orgn = ARM_LPAE_TCR_RGN_WBWA; in arm_64_lpae_alloc_pgtable_s2()
954 vtcr->sh = ARM_LPAE_TCR_SH_OS; in arm_64_lpae_alloc_pgtable_s2()
955 vtcr->irgn = ARM_LPAE_TCR_RGN_NC; in arm_64_lpae_alloc_pgtable_s2()
956 vtcr->orgn = ARM_LPAE_TCR_RGN_NC; in arm_64_lpae_alloc_pgtable_s2()
959 sl = data->start_level; in arm_64_lpae_alloc_pgtable_s2()
961 switch (ARM_LPAE_GRANULE(data)) { in arm_64_lpae_alloc_pgtable_s2()
963 vtcr->tg = ARM_LPAE_TCR_TG0_4K; in arm_64_lpae_alloc_pgtable_s2()
964 sl++; /* SL0 format is different for 4K granule size */ in arm_64_lpae_alloc_pgtable_s2()
967 vtcr->tg = ARM_LPAE_TCR_TG0_16K; in arm_64_lpae_alloc_pgtable_s2()
970 vtcr->tg = ARM_LPAE_TCR_TG0_64K; in arm_64_lpae_alloc_pgtable_s2()
974 switch (cfg->oas) { in arm_64_lpae_alloc_pgtable_s2()
976 vtcr->ps = ARM_LPAE_TCR_PS_32_BIT; in arm_64_lpae_alloc_pgtable_s2()
979 vtcr->ps = ARM_LPAE_TCR_PS_36_BIT; in arm_64_lpae_alloc_pgtable_s2()
982 vtcr->ps = ARM_LPAE_TCR_PS_40_BIT; in arm_64_lpae_alloc_pgtable_s2()
985 vtcr->ps = ARM_LPAE_TCR_PS_42_BIT; in arm_64_lpae_alloc_pgtable_s2()
988 vtcr->ps = ARM_LPAE_TCR_PS_44_BIT; in arm_64_lpae_alloc_pgtable_s2()
991 vtcr->ps = ARM_LPAE_TCR_PS_48_BIT; in arm_64_lpae_alloc_pgtable_s2()
994 vtcr->ps = ARM_LPAE_TCR_PS_52_BIT; in arm_64_lpae_alloc_pgtable_s2()
1000 vtcr->tsz = 64ULL - cfg->ias; in arm_64_lpae_alloc_pgtable_s2()
1001 vtcr->sl = ~sl & ARM_LPAE_VTCR_SL0_MASK; in arm_64_lpae_alloc_pgtable_s2()
1004 data->pgd = __arm_lpae_alloc_pages(ARM_LPAE_PGD_SIZE(data), in arm_64_lpae_alloc_pgtable_s2()
1006 if (!data->pgd) in arm_64_lpae_alloc_pgtable_s2()
1013 cfg->arm_lpae_s2_cfg.vttbr = virt_to_phys(data->pgd); in arm_64_lpae_alloc_pgtable_s2()
1014 return &data->iop; in arm_64_lpae_alloc_pgtable_s2()
1017 kfree(data); in arm_64_lpae_alloc_pgtable_s2()
1024 if (cfg->ias > 32 || cfg->oas > 40) in arm_32_lpae_alloc_pgtable_s1()
1027 cfg->pgsize_bitmap &= (SZ_4K | SZ_2M | SZ_1G); in arm_32_lpae_alloc_pgtable_s1()
1034 if (cfg->ias > 40 || cfg->oas > 40) in arm_32_lpae_alloc_pgtable_s2()
1037 cfg->pgsize_bitmap &= (SZ_4K | SZ_2M | SZ_1G); in arm_32_lpae_alloc_pgtable_s2()
1044 struct arm_lpae_io_pgtable *data; in arm_mali_lpae_alloc_pgtable() local
1047 if (cfg->quirks) in arm_mali_lpae_alloc_pgtable()
1050 if (cfg->ias > 48 || cfg->oas > 40) in arm_mali_lpae_alloc_pgtable()
1053 cfg->pgsize_bitmap &= (SZ_4K | SZ_2M | SZ_1G); in arm_mali_lpae_alloc_pgtable()
1055 data = arm_lpae_alloc_pgtable(cfg); in arm_mali_lpae_alloc_pgtable()
1056 if (!data) in arm_mali_lpae_alloc_pgtable()
1059 /* Mali seems to need a full 4-level table regardless of IAS */ in arm_mali_lpae_alloc_pgtable()
1060 if (data->start_level > 0) { in arm_mali_lpae_alloc_pgtable()
1061 data->start_level = 0; in arm_mali_lpae_alloc_pgtable()
1062 data->pgd_bits = 0; in arm_mali_lpae_alloc_pgtable()
1065 * MEMATTR: Mali has no actual notion of a non-cacheable type, so the in arm_mali_lpae_alloc_pgtable()
1066 * best we can do is mimic the out-of-tree driver and hope that the in arm_mali_lpae_alloc_pgtable()
1067 * "implementation-defined caching policy" is good enough. Similarly, in arm_mali_lpae_alloc_pgtable()
1071 cfg->arm_mali_lpae_cfg.memattr = in arm_mali_lpae_alloc_pgtable()
1079 data->pgd = __arm_lpae_alloc_pages(ARM_LPAE_PGD_SIZE(data), GFP_KERNEL, in arm_mali_lpae_alloc_pgtable()
1081 if (!data->pgd) in arm_mali_lpae_alloc_pgtable()
1087 cfg->arm_mali_lpae_cfg.transtab = virt_to_phys(data->pgd) | in arm_mali_lpae_alloc_pgtable()
1090 if (cfg->coherent_walk) in arm_mali_lpae_alloc_pgtable()
1091 cfg->arm_mali_lpae_cfg.transtab |= ARM_MALI_LPAE_TTBR_SHARE_OUTER; in arm_mali_lpae_alloc_pgtable()
1093 return &data->iop; in arm_mali_lpae_alloc_pgtable()
1096 kfree(data); in arm_mali_lpae_alloc_pgtable()
1139 static void __init dummy_tlb_flush(unsigned long iova, size_t size, in dummy_tlb_flush() argument
1143 WARN_ON(!(size & cfg_cookie->pgsize_bitmap)); in dummy_tlb_flush()
1161 struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); in arm_lpae_dump_ops() local
1162 struct io_pgtable_cfg *cfg = &data->iop.cfg; in arm_lpae_dump_ops()
1164 pr_err("cfg: pgsize_bitmap 0x%lx, ias %u-bit\n", in arm_lpae_dump_ops()
1165 cfg->pgsize_bitmap, cfg->ias); in arm_lpae_dump_ops()
1166 pr_err("data: %d levels, 0x%zx pgd_size, %u pg_shift, %u bits_per_level, pgd @ %p\n", in arm_lpae_dump_ops()
1167 ARM_LPAE_MAX_LEVELS - data->start_level, ARM_LPAE_PGD_SIZE(data), in arm_lpae_dump_ops()
1168 ilog2(ARM_LPAE_GRANULE(data)), data->bits_per_level, data->pgd); in arm_lpae_dump_ops()
1175 -EFAULT; \
1187 size_t size, mapped; in arm_lpae_run_tests() local
1197 return -ENOMEM; in arm_lpae_run_tests()
1204 if (ops->iova_to_phys(ops, 42)) in arm_lpae_run_tests()
1207 if (ops->iova_to_phys(ops, SZ_1G + 42)) in arm_lpae_run_tests()
1210 if (ops->iova_to_phys(ops, SZ_2G + 42)) in arm_lpae_run_tests()
1217 for_each_set_bit(j, &cfg->pgsize_bitmap, BITS_PER_LONG) { in arm_lpae_run_tests()
1218 size = 1UL << j; in arm_lpae_run_tests()
1220 if (ops->map_pages(ops, iova, iova, size, 1, in arm_lpae_run_tests()
1227 if (!ops->map_pages(ops, iova, iova + size, size, 1, in arm_lpae_run_tests()
1232 if (ops->iova_to_phys(ops, iova + 42) != (iova + 42)) in arm_lpae_run_tests()
1239 size = 1UL << __ffs(cfg->pgsize_bitmap); in arm_lpae_run_tests()
1240 if (ops->unmap_pages(ops, SZ_1G + size, size, 1, NULL) != size) in arm_lpae_run_tests()
1244 if (ops->map_pages(ops, SZ_1G + size, size, size, 1, in arm_lpae_run_tests()
1248 if (ops->iova_to_phys(ops, SZ_1G + size + 42) != (size + 42)) in arm_lpae_run_tests()
1253 for_each_set_bit(j, &cfg->pgsize_bitmap, BITS_PER_LONG) { in arm_lpae_run_tests()
1254 size = 1UL << j; in arm_lpae_run_tests()
1256 if (ops->unmap_pages(ops, iova, size, 1, NULL) != size) in arm_lpae_run_tests()
1259 if (ops->iova_to_phys(ops, iova + 42)) in arm_lpae_run_tests()
1263 if (ops->map_pages(ops, iova, iova, size, 1, in arm_lpae_run_tests()
1267 if (ops->iova_to_phys(ops, iova + 42) != (iova + 42)) in arm_lpae_run_tests()
1318 return fail ? -EFAULT : 0; in arm_lpae_do_selftests()