[src/trunk]: src/sys/arch/aarch64/aarch64 Update pmap_map_chunk to allow L[12...

[skrll <skrll%NetBSD.org@localhost>]

details:   https://anonhg.NetBSD.org/src/rev/20926df0f26e
branches:  trunk
changeset: 466666:20926df0f26e
user:      skrll <skrll%NetBSD.org@localhost>
date:      Mon Dec 30 16:03:48 2019 +0000

description:
Update pmap_map_chunk to allow L[12] block mappings and L3 page mappings

diffstat:

 sys/arch/aarch64/aarch64/pmap.c |  63 +++++++++++++++++++++++++++-------------
 1 files changed, 42 insertions(+), 21 deletions(-)

diffs (91 lines):

diff -r 7e8f05da2ea7 -r 20926df0f26e sys/arch/aarch64/aarch64/pmap.c
--- a/sys/arch/aarch64/aarch64/pmap.c   Mon Dec 30 15:58:12 2019 +0000
+++ b/sys/arch/aarch64/aarch64/pmap.c   Mon Dec 30 16:03:48 2019 +0000
@@ -1,4 +1,4 @@
-/*     $NetBSD: pmap.c,v 1.59 2019/12/30 15:42:39 skrll Exp $  */
+/*     $NetBSD: pmap.c,v 1.60 2019/12/30 16:03:48 skrll Exp $  */
 
 /*
  * Copyright (c) 2017 Ryo Shimizu <ryo%nerv.org@localhost>
@@ -27,7 +27,7 @@
  */
 
 #include <sys/cdefs.h>
-__KERNEL_RCSID(0, "$NetBSD: pmap.c,v 1.59 2019/12/30 15:42:39 skrll Exp $");
+__KERNEL_RCSID(0, "$NetBSD: pmap.c,v 1.60 2019/12/30 16:03:48 skrll Exp $");
 
 #include "opt_arm_debug.h"
 #include "opt_ddb.h"
@@ -268,6 +268,12 @@
 
 static const struct pmap_devmap *pmap_devmap_table;
 
+#define        L1_BLK_MAPPABLE_P(va, pa, size)                                 \
+    ((((va) | (pa)) & L1_OFFSET) == 0 && (size) >= L1_SIZE)
+
+#define        L2_BLK_MAPPABLE_P(va, pa, size)                                 \
+    ((((va) | (pa)) & L2_OFFSET) == 0 && (size) >= L2_SIZE)
+
 static vsize_t
 pmap_map_chunk(vaddr_t va, paddr_t pa, vsize_t size,
     vm_prot_t prot, u_int flags)
@@ -276,25 +282,40 @@
        psize_t blocksize;
        int rc;
 
-       /* devmap always use L2 mapping */
-       blocksize = L2_SIZE;
-
-       attr = _pmap_pte_adjust_prot(L2_BLOCK, prot, VM_PROT_ALL, false);
-       attr = _pmap_pte_adjust_cacheflags(attr, flags);
-       /* user cannot execute, and kernel follows the prot */
-       attr |= (LX_BLKPAG_UXN|LX_BLKPAG_PXN);
-       if (prot & VM_PROT_EXECUTE)
-               attr &= ~LX_BLKPAG_PXN;
-
-       rc = pmapboot_enter(va, pa, size, blocksize, attr,
-           PMAPBOOT_ENTER_NOOVERWRITE, bootpage_alloc, NULL);
-       if (rc != 0)
-               panic("%s: pmapboot_enter failed. %lx is already mapped?\n",
-                   __func__, va);
-
-       aarch64_tlbi_by_va(va);
-
-       return ((va + size + blocksize - 1) & ~(blocksize - 1)) - va;
+       vsize_t resid = round_page(size);
+       vsize_t mapped = 0;
+
+       while (resid > 0) {
+               if (L1_BLK_MAPPABLE_P(va, pa, resid)) {
+                       blocksize = L1_SIZE;
+                       attr = L1_BLOCK;
+               } else if (L2_BLK_MAPPABLE_P(va, pa, resid)) {
+                       blocksize = L2_SIZE;
+                       attr = L2_BLOCK;
+               } else {
+                       blocksize = L3_SIZE;
+                       attr = L3_PAGE;
+               }
+
+               attr = _pmap_pte_adjust_prot(attr, prot, VM_PROT_ALL, false);
+               attr = _pmap_pte_adjust_cacheflags(attr, flags);
+
+               rc = pmapboot_enter(va, pa, blocksize, blocksize, attr,
+                   PMAPBOOT_ENTER_NOOVERWRITE, bootpage_alloc, NULL);
+               if (rc != 0) {
+                       panic("%s: pmapboot_enter failed. %lx is already mapped?\n",
+                           __func__, va);
+               }
+
+               va += blocksize;
+               pa += blocksize;
+               resid -= blocksize;
+               mapped += blocksize;
+
+               aarch64_tlbi_by_va(va);
+       }
+
+       return mapped;
 }
 
 void