xref: /openbmc/qemu/accel/tcg/cputlb.c (revision 4cef72d0425c34cca05f1df9796bd57a96318310)
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  */
1054f2553f04SKONRAD Frederic tb_page_addr_t get_page_addr_code(CPUArchState *env, target_ulong addr)
1055f2553f04SKONRAD Frederic {
1056383beda9SRichard Henderson     uintptr_t mmu_idx = cpu_mmu_index(env, true);
1057383beda9SRichard Henderson     uintptr_t index = tlb_index(env, mmu_idx, addr);
1058383beda9SRichard Henderson     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
1059f2553f04SKONRAD Frederic     void *p;
1060f2553f04SKONRAD Frederic 
1061383beda9SRichard Henderson     if (unlikely(!tlb_hit(entry->addr_code, addr))) {
1062b493ccf1SPeter Maydell         if (!VICTIM_TLB_HIT(addr_code, addr)) {
106329a0af61SRichard Henderson             tlb_fill(env_cpu(env), addr, 0, MMU_INST_FETCH, mmu_idx, 0);
10646d967cb8SEmilio G. Cota             index = tlb_index(env, mmu_idx, addr);
10656d967cb8SEmilio G. Cota             entry = tlb_entry(env, mmu_idx, addr);
106630d7e098SRichard Henderson 
106730d7e098SRichard Henderson             if (unlikely(entry->addr_code & TLB_INVALID_MASK)) {
106830d7e098SRichard Henderson                 /*
106930d7e098SRichard Henderson                  * The MMU protection covers a smaller range than a target
107030d7e098SRichard Henderson                  * page, so we must redo the MMU check for every insn.
107130d7e098SRichard Henderson                  */
107230d7e098SRichard Henderson                 return -1;
107330d7e098SRichard Henderson             }
107471b9a453SKONRAD Frederic         }
1075383beda9SRichard Henderson         assert(tlb_hit(entry->addr_code, addr));
1076f2553f04SKONRAD Frederic     }
107755df6fcfSPeter Maydell 
107830d7e098SRichard Henderson     if (unlikely(entry->addr_code & TLB_MMIO)) {
107930d7e098SRichard Henderson         /* The region is not backed by RAM.  */
108020cb6ae4SPeter Maydell         return -1;
108155df6fcfSPeter Maydell     }
108255df6fcfSPeter Maydell 
1083383beda9SRichard Henderson     p = (void *)((uintptr_t)addr + entry->addend);
1084f2553f04SKONRAD Frederic     return qemu_ram_addr_from_host_nofail(p);
1085f2553f04SKONRAD Frederic }
1086f2553f04SKONRAD Frederic 
1087707526adSRichard Henderson static void notdirty_write(CPUState *cpu, vaddr mem_vaddr, unsigned size,
1088707526adSRichard Henderson                            CPUIOTLBEntry *iotlbentry, uintptr_t retaddr)
1089707526adSRichard Henderson {
1090707526adSRichard Henderson     ram_addr_t ram_addr = mem_vaddr + iotlbentry->addr;
1091707526adSRichard Henderson 
1092707526adSRichard Henderson     trace_memory_notdirty_write_access(mem_vaddr, ram_addr, size);
1093707526adSRichard Henderson 
1094707526adSRichard Henderson     if (!cpu_physical_memory_get_dirty_flag(ram_addr, DIRTY_MEMORY_CODE)) {
1095707526adSRichard Henderson         struct page_collection *pages
1096707526adSRichard Henderson             = page_collection_lock(ram_addr, ram_addr + size);
10975a7c27bbSRichard Henderson         tb_invalidate_phys_page_fast(pages, ram_addr, size, retaddr);
1098707526adSRichard Henderson         page_collection_unlock(pages);
1099707526adSRichard Henderson     }
1100707526adSRichard Henderson 
1101707526adSRichard Henderson     /*
1102707526adSRichard Henderson      * Set both VGA and migration bits for simplicity and to remove
1103707526adSRichard Henderson      * the notdirty callback faster.
1104707526adSRichard Henderson      */
1105707526adSRichard Henderson     cpu_physical_memory_set_dirty_range(ram_addr, size, DIRTY_CLIENTS_NOCODE);
1106707526adSRichard Henderson 
1107707526adSRichard Henderson     /* We remove the notdirty callback only if the code has been flushed. */
1108707526adSRichard Henderson     if (!cpu_physical_memory_is_clean(ram_addr)) {
1109707526adSRichard Henderson         trace_memory_notdirty_set_dirty(mem_vaddr);
1110707526adSRichard Henderson         tlb_set_dirty(cpu, mem_vaddr);
1111707526adSRichard Henderson     }
1112707526adSRichard Henderson }
1113707526adSRichard Henderson 
1114c25c283dSDavid Hildenbrand /*
1115c25c283dSDavid Hildenbrand  * Probe for whether the specified guest access is permitted. If it is not
1116c25c283dSDavid Hildenbrand  * permitted then an exception will be taken in the same way as if this
1117c25c283dSDavid Hildenbrand  * were a real access (and we will not return).
1118fef39ccdSDavid Hildenbrand  * If the size is 0 or the page requires I/O access, returns NULL; otherwise,
1119fef39ccdSDavid Hildenbrand  * returns the address of the host page similar to tlb_vaddr_to_host().
1120d9bb58e5SYang Zhong  */
1121c25c283dSDavid Hildenbrand void *probe_access(CPUArchState *env, target_ulong addr, int size,
1122c25c283dSDavid Hildenbrand                    MMUAccessType access_type, int mmu_idx, uintptr_t retaddr)
1123d9bb58e5SYang Zhong {
1124383beda9SRichard Henderson     uintptr_t index = tlb_index(env, mmu_idx, addr);
1125383beda9SRichard Henderson     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
1126c25c283dSDavid Hildenbrand     target_ulong tlb_addr;
1127c25c283dSDavid Hildenbrand     size_t elt_ofs;
1128c25c283dSDavid Hildenbrand     int wp_access;
1129d9bb58e5SYang Zhong 
1130ca86cf32SDavid Hildenbrand     g_assert(-(addr | TARGET_PAGE_MASK) >= size);
1131ca86cf32SDavid Hildenbrand 
1132c25c283dSDavid Hildenbrand     switch (access_type) {
1133c25c283dSDavid Hildenbrand     case MMU_DATA_LOAD:
1134c25c283dSDavid Hildenbrand         elt_ofs = offsetof(CPUTLBEntry, addr_read);
1135c25c283dSDavid Hildenbrand         wp_access = BP_MEM_READ;
1136c25c283dSDavid Hildenbrand         break;
1137c25c283dSDavid Hildenbrand     case MMU_DATA_STORE:
1138c25c283dSDavid Hildenbrand         elt_ofs = offsetof(CPUTLBEntry, addr_write);
1139c25c283dSDavid Hildenbrand         wp_access = BP_MEM_WRITE;
1140c25c283dSDavid Hildenbrand         break;
1141c25c283dSDavid Hildenbrand     case MMU_INST_FETCH:
1142c25c283dSDavid Hildenbrand         elt_ofs = offsetof(CPUTLBEntry, addr_code);
1143c25c283dSDavid Hildenbrand         wp_access = BP_MEM_READ;
1144c25c283dSDavid Hildenbrand         break;
1145c25c283dSDavid Hildenbrand     default:
1146c25c283dSDavid Hildenbrand         g_assert_not_reached();
1147c25c283dSDavid Hildenbrand     }
1148c25c283dSDavid Hildenbrand     tlb_addr = tlb_read_ofs(entry, elt_ofs);
1149c25c283dSDavid Hildenbrand 
115003a98189SDavid Hildenbrand     if (unlikely(!tlb_hit(tlb_addr, addr))) {
1151c25c283dSDavid Hildenbrand         if (!victim_tlb_hit(env, mmu_idx, index, elt_ofs,
1152c25c283dSDavid Hildenbrand                             addr & TARGET_PAGE_MASK)) {
1153c25c283dSDavid Hildenbrand             tlb_fill(env_cpu(env), addr, size, access_type, mmu_idx, retaddr);
115403a98189SDavid Hildenbrand             /* TLB resize via tlb_fill may have moved the entry. */
115503a98189SDavid Hildenbrand             index = tlb_index(env, mmu_idx, addr);
115603a98189SDavid Hildenbrand             entry = tlb_entry(env, mmu_idx, addr);
1157d9bb58e5SYang Zhong         }
1158c25c283dSDavid Hildenbrand         tlb_addr = tlb_read_ofs(entry, elt_ofs);
115903a98189SDavid Hildenbrand     }
116003a98189SDavid Hildenbrand 
1161fef39ccdSDavid Hildenbrand     if (!size) {
1162fef39ccdSDavid Hildenbrand         return NULL;
1163fef39ccdSDavid Hildenbrand     }
1164fef39ccdSDavid Hildenbrand 
116573bc0bd4SRichard Henderson     if (unlikely(tlb_addr & TLB_FLAGS_MASK)) {
116673bc0bd4SRichard Henderson         CPUIOTLBEntry *iotlbentry = &env_tlb(env)->d[mmu_idx].iotlb[index];
116773bc0bd4SRichard Henderson 
116873bc0bd4SRichard Henderson         /* Reject I/O access, or other required slow-path.  */
116973bc0bd4SRichard Henderson         if (tlb_addr & (TLB_MMIO | TLB_BSWAP | TLB_DISCARD_WRITE)) {
117073bc0bd4SRichard Henderson             return NULL;
117173bc0bd4SRichard Henderson         }
117273bc0bd4SRichard Henderson 
117303a98189SDavid Hildenbrand         /* Handle watchpoints.  */
1174fef39ccdSDavid Hildenbrand         if (tlb_addr & TLB_WATCHPOINT) {
117503a98189SDavid Hildenbrand             cpu_check_watchpoint(env_cpu(env), addr, size,
117673bc0bd4SRichard Henderson                                  iotlbentry->attrs, wp_access, retaddr);
1177d9bb58e5SYang Zhong         }
1178fef39ccdSDavid Hildenbrand 
117973bc0bd4SRichard Henderson         /* Handle clean RAM pages.  */
118073bc0bd4SRichard Henderson         if (tlb_addr & TLB_NOTDIRTY) {
118173bc0bd4SRichard Henderson             notdirty_write(env_cpu(env), addr, size, iotlbentry, retaddr);
118273bc0bd4SRichard Henderson         }
1183fef39ccdSDavid Hildenbrand     }
1184fef39ccdSDavid Hildenbrand 
1185fef39ccdSDavid Hildenbrand     return (void *)((uintptr_t)addr + entry->addend);
1186d9bb58e5SYang Zhong }
1187d9bb58e5SYang Zhong 
11884811e909SRichard Henderson void *tlb_vaddr_to_host(CPUArchState *env, abi_ptr addr,
11894811e909SRichard Henderson                         MMUAccessType access_type, int mmu_idx)
11904811e909SRichard Henderson {
11914811e909SRichard Henderson     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
11924811e909SRichard Henderson     uintptr_t tlb_addr, page;
11934811e909SRichard Henderson     size_t elt_ofs;
11944811e909SRichard Henderson 
11954811e909SRichard Henderson     switch (access_type) {
11964811e909SRichard Henderson     case MMU_DATA_LOAD:
11974811e909SRichard Henderson         elt_ofs = offsetof(CPUTLBEntry, addr_read);
11984811e909SRichard Henderson         break;
11994811e909SRichard Henderson     case MMU_DATA_STORE:
12004811e909SRichard Henderson         elt_ofs = offsetof(CPUTLBEntry, addr_write);
12014811e909SRichard Henderson         break;
12024811e909SRichard Henderson     case MMU_INST_FETCH:
12034811e909SRichard Henderson         elt_ofs = offsetof(CPUTLBEntry, addr_code);
12044811e909SRichard Henderson         break;
12054811e909SRichard Henderson     default:
12064811e909SRichard Henderson         g_assert_not_reached();
12074811e909SRichard Henderson     }
12084811e909SRichard Henderson 
12094811e909SRichard Henderson     page = addr & TARGET_PAGE_MASK;
12104811e909SRichard Henderson     tlb_addr = tlb_read_ofs(entry, elt_ofs);
12114811e909SRichard Henderson 
12124811e909SRichard Henderson     if (!tlb_hit_page(tlb_addr, page)) {
12134811e909SRichard Henderson         uintptr_t index = tlb_index(env, mmu_idx, addr);
12144811e909SRichard Henderson 
12154811e909SRichard Henderson         if (!victim_tlb_hit(env, mmu_idx, index, elt_ofs, page)) {
121629a0af61SRichard Henderson             CPUState *cs = env_cpu(env);
12174811e909SRichard Henderson             CPUClass *cc = CPU_GET_CLASS(cs);
12184811e909SRichard Henderson 
12194811e909SRichard Henderson             if (!cc->tlb_fill(cs, addr, 0, access_type, mmu_idx, true, 0)) {
12204811e909SRichard Henderson                 /* Non-faulting page table read failed.  */
12214811e909SRichard Henderson                 return NULL;
12224811e909SRichard Henderson             }
12234811e909SRichard Henderson 
12244811e909SRichard Henderson             /* TLB resize via tlb_fill may have moved the entry.  */
12254811e909SRichard Henderson             entry = tlb_entry(env, mmu_idx, addr);
12264811e909SRichard Henderson         }
12274811e909SRichard Henderson         tlb_addr = tlb_read_ofs(entry, elt_ofs);
12284811e909SRichard Henderson     }
12294811e909SRichard Henderson 
12304811e909SRichard Henderson     if (tlb_addr & ~TARGET_PAGE_MASK) {
12314811e909SRichard Henderson         /* IO access */
12324811e909SRichard Henderson         return NULL;
12334811e909SRichard Henderson     }
12344811e909SRichard Henderson 
12354811e909SRichard Henderson     return (void *)((uintptr_t)addr + entry->addend);
12364811e909SRichard Henderson }
12374811e909SRichard Henderson 
1238d9bb58e5SYang Zhong /* Probe for a read-modify-write atomic operation.  Do not allow unaligned
1239d9bb58e5SYang Zhong  * operations, or io operations to proceed.  Return the host address.  */
1240d9bb58e5SYang Zhong static void *atomic_mmu_lookup(CPUArchState *env, target_ulong addr,
1241707526adSRichard Henderson                                TCGMemOpIdx oi, uintptr_t retaddr)
1242d9bb58e5SYang Zhong {
1243d9bb58e5SYang Zhong     size_t mmu_idx = get_mmuidx(oi);
1244383beda9SRichard Henderson     uintptr_t index = tlb_index(env, mmu_idx, addr);
1245383beda9SRichard Henderson     CPUTLBEntry *tlbe = tlb_entry(env, mmu_idx, addr);
1246403f290cSEmilio G. Cota     target_ulong tlb_addr = tlb_addr_write(tlbe);
124714776ab5STony Nguyen     MemOp mop = get_memop(oi);
1248d9bb58e5SYang Zhong     int a_bits = get_alignment_bits(mop);
1249d9bb58e5SYang Zhong     int s_bits = mop & MO_SIZE;
125034d49937SPeter Maydell     void *hostaddr;
1251d9bb58e5SYang Zhong 
1252d9bb58e5SYang Zhong     /* Adjust the given return address.  */
1253d9bb58e5SYang Zhong     retaddr -= GETPC_ADJ;
1254d9bb58e5SYang Zhong 
1255d9bb58e5SYang Zhong     /* Enforce guest required alignment.  */
1256d9bb58e5SYang Zhong     if (unlikely(a_bits > 0 && (addr & ((1 << a_bits) - 1)))) {
1257d9bb58e5SYang Zhong         /* ??? Maybe indicate atomic op to cpu_unaligned_access */
125829a0af61SRichard Henderson         cpu_unaligned_access(env_cpu(env), addr, MMU_DATA_STORE,
1259d9bb58e5SYang Zhong                              mmu_idx, retaddr);
1260d9bb58e5SYang Zhong     }
1261d9bb58e5SYang Zhong 
1262d9bb58e5SYang Zhong     /* Enforce qemu required alignment.  */
1263d9bb58e5SYang Zhong     if (unlikely(addr & ((1 << s_bits) - 1))) {
1264d9bb58e5SYang Zhong         /* We get here if guest alignment was not requested,
1265d9bb58e5SYang Zhong            or was not enforced by cpu_unaligned_access above.
1266d9bb58e5SYang Zhong            We might widen the access and emulate, but for now
1267d9bb58e5SYang Zhong            mark an exception and exit the cpu loop.  */
1268d9bb58e5SYang Zhong         goto stop_the_world;
1269d9bb58e5SYang Zhong     }
1270d9bb58e5SYang Zhong 
1271d9bb58e5SYang Zhong     /* Check TLB entry and enforce page permissions.  */
1272334692bcSPeter Maydell     if (!tlb_hit(tlb_addr, addr)) {
1273d9bb58e5SYang Zhong         if (!VICTIM_TLB_HIT(addr_write, addr)) {
127429a0af61SRichard Henderson             tlb_fill(env_cpu(env), addr, 1 << s_bits, MMU_DATA_STORE,
127598670d47SLaurent Vivier                      mmu_idx, retaddr);
12766d967cb8SEmilio G. Cota             index = tlb_index(env, mmu_idx, addr);
12776d967cb8SEmilio G. Cota             tlbe = tlb_entry(env, mmu_idx, addr);
1278d9bb58e5SYang Zhong         }
1279403f290cSEmilio G. Cota         tlb_addr = tlb_addr_write(tlbe) & ~TLB_INVALID_MASK;
1280d9bb58e5SYang Zhong     }
1281d9bb58e5SYang Zhong 
128255df6fcfSPeter Maydell     /* Notice an IO access or a needs-MMU-lookup access */
128330d7e098SRichard Henderson     if (unlikely(tlb_addr & TLB_MMIO)) {
1284d9bb58e5SYang Zhong         /* There's really nothing that can be done to
1285d9bb58e5SYang Zhong            support this apart from stop-the-world.  */
1286d9bb58e5SYang Zhong         goto stop_the_world;
1287d9bb58e5SYang Zhong     }
1288d9bb58e5SYang Zhong 
1289d9bb58e5SYang Zhong     /* Let the guest notice RMW on a write-only page.  */
129034d49937SPeter Maydell     if (unlikely(tlbe->addr_read != (tlb_addr & ~TLB_NOTDIRTY))) {
129129a0af61SRichard Henderson         tlb_fill(env_cpu(env), addr, 1 << s_bits, MMU_DATA_LOAD,
129298670d47SLaurent Vivier                  mmu_idx, retaddr);
1293d9bb58e5SYang Zhong         /* Since we don't support reads and writes to different addresses,
1294d9bb58e5SYang Zhong            and we do have the proper page loaded for write, this shouldn't
1295d9bb58e5SYang Zhong            ever return.  But just in case, handle via stop-the-world.  */
1296d9bb58e5SYang Zhong         goto stop_the_world;
1297d9bb58e5SYang Zhong     }
1298d9bb58e5SYang Zhong 
129934d49937SPeter Maydell     hostaddr = (void *)((uintptr_t)addr + tlbe->addend);
130034d49937SPeter Maydell 
130134d49937SPeter Maydell     if (unlikely(tlb_addr & TLB_NOTDIRTY)) {
1302707526adSRichard Henderson         notdirty_write(env_cpu(env), addr, 1 << s_bits,
1303707526adSRichard Henderson                        &env_tlb(env)->d[mmu_idx].iotlb[index], retaddr);
130434d49937SPeter Maydell     }
130534d49937SPeter Maydell 
130634d49937SPeter Maydell     return hostaddr;
1307d9bb58e5SYang Zhong 
1308d9bb58e5SYang Zhong  stop_the_world:
130929a0af61SRichard Henderson     cpu_loop_exit_atomic(env_cpu(env), retaddr);
1310d9bb58e5SYang Zhong }
1311d9bb58e5SYang Zhong 
1312eed56642SAlex Bennée /*
1313eed56642SAlex Bennée  * Load Helpers
1314eed56642SAlex Bennée  *
1315eed56642SAlex Bennée  * We support two different access types. SOFTMMU_CODE_ACCESS is
1316eed56642SAlex Bennée  * specifically for reading instructions from system memory. It is
1317eed56642SAlex Bennée  * called by the translation loop and in some helpers where the code
1318eed56642SAlex Bennée  * is disassembled. It shouldn't be called directly by guest code.
1319eed56642SAlex Bennée  */
1320d9bb58e5SYang Zhong 
13212dd92606SRichard Henderson typedef uint64_t FullLoadHelper(CPUArchState *env, target_ulong addr,
13222dd92606SRichard Henderson                                 TCGMemOpIdx oi, uintptr_t retaddr);
13232dd92606SRichard Henderson 
1324c6b716cdSRichard Henderson static inline uint64_t QEMU_ALWAYS_INLINE
132580d9d1c6SRichard Henderson load_memop(const void *haddr, MemOp op)
132680d9d1c6SRichard Henderson {
132780d9d1c6SRichard Henderson     switch (op) {
132880d9d1c6SRichard Henderson     case MO_UB:
132980d9d1c6SRichard Henderson         return ldub_p(haddr);
133080d9d1c6SRichard Henderson     case MO_BEUW:
133180d9d1c6SRichard Henderson         return lduw_be_p(haddr);
133280d9d1c6SRichard Henderson     case MO_LEUW:
133380d9d1c6SRichard Henderson         return lduw_le_p(haddr);
133480d9d1c6SRichard Henderson     case MO_BEUL:
133580d9d1c6SRichard Henderson         return (uint32_t)ldl_be_p(haddr);
133680d9d1c6SRichard Henderson     case MO_LEUL:
133780d9d1c6SRichard Henderson         return (uint32_t)ldl_le_p(haddr);
133880d9d1c6SRichard Henderson     case MO_BEQ:
133980d9d1c6SRichard Henderson         return ldq_be_p(haddr);
134080d9d1c6SRichard Henderson     case MO_LEQ:
134180d9d1c6SRichard Henderson         return ldq_le_p(haddr);
134280d9d1c6SRichard Henderson     default:
134380d9d1c6SRichard Henderson         qemu_build_not_reached();
134480d9d1c6SRichard Henderson     }
134580d9d1c6SRichard Henderson }
134680d9d1c6SRichard Henderson 
134780d9d1c6SRichard Henderson static inline uint64_t QEMU_ALWAYS_INLINE
13482dd92606SRichard Henderson load_helper(CPUArchState *env, target_ulong addr, TCGMemOpIdx oi,
1349be5c4787STony Nguyen             uintptr_t retaddr, MemOp op, bool code_read,
13502dd92606SRichard Henderson             FullLoadHelper *full_load)
1351eed56642SAlex Bennée {
1352eed56642SAlex Bennée     uintptr_t mmu_idx = get_mmuidx(oi);
1353eed56642SAlex Bennée     uintptr_t index = tlb_index(env, mmu_idx, addr);
1354eed56642SAlex Bennée     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
1355eed56642SAlex Bennée     target_ulong tlb_addr = code_read ? entry->addr_code : entry->addr_read;
1356eed56642SAlex Bennée     const size_t tlb_off = code_read ?
1357eed56642SAlex Bennée         offsetof(CPUTLBEntry, addr_code) : offsetof(CPUTLBEntry, addr_read);
1358f1be3696SRichard Henderson     const MMUAccessType access_type =
1359f1be3696SRichard Henderson         code_read ? MMU_INST_FETCH : MMU_DATA_LOAD;
1360eed56642SAlex Bennée     unsigned a_bits = get_alignment_bits(get_memop(oi));
1361eed56642SAlex Bennée     void *haddr;
1362eed56642SAlex Bennée     uint64_t res;
1363be5c4787STony Nguyen     size_t size = memop_size(op);
1364d9bb58e5SYang Zhong 
1365eed56642SAlex Bennée     /* Handle CPU specific unaligned behaviour */
1366eed56642SAlex Bennée     if (addr & ((1 << a_bits) - 1)) {
136729a0af61SRichard Henderson         cpu_unaligned_access(env_cpu(env), addr, access_type,
1368eed56642SAlex Bennée                              mmu_idx, retaddr);
1369eed56642SAlex Bennée     }
1370eed56642SAlex Bennée 
1371eed56642SAlex Bennée     /* If the TLB entry is for a different page, reload and try again.  */
1372eed56642SAlex Bennée     if (!tlb_hit(tlb_addr, addr)) {
1373eed56642SAlex Bennée         if (!victim_tlb_hit(env, mmu_idx, index, tlb_off,
1374eed56642SAlex Bennée                             addr & TARGET_PAGE_MASK)) {
137529a0af61SRichard Henderson             tlb_fill(env_cpu(env), addr, size,
1376f1be3696SRichard Henderson                      access_type, mmu_idx, retaddr);
1377eed56642SAlex Bennée             index = tlb_index(env, mmu_idx, addr);
1378eed56642SAlex Bennée             entry = tlb_entry(env, mmu_idx, addr);
1379eed56642SAlex Bennée         }
1380eed56642SAlex Bennée         tlb_addr = code_read ? entry->addr_code : entry->addr_read;
138130d7e098SRichard Henderson         tlb_addr &= ~TLB_INVALID_MASK;
1382eed56642SAlex Bennée     }
1383eed56642SAlex Bennée 
138450b107c5SRichard Henderson     /* Handle anything that isn't just a straight memory access.  */
1385eed56642SAlex Bennée     if (unlikely(tlb_addr & ~TARGET_PAGE_MASK)) {
138650b107c5SRichard Henderson         CPUIOTLBEntry *iotlbentry;
13875b87b3e6SRichard Henderson         bool need_swap;
138850b107c5SRichard Henderson 
138950b107c5SRichard Henderson         /* For anything that is unaligned, recurse through full_load.  */
1390eed56642SAlex Bennée         if ((addr & (size - 1)) != 0) {
1391eed56642SAlex Bennée             goto do_unaligned_access;
1392eed56642SAlex Bennée         }
139350b107c5SRichard Henderson 
139450b107c5SRichard Henderson         iotlbentry = &env_tlb(env)->d[mmu_idx].iotlb[index];
139550b107c5SRichard Henderson 
139650b107c5SRichard Henderson         /* Handle watchpoints.  */
139750b107c5SRichard Henderson         if (unlikely(tlb_addr & TLB_WATCHPOINT)) {
139850b107c5SRichard Henderson             /* On watchpoint hit, this will longjmp out.  */
139950b107c5SRichard Henderson             cpu_check_watchpoint(env_cpu(env), addr, size,
140050b107c5SRichard Henderson                                  iotlbentry->attrs, BP_MEM_READ, retaddr);
14015b87b3e6SRichard Henderson         }
140250b107c5SRichard Henderson 
14035b87b3e6SRichard Henderson         need_swap = size > 1 && (tlb_addr & TLB_BSWAP);
140450b107c5SRichard Henderson 
140550b107c5SRichard Henderson         /* Handle I/O access.  */
14065b87b3e6SRichard Henderson         if (likely(tlb_addr & TLB_MMIO)) {
14075b87b3e6SRichard Henderson             return io_readx(env, iotlbentry, mmu_idx, addr, retaddr,
14085b87b3e6SRichard Henderson                             access_type, op ^ (need_swap * MO_BSWAP));
14095b87b3e6SRichard Henderson         }
14105b87b3e6SRichard Henderson 
14115b87b3e6SRichard Henderson         haddr = (void *)((uintptr_t)addr + entry->addend);
14125b87b3e6SRichard Henderson 
14135b87b3e6SRichard Henderson         /*
14145b87b3e6SRichard Henderson          * Keep these two load_memop separate to ensure that the compiler
14155b87b3e6SRichard Henderson          * is able to fold the entire function to a single instruction.
14165b87b3e6SRichard Henderson          * There is a build-time assert inside to remind you of this.  ;-)
14175b87b3e6SRichard Henderson          */
14185b87b3e6SRichard Henderson         if (unlikely(need_swap)) {
14195b87b3e6SRichard Henderson             return load_memop(haddr, op ^ MO_BSWAP);
14205b87b3e6SRichard Henderson         }
14215b87b3e6SRichard Henderson         return load_memop(haddr, op);
1422eed56642SAlex Bennée     }
1423eed56642SAlex Bennée 
1424eed56642SAlex Bennée     /* Handle slow unaligned access (it spans two pages or IO).  */
1425eed56642SAlex Bennée     if (size > 1
1426eed56642SAlex Bennée         && unlikely((addr & ~TARGET_PAGE_MASK) + size - 1
1427eed56642SAlex Bennée                     >= TARGET_PAGE_SIZE)) {
1428eed56642SAlex Bennée         target_ulong addr1, addr2;
14298c79b288SAlex Bennée         uint64_t r1, r2;
1430eed56642SAlex Bennée         unsigned shift;
1431eed56642SAlex Bennée     do_unaligned_access:
1432ab7a2009SAlex Bennée         addr1 = addr & ~((target_ulong)size - 1);
1433eed56642SAlex Bennée         addr2 = addr1 + size;
14342dd92606SRichard Henderson         r1 = full_load(env, addr1, oi, retaddr);
14352dd92606SRichard Henderson         r2 = full_load(env, addr2, oi, retaddr);
1436eed56642SAlex Bennée         shift = (addr & (size - 1)) * 8;
1437eed56642SAlex Bennée 
1438be5c4787STony Nguyen         if (memop_big_endian(op)) {
1439eed56642SAlex Bennée             /* Big-endian combine.  */
1440eed56642SAlex Bennée             res = (r1 << shift) | (r2 >> ((size * 8) - shift));
1441eed56642SAlex Bennée         } else {
1442eed56642SAlex Bennée             /* Little-endian combine.  */
1443eed56642SAlex Bennée             res = (r1 >> shift) | (r2 << ((size * 8) - shift));
1444eed56642SAlex Bennée         }
1445eed56642SAlex Bennée         return res & MAKE_64BIT_MASK(0, size * 8);
1446eed56642SAlex Bennée     }
1447eed56642SAlex Bennée 
1448eed56642SAlex Bennée     haddr = (void *)((uintptr_t)addr + entry->addend);
144980d9d1c6SRichard Henderson     return load_memop(haddr, op);
1450eed56642SAlex Bennée }
1451eed56642SAlex Bennée 
1452eed56642SAlex Bennée /*
1453eed56642SAlex Bennée  * For the benefit of TCG generated code, we want to avoid the
1454eed56642SAlex Bennée  * complication of ABI-specific return type promotion and always
1455eed56642SAlex Bennée  * return a value extended to the register size of the host. This is
1456eed56642SAlex Bennée  * tcg_target_long, except in the case of a 32-bit host and 64-bit
1457eed56642SAlex Bennée  * data, and for that we always have uint64_t.
1458eed56642SAlex Bennée  *
1459eed56642SAlex Bennée  * We don't bother with this widened value for SOFTMMU_CODE_ACCESS.
1460eed56642SAlex Bennée  */
1461eed56642SAlex Bennée 
14622dd92606SRichard Henderson static uint64_t full_ldub_mmu(CPUArchState *env, target_ulong addr,
14632dd92606SRichard Henderson                               TCGMemOpIdx oi, uintptr_t retaddr)
14642dd92606SRichard Henderson {
1465be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_UB, false, full_ldub_mmu);
14662dd92606SRichard Henderson }
14672dd92606SRichard Henderson 
1468fc1bc777SRichard Henderson tcg_target_ulong helper_ret_ldub_mmu(CPUArchState *env, target_ulong addr,
1469fc1bc777SRichard Henderson                                      TCGMemOpIdx oi, uintptr_t retaddr)
1470eed56642SAlex Bennée {
14712dd92606SRichard Henderson     return full_ldub_mmu(env, addr, oi, retaddr);
14722dd92606SRichard Henderson }
14732dd92606SRichard Henderson 
14742dd92606SRichard Henderson static uint64_t full_le_lduw_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_LEUW, false,
14782dd92606SRichard Henderson                        full_le_lduw_mmu);
1479eed56642SAlex Bennée }
1480eed56642SAlex Bennée 
1481fc1bc777SRichard Henderson tcg_target_ulong helper_le_lduw_mmu(CPUArchState *env, target_ulong addr,
1482fc1bc777SRichard Henderson                                     TCGMemOpIdx oi, uintptr_t retaddr)
1483eed56642SAlex Bennée {
14842dd92606SRichard Henderson     return full_le_lduw_mmu(env, addr, oi, retaddr);
14852dd92606SRichard Henderson }
14862dd92606SRichard Henderson 
14872dd92606SRichard Henderson static uint64_t full_be_lduw_mmu(CPUArchState *env, target_ulong addr,
14882dd92606SRichard Henderson                                  TCGMemOpIdx oi, uintptr_t retaddr)
14892dd92606SRichard Henderson {
1490be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEUW, false,
14912dd92606SRichard Henderson                        full_be_lduw_mmu);
1492eed56642SAlex Bennée }
1493eed56642SAlex Bennée 
1494fc1bc777SRichard Henderson tcg_target_ulong helper_be_lduw_mmu(CPUArchState *env, target_ulong addr,
1495fc1bc777SRichard Henderson                                     TCGMemOpIdx oi, uintptr_t retaddr)
1496eed56642SAlex Bennée {
14972dd92606SRichard Henderson     return full_be_lduw_mmu(env, addr, oi, retaddr);
14982dd92606SRichard Henderson }
14992dd92606SRichard Henderson 
15002dd92606SRichard Henderson static uint64_t full_le_ldul_mmu(CPUArchState *env, target_ulong addr,
15012dd92606SRichard Henderson                                  TCGMemOpIdx oi, uintptr_t retaddr)
15022dd92606SRichard Henderson {
1503be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEUL, false,
15042dd92606SRichard Henderson                        full_le_ldul_mmu);
1505eed56642SAlex Bennée }
1506eed56642SAlex Bennée 
1507fc1bc777SRichard Henderson tcg_target_ulong helper_le_ldul_mmu(CPUArchState *env, target_ulong addr,
1508fc1bc777SRichard Henderson                                     TCGMemOpIdx oi, uintptr_t retaddr)
1509eed56642SAlex Bennée {
15102dd92606SRichard Henderson     return full_le_ldul_mmu(env, addr, oi, retaddr);
15112dd92606SRichard Henderson }
15122dd92606SRichard Henderson 
15132dd92606SRichard Henderson static uint64_t full_be_ldul_mmu(CPUArchState *env, target_ulong addr,
15142dd92606SRichard Henderson                                  TCGMemOpIdx oi, uintptr_t retaddr)
15152dd92606SRichard Henderson {
1516be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEUL, false,
15172dd92606SRichard Henderson                        full_be_ldul_mmu);
1518eed56642SAlex Bennée }
1519eed56642SAlex Bennée 
1520fc1bc777SRichard Henderson tcg_target_ulong helper_be_ldul_mmu(CPUArchState *env, target_ulong addr,
1521fc1bc777SRichard Henderson                                     TCGMemOpIdx oi, uintptr_t retaddr)
1522eed56642SAlex Bennée {
15232dd92606SRichard Henderson     return full_be_ldul_mmu(env, addr, oi, retaddr);
1524eed56642SAlex Bennée }
1525eed56642SAlex Bennée 
1526fc1bc777SRichard Henderson uint64_t helper_le_ldq_mmu(CPUArchState *env, target_ulong addr,
1527fc1bc777SRichard Henderson                            TCGMemOpIdx oi, uintptr_t retaddr)
1528eed56642SAlex Bennée {
1529be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEQ, false,
15302dd92606SRichard Henderson                        helper_le_ldq_mmu);
1531eed56642SAlex Bennée }
1532eed56642SAlex Bennée 
1533fc1bc777SRichard Henderson uint64_t helper_be_ldq_mmu(CPUArchState *env, target_ulong addr,
1534fc1bc777SRichard Henderson                            TCGMemOpIdx oi, uintptr_t retaddr)
1535eed56642SAlex Bennée {
1536be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEQ, false,
15372dd92606SRichard Henderson                        helper_be_ldq_mmu);
1538eed56642SAlex Bennée }
1539eed56642SAlex Bennée 
1540eed56642SAlex Bennée /*
1541eed56642SAlex Bennée  * Provide signed versions of the load routines as well.  We can of course
1542eed56642SAlex Bennée  * avoid this for 64-bit data, or for 32-bit data on 32-bit host.
1543eed56642SAlex Bennée  */
1544eed56642SAlex Bennée 
1545eed56642SAlex Bennée 
1546eed56642SAlex Bennée tcg_target_ulong helper_ret_ldsb_mmu(CPUArchState *env, target_ulong addr,
1547eed56642SAlex Bennée                                      TCGMemOpIdx oi, uintptr_t retaddr)
1548eed56642SAlex Bennée {
1549eed56642SAlex Bennée     return (int8_t)helper_ret_ldub_mmu(env, addr, oi, retaddr);
1550eed56642SAlex Bennée }
1551eed56642SAlex Bennée 
1552eed56642SAlex Bennée tcg_target_ulong helper_le_ldsw_mmu(CPUArchState *env, target_ulong addr,
1553eed56642SAlex Bennée                                     TCGMemOpIdx oi, uintptr_t retaddr)
1554eed56642SAlex Bennée {
1555eed56642SAlex Bennée     return (int16_t)helper_le_lduw_mmu(env, addr, oi, retaddr);
1556eed56642SAlex Bennée }
1557eed56642SAlex Bennée 
1558eed56642SAlex Bennée tcg_target_ulong helper_be_ldsw_mmu(CPUArchState *env, target_ulong addr,
1559eed56642SAlex Bennée                                     TCGMemOpIdx oi, uintptr_t retaddr)
1560eed56642SAlex Bennée {
1561eed56642SAlex Bennée     return (int16_t)helper_be_lduw_mmu(env, addr, oi, retaddr);
1562eed56642SAlex Bennée }
1563eed56642SAlex Bennée 
1564eed56642SAlex Bennée tcg_target_ulong helper_le_ldsl_mmu(CPUArchState *env, target_ulong addr,
1565eed56642SAlex Bennée                                     TCGMemOpIdx oi, uintptr_t retaddr)
1566eed56642SAlex Bennée {
1567eed56642SAlex Bennée     return (int32_t)helper_le_ldul_mmu(env, addr, oi, retaddr);
1568eed56642SAlex Bennée }
1569eed56642SAlex Bennée 
1570eed56642SAlex Bennée tcg_target_ulong helper_be_ldsl_mmu(CPUArchState *env, target_ulong addr,
1571eed56642SAlex Bennée                                     TCGMemOpIdx oi, uintptr_t retaddr)
1572eed56642SAlex Bennée {
1573eed56642SAlex Bennée     return (int32_t)helper_be_ldul_mmu(env, addr, oi, retaddr);
1574eed56642SAlex Bennée }
1575eed56642SAlex Bennée 
1576eed56642SAlex Bennée /*
1577eed56642SAlex Bennée  * Store Helpers
1578eed56642SAlex Bennée  */
1579eed56642SAlex Bennée 
1580c6b716cdSRichard Henderson static inline void QEMU_ALWAYS_INLINE
158180d9d1c6SRichard Henderson store_memop(void *haddr, uint64_t val, MemOp op)
158280d9d1c6SRichard Henderson {
158380d9d1c6SRichard Henderson     switch (op) {
158480d9d1c6SRichard Henderson     case MO_UB:
158580d9d1c6SRichard Henderson         stb_p(haddr, val);
158680d9d1c6SRichard Henderson         break;
158780d9d1c6SRichard Henderson     case MO_BEUW:
158880d9d1c6SRichard Henderson         stw_be_p(haddr, val);
158980d9d1c6SRichard Henderson         break;
159080d9d1c6SRichard Henderson     case MO_LEUW:
159180d9d1c6SRichard Henderson         stw_le_p(haddr, val);
159280d9d1c6SRichard Henderson         break;
159380d9d1c6SRichard Henderson     case MO_BEUL:
159480d9d1c6SRichard Henderson         stl_be_p(haddr, val);
159580d9d1c6SRichard Henderson         break;
159680d9d1c6SRichard Henderson     case MO_LEUL:
159780d9d1c6SRichard Henderson         stl_le_p(haddr, val);
159880d9d1c6SRichard Henderson         break;
159980d9d1c6SRichard Henderson     case MO_BEQ:
160080d9d1c6SRichard Henderson         stq_be_p(haddr, val);
160180d9d1c6SRichard Henderson         break;
160280d9d1c6SRichard Henderson     case MO_LEQ:
160380d9d1c6SRichard Henderson         stq_le_p(haddr, val);
160480d9d1c6SRichard Henderson         break;
160580d9d1c6SRichard Henderson     default:
160680d9d1c6SRichard Henderson         qemu_build_not_reached();
160780d9d1c6SRichard Henderson     }
160880d9d1c6SRichard Henderson }
160980d9d1c6SRichard Henderson 
161080d9d1c6SRichard Henderson static inline void QEMU_ALWAYS_INLINE
16114601f8d1SRichard Henderson store_helper(CPUArchState *env, target_ulong addr, uint64_t val,
1612be5c4787STony Nguyen              TCGMemOpIdx oi, uintptr_t retaddr, MemOp op)
1613eed56642SAlex Bennée {
1614eed56642SAlex Bennée     uintptr_t mmu_idx = get_mmuidx(oi);
1615eed56642SAlex Bennée     uintptr_t index = tlb_index(env, mmu_idx, addr);
1616eed56642SAlex Bennée     CPUTLBEntry *entry = tlb_entry(env, mmu_idx, addr);
1617eed56642SAlex Bennée     target_ulong tlb_addr = tlb_addr_write(entry);
1618eed56642SAlex Bennée     const size_t tlb_off = offsetof(CPUTLBEntry, addr_write);
1619eed56642SAlex Bennée     unsigned a_bits = get_alignment_bits(get_memop(oi));
1620eed56642SAlex Bennée     void *haddr;
1621be5c4787STony Nguyen     size_t size = memop_size(op);
1622eed56642SAlex Bennée 
1623eed56642SAlex Bennée     /* Handle CPU specific unaligned behaviour */
1624eed56642SAlex Bennée     if (addr & ((1 << a_bits) - 1)) {
162529a0af61SRichard Henderson         cpu_unaligned_access(env_cpu(env), addr, MMU_DATA_STORE,
1626eed56642SAlex Bennée                              mmu_idx, retaddr);
1627eed56642SAlex Bennée     }
1628eed56642SAlex Bennée 
1629eed56642SAlex Bennée     /* If the TLB entry is for a different page, reload and try again.  */
1630eed56642SAlex Bennée     if (!tlb_hit(tlb_addr, addr)) {
1631eed56642SAlex Bennée         if (!victim_tlb_hit(env, mmu_idx, index, tlb_off,
1632eed56642SAlex Bennée             addr & TARGET_PAGE_MASK)) {
163329a0af61SRichard Henderson             tlb_fill(env_cpu(env), addr, size, MMU_DATA_STORE,
1634eed56642SAlex Bennée                      mmu_idx, retaddr);
1635eed56642SAlex Bennée             index = tlb_index(env, mmu_idx, addr);
1636eed56642SAlex Bennée             entry = tlb_entry(env, mmu_idx, addr);
1637eed56642SAlex Bennée         }
1638eed56642SAlex Bennée         tlb_addr = tlb_addr_write(entry) & ~TLB_INVALID_MASK;
1639eed56642SAlex Bennée     }
1640eed56642SAlex Bennée 
164150b107c5SRichard Henderson     /* Handle anything that isn't just a straight memory access.  */
1642eed56642SAlex Bennée     if (unlikely(tlb_addr & ~TARGET_PAGE_MASK)) {
164350b107c5SRichard Henderson         CPUIOTLBEntry *iotlbentry;
16445b87b3e6SRichard Henderson         bool need_swap;
164550b107c5SRichard Henderson 
164650b107c5SRichard Henderson         /* For anything that is unaligned, recurse through byte stores.  */
1647eed56642SAlex Bennée         if ((addr & (size - 1)) != 0) {
1648eed56642SAlex Bennée             goto do_unaligned_access;
1649eed56642SAlex Bennée         }
165050b107c5SRichard Henderson 
165150b107c5SRichard Henderson         iotlbentry = &env_tlb(env)->d[mmu_idx].iotlb[index];
165250b107c5SRichard Henderson 
165350b107c5SRichard Henderson         /* Handle watchpoints.  */
165450b107c5SRichard Henderson         if (unlikely(tlb_addr & TLB_WATCHPOINT)) {
165550b107c5SRichard Henderson             /* On watchpoint hit, this will longjmp out.  */
165650b107c5SRichard Henderson             cpu_check_watchpoint(env_cpu(env), addr, size,
165750b107c5SRichard Henderson                                  iotlbentry->attrs, BP_MEM_WRITE, retaddr);
16585b87b3e6SRichard Henderson         }
165950b107c5SRichard Henderson 
16605b87b3e6SRichard Henderson         need_swap = size > 1 && (tlb_addr & TLB_BSWAP);
166150b107c5SRichard Henderson 
166250b107c5SRichard Henderson         /* Handle I/O access.  */
166308565552SRichard Henderson         if (tlb_addr & TLB_MMIO) {
16645b87b3e6SRichard Henderson             io_writex(env, iotlbentry, mmu_idx, val, addr, retaddr,
16655b87b3e6SRichard Henderson                       op ^ (need_swap * MO_BSWAP));
16665b87b3e6SRichard Henderson             return;
16675b87b3e6SRichard Henderson         }
16685b87b3e6SRichard Henderson 
16697b0d792cSRichard Henderson         /* Ignore writes to ROM.  */
16707b0d792cSRichard Henderson         if (unlikely(tlb_addr & TLB_DISCARD_WRITE)) {
16717b0d792cSRichard Henderson             return;
16727b0d792cSRichard Henderson         }
16737b0d792cSRichard Henderson 
167408565552SRichard Henderson         /* Handle clean RAM pages.  */
167508565552SRichard Henderson         if (tlb_addr & TLB_NOTDIRTY) {
1676707526adSRichard Henderson             notdirty_write(env_cpu(env), addr, size, iotlbentry, retaddr);
167708565552SRichard Henderson         }
167808565552SRichard Henderson 
1679707526adSRichard Henderson         haddr = (void *)((uintptr_t)addr + entry->addend);
168008565552SRichard Henderson 
16815b87b3e6SRichard Henderson         /*
16825b87b3e6SRichard Henderson          * Keep these two store_memop separate to ensure that the compiler
16835b87b3e6SRichard Henderson          * is able to fold the entire function to a single instruction.
16845b87b3e6SRichard Henderson          * There is a build-time assert inside to remind you of this.  ;-)
16855b87b3e6SRichard Henderson          */
16865b87b3e6SRichard Henderson         if (unlikely(need_swap)) {
16875b87b3e6SRichard Henderson             store_memop(haddr, val, op ^ MO_BSWAP);
16885b87b3e6SRichard Henderson         } else {
16895b87b3e6SRichard Henderson             store_memop(haddr, val, op);
16905b87b3e6SRichard Henderson         }
1691eed56642SAlex Bennée         return;
1692eed56642SAlex Bennée     }
1693eed56642SAlex Bennée 
1694eed56642SAlex Bennée     /* Handle slow unaligned access (it spans two pages or IO).  */
1695eed56642SAlex Bennée     if (size > 1
1696eed56642SAlex Bennée         && unlikely((addr & ~TARGET_PAGE_MASK) + size - 1
1697eed56642SAlex Bennée                      >= TARGET_PAGE_SIZE)) {
1698eed56642SAlex Bennée         int i;
1699eed56642SAlex Bennée         uintptr_t index2;
1700eed56642SAlex Bennée         CPUTLBEntry *entry2;
1701eed56642SAlex Bennée         target_ulong page2, tlb_addr2;
17028f7cd2adSRichard Henderson         size_t size2;
17038f7cd2adSRichard Henderson 
1704eed56642SAlex Bennée     do_unaligned_access:
1705eed56642SAlex Bennée         /*
1706eed56642SAlex Bennée          * Ensure the second page is in the TLB.  Note that the first page
1707eed56642SAlex Bennée          * is already guaranteed to be filled, and that the second page
1708eed56642SAlex Bennée          * cannot evict the first.
1709eed56642SAlex Bennée          */
1710eed56642SAlex Bennée         page2 = (addr + size) & TARGET_PAGE_MASK;
17118f7cd2adSRichard Henderson         size2 = (addr + size) & ~TARGET_PAGE_MASK;
1712eed56642SAlex Bennée         index2 = tlb_index(env, mmu_idx, page2);
1713eed56642SAlex Bennée         entry2 = tlb_entry(env, mmu_idx, page2);
1714eed56642SAlex Bennée         tlb_addr2 = tlb_addr_write(entry2);
171550b107c5SRichard Henderson         if (!tlb_hit_page(tlb_addr2, page2)) {
171650b107c5SRichard Henderson             if (!victim_tlb_hit(env, mmu_idx, index2, tlb_off, page2)) {
17178f7cd2adSRichard Henderson                 tlb_fill(env_cpu(env), page2, size2, MMU_DATA_STORE,
1718eed56642SAlex Bennée                          mmu_idx, retaddr);
171950b107c5SRichard Henderson                 index2 = tlb_index(env, mmu_idx, page2);
172050b107c5SRichard Henderson                 entry2 = tlb_entry(env, mmu_idx, page2);
172150b107c5SRichard Henderson             }
172250b107c5SRichard Henderson             tlb_addr2 = tlb_addr_write(entry2);
172350b107c5SRichard Henderson         }
172450b107c5SRichard Henderson 
172550b107c5SRichard Henderson         /*
172650b107c5SRichard Henderson          * Handle watchpoints.  Since this may trap, all checks
172750b107c5SRichard Henderson          * must happen before any store.
172850b107c5SRichard Henderson          */
172950b107c5SRichard Henderson         if (unlikely(tlb_addr & TLB_WATCHPOINT)) {
173050b107c5SRichard Henderson             cpu_check_watchpoint(env_cpu(env), addr, size - size2,
173150b107c5SRichard Henderson                                  env_tlb(env)->d[mmu_idx].iotlb[index].attrs,
173250b107c5SRichard Henderson                                  BP_MEM_WRITE, retaddr);
173350b107c5SRichard Henderson         }
173450b107c5SRichard Henderson         if (unlikely(tlb_addr2 & TLB_WATCHPOINT)) {
173550b107c5SRichard Henderson             cpu_check_watchpoint(env_cpu(env), page2, size2,
173650b107c5SRichard Henderson                                  env_tlb(env)->d[mmu_idx].iotlb[index2].attrs,
173750b107c5SRichard Henderson                                  BP_MEM_WRITE, retaddr);
1738eed56642SAlex Bennée         }
1739eed56642SAlex Bennée 
1740eed56642SAlex Bennée         /*
1741eed56642SAlex Bennée          * XXX: not efficient, but simple.
1742eed56642SAlex Bennée          * This loop must go in the forward direction to avoid issues
1743eed56642SAlex Bennée          * with self-modifying code in Windows 64-bit.
1744eed56642SAlex Bennée          */
1745eed56642SAlex Bennée         for (i = 0; i < size; ++i) {
1746eed56642SAlex Bennée             uint8_t val8;
1747be5c4787STony Nguyen             if (memop_big_endian(op)) {
1748eed56642SAlex Bennée                 /* Big-endian extract.  */
1749eed56642SAlex Bennée                 val8 = val >> (((size - 1) * 8) - (i * 8));
1750eed56642SAlex Bennée             } else {
1751eed56642SAlex Bennée                 /* Little-endian extract.  */
1752eed56642SAlex Bennée                 val8 = val >> (i * 8);
1753eed56642SAlex Bennée             }
17544601f8d1SRichard Henderson             helper_ret_stb_mmu(env, addr + i, val8, oi, retaddr);
1755eed56642SAlex Bennée         }
1756eed56642SAlex Bennée         return;
1757eed56642SAlex Bennée     }
1758eed56642SAlex Bennée 
1759eed56642SAlex Bennée     haddr = (void *)((uintptr_t)addr + entry->addend);
176080d9d1c6SRichard Henderson     store_memop(haddr, val, op);
1761eed56642SAlex Bennée }
1762eed56642SAlex Bennée 
1763fc1bc777SRichard Henderson void helper_ret_stb_mmu(CPUArchState *env, target_ulong addr, uint8_t val,
1764eed56642SAlex Bennée                         TCGMemOpIdx oi, uintptr_t retaddr)
1765eed56642SAlex Bennée {
1766be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_UB);
1767eed56642SAlex Bennée }
1768eed56642SAlex Bennée 
1769fc1bc777SRichard Henderson void helper_le_stw_mmu(CPUArchState *env, target_ulong addr, uint16_t val,
1770eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1771eed56642SAlex Bennée {
1772be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_LEUW);
1773eed56642SAlex Bennée }
1774eed56642SAlex Bennée 
1775fc1bc777SRichard Henderson void helper_be_stw_mmu(CPUArchState *env, target_ulong addr, uint16_t val,
1776eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1777eed56642SAlex Bennée {
1778be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_BEUW);
1779eed56642SAlex Bennée }
1780eed56642SAlex Bennée 
1781fc1bc777SRichard Henderson void helper_le_stl_mmu(CPUArchState *env, target_ulong addr, uint32_t val,
1782eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1783eed56642SAlex Bennée {
1784be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_LEUL);
1785eed56642SAlex Bennée }
1786eed56642SAlex Bennée 
1787fc1bc777SRichard Henderson void helper_be_stl_mmu(CPUArchState *env, target_ulong addr, uint32_t val,
1788eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1789eed56642SAlex Bennée {
1790be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_BEUL);
1791eed56642SAlex Bennée }
1792eed56642SAlex Bennée 
1793fc1bc777SRichard Henderson void helper_le_stq_mmu(CPUArchState *env, target_ulong addr, uint64_t val,
1794eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1795eed56642SAlex Bennée {
1796be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_LEQ);
1797eed56642SAlex Bennée }
1798eed56642SAlex Bennée 
1799fc1bc777SRichard Henderson void helper_be_stq_mmu(CPUArchState *env, target_ulong addr, uint64_t val,
1800eed56642SAlex Bennée                        TCGMemOpIdx oi, uintptr_t retaddr)
1801eed56642SAlex Bennée {
1802be5c4787STony Nguyen     store_helper(env, addr, val, oi, retaddr, MO_BEQ);
1803eed56642SAlex Bennée }
1804d9bb58e5SYang Zhong 
1805d9bb58e5SYang Zhong /* First set of helpers allows passing in of OI and RETADDR.  This makes
1806d9bb58e5SYang Zhong    them callable from other helpers.  */
1807d9bb58e5SYang Zhong 
1808d9bb58e5SYang Zhong #define EXTRA_ARGS     , TCGMemOpIdx oi, uintptr_t retaddr
1809d9bb58e5SYang Zhong #define ATOMIC_NAME(X) \
1810d9bb58e5SYang Zhong     HELPER(glue(glue(glue(atomic_ ## X, SUFFIX), END), _mmu))
1811707526adSRichard Henderson #define ATOMIC_MMU_DECLS
1812707526adSRichard Henderson #define ATOMIC_MMU_LOOKUP atomic_mmu_lookup(env, addr, oi, retaddr)
1813707526adSRichard Henderson #define ATOMIC_MMU_CLEANUP
1814d9bb58e5SYang Zhong 
1815d9bb58e5SYang Zhong #define DATA_SIZE 1
1816d9bb58e5SYang Zhong #include "atomic_template.h"
1817d9bb58e5SYang Zhong 
1818d9bb58e5SYang Zhong #define DATA_SIZE 2
1819d9bb58e5SYang Zhong #include "atomic_template.h"
1820d9bb58e5SYang Zhong 
1821d9bb58e5SYang Zhong #define DATA_SIZE 4
1822d9bb58e5SYang Zhong #include "atomic_template.h"
1823d9bb58e5SYang Zhong 
1824d9bb58e5SYang Zhong #ifdef CONFIG_ATOMIC64
1825d9bb58e5SYang Zhong #define DATA_SIZE 8
1826d9bb58e5SYang Zhong #include "atomic_template.h"
1827d9bb58e5SYang Zhong #endif
1828d9bb58e5SYang Zhong 
1829e6cd4bb5SRichard Henderson #if HAVE_CMPXCHG128 || HAVE_ATOMIC128
1830d9bb58e5SYang Zhong #define DATA_SIZE 16
1831d9bb58e5SYang Zhong #include "atomic_template.h"
1832d9bb58e5SYang Zhong #endif
1833d9bb58e5SYang Zhong 
1834d9bb58e5SYang Zhong /* Second set of helpers are directly callable from TCG as helpers.  */
1835d9bb58e5SYang Zhong 
1836d9bb58e5SYang Zhong #undef EXTRA_ARGS
1837d9bb58e5SYang Zhong #undef ATOMIC_NAME
1838d9bb58e5SYang Zhong #undef ATOMIC_MMU_LOOKUP
1839d9bb58e5SYang Zhong #define EXTRA_ARGS         , TCGMemOpIdx oi
1840d9bb58e5SYang Zhong #define ATOMIC_NAME(X)     HELPER(glue(glue(atomic_ ## X, SUFFIX), END))
1841707526adSRichard Henderson #define ATOMIC_MMU_LOOKUP  atomic_mmu_lookup(env, addr, oi, GETPC())
1842d9bb58e5SYang Zhong 
1843d9bb58e5SYang Zhong #define DATA_SIZE 1
1844d9bb58e5SYang Zhong #include "atomic_template.h"
1845d9bb58e5SYang Zhong 
1846d9bb58e5SYang Zhong #define DATA_SIZE 2
1847d9bb58e5SYang Zhong #include "atomic_template.h"
1848d9bb58e5SYang Zhong 
1849d9bb58e5SYang Zhong #define DATA_SIZE 4
1850d9bb58e5SYang Zhong #include "atomic_template.h"
1851d9bb58e5SYang Zhong 
1852d9bb58e5SYang Zhong #ifdef CONFIG_ATOMIC64
1853d9bb58e5SYang Zhong #define DATA_SIZE 8
1854d9bb58e5SYang Zhong #include "atomic_template.h"
1855d9bb58e5SYang Zhong #endif
1856d9bb58e5SYang Zhong 
1857d9bb58e5SYang Zhong /* Code access functions.  */
1858d9bb58e5SYang Zhong 
18592dd92606SRichard Henderson static uint64_t full_ldub_cmmu(CPUArchState *env, target_ulong addr,
18602dd92606SRichard Henderson                                TCGMemOpIdx oi, uintptr_t retaddr)
18612dd92606SRichard Henderson {
1862be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_8, true, full_ldub_cmmu);
18632dd92606SRichard Henderson }
18642dd92606SRichard Henderson 
1865*4cef72d0SAlex Bennée uint8_t helper_ret_ldub_cmmu(CPUArchState *env, target_ulong addr,
1866fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1867eed56642SAlex Bennée {
18682dd92606SRichard Henderson     return full_ldub_cmmu(env, addr, oi, retaddr);
18692dd92606SRichard Henderson }
18702dd92606SRichard Henderson 
1871*4cef72d0SAlex Bennée int8_t helper_ret_ldsb_cmmu(CPUArchState *env, target_ulong addr,
1872*4cef72d0SAlex Bennée                             TCGMemOpIdx oi, uintptr_t retaddr)
1873*4cef72d0SAlex Bennée {
1874*4cef72d0SAlex Bennée     return (int8_t) full_ldub_cmmu(env, addr, oi, retaddr);
1875*4cef72d0SAlex Bennée }
1876*4cef72d0SAlex Bennée 
18772dd92606SRichard Henderson static uint64_t full_le_lduw_cmmu(CPUArchState *env, target_ulong addr,
18782dd92606SRichard Henderson                                   TCGMemOpIdx oi, uintptr_t retaddr)
18792dd92606SRichard Henderson {
1880be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEUW, true,
18812dd92606SRichard Henderson                        full_le_lduw_cmmu);
1882eed56642SAlex Bennée }
1883d9bb58e5SYang Zhong 
1884*4cef72d0SAlex Bennée uint16_t helper_le_lduw_cmmu(CPUArchState *env, target_ulong addr,
1885fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1886eed56642SAlex Bennée {
18872dd92606SRichard Henderson     return full_le_lduw_cmmu(env, addr, oi, retaddr);
18882dd92606SRichard Henderson }
18892dd92606SRichard Henderson 
1890*4cef72d0SAlex Bennée int16_t helper_le_ldsw_cmmu(CPUArchState *env, target_ulong addr,
1891*4cef72d0SAlex Bennée                             TCGMemOpIdx oi, uintptr_t retaddr)
1892*4cef72d0SAlex Bennée {
1893*4cef72d0SAlex Bennée     return (int16_t) full_le_lduw_cmmu(env, addr, oi, retaddr);
1894*4cef72d0SAlex Bennée }
1895*4cef72d0SAlex Bennée 
18962dd92606SRichard Henderson static uint64_t full_be_lduw_cmmu(CPUArchState *env, target_ulong addr,
18972dd92606SRichard Henderson                                   TCGMemOpIdx oi, uintptr_t retaddr)
18982dd92606SRichard Henderson {
1899be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEUW, true,
19002dd92606SRichard Henderson                        full_be_lduw_cmmu);
1901eed56642SAlex Bennée }
1902d9bb58e5SYang Zhong 
1903*4cef72d0SAlex Bennée uint16_t helper_be_lduw_cmmu(CPUArchState *env, target_ulong addr,
1904fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1905eed56642SAlex Bennée {
19062dd92606SRichard Henderson     return full_be_lduw_cmmu(env, addr, oi, retaddr);
19072dd92606SRichard Henderson }
19082dd92606SRichard Henderson 
1909*4cef72d0SAlex Bennée int16_t helper_be_ldsw_cmmu(CPUArchState *env, target_ulong addr,
1910*4cef72d0SAlex Bennée                             TCGMemOpIdx oi, uintptr_t retaddr)
1911*4cef72d0SAlex Bennée {
1912*4cef72d0SAlex Bennée     return (int16_t) full_be_lduw_cmmu(env, addr, oi, retaddr);
1913*4cef72d0SAlex Bennée }
1914*4cef72d0SAlex Bennée 
19152dd92606SRichard Henderson static uint64_t full_le_ldul_cmmu(CPUArchState *env, target_ulong addr,
19162dd92606SRichard Henderson                                   TCGMemOpIdx oi, uintptr_t retaddr)
19172dd92606SRichard Henderson {
1918be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEUL, true,
19192dd92606SRichard Henderson                        full_le_ldul_cmmu);
1920eed56642SAlex Bennée }
1921d9bb58e5SYang Zhong 
1922fc1bc777SRichard Henderson uint32_t helper_le_ldl_cmmu(CPUArchState *env, target_ulong addr,
1923fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1924eed56642SAlex Bennée {
19252dd92606SRichard Henderson     return full_le_ldul_cmmu(env, addr, oi, retaddr);
19262dd92606SRichard Henderson }
19272dd92606SRichard Henderson 
19282dd92606SRichard Henderson static uint64_t full_be_ldul_cmmu(CPUArchState *env, target_ulong addr,
19292dd92606SRichard Henderson                                   TCGMemOpIdx oi, uintptr_t retaddr)
19302dd92606SRichard Henderson {
1931be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEUL, true,
19322dd92606SRichard Henderson                        full_be_ldul_cmmu);
1933eed56642SAlex Bennée }
1934d9bb58e5SYang Zhong 
1935fc1bc777SRichard Henderson uint32_t helper_be_ldl_cmmu(CPUArchState *env, target_ulong addr,
1936fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1937eed56642SAlex Bennée {
19382dd92606SRichard Henderson     return full_be_ldul_cmmu(env, addr, oi, retaddr);
1939eed56642SAlex Bennée }
1940eed56642SAlex Bennée 
1941fc1bc777SRichard Henderson uint64_t helper_le_ldq_cmmu(CPUArchState *env, target_ulong addr,
1942fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1943eed56642SAlex Bennée {
1944be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_LEQ, true,
19452dd92606SRichard Henderson                        helper_le_ldq_cmmu);
1946eed56642SAlex Bennée }
1947eed56642SAlex Bennée 
1948fc1bc777SRichard Henderson uint64_t helper_be_ldq_cmmu(CPUArchState *env, target_ulong addr,
1949fc1bc777SRichard Henderson                             TCGMemOpIdx oi, uintptr_t retaddr)
1950eed56642SAlex Bennée {
1951be5c4787STony Nguyen     return load_helper(env, addr, oi, retaddr, MO_BEQ, true,
19522dd92606SRichard Henderson                        helper_be_ldq_cmmu);
1953eed56642SAlex Bennée }
1954