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