vtophys.cc revision 547
14130Ssaidi@eecs.umich.edu/* 24130Ssaidi@eecs.umich.edu * Copyright (c) 2003 The Regents of The University of Michigan 34130Ssaidi@eecs.umich.edu * All rights reserved. 44130Ssaidi@eecs.umich.edu * 54130Ssaidi@eecs.umich.edu * Redistribution and use in source and binary forms, with or without 64130Ssaidi@eecs.umich.edu * modification, are permitted provided that the following conditions are 74130Ssaidi@eecs.umich.edu * met: redistributions of source code must retain the above copyright 84130Ssaidi@eecs.umich.edu * notice, this list of conditions and the following disclaimer; 94130Ssaidi@eecs.umich.edu * redistributions in binary form must reproduce the above copyright 104130Ssaidi@eecs.umich.edu * notice, this list of conditions and the following disclaimer in the 114130Ssaidi@eecs.umich.edu * documentation and/or other materials provided with the distribution; 124130Ssaidi@eecs.umich.edu * neither the name of the copyright holders nor the names of its 134130Ssaidi@eecs.umich.edu * contributors may be used to endorse or promote products derived from 144130Ssaidi@eecs.umich.edu * this software without specific prior written permission. 154130Ssaidi@eecs.umich.edu * 164130Ssaidi@eecs.umich.edu * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 174130Ssaidi@eecs.umich.edu * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 184130Ssaidi@eecs.umich.edu * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 194130Ssaidi@eecs.umich.edu * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 204130Ssaidi@eecs.umich.edu * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 214130Ssaidi@eecs.umich.edu * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 224130Ssaidi@eecs.umich.edu * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 234130Ssaidi@eecs.umich.edu * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 244130Ssaidi@eecs.umich.edu * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 254130Ssaidi@eecs.umich.edu * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 264130Ssaidi@eecs.umich.edu * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 274130Ssaidi@eecs.umich.edu */ 284130Ssaidi@eecs.umich.edu 294130Ssaidi@eecs.umich.edu#include <string> 304130Ssaidi@eecs.umich.edu 316654Snate@binkert.org#include "targetarch/pmap.h" 324130Ssaidi@eecs.umich.edu 334130Ssaidi@eecs.umich.edu#include "cpu/exec_context.hh" 349728Sandreas.hansson@arm.com#include "mem/functional_mem/physical_memory.hh" 359802Snilay@cs.wisc.edu#include "base/trace.hh" 369802Snilay@cs.wisc.edu#include "targetarch/vtophys.hh" 379802Snilay@cs.wisc.edu 384130Ssaidi@eecs.umich.eduusing namespace std; 398882Sgblack@eecs.umich.edu 408882Sgblack@eecs.umich.eduinline Addr 417876Sgblack@eecs.umich.edulevel3_index(Addr vaddr) 424130Ssaidi@eecs.umich.edu{ return (vaddr >> ALPHA_PGSHIFT) & PTEMASK; } 438801Sgblack@eecs.umich.edu 444167Sbinkertn@umich.eduinline Addr 454167Sbinkertn@umich.edulevel2_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