vtophys.cc revision 547
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 38using namespace std; 39 40inline Addr 41level3_index(Addr vaddr) 42{ return (vaddr >> ALPHA_PGSHIFT) & PTEMASK; } 43 44inline Addr 45level2_index(Addr vaddr) 46{ return (vaddr >> (ALPHA_PGSHIFT + NPTEPG_SHIFT)) & PTEMASK; } 47 48inline Addr 49level1_index(Addr vaddr) 50{ return (vaddr >> (ALPHA_PGSHIFT + 2 * NPTEPG_SHIFT)) & PTEMASK; } 51 52Addr 53kernel_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 78Addr 79vtophys(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 94Addr 95vtophys(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 119uint8_t * 120ptomem(ExecContext *xc, Addr paddr, size_t len) 121{ 122 return xc->physmem->dma_addr(paddr, len); 123} 124 125uint8_t * 126vtomem(ExecContext *xc, Addr vaddr, size_t len) 127{ 128 Addr paddr = vtophys(xc, vaddr); 129 return xc->physmem->dma_addr(paddr, len); 130} 131 132void 133CopyData(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 173void 174CopyString(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} 231