vtophys.cc revision 924
110037SARM gem5 Developers/* 210037SARM gem5 Developers * Copyright (c) 2002-2004 The Regents of The University of Michigan 310037SARM gem5 Developers * All rights reserved. 410037SARM gem5 Developers * 510037SARM gem5 Developers * Redistribution and use in source and binary forms, with or without 610037SARM gem5 Developers * modification, are permitted provided that the following conditions are 710037SARM gem5 Developers * met: redistributions of source code must retain the above copyright 810037SARM gem5 Developers * notice, this list of conditions and the following disclaimer; 910037SARM gem5 Developers * redistributions in binary form must reproduce the above copyright 1010037SARM gem5 Developers * notice, this list of conditions and the following disclaimer in the 1110037SARM gem5 Developers * documentation and/or other materials provided with the distribution; 1210037SARM gem5 Developers * neither the name of the copyright holders nor the names of its 1310037SARM gem5 Developers * contributors may be used to endorse or promote products derived from 1410037SARM gem5 Developers * this software without specific prior written permission. 1510037SARM gem5 Developers * 1610037SARM gem5 Developers * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 1710037SARM gem5 Developers * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 1810037SARM gem5 Developers * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 1910037SARM gem5 Developers * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 2010037SARM gem5 Developers * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 2110037SARM gem5 Developers * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 2210037SARM gem5 Developers * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 2310037SARM gem5 Developers * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 2410037SARM gem5 Developers * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 2510037SARM gem5 Developers * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 2610037SARM gem5 Developers * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 2710037SARM gem5 Developers */ 2810037SARM gem5 Developers 2910037SARM gem5 Developers#include <string> 3010037SARM gem5 Developers 3110037SARM gem5 Developers#include "targetarch/pmap.h" 3210037SARM gem5 Developers 3310037SARM gem5 Developers#include "cpu/exec_context.hh" 3410037SARM gem5 Developers#include "mem/functional_mem/physical_memory.hh" 3510037SARM gem5 Developers#include "base/trace.hh" 3610037SARM gem5 Developers#include "targetarch/vtophys.hh" 3710037SARM gem5 Developers 3810037SARM gem5 Developersusing namespace std; 3910037SARM gem5 Developers 4010037SARM gem5 Developersinline Addr 4110037SARM gem5 Developerslevel3_index(Addr vaddr) 4210037SARM gem5 Developers{ return (vaddr >> ALPHA_PGSHIFT) & PTEMASK; } 4310037SARM gem5 Developers 4410037SARM gem5 Developersinline Addr 4510037SARM gem5 Developerslevel2_index(Addr vaddr) 4610037SARM gem5 Developers{ return (vaddr >> (ALPHA_PGSHIFT + NPTEPG_SHIFT)) & PTEMASK; } 4710037SARM gem5 Developers 4810037SARM gem5 Developersinline Addr 4910037SARM gem5 Developerslevel1_index(Addr vaddr) 5010037SARM gem5 Developers{ return (vaddr >> (ALPHA_PGSHIFT + 2 * NPTEPG_SHIFT)) & PTEMASK; } 5110037SARM gem5 Developers 5210037SARM gem5 DevelopersAddr 5310037SARM gem5 Developerskernel_pte_lookup(PhysicalMemory *pmem, Addr ptbr, Addr vaddr) 5410037SARM gem5 Developers{ 5510037SARM gem5 Developers uint64_t level1_map = ptbr; 5610037SARM gem5 Developers Addr level1_pte = level1_map + (level1_index(vaddr) << PTESHIFT); 5710037SARM gem5 Developers 5810037SARM gem5 Developers uint64_t level1 = pmem->phys_read_qword(level1_pte); 5910037SARM gem5 Developers if (!entry_valid(level1)) { 6010037SARM gem5 Developers DPRINTF(VtoPhys, "level 1 PTE not valid, va = %#\n", vaddr); 6112616Sgabeblack@google.com return 0; 6210037SARM gem5 Developers } 6310037SARM gem5 Developers 6410037SARM gem5 Developers uint64_t level2_map = PMAP_PTE_PA(level1); 6510037SARM gem5 Developers Addr level2_pte = level2_map + (level2_index(vaddr) << PTESHIFT); 6610037SARM gem5 Developers uint64_t level2 = pmem->phys_read_qword(level2_pte); 6710037SARM gem5 Developers if (!entry_valid(level2)) { 6810037SARM gem5 Developers DPRINTF(VtoPhys, "level 2 PTE not valid, va = %#x\n", vaddr); 6910037SARM gem5 Developers return 0; 7010037SARM gem5 Developers } 7110037SARM gem5 Developers 7210037SARM gem5 Developers uint64_t level3_map = PMAP_PTE_PA(level2); 7310037SARM gem5 Developers Addr level3_pte = level3_map + (level3_index(vaddr) << PTESHIFT); 7410037SARM gem5 Developers 7510037SARM gem5 Developers return level3_pte; 7610037SARM gem5 Developers} 7710037SARM gem5 Developers 7810037SARM gem5 DevelopersAddr 7910037SARM gem5 Developersvtophys(PhysicalMemory *xc, Addr vaddr) 8010037SARM gem5 Developers{ 8110037SARM gem5 Developers Addr paddr = 0; 8212616Sgabeblack@google.com if (vaddr < ALPHA_K0SEG_BASE) 8310037SARM gem5 Developers DPRINTF(VtoPhys, "vtophys: invalid vaddr %#x", vaddr); 8410037SARM gem5 Developers else if (vaddr < ALPHA_K1SEG_BASE) 8510037SARM gem5 Developers paddr = ALPHA_K0SEG_TO_PHYS(vaddr); 8610037SARM gem5 Developers else 8710037SARM gem5 Developers panic("vtophys: ptbr is not set on virtual lookup"); 8810037SARM gem5 Developers 8910037SARM gem5 Developers DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr); 9010037SARM gem5 Developers 9110037SARM gem5 Developers return paddr; 9210037SARM gem5 Developers} 9310037SARM gem5 Developers 9410037SARM gem5 DevelopersAddr 9510037SARM gem5 Developersvtophys(ExecContext *xc, Addr vaddr) 9610037SARM gem5 Developers{ 9710037SARM gem5 Developers Addr ptbr = xc->regs.ipr[AlphaISA::IPR_PALtemp20]; 9810037SARM gem5 Developers Addr paddr = 0; 9910037SARM gem5 Developers //@todo Andrew couldn't remember why he commented some of this code 10010037SARM gem5 Developers //so I put it back in. Perhaps something to do with gdb debugging? 10110037SARM gem5 Developers if (PC_PAL(vaddr)) { 10212616Sgabeblack@google.com paddr = vaddr & ~ULL(1); 10310037SARM gem5 Developers } else if (!ptbr) { 10410037SARM gem5 Developers paddr = vaddr; 10510037SARM gem5 Developers } else { 10610037SARM gem5 Developers if (vaddr >= ALPHA_K0SEG_BASE && vaddr <= ALPHA_K0SEG_END) { 10710037SARM gem5 Developers paddr = ALPHA_K0SEG_TO_PHYS(vaddr); 10810037SARM gem5 Developers } else { 10910037SARM gem5 Developers Addr pte = kernel_pte_lookup(xc->physmem, ptbr, vaddr); 11010037SARM gem5 Developers uint64_t entry = xc->physmem->phys_read_qword(pte); 11110037SARM gem5 Developers if (pte && entry_valid(entry)) 11210037SARM gem5 Developers paddr = PMAP_PTE_PA(entry) | (vaddr & PGOFSET); 11310037SARM gem5 Developers } 11410037SARM gem5 Developers } 11510037SARM gem5 Developers 11610037SARM gem5 Developers 11710037SARM gem5 Developers DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr); 11810037SARM gem5 Developers 11910037SARM gem5 Developers return paddr; 12010037SARM gem5 Developers} 12110037SARM gem5 Developers 12212616Sgabeblack@google.comuint8_t * 12310037SARM gem5 Developersptomem(ExecContext *xc, Addr paddr, size_t len) 12410037SARM gem5 Developers{ 12510037SARM gem5 Developers return xc->physmem->dma_addr(paddr, len); 12610037SARM gem5 Developers} 12710037SARM gem5 Developers 12810037SARM gem5 Developersuint8_t * 12910037SARM gem5 Developersvtomem(ExecContext *xc, Addr vaddr, size_t len) 13010037SARM gem5 Developers{ 13110037SARM gem5 Developers Addr paddr = vtophys(xc, vaddr); 13210037SARM gem5 Developers return xc->physmem->dma_addr(paddr, len); 13310037SARM gem5 Developers} 13410037SARM gem5 Developers 13510037SARM gem5 Developersvoid 13610037SARM gem5 DevelopersCopyData(ExecContext *xc, void *dest, Addr vaddr, size_t cplen) 13710037SARM gem5 Developers{ 13810037SARM gem5 Developers Addr paddr; 13910037SARM gem5 Developers char *dmaaddr; 14010037SARM gem5 Developers char *dst = (char *)dest; 14110037SARM gem5 Developers int len; 14210037SARM gem5 Developers 14312616Sgabeblack@google.com paddr = vtophys(xc, vaddr); 14410037SARM gem5 Developers len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)cplen); 14510037SARM gem5 Developers dmaaddr = (char *)xc->physmem->dma_addr(paddr, len); 14610037SARM gem5 Developers assert(dmaaddr); 14710037SARM gem5 Developers 14810037SARM gem5 Developers memcpy(dst, dmaaddr, len); 14910037SARM gem5 Developers if (len == cplen) 15010037SARM gem5 Developers return; 15110037SARM gem5 Developers 15210037SARM gem5 Developers cplen -= len; 15310037SARM gem5 Developers dst += len; 15410037SARM gem5 Developers vaddr += len; 15510037SARM gem5 Developers 15610037SARM gem5 Developers while (cplen > ALPHA_PGBYTES) { 15710037SARM gem5 Developers paddr = vtophys(xc, vaddr); 15810037SARM gem5 Developers dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES); 15910037SARM gem5 Developers assert(dmaaddr); 16010037SARM gem5 Developers 16110037SARM gem5 Developers memcpy(dst, dmaaddr, ALPHA_PGBYTES); 16210037SARM gem5 Developers cplen -= ALPHA_PGBYTES; 16312616Sgabeblack@google.com dst += ALPHA_PGBYTES; 16410037SARM gem5 Developers vaddr += ALPHA_PGBYTES; 16510037SARM gem5 Developers } 16610037SARM gem5 Developers 16710037SARM gem5 Developers if (cplen > 0) { 16810037SARM gem5 Developers paddr = vtophys(xc, vaddr); 16910037SARM gem5 Developers dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen); 17012234Sgabeblack@google.com assert(dmaaddr); 17110037SARM gem5 Developers 17210037SARM gem5 Developers memcpy(dst, dmaaddr, cplen); 17310037SARM gem5 Developers } 17410037SARM gem5 Developers} 17512234Sgabeblack@google.com 17610037SARM gem5 Developersvoid 17710037SARM gem5 DevelopersCopyString(ExecContext *xc, char *dst, Addr vaddr, size_t maxlen) 17810037SARM gem5 Developers{ 17910037SARM gem5 Developers Addr paddr; 18010037SARM gem5 Developers char *dmaaddr; 18110037SARM gem5 Developers int len; 18210037SARM gem5 Developers 18313544Sgabeblack@google.com paddr = vtophys(xc, vaddr); 18413544Sgabeblack@google.com len = min((int)(ALPHA_PGBYTES - (paddr & PGOFSET)), (int)maxlen); 18510037SARM gem5 Developers dmaaddr = (char *)xc->physmem->dma_addr(paddr, len); 18610037SARM gem5 Developers assert(dmaaddr); 18713544Sgabeblack@google.com 18810037SARM gem5 Developers char *term = (char *)memchr(dmaaddr, 0, len); 18910037SARM gem5 Developers if (term) 19010037SARM gem5 Developers len = term - dmaaddr + 1; 19110037SARM gem5 Developers 19213544Sgabeblack@google.com memcpy(dst, dmaaddr, len); 19310037SARM gem5 Developers 19410037SARM gem5 Developers if (term || len == maxlen) 19510037SARM gem5 Developers return; 19610037SARM gem5 Developers 19710037SARM gem5 Developers maxlen -= len; 19810037SARM gem5 Developers dst += len; 19910037SARM gem5 Developers vaddr += len; 20010037SARM gem5 Developers 20110037SARM gem5 Developers while (maxlen > ALPHA_PGBYTES) { 20210037SARM gem5 Developers paddr = vtophys(xc, vaddr); 20310037SARM gem5 Developers dmaaddr = (char *)xc->physmem->dma_addr(paddr, ALPHA_PGBYTES); 20410037SARM gem5 Developers assert(dmaaddr); 20510037SARM gem5 Developers 20610037SARM gem5 Developers char *term = (char *)memchr(dmaaddr, 0, ALPHA_PGBYTES); 20710037SARM gem5 Developers len = term ? (term - dmaaddr + 1) : ALPHA_PGBYTES; 20812234Sgabeblack@google.com 20910037SARM gem5 Developers memcpy(dst, dmaaddr, len); 21010037SARM gem5 Developers if (term) 21110037SARM gem5 Developers return; 21210037SARM gem5 Developers 21310037SARM gem5 Developers maxlen -= ALPHA_PGBYTES; 21410037SARM gem5 Developers dst += ALPHA_PGBYTES; 21510037SARM gem5 Developers vaddr += ALPHA_PGBYTES; 21610037SARM gem5 Developers } 21713544Sgabeblack@google.com 21813544Sgabeblack@google.com if (maxlen > 0) { 21910037SARM gem5 Developers paddr = vtophys(xc, vaddr); 22010037SARM gem5 Developers dmaaddr = (char *)xc->physmem->dma_addr(paddr, maxlen); 22113544Sgabeblack@google.com assert(dmaaddr); 22210037SARM gem5 Developers 22310037SARM gem5 Developers char *term = (char *)memchr(dmaaddr, 0, maxlen); 22410037SARM gem5 Developers len = term ? (term - dmaaddr + 1) : maxlen; 22510037SARM gem5 Developers 22610037SARM gem5 Developers memcpy(dst, dmaaddr, len); 22713544Sgabeblack@google.com 22810037SARM gem5 Developers maxlen -= len; 22910037SARM gem5 Developers } 23010037SARM gem5 Developers 23110037SARM gem5 Developers if (maxlen == 0) 23213544Sgabeblack@google.com dst[maxlen] = '\0'; 23310037SARM gem5 Developers} 23410037SARM gem5 Developers