arch/alpha/vtophys.cc

   1 /*
   2  * Copyright (c) 2002-2004 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     //@todo Andrew couldn't remember why he commented some of this code
 100     //so I put it back in. Perhaps something to do with gdb debugging?
 101     if (PC_PAL(vaddr)) {
 102         paddr = vaddr & ~ULL(1);
 103     } else {
 104         if (vaddr >= ALPHA_K0SEG_BASE && vaddr <= ALPHA_K0SEG_END) {
 105             paddr = ALPHA_K0SEG_TO_PHYS(vaddr);
 106         } else if (!ptbr) {
 107             paddr = vaddr;
 108         } else {
 109             Addr pte = kernel_pte_lookup(xc->physmem, ptbr, vaddr);
 110             uint64_t entry = xc->physmem->phys_read_qword(pte);
 111             if (pte && entry_valid(entry))
 112                 paddr = PMAP_PTE_PA(entry) | (vaddr & PGOFSET);
 113         }
 114     }
 115
 116
 117     DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr);
 118
 119     return paddr;
 120 }
 121
 122 uint8_t *
 123 ptomem(ExecContext *xc, Addr paddr, size_t len)
 124 {
 125     return xc->physmem->dma_addr(paddr, len);
 126 }
 127
 128 uint8_t *
 129 vtomem(ExecContext *xc, Addr vaddr, size_t len)
 130 {
 131     Addr paddr = vtophys(xc, vaddr);
 132     return xc->physmem->dma_addr(paddr, len);
 133 }
 134
 135 void
 136 CopyOut(ExecContext *xc, void *dest, Addr src, size_t cplen)
 137 {
 138     Addr paddr;
 139     char *dmaaddr;
 140     char *dst = (char *)dest;
 141     int len;
 142
 143     paddr = vtophys(xc, src);
 144     len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)cplen);
 145     dmaaddr = (char *)xc->physmem->dma_addr(paddr, len);
 146     assert(dmaaddr);
 147
 148     memcpy(dst, dmaaddr, len);
 149     if (len == cplen)
 150         return;
 151
 152     cplen -= len;
 153     dst += len;
 154     src += len;
 155
 156     while (cplen > ALPHA_PGBYTES) {
 157         paddr = vtophys(xc, src);
 158         dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES);
 159         assert(dmaaddr);
 160
 161         memcpy(dst, dmaaddr, ALPHA_PGBYTES);
 162         cplen -= ALPHA_PGBYTES;
 163         dst += ALPHA_PGBYTES;
 164         src += ALPHA_PGBYTES;
 165     }
 166
 167     if (cplen > 0) {
 168         paddr = vtophys(xc, src);
 169         dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen);
 170         assert(dmaaddr);
 171
 172         memcpy(dst, dmaaddr, cplen);
 173     }
 174 }
 175
 176 void
 177 CopyIn(ExecContext *xc, Addr dest, void *source, size_t cplen)
 178 {
 179     Addr paddr;
 180     char *dmaaddr;
 181     char *src = (char *)source;
 182     int len;
 183
 184     paddr = vtophys(xc, dest);
 185     len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)cplen);
 186     dmaaddr = (char *)xc->physmem->dma_addr(paddr, len);
 187     assert(dmaaddr);
 188
 189     memcpy(dmaaddr, src, len);
 190     if (len == cplen)
 191         return;
 192
 193     cplen -= len;
 194     src += len;
 195     dest += len;
 196
 197     while (cplen > ALPHA_PGBYTES) {
 198         paddr = vtophys(xc, dest);
 199         dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES);
 200         assert(dmaaddr);
 201
 202         memcpy(dmaaddr, src, ALPHA_PGBYTES);
 203         cplen -= ALPHA_PGBYTES;
 204         src += ALPHA_PGBYTES;
 205         dest += ALPHA_PGBYTES;
 206     }
 207
 208     if (cplen > 0) {
 209         paddr = vtophys(xc, dest);
 210         dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen);
 211         assert(dmaaddr);
 212
 213         memcpy(dmaaddr, src, cplen);
 214     }
 215 }
 216
 217 void
 218 CopyString(ExecContext *xc, char *dst, Addr vaddr, size_t maxlen)
 219 {
 220     Addr paddr;
 221     char *dmaaddr;
 222     int len;
 223
 224     paddr = vtophys(xc, vaddr);
 225     len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)maxlen);
 226     dmaaddr = (char *)xc->physmem->dma_addr(paddr, len);
 227     assert(dmaaddr);
 228
 229     char *term = (char *)memchr(dmaaddr, 0, len);
 230     if (term)
 231         len = term - dmaaddr + 1;
 232
 233     memcpy(dst, dmaaddr, len);
 234
 235     if (term || len == maxlen)
 236         return;
 237
 238     maxlen -= len;
 239     dst += len;
 240     vaddr += len;
 241
 242     while (maxlen > ALPHA_PGBYTES) {
 243         paddr = vtophys(xc, vaddr);
 244         dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES);
 245         assert(dmaaddr);
 246
 247         char *term = (char *)memchr(dmaaddr, 0, ALPHA_PGBYTES);
 248         len = term ? (term - dmaaddr + 1) : ALPHA_PGBYTES;
 249
 250         memcpy(dst, dmaaddr, len);
 251         if (term)
 252             return;
 253
 254         maxlen -= ALPHA_PGBYTES;
 255         dst += ALPHA_PGBYTES;
 256         vaddr += ALPHA_PGBYTES;
 257     }
 258
 259     if (maxlen > 0) {
 260         paddr = vtophys(xc, vaddr);
 261         dmaaddr = (char *)xc->physmem->dma_addr(paddr, maxlen);
 262         assert(dmaaddr);
 263
 264         char *term = (char *)memchr(dmaaddr, 0, maxlen);
 265         len = term ? (term - dmaaddr + 1) : maxlen;
 266
 267         memcpy(dst, dmaaddr, len);
 268
 269         maxlen -= len;
 270     }
 271
 272     if (maxlen == 0)
 273         dst[maxlen] = '\0';
 274 }