arch/alpha/vtophys.cc

   1 /*
   2  * Copyright (c) 2003 The Regents of The University of Michigan
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions are
   7  * met: redistributions of source code must retain the above copyright
   8  * notice, this list of conditions and the following disclaimer;
   9  * redistributions in binary form must reproduce the above copyright
  10  * notice, this list of conditions and the following disclaimer in the
  11  * documentation and/or other materials provided with the distribution;
  12  * neither the name of the copyright holders nor the names of its
  13  * contributors may be used to endorse or promote products derived from
  14  * this software without specific prior written permission.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  17  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  18  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  19  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  20  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  21  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  22  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  26  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27  */
  28
  29 #include <string>
  30
  31 #include "targetarch/pmap.h"
  32
  33 #include "cpu/exec_context.hh"
  34 #include "mem/functional_mem/physical_memory.hh"
  35 #include "base/trace.hh"
  36 #include "targetarch/vtophys.hh"
  37
  38 using namespace std;
  39
  40 inline Addr
  41 level3_index(Addr vaddr)
  42 { return (vaddr >> ALPHA_PGSHIFT) & PTEMASK; }
  43
  44 inline Addr
  45 level2_index(Addr vaddr)
  46 { return (vaddr >> (ALPHA_PGSHIFT + NPTEPG_SHIFT)) & PTEMASK; }
  47
  48 inline Addr
  49 level1_index(Addr vaddr)
  50 { return (vaddr >> (ALPHA_PGSHIFT + 2 * NPTEPG_SHIFT)) & PTEMASK; }
  51
  52 Addr
  53 kernel_pte_lookup(PhysicalMemory *pmem, Addr ptbr, Addr vaddr)
  54 {
  55     uint64_t level1_map = ptbr;
  56     Addr level1_pte = level1_map + (level1_index(vaddr) << PTESHIFT);
  57
  58     uint64_t level1 = pmem->phys_read_qword(level1_pte);
  59     if (!entry_valid(level1)) {
  60         DPRINTF(VtoPhys, "level 1 PTE not valid, va = %#\n", vaddr);
  61         return 0;
  62     }
  63
  64     uint64_t level2_map = PMAP_PTE_PA(level1);
  65     Addr level2_pte = level2_map + (level2_index(vaddr) << PTESHIFT);
  66     uint64_t level2 = pmem->phys_read_qword(level2_pte);
  67     if (!entry_valid(level2)) {
  68         DPRINTF(VtoPhys, "level 2 PTE not valid, va = %#x\n", vaddr);
  69         return 0;
  70     }
  71
  72     uint64_t level3_map = PMAP_PTE_PA(level2);
  73     Addr level3_pte = level3_map + (level3_index(vaddr) << PTESHIFT);
  74
  75     return level3_pte;
  76 }
  77
  78 Addr
  79 vtophys(PhysicalMemory *xc, Addr vaddr)
  80 {
  81     Addr paddr = 0;
  82     if (vaddr < ALPHA_K0SEG_BASE)
  83         DPRINTF(VtoPhys, "vtophys: invalid vaddr %#x", vaddr);
  84     else if (vaddr < ALPHA_K1SEG_BASE)
  85         paddr = ALPHA_K0SEG_TO_PHYS(vaddr);
  86     else
  87         panic("vtophys: ptbr is not set on virtual lookup");
  88
  89     DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr);
  90
  91     return paddr;
  92 }
  93
  94 Addr
  95 vtophys(ExecContext *xc, Addr vaddr)
  96 {
  97     Addr ptbr = xc->regs.ipr[AlphaISA::IPR_PALtemp20];
  98     Addr paddr = 0;
  99     if (PC_PAL(vaddr)) {
 100         paddr = vaddr & ~ULL(1);
 101     } else if (!ptbr) {
 102         paddr = vaddr;
 103     } else {
 104         if (vaddr >= ALPHA_K0SEG_BASE && vaddr <= ALPHA_K0SEG_END) {
 105             paddr = ALPHA_K0SEG_TO_PHYS(vaddr);
 106         } else {
 107             Addr pte = kernel_pte_lookup(xc->physmem, ptbr, vaddr);
 108             uint64_t entry = xc->physmem->phys_read_qword(pte);
 109             if (pte && entry_valid(entry))
 110                 paddr = PMAP_PTE_PA(entry) | (vaddr & PGOFSET);
 111         }
 112     }
 113
 114     DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr);
 115
 116     return paddr;
 117 }
 118
 119 uint8_t *
 120 ptomem(ExecContext *xc, Addr paddr, size_t len)
 121 {
 122     return xc->physmem->dma_addr(paddr, len);
 123 }
 124
 125 uint8_t *
 126 vtomem(ExecContext *xc, Addr vaddr, size_t len)
 127 {
 128     Addr paddr = vtophys(xc, vaddr);
 129     return xc->physmem->dma_addr(paddr, len);
 130 }
 131
 132 void
 133 CopyData(ExecContext *xc, void *dest, Addr vaddr, size_t cplen)
 134 {
 135     Addr paddr;
 136     char *dmaaddr;
 137     char *dst = (char *)dest;
 138     int len;
 139
 140     paddr = vtophys(xc, vaddr);
 141     len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)cplen);
 142     dmaaddr = (char *)xc->physmem->dma_addr(paddr, len);
 143     assert(dmaaddr);
 144
 145     memcpy(dst, dmaaddr, len);
 146     if (len == cplen)
 147         return;
 148
 149     cplen -= len;
 150     dst += len;
 151     vaddr += len;
 152
 153     while (cplen > ALPHA_PGBYTES) {
 154         paddr = vtophys(xc, vaddr);
 155         dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES);
 156         assert(dmaaddr);
 157
 158         memcpy(dst, dmaaddr, ALPHA_PGBYTES);
 159         cplen -= ALPHA_PGBYTES;
 160         dst += ALPHA_PGBYTES;
 161         vaddr += ALPHA_PGBYTES;
 162     }
 163
 164     if (cplen > 0) {
 165         paddr = vtophys(xc, vaddr);
 166         dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen);
 167         assert(dmaaddr);
 168
 169         memcpy(dst, dmaaddr, cplen);
 170     }
 171 }
 172
 173 void
 174 CopyString(ExecContext *xc, char *dst, Addr vaddr, size_t maxlen)
 175 {
 176     Addr paddr;
 177     char *dmaaddr;
 178     int len;
 179
 180     paddr = vtophys(xc, vaddr);
 181     len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)maxlen);
 182     dmaaddr = (char *)xc->physmem->dma_addr(paddr, len);
 183     assert(dmaaddr);
 184
 185     char *term = (char *)memchr(dmaaddr, 0, len);
 186     if (term)
 187         len = term - dmaaddr + 1;
 188
 189     memcpy(dst, dmaaddr, len);
 190
 191     if (term || len == maxlen)
 192         return;
 193
 194     maxlen -= len;
 195     dst += len;
 196     vaddr += len;
 197
 198     while (maxlen > ALPHA_PGBYTES) {
 199         paddr = vtophys(xc, vaddr);
 200         dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES);
 201         assert(dmaaddr);
 202
 203         char *term = (char *)memchr(dmaaddr, 0, ALPHA_PGBYTES);
 204         len = term ? (term - dmaaddr + 1) : ALPHA_PGBYTES;
 205
 206         memcpy(dst, dmaaddr, len);
 207         if (term)
 208             return;
 209
 210         maxlen -= ALPHA_PGBYTES;
 211         dst += ALPHA_PGBYTES;
 212         vaddr += ALPHA_PGBYTES;
 213     }
 214
 215     if (maxlen > 0) {
 216         paddr = vtophys(xc, vaddr);
 217         dmaaddr = (char *)xc->physmem->dma_addr(paddr, maxlen);
 218         assert(dmaaddr);
 219
 220         char *term = (char *)memchr(dmaaddr, 0, maxlen);
 221         len = term ? (term - dmaaddr + 1) : maxlen;
 222
 223         memcpy(dst, dmaaddr, len);
 224
 225         maxlen -= len;
 226     }
 227
 228     if (maxlen == 0)
 229         dst[maxlen] = '\0';
 230 }