4 * Copyright (c) 2007 AXIS Communications AB
5 * Written by Edgar E. Iglesias.
7 * This library is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2 of the License, or (at your option) any later version.
12 * This library is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
17 * You should have received a copy of the GNU Lesser General Public
18 * License along with this library; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22 #ifndef CONFIG_USER_ONLY
35 static int cris_mmu_enabled(uint32_t rw_gc_cfg
)
37 return (rw_gc_cfg
& 12) != 0;
40 static int cris_mmu_segmented_addr(int seg
, uint32_t rw_mm_cfg
)
42 return (1 << seg
) & rw_mm_cfg
;
45 static uint32_t cris_mmu_translate_seg(CPUState
*env
, int seg
)
51 base
= env
->sregs
[SFR_RW_MM_KBASE_LO
];
53 base
= env
->sregs
[SFR_RW_MM_KBASE_HI
];
62 /* Used by the tlb decoder. */
63 #define EXTRACT_FIELD(src, start, end) \
64 (((src) >> start) & ((1 << (end - start + 1)) - 1))
66 static inline void set_field(uint32_t *dst
, unsigned int val
,
67 unsigned int offset
, unsigned int width
)
71 mask
= (1 << width
) - 1;
76 D(printf ("val=%x mask=%x dst=%x\n", val
, mask
, *dst
));
81 static int cris_mmu_translate_page(struct cris_mmu_result_t
*res
,
82 CPUState
*env
, uint32_t vaddr
,
88 uint32_t tlb_vpn
, tlb_pfn
= 0;
89 int tlb_pid
, tlb_g
, tlb_v
, tlb_k
, tlb_w
, tlb_x
;
90 int cfg_v
, cfg_k
, cfg_w
, cfg_x
;
97 r_cause
= env
->sregs
[SFR_R_MM_CAUSE
];
98 r_cfg
= env
->sregs
[SFR_RW_MM_CFG
];
99 rwcause
= rw
? CRIS_MMU_ERR_WRITE
: CRIS_MMU_ERR_READ
;
104 /* We know the index which to check on each set.
105 Scan both I and D. */
107 for (i
= 0; i
< 4; i
++) {
109 for (j
= 0; j
< 16; j
++) {
110 lo
= env
->tlbsets
[1][i
][j
].lo
;
111 hi
= env
->tlbsets
[1][i
][j
].hi
;
112 tlb_vpn
= EXTRACT_FIELD(hi
, 13, 31);
113 tlb_pfn
= EXTRACT_FIELD(lo
, 13, 31);
115 printf ("TLB: [%d][%d] hi=%x lo=%x v=%x p=%x\n",
116 i
, j
, hi
, lo
, tlb_vpn
, tlb_pfn
);
120 for (i
= 0; i
< 4; i
++)
122 lo
= env
->tlbsets
[1][i
][idx
].lo
;
123 hi
= env
->tlbsets
[1][i
][idx
].hi
;
125 tlb_vpn
= EXTRACT_FIELD(hi
, 13, 31);
126 tlb_pfn
= EXTRACT_FIELD(lo
, 13, 31);
128 D(printf ("TLB[%d][%d] tlbv=%x vpage=%x -> pfn=%x\n",
129 i
, idx
, tlb_vpn
, vpage
, tlb_pfn
));
130 if (tlb_vpn
== vpage
) {
138 cfg_w
= EXTRACT_FIELD(r_cfg
, 19, 19);
139 cfg_k
= EXTRACT_FIELD(r_cfg
, 18, 18);
140 cfg_x
= EXTRACT_FIELD(r_cfg
, 17, 17);
141 cfg_v
= EXTRACT_FIELD(r_cfg
, 16, 16);
143 tlb_pid
= EXTRACT_FIELD(hi
, 0, 7);
144 tlb_pfn
= EXTRACT_FIELD(lo
, 13, 31);
145 tlb_g
= EXTRACT_FIELD(lo
, 4, 4);
146 tlb_v
= EXTRACT_FIELD(lo
, 3, 3);
147 tlb_k
= EXTRACT_FIELD(lo
, 2, 2);
148 tlb_w
= EXTRACT_FIELD(lo
, 1, 1);
149 tlb_x
= EXTRACT_FIELD(lo
, 0, 0);
152 set_exception_vector(0x04, i_mmu_refill);
153 set_exception_vector(0x05, i_mmu_invalid);
154 set_exception_vector(0x06, i_mmu_access);
155 set_exception_vector(0x07, i_mmu_execute);
156 set_exception_vector(0x08, d_mmu_refill);
157 set_exception_vector(0x09, d_mmu_invalid);
158 set_exception_vector(0x0a, d_mmu_access);
159 set_exception_vector(0x0b, d_mmu_write);
161 if (cfg_v
&& !tlb_v
) {
162 printf ("tlb: invalid\n");
163 set_field(&r_cause
, rwcause
, 8, 9);
170 && tlb_pid
!= env
->pregs
[PR_PID
]
171 && cfg_w
&& !tlb_w
) {
172 printf ("tlb: wrong pid\n");
176 else if (rw
&& cfg_w
&& !tlb_w
) {
177 printf ("tlb: write protected\n");
186 env
->sregs
[SFR_RW_MM_TLB_SEL
] = 0;
187 D(printf ("tlb: miss %x vp=%x\n",
188 env
->sregs
[SFR_RW_MM_TLB_SEL
], vpage
& 15));
189 set_field(&env
->sregs
[SFR_RW_MM_TLB_SEL
], vpage
& 15, 0, 4);
190 set_field(&env
->sregs
[SFR_RW_MM_TLB_SEL
], 0, 4, 5);
195 set_field(&r_cause
, rwcause
, 8, 9);
196 set_field(&r_cause
, vpage
, 13, 19);
197 set_field(&r_cause
, env
->pregs
[PR_PID
], 0, 8);
198 env
->sregs
[SFR_R_MM_CAUSE
] = r_cause
;
200 D(printf ("%s mtch=%d pc=%x va=%x vpn=%x tlbvpn=%x pfn=%x pid=%x"
201 " %x cause=%x sel=%x r13=%x\n",
202 __func__
, match
, env
->pc
,
204 tlb_vpn
, tlb_pfn
, tlb_pid
,
207 env
->sregs
[SFR_RW_MM_TLB_SEL
],
214 /* Give us the vaddr corresponding to the latest TLB update. */
215 target_ulong
cris_mmu_tlb_latest_update(CPUState
*env
, uint32_t new_lo
)
217 uint32_t sel
= env
->sregs
[SFR_RW_MM_TLB_SEL
];
223 idx
= EXTRACT_FIELD(sel
, 0, 4);
224 set
= EXTRACT_FIELD(sel
, 4, 5);
226 hi
= env
->tlbsets
[1][set
][idx
].hi
;
227 vaddr
= EXTRACT_FIELD(hi
, 13, 31);
228 return vaddr
<< TARGET_PAGE_BITS
;
231 int cris_mmu_translate(struct cris_mmu_result_t
*res
,
232 CPUState
*env
, uint32_t vaddr
,
235 uint32_t phy
= vaddr
;
238 int is_user
= mmu_idx
== MMU_USER_IDX
;
240 if (!cris_mmu_enabled(env
->sregs
[SFR_RW_GC_CFG
])) {
246 if (cris_mmu_segmented_addr(seg
, env
->sregs
[SFR_RW_MM_CFG
]))
251 base
= cris_mmu_translate_seg(env
, seg
);
252 phy
= base
| (0x0fffffff & vaddr
);
257 miss
= cris_mmu_translate_page(res
, env
, vaddr
, rw
, is_user
);
260 phy
|= (res
->pfn
<< 13);
264 D(printf ("miss=%d v=%x -> p=%x\n", miss
, vaddr
, phy
));