vtophys.cc revision 953
17584SN/A/* 28869SAli.Saidi@ARM.com * Copyright (c) 2002-2004 The Regents of The University of Michigan 37584SN/A * All rights reserved. 47584SN/A * 57584SN/A * Redistribution and use in source and binary forms, with or without 67584SN/A * modification, are permitted provided that the following conditions are 77584SN/A * met: redistributions of source code must retain the above copyright 87584SN/A * notice, this list of conditions and the following disclaimer; 97584SN/A * redistributions in binary form must reproduce the above copyright 107584SN/A * notice, this list of conditions and the following disclaimer in the 117584SN/A * documentation and/or other materials provided with the distribution; 127584SN/A * neither the name of the copyright holders nor the names of its 137584SN/A * contributors may be used to endorse or promote products derived from 147584SN/A * this software without specific prior written permission. 157584SN/A * 167584SN/A * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 177584SN/A * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 187584SN/A * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 197584SN/A * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 207584SN/A * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 217584SN/A * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 227584SN/A * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 237584SN/A * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 247584SN/A * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 257584SN/A * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 267584SN/A * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 277584SN/A */ 287584SN/A 297584SN/A#include <string> 307584SN/A 317584SN/A#include "targetarch/pmap.h" 327584SN/A 337584SN/A#include "cpu/exec_context.hh" 347584SN/A#include "mem/functional_mem/physical_memory.hh" 357584SN/A#include "base/trace.hh" 367584SN/A#include "targetarch/vtophys.hh" 377584SN/A 387584SN/Ausing namespace std; 397584SN/A 4011793Sbrandon.potter@amd.cominline Addr 4111793Sbrandon.potter@amd.comlevel3_index(Addr vaddr) 427584SN/A{ return (vaddr >> ALPHA_PGSHIFT) & PTEMASK; } 438869SAli.Saidi@ARM.com 447584SN/Ainline Addr 458245SN/Alevel2_index(Addr vaddr) 468245SN/A{ return (vaddr >> (ALPHA_PGSHIFT + NPTEPG_SHIFT)) & PTEMASK; } 478869SAli.Saidi@ARM.com 487584SN/Ainline Addr 497584SN/Alevel1_index(Addr vaddr) 507584SN/A{ return (vaddr >> (ALPHA_PGSHIFT + 2 * NPTEPG_SHIFT)) & PTEMASK; } 518869SAli.Saidi@ARM.com 529808Sstever@gmail.comAddr 539808Sstever@gmail.comkernel_pte_lookup(PhysicalMemory *pmem, Addr ptbr, Addr vaddr) 5412086Sspwilson2@wisc.edu{ 5512086Sspwilson2@wisc.edu uint64_t level1_map = ptbr; 567584SN/A Addr level1_pte = level1_map + (level1_index(vaddr) << PTESHIFT); 577584SN/A 587584SN/A uint64_t level1 = pmem->phys_read_qword(level1_pte); 597584SN/A if (!entry_valid(level1)) { 607584SN/A DPRINTF(VtoPhys, "level 1 PTE not valid, va = %#\n", vaddr); 618869SAli.Saidi@ARM.com return 0; 627584SN/A } 637584SN/A 647584SN/A uint64_t level2_map = PMAP_PTE_PA(level1); 657584SN/A Addr level2_pte = level2_map + (level2_index(vaddr) << PTESHIFT); 668869SAli.Saidi@ARM.com uint64_t level2 = pmem->phys_read_qword(level2_pte); 677584SN/A if (!entry_valid(level2)) { 688869SAli.Saidi@ARM.com DPRINTF(VtoPhys, "level 2 PTE not valid, va = %#x\n", vaddr); 698869SAli.Saidi@ARM.com return 0; 708869SAli.Saidi@ARM.com } 718869SAli.Saidi@ARM.com 728869SAli.Saidi@ARM.com uint64_t level3_map = PMAP_PTE_PA(level2); 738869SAli.Saidi@ARM.com Addr level3_pte = level3_map + (level3_index(vaddr) << PTESHIFT); 748869SAli.Saidi@ARM.com 758869SAli.Saidi@ARM.com return level3_pte; 768869SAli.Saidi@ARM.com} 778869SAli.Saidi@ARM.com 788869SAli.Saidi@ARM.comAddr 798869SAli.Saidi@ARM.comvtophys(PhysicalMemory *xc, Addr vaddr) 808869SAli.Saidi@ARM.com{ 818869SAli.Saidi@ARM.com Addr paddr = 0; 828869SAli.Saidi@ARM.com if (vaddr < ALPHA_K0SEG_BASE) 838869SAli.Saidi@ARM.com DPRINTF(VtoPhys, "vtophys: invalid vaddr %#x", vaddr); 848869SAli.Saidi@ARM.com else if (vaddr < ALPHA_K1SEG_BASE) 858869SAli.Saidi@ARM.com paddr = ALPHA_K0SEG_TO_PHYS(vaddr); 868869SAli.Saidi@ARM.com else 878869SAli.Saidi@ARM.com panic("vtophys: ptbr is not set on virtual lookup"); 888869SAli.Saidi@ARM.com 898869SAli.Saidi@ARM.com DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr); 908869SAli.Saidi@ARM.com 918869SAli.Saidi@ARM.com return paddr; 928869SAli.Saidi@ARM.com} 939806Sstever@gmail.com 948869SAli.Saidi@ARM.comAddr 958869SAli.Saidi@ARM.comvtophys(ExecContext *xc, Addr vaddr) 968869SAli.Saidi@ARM.com{ 978869SAli.Saidi@ARM.com Addr ptbr = xc->regs.ipr[AlphaISA::IPR_PALtemp20]; 988869SAli.Saidi@ARM.com Addr paddr = 0; 998869SAli.Saidi@ARM.com //@todo Andrew couldn't remember why he commented some of this code 1008869SAli.Saidi@ARM.com //so I put it back in. Perhaps something to do with gdb debugging? 1018869SAli.Saidi@ARM.com if (PC_PAL(vaddr)) { 1028869SAli.Saidi@ARM.com paddr = vaddr & ~ULL(1); 1038869SAli.Saidi@ARM.com } else if (!ptbr) { 1048869SAli.Saidi@ARM.com paddr = vaddr; 1058869SAli.Saidi@ARM.com } else { 1068869SAli.Saidi@ARM.com if (vaddr >= ALPHA_K0SEG_BASE && vaddr <= ALPHA_K0SEG_END) { 1078869SAli.Saidi@ARM.com paddr = ALPHA_K0SEG_TO_PHYS(vaddr); 1088869SAli.Saidi@ARM.com } else { 1098869SAli.Saidi@ARM.com Addr pte = kernel_pte_lookup(xc->physmem, ptbr, vaddr); 1108869SAli.Saidi@ARM.com uint64_t entry = xc->physmem->phys_read_qword(pte); 1118869SAli.Saidi@ARM.com if (pte && entry_valid(entry)) 1128869SAli.Saidi@ARM.com paddr = PMAP_PTE_PA(entry) | (vaddr & PGOFSET); 1138869SAli.Saidi@ARM.com } 1148869SAli.Saidi@ARM.com } 1158869SAli.Saidi@ARM.com 1168869SAli.Saidi@ARM.com 1178869SAli.Saidi@ARM.com DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr); 1187584SN/A 1197584SN/A return paddr; 1207584SN/A} 1217584SN/A 1227584SN/Auint8_t * 1238869SAli.Saidi@ARM.comptomem(ExecContext *xc, Addr paddr, size_t len) 1247584SN/A{ 1257584SN/A return xc->physmem->dma_addr(paddr, len); 1267584SN/A} 1277584SN/A 1288869SAli.Saidi@ARM.comuint8_t * 1297584SN/Avtomem(ExecContext *xc, Addr vaddr, size_t len) 1308869SAli.Saidi@ARM.com{ 1318869SAli.Saidi@ARM.com Addr paddr = vtophys(xc, vaddr); 1328869SAli.Saidi@ARM.com return xc->physmem->dma_addr(paddr, len); 1338869SAli.Saidi@ARM.com} 1348869SAli.Saidi@ARM.com 1358869SAli.Saidi@ARM.comvoid 1368869SAli.Saidi@ARM.comCopyOut(ExecContext *xc, void *dest, Addr src, size_t cplen) 1378869SAli.Saidi@ARM.com{ 1388869SAli.Saidi@ARM.com Addr paddr; 1398869SAli.Saidi@ARM.com char *dmaaddr; 1408869SAli.Saidi@ARM.com char *dst = (char *)dest; 1418869SAli.Saidi@ARM.com int len; 1428869SAli.Saidi@ARM.com 1438869SAli.Saidi@ARM.com paddr = vtophys(xc, src); 1448869SAli.Saidi@ARM.com len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)cplen); 1458869SAli.Saidi@ARM.com dmaaddr = (char *)xc->physmem->dma_addr(paddr, len); 1468869SAli.Saidi@ARM.com assert(dmaaddr); 1478869SAli.Saidi@ARM.com 1488869SAli.Saidi@ARM.com memcpy(dst, dmaaddr, len); 1498869SAli.Saidi@ARM.com if (len == cplen) 1508869SAli.Saidi@ARM.com return; 1518869SAli.Saidi@ARM.com 1528869SAli.Saidi@ARM.com cplen -= len; 1538869SAli.Saidi@ARM.com dst += len; 1548869SAli.Saidi@ARM.com src += len; 1559806Sstever@gmail.com 1568869SAli.Saidi@ARM.com while (cplen > ALPHA_PGBYTES) { 1578869SAli.Saidi@ARM.com paddr = vtophys(xc, src); 1588869SAli.Saidi@ARM.com dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES); 1598869SAli.Saidi@ARM.com assert(dmaaddr); 1608869SAli.Saidi@ARM.com 1617584SN/A memcpy(dst, dmaaddr, ALPHA_PGBYTES); 1627584SN/A cplen -= ALPHA_PGBYTES; 1637584SN/A dst += ALPHA_PGBYTES; 1647584SN/A src += ALPHA_PGBYTES; 1657584SN/A } 1668869SAli.Saidi@ARM.com 1677584SN/A if (cplen > 0) { 1688869SAli.Saidi@ARM.com paddr = vtophys(xc, src); 1698869SAli.Saidi@ARM.com dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen); 1708869SAli.Saidi@ARM.com assert(dmaaddr); 1718869SAli.Saidi@ARM.com 1728869SAli.Saidi@ARM.com memcpy(dst, dmaaddr, cplen); 1738869SAli.Saidi@ARM.com } 1748869SAli.Saidi@ARM.com} 1758869SAli.Saidi@ARM.com 1768869SAli.Saidi@ARM.comvoid 1778869SAli.Saidi@ARM.comCopyIn(ExecContext *xc, Addr dest, void *source, size_t cplen) 1788869SAli.Saidi@ARM.com{ 1798869SAli.Saidi@ARM.com Addr paddr; 1808869SAli.Saidi@ARM.com char *dmaaddr; 1818869SAli.Saidi@ARM.com char *src = (char *)source; 1828869SAli.Saidi@ARM.com int len; 1838869SAli.Saidi@ARM.com 1848869SAli.Saidi@ARM.com paddr = vtophys(xc, dest); 1858869SAli.Saidi@ARM.com len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)cplen); 1868869SAli.Saidi@ARM.com dmaaddr = (char *)xc->physmem->dma_addr(paddr, len); 1878869SAli.Saidi@ARM.com assert(dmaaddr); 1888869SAli.Saidi@ARM.com 1898869SAli.Saidi@ARM.com memcpy(dmaaddr, src, len); 1908993SAli.Saidi@ARM.com if (len == cplen) 1918869SAli.Saidi@ARM.com return; 1928869SAli.Saidi@ARM.com 1937584SN/A cplen -= len; 1947584SN/A src += len; 1957584SN/A dest += len; 1967584SN/A 19710905Sandreas.sandberg@arm.com while (cplen > ALPHA_PGBYTES) { 1987584SN/A paddr = vtophys(xc, dest); 1998869SAli.Saidi@ARM.com dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES); 2008869SAli.Saidi@ARM.com assert(dmaaddr); 2018869SAli.Saidi@ARM.com 2028869SAli.Saidi@ARM.com memcpy(dmaaddr, src, ALPHA_PGBYTES); 2038869SAli.Saidi@ARM.com cplen -= ALPHA_PGBYTES; 2048869SAli.Saidi@ARM.com src += ALPHA_PGBYTES; 2058869SAli.Saidi@ARM.com dest += ALPHA_PGBYTES; 2068869SAli.Saidi@ARM.com } 2077584SN/A 2088869SAli.Saidi@ARM.com if (cplen > 0) { 2097733SN/A paddr = vtophys(xc, dest); 2107733SN/A dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen); 2117733SN/A assert(dmaaddr); 2127733SN/A 2138869SAli.Saidi@ARM.com memcpy(dmaaddr, src, cplen); 2147733SN/A } 2157733SN/A} 2167733SN/A 2177733SN/Avoid 2187733SN/ACopyString(ExecContext *xc, char *dst, Addr vaddr, size_t maxlen) 21910905Sandreas.sandberg@arm.com{ 2207733SN/A Addr paddr; 2218869SAli.Saidi@ARM.com char *dmaaddr; 2227733SN/A int len; 2238869SAli.Saidi@ARM.com 2248869SAli.Saidi@ARM.com paddr = vtophys(xc, vaddr); 2258869SAli.Saidi@ARM.com len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)maxlen); 2268869SAli.Saidi@ARM.com dmaaddr = (char *)xc->physmem->dma_addr(paddr, len); 2277733SN/A assert(dmaaddr); 2288869SAli.Saidi@ARM.com 2297733SN/A char *term = (char *)memchr(dmaaddr, 0, len); 2307733SN/A if (term) 2317733SN/A len = term - dmaaddr + 1; 2327733SN/A 2337733SN/A memcpy(dst, dmaaddr, len); 2347733SN/A 2357733SN/A if (term || len == maxlen) 2367733SN/A return; 2378869SAli.Saidi@ARM.com 2387733SN/A maxlen -= len; 2397733SN/A dst += len; 2407733SN/A vaddr += len; 2417733SN/A 2427584SN/A while (maxlen > ALPHA_PGBYTES) { 2438869SAli.Saidi@ARM.com paddr = vtophys(xc, vaddr); 2448869SAli.Saidi@ARM.com dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES); 2457584SN/A assert(dmaaddr); 2468869SAli.Saidi@ARM.com 2477584SN/A 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} 275