vtophys.cc revision 1762
16899SN/A/* 26899SN/A * Copyright (c) 2002-2005 The Regents of The University of Michigan 36899SN/A * All rights reserved. 46899SN/A * 56899SN/A * Redistribution and use in source and binary forms, with or without 66899SN/A * modification, are permitted provided that the following conditions are 76899SN/A * met: redistributions of source code must retain the above copyright 86899SN/A * notice, this list of conditions and the following disclaimer; 96899SN/A * redistributions in binary form must reproduce the above copyright 106899SN/A * notice, this list of conditions and the following disclaimer in the 116899SN/A * documentation and/or other materials provided with the distribution; 126899SN/A * neither the name of the copyright holders nor the names of its 136899SN/A * contributors may be used to endorse or promote products derived from 146899SN/A * this software without specific prior written permission. 156899SN/A * 166899SN/A * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 176899SN/A * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 186899SN/A * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 196899SN/A * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 206899SN/A * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 216899SN/A * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 226899SN/A * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 236899SN/A * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 246899SN/A * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 256899SN/A * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 266899SN/A * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 276899SN/A */ 286899SN/A 296899SN/A#include <string> 307053SN/A 317053SN/A#include "arch/alpha/vtophys.hh" 326899SN/A#include "base/trace.hh" 337055SN/A#include "cpu/exec_context.hh" 347055SN/A#include "mem/functional/physical.hh" 357632SBrad.Beckmann@amd.com 367053SN/Ausing namespace std; 377053SN/A 387053SN/AAlphaISA::PageTableEntry 396899SN/Akernel_pte_lookup(PhysicalMemory *pmem, Addr ptbr, AlphaISA::VAddr vaddr) 406899SN/A{ 417053SN/A Addr level1_pte = ptbr + vaddr.level1(); 426899SN/A AlphaISA::PageTableEntry level1 = pmem->phys_read_qword(level1_pte); 436899SN/A if (!level1.valid()) { 446899SN/A DPRINTF(VtoPhys, "level 1 PTE not valid, va = %#\n", vaddr); 457053SN/A return 0; 466899SN/A } 477053SN/A 487053SN/A Addr level2_pte = level1.paddr() + vaddr.level2(); 497053SN/A AlphaISA::PageTableEntry level2 = pmem->phys_read_qword(level2_pte); 507053SN/A if (!level2.valid()) { 517053SN/A DPRINTF(VtoPhys, "level 2 PTE not valid, va = %#x\n", vaddr); 526899SN/A return 0; 537053SN/A } 547053SN/A 557053SN/A Addr level3_pte = level2.paddr() + vaddr.level3(); 567053SN/A AlphaISA::PageTableEntry level3 = pmem->phys_read_qword(level3_pte); 576899SN/A if (!level3.valid()) { 587055SN/A DPRINTF(VtoPhys, "level 3 PTE not valid, va = %#x\n", vaddr); 596899SN/A return 0; 607053SN/A } 617053SN/A return level3; 627053SN/A} 637053SN/A 646899SN/AAddr 657053SN/Avtophys(PhysicalMemory *xc, Addr vaddr) 667053SN/A{ 676899SN/A Addr paddr = 0; 687053SN/A if (AlphaISA::IsUSeg(vaddr)) 696899SN/A DPRINTF(VtoPhys, "vtophys: invalid vaddr %#x", vaddr); 707053SN/A else if (AlphaISA::IsK0Seg(vaddr)) 717053SN/A paddr = AlphaISA::K0Seg2Phys(vaddr); 727053SN/A else 737053SN/A panic("vtophys: ptbr is not set on virtual lookup"); 747053SN/A 757053SN/A DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr); 767053SN/A 777053SN/A return paddr; 787053SN/A} 796899SN/A 806899SN/AAddr 817055SN/Avtophys(ExecContext *xc, Addr addr) 827055SN/A{ 836899SN/A AlphaISA::VAddr vaddr = addr; 847053SN/A Addr ptbr = xc->regs.ipr[AlphaISA::IPR_PALtemp20]; 857055SN/A Addr paddr = 0; 867053SN/A //@todo Andrew couldn't remember why he commented some of this code 876899SN/A //so I put it back in. Perhaps something to do with gdb debugging? 886899SN/A if (AlphaISA::PcPAL(vaddr) && (vaddr < EV5::PalMax)) { 897053SN/A paddr = vaddr & ~ULL(1); 90 } else { 91 if (AlphaISA::IsK0Seg(vaddr)) { 92 paddr = AlphaISA::K0Seg2Phys(vaddr); 93 } else if (!ptbr) { 94 paddr = vaddr; 95 } else { 96 AlphaISA::PageTableEntry pte = 97 kernel_pte_lookup(xc->physmem, ptbr, vaddr); 98 if (pte.valid()) 99 paddr = pte.paddr() | vaddr.offset(); 100 } 101 } 102 103 104 DPRINTF(VtoPhys, "vtophys(%#x) -> %#x\n", vaddr, paddr); 105 106 return paddr; 107} 108 109uint8_t * 110ptomem(ExecContext *xc, Addr paddr, size_t len) 111{ 112 return xc->physmem->dma_addr(paddr, len); 113} 114 115uint8_t * 116vtomem(ExecContext *xc, Addr vaddr, size_t len) 117{ 118 Addr paddr = vtophys(xc, vaddr); 119 return xc->physmem->dma_addr(paddr, len); 120} 121 122void 123CopyOut(ExecContext *xc, void *dest, Addr src, size_t cplen) 124{ 125 Addr paddr; 126 char *dmaaddr; 127 char *dst = (char *)dest; 128 int len; 129 130 paddr = vtophys(xc, src); 131 len = min((int)(AlphaISA::PageBytes - (paddr & AlphaISA::PageOffset)), 132 (int)cplen); 133 dmaaddr = (char *)xc->physmem->dma_addr(paddr, len); 134 assert(dmaaddr); 135 136 memcpy(dst, dmaaddr, len); 137 if (len == cplen) 138 return; 139 140 cplen -= len; 141 dst += len; 142 src += len; 143 144 while (cplen > AlphaISA::PageBytes) { 145 paddr = vtophys(xc, src); 146 dmaaddr = (char *)xc->physmem->dma_addr(paddr, AlphaISA::PageBytes); 147 assert(dmaaddr); 148 149 memcpy(dst, dmaaddr, AlphaISA::PageBytes); 150 cplen -= AlphaISA::PageBytes; 151 dst += AlphaISA::PageBytes; 152 src += AlphaISA::PageBytes; 153 } 154 155 if (cplen > 0) { 156 paddr = vtophys(xc, src); 157 dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen); 158 assert(dmaaddr); 159 160 memcpy(dst, dmaaddr, cplen); 161 } 162} 163 164void 165CopyIn(ExecContext *xc, Addr dest, void *source, size_t cplen) 166{ 167 Addr paddr; 168 char *dmaaddr; 169 char *src = (char *)source; 170 int len; 171 172 paddr = vtophys(xc, dest); 173 len = min((int)(AlphaISA::PageBytes - (paddr & AlphaISA::PageOffset)), 174 (int)cplen); 175 dmaaddr = (char *)xc->physmem->dma_addr(paddr, len); 176 assert(dmaaddr); 177 178 memcpy(dmaaddr, src, len); 179 if (len == cplen) 180 return; 181 182 cplen -= len; 183 src += len; 184 dest += len; 185 186 while (cplen > AlphaISA::PageBytes) { 187 paddr = vtophys(xc, dest); 188 dmaaddr = (char *)xc->physmem->dma_addr(paddr, AlphaISA::PageBytes); 189 assert(dmaaddr); 190 191 memcpy(dmaaddr, src, AlphaISA::PageBytes); 192 cplen -= AlphaISA::PageBytes; 193 src += AlphaISA::PageBytes; 194 dest += AlphaISA::PageBytes; 195 } 196 197 if (cplen > 0) { 198 paddr = vtophys(xc, dest); 199 dmaaddr = (char *)xc->physmem->dma_addr(paddr, cplen); 200 assert(dmaaddr); 201 202 memcpy(dmaaddr, src, cplen); 203 } 204} 205 206void 207CopyString(ExecContext *xc, char *dst, Addr vaddr, size_t maxlen) 208{ 209 Addr paddr; 210 char *dmaaddr; 211 int len; 212 213 paddr = vtophys(xc, vaddr); 214 len = min((int)(AlphaISA::PageBytes - (paddr & AlphaISA::PageOffset)), 215 (int)maxlen); 216 dmaaddr = (char *)xc->physmem->dma_addr(paddr, len); 217 assert(dmaaddr); 218 219 char *term = (char *)memchr(dmaaddr, 0, len); 220 if (term) 221 len = term - dmaaddr + 1; 222 223 memcpy(dst, dmaaddr, len); 224 225 if (term || len == maxlen) 226 return; 227 228 maxlen -= len; 229 dst += len; 230 vaddr += len; 231 232 while (maxlen > AlphaISA::PageBytes) { 233 paddr = vtophys(xc, vaddr); 234 dmaaddr = (char *)xc->physmem->dma_addr(paddr, AlphaISA::PageBytes); 235 assert(dmaaddr); 236 237 char *term = (char *)memchr(dmaaddr, 0, AlphaISA::PageBytes); 238 len = term ? (term - dmaaddr + 1) : AlphaISA::PageBytes; 239 240 memcpy(dst, dmaaddr, len); 241 if (term) 242 return; 243 244 maxlen -= AlphaISA::PageBytes; 245 dst += AlphaISA::PageBytes; 246 vaddr += AlphaISA::PageBytes; 247 } 248 249 if (maxlen > 0) { 250 paddr = vtophys(xc, vaddr); 251 dmaaddr = (char *)xc->physmem->dma_addr(paddr, maxlen); 252 assert(dmaaddr); 253 254 char *term = (char *)memchr(dmaaddr, 0, maxlen); 255 len = term ? (term - dmaaddr + 1) : maxlen; 256 257 memcpy(dst, dmaaddr, len); 258 259 maxlen -= len; 260 } 261 262 if (maxlen == 0) 263 dst[maxlen] = '\0'; 264} 265