xref: /openbmc/qemu/accel/tcg/cputlb.c (revision 4b2190dabd1fe1db5e07732de311662382d40fb9)
1d9bb58e5SYang Zhong /*
2d9bb58e5SYang Zhong  *  Common CPU TLB handling
3d9bb58e5SYang Zhong  *
4d9bb58e5SYang Zhong  *  Copyright (c) 2003 Fabrice Bellard
5d9bb58e5SYang Zhong  *
6d9bb58e5SYang Zhong  * This library is free software; you can redistribute it and/or
7d9bb58e5SYang Zhong  * modify it under the terms of the GNU Lesser General Public
8d9bb58e5SYang Zhong  * License as published by the Free Software Foundation; either
9fb0343d5SThomas Huth  * version 2.1 of the License, or (at your option) any later version.
10d9bb58e5SYang Zhong  *
11d9bb58e5SYang Zhong  * This library is distributed in the hope that it will be useful,
12d9bb58e5SYang Zhong  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13d9bb58e5SYang Zhong  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14d9bb58e5SYang Zhong  * Lesser General Public License for more details.
15d9bb58e5SYang Zhong  *
16d9bb58e5SYang Zhong  * You should have received a copy of the GNU Lesser General Public
17d9bb58e5SYang Zhong  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18d9bb58e5SYang Zhong  */
19d9bb58e5SYang Zhong 
20d9bb58e5SYang Zhong #include "qemu/osdep.h"
21d9bb58e5SYang Zhong #include "qemu/main-loop.h"
22d9bb58e5SYang Zhong #include "cpu.h"
23d9bb58e5SYang Zhong #include "exec/exec-all.h"
24d9bb58e5SYang Zhong #include "exec/memory.h"
25d9bb58e5SYang Zhong #include "exec/address-spaces.h"
26d9bb58e5SYang Zhong #include "exec/cpu_ldst.h"
27d9bb58e5SYang Zhong #include "exec/cputlb.h"
28d9bb58e5SYang Zhong #include "exec/memory-internal.h"
29d9bb58e5SYang Zhong #include "exec/ram_addr.h"
30d9bb58e5SYang Zhong #include "tcg/tcg.h"
31d9bb58e5SYang Zhong #include "qemu/error-report.h"
32d9bb58e5SYang Zhong #include "exec/log.h"
33d9bb58e5SYang Zhong #include "exec/helper-proto.h"
34d9bb58e5SYang Zhong #include "qemu/atomic.h"
35e6cd4bb5SRichard Henderson #include "qemu/atomic128.h"
36707526adSRichard Henderson #include "translate-all.h"
37d9bb58e5SYang Zhong 
38d9bb58e5SYang Zhong /* DEBUG defines, enable DEBUG_TLB_LOG to log to the CPU_LOG_MMU target */
39d9bb58e5SYang Zhong /* #define DEBUG_TLB */
40d9bb58e5SYang Zhong /* #define DEBUG_TLB_LOG */
41d9bb58e5SYang Zhong 
42d9bb58e5SYang Zhong #ifdef DEBUG_TLB
43d9bb58e5SYang Zhong # define DEBUG_TLB_GATE 1
44d9bb58e5SYang Zhong # ifdef DEBUG_TLB_LOG
45d9bb58e5SYang Zhong #  define DEBUG_TLB_LOG_GATE 1
46d9bb58e5SYang Zhong # else
47d9bb58e5SYang Zhong #  define DEBUG_TLB_LOG_GATE 0
48d9bb58e5SYang Zhong # endif
49d9bb58e5SYang Zhong #else
50d9bb58e5SYang Zhong # define DEBUG_TLB_GATE 0
51d9bb58e5SYang Zhong # define DEBUG_TLB_LOG_GATE 0
52d9bb58e5SYang Zhong #endif
53d9bb58e5SYang Zhong 
54d9bb58e5SYang Zhong #define tlb_debug(fmt, ...) do { \
55d9bb58e5SYang Zhong     if (DEBUG_TLB_LOG_GATE) { \
56d9bb58e5SYang Zhong         qemu_log_mask(CPU_LOG_MMU, "%s: " fmt, __func__, \
57d9bb58e5SYang Zhong                       ## __VA_ARGS__); \
58d9bb58e5SYang Zhong     } else if (DEBUG_TLB_GATE) { \
59d9bb58e5SYang Zhong         fprintf(stderr, "%s: " fmt, __func__, ## __VA_ARGS__); \
60d9bb58e5SYang Zhong     } \
61d9bb58e5SYang Zhong } while (0)
62d9bb58e5SYang Zhong 
63ea9025cbSEmilio G. Cota #define assert_cpu_is_self(cpu) do {                              \
64d9bb58e5SYang Zhong         if (DEBUG_TLB_GATE) {                                     \
65ea9025cbSEmilio G. Cota             g_assert(!(cpu)->created || qemu_cpu_is_self(cpu));   \
66d9bb58e5SYang Zhong         }                                                         \
67d9bb58e5SYang Zhong     } while (0)
68d9bb58e5SYang Zhong 
69d9bb58e5SYang Zhong /* run_on_cpu_data.target_ptr should always be big enough for a
70d9bb58e5SYang Zhong  * target_ulong even on 32 bit builds */
71d9bb58e5SYang Zhong QEMU_BUILD_BUG_ON(sizeof(target_ulong) > sizeof(run_on_cpu_data));
72d9bb58e5SYang Zhong 
73d9bb58e5SYang Zhong /* We currently can't handle more than 16 bits in the MMUIDX bitmask.
74d9bb58e5SYang Zhong  */
75d9bb58e5SYang Zhong QEMU_BUILD_BUG_ON(NB_MMU_MODES > 16);
76d9bb58e5SYang Zhong #define ALL_MMUIDX_BITS ((1 << NB_MMU_MODES) - 1)
77d9bb58e5SYang Zhong 
7886e1eff8SEmilio G. Cota static inline size_t sizeof_tlb(CPUArchState *env, uintptr_t mmu_idx)
7986e1eff8SEmilio G. Cota {
80a40ec84eSRichard Henderson     return env_tlb(env)->f[mmu_idx].mask + (1 << CPU_TLB_ENTRY_BITS);
8186e1eff8SEmilio G. Cota }
8286e1eff8SEmilio G. Cota 
8379e42085SRichard Henderson static void tlb_window_reset(CPUTLBDesc *desc, int64_t ns,
8486e1eff8SEmilio G. Cota                              size_t max_entries)
8586e1eff8SEmilio G. Cota {
8679e42085SRichard Henderson     desc->window_begin_ns = ns;
8779e42085SRichard Henderson     desc->window_max_entries = max_entries;
8886e1eff8SEmilio G. Cota }
8986e1eff8SEmilio G. Cota 
9086e1eff8SEmilio G. Cota static void tlb_dyn_init(CPUArchState *env)
9186e1eff8SEmilio G. Cota {
9286e1eff8SEmilio G. Cota     int i;
9386e1eff8SEmilio G. Cota 
9486e1eff8SEmilio G. Cota     for (i = 0; i < NB_MMU_MODES; i++) {
95a40ec84eSRichard Henderson         CPUTLBDesc *desc = &env_tlb(env)->d[i];
9686e1eff8SEmilio G. Cota         size_t n_entries = 1 << CPU_TLB_DYN_DEFAULT_BITS;
9786e1eff8SEmilio G. Cota 
9879e42085SRichard Henderson         tlb_window_reset(desc, get_clock_realtime(), 0);
9986e1eff8SEmilio G. Cota         desc->n_used_entries = 0;
100a40ec84eSRichard Henderson         env_tlb(env)->f[i].mask = (n_entries - 1) << CPU_TLB_ENTRY_BITS;
101a40ec84eSRichard Henderson         env_tlb(env)->f[i].table = g_new(CPUTLBEntry, n_entries);
102a40ec84eSRichard Henderson         env_tlb(env)->d[i].iotlb = g_new(CPUIOTLBEntry, n_entries);
10386e1eff8SEmilio G. Cota     }
10486e1eff8SEmilio G. Cota }
10586e1eff8SEmilio G. Cota 
10686e1eff8SEmilio G. Cota /**
10786e1eff8SEmilio G. Cota  * tlb_mmu_resize_locked() - perform TLB resize bookkeeping; resize if necessary
10886e1eff8SEmilio G. Cota  * @env: CPU that owns the TLB
10986e1eff8SEmilio G. Cota  * @mmu_idx: MMU index of the TLB
11086e1eff8SEmilio G. Cota  *
11186e1eff8SEmilio G. Cota  * Called with tlb_lock_held.
11286e1eff8SEmilio G. Cota  *
11386e1eff8SEmilio G. Cota  * We have two main constraints when resizing a TLB: (1) we only resize it
11486e1eff8SEmilio G. Cota  * on a TLB flush (otherwise we'd have to take a perf hit by either rehashing
11586e1eff8SEmilio G. Cota  * the array or unnecessarily flushing it), which means we do not control how
11686e1eff8SEmilio G. Cota  * frequently the resizing can occur; (2) we don't have access to the guest's
11786e1eff8SEmilio G. Cota  * future scheduling decisions, and therefore have to decide the magnitude of
11886e1eff8SEmilio G. Cota  * the resize based on past observations.
11986e1eff8SEmilio G. Cota  *
12086e1eff8SEmilio G. Cota  * In general, a memory-hungry process can benefit greatly from an appropriately
12186e1eff8SEmilio G. Cota  * sized TLB, since a guest TLB miss is very expensive. This doesn't mean that
12286e1eff8SEmilio G. Cota  * we just have to make the TLB as large as possible; while an oversized TLB
12386e1eff8SEmilio G. Cota  * results in minimal TLB miss rates, it also takes longer to be flushed
12486e1eff8SEmilio G. Cota  * (flushes can be _very_ frequent), and the reduced locality can also hurt
12586e1eff8SEmilio G. Cota  * performance.
12686e1eff8SEmilio G. Cota  *
12786e1eff8SEmilio G. Cota  * To achieve near-optimal performance for all kinds of workloads, we:
12886e1eff8SEmilio G. Cota  *
12986e1eff8SEmilio G. Cota  * 1. Aggressively increase the size of the TLB when the use rate of the
13086e1eff8SEmilio G. Cota  * TLB being flushed is high, since it is likely that in the near future this
13186e1eff8SEmilio G. Cota  * memory-hungry process will execute again, and its memory hungriness will
13286e1eff8SEmilio G. Cota  * probably be similar.
13386e1eff8SEmilio G. Cota  *
13486e1eff8SEmilio G. Cota  * 2. Slowly reduce the size of the TLB as the use rate declines over a
13586e1eff8SEmilio G. Cota  * reasonably large time window. The rationale is that if in such a time window
13686e1eff8SEmilio G. Cota  * we have not observed a high TLB use rate, it is likely that we won't observe
13786e1eff8SEmilio G. Cota  * it in the near future. In that case, once a time window expires we downsize
13886e1eff8SEmilio G. Cota  * the TLB to match the maximum use rate observed in the window.
13986e1eff8SEmilio G. Cota  *
14086e1eff8SEmilio G. Cota  * 3. Try to keep the maximum use rate in a time window in the 30-70% range,
14186e1eff8SEmilio G. Cota  * since in that range performance is likely near-optimal. Recall that the TLB
14286e1eff8SEmilio G. Cota  * is direct mapped, so we want the use rate to be low (or at least not too
14386e1eff8SEmilio G. Cota  * high), since otherwise we are likely to have a significant amount of
14486e1eff8SEmilio G. Cota  * conflict misses.
14586e1eff8SEmilio G. Cota  */
14686e1eff8SEmilio G. Cota static void tlb_mmu_resize_locked(CPUArchState *env, int mmu_idx)
14786e1eff8SEmilio G. Cota {
148a40ec84eSRichard Henderson     CPUTLBDesc *desc = &env_tlb(env)->d[mmu_idx];
14986e1eff8SEmilio G. Cota     size_t old_size = tlb_n_entries(env, mmu_idx);
15086e1eff8SEmilio G. Cota     size_t rate;
15186e1eff8SEmilio G. Cota     size_t new_size = old_size;
15286e1eff8SEmilio G. Cota     int64_t now = get_clock_realtime();
15386e1eff8SEmilio G. Cota     int64_t window_len_ms = 100;
15486e1eff8SEmilio G. Cota     int64_t window_len_ns = window_len_ms * 1000 * 1000;
15579e42085SRichard Henderson     bool window_expired = now > desc->window_begin_ns + window_len_ns;
15686e1eff8SEmilio G. Cota 
15779e42085SRichard Henderson     if (desc->n_used_entries > desc->window_max_entries) {
15879e42085SRichard Henderson         desc->window_max_entries = desc->n_used_entries;
15986e1eff8SEmilio G. Cota     }
16079e42085SRichard Henderson     rate = desc->window_max_entries * 100 / old_size;
16186e1eff8SEmilio G. Cota 
16286e1eff8SEmilio G. Cota     if (rate > 70) {
16386e1eff8SEmilio G. Cota         new_size = MIN(old_size << 1, 1 << CPU_TLB_DYN_MAX_BITS);
16486e1eff8SEmilio G. Cota     } else if (rate < 30 && window_expired) {
16579e42085SRichard Henderson         size_t ceil = pow2ceil(desc->window_max_entries);
16679e42085SRichard Henderson         size_t expected_rate = desc->window_max_entries * 100 / ceil;
16786e1eff8SEmilio G. Cota 
16886e1eff8SEmilio G. Cota         /*
16986e1eff8SEmilio G. Cota          * Avoid undersizing when the max number of entries seen is just below
17086e1eff8SEmilio G. Cota          * a pow2. For instance, if max_entries == 1025, the expected use rate
17186e1eff8SEmilio G. Cota          * would be 1025/2048==50%. However, if max_entries == 1023, we'd get
17286e1eff8SEmilio G. Cota          * 1023/1024==99.9% use rate, so we'd likely end up doubling the size
17386e1eff8SEmilio G. Cota          * later. Thus, make sure that the expected use rate remains below 70%.
17486e1eff8SEmilio G. Cota          * (and since we double the size, that means the lowest rate we'd
17586e1eff8SEmilio G. Cota          * expect to get is 35%, which is still in the 30-70% range where
17686e1eff8SEmilio G. Cota          * we consider that the size is appropriate.)
17786e1eff8SEmilio G. Cota          */
17886e1eff8SEmilio G. Cota         if (expected_rate > 70) {
17986e1eff8SEmilio G. Cota             ceil *= 2;
18086e1eff8SEmilio G. Cota         }
18186e1eff8SEmilio G. Cota         new_size = MAX(ceil, 1 << CPU_TLB_DYN_MIN_BITS);
18286e1eff8SEmilio G. Cota     }
18386e1eff8SEmilio G. Cota 
18486e1eff8SEmilio G. Cota     if (new_size == old_size) {
18586e1eff8SEmilio G. Cota         if (window_expired) {
18679e42085SRichard Henderson             tlb_window_reset(desc, now, desc->n_used_entries);
18786e1eff8SEmilio G. Cota         }
18886e1eff8SEmilio G. Cota         return;
18986e1eff8SEmilio G. Cota     }
19086e1eff8SEmilio G. Cota 
191a40ec84eSRichard Henderson     g_free(env_tlb(env)->f[mmu_idx].table);
192a40ec84eSRichard Henderson     g_free(env_tlb(env)->d[mmu_idx].iotlb);
19386e1eff8SEmilio G. Cota 
19479e42085SRichard Henderson     tlb_window_reset(desc, now, 0);
19586e1eff8SEmilio G. Cota     /* desc->n_used_entries is cleared by the caller */
196a40ec84eSRichard Henderson     env_tlb(env)->f[mmu_idx].mask = (new_size - 1) << CPU_TLB_ENTRY_BITS;
197a40ec84eSRichard Henderson     env_tlb(env)->f[mmu_idx].table = g_try_new(CPUTLBEntry, new_size);
198a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].iotlb = g_try_new(CPUIOTLBEntry, new_size);
19986e1eff8SEmilio G. Cota     /*
20086e1eff8SEmilio G. Cota      * If the allocations fail, try smaller sizes. We just freed some
20186e1eff8SEmilio G. Cota      * memory, so going back to half of new_size has a good chance of working.
20286e1eff8SEmilio G. Cota      * Increased memory pressure elsewhere in the system might cause the
20386e1eff8SEmilio G. Cota      * allocations to fail though, so we progressively reduce the allocation
20486e1eff8SEmilio G. Cota      * size, aborting if we cannot even allocate the smallest TLB we support.
20586e1eff8SEmilio G. Cota      */
206a40ec84eSRichard Henderson     while (env_tlb(env)->f[mmu_idx].table == NULL ||
207a40ec84eSRichard Henderson            env_tlb(env)->d[mmu_idx].iotlb == NULL) {
20886e1eff8SEmilio G. Cota         if (new_size == (1 << CPU_TLB_DYN_MIN_BITS)) {
20986e1eff8SEmilio G. Cota             error_report("%s: %s", __func__, strerror(errno));
21086e1eff8SEmilio G. Cota             abort();
21186e1eff8SEmilio G. Cota         }
21286e1eff8SEmilio G. Cota         new_size = MAX(new_size >> 1, 1 << CPU_TLB_DYN_MIN_BITS);
213a40ec84eSRichard Henderson         env_tlb(env)->f[mmu_idx].mask = (new_size - 1) << CPU_TLB_ENTRY_BITS;
21486e1eff8SEmilio G. Cota 
215a40ec84eSRichard Henderson         g_free(env_tlb(env)->f[mmu_idx].table);
216a40ec84eSRichard Henderson         g_free(env_tlb(env)->d[mmu_idx].iotlb);
217a40ec84eSRichard Henderson         env_tlb(env)->f[mmu_idx].table = g_try_new(CPUTLBEntry, new_size);
218a40ec84eSRichard Henderson         env_tlb(env)->d[mmu_idx].iotlb = g_try_new(CPUIOTLBEntry, new_size);
21986e1eff8SEmilio G. Cota     }
22086e1eff8SEmilio G. Cota }
22186e1eff8SEmilio G. Cota 
22286e1eff8SEmilio G. Cota static inline void tlb_table_flush_by_mmuidx(CPUArchState *env, int mmu_idx)
22386e1eff8SEmilio G. Cota {
22486e1eff8SEmilio G. Cota     tlb_mmu_resize_locked(env, mmu_idx);
225a40ec84eSRichard Henderson     memset(env_tlb(env)->f[mmu_idx].table, -1, sizeof_tlb(env, mmu_idx));
226a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].n_used_entries = 0;
22786e1eff8SEmilio G. Cota }
22886e1eff8SEmilio G. Cota 
22986e1eff8SEmilio G. Cota static inline void tlb_n_used_entries_inc(CPUArchState *env, uintptr_t mmu_idx)
23086e1eff8SEmilio G. Cota {
231a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].n_used_entries++;
23286e1eff8SEmilio G. Cota }
23386e1eff8SEmilio G. Cota 
23486e1eff8SEmilio G. Cota static inline void tlb_n_used_entries_dec(CPUArchState *env, uintptr_t mmu_idx)
23586e1eff8SEmilio G. Cota {
236a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].n_used_entries--;
23786e1eff8SEmilio G. Cota }
23886e1eff8SEmilio G. Cota 
2395005e253SEmilio G. Cota void tlb_init(CPUState *cpu)
2405005e253SEmilio G. Cota {
24171aec354SEmilio G. Cota     CPUArchState *env = cpu->env_ptr;
24271aec354SEmilio G. Cota 
243a40ec84eSRichard Henderson     qemu_spin_init(&env_tlb(env)->c.lock);
2443d1523ceSRichard Henderson 
2453d1523ceSRichard Henderson     /* Ensure that cpu_reset performs a full flush.  */
246a40ec84eSRichard Henderson     env_tlb(env)->c.dirty = ALL_MMUIDX_BITS;
24786e1eff8SEmilio G. Cota 
24886e1eff8SEmilio G. Cota     tlb_dyn_init(env);
2495005e253SEmilio G. Cota }
2505005e253SEmilio G. Cota 
251d9bb58e5SYang Zhong /* flush_all_helper: run fn across all cpus
252d9bb58e5SYang Zhong  *
253d9bb58e5SYang Zhong  * If the wait flag is set then the src cpu's helper will be queued as
254d9bb58e5SYang Zhong  * "safe" work and the loop exited creating a synchronisation point
255d9bb58e5SYang Zhong  * where all queued work will be finished before execution starts
256d9bb58e5SYang Zhong  * again.
257d9bb58e5SYang Zhong  */
258d9bb58e5SYang Zhong static void flush_all_helper(CPUState *src, run_on_cpu_func fn,
259d9bb58e5SYang Zhong                              run_on_cpu_data d)
260d9bb58e5SYang Zhong {
261d9bb58e5SYang Zhong     CPUState *cpu;
262d9bb58e5SYang Zhong 
263d9bb58e5SYang Zhong     CPU_FOREACH(cpu) {
264d9bb58e5SYang Zhong         if (cpu != src) {
265d9bb58e5SYang Zhong             async_run_on_cpu(cpu, fn, d);
266d9bb58e5SYang Zhong         }
267d9bb58e5SYang Zhong     }
268d9bb58e5SYang Zhong }
269d9bb58e5SYang Zhong 
270e09de0a2SRichard Henderson void tlb_flush_counts(size_t *pfull, size_t *ppart, size_t *pelide)
27183974cf4SEmilio G. Cota {
27283974cf4SEmilio G. Cota     CPUState *cpu;
273e09de0a2SRichard Henderson     size_t full = 0, part = 0, elide = 0;
27483974cf4SEmilio G. Cota 
27583974cf4SEmilio G. Cota     CPU_FOREACH(cpu) {
27683974cf4SEmilio G. Cota         CPUArchState *env = cpu->env_ptr;
27783974cf4SEmilio G. Cota 
278a40ec84eSRichard Henderson         full += atomic_read(&env_tlb(env)->c.full_flush_count);
279a40ec84eSRichard Henderson         part += atomic_read(&env_tlb(env)->c.part_flush_count);
280a40ec84eSRichard Henderson         elide += atomic_read(&env_tlb(env)->c.elide_flush_count);
28183974cf4SEmilio G. Cota     }
282e09de0a2SRichard Henderson     *pfull = full;
283e09de0a2SRichard Henderson     *ppart = part;
284e09de0a2SRichard Henderson     *pelide = elide;
28583974cf4SEmilio G. Cota }
286d9bb58e5SYang Zhong 
2871308e026SRichard Henderson static void tlb_flush_one_mmuidx_locked(CPUArchState *env, int mmu_idx)
2881308e026SRichard Henderson {
28986e1eff8SEmilio G. Cota     tlb_table_flush_by_mmuidx(env, mmu_idx);
290a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].large_page_addr = -1;
291a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].large_page_mask = -1;
292a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].vindex = 0;
293a40ec84eSRichard Henderson     memset(env_tlb(env)->d[mmu_idx].vtable, -1,
294a40ec84eSRichard Henderson            sizeof(env_tlb(env)->d[0].vtable));
2951308e026SRichard Henderson }
2961308e026SRichard Henderson 
297d9bb58e5SYang Zhong static void tlb_flush_by_mmuidx_async_work(CPUState *cpu, run_on_cpu_data data)
298d9bb58e5SYang Zhong {
299d9bb58e5SYang Zhong     CPUArchState *env = cpu->env_ptr;
3003d1523ceSRichard Henderson     uint16_t asked = data.host_int;
3013d1523ceSRichard Henderson     uint16_t all_dirty, work, to_clean;
302d9bb58e5SYang Zhong 
303d9bb58e5SYang Zhong     assert_cpu_is_self(cpu);
304d9bb58e5SYang Zhong 
3053d1523ceSRichard Henderson     tlb_debug("mmu_idx:0x%04" PRIx16 "\n", asked);
306d9bb58e5SYang Zhong 
307a40ec84eSRichard Henderson     qemu_spin_lock(&env_tlb(env)->c.lock);
30860a2ad7dSRichard Henderson 
309a40ec84eSRichard Henderson     all_dirty = env_tlb(env)->c.dirty;
3103d1523ceSRichard Henderson     to_clean = asked & all_dirty;
3113d1523ceSRichard Henderson     all_dirty &= ~to_clean;
312a40ec84eSRichard Henderson     env_tlb(env)->c.dirty = all_dirty;
3133d1523ceSRichard Henderson 
3143d1523ceSRichard Henderson     for (work = to_clean; work != 0; work &= work - 1) {
3153d1523ceSRichard Henderson         int mmu_idx = ctz32(work);
3161308e026SRichard Henderson         tlb_flush_one_mmuidx_locked(env, mmu_idx);
317d9bb58e5SYang Zhong     }
3183d1523ceSRichard Henderson 
319a40ec84eSRichard Henderson     qemu_spin_unlock(&env_tlb(env)->c.lock);
320d9bb58e5SYang Zhong 
321f3ced3c5SEmilio G. Cota     cpu_tb_jmp_cache_clear(cpu);
32264f2674bSRichard Henderson 
3233d1523ceSRichard Henderson     if (to_clean == ALL_MMUIDX_BITS) {
324a40ec84eSRichard Henderson         atomic_set(&env_tlb(env)->c.full_flush_count,
325a40ec84eSRichard Henderson                    env_tlb(env)->c.full_flush_count + 1);
326e09de0a2SRichard Henderson     } else {
327a40ec84eSRichard Henderson         atomic_set(&env_tlb(env)->c.part_flush_count,
328a40ec84eSRichard Henderson                    env_tlb(env)->c.part_flush_count + ctpop16(to_clean));
3293d1523ceSRichard Henderson         if (to_clean != asked) {
330a40ec84eSRichard Henderson             atomic_set(&env_tlb(env)->c.elide_flush_count,
331a40ec84eSRichard Henderson                        env_tlb(env)->c.elide_flush_count +
3323d1523ceSRichard Henderson                        ctpop16(asked & ~to_clean));
3333d1523ceSRichard Henderson         }
33464f2674bSRichard Henderson     }
335d9bb58e5SYang Zhong }
336d9bb58e5SYang Zhong 
337d9bb58e5SYang Zhong void tlb_flush_by_mmuidx(CPUState *cpu, uint16_t idxmap)
338d9bb58e5SYang Zhong {
339d9bb58e5SYang Zhong     tlb_debug("mmu_idx: 0x%" PRIx16 "\n", idxmap);
340d9bb58e5SYang Zhong 
34164f2674bSRichard Henderson     if (cpu->created && !qemu_cpu_is_self(cpu)) {
342d9bb58e5SYang Zhong         async_run_on_cpu(cpu, tlb_flush_by_mmuidx_async_work,
343ab651105SRichard Henderson                          RUN_ON_CPU_HOST_INT(idxmap));
344d9bb58e5SYang Zhong     } else {
34560a2ad7dSRichard Henderson         tlb_flush_by_mmuidx_async_work(cpu, RUN_ON_CPU_HOST_INT(idxmap));
346d9bb58e5SYang Zhong     }
347d9bb58e5SYang Zhong }
348d9bb58e5SYang Zhong 
34964f2674bSRichard Henderson void tlb_flush(CPUState *cpu)
35064f2674bSRichard Henderson {
35164f2674bSRichard Henderson     tlb_flush_by_mmuidx(cpu, ALL_MMUIDX_BITS);
35264f2674bSRichard Henderson }
35364f2674bSRichard Henderson 
354d9bb58e5SYang Zhong void tlb_flush_by_mmuidx_all_cpus(CPUState *src_cpu, uint16_t idxmap)
355d9bb58e5SYang Zhong {
356d9bb58e5SYang Zhong     const run_on_cpu_func fn = tlb_flush_by_mmuidx_async_work;
357d9bb58e5SYang Zhong 
358d9bb58e5SYang Zhong     tlb_debug("mmu_idx: 0x%"PRIx16"\n", idxmap);
359d9bb58e5SYang Zhong 
360d9bb58e5SYang Zhong     flush_all_helper(src_cpu, fn, RUN_ON_CPU_HOST_INT(idxmap));
361d9bb58e5SYang Zhong     fn(src_cpu, RUN_ON_CPU_HOST_INT(idxmap));
362d9bb58e5SYang Zhong }
363d9bb58e5SYang Zhong 
36464f2674bSRichard Henderson void tlb_flush_all_cpus(CPUState *src_cpu)
36564f2674bSRichard Henderson {
36664f2674bSRichard Henderson     tlb_flush_by_mmuidx_all_cpus(src_cpu, ALL_MMUIDX_BITS);
36764f2674bSRichard Henderson }
36864f2674bSRichard Henderson 
36964f2674bSRichard Henderson void tlb_flush_by_mmuidx_all_cpus_synced(CPUState *src_cpu, uint16_t idxmap)
370d9bb58e5SYang Zhong {
371d9bb58e5SYang Zhong     const run_on_cpu_func fn = tlb_flush_by_mmuidx_async_work;
372d9bb58e5SYang Zhong 
373d9bb58e5SYang Zhong     tlb_debug("mmu_idx: 0x%"PRIx16"\n", idxmap);
374d9bb58e5SYang Zhong 
375d9bb58e5SYang Zhong     flush_all_helper(src_cpu, fn, RUN_ON_CPU_HOST_INT(idxmap));
376d9bb58e5SYang Zhong     async_safe_run_on_cpu(src_cpu, fn, RUN_ON_CPU_HOST_INT(idxmap));
377d9bb58e5SYang Zhong }
378d9bb58e5SYang Zhong 
37964f2674bSRichard Henderson void tlb_flush_all_cpus_synced(CPUState *src_cpu)
38064f2674bSRichard Henderson {
38164f2674bSRichard Henderson     tlb_flush_by_mmuidx_all_cpus_synced(src_cpu, ALL_MMUIDX_BITS);
38264f2674bSRichard Henderson }
38364f2674bSRichard Henderson 
38468fea038SRichard Henderson static inline bool tlb_hit_page_anyprot(CPUTLBEntry *tlb_entry,
38568fea038SRichard Henderson                                         target_ulong page)
386d9bb58e5SYang Zhong {
38768fea038SRichard Henderson     return tlb_hit_page(tlb_entry->addr_read, page) ||
388403f290cSEmilio G. Cota            tlb_hit_page(tlb_addr_write(tlb_entry), page) ||
38968fea038SRichard Henderson            tlb_hit_page(tlb_entry->addr_code, page);
39068fea038SRichard Henderson }
39168fea038SRichard Henderson 
3923cea94bbSEmilio G. Cota /**
3933cea94bbSEmilio G. Cota  * tlb_entry_is_empty - return true if the entry is not in use
3943cea94bbSEmilio G. Cota  * @te: pointer to CPUTLBEntry
3953cea94bbSEmilio G. Cota  */
3963cea94bbSEmilio G. Cota static inline bool tlb_entry_is_empty(const CPUTLBEntry *te)
3973cea94bbSEmilio G. Cota {
3983cea94bbSEmilio G. Cota     return te->addr_read == -1 && te->addr_write == -1 && te->addr_code == -1;
3993cea94bbSEmilio G. Cota }
4003cea94bbSEmilio G. Cota 
40153d28455SRichard Henderson /* Called with tlb_c.lock held */
40286e1eff8SEmilio G. Cota static inline bool tlb_flush_entry_locked(CPUTLBEntry *tlb_entry,
40371aec354SEmilio G. Cota                                           target_ulong page)
40468fea038SRichard Henderson {
40568fea038SRichard Henderson     if (tlb_hit_page_anyprot(tlb_entry, page)) {
406d9bb58e5SYang Zhong         memset(tlb_entry, -1, sizeof(*tlb_entry));
40786e1eff8SEmilio G. Cota         return true;
408d9bb58e5SYang Zhong     }
40986e1eff8SEmilio G. Cota     return false;
410d9bb58e5SYang Zhong }
411d9bb58e5SYang Zhong 
41253d28455SRichard Henderson /* Called with tlb_c.lock held */
41371aec354SEmilio G. Cota static inline void tlb_flush_vtlb_page_locked(CPUArchState *env, int mmu_idx,
41468fea038SRichard Henderson                                               target_ulong page)
41568fea038SRichard Henderson {
416a40ec84eSRichard Henderson     CPUTLBDesc *d = &env_tlb(env)->d[mmu_idx];
41768fea038SRichard Henderson     int k;
41871aec354SEmilio G. Cota 
41929a0af61SRichard Henderson     assert_cpu_is_self(env_cpu(env));
42068fea038SRichard Henderson     for (k = 0; k < CPU_VTLB_SIZE; k++) {
421a40ec84eSRichard Henderson         if (tlb_flush_entry_locked(&d->vtable[k], page)) {
42286e1eff8SEmilio G. Cota             tlb_n_used_entries_dec(env, mmu_idx);
42386e1eff8SEmilio G. Cota         }
42468fea038SRichard Henderson     }
42568fea038SRichard Henderson }
42668fea038SRichard Henderson 
4271308e026SRichard Henderson static void tlb_flush_page_locked(CPUArchState *env, int midx,
4281308e026SRichard Henderson                                   target_ulong page)
4291308e026SRichard Henderson {
430a40ec84eSRichard Henderson     target_ulong lp_addr = env_tlb(env)->d[midx].large_page_addr;
431a40ec84eSRichard Henderson     target_ulong lp_mask = env_tlb(env)->d[midx].large_page_mask;
4321308e026SRichard Henderson 
4331308e026SRichard Henderson     /* Check if we need to flush due to large pages.  */
4341308e026SRichard Henderson     if ((page & lp_mask) == lp_addr) {
4351308e026SRichard Henderson         tlb_debug("forcing full flush midx %d ("
4361308e026SRichard Henderson                   TARGET_FMT_lx "/" TARGET_FMT_lx ")\n",
4371308e026SRichard Henderson                   midx, lp_addr, lp_mask);
4381308e026SRichard Henderson         tlb_flush_one_mmuidx_locked(env, midx);
4391308e026SRichard Henderson     } else {
44086e1eff8SEmilio G. Cota         if (tlb_flush_entry_locked(tlb_entry(env, midx, page), page)) {
44186e1eff8SEmilio G. Cota             tlb_n_used_entries_dec(env, midx);
44286e1eff8SEmilio G. Cota         }
4431308e026SRichard Henderson         tlb_flush_vtlb_page_locked(env, midx, page);
4441308e026SRichard Henderson     }
4451308e026SRichard Henderson }
4461308e026SRichard Henderson 
447d9bb58e5SYang Zhong /* As we are going to hijack the bottom bits of the page address for a
448d9bb58e5SYang Zhong  * mmuidx bit mask we need to fail to build if we can't do that
449d9bb58e5SYang Zhong  */
450d9bb58e5SYang Zhong QEMU_BUILD_BUG_ON(NB_MMU_MODES > TARGET_PAGE_BITS_MIN);
451d9bb58e5SYang Zhong 
452d9bb58e5SYang Zhong static void tlb_flush_page_by_mmuidx_async_work(CPUState *cpu,
453d9bb58e5SYang Zhong                                                 run_on_cpu_data data)
454d9bb58e5SYang Zhong {
455d9bb58e5SYang Zhong     CPUArchState *env = cpu->env_ptr;
456d9bb58e5SYang Zhong     target_ulong addr_and_mmuidx = (target_ulong) data.target_ptr;
457d9bb58e5SYang Zhong     target_ulong addr = addr_and_mmuidx & TARGET_PAGE_MASK;
458d9bb58e5SYang Zhong     unsigned long mmu_idx_bitmap = addr_and_mmuidx & ALL_MMUIDX_BITS;
459d9bb58e5SYang Zhong     int mmu_idx;
460d9bb58e5SYang Zhong 
461d9bb58e5SYang Zhong     assert_cpu_is_self(cpu);
462d9bb58e5SYang Zhong 
4631308e026SRichard Henderson     tlb_debug("page addr:" TARGET_FMT_lx " mmu_map:0x%lx\n",
464383beda9SRichard Henderson               addr, mmu_idx_bitmap);
465d9bb58e5SYang Zhong 
466a40ec84eSRichard Henderson     qemu_spin_lock(&env_tlb(env)->c.lock);
467d9bb58e5SYang Zhong     for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++) {
468d9bb58e5SYang Zhong         if (test_bit(mmu_idx, &mmu_idx_bitmap)) {
4691308e026SRichard Henderson             tlb_flush_page_locked(env, mmu_idx, addr);
470d9bb58e5SYang Zhong         }
471d9bb58e5SYang Zhong     }
472a40ec84eSRichard Henderson     qemu_spin_unlock(&env_tlb(env)->c.lock);
473d9bb58e5SYang Zhong 
474d9bb58e5SYang Zhong     tb_flush_jmp_cache(cpu, addr);
475d9bb58e5SYang Zhong }
476d9bb58e5SYang Zhong 
477d9bb58e5SYang Zhong void tlb_flush_page_by_mmuidx(CPUState *cpu, target_ulong addr, uint16_t idxmap)
478d9bb58e5SYang Zhong {
479d9bb58e5SYang Zhong     target_ulong addr_and_mmu_idx;
480d9bb58e5SYang Zhong 
481d9bb58e5SYang Zhong     tlb_debug("addr: "TARGET_FMT_lx" mmu_idx:%" PRIx16 "\n", addr, idxmap);
482d9bb58e5SYang Zhong 
483d9bb58e5SYang Zhong     /* This should already be page aligned */
484d9bb58e5SYang Zhong     addr_and_mmu_idx = addr & TARGET_PAGE_MASK;
485d9bb58e5SYang Zhong     addr_and_mmu_idx |= idxmap;
486d9bb58e5SYang Zhong 
487d9bb58e5SYang Zhong     if (!qemu_cpu_is_self(cpu)) {
4881308e026SRichard Henderson         async_run_on_cpu(cpu, tlb_flush_page_by_mmuidx_async_work,
489d9bb58e5SYang Zhong                          RUN_ON_CPU_TARGET_PTR(addr_and_mmu_idx));
490d9bb58e5SYang Zhong     } else {
4911308e026SRichard Henderson         tlb_flush_page_by_mmuidx_async_work(
492d9bb58e5SYang Zhong             cpu, RUN_ON_CPU_TARGET_PTR(addr_and_mmu_idx));
493d9bb58e5SYang Zhong     }
494d9bb58e5SYang Zhong }
495d9bb58e5SYang Zhong 
496f8144c6cSRichard Henderson void tlb_flush_page(CPUState *cpu, target_ulong addr)
497f8144c6cSRichard Henderson {
498f8144c6cSRichard Henderson     tlb_flush_page_by_mmuidx(cpu, addr, ALL_MMUIDX_BITS);
499f8144c6cSRichard Henderson }
500f8144c6cSRichard Henderson 
501d9bb58e5SYang Zhong void tlb_flush_page_by_mmuidx_all_cpus(CPUState *src_cpu, target_ulong addr,
502d9bb58e5SYang Zhong                                        uint16_t idxmap)
503d9bb58e5SYang Zhong {
5041308e026SRichard Henderson     const run_on_cpu_func fn = tlb_flush_page_by_mmuidx_async_work;
505d9bb58e5SYang Zhong     target_ulong addr_and_mmu_idx;
506d9bb58e5SYang Zhong 
507d9bb58e5SYang Zhong     tlb_debug("addr: "TARGET_FMT_lx" mmu_idx:%"PRIx16"\n", addr, idxmap);
508d9bb58e5SYang Zhong 
509d9bb58e5SYang Zhong     /* This should already be page aligned */
510d9bb58e5SYang Zhong     addr_and_mmu_idx = addr & TARGET_PAGE_MASK;
511d9bb58e5SYang Zhong     addr_and_mmu_idx |= idxmap;
512d9bb58e5SYang Zhong 
513d9bb58e5SYang Zhong     flush_all_helper(src_cpu, fn, RUN_ON_CPU_TARGET_PTR(addr_and_mmu_idx));
514d9bb58e5SYang Zhong     fn(src_cpu, RUN_ON_CPU_TARGET_PTR(addr_and_mmu_idx));
515d9bb58e5SYang Zhong }
516d9bb58e5SYang Zhong 
517f8144c6cSRichard Henderson void tlb_flush_page_all_cpus(CPUState *src, target_ulong addr)
518f8144c6cSRichard Henderson {
519f8144c6cSRichard Henderson     tlb_flush_page_by_mmuidx_all_cpus(src, addr, ALL_MMUIDX_BITS);
520f8144c6cSRichard Henderson }
521f8144c6cSRichard Henderson 
522d9bb58e5SYang Zhong void tlb_flush_page_by_mmuidx_all_cpus_synced(CPUState *src_cpu,
523d9bb58e5SYang Zhong                                               target_ulong addr,
524d9bb58e5SYang Zhong                                               uint16_t idxmap)
525d9bb58e5SYang Zhong {
5261308e026SRichard Henderson     const run_on_cpu_func fn = tlb_flush_page_by_mmuidx_async_work;
527d9bb58e5SYang Zhong     target_ulong addr_and_mmu_idx;
528d9bb58e5SYang Zhong 
529d9bb58e5SYang Zhong     tlb_debug("addr: "TARGET_FMT_lx" mmu_idx:%"PRIx16"\n", addr, idxmap);
530d9bb58e5SYang Zhong 
531d9bb58e5SYang Zhong     /* This should already be page aligned */
532d9bb58e5SYang Zhong     addr_and_mmu_idx = addr & TARGET_PAGE_MASK;
533d9bb58e5SYang Zhong     addr_and_mmu_idx |= idxmap;
534d9bb58e5SYang Zhong 
535d9bb58e5SYang Zhong     flush_all_helper(src_cpu, fn, RUN_ON_CPU_TARGET_PTR(addr_and_mmu_idx));
536d9bb58e5SYang Zhong     async_safe_run_on_cpu(src_cpu, fn, RUN_ON_CPU_TARGET_PTR(addr_and_mmu_idx));
537d9bb58e5SYang Zhong }
538d9bb58e5SYang Zhong 
539f8144c6cSRichard Henderson void tlb_flush_page_all_cpus_synced(CPUState *src, target_ulong addr)
540d9bb58e5SYang Zhong {
541f8144c6cSRichard Henderson     tlb_flush_page_by_mmuidx_all_cpus_synced(src, addr, ALL_MMUIDX_BITS);
542d9bb58e5SYang Zhong }
543d9bb58e5SYang Zhong 
544d9bb58e5SYang Zhong /* update the TLBs so that writes to code in the virtual page 'addr'
545d9bb58e5SYang Zhong    can be detected */
546d9bb58e5SYang Zhong void tlb_protect_code(ram_addr_t ram_addr)
547d9bb58e5SYang Zhong {
548d9bb58e5SYang Zhong     cpu_physical_memory_test_and_clear_dirty(ram_addr, TARGET_PAGE_SIZE,
549d9bb58e5SYang Zhong                                              DIRTY_MEMORY_CODE);
550d9bb58e5SYang Zhong }
551d9bb58e5SYang Zhong 
552d9bb58e5SYang Zhong /* update the TLB so that writes in physical page 'phys_addr' are no longer
553d9bb58e5SYang Zhong    tested for self modifying code */
554d9bb58e5SYang Zhong void tlb_unprotect_code(ram_addr_t ram_addr)
555d9bb58e5SYang Zhong {
556d9bb58e5SYang Zhong     cpu_physical_memory_set_dirty_flag(ram_addr, DIRTY_MEMORY_CODE);
557d9bb58e5SYang Zhong }
558d9bb58e5SYang Zhong 
559d9bb58e5SYang Zhong 
560d9bb58e5SYang Zhong /*
561d9bb58e5SYang Zhong  * Dirty write flag handling
562d9bb58e5SYang Zhong  *
563d9bb58e5SYang Zhong  * When the TCG code writes to a location it looks up the address in
564d9bb58e5SYang Zhong  * the TLB and uses that data to compute the final address. If any of
565d9bb58e5SYang Zhong  * the lower bits of the address are set then the slow path is forced.
566d9bb58e5SYang Zhong  * There are a number of reasons to do this but for normal RAM the
567d9bb58e5SYang Zhong  * most usual is detecting writes to code regions which may invalidate
568d9bb58e5SYang Zhong  * generated code.
569d9bb58e5SYang Zhong  *
57071aec354SEmilio G. Cota  * Other vCPUs might be reading their TLBs during guest execution, so we update
57171aec354SEmilio G. Cota  * te->addr_write with atomic_set. We don't need to worry about this for
57271aec354SEmilio G. Cota  * oversized guests as MTTCG is disabled for them.
573d9bb58e5SYang Zhong  *
57453d28455SRichard Henderson  * Called with tlb_c.lock held.
575d9bb58e5SYang Zhong  */
57671aec354SEmilio G. Cota static void tlb_reset_dirty_range_locked(CPUTLBEntry *tlb_entry,
57771aec354SEmilio G. Cota                                          uintptr_t start, uintptr_t length)
578d9bb58e5SYang Zhong {
579d9bb58e5SYang Zhong     uintptr_t addr = tlb_entry->addr_write;
580d9bb58e5SYang Zhong 
5817b0d792cSRichard Henderson     if ((addr & (TLB_INVALID_MASK | TLB_MMIO |
5827b0d792cSRichard Henderson                  TLB_DISCARD_WRITE | TLB_NOTDIRTY)) == 0) {
583d9bb58e5SYang Zhong         addr &= TARGET_PAGE_MASK;
584d9bb58e5SYang Zhong         addr += tlb_entry->addend;
585d9bb58e5SYang Zhong         if ((addr - start) < length) {
586d9bb58e5SYang Zhong #if TCG_OVERSIZED_GUEST
58771aec354SEmilio G. Cota             tlb_entry->addr_write |= TLB_NOTDIRTY;
588d9bb58e5SYang Zhong #else
58971aec354SEmilio G. Cota             atomic_set(&tlb_entry->addr_write,
59071aec354SEmilio G. Cota                        tlb_entry->addr_write | TLB_NOTDIRTY);
591d9bb58e5SYang Zhong #endif
592d9bb58e5SYang Zhong         }
59371aec354SEmilio G. Cota     }
59471aec354SEmilio G. Cota }
59571aec354SEmilio G. Cota 
59671aec354SEmilio G. Cota /*
59753d28455SRichard Henderson  * Called with tlb_c.lock held.
59871aec354SEmilio G. Cota  * Called only from the vCPU context, i.e. the TLB's owner thread.
59971aec354SEmilio G. Cota  */
60071aec354SEmilio G. Cota static inline void copy_tlb_helper_locked(CPUTLBEntry *d, const CPUTLBEntry *s)
60171aec354SEmilio G. Cota {
60271aec354SEmilio G. Cota     *d = *s;
60371aec354SEmilio G. Cota }
604d9bb58e5SYang Zhong 
605d9bb58e5SYang Zhong /* This is a cross vCPU call (i.e. another vCPU resetting the flags of
60671aec354SEmilio G. Cota  * the target vCPU).
60753d28455SRichard Henderson  * We must take tlb_c.lock to avoid racing with another vCPU update. The only
60871aec354SEmilio G. Cota  * thing actually updated is the target TLB entry ->addr_write flags.
609d9bb58e5SYang Zhong  */
610d9bb58e5SYang Zhong void tlb_reset_dirty(CPUState *cpu, ram_addr_t start1, ram_addr_t length)
611d9bb58e5SYang Zhong {
612d9bb58e5SYang Zhong     CPUArchState *env;
613d9bb58e5SYang Zhong 
614d9bb58e5SYang Zhong     int mmu_idx;
615d9bb58e5SYang Zhong 
616d9bb58e5SYang Zhong     env = cpu->env_ptr;
617a40ec84eSRichard Henderson     qemu_spin_lock(&env_tlb(env)->c.lock);
618d9bb58e5SYang Zhong     for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++) {
619d9bb58e5SYang Zhong         unsigned int i;
62086e1eff8SEmilio G. Cota         unsigned int n = tlb_n_entries(env, mmu_idx);
621d9bb58e5SYang Zhong 
62286e1eff8SEmilio G. Cota         for (i = 0; i < n; i++) {
623a40ec84eSRichard Henderson             tlb_reset_dirty_range_locked(&env_tlb(env)->f[mmu_idx].table[i],
624a40ec84eSRichard Henderson                                          start1, length);
625d9bb58e5SYang Zhong         }
626d9bb58e5SYang Zhong 
627d9bb58e5SYang Zhong         for (i = 0; i < CPU_VTLB_SIZE; i++) {
628a40ec84eSRichard Henderson             tlb_reset_dirty_range_locked(&env_tlb(env)->d[mmu_idx].vtable[i],
629a40ec84eSRichard Henderson                                          start1, length);
630d9bb58e5SYang Zhong         }
631d9bb58e5SYang Zhong     }
632a40ec84eSRichard Henderson     qemu_spin_unlock(&env_tlb(env)->c.lock);
633d9bb58e5SYang Zhong }
634d9bb58e5SYang Zhong 
63553d28455SRichard Henderson /* Called with tlb_c.lock held */
63671aec354SEmilio G. Cota static inline void tlb_set_dirty1_locked(CPUTLBEntry *tlb_entry,
63771aec354SEmilio G. Cota                                          target_ulong vaddr)
638d9bb58e5SYang Zhong {
639d9bb58e5SYang Zhong     if (tlb_entry->addr_write == (vaddr | TLB_NOTDIRTY)) {
640d9bb58e5SYang Zhong         tlb_entry->addr_write = vaddr;
641d9bb58e5SYang Zhong     }
642d9bb58e5SYang Zhong }
643d9bb58e5SYang Zhong 
644d9bb58e5SYang Zhong /* update the TLB corresponding to virtual page vaddr
645d9bb58e5SYang Zhong    so that it is no longer dirty */
646d9bb58e5SYang Zhong void tlb_set_dirty(CPUState *cpu, target_ulong vaddr)
647d9bb58e5SYang Zhong {
648d9bb58e5SYang Zhong     CPUArchState *env = cpu->env_ptr;
649d9bb58e5SYang Zhong     int mmu_idx;
650d9bb58e5SYang Zhong 
651d9bb58e5SYang Zhong     assert_cpu_is_self(cpu);
652d9bb58e5SYang Zhong 
653d9bb58e5SYang Zhong     vaddr &= TARGET_PAGE_MASK;
654a40ec84eSRichard Henderson     qemu_spin_lock(&env_tlb(env)->c.lock);
655d9bb58e5SYang Zhong     for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++) {
656383beda9SRichard Henderson         tlb_set_dirty1_locked(tlb_entry(env, mmu_idx, vaddr), vaddr);
657d9bb58e5SYang Zhong     }
658d9bb58e5SYang Zhong 
659d9bb58e5SYang Zhong     for (mmu_idx = 0; mmu_idx < NB_MMU_MODES; mmu_idx++) {
660d9bb58e5SYang Zhong         int k;
661d9bb58e5SYang Zhong         for (k = 0; k < CPU_VTLB_SIZE; k++) {
662a40ec84eSRichard Henderson             tlb_set_dirty1_locked(&env_tlb(env)->d[mmu_idx].vtable[k], vaddr);
663d9bb58e5SYang Zhong         }
664d9bb58e5SYang Zhong     }
665a40ec84eSRichard Henderson     qemu_spin_unlock(&env_tlb(env)->c.lock);
666d9bb58e5SYang Zhong }
667d9bb58e5SYang Zhong 
668d9bb58e5SYang Zhong /* Our TLB does not support large pages, so remember the area covered by
669d9bb58e5SYang Zhong    large pages and trigger a full TLB flush if these are invalidated.  */
6701308e026SRichard Henderson static void tlb_add_large_page(CPUArchState *env, int mmu_idx,
6711308e026SRichard Henderson                                target_ulong vaddr, target_ulong size)
672d9bb58e5SYang Zhong {
673a40ec84eSRichard Henderson     target_ulong lp_addr = env_tlb(env)->d[mmu_idx].large_page_addr;
6741308e026SRichard Henderson     target_ulong lp_mask = ~(size - 1);
675d9bb58e5SYang Zhong 
6761308e026SRichard Henderson     if (lp_addr == (target_ulong)-1) {
6771308e026SRichard Henderson         /* No previous large page.  */
6781308e026SRichard Henderson         lp_addr = vaddr;
6791308e026SRichard Henderson     } else {
680d9bb58e5SYang Zhong         /* Extend the existing region to include the new page.
6811308e026SRichard Henderson            This is a compromise between unnecessary flushes and
6821308e026SRichard Henderson            the cost of maintaining a full variable size TLB.  */
683a40ec84eSRichard Henderson         lp_mask &= env_tlb(env)->d[mmu_idx].large_page_mask;
6841308e026SRichard Henderson         while (((lp_addr ^ vaddr) & lp_mask) != 0) {
6851308e026SRichard Henderson             lp_mask <<= 1;
686d9bb58e5SYang Zhong         }
6871308e026SRichard Henderson     }
688a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].large_page_addr = lp_addr & lp_mask;
689a40ec84eSRichard Henderson     env_tlb(env)->d[mmu_idx].large_page_mask = lp_mask;
690d9bb58e5SYang Zhong }
691d9bb58e5SYang Zhong 
692d9bb58e5SYang Zhong /* Add a new TLB entry. At most one entry for a given virtual address
693d9bb58e5SYang Zhong  * is permitted. Only a single TARGET_PAGE_SIZE region is mapped, the
694d9bb58e5SYang Zhong  * supplied size is only used by tlb_flush_page.
695d9bb58e5SYang Zhong  *
696d9bb58e5SYang Zhong  * Called from TCG-generated code, which is under an RCU read-side
697d9bb58e5SYang Zhong  * critical section.
698d9bb58e5SYang Zhong  */
699d9bb58e5SYang Zhong void tlb_set_page_with_attrs(CPUState *cpu, target_ulong vaddr,
700d9bb58e5SYang Zhong                              hwaddr paddr, MemTxAttrs attrs, int prot,
701d9bb58e5SYang Zhong                              int mmu_idx, target_ulong size)
702d9bb58e5SYang Zhong {
703d9bb58e5SYang Zhong     CPUArchState *env = cpu->env_ptr;
704a40ec84eSRichard Henderson     CPUTLB *tlb = env_tlb(env);
705a40ec84eSRichard Henderson     CPUTLBDesc *desc = &tlb->d[mmu_idx];
706d9bb58e5SYang Zhong     MemoryRegionSection *section;
707d9bb58e5SYang Zhong     unsigned int index;
708d9bb58e5SYang Zhong     target_ulong address;
7098f5db641SRichard Henderson     target_ulong write_address;
710d9bb58e5SYang Zhong     uintptr_t addend;
71168fea038SRichard Henderson     CPUTLBEntry *te, tn;
71255df6fcfSPeter Maydell     hwaddr iotlb, xlat, sz, paddr_page;
71355df6fcfSPeter Maydell     target_ulong vaddr_page;
714d9bb58e5SYang Zhong     int asidx = cpu_asidx_from_attrs(cpu, attrs);
71550b107c5SRichard Henderson     int wp_flags;
7168f5db641SRichard Henderson     bool is_ram, is_romd;
717d9bb58e5SYang Zhong 
718d9bb58e5SYang Zhong     assert_cpu_is_self(cpu);
71955df6fcfSPeter Maydell 
7201308e026SRichard Henderson     if (size <= TARGET_PAGE_SIZE) {
72155df6fcfSPeter Maydell         sz = TARGET_PAGE_SIZE;
72255df6fcfSPeter Maydell     } else {
7231308e026SRichard Henderson         tlb_add_large_page(env, mmu_idx, vaddr, size);
724d9bb58e5SYang Zhong         sz = size;
72555df6fcfSPeter Maydell     }
72655df6fcfSPeter Maydell     vaddr_page = vaddr & TARGET_PAGE_MASK;
72755df6fcfSPeter Maydell     paddr_page = paddr & TARGET_PAGE_MASK;
72855df6fcfSPeter Maydell 
72955df6fcfSPeter Maydell     section = address_space_translate_for_iotlb(cpu, asidx, paddr_page,
73055df6fcfSPeter Maydell                                                 &xlat, &sz, attrs, &prot);
731d9bb58e5SYang Zhong     assert(sz >= TARGET_PAGE_SIZE);
732d9bb58e5SYang Zhong 
733d9bb58e5SYang Zhong     tlb_debug("vaddr=" TARGET_FMT_lx " paddr=0x" TARGET_FMT_plx
734d9bb58e5SYang Zhong               " prot=%x idx=%d\n",
735d9bb58e5SYang Zhong               vaddr, paddr, prot, mmu_idx);
736d9bb58e5SYang Zhong 
73755df6fcfSPeter Maydell     address = vaddr_page;
73855df6fcfSPeter Maydell     if (size < TARGET_PAGE_SIZE) {
73930d7e098SRichard Henderson         /* Repeat the MMU check and TLB fill on every access.  */
74030d7e098SRichard Henderson         address |= TLB_INVALID_MASK;
74155df6fcfSPeter Maydell     }
742a26fc6f5STony Nguyen     if (attrs.byte_swap) {
7435b87b3e6SRichard Henderson         address |= TLB_BSWAP;
744a26fc6f5STony Nguyen     }
7458f5db641SRichard Henderson 
7468f5db641SRichard Henderson     is_ram = memory_region_is_ram(section->mr);
7478f5db641SRichard Henderson     is_romd = memory_region_is_romd(section->mr);
7488f5db641SRichard Henderson 
7498f5db641SRichard Henderson     if (is_ram || is_romd) {
7508f5db641SRichard Henderson         /* RAM and ROMD both have associated host memory. */
751d9bb58e5SYang Zhong         addend = (uintptr_t)memory_region_get_ram_ptr(section->mr) + xlat;
7528f5db641SRichard Henderson     } else {
7538f5db641SRichard Henderson         /* I/O does not; force the host address to NULL. */
7548f5db641SRichard Henderson         addend = 0;
755d9bb58e5SYang Zhong     }
756d9bb58e5SYang Zhong 
7578f5db641SRichard Henderson     write_address = address;
7588f5db641SRichard Henderson     if (is_ram) {
7598f5db641SRichard Henderson         iotlb = memory_region_get_ram_addr(section->mr) + xlat;
7608f5db641SRichard Henderson         /*
7618f5db641SRichard Henderson          * Computing is_clean is expensive; avoid all that unless
7628f5db641SRichard Henderson          * the page is actually writable.
7638f5db641SRichard Henderson          */
7648f5db641SRichard Henderson         if (prot & PAGE_WRITE) {
7658f5db641SRichard Henderson             if (section->readonly) {
7668f5db641SRichard Henderson                 write_address |= TLB_DISCARD_WRITE;
7678f5db641SRichard Henderson             } else if (cpu_physical_memory_is_clean(iotlb)) {
7688f5db641SRichard Henderson                 write_address |= TLB_NOTDIRTY;
7698f5db641SRichard Henderson             }
7708f5db641SRichard Henderson         }
7718f5db641SRichard Henderson     } else {
7728f5db641SRichard Henderson         /* I/O or ROMD */
7738f5db641SRichard Henderson         iotlb = memory_region_section_get_iotlb(cpu, section) + xlat;
7748f5db641SRichard Henderson         /*
7758f5db641SRichard Henderson          * Writes to romd devices must go through MMIO to enable write.
7768f5db641SRichard Henderson          * Reads to romd devices go through the ram_ptr found above,
7778f5db641SRichard Henderson          * but of course reads to I/O must go through MMIO.
7788f5db641SRichard Henderson          */
7798f5db641SRichard Henderson         write_address |= TLB_MMIO;
7808f5db641SRichard Henderson         if (!is_romd) {
7818f5db641SRichard Henderson             address = write_address;
7828f5db641SRichard Henderson         }
7838f5db641SRichard Henderson     }
7848f5db641SRichard Henderson 
78550b107c5SRichard Henderson     wp_flags = cpu_watchpoint_address_matches(cpu, vaddr_page,
78650b107c5SRichard Henderson                                               TARGET_PAGE_SIZE);
787d9bb58e5SYang Zhong 
788383beda9SRichard Henderson     index = tlb_index(env, mmu_idx, vaddr_page);
789383beda9SRichard Henderson     te = tlb_entry(env, mmu_idx, vaddr_page);
790d9bb58e5SYang Zhong 
79168fea038SRichard Henderson     /*
79271aec354SEmilio G. Cota      * Hold the TLB lock for the rest of the function. We could acquire/release
79371aec354SEmilio G. Cota      * the lock several times in the function, but it is faster to amortize the
79471aec354SEmilio G. Cota      * acquisition cost by acquiring it just once. Note that this leads to
79571aec354SEmilio G. Cota      * a longer critical section, but this is not a concern since the TLB lock
79671aec354SEmilio G. Cota      * is unlikely to be contended.
79771aec354SEmilio G. Cota      */
798a40ec84eSRichard Henderson     qemu_spin_lock(&tlb->c.lock);
79971aec354SEmilio G. Cota 
8003d1523ceSRichard Henderson     /* Note that the tlb is no longer clean.  */
801a40ec84eSRichard Henderson     tlb->c.dirty |= 1 << mmu_idx;
8023d1523ceSRichard Henderson 
80371aec354SEmilio G. Cota     /* Make sure there's no cached translation for the new page.  */
80471aec354SEmilio G. Cota     tlb_flush_vtlb_page_locked(env, mmu_idx, vaddr_page);
80571aec354SEmilio G. Cota 
80671aec354SEmilio G. Cota     /*
80768fea038SRichard Henderson      * Only evict the old entry to the victim tlb if it's for a
80868fea038SRichard Henderson      * different page; otherwise just overwrite the stale data.
80968fea038SRichard Henderson      */
8103cea94bbSEmilio G. Cota     if (!tlb_hit_page_anyprot(te, vaddr_page) && !tlb_entry_is_empty(te)) {
811a40ec84eSRichard Henderson         unsigned vidx = desc->vindex++ % CPU_VTLB_SIZE;
812a40ec84eSRichard Henderson         CPUTLBEntry *tv = &desc->vtable[vidx];
81368fea038SRichard Henderson 
81468fea038SRichard Henderson         /* Evict the old entry into the victim tlb.  */
81571aec354SEmilio G. Cota         copy_tlb_helper_locked(tv, te);
816a40ec84eSRichard Henderson         desc->viotlb[vidx] = desc->iotlb[index];
81786e1eff8SEmilio G. Cota         tlb_n_used_entries_dec(env, mmu_idx);
81868fea038SRichard Henderson     }
819d9bb58e5SYang Zhong 
820d9bb58e5SYang Zhong     /* refill the tlb */
821ace41090SPeter Maydell     /*
822ace41090SPeter Maydell      * At this point iotlb contains a physical section number in the lower
823ace41090SPeter Maydell      * TARGET_PAGE_BITS, and either
8248f5db641SRichard Henderson      *  + the ram_addr_t of the page base of the target RAM (RAM)
8258f5db641SRichard Henderson      *  + the offset within section->mr of the page base (I/O, ROMD)
82655df6fcfSPeter Maydell      * We subtract the vaddr_page (which is page aligned and thus won't
827ace41090SPeter Maydell      * disturb the low bits) to give an offset which can be added to the
828ace41090SPeter Maydell      * (non-page-aligned) vaddr of the eventual memory access to get
829ace41090SPeter Maydell      * the MemoryRegion offset for the access. Note that the vaddr we
830ace41090SPeter Maydell      * subtract here is that of the page base, and not the same as the
831ace41090SPeter Maydell      * vaddr we add back in io_readx()/io_writex()/get_page_addr_code().
832ace41090SPeter Maydell      */
833a40ec84eSRichard Henderson     desc->iotlb[index].addr = iotlb - vaddr_page;
834a40ec84eSRichard Henderson     desc->iotlb[index].attrs = attrs;
835d9bb58e5SYang Zhong 
836d9bb58e5SYang Zhong     /* Now calculate the new entry */
83755df6fcfSPeter Maydell     tn.addend = addend - vaddr_page;
838d9bb58e5SYang Zhong     if (prot & PAGE_READ) {
839d9bb58e5SYang Zhong         tn.addr_read = address;
84050b107c5SRichard Henderson         if (wp_flags & BP_MEM_READ) {
84150b107c5SRichard Henderson             tn.addr_read |= TLB_WATCHPOINT;
84250b107c5SRichard Henderson         }
843d9bb58e5SYang Zhong     } else {
844d9bb58e5SYang Zhong         tn.addr_read = -1;
845d9bb58e5SYang Zhong     }
846d9bb58e5SYang Zhong 
847d9bb58e5SYang Zhong     if (prot & PAGE_EXEC) {
8488f5db641SRichard Henderson         tn.addr_code = address;
849d9bb58e5SYang Zhong     } else {
850d9bb58e5SYang Zhong         tn.addr_code = -1;
851d9bb58e5SYang Zhong     }
852d9bb58e5SYang Zhong 
853d9bb58e5SYang Zhong     tn.addr_write = -1;
854d9bb58e5SYang Zhong     if (prot & PAGE_WRITE) {
8558f5db641SRichard Henderson         tn.addr_write = write_address;
856f52bfb12SDavid Hildenbrand         if (prot & PAGE_WRITE_INV) {
857f52bfb12SDavid Hildenbrand             tn.addr_write |= TLB_INVALID_MASK;
858f52bfb12SDavid Hildenbrand         }
85950b107c5SRichard Henderson         if (wp_flags & BP_MEM_WRITE) {
86050b107c5SRichard Henderson             tn.addr_write |= TLB_WATCHPOINT;
86150b107c5SRichard Henderson         }
862d9bb58e5SYang Zhong     }
863d9bb58e5SYang Zhong 
86471aec354SEmilio G. Cota     copy_tlb_helper_locked(te, &tn);
86586e1eff8SEmilio G. Cota     tlb_n_used_entries_inc(env, mmu_idx);
866a40ec84eSRichard Henderson     qemu_spin_unlock(&tlb->c.lock);
867d9bb58e5SYang Zhong }
868d9bb58e5SYang Zhong 
869d9bb58e5SYang Zhong /* Add a new TLB entry, but without specifying the memory
870d9bb58e5SYang Zhong  * transaction attributes to be used.
871d9bb58e5SYang Zhong  */
872d9bb58e5SYang Zhong void tlb_set_page(CPUState *cpu, target_ulong vaddr,
873d9bb58e5SYang Zhong                   hwaddr paddr, int prot,
874d9bb58e5SYang Zhong                   int mmu_idx, target_ulong size)
875d9bb58e5SYang Zhong {
876d9bb58e5SYang Zhong     tlb_set_page_with_attrs(cpu, vaddr, paddr, MEMTXATTRS_UNSPECIFIED,
877d9bb58e5SYang Zhong                             prot, mmu_idx, size);
878d9bb58e5SYang Zhong }
879d9bb58e5SYang Zhong 
880d9bb58e5SYang Zhong static inline ram_addr_t qemu_ram_addr_from_host_nofail(void *ptr)
881d9bb58e5SYang Zhong {
882d9bb58e5SYang Zhong     ram_addr_t ram_addr;
883d9bb58e5SYang Zhong 
884d9bb58e5SYang Zhong     ram_addr = qemu_ram_addr_from_host(ptr);
885d9bb58e5SYang Zhong     if (ram_addr == RAM_ADDR_INVALID) {
886d9bb58e5SYang Zhong         error_report("Bad ram pointer %p", ptr);
887d9bb58e5SYang Zhong         abort();
888d9bb58e5SYang Zhong     }
889d9bb58e5SYang Zhong     return ram_addr;
890d9bb58e5SYang Zhong }
891d9bb58e5SYang Zhong 
892c319dc13SRichard Henderson /*
893c319dc13SRichard Henderson  * Note: tlb_fill() can trigger a resize of the TLB. This means that all of the
894c319dc13SRichard Henderson  * caller's prior references to the TLB table (e.g. CPUTLBEntry pointers) must
895c319dc13SRichard Henderson  * be discarded and looked up again (e.g. via tlb_entry()).
896c319dc13SRichard Henderson  */
897c319dc13SRichard Henderson static void tlb_fill(CPUState *cpu, target_ulong addr, int size,
898c319dc13SRichard Henderson                      MMUAccessType access_type, int mmu_idx, uintptr_t retaddr)
899c319dc13SRichard Henderson {
900c319dc13SRichard Henderson     CPUClass *cc = CPU_GET_CLASS(cpu);
901c319dc13SRichard Henderson     bool ok;
902c319dc13SRichard Henderson 
903c319dc13SRichard Henderson     /*
904c319dc13SRichard Henderson      * This is not a probe, so only valid return is success; failure
905c319dc13SRichard Henderson      * should result in exception + longjmp to the cpu loop.
906c319dc13SRichard Henderson      */
907c319dc13SRichard Henderson     ok = cc->tlb_fill(cpu, addr, size, access_type, mmu_idx, false, retaddr);
908c319dc13SRichard Henderson     assert(ok);
909c319dc13SRichard Henderson }
910c319dc13SRichard Henderson 
911d9bb58e5SYang Zhong static uint64_t io_readx(CPUArchState *env, CPUIOTLBEntry *iotlbentry,
912f1be3696SRichard Henderson                          int mmu_idx, target_ulong addr, uintptr_t retaddr,
913be5c4787STony Nguyen                          MMUAccessType access_type, MemOp op)
914d9bb58e5SYang Zhong {
91529a0af61SRichard Henderson     CPUState *cpu = env_cpu(env);
9162d54f194SPeter Maydell     hwaddr mr_offset;
9172d54f194SPeter Maydell     MemoryRegionSection *section;
9182d54f194SPeter Maydell     MemoryRegion *mr;
919d9bb58e5SYang Zhong     uint64_t val;
920d9bb58e5SYang Zhong     bool locked = false;
92104e3aabdSPeter Maydell     MemTxResult r;
922d9bb58e5SYang Zhong 
9232d54f194SPeter Maydell     section = iotlb_to_section(cpu, iotlbentry->addr, iotlbentry->attrs);
9242d54f194SPeter Maydell     mr = section->mr;
9252d54f194SPeter Maydell     mr_offset = (iotlbentry->addr & TARGET_PAGE_MASK) + addr;
926d9bb58e5SYang Zhong     cpu->mem_io_pc = retaddr;
92708565552SRichard Henderson     if (!cpu->can_do_io) {
928d9bb58e5SYang Zhong         cpu_io_recompile(cpu, retaddr);
929d9bb58e5SYang Zhong     }
930d9bb58e5SYang Zhong 
931dbea78a4SPeter Maydell     cpu->mem_io_access_type = access_type;
932d9bb58e5SYang Zhong 
9338b812533SAlex Bennée     if (mr->global_locking && !qemu_mutex_iothread_locked()) {
934d9bb58e5SYang Zhong         qemu_mutex_lock_iothread();
935d9bb58e5SYang Zhong         locked = true;
936d9bb58e5SYang Zhong     }
937be5c4787STony Nguyen     r = memory_region_dispatch_read(mr, mr_offset, &val, op, iotlbentry->attrs);
93804e3aabdSPeter Maydell     if (r != MEMTX_OK) {
9392d54f194SPeter Maydell         hwaddr physaddr = mr_offset +
9402d54f194SPeter Maydell             section->offset_within_address_space -
9412d54f194SPeter Maydell             section->offset_within_region;
9422d54f194SPeter Maydell 
943be5c4787STony Nguyen         cpu_transaction_failed(cpu, physaddr, addr, memop_size(op), access_type,
94404e3aabdSPeter Maydell                                mmu_idx, iotlbentry->attrs, r, retaddr);
94504e3aabdSPeter Maydell     }
946d9bb58e5SYang Zhong     if (locked) {
947d9bb58e5SYang Zhong         qemu_mutex_unlock_iothread();
948d9bb58e5SYang Zhong     }
949d9bb58e5SYang Zhong 
950d9bb58e5SYang Zhong     return val;
951d9bb58e5SYang Zhong }
952d9bb58e5SYang Zhong 
953d9bb58e5SYang Zhong static void io_writex(CPUArchState *env, CPUIOTLBEntry *iotlbentry,
954f1be3696SRichard Henderson                       int mmu_idx, uint64_t val, target_ulong addr,
955be5c4787STony Nguyen                       uintptr_t retaddr, MemOp op)
956d9bb58e5SYang Zhong {
95729a0af61SRichard Henderson     CPUState *cpu = env_cpu(env);
9582d54f194SPeter Maydell     hwaddr mr_offset;
9592d54f194SPeter Maydell     MemoryRegionSection *section;
9602d54f194SPeter Maydell     MemoryRegion *mr;
961d9bb58e5SYang Zhong     bool locked = false;
96204e3aabdSPeter Maydell     MemTxResult r;
963d9bb58e5SYang Zhong 
9642d54f194SPeter Maydell     section = iotlb_to_section(cpu, iotlbentry->addr, iotlbentry->attrs);
9652d54f194SPeter Maydell     mr = section->mr;
9662d54f194SPeter Maydell     mr_offset = (iotlbentry->addr & TARGET_PAGE_MASK) + addr;
96708565552SRichard Henderson     if (!cpu->can_do_io) {
968d9bb58e5SYang Zhong         cpu_io_recompile(cpu, retaddr);
969d9bb58e5SYang Zhong     }
970d9bb58e5SYang Zhong     cpu->mem_io_pc = retaddr;
971d9bb58e5SYang Zhong 
9728b812533SAlex Bennée     if (mr->global_locking && !qemu_mutex_iothread_locked()) {
973d9bb58e5SYang Zhong         qemu_mutex_lock_iothread();
974d9bb58e5SYang Zhong         locked = true;
975d9bb58e5SYang Zhong     }
976be5c4787STony Nguyen     r = memory_region_dispatch_write(mr, mr_offset, val, op, iotlbentry->attrs);
97704e3aabdSPeter Maydell     if (r != MEMTX_OK) {
9782d54f194SPeter Maydell         hwaddr physaddr = mr_offset +
9792d54f194SPeter Maydell             section->offset_within_address_space -
9802d54f194SPeter Maydell             section->offset_within_region;
9812d54f194SPeter Maydell 
982be5c4787STony Nguyen         cpu_transaction_failed(cpu, physaddr, addr, memop_size(op),
983be5c4787STony Nguyen                                MMU_DATA_STORE, mmu_idx, iotlbentry->attrs, r,
984be5c4787STony Nguyen                                retaddr);
98504e3aabdSPeter Maydell     }
986d9bb58e5SYang Zhong     if (locked) {
987d9bb58e5SYang Zhong         qemu_mutex_unlock_iothread();
988d9bb58e5SYang Zhong     }
989d9bb58e5SYang Zhong }
990d9bb58e5SYang Zhong 
9914811e909SRichard Henderson static inline target_ulong tlb_read_ofs(CPUTLBEntry *entry, size_t ofs)
9924811e909SRichard Henderson {
9934811e909SRichard Henderson #if TCG_OVERSIZED_GUEST
9944811e909SRichard Henderson     return *(target_ulong *)((uintptr_t)entry + ofs);
9954811e909SRichard Henderson #else
9964811e909SRichard Henderson     /* ofs might correspond to .addr_write, so use atomic_read */
9974811e909SRichard Henderson     return atomic_read((target_ulong *)((uintptr_t)entry + ofs));
9984811e909SRichard Henderson #endif
9994811e909SRichard Henderson }
10004811e909SRichard Henderson 
1001d9bb58e5SYang Zhong /* Return true if ADDR is present in the victim tlb, and has been copied
1002d9bb58e5SYang Zhong    back to the main tlb.  */
1003d9bb58e5SYang Zhong static bool victim_tlb_hit(CPUArchState *env, size_t mmu_idx, size_t index,
1004d9bb58e5SYang Zhong                            size_t elt_ofs, target_ulong page)
1005d9bb58e5SYang Zhong {
1006d9bb58e5SYang Zhong     size_t vidx;
100771aec354SEmilio G. Cota 
100829a0af61SRichard Henderson     assert_cpu_is_self(env_cpu(env));
1009d9bb58e5SYang Zhong     for (vidx = 0; vidx < CPU_VTLB_SIZE; ++vidx) {
1010a40ec84eSRichard Henderson         CPUTLBEntry *vtlb = &env_tlb(env)->d[mmu_idx].vtable[vidx];
1011a40ec84eSRichard Henderson         target_ulong cmp;
1012a40ec84eSRichard Henderson 
1013a40ec84eSRichard Henderson         /* elt_ofs might correspond to .addr_write, so use atomic_read */
1014a40ec84eSRichard Henderson #if TCG_OVERSIZED_GUEST
1015a40ec84eSRichard Henderson         cmp = *(target_ulong *)((uintptr_t)vtlb + elt_ofs);
1016a40ec84eSRichard Henderson #else
1017a40ec84eSRichard Henderson         cmp = atomic_read((target_ulong *)((uintptr_t)vtlb + elt_ofs));
1018a40ec84eSRichard Henderson #endif
1019d9bb58e5SYang Zhong 
1020d9bb58e5SYang Zhong         if (cmp == page) {
1021d9bb58e5SYang Zhong             /* Found entry in victim tlb, swap tlb and iotlb.  */
1022a40ec84eSRichard Henderson             CPUTLBEntry tmptlb, *tlb = &env_tlb(env)->f[mmu_idx].table[index];
1023d9bb58e5SYang Zhong 
1024a40ec84eSRichard Henderson             qemu_spin_lock(&env_tlb(env)->c.lock);
102571aec354SEmilio G. Cota             copy_tlb_helper_locked(&tmptlb, tlb);
102671aec354SEmilio G. Cota             copy_tlb_helper_locked(tlb, vtlb);
102771aec354SEmilio G. Cota             copy_tlb_helper_locked(vtlb, &tmptlb);
1028a40ec84eSRichard Henderson             qemu_spin_unlock(&env_tlb(env)->c.lock);
1029d9bb58e5SYang Zhong 
1030a40ec84eSRichard Henderson             CPUIOTLBEntry tmpio, *io = &env_tlb(env)->d[mmu_idx].iotlb[index];
1031a40ec84eSRichard Henderson             CPUIOTLBEntry *vio = &env_tlb(env)->d[mmu_idx].viotlb[vidx];
1032d9bb58e5SYang Zhong             tmpio = *io; *io = *vio; *vio = tmpio;
1033d9bb58e5SYang Zhong             return true;
1034d9bb58e5SYang Zhong         }
1035d9bb58e5SYang Zhong     }
1036d9bb58e5SYang Zhong     return false;
1037d9bb58e5SYang Zhong }
1038d9bb58e5SYang Zhong 
1039d9bb58e5SYang Zhong /* Macro to call the above, with local variables from the use context.  */
1040d9bb58e5SYang Zhong #define VICTIM_TLB_HIT(TY, ADDR) \
1041d9bb58e5SYang Zhong   victim_tlb_hit(env, mmu_idx, index, offsetof(CPUTLBEntry, TY), \
1042d9bb58e5SYang Zhong                  (ADDR) & TARGET_PAGE_MASK)
1043d9bb58e5SYang Zhong 
104430d7e098SRichard Henderson /*
104530d7e098SRichard Henderson  * Return a ram_addr_t for the virtual address for execution.
104630d7e098SRichard Henderson  *
104730d7e098SRichard Henderson  * Return -1 if we can't translate and execute from an entire page
104830d7e098SRichard Henderson  * of RAM.  This will force us to execute by loading and translating
104930d7e098SRichard Henderson  * one insn at a time, without caching.
105030d7e098SRichard Henderson  *
105130d7e098SRichard Henderson  * NOTE: This function will trigger an exception if the page is
105230d7e098SRichard Henderson  * not executable.
1053f2553f04SKONRAD Frederic  */
1054*4b2190daSEmilio G. Cota tb_page_addr_t get_page_addr_code_hostp(CPUArchState *env, target_ulong addr,
1055*4b2190daSEmilio G. Cota                                         void **hostp)
1056f2553f04SKONRAD Frederic {
1057383beda9SRichard Henderson     uintptr_t mmu_idx = cpu_mmu_index(env, true);
1058383beda9SRichard Henderson     uintptr_t index = tlb_index(env, mmu_idx, addr);
1059383beda9SRichard Henderson     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
1060f2553f04SKONRAD Frederic     void *p;
1061f2553f04SKONRAD Frederic 
1062383beda9SRichard Henderson     if (unlikely(!tlb_hit(entry->addr_code, addr))) {
1063b493ccf1SPeter Maydell         if (!VICTIM_TLB_HIT(addr_code, addr)) {
106429a0af61SRichard Henderson             tlb_fill(env_cpu(env), addr, 0, MMU_INST_FETCH, mmu_idx, 0);
10656d967cb8SEmilio G. Cota             index = tlb_index(env, mmu_idx, addr);
10666d967cb8SEmilio G. Cota             entry = tlb_entry(env, mmu_idx, addr);
106730d7e098SRichard Henderson 
106830d7e098SRichard Henderson             if (unlikely(entry->addr_code & TLB_INVALID_MASK)) {
106930d7e098SRichard Henderson                 /*
107030d7e098SRichard Henderson                  * The MMU protection covers a smaller range than a target
107130d7e098SRichard Henderson                  * page, so we must redo the MMU check for every insn.
107230d7e098SRichard Henderson                  */
107330d7e098SRichard Henderson                 return -1;
107430d7e098SRichard Henderson             }
107571b9a453SKONRAD Frederic         }
1076383beda9SRichard Henderson         assert(tlb_hit(entry->addr_code, addr));
1077f2553f04SKONRAD Frederic     }
107855df6fcfSPeter Maydell 
107930d7e098SRichard Henderson     if (unlikely(entry->addr_code & TLB_MMIO)) {
108030d7e098SRichard Henderson         /* The region is not backed by RAM.  */
1081*4b2190daSEmilio G. Cota         if (hostp) {
1082*4b2190daSEmilio G. Cota             *hostp = NULL;
1083*4b2190daSEmilio G. Cota         }
108420cb6ae4SPeter Maydell         return -1;
108555df6fcfSPeter Maydell     }
108655df6fcfSPeter Maydell 
1087383beda9SRichard Henderson     p = (void *)((uintptr_t)addr + entry->addend);
1088*4b2190daSEmilio G. Cota     if (hostp) {
1089*4b2190daSEmilio G. Cota         *hostp = p;
1090*4b2190daSEmilio G. Cota     }
1091f2553f04SKONRAD Frederic     return qemu_ram_addr_from_host_nofail(p);
1092f2553f04SKONRAD Frederic }
1093f2553f04SKONRAD Frederic 
1094*4b2190daSEmilio G. Cota tb_page_addr_t get_page_addr_code(CPUArchState *env, target_ulong addr)
1095*4b2190daSEmilio G. Cota {
1096*4b2190daSEmilio G. Cota     return get_page_addr_code_hostp(env, addr, NULL);
1097*4b2190daSEmilio G. Cota }
1098*4b2190daSEmilio G. Cota 
1099707526adSRichard Henderson static void notdirty_write(CPUState *cpu, vaddr mem_vaddr, unsigned size,
1100707526adSRichard Henderson                            CPUIOTLBEntry *iotlbentry, uintptr_t retaddr)
1101707526adSRichard Henderson {
1102707526adSRichard Henderson     ram_addr_t ram_addr = mem_vaddr + iotlbentry->addr;
1103707526adSRichard Henderson 
1104707526adSRichard Henderson     trace_memory_notdirty_write_access(mem_vaddr, ram_addr, size);
1105707526adSRichard Henderson 
1106707526adSRichard Henderson     if (!cpu_physical_memory_get_dirty_flag(ram_addr, DIRTY_MEMORY_CODE)) {
1107707526adSRichard Henderson         struct page_collection *pages
1108707526adSRichard Henderson             = page_collection_lock(ram_addr, ram_addr + size);
11095a7c27bbSRichard Henderson         tb_invalidate_phys_page_fast(pages, ram_addr, size, retaddr);
1110707526adSRichard Henderson         page_collection_unlock(pages);
1111707526adSRichard Henderson     }
1112707526adSRichard Henderson 
1113707526adSRichard Henderson     /*
1114707526adSRichard Henderson      * Set both VGA and migration bits for simplicity and to remove
1115707526adSRichard Henderson      * the notdirty callback faster.
1116707526adSRichard Henderson      */
1117707526adSRichard Henderson     cpu_physical_memory_set_dirty_range(ram_addr, size, DIRTY_CLIENTS_NOCODE);
1118707526adSRichard Henderson 
1119707526adSRichard Henderson     /* We remove the notdirty callback only if the code has been flushed. */
1120707526adSRichard Henderson     if (!cpu_physical_memory_is_clean(ram_addr)) {
1121707526adSRichard Henderson         trace_memory_notdirty_set_dirty(mem_vaddr);
1122707526adSRichard Henderson         tlb_set_dirty(cpu, mem_vaddr);
1123707526adSRichard Henderson     }
1124707526adSRichard Henderson }
1125707526adSRichard Henderson 
1126c25c283dSDavid Hildenbrand /*
1127c25c283dSDavid Hildenbrand  * Probe for whether the specified guest access is permitted. If it is not
1128c25c283dSDavid Hildenbrand  * permitted then an exception will be taken in the same way as if this
1129c25c283dSDavid Hildenbrand  * were a real access (and we will not return).
1130fef39ccdSDavid Hildenbrand  * If the size is 0 or the page requires I/O access, returns NULL; otherwise,
1131fef39ccdSDavid Hildenbrand  * returns the address of the host page similar to tlb_vaddr_to_host().
1132d9bb58e5SYang Zhong  */
1133c25c283dSDavid Hildenbrand void *probe_access(CPUArchState *env, target_ulong addr, int size,
1134c25c283dSDavid Hildenbrand                    MMUAccessType access_type, int mmu_idx, uintptr_t retaddr)
1135d9bb58e5SYang Zhong {
1136383beda9SRichard Henderson     uintptr_t index = tlb_index(env, mmu_idx, addr);
1137383beda9SRichard Henderson     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
1138c25c283dSDavid Hildenbrand     target_ulong tlb_addr;
1139c25c283dSDavid Hildenbrand     size_t elt_ofs;
1140c25c283dSDavid Hildenbrand     int wp_access;
1141d9bb58e5SYang Zhong 
1142ca86cf32SDavid Hildenbrand     g_assert(-(addr | TARGET_PAGE_MASK) >= size);
1143ca86cf32SDavid Hildenbrand 
1144c25c283dSDavid Hildenbrand     switch (access_type) {
1145c25c283dSDavid Hildenbrand     case MMU_DATA_LOAD:
1146c25c283dSDavid Hildenbrand         elt_ofs = offsetof(CPUTLBEntry, addr_read);
1147c25c283dSDavid Hildenbrand         wp_access = BP_MEM_READ;
1148c25c283dSDavid Hildenbrand         break;
1149c25c283dSDavid Hildenbrand     case MMU_DATA_STORE:
1150c25c283dSDavid Hildenbrand         elt_ofs = offsetof(CPUTLBEntry, addr_write);
1151c25c283dSDavid Hildenbrand         wp_access = BP_MEM_WRITE;
1152c25c283dSDavid Hildenbrand         break;
1153c25c283dSDavid Hildenbrand     case MMU_INST_FETCH:
1154c25c283dSDavid Hildenbrand         elt_ofs = offsetof(CPUTLBEntry, addr_code);
1155c25c283dSDavid Hildenbrand         wp_access = BP_MEM_READ;
1156c25c283dSDavid Hildenbrand         break;
1157c25c283dSDavid Hildenbrand     default:
1158c25c283dSDavid Hildenbrand         g_assert_not_reached();
1159c25c283dSDavid Hildenbrand     }
1160c25c283dSDavid Hildenbrand     tlb_addr = tlb_read_ofs(entry, elt_ofs);
1161c25c283dSDavid Hildenbrand 
116203a98189SDavid Hildenbrand     if (unlikely(!tlb_hit(tlb_addr, addr))) {
1163c25c283dSDavid Hildenbrand         if (!victim_tlb_hit(env, mmu_idx, index, elt_ofs,
1164c25c283dSDavid Hildenbrand                             addr & TARGET_PAGE_MASK)) {
1165c25c283dSDavid Hildenbrand             tlb_fill(env_cpu(env), addr, size, access_type, mmu_idx, retaddr);
116603a98189SDavid Hildenbrand             /* TLB resize via tlb_fill may have moved the entry. */
116703a98189SDavid Hildenbrand             index = tlb_index(env, mmu_idx, addr);
116803a98189SDavid Hildenbrand             entry = tlb_entry(env, mmu_idx, addr);
1169d9bb58e5SYang Zhong         }
1170c25c283dSDavid Hildenbrand         tlb_addr = tlb_read_ofs(entry, elt_ofs);
117103a98189SDavid Hildenbrand     }
117203a98189SDavid Hildenbrand 
1173fef39ccdSDavid Hildenbrand     if (!size) {
1174fef39ccdSDavid Hildenbrand         return NULL;
1175fef39ccdSDavid Hildenbrand     }
1176fef39ccdSDavid Hildenbrand 
117773bc0bd4SRichard Henderson     if (unlikely(tlb_addr & TLB_FLAGS_MASK)) {
117873bc0bd4SRichard Henderson         CPUIOTLBEntry *iotlbentry = &env_tlb(env)->d[mmu_idx].iotlb[index];
117973bc0bd4SRichard Henderson 
118073bc0bd4SRichard Henderson         /* Reject I/O access, or other required slow-path.  */
118173bc0bd4SRichard Henderson         if (tlb_addr & (TLB_MMIO | TLB_BSWAP | TLB_DISCARD_WRITE)) {
118273bc0bd4SRichard Henderson             return NULL;
118373bc0bd4SRichard Henderson         }
118473bc0bd4SRichard Henderson 
118503a98189SDavid Hildenbrand         /* Handle watchpoints.  */
1186fef39ccdSDavid Hildenbrand         if (tlb_addr & TLB_WATCHPOINT) {
118703a98189SDavid Hildenbrand             cpu_check_watchpoint(env_cpu(env), addr, size,
118873bc0bd4SRichard Henderson                                  iotlbentry->attrs, wp_access, retaddr);
1189d9bb58e5SYang Zhong         }
1190fef39ccdSDavid Hildenbrand 
119173bc0bd4SRichard Henderson         /* Handle clean RAM pages.  */
119273bc0bd4SRichard Henderson         if (tlb_addr & TLB_NOTDIRTY) {
119373bc0bd4SRichard Henderson             notdirty_write(env_cpu(env), addr, size, iotlbentry, retaddr);
119473bc0bd4SRichard Henderson         }
1195fef39ccdSDavid Hildenbrand     }
1196fef39ccdSDavid Hildenbrand 
1197fef39ccdSDavid Hildenbrand     return (void *)((uintptr_t)addr + entry->addend);
1198d9bb58e5SYang Zhong }
1199d9bb58e5SYang Zhong 
12004811e909SRichard Henderson void *tlb_vaddr_to_host(CPUArchState *env, abi_ptr addr,
12014811e909SRichard Henderson                         MMUAccessType access_type, int mmu_idx)
12024811e909SRichard Henderson {
12034811e909SRichard Henderson     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
12044811e909SRichard Henderson     uintptr_t tlb_addr, page;
12054811e909SRichard Henderson     size_t elt_ofs;
12064811e909SRichard Henderson 
12074811e909SRichard Henderson     switch (access_type) {
12084811e909SRichard Henderson     case MMU_DATA_LOAD:
12094811e909SRichard Henderson         elt_ofs = offsetof(CPUTLBEntry, addr_read);
12104811e909SRichard Henderson         break;
12114811e909SRichard Henderson     case MMU_DATA_STORE:
12124811e909SRichard Henderson         elt_ofs = offsetof(CPUTLBEntry, addr_write);
12134811e909SRichard Henderson         break;
12144811e909SRichard Henderson     case MMU_INST_FETCH:
12154811e909SRichard Henderson         elt_ofs = offsetof(CPUTLBEntry, addr_code);
12164811e909SRichard Henderson         break;
12174811e909SRichard Henderson     default:
12184811e909SRichard Henderson         g_assert_not_reached();
12194811e909SRichard Henderson     }
12204811e909SRichard Henderson 
12214811e909SRichard Henderson     page = addr & TARGET_PAGE_MASK;
12224811e909SRichard Henderson     tlb_addr = tlb_read_ofs(entry, elt_ofs);
12234811e909SRichard Henderson 
12244811e909SRichard Henderson     if (!tlb_hit_page(tlb_addr, page)) {
12254811e909SRichard Henderson         uintptr_t index = tlb_index(env, mmu_idx, addr);
12264811e909SRichard Henderson 
12274811e909SRichard Henderson         if (!victim_tlb_hit(env, mmu_idx, index, elt_ofs, page)) {
122829a0af61SRichard Henderson             CPUState *cs = env_cpu(env);
12294811e909SRichard Henderson             CPUClass *cc = CPU_GET_CLASS(cs);
12304811e909SRichard Henderson 
12314811e909SRichard Henderson             if (!cc->tlb_fill(cs, addr, 0, access_type, mmu_idx, true, 0)) {
12324811e909SRichard Henderson                 /* Non-faulting page table read failed.  */
12334811e909SRichard Henderson                 return NULL;
12344811e909SRichard Henderson             }
12354811e909SRichard Henderson 
12364811e909SRichard Henderson             /* TLB resize via tlb_fill may have moved the entry.  */
12374811e909SRichard Henderson             entry = tlb_entry(env, mmu_idx, addr);
12384811e909SRichard Henderson         }
12394811e909SRichard Henderson         tlb_addr = tlb_read_ofs(entry, elt_ofs);
12404811e909SRichard Henderson     }
12414811e909SRichard Henderson 
12424811e909SRichard Henderson     if (tlb_addr & ~TARGET_PAGE_MASK) {
12434811e909SRichard Henderson         /* IO access */
12444811e909SRichard Henderson         return NULL;
12454811e909SRichard Henderson     }
12464811e909SRichard Henderson 
12474811e909SRichard Henderson     return (void *)((uintptr_t)addr + entry->addend);
12484811e909SRichard Henderson }
12494811e909SRichard Henderson 
1250d9bb58e5SYang Zhong /* Probe for a read-modify-write atomic operation.  Do not allow unaligned
1251d9bb58e5SYang Zhong  * operations, or io operations to proceed.  Return the host address.  */
1252d9bb58e5SYang Zhong static void *atomic_mmu_lookup(CPUArchState *env, target_ulong addr,
1253707526adSRichard Henderson                                TCGMemOpIdx oi, uintptr_t retaddr)
1254d9bb58e5SYang Zhong {
1255d9bb58e5SYang Zhong     size_t mmu_idx = get_mmuidx(oi);
1256383beda9SRichard Henderson     uintptr_t index = tlb_index(env, mmu_idx, addr);
1257383beda9SRichard Henderson     CPUTLBEntry *tlbe = tlb_entry(env, mmu_idx, addr);
1258403f290cSEmilio G. Cota     target_ulong tlb_addr = tlb_addr_write(tlbe);
125914776ab5STony Nguyen     MemOp mop = get_memop(oi);
1260d9bb58e5SYang Zhong     int a_bits = get_alignment_bits(mop);
1261d9bb58e5SYang Zhong     int s_bits = mop & MO_SIZE;
126234d49937SPeter Maydell     void *hostaddr;
1263d9bb58e5SYang Zhong 
1264d9bb58e5SYang Zhong     /* Adjust the given return address.  */
1265d9bb58e5SYang Zhong     retaddr -= GETPC_ADJ;
1266d9bb58e5SYang Zhong 
1267d9bb58e5SYang Zhong     /* Enforce guest required alignment.  */
1268d9bb58e5SYang Zhong     if (unlikely(a_bits > 0 && (addr & ((1 << a_bits) - 1)))) {
1269d9bb58e5SYang Zhong         /* ??? Maybe indicate atomic op to cpu_unaligned_access */
127029a0af61SRichard Henderson         cpu_unaligned_access(env_cpu(env), addr, MMU_DATA_STORE,
1271d9bb58e5SYang Zhong                              mmu_idx, retaddr);
1272d9bb58e5SYang Zhong     }
1273d9bb58e5SYang Zhong 
1274d9bb58e5SYang Zhong     /* Enforce qemu required alignment.  */
1275d9bb58e5SYang Zhong     if (unlikely(addr & ((1 << s_bits) - 1))) {
1276d9bb58e5SYang Zhong         /* We get here if guest alignment was not requested,
1277d9bb58e5SYang Zhong            or was not enforced by cpu_unaligned_access above.
1278d9bb58e5SYang Zhong            We might widen the access and emulate, but for now
1279d9bb58e5SYang Zhong            mark an exception and exit the cpu loop.  */
1280d9bb58e5SYang Zhong         goto stop_the_world;
1281d9bb58e5SYang Zhong     }
1282d9bb58e5SYang Zhong 
1283d9bb58e5SYang Zhong     /* Check TLB entry and enforce page permissions.  */
1284334692bcSPeter Maydell     if (!tlb_hit(tlb_addr, addr)) {
1285d9bb58e5SYang Zhong         if (!VICTIM_TLB_HIT(addr_write, addr)) {
128629a0af61SRichard Henderson             tlb_fill(env_cpu(env), addr, 1 << s_bits, MMU_DATA_STORE,
128798670d47SLaurent Vivier                      mmu_idx, retaddr);
12886d967cb8SEmilio G. Cota             index = tlb_index(env, mmu_idx, addr);
12896d967cb8SEmilio G. Cota             tlbe = tlb_entry(env, mmu_idx, addr);
1290d9bb58e5SYang Zhong         }
1291403f290cSEmilio G. Cota         tlb_addr = tlb_addr_write(tlbe) & ~TLB_INVALID_MASK;
1292d9bb58e5SYang Zhong     }
1293d9bb58e5SYang Zhong 
129455df6fcfSPeter Maydell     /* Notice an IO access or a needs-MMU-lookup access */
129530d7e098SRichard Henderson     if (unlikely(tlb_addr & TLB_MMIO)) {
1296d9bb58e5SYang Zhong         /* There's really nothing that can be done to
1297d9bb58e5SYang Zhong            support this apart from stop-the-world.  */
1298d9bb58e5SYang Zhong         goto stop_the_world;
1299d9bb58e5SYang Zhong     }
1300d9bb58e5SYang Zhong 
1301d9bb58e5SYang Zhong     /* Let the guest notice RMW on a write-only page.  */
130234d49937SPeter Maydell     if (unlikely(tlbe->addr_read != (tlb_addr & ~TLB_NOTDIRTY))) {
130329a0af61SRichard Henderson         tlb_fill(env_cpu(env), addr, 1 << s_bits, MMU_DATA_LOAD,
130498670d47SLaurent Vivier                  mmu_idx, retaddr);
1305d9bb58e5SYang Zhong         /* Since we don't support reads and writes to different addresses,
1306d9bb58e5SYang Zhong            and we do have the proper page loaded for write, this shouldn't
1307d9bb58e5SYang Zhong            ever return.  But just in case, handle via stop-the-world.  */
1308d9bb58e5SYang Zhong         goto stop_the_world;
1309d9bb58e5SYang Zhong     }
1310d9bb58e5SYang Zhong 
131134d49937SPeter Maydell     hostaddr = (void *)((uintptr_t)addr + tlbe->addend);
131234d49937SPeter Maydell 
131334d49937SPeter Maydell     if (unlikely(tlb_addr & TLB_NOTDIRTY)) {
1314707526adSRichard Henderson         notdirty_write(env_cpu(env), addr, 1 << s_bits,
1315707526adSRichard Henderson                        &env_tlb(env)->d[mmu_idx].iotlb[index], retaddr);
131634d49937SPeter Maydell     }
131734d49937SPeter Maydell 
131834d49937SPeter Maydell     return hostaddr;
1319d9bb58e5SYang Zhong 
1320d9bb58e5SYang Zhong  stop_the_world:
132129a0af61SRichard Henderson     cpu_loop_exit_atomic(env_cpu(env), retaddr);
1322d9bb58e5SYang Zhong }
1323d9bb58e5SYang Zhong 
1324eed56642SAlex Bennée /*
1325eed56642SAlex Bennée  * Load Helpers
1326eed56642SAlex Bennée  *
1327eed56642SAlex Bennée  * We support two different access types. SOFTMMU_CODE_ACCESS is
1328eed56642SAlex Bennée  * specifically for reading instructions from system memory. It is
1329eed56642SAlex Bennée  * called by the translation loop and in some helpers where the code
1330eed56642SAlex Bennée  * is disassembled. It shouldn't be called directly by guest code.
1331eed56642SAlex Bennée  */
1332d9bb58e5SYang Zhong 
13332dd92606SRichard Henderson typedef uint64_t FullLoadHelper(CPUArchState *env, target_ulong addr,
13342dd92606SRichard Henderson                                 TCGMemOpIdx oi, uintptr_t retaddr);
13352dd92606SRichard Henderson 
1336c6b716cdSRichard Henderson static inline uint64_t QEMU_ALWAYS_INLINE
133780d9d1c6SRichard Henderson load_memop(const void *haddr, MemOp op)
133880d9d1c6SRichard Henderson {
133980d9d1c6SRichard Henderson     switch (op) {
134080d9d1c6SRichard Henderson     case MO_UB:
134180d9d1c6SRichard Henderson         return ldub_p(haddr);
134280d9d1c6SRichard Henderson     case MO_BEUW:
134380d9d1c6SRichard Henderson         return lduw_be_p(haddr);
134480d9d1c6SRichard Henderson     case MO_LEUW:
134580d9d1c6SRichard Henderson         return lduw_le_p(haddr);
134680d9d1c6SRichard Henderson     case MO_BEUL:
134780d9d1c6SRichard Henderson         return (uint32_t)ldl_be_p(haddr);
134880d9d1c6SRichard Henderson     case MO_LEUL:
134980d9d1c6SRichard Henderson         return (uint32_t)ldl_le_p(haddr);
135080d9d1c6SRichard Henderson     case MO_BEQ:
135180d9d1c6SRichard Henderson         return ldq_be_p(haddr);
135280d9d1c6SRichard Henderson     case MO_LEQ:
135380d9d1c6SRichard Henderson         return ldq_le_p(haddr);
135480d9d1c6SRichard Henderson     default:
135580d9d1c6SRichard Henderson         qemu_build_not_reached();
135680d9d1c6SRichard Henderson     }
135780d9d1c6SRichard Henderson }
135880d9d1c6SRichard Henderson 
135980d9d1c6SRichard Henderson static inline uint64_t QEMU_ALWAYS_INLINE
13602dd92606SRichard Henderson load_helper(CPUArchState *env, target_ulong addr, TCGMemOpIdx oi,
1361be5c4787STony Nguyen             uintptr_t retaddr, MemOp op, bool code_read,
13622dd92606SRichard Henderson             FullLoadHelper *full_load)
1363eed56642SAlex Bennée {
1364eed56642SAlex Bennée     uintptr_t mmu_idx = get_mmuidx(oi);
1365eed56642SAlex Bennée     uintptr_t index = tlb_index(env, mmu_idx, addr);
1366eed56642SAlex Bennée     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
1367eed56642SAlex Bennée     target_ulong tlb_addr = code_read ? entry->addr_code : entry->addr_read;
1368eed56642SAlex Bennée     const size_t tlb_off = code_read ?
1369eed56642SAlex Bennée         offsetof(CPUTLBEntry, addr_code) : offsetof(CPUTLBEntry, addr_read);
1370f1be3696SRichard Henderson     const MMUAccessType access_type =
1371f1be3696SRichard Henderson         code_read ? MMU_INST_FETCH : MMU_DATA_LOAD;
1372eed56642SAlex Bennée     unsigned a_bits = get_alignment_bits(get_memop(oi));
1373eed56642SAlex Bennée     void *haddr;
1374eed56642SAlex Bennée     uint64_t res;
1375be5c4787STony Nguyen     size_t size = memop_size(op);
1376d9bb58e5SYang Zhong 
1377eed56642SAlex Bennée     /* Handle CPU specific unaligned behaviour */
1378eed56642SAlex Bennée     if (addr & ((1 << a_bits) - 1)) {
137929a0af61SRichard Henderson         cpu_unaligned_access(env_cpu(env), addr, access_type,
1380eed56642SAlex Bennée                              mmu_idx, retaddr);
1381eed56642SAlex Bennée     }
1382eed56642SAlex Bennée 
1383eed56642SAlex Bennée     /* If the TLB entry is for a different page, reload and try again.  */
1384eed56642SAlex Bennée     if (!tlb_hit(tlb_addr, addr)) {
1385eed56642SAlex Bennée         if (!victim_tlb_hit(env, mmu_idx, index, tlb_off,
1386eed56642SAlex Bennée                             addr & TARGET_PAGE_MASK)) {
138729a0af61SRichard Henderson             tlb_fill(env_cpu(env), addr, size,
1388f1be3696SRichard Henderson                      access_type, mmu_idx, retaddr);
1389eed56642SAlex Bennée             index = tlb_index(env, mmu_idx, addr);
1390eed56642SAlex Bennée             entry = tlb_entry(env, mmu_idx, addr);
1391eed56642SAlex Bennée         }
1392eed56642SAlex Bennée         tlb_addr = code_read ? entry->addr_code : entry->addr_read;
139330d7e098SRichard Henderson         tlb_addr &= ~TLB_INVALID_MASK;
1394eed56642SAlex Bennée     }
1395eed56642SAlex Bennée 
139650b107c5SRichard Henderson     /* Handle anything that isn't just a straight memory access.  */
1397eed56642SAlex Bennée     if (unlikely(tlb_addr & ~TARGET_PAGE_MASK)) {
139850b107c5SRichard Henderson         CPUIOTLBEntry *iotlbentry;
13995b87b3e6SRichard Henderson         bool need_swap;
140050b107c5SRichard Henderson 
140150b107c5SRichard Henderson         /* For anything that is unaligned, recurse through full_load.  */
1402eed56642SAlex Bennée         if ((addr & (size - 1)) != 0) {
1403eed56642SAlex Bennée             goto do_unaligned_access;
1404eed56642SAlex Bennée         }
140550b107c5SRichard Henderson 
140650b107c5SRichard Henderson         iotlbentry = &env_tlb(env)->d[mmu_idx].iotlb[index];
140750b107c5SRichard Henderson 
140850b107c5SRichard Henderson         /* Handle watchpoints.  */
140950b107c5SRichard Henderson         if (unlikely(tlb_addr & TLB_WATCHPOINT)) {
141050b107c5SRichard Henderson             /* On watchpoint hit, this will longjmp out.  */
141150b107c5SRichard Henderson             cpu_check_watchpoint(env_cpu(env), addr, size,
141250b107c5SRichard Henderson                                  iotlbentry->attrs, BP_MEM_READ, retaddr);
14135b87b3e6SRichard Henderson         }
141450b107c5SRichard Henderson 
14155b87b3e6SRichard Henderson         need_swap = size > 1 && (tlb_addr & TLB_BSWAP);
141650b107c5SRichard Henderson 
141750b107c5SRichard Henderson         /* Handle I/O access.  */
14185b87b3e6SRichard Henderson         if (likely(tlb_addr & TLB_MMIO)) {
14195b87b3e6SRichard Henderson             return io_readx(env, iotlbentry, mmu_idx, addr, retaddr,
14205b87b3e6SRichard Henderson                             access_type, op ^ (need_swap * MO_BSWAP));
14215b87b3e6SRichard Henderson         }
14225b87b3e6SRichard Henderson 
14235b87b3e6SRichard Henderson         haddr = (void *)((uintptr_t)addr + entry->addend);
14245b87b3e6SRichard Henderson 
14255b87b3e6SRichard Henderson         /*
14265b87b3e6SRichard Henderson          * Keep these two load_memop separate to ensure that the compiler
14275b87b3e6SRichard Henderson          * is able to fold the entire function to a single instruction.
14285b87b3e6SRichard Henderson          * There is a build-time assert inside to remind you of this.  ;-)
14295b87b3e6SRichard Henderson          */
14305b87b3e6SRichard Henderson         if (unlikely(need_swap)) {
14315b87b3e6SRichard Henderson             return load_memop(haddr, op ^ MO_BSWAP);
14325b87b3e6SRichard Henderson         }
14335b87b3e6SRichard Henderson         return load_memop(haddr, op);
1434eed56642SAlex Bennée     }
1435eed56642SAlex Bennée 
1436eed56642SAlex Bennée     /* Handle slow unaligned access (it spans two pages or IO).  */
1437eed56642SAlex Bennée     if (size > 1
1438eed56642SAlex Bennée         && unlikely((addr & ~TARGET_PAGE_MASK) + size - 1
1439eed56642SAlex Bennée                     >= TARGET_PAGE_SIZE)) {
1440eed56642SAlex Bennée         target_ulong addr1, addr2;
14418c79b288SAlex Bennée         uint64_t r1, r2;
1442eed56642SAlex Bennée         unsigned shift;
1443eed56642SAlex Bennée     do_unaligned_access:
1444ab7a2009SAlex Bennée         addr1 = addr & ~((target_ulong)size - 1);
1445eed56642SAlex Bennée         addr2 = addr1 + size;
14462dd92606SRichard Henderson         r1 = full_load(env, addr1, oi, retaddr);
14472dd92606SRichard Henderson         r2 = full_load(env, addr2, oi, retaddr);
1448eed56642SAlex Bennée         shift = (addr & (size - 1)) * 8;
1449eed56642SAlex Bennée 
1450be5c4787STony Nguyen         if (memop_big_endian(op)) {
1451eed56642SAlex Bennée             /* Big-endian combine.  */
1452eed56642SAlex Bennée             res = (r1 << shift) | (r2 >> ((size * 8) - shift));
1453eed56642SAlex Bennée         } else {
1454eed56642SAlex Bennée             /* Little-endian combine.  */
1455eed56642SAlex Bennée             res = (r1 >> shift) | (r2 << ((size * 8) - shift));
1456eed56642SAlex Bennée         }
1457eed56642SAlex Bennée         return res & MAKE_64BIT_MASK(0, size * 8);
1458eed56642SAlex Bennée     }
1459eed56642SAlex Bennée 
1460eed56642SAlex Bennée     haddr = (void *)((uintptr_t)addr + entry->addend);
146180d9d1c6SRichard Henderson     return load_memop(haddr, op);
1462eed56642SAlex Bennée }
1463eed56642SAlex Bennée 
1464eed56642SAlex Bennée /*
1465eed56642SAlex Bennée  * For the benefit of TCG generated code, we want to avoid the
1466eed56642SAlex Bennée  * complication of ABI-specific return type promotion and always
1467eed56642SAlex Bennée  * return a value extended to the register size of the host. This is
1468eed56642SAlex Bennée  * tcg_target_long, except in the case of a 32-bit host and 64-bit
1469eed56642SAlex Bennée  * data, and for that we always have uint64_t.
1470eed56642SAlex Bennée  *
1471eed56642SAlex Bennée  * We don't bother with this widened value for SOFTMMU_CODE_ACCESS.
1472eed56642SAlex Bennée  */
1473eed56642SAlex Bennée 
14742dd92606SRichard Henderson static uint64_t full_ldub_mmu(CPUArchState *env, target_ulong addr,
14752dd92606SRichard Henderson                               TCGMemOpIdx oi, uintptr_t retaddr)
14762dd92606SRichard Henderson {
1477be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_UB, false, full_ldub_mmu);
14782dd92606SRichard Henderson }
14792dd92606SRichard Henderson 
1480fc1bc777SRichard Henderson tcg_target_ulong helper_ret_ldub_mmu(CPUArchState *env, target_ulong addr,
1481fc1bc777SRichard Henderson                                      TCGMemOpIdx oi, uintptr_t retaddr)
1482eed56642SAlex Bennée {
14832dd92606SRichard Henderson     return full_ldub_mmu(env, addr, oi, retaddr);
14842dd92606SRichard Henderson }
14852dd92606SRichard Henderson 
14862dd92606SRichard Henderson static uint64_t full_le_lduw_mmu(CPUArchState *env, target_ulong addr,
14872dd92606SRichard Henderson                                  TCGMemOpIdx oi, uintptr_t retaddr)
14882dd92606SRichard Henderson {
1489be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEUW, false,
14902dd92606SRichard Henderson                        full_le_lduw_mmu);
1491eed56642SAlex Bennée }
1492eed56642SAlex Bennée 
1493fc1bc777SRichard Henderson tcg_target_ulong helper_le_lduw_mmu(CPUArchState *env, target_ulong addr,
1494fc1bc777SRichard Henderson                                     TCGMemOpIdx oi, uintptr_t retaddr)
1495eed56642SAlex Bennée {
14962dd92606SRichard Henderson     return full_le_lduw_mmu(env, addr, oi, retaddr);
14972dd92606SRichard Henderson }
14982dd92606SRichard Henderson 
14992dd92606SRichard Henderson static uint64_t full_be_lduw_mmu(CPUArchState *env, target_ulong addr,
15002dd92606SRichard Henderson                                  TCGMemOpIdx oi, uintptr_t retaddr)
15012dd92606SRichard Henderson {
1502be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEUW, false,
15032dd92606SRichard Henderson                        full_be_lduw_mmu);
1504eed56642SAlex Bennée }
1505eed56642SAlex Bennée 
1506fc1bc777SRichard Henderson tcg_target_ulong helper_be_lduw_mmu(CPUArchState *env, target_ulong addr,
1507fc1bc777SRichard Henderson                                     TCGMemOpIdx oi, uintptr_t retaddr)
1508eed56642SAlex Bennée {
15092dd92606SRichard Henderson     return full_be_lduw_mmu(env, addr, oi, retaddr);
15102dd92606SRichard Henderson }
15112dd92606SRichard Henderson 
15122dd92606SRichard Henderson static uint64_t full_le_ldul_mmu(CPUArchState *env, target_ulong addr,
15132dd92606SRichard Henderson                                  TCGMemOpIdx oi, uintptr_t retaddr)
15142dd92606SRichard Henderson {
1515be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEUL, false,
15162dd92606SRichard Henderson                        full_le_ldul_mmu);
1517eed56642SAlex Bennée }
1518eed56642SAlex Bennée 
1519fc1bc777SRichard Henderson tcg_target_ulong helper_le_ldul_mmu(CPUArchState *env, target_ulong addr,
1520fc1bc777SRichard Henderson                                     TCGMemOpIdx oi, uintptr_t retaddr)
1521eed56642SAlex Bennée {
15222dd92606SRichard Henderson     return full_le_ldul_mmu(env, addr, oi, retaddr);
15232dd92606SRichard Henderson }
15242dd92606SRichard Henderson 
15252dd92606SRichard Henderson static uint64_t full_be_ldul_mmu(CPUArchState *env, target_ulong addr,
15262dd92606SRichard Henderson                                  TCGMemOpIdx oi, uintptr_t retaddr)
15272dd92606SRichard Henderson {
1528be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEUL, false,
15292dd92606SRichard Henderson                        full_be_ldul_mmu);
1530eed56642SAlex Bennée }
1531eed56642SAlex Bennée 
1532fc1bc777SRichard Henderson tcg_target_ulong helper_be_ldul_mmu(CPUArchState *env, target_ulong addr,
1533fc1bc777SRichard Henderson                                     TCGMemOpIdx oi, uintptr_t retaddr)
1534eed56642SAlex Bennée {
15352dd92606SRichard Henderson     return full_be_ldul_mmu(env, addr, oi, retaddr);
1536eed56642SAlex Bennée }
1537eed56642SAlex Bennée 
1538fc1bc777SRichard Henderson uint64_t helper_le_ldq_mmu(CPUArchState *env, target_ulong addr,
1539fc1bc777SRichard Henderson                            TCGMemOpIdx oi, uintptr_t retaddr)
1540eed56642SAlex Bennée {
1541be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEQ, false,
15422dd92606SRichard Henderson                        helper_le_ldq_mmu);
1543eed56642SAlex Bennée }
1544eed56642SAlex Bennée 
1545fc1bc777SRichard Henderson uint64_t helper_be_ldq_mmu(CPUArchState *env, target_ulong addr,
1546fc1bc777SRichard Henderson                            TCGMemOpIdx oi, uintptr_t retaddr)
1547eed56642SAlex Bennée {
1548be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEQ, false,
15492dd92606SRichard Henderson                        helper_be_ldq_mmu);
1550eed56642SAlex Bennée }
1551eed56642SAlex Bennée 
1552eed56642SAlex Bennée /*
1553eed56642SAlex Bennée  * Provide signed versions of the load routines as well.  We can of course
1554eed56642SAlex Bennée  * avoid this for 64-bit data, or for 32-bit data on 32-bit host.
1555eed56642SAlex Bennée  */
1556eed56642SAlex Bennée 
1557eed56642SAlex Bennée 
1558eed56642SAlex Bennée tcg_target_ulong helper_ret_ldsb_mmu(CPUArchState *env, target_ulong addr,
1559eed56642SAlex Bennée                                      TCGMemOpIdx oi, uintptr_t retaddr)
1560eed56642SAlex Bennée {
1561eed56642SAlex Bennée     return (int8_t)helper_ret_ldub_mmu(env, addr, oi, retaddr);
1562eed56642SAlex Bennée }
1563eed56642SAlex Bennée 
1564eed56642SAlex Bennée tcg_target_ulong helper_le_ldsw_mmu(CPUArchState *env, target_ulong addr,
1565eed56642SAlex Bennée                                     TCGMemOpIdx oi, uintptr_t retaddr)
1566eed56642SAlex Bennée {
1567eed56642SAlex Bennée     return (int16_t)helper_le_lduw_mmu(env, addr, oi, retaddr);
1568eed56642SAlex Bennée }
1569eed56642SAlex Bennée 
1570eed56642SAlex Bennée tcg_target_ulong helper_be_ldsw_mmu(CPUArchState *env, target_ulong addr,
1571eed56642SAlex Bennée                                     TCGMemOpIdx oi, uintptr_t retaddr)
1572eed56642SAlex Bennée {
1573eed56642SAlex Bennée     return (int16_t)helper_be_lduw_mmu(env, addr, oi, retaddr);
1574eed56642SAlex Bennée }
1575eed56642SAlex Bennée 
1576eed56642SAlex Bennée tcg_target_ulong helper_le_ldsl_mmu(CPUArchState *env, target_ulong addr,
1577eed56642SAlex Bennée                                     TCGMemOpIdx oi, uintptr_t retaddr)
1578eed56642SAlex Bennée {
1579eed56642SAlex Bennée     return (int32_t)helper_le_ldul_mmu(env, addr, oi, retaddr);
1580eed56642SAlex Bennée }
1581eed56642SAlex Bennée 
1582eed56642SAlex Bennée tcg_target_ulong helper_be_ldsl_mmu(CPUArchState *env, target_ulong addr,
1583eed56642SAlex Bennée                                     TCGMemOpIdx oi, uintptr_t retaddr)
1584eed56642SAlex Bennée {
1585eed56642SAlex Bennée     return (int32_t)helper_be_ldul_mmu(env, addr, oi, retaddr);
1586eed56642SAlex Bennée }
1587eed56642SAlex Bennée 
1588eed56642SAlex Bennée /*
1589eed56642SAlex Bennée  * Store Helpers
1590eed56642SAlex Bennée  */
1591eed56642SAlex Bennée 
1592c6b716cdSRichard Henderson static inline void QEMU_ALWAYS_INLINE
159380d9d1c6SRichard Henderson store_memop(void *haddr, uint64_t val, MemOp op)
159480d9d1c6SRichard Henderson {
159580d9d1c6SRichard Henderson     switch (op) {
159680d9d1c6SRichard Henderson     case MO_UB:
159780d9d1c6SRichard Henderson         stb_p(haddr, val);
159880d9d1c6SRichard Henderson         break;
159980d9d1c6SRichard Henderson     case MO_BEUW:
160080d9d1c6SRichard Henderson         stw_be_p(haddr, val);
160180d9d1c6SRichard Henderson         break;
160280d9d1c6SRichard Henderson     case MO_LEUW:
160380d9d1c6SRichard Henderson         stw_le_p(haddr, val);
160480d9d1c6SRichard Henderson         break;
160580d9d1c6SRichard Henderson     case MO_BEUL:
160680d9d1c6SRichard Henderson         stl_be_p(haddr, val);
160780d9d1c6SRichard Henderson         break;
160880d9d1c6SRichard Henderson     case MO_LEUL:
160980d9d1c6SRichard Henderson         stl_le_p(haddr, val);
161080d9d1c6SRichard Henderson         break;
161180d9d1c6SRichard Henderson     case MO_BEQ:
161280d9d1c6SRichard Henderson         stq_be_p(haddr, val);
161380d9d1c6SRichard Henderson         break;
161480d9d1c6SRichard Henderson     case MO_LEQ:
161580d9d1c6SRichard Henderson         stq_le_p(haddr, val);
161680d9d1c6SRichard Henderson         break;
161780d9d1c6SRichard Henderson     default:
161880d9d1c6SRichard Henderson         qemu_build_not_reached();
161980d9d1c6SRichard Henderson     }
162080d9d1c6SRichard Henderson }
162180d9d1c6SRichard Henderson 
162280d9d1c6SRichard Henderson static inline void QEMU_ALWAYS_INLINE
16234601f8d1SRichard Henderson store_helper(CPUArchState *env, target_ulong addr, uint64_t val,
1624be5c4787STony Nguyen              TCGMemOpIdx oi, uintptr_t retaddr, MemOp op)
1625eed56642SAlex Bennée {
1626eed56642SAlex Bennée     uintptr_t mmu_idx = get_mmuidx(oi);
1627eed56642SAlex Bennée     uintptr_t index = tlb_index(env, mmu_idx, addr);
1628eed56642SAlex Bennée     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
1629eed56642SAlex Bennée     target_ulong tlb_addr = tlb_addr_write(entry);
1630eed56642SAlex Bennée     const size_t tlb_off = offsetof(CPUTLBEntry, addr_write);
1631eed56642SAlex Bennée     unsigned a_bits = get_alignment_bits(get_memop(oi));
1632eed56642SAlex Bennée     void *haddr;
1633be5c4787STony Nguyen     size_t size = memop_size(op);
1634eed56642SAlex Bennée 
1635eed56642SAlex Bennée     /* Handle CPU specific unaligned behaviour */
1636eed56642SAlex Bennée     if (addr & ((1 << a_bits) - 1)) {
163729a0af61SRichard Henderson         cpu_unaligned_access(env_cpu(env), addr, MMU_DATA_STORE,
1638eed56642SAlex Bennée                              mmu_idx, retaddr);
1639eed56642SAlex Bennée     }
1640eed56642SAlex Bennée 
1641eed56642SAlex Bennée     /* If the TLB entry is for a different page, reload and try again.  */
1642eed56642SAlex Bennée     if (!tlb_hit(tlb_addr, addr)) {
1643eed56642SAlex Bennée         if (!victim_tlb_hit(env, mmu_idx, index, tlb_off,
1644eed56642SAlex Bennée             addr & TARGET_PAGE_MASK)) {
164529a0af61SRichard Henderson             tlb_fill(env_cpu(env), addr, size, MMU_DATA_STORE,
1646eed56642SAlex Bennée                      mmu_idx, retaddr);
1647eed56642SAlex Bennée             index = tlb_index(env, mmu_idx, addr);
1648eed56642SAlex Bennée             entry = tlb_entry(env, mmu_idx, addr);
1649eed56642SAlex Bennée         }
1650eed56642SAlex Bennée         tlb_addr = tlb_addr_write(entry) & ~TLB_INVALID_MASK;
1651eed56642SAlex Bennée     }
1652eed56642SAlex Bennée 
165350b107c5SRichard Henderson     /* Handle anything that isn't just a straight memory access.  */
1654eed56642SAlex Bennée     if (unlikely(tlb_addr & ~TARGET_PAGE_MASK)) {
165550b107c5SRichard Henderson         CPUIOTLBEntry *iotlbentry;
16565b87b3e6SRichard Henderson         bool need_swap;
165750b107c5SRichard Henderson 
165850b107c5SRichard Henderson         /* For anything that is unaligned, recurse through byte stores.  */
1659eed56642SAlex Bennée         if ((addr & (size - 1)) != 0) {
1660eed56642SAlex Bennée             goto do_unaligned_access;
1661eed56642SAlex Bennée         }
166250b107c5SRichard Henderson 
166350b107c5SRichard Henderson         iotlbentry = &env_tlb(env)->d[mmu_idx].iotlb[index];
166450b107c5SRichard Henderson 
166550b107c5SRichard Henderson         /* Handle watchpoints.  */
166650b107c5SRichard Henderson         if (unlikely(tlb_addr & TLB_WATCHPOINT)) {
166750b107c5SRichard Henderson             /* On watchpoint hit, this will longjmp out.  */
166850b107c5SRichard Henderson             cpu_check_watchpoint(env_cpu(env), addr, size,
166950b107c5SRichard Henderson                                  iotlbentry->attrs, BP_MEM_WRITE, retaddr);
16705b87b3e6SRichard Henderson         }
167150b107c5SRichard Henderson 
16725b87b3e6SRichard Henderson         need_swap = size > 1 && (tlb_addr & TLB_BSWAP);
167350b107c5SRichard Henderson 
167450b107c5SRichard Henderson         /* Handle I/O access.  */
167508565552SRichard Henderson         if (tlb_addr & TLB_MMIO) {
16765b87b3e6SRichard Henderson             io_writex(env, iotlbentry, mmu_idx, val, addr, retaddr,
16775b87b3e6SRichard Henderson                       op ^ (need_swap * MO_BSWAP));
16785b87b3e6SRichard Henderson             return;
16795b87b3e6SRichard Henderson         }
16805b87b3e6SRichard Henderson 
16817b0d792cSRichard Henderson         /* Ignore writes to ROM.  */
16827b0d792cSRichard Henderson         if (unlikely(tlb_addr & TLB_DISCARD_WRITE)) {
16837b0d792cSRichard Henderson             return;
16847b0d792cSRichard Henderson         }
16857b0d792cSRichard Henderson 
168608565552SRichard Henderson         /* Handle clean RAM pages.  */
168708565552SRichard Henderson         if (tlb_addr & TLB_NOTDIRTY) {
1688707526adSRichard Henderson             notdirty_write(env_cpu(env), addr, size, iotlbentry, retaddr);
168908565552SRichard Henderson         }
169008565552SRichard Henderson 
1691707526adSRichard Henderson         haddr = (void *)((uintptr_t)addr + entry->addend);
169208565552SRichard Henderson 
16935b87b3e6SRichard Henderson         /*
16945b87b3e6SRichard Henderson          * Keep these two store_memop separate to ensure that the compiler
16955b87b3e6SRichard Henderson          * is able to fold the entire function to a single instruction.
16965b87b3e6SRichard Henderson          * There is a build-time assert inside to remind you of this.  ;-)
16975b87b3e6SRichard Henderson          */
16985b87b3e6SRichard Henderson         if (unlikely(need_swap)) {
16995b87b3e6SRichard Henderson             store_memop(haddr, val, op ^ MO_BSWAP);
17005b87b3e6SRichard Henderson         } else {
17015b87b3e6SRichard Henderson             store_memop(haddr, val, op);
17025b87b3e6SRichard Henderson         }
1703eed56642SAlex Bennée         return;
1704eed56642SAlex Bennée     }
1705eed56642SAlex Bennée 
1706eed56642SAlex Bennée     /* Handle slow unaligned access (it spans two pages or IO).  */
1707eed56642SAlex Bennée     if (size > 1
1708eed56642SAlex Bennée         && unlikely((addr & ~TARGET_PAGE_MASK) + size - 1
1709eed56642SAlex Bennée                      >= TARGET_PAGE_SIZE)) {
1710eed56642SAlex Bennée         int i;
1711eed56642SAlex Bennée         uintptr_t index2;
1712eed56642SAlex Bennée         CPUTLBEntry *entry2;
1713eed56642SAlex Bennée         target_ulong page2, tlb_addr2;
17148f7cd2adSRichard Henderson         size_t size2;
17158f7cd2adSRichard Henderson 
1716eed56642SAlex Bennée     do_unaligned_access:
1717eed56642SAlex Bennée         /*
1718eed56642SAlex Bennée          * Ensure the second page is in the TLB.  Note that the first page
1719eed56642SAlex Bennée          * is already guaranteed to be filled, and that the second page
1720eed56642SAlex Bennée          * cannot evict the first.
1721eed56642SAlex Bennée          */
1722eed56642SAlex Bennée         page2 = (addr + size) & TARGET_PAGE_MASK;
17238f7cd2adSRichard Henderson         size2 = (addr + size) & ~TARGET_PAGE_MASK;
1724eed56642SAlex Bennée         index2 = tlb_index(env, mmu_idx, page2);
1725eed56642SAlex Bennée         entry2 = tlb_entry(env, mmu_idx, page2);
1726eed56642SAlex Bennée         tlb_addr2 = tlb_addr_write(entry2);
172750b107c5SRichard Henderson         if (!tlb_hit_page(tlb_addr2, page2)) {
172850b107c5SRichard Henderson             if (!victim_tlb_hit(env, mmu_idx, index2, tlb_off, page2)) {
17298f7cd2adSRichard Henderson                 tlb_fill(env_cpu(env), page2, size2, MMU_DATA_STORE,
1730eed56642SAlex Bennée                          mmu_idx, retaddr);
173150b107c5SRichard Henderson                 index2 = tlb_index(env, mmu_idx, page2);
173250b107c5SRichard Henderson                 entry2 = tlb_entry(env, mmu_idx, page2);
173350b107c5SRichard Henderson             }
173450b107c5SRichard Henderson             tlb_addr2 = tlb_addr_write(entry2);
173550b107c5SRichard Henderson         }
173650b107c5SRichard Henderson 
173750b107c5SRichard Henderson         /*
173850b107c5SRichard Henderson          * Handle watchpoints.  Since this may trap, all checks
173950b107c5SRichard Henderson          * must happen before any store.
174050b107c5SRichard Henderson          */
174150b107c5SRichard Henderson         if (unlikely(tlb_addr & TLB_WATCHPOINT)) {
174250b107c5SRichard Henderson             cpu_check_watchpoint(env_cpu(env), addr, size - size2,
174350b107c5SRichard Henderson                                  env_tlb(env)->d[mmu_idx].iotlb[index].attrs,
174450b107c5SRichard Henderson                                  BP_MEM_WRITE, retaddr);
174550b107c5SRichard Henderson         }
174650b107c5SRichard Henderson         if (unlikely(tlb_addr2 & TLB_WATCHPOINT)) {
174750b107c5SRichard Henderson             cpu_check_watchpoint(env_cpu(env), page2, size2,
174850b107c5SRichard Henderson                                  env_tlb(env)->d[mmu_idx].iotlb[index2].attrs,
174950b107c5SRichard Henderson                                  BP_MEM_WRITE, retaddr);
1750eed56642SAlex Bennée         }
1751eed56642SAlex Bennée 
1752eed56642SAlex Bennée         /*
1753eed56642SAlex Bennée          * XXX: not efficient, but simple.
1754eed56642SAlex Bennée          * This loop must go in the forward direction to avoid issues
1755eed56642SAlex Bennée          * with self-modifying code in Windows 64-bit.
1756eed56642SAlex Bennée          */
1757eed56642SAlex Bennée         for (i = 0; i < size; ++i) {
1758eed56642SAlex Bennée             uint8_t val8;
1759be5c4787STony Nguyen             if (memop_big_endian(op)) {
1760eed56642SAlex Bennée                 /* Big-endian extract.  */
1761eed56642SAlex Bennée                 val8 = val >> (((size - 1) * 8) - (i * 8));
1762eed56642SAlex Bennée             } else {
1763eed56642SAlex Bennée                 /* Little-endian extract.  */
1764eed56642SAlex Bennée                 val8 = val >> (i * 8);
1765eed56642SAlex Bennée             }
17664601f8d1SRichard Henderson             helper_ret_stb_mmu(env, addr + i, val8, oi, retaddr);
1767eed56642SAlex Bennée         }
1768eed56642SAlex Bennée         return;
1769eed56642SAlex Bennée     }
1770eed56642SAlex Bennée 
1771eed56642SAlex Bennée     haddr = (void *)((uintptr_t)addr + entry->addend);
177280d9d1c6SRichard Henderson     store_memop(haddr, val, op);
1773eed56642SAlex Bennée }
1774eed56642SAlex Bennée 
1775fc1bc777SRichard Henderson void helper_ret_stb_mmu(CPUArchState *env, target_ulong addr, uint8_t val,
1776eed56642SAlex Bennée                         TCGMemOpIdx oi, uintptr_t retaddr)
1777eed56642SAlex Bennée {
1778be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_UB);
1779eed56642SAlex Bennée }
1780eed56642SAlex Bennée 
1781fc1bc777SRichard Henderson void helper_le_stw_mmu(CPUArchState *env, target_ulong addr, uint16_t val,
1782eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1783eed56642SAlex Bennée {
1784be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_LEUW);
1785eed56642SAlex Bennée }
1786eed56642SAlex Bennée 
1787fc1bc777SRichard Henderson void helper_be_stw_mmu(CPUArchState *env, target_ulong addr, uint16_t val,
1788eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1789eed56642SAlex Bennée {
1790be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_BEUW);
1791eed56642SAlex Bennée }
1792eed56642SAlex Bennée 
1793fc1bc777SRichard Henderson void helper_le_stl_mmu(CPUArchState *env, target_ulong addr, uint32_t val,
1794eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1795eed56642SAlex Bennée {
1796be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_LEUL);
1797eed56642SAlex Bennée }
1798eed56642SAlex Bennée 
1799fc1bc777SRichard Henderson void helper_be_stl_mmu(CPUArchState *env, target_ulong addr, uint32_t val,
1800eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1801eed56642SAlex Bennée {
1802be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_BEUL);
1803eed56642SAlex Bennée }
1804eed56642SAlex Bennée 
1805fc1bc777SRichard Henderson void helper_le_stq_mmu(CPUArchState *env, target_ulong addr, uint64_t val,
1806eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1807eed56642SAlex Bennée {
1808be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_LEQ);
1809eed56642SAlex Bennée }
1810eed56642SAlex Bennée 
1811fc1bc777SRichard Henderson void helper_be_stq_mmu(CPUArchState *env, target_ulong addr, uint64_t val,
1812eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1813eed56642SAlex Bennée {
1814be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_BEQ);
1815eed56642SAlex Bennée }
1816d9bb58e5SYang Zhong 
1817d9bb58e5SYang Zhong /* First set of helpers allows passing in of OI and RETADDR.  This makes
1818d9bb58e5SYang Zhong    them callable from other helpers.  */
1819d9bb58e5SYang Zhong 
1820d9bb58e5SYang Zhong #define EXTRA_ARGS     , TCGMemOpIdx oi, uintptr_t retaddr
1821d9bb58e5SYang Zhong #define ATOMIC_NAME(X) \
1822d9bb58e5SYang Zhong     HELPER(glue(glue(glue(atomic_ ## X, SUFFIX), END), _mmu))
1823707526adSRichard Henderson #define ATOMIC_MMU_DECLS
1824707526adSRichard Henderson #define ATOMIC_MMU_LOOKUP atomic_mmu_lookup(env, addr, oi, retaddr)
1825707526adSRichard Henderson #define ATOMIC_MMU_CLEANUP
1826504f73f7SAlex Bennée #define ATOMIC_MMU_IDX   get_mmuidx(oi)
1827d9bb58e5SYang Zhong 
1828d9bb58e5SYang Zhong #define DATA_SIZE 1
1829d9bb58e5SYang Zhong #include "atomic_template.h"
1830d9bb58e5SYang Zhong 
1831d9bb58e5SYang Zhong #define DATA_SIZE 2
1832d9bb58e5SYang Zhong #include "atomic_template.h"
1833d9bb58e5SYang Zhong 
1834d9bb58e5SYang Zhong #define DATA_SIZE 4
1835d9bb58e5SYang Zhong #include "atomic_template.h"
1836d9bb58e5SYang Zhong 
1837d9bb58e5SYang Zhong #ifdef CONFIG_ATOMIC64
1838d9bb58e5SYang Zhong #define DATA_SIZE 8
1839d9bb58e5SYang Zhong #include "atomic_template.h"
1840d9bb58e5SYang Zhong #endif
1841d9bb58e5SYang Zhong 
1842e6cd4bb5SRichard Henderson #if HAVE_CMPXCHG128 || HAVE_ATOMIC128
1843d9bb58e5SYang Zhong #define DATA_SIZE 16
1844d9bb58e5SYang Zhong #include "atomic_template.h"
1845d9bb58e5SYang Zhong #endif
1846d9bb58e5SYang Zhong 
1847d9bb58e5SYang Zhong /* Second set of helpers are directly callable from TCG as helpers.  */
1848d9bb58e5SYang Zhong 
1849d9bb58e5SYang Zhong #undef EXTRA_ARGS
1850d9bb58e5SYang Zhong #undef ATOMIC_NAME
1851d9bb58e5SYang Zhong #undef ATOMIC_MMU_LOOKUP
1852d9bb58e5SYang Zhong #define EXTRA_ARGS         , TCGMemOpIdx oi
1853d9bb58e5SYang Zhong #define ATOMIC_NAME(X)     HELPER(glue(glue(atomic_ ## X, SUFFIX), END))
1854707526adSRichard Henderson #define ATOMIC_MMU_LOOKUP  atomic_mmu_lookup(env, addr, oi, GETPC())
1855d9bb58e5SYang Zhong 
1856d9bb58e5SYang Zhong #define DATA_SIZE 1
1857d9bb58e5SYang Zhong #include "atomic_template.h"
1858d9bb58e5SYang Zhong 
1859d9bb58e5SYang Zhong #define DATA_SIZE 2
1860d9bb58e5SYang Zhong #include "atomic_template.h"
1861d9bb58e5SYang Zhong 
1862d9bb58e5SYang Zhong #define DATA_SIZE 4
1863d9bb58e5SYang Zhong #include "atomic_template.h"
1864d9bb58e5SYang Zhong 
1865d9bb58e5SYang Zhong #ifdef CONFIG_ATOMIC64
1866d9bb58e5SYang Zhong #define DATA_SIZE 8
1867d9bb58e5SYang Zhong #include "atomic_template.h"
1868d9bb58e5SYang Zhong #endif
1869504f73f7SAlex Bennée #undef ATOMIC_MMU_IDX
1870d9bb58e5SYang Zhong 
1871d9bb58e5SYang Zhong /* Code access functions.  */
1872d9bb58e5SYang Zhong 
18732dd92606SRichard Henderson static uint64_t full_ldub_cmmu(CPUArchState *env, target_ulong addr,
18742dd92606SRichard Henderson                                TCGMemOpIdx oi, uintptr_t retaddr)
18752dd92606SRichard Henderson {
1876be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_8, true, full_ldub_cmmu);
18772dd92606SRichard Henderson }
18782dd92606SRichard Henderson 
1879fc1bc777SRichard Henderson uint8_t helper_ret_ldb_cmmu(CPUArchState *env, target_ulong addr,
1880fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1881eed56642SAlex Bennée {
18822dd92606SRichard Henderson     return full_ldub_cmmu(env, addr, oi, retaddr);
18832dd92606SRichard Henderson }
18842dd92606SRichard Henderson 
18852dd92606SRichard Henderson static uint64_t full_le_lduw_cmmu(CPUArchState *env, target_ulong addr,
18862dd92606SRichard Henderson                                   TCGMemOpIdx oi, uintptr_t retaddr)
18872dd92606SRichard Henderson {
1888be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEUW, true,
18892dd92606SRichard Henderson                        full_le_lduw_cmmu);
1890eed56642SAlex Bennée }
1891d9bb58e5SYang Zhong 
1892fc1bc777SRichard Henderson uint16_t helper_le_ldw_cmmu(CPUArchState *env, target_ulong addr,
1893fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1894eed56642SAlex Bennée {
18952dd92606SRichard Henderson     return full_le_lduw_cmmu(env, addr, oi, retaddr);
18962dd92606SRichard Henderson }
18972dd92606SRichard Henderson 
18982dd92606SRichard Henderson static uint64_t full_be_lduw_cmmu(CPUArchState *env, target_ulong addr,
18992dd92606SRichard Henderson                                   TCGMemOpIdx oi, uintptr_t retaddr)
19002dd92606SRichard Henderson {
1901be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEUW, true,
19022dd92606SRichard Henderson                        full_be_lduw_cmmu);
1903eed56642SAlex Bennée }
1904d9bb58e5SYang Zhong 
1905fc1bc777SRichard Henderson uint16_t helper_be_ldw_cmmu(CPUArchState *env, target_ulong addr,
1906fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1907eed56642SAlex Bennée {
19082dd92606SRichard Henderson     return full_be_lduw_cmmu(env, addr, oi, retaddr);
19092dd92606SRichard Henderson }
19102dd92606SRichard Henderson 
19112dd92606SRichard Henderson static uint64_t full_le_ldul_cmmu(CPUArchState *env, target_ulong addr,
19122dd92606SRichard Henderson                                   TCGMemOpIdx oi, uintptr_t retaddr)
19132dd92606SRichard Henderson {
1914be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEUL, true,
19152dd92606SRichard Henderson                        full_le_ldul_cmmu);
1916eed56642SAlex Bennée }
1917d9bb58e5SYang Zhong 
1918fc1bc777SRichard Henderson uint32_t helper_le_ldl_cmmu(CPUArchState *env, target_ulong addr,
1919fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1920eed56642SAlex Bennée {
19212dd92606SRichard Henderson     return full_le_ldul_cmmu(env, addr, oi, retaddr);
19222dd92606SRichard Henderson }
19232dd92606SRichard Henderson 
19242dd92606SRichard Henderson static uint64_t full_be_ldul_cmmu(CPUArchState *env, target_ulong addr,
19252dd92606SRichard Henderson                                   TCGMemOpIdx oi, uintptr_t retaddr)
19262dd92606SRichard Henderson {
1927be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEUL, true,
19282dd92606SRichard Henderson                        full_be_ldul_cmmu);
1929eed56642SAlex Bennée }
1930d9bb58e5SYang Zhong 
1931fc1bc777SRichard Henderson uint32_t helper_be_ldl_cmmu(CPUArchState *env, target_ulong addr,
1932fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1933eed56642SAlex Bennée {
19342dd92606SRichard Henderson     return full_be_ldul_cmmu(env, addr, oi, retaddr);
1935eed56642SAlex Bennée }
1936eed56642SAlex Bennée 
1937fc1bc777SRichard Henderson uint64_t helper_le_ldq_cmmu(CPUArchState *env, target_ulong addr,
1938fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1939eed56642SAlex Bennée {
1940be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEQ, true,
19412dd92606SRichard Henderson                        helper_le_ldq_cmmu);
1942eed56642SAlex Bennée }
1943eed56642SAlex Bennée 
1944fc1bc777SRichard Henderson uint64_t helper_be_ldq_cmmu(CPUArchState *env, target_ulong addr,
1945fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1946eed56642SAlex Bennée {
1947be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEQ, true,
19482dd92606SRichard Henderson                        helper_be_ldq_cmmu);
1949eed56642SAlex Bennée }
1950