2 * Copyright (c) 2003 The Regents of The University of Michigan
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions are
7 * met: redistributions of source code must retain the above copyright
8 * notice, this list of conditions and the following disclaimer;
9 * redistributions in binary form must reproduce the above copyright
10 * notice, this list of conditions and the following disclaimer in the
11 * documentation and/or other materials provided with the distribution;
12 * neither the name of the copyright holders nor the names of its
13 * contributors may be used to endorse or promote products derived from
14 * this software without specific prior written permission.
16 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
17 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
18 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
19 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
20 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
21 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
22 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
26 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 #include "targetarch/pmap.h"
33 #include "cpu/exec_context.hh"
34 #include "mem/functional_mem/physical_memory.hh"
35 #include "base/trace.hh"
36 #include "targetarch/vtophys.hh"
41 level3_index(Addr vaddr
)
42 { return (vaddr
>> ALPHA_PGSHIFT
) & PTEMASK
; }
45 level2_index(Addr vaddr
)
46 { return (vaddr
>> (ALPHA_PGSHIFT
+ NPTEPG_SHIFT
)) & PTEMASK
; }
49 level1_index(Addr vaddr
)
50 { return (vaddr
>> (ALPHA_PGSHIFT
+ 2 * NPTEPG_SHIFT
)) & PTEMASK
; }
53 kernel_pte_lookup(PhysicalMemory
*pmem
, Addr ptbr
, Addr vaddr
)
55 uint64_t level1_map
= ptbr
;
56 Addr level1_pte
= level1_map
+ (level1_index(vaddr
) << PTESHIFT
);
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
);
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
);
72 uint64_t level3_map
= PMAP_PTE_PA(level2
);
73 Addr level3_pte
= level3_map
+ (level3_index(vaddr
) << PTESHIFT
);
79 vtophys(PhysicalMemory
*xc
, Addr vaddr
)
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
);
87 panic("vtophys: ptbr is not set on virtual lookup");
89 DPRINTF(VtoPhys
, "vtophys(%#x) -> %#x\n", vaddr
, paddr
);
95 vtophys(ExecContext
*xc
, Addr vaddr
)
97 Addr ptbr
= xc
->regs
.ipr
[AlphaISA::IPR_PALtemp20
];
99 if (PC_PAL(vaddr
) || vaddr
< 0x10000) {
100 paddr
= vaddr
& ~ULL(1);
104 if (vaddr
>= ALPHA_K0SEG_BASE
&& vaddr
<= ALPHA_K0SEG_END
) {
105 paddr
= ALPHA_K0SEG_TO_PHYS(vaddr
);
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
);
114 DPRINTF(VtoPhys
, "vtophys(%#x) -> %#x\n", vaddr
, paddr
);
120 ptomem(ExecContext
*xc
, Addr paddr
, size_t len
)
122 return xc
->physmem
->dma_addr(paddr
, len
);
126 vtomem(ExecContext
*xc
, Addr vaddr
, size_t len
)
128 Addr paddr
= vtophys(xc
, vaddr
);
129 return xc
->physmem
->dma_addr(paddr
, len
);
133 CopyData(ExecContext
*xc
, void *dest
, Addr vaddr
, size_t cplen
)
137 char *dst
= (char *)dest
;
140 paddr
= vtophys(xc
, vaddr
);
141 len
= min((int)(ALPHA_PGBYTES
- (paddr
& PGOFSET
)), (int)cplen
);
142 dmaaddr
= (char *)xc
->physmem
->dma_addr(paddr
, len
);
145 memcpy(dst
, dmaaddr
, len
);
153 while (cplen
> ALPHA_PGBYTES
) {
154 paddr
= vtophys(xc
, vaddr
);
155 dmaaddr
= (char *)xc
->physmem
->dma_addr(paddr
, ALPHA_PGBYTES
);
158 memcpy(dst
, dmaaddr
, ALPHA_PGBYTES
);
159 cplen
-= ALPHA_PGBYTES
;
160 dst
+= ALPHA_PGBYTES
;
161 vaddr
+= ALPHA_PGBYTES
;
165 paddr
= vtophys(xc
, vaddr
);
166 dmaaddr
= (char *)xc
->physmem
->dma_addr(paddr
, cplen
);
169 memcpy(dst
, dmaaddr
, cplen
);
174 CopyString(ExecContext
*xc
, char *dst
, Addr vaddr
, size_t maxlen
)
180 paddr
= vtophys(xc
, vaddr
);
181 len
= min((int)(ALPHA_PGBYTES
- (paddr
& PGOFSET
)), (int)maxlen
);
182 dmaaddr
= (char *)xc
->physmem
->dma_addr(paddr
, len
);
185 char *term
= (char *)memchr(dmaaddr
, 0, len
);
187 len
= term
- dmaaddr
+ 1;
189 memcpy(dst
, dmaaddr
, len
);
191 if (term
|| len
== maxlen
)
198 while (maxlen
> ALPHA_PGBYTES
) {
199 paddr
= vtophys(xc
, vaddr
);
200 dmaaddr
= (char *)xc
->physmem
->dma_addr(paddr
, ALPHA_PGBYTES
);
203 char *term
= (char *)memchr(dmaaddr
, 0, ALPHA_PGBYTES
);
204 len
= term
? (term
- dmaaddr
+ 1) : ALPHA_PGBYTES
;
206 memcpy(dst
, dmaaddr
, len
);
210 maxlen
-= ALPHA_PGBYTES
;
211 dst
+= ALPHA_PGBYTES
;
212 vaddr
+= ALPHA_PGBYTES
;
216 paddr
= vtophys(xc
, vaddr
);
217 dmaaddr
= (char *)xc
->physmem
->dma_addr(paddr
, maxlen
);
220 char *term
= (char *)memchr(dmaaddr
, 0, maxlen
);
221 len
= term
? (term
- dmaaddr
+ 1) : maxlen
;
223 memcpy(dst
, dmaaddr
, len
);