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 (vaddr < ALPHA_K0SEG_BASE) {
 100         DPRINTF(VtoPhys, "vtophys: invalid vaddr %#x", vaddr);
 101     } else if (vaddr < ALPHA_K1SEG_BASE) {
 102         paddr = ALPHA_K0SEG_TO_PHYS(vaddr);
 103     } else {
 104         if (!ptbr)
 105             panic("vtophys: ptbr is not set on virtual lookup");
 106
 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     DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr);
 114
 115     return paddr;
 116 }
 117
 118 uint8_t *
 119 vtomem(ExecContext *xc, Addr vaddr, size_t len)
 120 {
 121     Addr paddr = vtophys(xc, vaddr);
 122     return xc->physmem->dma_addr(paddr, len);
 123 }
 124
 125 void
 126 CopyData(ExecContext *xc, void *dest, Addr vaddr, size_t cplen)
 127 {
 128     Addr paddr;
 129     char *dmaaddr;
 130     char *dst = (char *)dest;
 131     int len;
 132
 133     paddr = vtophys(xc, vaddr);
 134     len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)cplen);
 135     dmaaddr = (char *)xc->physmem->dma_addr(paddr, len);
 136     assert(dmaaddr);
 137
 138     memcpy(dst, dmaaddr, len);
 139     if (len == cplen)
 140         return;
 141
 142     cplen -= len;
 143     dst += len;
 144     vaddr += len;
 145
 146     while (cplen > ALPHA_PGBYTES) {
 147         paddr = vtophys(xc, vaddr);
 148         dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES);
 149         assert(dmaaddr);
 150
 151         memcpy(dst, dmaaddr, ALPHA_PGBYTES);
 152         cplen -= ALPHA_PGBYTES;
 153         dst += ALPHA_PGBYTES;
 154         vaddr += ALPHA_PGBYTES;
 155     }
 156
 157     if (cplen > 0) {
 158         paddr = vtophys(xc, vaddr);
 159         dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen);
 160         assert(dmaaddr);
 161
 162         memcpy(dst, dmaaddr, cplen);
 163     }
 164 }
 165
 166 void
 167 CopyString(ExecContext *xc, char *dst, Addr vaddr, size_t maxlen)
 168 {
 169     Addr paddr;
 170     char *dmaaddr;
 171     int len;
 172
 173     paddr = vtophys(xc, vaddr);
 174     len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)maxlen);
 175     dmaaddr = (char *)xc->physmem->dma_addr(paddr, len);
 176     assert(dmaaddr);
 177
 178     char *term = (char *)memchr(dmaaddr, 0, len);
 179     if (term)
 180         len = term - dmaaddr + 1;
 181
 182     memcpy(dst, dmaaddr, len);
 183
 184     if (term || len == maxlen)
 185         return;
 186
 187     maxlen -= len;
 188     dst += len;
 189     vaddr += len;
 190
 191     while (maxlen > ALPHA_PGBYTES) {
 192         paddr = vtophys(xc, vaddr);
 193         dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES);
 194         assert(dmaaddr);
 195
 196         char *term = (char *)memchr(dmaaddr, 0, ALPHA_PGBYTES);
 197         len = term ? (term - dmaaddr + 1) : ALPHA_PGBYTES;
 198
 199         memcpy(dst, dmaaddr, len);
 200         if (term)
 201             return;
 202
 203         maxlen -= ALPHA_PGBYTES;
 204         dst += ALPHA_PGBYTES;
 205         vaddr += ALPHA_PGBYTES;
 206     }
 207
 208     if (maxlen > 0) {
 209         paddr = vtophys(xc, vaddr);
 210         dmaaddr = (char *)xc->physmem->dma_addr(paddr, maxlen);
 211         assert(dmaaddr);
 212
 213         char *term = (char *)memchr(dmaaddr, 0, maxlen);
 214         len = term ? (term - dmaaddr + 1) : maxlen;
 215
 216         memcpy(dst, dmaaddr, len);
 217
 218         maxlen -= len;
 219     }
 220
 221     if (maxlen == 0)
 222         dst[maxlen] = '\0';
 223 }