xref: /qemu/accel/tcg/user-exec.c (revision 03c981e7d63eaa03e6b7c4b9ef59b45b0b985876)
142a623c7SBlue Swirl /*
242a623c7SBlue Swirl  *  User emulator execution
342a623c7SBlue Swirl  *
442a623c7SBlue Swirl  *  Copyright (c) 2003-2005 Fabrice Bellard
542a623c7SBlue Swirl  *
642a623c7SBlue Swirl  * This library is free software; you can redistribute it and/or
742a623c7SBlue Swirl  * modify it under the terms of the GNU Lesser General Public
842a623c7SBlue Swirl  * License as published by the Free Software Foundation; either
9fb0343d5SThomas Huth  * version 2.1 of the License, or (at your option) any later version.
1042a623c7SBlue Swirl  *
1142a623c7SBlue Swirl  * This library is distributed in the hope that it will be useful,
1242a623c7SBlue Swirl  * but WITHOUT ANY WARRANTY; without even the implied warranty of
1342a623c7SBlue Swirl  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
1442a623c7SBlue Swirl  * Lesser General Public License for more details.
1542a623c7SBlue Swirl  *
1642a623c7SBlue Swirl  * You should have received a copy of the GNU Lesser General Public
1742a623c7SBlue Swirl  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
1842a623c7SBlue Swirl  */
19d38ea87aSPeter Maydell #include "qemu/osdep.h"
2015017436SPhilippe Mathieu-Daudé #include "accel/tcg/cpu-ops.h"
2176cad711SPaolo Bonzini #include "disas/disas.h"
224fadca8dSPierrick Bouvier #include "cpu.h"
23585d4b12SPhilippe Mathieu-Daudé #include "exec/vaddr.h"
244d43552aSPierrick Bouvier #include "exec/tlb-flags.h"
25dcb32f1dSPhilippe Mathieu-Daudé #include "tcg/tcg.h"
26023b0ae3SPeter Maydell #include "qemu/bitops.h"
27177a8cb8SRichard Henderson #include "qemu/rcu.h"
2842fa9665SPhilippe Mathieu-Daudé #include "accel/tcg/cpu-ldst.h"
290baf907bSRichard Henderson #include "accel/tcg/helper-retaddr.h"
30fe1a3aceSPhilippe Mathieu-Daudé #include "accel/tcg/probe.h"
311bf0d6e4SPhilippe Mathieu-Daudé #include "user/cpu_loop.h"
32*03c981e7SRichard Henderson #include "user/guest-host.h"
3340ab89f3SPhilippe Mathieu-Daudé #include "qemu/main-loop.h"
34634f1455SPhilippe Mathieu-Daudé #include "user/page-protection.h"
3574781c08SPhilippe Mathieu-Daudé #include "exec/page-protection.h"
36a411d296SPhilippe Mathieu-Daudé #include "exec/helper-proto.h"
37e6cd4bb5SRichard Henderson #include "qemu/atomic128.h"
38a523b62cSPhilippe Mathieu-Daudé #include "qemu/bswap.h"
39a523b62cSPhilippe Mathieu-Daudé #include "qemu/int128.h"
40b24bad34SAlex Bennée #include "trace.h"
4137e891e3SRichard Henderson #include "tcg/tcg-ldst.h"
429638cb59SPhilippe Mathieu-Daudé #include "backend-ldst.h"
4343e7a2d3SPhilippe Mathieu-Daudé #include "internal-common.h"
4493ef2c2fSPhilippe Mathieu-Daudé #include "tb-internal.h"
4542a623c7SBlue Swirl 
46ec603b55SRichard Henderson __thread uintptr_t helper_retaddr;
47ec603b55SRichard Henderson 
4842a623c7SBlue Swirl //#define DEBUG_SIGNAL
4942a623c7SBlue Swirl 
5040ab89f3SPhilippe Mathieu-Daudé void cpu_interrupt(CPUState *cpu, int mask)
5140ab89f3SPhilippe Mathieu-Daudé {
5240ab89f3SPhilippe Mathieu-Daudé     g_assert(bql_locked());
5340ab89f3SPhilippe Mathieu-Daudé     cpu->interrupt_request |= mask;
5440ab89f3SPhilippe Mathieu-Daudé     qatomic_set(&cpu->neg.icount_decr.u16.high, -1);
5540ab89f3SPhilippe Mathieu-Daudé }
5640ab89f3SPhilippe Mathieu-Daudé 
570fdbb7d2SRichard Henderson /*
580fdbb7d2SRichard Henderson  * Adjust the pc to pass to cpu_restore_state; return the memop type.
590fdbb7d2SRichard Henderson  */
600fdbb7d2SRichard Henderson MMUAccessType adjust_signal_pc(uintptr_t *pc, bool is_write)
6142a623c7SBlue Swirl {
6252ba13f0SRichard Henderson     switch (helper_retaddr) {
6352ba13f0SRichard Henderson     default:
6452ba13f0SRichard Henderson         /*
6552ba13f0SRichard Henderson          * Fault during host memory operation within a helper function.
6652ba13f0SRichard Henderson          * The helper's host return address, saved here, gives us a
6752ba13f0SRichard Henderson          * pointer into the generated code that will unwind to the
6852ba13f0SRichard Henderson          * correct guest pc.
69ec603b55SRichard Henderson          */
700fdbb7d2SRichard Henderson         *pc = helper_retaddr;
7152ba13f0SRichard Henderson         break;
7252ba13f0SRichard Henderson 
7352ba13f0SRichard Henderson     case 0:
7452ba13f0SRichard Henderson         /*
7552ba13f0SRichard Henderson          * Fault during host memory operation within generated code.
7652ba13f0SRichard Henderson          * (Or, a unrelated bug within qemu, but we can't tell from here).
7752ba13f0SRichard Henderson          *
7852ba13f0SRichard Henderson          * We take the host pc from the signal frame.  However, we cannot
7952ba13f0SRichard Henderson          * use that value directly.  Within cpu_restore_state_from_tb, we
8052ba13f0SRichard Henderson          * assume PC comes from GETPC(), as used by the helper functions,
8152ba13f0SRichard Henderson          * so we adjust the address by -GETPC_ADJ to form an address that
82e3a6e0daSzhaolichang          * is within the call insn, so that the address does not accidentally
8352ba13f0SRichard Henderson          * match the beginning of the next guest insn.  However, when the
8452ba13f0SRichard Henderson          * pc comes from the signal frame it points to the actual faulting
8552ba13f0SRichard Henderson          * host memory insn and not the return from a call insn.
8652ba13f0SRichard Henderson          *
8752ba13f0SRichard Henderson          * Therefore, adjust to compensate for what will be done later
8852ba13f0SRichard Henderson          * by cpu_restore_state_from_tb.
8952ba13f0SRichard Henderson          */
900fdbb7d2SRichard Henderson         *pc += GETPC_ADJ;
9152ba13f0SRichard Henderson         break;
9252ba13f0SRichard Henderson 
9352ba13f0SRichard Henderson     case 1:
9452ba13f0SRichard Henderson         /*
9552ba13f0SRichard Henderson          * Fault during host read for translation, or loosely, "execution".
9652ba13f0SRichard Henderson          *
9752ba13f0SRichard Henderson          * The guest pc is already pointing to the start of the TB for which
9852ba13f0SRichard Henderson          * code is being generated.  If the guest translator manages the
9952ba13f0SRichard Henderson          * page crossings correctly, this is exactly the correct address
10052ba13f0SRichard Henderson          * (and if the translator doesn't handle page boundaries correctly
10152ba13f0SRichard Henderson          * there's little we can do about that here).  Therefore, do not
10252ba13f0SRichard Henderson          * trigger the unwinder.
10352ba13f0SRichard Henderson          */
1040fdbb7d2SRichard Henderson         *pc = 0;
1050fdbb7d2SRichard Henderson         return MMU_INST_FETCH;
106ec603b55SRichard Henderson     }
107ec603b55SRichard Henderson 
1080fdbb7d2SRichard Henderson     return is_write ? MMU_DATA_STORE : MMU_DATA_LOAD;
1090fdbb7d2SRichard Henderson }
1100fdbb7d2SRichard Henderson 
1115e38ba7dSRichard Henderson /**
1125e38ba7dSRichard Henderson  * handle_sigsegv_accerr_write:
1135e38ba7dSRichard Henderson  * @cpu: the cpu context
1145e38ba7dSRichard Henderson  * @old_set: the sigset_t from the signal ucontext_t
1155e38ba7dSRichard Henderson  * @host_pc: the host pc, adjusted for the signal
1165e38ba7dSRichard Henderson  * @guest_addr: the guest address of the fault
1175e38ba7dSRichard Henderson  *
1185e38ba7dSRichard Henderson  * Return true if the write fault has been handled, and should be re-tried.
1195e38ba7dSRichard Henderson  *
1205e38ba7dSRichard Henderson  * Note that it is important that we don't call page_unprotect() unless
1219323e79fSPeter Maydell  * this is really a "write to nonwritable page" fault, because
1225e38ba7dSRichard Henderson  * page_unprotect() assumes that if it is called for an access to
1239323e79fSPeter Maydell  * a page that's writable this means we had two threads racing and
1249323e79fSPeter Maydell  * another thread got there first and already made the page writable;
1255e38ba7dSRichard Henderson  * so we will retry the access. If we were to call page_unprotect()
1265e38ba7dSRichard Henderson  * for some other kind of fault that should really be passed to the
1275e38ba7dSRichard Henderson  * guest, we'd end up in an infinite loop of retrying the faulting access.
1285e38ba7dSRichard Henderson  */
1295e38ba7dSRichard Henderson bool handle_sigsegv_accerr_write(CPUState *cpu, sigset_t *old_set,
130d551b822SRichard Henderson                                  uintptr_t host_pc, vaddr guest_addr)
1315e38ba7dSRichard Henderson {
13243625e35SRichard Henderson     switch (page_unprotect(cpu, guest_addr, host_pc)) {
1335e38ba7dSRichard Henderson     case 0:
1345e38ba7dSRichard Henderson         /*
1355e38ba7dSRichard Henderson          * Fault not caused by a page marked unwritable to protect
1365e38ba7dSRichard Henderson          * cached translations, must be the guest binary's problem.
1375e38ba7dSRichard Henderson          */
1385e38ba7dSRichard Henderson         return false;
1395e38ba7dSRichard Henderson     case 1:
1405e38ba7dSRichard Henderson         /*
1415e38ba7dSRichard Henderson          * Fault caused by protection of cached translation; TBs
1425e38ba7dSRichard Henderson          * invalidated, so resume execution.
1435e38ba7dSRichard Henderson          */
1445e38ba7dSRichard Henderson         return true;
1455e38ba7dSRichard Henderson     case 2:
1465e38ba7dSRichard Henderson         /*
1475e38ba7dSRichard Henderson          * Fault caused by protection of cached translation, and the
1485e38ba7dSRichard Henderson          * currently executing TB was modified and must be exited immediately.
1495e38ba7dSRichard Henderson          */
150940b3090SRichard Henderson         sigprocmask(SIG_SETMASK, old_set, NULL);
151940b3090SRichard Henderson         cpu_loop_exit_noexc(cpu);
1525e38ba7dSRichard Henderson         /* NORETURN */
1535e38ba7dSRichard Henderson     default:
1545e38ba7dSRichard Henderson         g_assert_not_reached();
1555e38ba7dSRichard Henderson     }
1565e38ba7dSRichard Henderson }
1575e38ba7dSRichard Henderson 
15867ff2186SRichard Henderson typedef struct PageFlagsNode {
159177a8cb8SRichard Henderson     struct rcu_head rcu;
16067ff2186SRichard Henderson     IntervalTreeNode itree;
16167ff2186SRichard Henderson     int flags;
16267ff2186SRichard Henderson } PageFlagsNode;
163d941c086SRichard Henderson 
16467ff2186SRichard Henderson static IntervalTreeRoot pageflags_root;
16567ff2186SRichard Henderson 
1665627d5c0SRichard Henderson static PageFlagsNode *pageflags_find(vaddr start, vaddr last)
167d941c086SRichard Henderson {
16867ff2186SRichard Henderson     IntervalTreeNode *n;
16967ff2186SRichard Henderson 
17067ff2186SRichard Henderson     n = interval_tree_iter_first(&pageflags_root, start, last);
17167ff2186SRichard Henderson     return n ? container_of(n, PageFlagsNode, itree) : NULL;
172d941c086SRichard Henderson }
173d941c086SRichard Henderson 
1745627d5c0SRichard Henderson static PageFlagsNode *pageflags_next(PageFlagsNode *p, vaddr start, vaddr last)
175d941c086SRichard Henderson {
17667ff2186SRichard Henderson     IntervalTreeNode *n;
177d941c086SRichard Henderson 
17867ff2186SRichard Henderson     n = interval_tree_iter_next(&p->itree, start, last);
17967ff2186SRichard Henderson     return n ? container_of(n, PageFlagsNode, itree) : NULL;
180d941c086SRichard Henderson }
181d941c086SRichard Henderson 
182d941c086SRichard Henderson int walk_memory_regions(void *priv, walk_memory_regions_fn fn)
183d941c086SRichard Henderson {
18467ff2186SRichard Henderson     IntervalTreeNode *n;
18567ff2186SRichard Henderson     int rc = 0;
186d941c086SRichard Henderson 
18767ff2186SRichard Henderson     mmap_lock();
18867ff2186SRichard Henderson     for (n = interval_tree_iter_first(&pageflags_root, 0, -1);
18967ff2186SRichard Henderson          n != NULL;
19067ff2186SRichard Henderson          n = interval_tree_iter_next(n, 0, -1)) {
19167ff2186SRichard Henderson         PageFlagsNode *p = container_of(n, PageFlagsNode, itree);
192d941c086SRichard Henderson 
19367ff2186SRichard Henderson         rc = fn(priv, n->start, n->last + 1, p->flags);
194d941c086SRichard Henderson         if (rc != 0) {
19567ff2186SRichard Henderson             break;
196d941c086SRichard Henderson         }
197d941c086SRichard Henderson     }
19867ff2186SRichard Henderson     mmap_unlock();
199d941c086SRichard Henderson 
20067ff2186SRichard Henderson     return rc;
201d941c086SRichard Henderson }
202d941c086SRichard Henderson 
203e1c8eb8cSRichard Henderson static int dump_region(void *opaque, vaddr start, vaddr end, int prot)
204d941c086SRichard Henderson {
205e1c8eb8cSRichard Henderson     FILE *f = opaque;
206*03c981e7SRichard Henderson     uint64_t mask;
207*03c981e7SRichard Henderson     int width;
208d941c086SRichard Henderson 
209*03c981e7SRichard Henderson     if (guest_addr_max <= UINT32_MAX) {
210*03c981e7SRichard Henderson         mask = UINT32_MAX, width = 8;
211*03c981e7SRichard Henderson     } else {
212*03c981e7SRichard Henderson         mask = UINT64_MAX, width = 16;
213*03c981e7SRichard Henderson     }
214*03c981e7SRichard Henderson 
215*03c981e7SRichard Henderson     fprintf(f, "%0*" PRIx64 "-%0*" PRIx64 " %0*" PRIx64 " %c%c%c\n",
216*03c981e7SRichard Henderson             width, start & mask,
217*03c981e7SRichard Henderson             width, end & mask,
218*03c981e7SRichard Henderson             width, (end - start) & mask,
219d941c086SRichard Henderson             ((prot & PAGE_READ) ? 'r' : '-'),
220d941c086SRichard Henderson             ((prot & PAGE_WRITE) ? 'w' : '-'),
221d941c086SRichard Henderson             ((prot & PAGE_EXEC) ? 'x' : '-'));
222d941c086SRichard Henderson     return 0;
223d941c086SRichard Henderson }
224d941c086SRichard Henderson 
225d941c086SRichard Henderson /* dump memory mappings */
226d941c086SRichard Henderson void page_dump(FILE *f)
227d941c086SRichard Henderson {
228*03c981e7SRichard Henderson     int width = guest_addr_max <= UINT32_MAX ? 8 : 16;
22967ff2186SRichard Henderson 
23067ff2186SRichard Henderson     fprintf(f, "%-*s %-*s %-*s %s\n",
231*03c981e7SRichard Henderson             width, "start", width, "end", width, "size", "prot");
232d941c086SRichard Henderson     walk_memory_regions(f, dump_region);
233d941c086SRichard Henderson }
234d941c086SRichard Henderson 
2355627d5c0SRichard Henderson int page_get_flags(vaddr address)
236d941c086SRichard Henderson {
23767ff2186SRichard Henderson     PageFlagsNode *p = pageflags_find(address, address);
238d941c086SRichard Henderson 
23967ff2186SRichard Henderson     /*
24067ff2186SRichard Henderson      * See util/interval-tree.c re lockless lookups: no false positives but
24167ff2186SRichard Henderson      * there are false negatives.  If we find nothing, retry with the mmap
24267ff2186SRichard Henderson      * lock acquired.
24367ff2186SRichard Henderson      */
24467ff2186SRichard Henderson     if (p) {
24567ff2186SRichard Henderson         return p->flags;
24667ff2186SRichard Henderson     }
24767ff2186SRichard Henderson     if (have_mmap_lock()) {
248d941c086SRichard Henderson         return 0;
249d941c086SRichard Henderson     }
25067ff2186SRichard Henderson 
25167ff2186SRichard Henderson     mmap_lock();
25267ff2186SRichard Henderson     p = pageflags_find(address, address);
25367ff2186SRichard Henderson     mmap_unlock();
25467ff2186SRichard Henderson     return p ? p->flags : 0;
25567ff2186SRichard Henderson }
25667ff2186SRichard Henderson 
25767ff2186SRichard Henderson /* A subroutine of page_set_flags: insert a new node for [start,last]. */
2585627d5c0SRichard Henderson static void pageflags_create(vaddr start, vaddr last, int flags)
25967ff2186SRichard Henderson {
26067ff2186SRichard Henderson     PageFlagsNode *p = g_new(PageFlagsNode, 1);
26167ff2186SRichard Henderson 
26267ff2186SRichard Henderson     p->itree.start = start;
26367ff2186SRichard Henderson     p->itree.last = last;
26467ff2186SRichard Henderson     p->flags = flags;
26567ff2186SRichard Henderson     interval_tree_insert(&p->itree, &pageflags_root);
26667ff2186SRichard Henderson }
26767ff2186SRichard Henderson 
26867ff2186SRichard Henderson /* A subroutine of page_set_flags: remove everything in [start,last]. */
2695627d5c0SRichard Henderson static bool pageflags_unset(vaddr start, vaddr last)
27067ff2186SRichard Henderson {
27167ff2186SRichard Henderson     bool inval_tb = false;
27267ff2186SRichard Henderson 
27367ff2186SRichard Henderson     while (true) {
27467ff2186SRichard Henderson         PageFlagsNode *p = pageflags_find(start, last);
2755627d5c0SRichard Henderson         vaddr p_last;
27667ff2186SRichard Henderson 
27767ff2186SRichard Henderson         if (!p) {
27867ff2186SRichard Henderson             break;
27967ff2186SRichard Henderson         }
28067ff2186SRichard Henderson 
28167ff2186SRichard Henderson         if (p->flags & PAGE_EXEC) {
28267ff2186SRichard Henderson             inval_tb = true;
28367ff2186SRichard Henderson         }
28467ff2186SRichard Henderson 
28567ff2186SRichard Henderson         interval_tree_remove(&p->itree, &pageflags_root);
28667ff2186SRichard Henderson         p_last = p->itree.last;
28767ff2186SRichard Henderson 
28867ff2186SRichard Henderson         if (p->itree.start < start) {
28967ff2186SRichard Henderson             /* Truncate the node from the end, or split out the middle. */
29067ff2186SRichard Henderson             p->itree.last = start - 1;
29167ff2186SRichard Henderson             interval_tree_insert(&p->itree, &pageflags_root);
29267ff2186SRichard Henderson             if (last < p_last) {
29367ff2186SRichard Henderson                 pageflags_create(last + 1, p_last, p->flags);
29467ff2186SRichard Henderson                 break;
29567ff2186SRichard Henderson             }
29667ff2186SRichard Henderson         } else if (p_last <= last) {
29767ff2186SRichard Henderson             /* Range completely covers node -- remove it. */
298177a8cb8SRichard Henderson             g_free_rcu(p, rcu);
29967ff2186SRichard Henderson         } else {
30067ff2186SRichard Henderson             /* Truncate the node from the start. */
30167ff2186SRichard Henderson             p->itree.start = last + 1;
30267ff2186SRichard Henderson             interval_tree_insert(&p->itree, &pageflags_root);
30367ff2186SRichard Henderson             break;
30467ff2186SRichard Henderson         }
30567ff2186SRichard Henderson     }
30667ff2186SRichard Henderson 
30767ff2186SRichard Henderson     return inval_tb;
30867ff2186SRichard Henderson }
30967ff2186SRichard Henderson 
31067ff2186SRichard Henderson /*
31167ff2186SRichard Henderson  * A subroutine of page_set_flags: nothing overlaps [start,last],
31267ff2186SRichard Henderson  * but check adjacent mappings and maybe merge into a single range.
31367ff2186SRichard Henderson  */
3145627d5c0SRichard Henderson static void pageflags_create_merge(vaddr start, vaddr last, int flags)
31567ff2186SRichard Henderson {
31667ff2186SRichard Henderson     PageFlagsNode *next = NULL, *prev = NULL;
31767ff2186SRichard Henderson 
31867ff2186SRichard Henderson     if (start > 0) {
31967ff2186SRichard Henderson         prev = pageflags_find(start - 1, start - 1);
32067ff2186SRichard Henderson         if (prev) {
32167ff2186SRichard Henderson             if (prev->flags == flags) {
32267ff2186SRichard Henderson                 interval_tree_remove(&prev->itree, &pageflags_root);
32367ff2186SRichard Henderson             } else {
32467ff2186SRichard Henderson                 prev = NULL;
32567ff2186SRichard Henderson             }
32667ff2186SRichard Henderson         }
32767ff2186SRichard Henderson     }
32867ff2186SRichard Henderson     if (last + 1 != 0) {
32967ff2186SRichard Henderson         next = pageflags_find(last + 1, last + 1);
33067ff2186SRichard Henderson         if (next) {
33167ff2186SRichard Henderson             if (next->flags == flags) {
33267ff2186SRichard Henderson                 interval_tree_remove(&next->itree, &pageflags_root);
33367ff2186SRichard Henderson             } else {
33467ff2186SRichard Henderson                 next = NULL;
33567ff2186SRichard Henderson             }
33667ff2186SRichard Henderson         }
33767ff2186SRichard Henderson     }
33867ff2186SRichard Henderson 
33967ff2186SRichard Henderson     if (prev) {
34067ff2186SRichard Henderson         if (next) {
34167ff2186SRichard Henderson             prev->itree.last = next->itree.last;
342177a8cb8SRichard Henderson             g_free_rcu(next, rcu);
34367ff2186SRichard Henderson         } else {
34467ff2186SRichard Henderson             prev->itree.last = last;
34567ff2186SRichard Henderson         }
34667ff2186SRichard Henderson         interval_tree_insert(&prev->itree, &pageflags_root);
34767ff2186SRichard Henderson     } else if (next) {
34867ff2186SRichard Henderson         next->itree.start = start;
34967ff2186SRichard Henderson         interval_tree_insert(&next->itree, &pageflags_root);
35067ff2186SRichard Henderson     } else {
35167ff2186SRichard Henderson         pageflags_create(start, last, flags);
35267ff2186SRichard Henderson     }
353d941c086SRichard Henderson }
354d941c086SRichard Henderson 
355d941c086SRichard Henderson /*
356d941c086SRichard Henderson  * Allow the target to decide if PAGE_TARGET_[12] may be reset.
357d941c086SRichard Henderson  * By default, they are not kept.
358d941c086SRichard Henderson  */
359d941c086SRichard Henderson #ifndef PAGE_TARGET_STICKY
360d941c086SRichard Henderson #define PAGE_TARGET_STICKY  0
361d941c086SRichard Henderson #endif
362d941c086SRichard Henderson #define PAGE_STICKY  (PAGE_ANON | PAGE_PASSTHROUGH | PAGE_TARGET_STICKY)
363d941c086SRichard Henderson 
36467ff2186SRichard Henderson /* A subroutine of page_set_flags: add flags to [start,last]. */
3655627d5c0SRichard Henderson static bool pageflags_set_clear(vaddr start, vaddr last,
36667ff2186SRichard Henderson                                 int set_flags, int clear_flags)
36767ff2186SRichard Henderson {
36867ff2186SRichard Henderson     PageFlagsNode *p;
3695627d5c0SRichard Henderson     vaddr p_start, p_last;
37067ff2186SRichard Henderson     int p_flags, merge_flags;
37167ff2186SRichard Henderson     bool inval_tb = false;
37267ff2186SRichard Henderson 
37367ff2186SRichard Henderson  restart:
37467ff2186SRichard Henderson     p = pageflags_find(start, last);
37567ff2186SRichard Henderson     if (!p) {
37667ff2186SRichard Henderson         if (set_flags) {
37767ff2186SRichard Henderson             pageflags_create_merge(start, last, set_flags);
37867ff2186SRichard Henderson         }
37967ff2186SRichard Henderson         goto done;
38067ff2186SRichard Henderson     }
38167ff2186SRichard Henderson 
38267ff2186SRichard Henderson     p_start = p->itree.start;
38367ff2186SRichard Henderson     p_last = p->itree.last;
38467ff2186SRichard Henderson     p_flags = p->flags;
38567ff2186SRichard Henderson     /* Using mprotect on a page does not change sticky bits. */
38667ff2186SRichard Henderson     merge_flags = (p_flags & ~clear_flags) | set_flags;
38767ff2186SRichard Henderson 
38867ff2186SRichard Henderson     /*
38967ff2186SRichard Henderson      * Need to flush if an overlapping executable region
39067ff2186SRichard Henderson      * removes exec, or adds write.
39167ff2186SRichard Henderson      */
39267ff2186SRichard Henderson     if ((p_flags & PAGE_EXEC)
39367ff2186SRichard Henderson         && (!(merge_flags & PAGE_EXEC)
39467ff2186SRichard Henderson             || (merge_flags & ~p_flags & PAGE_WRITE))) {
39567ff2186SRichard Henderson         inval_tb = true;
39667ff2186SRichard Henderson     }
39767ff2186SRichard Henderson 
39867ff2186SRichard Henderson     /*
39967ff2186SRichard Henderson      * If there is an exact range match, update and return without
40067ff2186SRichard Henderson      * attempting to merge with adjacent regions.
40167ff2186SRichard Henderson      */
40267ff2186SRichard Henderson     if (start == p_start && last == p_last) {
40367ff2186SRichard Henderson         if (merge_flags) {
40467ff2186SRichard Henderson             p->flags = merge_flags;
40567ff2186SRichard Henderson         } else {
40667ff2186SRichard Henderson             interval_tree_remove(&p->itree, &pageflags_root);
407177a8cb8SRichard Henderson             g_free_rcu(p, rcu);
40867ff2186SRichard Henderson         }
40967ff2186SRichard Henderson         goto done;
41067ff2186SRichard Henderson     }
41167ff2186SRichard Henderson 
41267ff2186SRichard Henderson     /*
41367ff2186SRichard Henderson      * If sticky bits affect the original mapping, then we must be more
41467ff2186SRichard Henderson      * careful about the existing intervals and the separate flags.
41567ff2186SRichard Henderson      */
41667ff2186SRichard Henderson     if (set_flags != merge_flags) {
41767ff2186SRichard Henderson         if (p_start < start) {
41867ff2186SRichard Henderson             interval_tree_remove(&p->itree, &pageflags_root);
41967ff2186SRichard Henderson             p->itree.last = start - 1;
42067ff2186SRichard Henderson             interval_tree_insert(&p->itree, &pageflags_root);
42167ff2186SRichard Henderson 
42267ff2186SRichard Henderson             if (last < p_last) {
42367ff2186SRichard Henderson                 if (merge_flags) {
42467ff2186SRichard Henderson                     pageflags_create(start, last, merge_flags);
42567ff2186SRichard Henderson                 }
42667ff2186SRichard Henderson                 pageflags_create(last + 1, p_last, p_flags);
42767ff2186SRichard Henderson             } else {
42867ff2186SRichard Henderson                 if (merge_flags) {
42967ff2186SRichard Henderson                     pageflags_create(start, p_last, merge_flags);
43067ff2186SRichard Henderson                 }
43167ff2186SRichard Henderson                 if (p_last < last) {
43267ff2186SRichard Henderson                     start = p_last + 1;
43367ff2186SRichard Henderson                     goto restart;
43467ff2186SRichard Henderson                 }
43567ff2186SRichard Henderson             }
43667ff2186SRichard Henderson         } else {
43767ff2186SRichard Henderson             if (start < p_start && set_flags) {
43867ff2186SRichard Henderson                 pageflags_create(start, p_start - 1, set_flags);
43967ff2186SRichard Henderson             }
44067ff2186SRichard Henderson             if (last < p_last) {
44167ff2186SRichard Henderson                 interval_tree_remove(&p->itree, &pageflags_root);
44267ff2186SRichard Henderson                 p->itree.start = last + 1;
44367ff2186SRichard Henderson                 interval_tree_insert(&p->itree, &pageflags_root);
44467ff2186SRichard Henderson                 if (merge_flags) {
44567ff2186SRichard Henderson                     pageflags_create(start, last, merge_flags);
44667ff2186SRichard Henderson                 }
44767ff2186SRichard Henderson             } else {
44867ff2186SRichard Henderson                 if (merge_flags) {
44967ff2186SRichard Henderson                     p->flags = merge_flags;
45067ff2186SRichard Henderson                 } else {
45167ff2186SRichard Henderson                     interval_tree_remove(&p->itree, &pageflags_root);
452177a8cb8SRichard Henderson                     g_free_rcu(p, rcu);
45367ff2186SRichard Henderson                 }
45467ff2186SRichard Henderson                 if (p_last < last) {
45567ff2186SRichard Henderson                     start = p_last + 1;
45667ff2186SRichard Henderson                     goto restart;
45767ff2186SRichard Henderson                 }
45867ff2186SRichard Henderson             }
45967ff2186SRichard Henderson         }
46067ff2186SRichard Henderson         goto done;
46167ff2186SRichard Henderson     }
46267ff2186SRichard Henderson 
46367ff2186SRichard Henderson     /* If flags are not changing for this range, incorporate it. */
46467ff2186SRichard Henderson     if (set_flags == p_flags) {
46567ff2186SRichard Henderson         if (start < p_start) {
46667ff2186SRichard Henderson             interval_tree_remove(&p->itree, &pageflags_root);
46767ff2186SRichard Henderson             p->itree.start = start;
46867ff2186SRichard Henderson             interval_tree_insert(&p->itree, &pageflags_root);
46967ff2186SRichard Henderson         }
47067ff2186SRichard Henderson         if (p_last < last) {
47167ff2186SRichard Henderson             start = p_last + 1;
47267ff2186SRichard Henderson             goto restart;
47367ff2186SRichard Henderson         }
47467ff2186SRichard Henderson         goto done;
47567ff2186SRichard Henderson     }
47667ff2186SRichard Henderson 
47767ff2186SRichard Henderson     /* Maybe split out head and/or tail ranges with the original flags. */
47867ff2186SRichard Henderson     interval_tree_remove(&p->itree, &pageflags_root);
47967ff2186SRichard Henderson     if (p_start < start) {
48067ff2186SRichard Henderson         p->itree.last = start - 1;
48167ff2186SRichard Henderson         interval_tree_insert(&p->itree, &pageflags_root);
48267ff2186SRichard Henderson 
48367ff2186SRichard Henderson         if (p_last < last) {
48467ff2186SRichard Henderson             goto restart;
48567ff2186SRichard Henderson         }
48667ff2186SRichard Henderson         if (last < p_last) {
48767ff2186SRichard Henderson             pageflags_create(last + 1, p_last, p_flags);
48867ff2186SRichard Henderson         }
48967ff2186SRichard Henderson     } else if (last < p_last) {
49067ff2186SRichard Henderson         p->itree.start = last + 1;
49167ff2186SRichard Henderson         interval_tree_insert(&p->itree, &pageflags_root);
49267ff2186SRichard Henderson     } else {
493177a8cb8SRichard Henderson         g_free_rcu(p, rcu);
49467ff2186SRichard Henderson         goto restart;
49567ff2186SRichard Henderson     }
49667ff2186SRichard Henderson     if (set_flags) {
49767ff2186SRichard Henderson         pageflags_create(start, last, set_flags);
49867ff2186SRichard Henderson     }
49967ff2186SRichard Henderson 
50067ff2186SRichard Henderson  done:
50167ff2186SRichard Henderson     return inval_tb;
50267ff2186SRichard Henderson }
50367ff2186SRichard Henderson 
5045627d5c0SRichard Henderson void page_set_flags(vaddr start, vaddr last, int flags)
505d941c086SRichard Henderson {
50667ff2186SRichard Henderson     bool reset = false;
50767ff2186SRichard Henderson     bool inval_tb = false;
508d941c086SRichard Henderson 
509d941c086SRichard Henderson     /* This function should never be called with addresses outside the
510d941c086SRichard Henderson        guest address space.  If this assert fires, it probably indicates
511d941c086SRichard Henderson        a missing call to h2g_valid.  */
51249840a4aSRichard Henderson     assert(start <= last);
51330da4760SRichard Henderson     assert(last <= guest_addr_max);
514d941c086SRichard Henderson     /* Only set PAGE_ANON with new mappings. */
515d941c086SRichard Henderson     assert(!(flags & PAGE_ANON) || (flags & PAGE_RESET));
516d941c086SRichard Henderson     assert_memory_lock();
517d941c086SRichard Henderson 
51849840a4aSRichard Henderson     start &= TARGET_PAGE_MASK;
51949840a4aSRichard Henderson     last |= ~TARGET_PAGE_MASK;
520d941c086SRichard Henderson 
52167ff2186SRichard Henderson     if (!(flags & PAGE_VALID)) {
52267ff2186SRichard Henderson         flags = 0;
52367ff2186SRichard Henderson     } else {
52467ff2186SRichard Henderson         reset = flags & PAGE_RESET;
52567ff2186SRichard Henderson         flags &= ~PAGE_RESET;
526d941c086SRichard Henderson         if (flags & PAGE_WRITE) {
527d941c086SRichard Henderson             flags |= PAGE_WRITE_ORG;
528d941c086SRichard Henderson         }
52967ff2186SRichard Henderson     }
53067ff2186SRichard Henderson 
53167ff2186SRichard Henderson     if (!flags || reset) {
53210310cbdSRichard Henderson         page_reset_target_data(start, last);
53367ff2186SRichard Henderson         inval_tb |= pageflags_unset(start, last);
534d941c086SRichard Henderson     }
53567ff2186SRichard Henderson     if (flags) {
53667ff2186SRichard Henderson         inval_tb |= pageflags_set_clear(start, last, flags,
53767ff2186SRichard Henderson                                         ~(reset ? 0 : PAGE_STICKY));
538d941c086SRichard Henderson     }
539d941c086SRichard Henderson     if (inval_tb) {
540072e057eSRichard Henderson         tb_invalidate_phys_range(NULL, start, last);
541d941c086SRichard Henderson     }
542d941c086SRichard Henderson }
543d941c086SRichard Henderson 
5445627d5c0SRichard Henderson bool page_check_range(vaddr start, vaddr len, int flags)
545d941c086SRichard Henderson {
5465627d5c0SRichard Henderson     vaddr last;
547e630c012SRichard Henderson     int locked;  /* tri-state: =0: unlocked, +1: global, -1: local */
548bef6f008SRichard Henderson     bool ret;
549d941c086SRichard Henderson 
550d941c086SRichard Henderson     if (len == 0) {
551bef6f008SRichard Henderson         return true;  /* trivial length */
552d941c086SRichard Henderson     }
553d941c086SRichard Henderson 
55467ff2186SRichard Henderson     last = start + len - 1;
55567ff2186SRichard Henderson     if (last < start) {
556bef6f008SRichard Henderson         return false; /* wrap around */
55767ff2186SRichard Henderson     }
558d941c086SRichard Henderson 
559e630c012SRichard Henderson     locked = have_mmap_lock();
56067ff2186SRichard Henderson     while (true) {
56167ff2186SRichard Henderson         PageFlagsNode *p = pageflags_find(start, last);
56267ff2186SRichard Henderson         int missing;
56367ff2186SRichard Henderson 
564d941c086SRichard Henderson         if (!p) {
565e630c012SRichard Henderson             if (!locked) {
566e630c012SRichard Henderson                 /*
567e630c012SRichard Henderson                  * Lockless lookups have false negatives.
568e630c012SRichard Henderson                  * Retry with the lock held.
569e630c012SRichard Henderson                  */
570e630c012SRichard Henderson                 mmap_lock();
571e630c012SRichard Henderson                 locked = -1;
572e630c012SRichard Henderson                 p = pageflags_find(start, last);
573e630c012SRichard Henderson             }
574e630c012SRichard Henderson             if (!p) {
575bef6f008SRichard Henderson                 ret = false; /* entire region invalid */
576e630c012SRichard Henderson                 break;
577e630c012SRichard Henderson             }
578d941c086SRichard Henderson         }
57967ff2186SRichard Henderson         if (start < p->itree.start) {
580bef6f008SRichard Henderson             ret = false; /* initial bytes invalid */
581e630c012SRichard Henderson             break;
582d941c086SRichard Henderson         }
583d941c086SRichard Henderson 
58467ff2186SRichard Henderson         missing = flags & ~p->flags;
58591e9e116SRichard Henderson         if (missing & ~PAGE_WRITE) {
586bef6f008SRichard Henderson             ret = false; /* page doesn't match */
587e630c012SRichard Henderson             break;
588d941c086SRichard Henderson         }
58967ff2186SRichard Henderson         if (missing & PAGE_WRITE) {
590d941c086SRichard Henderson             if (!(p->flags & PAGE_WRITE_ORG)) {
591bef6f008SRichard Henderson                 ret = false; /* page not writable */
592e630c012SRichard Henderson                 break;
59367ff2186SRichard Henderson             }
59467ff2186SRichard Henderson             /* Asking about writable, but has been protected: undo. */
59543625e35SRichard Henderson             if (!page_unprotect(NULL, start, 0)) {
596bef6f008SRichard Henderson                 ret = false;
597e630c012SRichard Henderson                 break;
598d941c086SRichard Henderson             }
59967ff2186SRichard Henderson             /* TODO: page_unprotect should take a range, not a single page. */
60067ff2186SRichard Henderson             if (last - start < TARGET_PAGE_SIZE) {
601bef6f008SRichard Henderson                 ret = true; /* ok */
602e630c012SRichard Henderson                 break;
603d941c086SRichard Henderson             }
60467ff2186SRichard Henderson             start += TARGET_PAGE_SIZE;
605d941c086SRichard Henderson             continue;
606d941c086SRichard Henderson         }
60767ff2186SRichard Henderson 
60867ff2186SRichard Henderson         if (last <= p->itree.last) {
609bef6f008SRichard Henderson             ret = true; /* ok */
610e630c012SRichard Henderson             break;
611d941c086SRichard Henderson         }
61267ff2186SRichard Henderson         start = p->itree.last + 1;
61367ff2186SRichard Henderson     }
614e630c012SRichard Henderson 
615e630c012SRichard Henderson     /* Release the lock if acquired locally. */
616e630c012SRichard Henderson     if (locked < 0) {
617e630c012SRichard Henderson         mmap_unlock();
618e630c012SRichard Henderson     }
619e630c012SRichard Henderson     return ret;
62067ff2186SRichard Henderson }
62167ff2186SRichard Henderson 
6225627d5c0SRichard Henderson bool page_check_range_empty(vaddr start, vaddr last)
623c2281ddcSRichard Henderson {
624c2281ddcSRichard Henderson     assert(last >= start);
625c2281ddcSRichard Henderson     assert_memory_lock();
626c2281ddcSRichard Henderson     return pageflags_find(start, last) == NULL;
627c2281ddcSRichard Henderson }
628c2281ddcSRichard Henderson 
6295627d5c0SRichard Henderson vaddr page_find_range_empty(vaddr min, vaddr max, vaddr len, vaddr align)
630f2bb7cf2SRichard Henderson {
6315627d5c0SRichard Henderson     vaddr len_m1, align_m1;
632f2bb7cf2SRichard Henderson 
633f2bb7cf2SRichard Henderson     assert(min <= max);
63430da4760SRichard Henderson     assert(max <= guest_addr_max);
635f2bb7cf2SRichard Henderson     assert(len != 0);
636f2bb7cf2SRichard Henderson     assert(is_power_of_2(align));
637f2bb7cf2SRichard Henderson     assert_memory_lock();
638f2bb7cf2SRichard Henderson 
639f2bb7cf2SRichard Henderson     len_m1 = len - 1;
640f2bb7cf2SRichard Henderson     align_m1 = align - 1;
641f2bb7cf2SRichard Henderson 
642f2bb7cf2SRichard Henderson     /* Iteratively narrow the search region. */
643f2bb7cf2SRichard Henderson     while (1) {
644f2bb7cf2SRichard Henderson         PageFlagsNode *p;
645f2bb7cf2SRichard Henderson 
646f2bb7cf2SRichard Henderson         /* Align min and double-check there's enough space remaining. */
647f2bb7cf2SRichard Henderson         min = (min + align_m1) & ~align_m1;
648f2bb7cf2SRichard Henderson         if (min > max) {
649f2bb7cf2SRichard Henderson             return -1;
650f2bb7cf2SRichard Henderson         }
651f2bb7cf2SRichard Henderson         if (len_m1 > max - min) {
652f2bb7cf2SRichard Henderson             return -1;
653f2bb7cf2SRichard Henderson         }
654f2bb7cf2SRichard Henderson 
655f2bb7cf2SRichard Henderson         p = pageflags_find(min, min + len_m1);
656f2bb7cf2SRichard Henderson         if (p == NULL) {
657f2bb7cf2SRichard Henderson             /* Found! */
658f2bb7cf2SRichard Henderson             return min;
659f2bb7cf2SRichard Henderson         }
660f2bb7cf2SRichard Henderson         if (max <= p->itree.last) {
661f2bb7cf2SRichard Henderson             /* Existing allocation fills the remainder of the search region. */
662f2bb7cf2SRichard Henderson             return -1;
663f2bb7cf2SRichard Henderson         }
664f2bb7cf2SRichard Henderson         /* Skip across existing allocation. */
665f2bb7cf2SRichard Henderson         min = p->itree.last + 1;
666f2bb7cf2SRichard Henderson     }
667f2bb7cf2SRichard Henderson }
668f2bb7cf2SRichard Henderson 
669b103cc6eSRichard Henderson void tb_lock_page0(tb_page_addr_t address)
67067ff2186SRichard Henderson {
67167ff2186SRichard Henderson     PageFlagsNode *p;
6725627d5c0SRichard Henderson     vaddr start, last;
673a372d483SRichard Henderson     int host_page_size = qemu_real_host_page_size();
67467ff2186SRichard Henderson     int prot;
67567ff2186SRichard Henderson 
67667ff2186SRichard Henderson     assert_memory_lock();
67767ff2186SRichard Henderson 
678a372d483SRichard Henderson     if (host_page_size <= TARGET_PAGE_SIZE) {
67967ff2186SRichard Henderson         start = address & TARGET_PAGE_MASK;
68067ff2186SRichard Henderson         last = start + TARGET_PAGE_SIZE - 1;
68167ff2186SRichard Henderson     } else {
682a372d483SRichard Henderson         start = address & -host_page_size;
683a372d483SRichard Henderson         last = start + host_page_size - 1;
68467ff2186SRichard Henderson     }
68567ff2186SRichard Henderson 
68667ff2186SRichard Henderson     p = pageflags_find(start, last);
68767ff2186SRichard Henderson     if (!p) {
68867ff2186SRichard Henderson         return;
68967ff2186SRichard Henderson     }
69067ff2186SRichard Henderson     prot = p->flags;
69167ff2186SRichard Henderson 
69267ff2186SRichard Henderson     if (unlikely(p->itree.last < last)) {
69367ff2186SRichard Henderson         /* More than one protection region covers the one host page. */
694a372d483SRichard Henderson         assert(TARGET_PAGE_SIZE < host_page_size);
69567ff2186SRichard Henderson         while ((p = pageflags_next(p, start, last)) != NULL) {
69667ff2186SRichard Henderson             prot |= p->flags;
69767ff2186SRichard Henderson         }
69867ff2186SRichard Henderson     }
69967ff2186SRichard Henderson 
70067ff2186SRichard Henderson     if (prot & PAGE_WRITE) {
70167ff2186SRichard Henderson         pageflags_set_clear(start, last, 0, PAGE_WRITE);
702a372d483SRichard Henderson         mprotect(g2h_untagged(start), last - start + 1,
70367ff2186SRichard Henderson                  prot & (PAGE_READ | PAGE_EXEC) ? PROT_READ : PROT_NONE);
704d941c086SRichard Henderson     }
705d941c086SRichard Henderson }
706d941c086SRichard Henderson 
707d941c086SRichard Henderson /*
708d941c086SRichard Henderson  * Called from signal handler: invalidate the code and unprotect the
709d941c086SRichard Henderson  * page. Return 0 if the fault was not handled, 1 if it was handled,
710d941c086SRichard Henderson  * and 2 if it was handled but the caller must cause the TB to be
711d941c086SRichard Henderson  * immediately exited. (We can only return 2 if the 'pc' argument is
712d941c086SRichard Henderson  * non-zero.)
713d941c086SRichard Henderson  */
71443625e35SRichard Henderson int page_unprotect(CPUState *cpu, tb_page_addr_t address, uintptr_t pc)
715d941c086SRichard Henderson {
71667ff2186SRichard Henderson     PageFlagsNode *p;
717d941c086SRichard Henderson     bool current_tb_invalidated;
718d941c086SRichard Henderson 
71943625e35SRichard Henderson     assert((cpu == NULL) == (pc == 0));
72043625e35SRichard Henderson 
721d941c086SRichard Henderson     /*
722d941c086SRichard Henderson      * Technically this isn't safe inside a signal handler.  However we
723d941c086SRichard Henderson      * know this only ever happens in a synchronous SEGV handler, so in
724d941c086SRichard Henderson      * practice it seems to be ok.
725d941c086SRichard Henderson      */
726d941c086SRichard Henderson     mmap_lock();
727d941c086SRichard Henderson 
72867ff2186SRichard Henderson     p = pageflags_find(address, address);
72967ff2186SRichard Henderson 
73067ff2186SRichard Henderson     /* If this address was not really writable, nothing to do. */
73167ff2186SRichard Henderson     if (!p || !(p->flags & PAGE_WRITE_ORG)) {
732d941c086SRichard Henderson         mmap_unlock();
733d941c086SRichard Henderson         return 0;
734d941c086SRichard Henderson     }
735d941c086SRichard Henderson 
736d941c086SRichard Henderson     current_tb_invalidated = false;
737d941c086SRichard Henderson     if (p->flags & PAGE_WRITE) {
738d941c086SRichard Henderson         /*
739d941c086SRichard Henderson          * If the page is actually marked WRITE then assume this is because
740d941c086SRichard Henderson          * this thread raced with another one which got here first and
741d941c086SRichard Henderson          * set the page to PAGE_WRITE and did the TB invalidate for us.
742d941c086SRichard Henderson          */
74377ad412bSRichard Henderson         if (pc && cpu->cc->tcg_ops->precise_smc) {
744d941c086SRichard Henderson             TranslationBlock *current_tb = tcg_tb_lookup(pc);
745d941c086SRichard Henderson             if (current_tb) {
746d941c086SRichard Henderson                 current_tb_invalidated = tb_cflags(current_tb) & CF_INVALID;
747d941c086SRichard Henderson             }
74877ad412bSRichard Henderson         }
749d941c086SRichard Henderson     } else {
750a372d483SRichard Henderson         int host_page_size = qemu_real_host_page_size();
7515627d5c0SRichard Henderson         vaddr start, len, i;
75267ff2186SRichard Henderson         int prot;
753d941c086SRichard Henderson 
754a372d483SRichard Henderson         if (host_page_size <= TARGET_PAGE_SIZE) {
75567ff2186SRichard Henderson             start = address & TARGET_PAGE_MASK;
75667ff2186SRichard Henderson             len = TARGET_PAGE_SIZE;
75767ff2186SRichard Henderson             prot = p->flags | PAGE_WRITE;
75867ff2186SRichard Henderson             pageflags_set_clear(start, start + len - 1, PAGE_WRITE, 0);
75900f70884SRichard Henderson             current_tb_invalidated =
76000f70884SRichard Henderson                 tb_invalidate_phys_page_unwind(cpu, start, pc);
76167ff2186SRichard Henderson         } else {
762a372d483SRichard Henderson             start = address & -host_page_size;
763a372d483SRichard Henderson             len = host_page_size;
764d941c086SRichard Henderson             prot = 0;
765d941c086SRichard Henderson 
76667ff2186SRichard Henderson             for (i = 0; i < len; i += TARGET_PAGE_SIZE) {
7675627d5c0SRichard Henderson                 vaddr addr = start + i;
76867ff2186SRichard Henderson 
76967ff2186SRichard Henderson                 p = pageflags_find(addr, addr);
77067ff2186SRichard Henderson                 if (p) {
77167ff2186SRichard Henderson                     prot |= p->flags;
77267ff2186SRichard Henderson                     if (p->flags & PAGE_WRITE_ORG) {
77367ff2186SRichard Henderson                         prot |= PAGE_WRITE;
77467ff2186SRichard Henderson                         pageflags_set_clear(addr, addr + TARGET_PAGE_SIZE - 1,
77567ff2186SRichard Henderson                                             PAGE_WRITE, 0);
77667ff2186SRichard Henderson                     }
77767ff2186SRichard Henderson                 }
778d941c086SRichard Henderson                 /*
779d941c086SRichard Henderson                  * Since the content will be modified, we must invalidate
780d941c086SRichard Henderson                  * the corresponding translated code.
781d941c086SRichard Henderson                  */
782d941c086SRichard Henderson                 current_tb_invalidated |=
78300f70884SRichard Henderson                     tb_invalidate_phys_page_unwind(cpu, addr, pc);
784d941c086SRichard Henderson             }
78567ff2186SRichard Henderson         }
78667ff2186SRichard Henderson         if (prot & PAGE_EXEC) {
78767ff2186SRichard Henderson             prot = (prot & ~PAGE_EXEC) | PAGE_READ;
78867ff2186SRichard Henderson         }
78986b7c551SBALATON Zoltan         mprotect((void *)g2h_untagged(start), len, prot & PAGE_RWX);
790d941c086SRichard Henderson     }
791d941c086SRichard Henderson     mmap_unlock();
79267ff2186SRichard Henderson 
793d941c086SRichard Henderson     /* If current TB was invalidated return to main loop */
794d941c086SRichard Henderson     return current_tb_invalidated ? 2 : 1;
795d941c086SRichard Henderson }
796d941c086SRichard Henderson 
7974f8f4127SAnton Johansson static int probe_access_internal(CPUArchState *env, vaddr addr,
798069cfe77SRichard Henderson                                  int fault_size, MMUAccessType access_type,
799069cfe77SRichard Henderson                                  bool nonfault, uintptr_t ra)
80059e96ac6SDavid Hildenbrand {
80172d2bbf9SRichard Henderson     int acc_flag;
80272d2bbf9SRichard Henderson     bool maperr;
803c25c283dSDavid Hildenbrand 
804c25c283dSDavid Hildenbrand     switch (access_type) {
805c25c283dSDavid Hildenbrand     case MMU_DATA_STORE:
80672d2bbf9SRichard Henderson         acc_flag = PAGE_WRITE_ORG;
807c25c283dSDavid Hildenbrand         break;
808c25c283dSDavid Hildenbrand     case MMU_DATA_LOAD:
80972d2bbf9SRichard Henderson         acc_flag = PAGE_READ;
810c25c283dSDavid Hildenbrand         break;
811c25c283dSDavid Hildenbrand     case MMU_INST_FETCH:
81272d2bbf9SRichard Henderson         acc_flag = PAGE_EXEC;
813c25c283dSDavid Hildenbrand         break;
814c25c283dSDavid Hildenbrand     default:
815c25c283dSDavid Hildenbrand         g_assert_not_reached();
816c25c283dSDavid Hildenbrand     }
817c25c283dSDavid Hildenbrand 
81872d2bbf9SRichard Henderson     if (guest_addr_valid_untagged(addr)) {
81972d2bbf9SRichard Henderson         int page_flags = page_get_flags(addr);
82072d2bbf9SRichard Henderson         if (page_flags & acc_flag) {
8212a339feeSRichard Henderson             if (access_type != MMU_INST_FETCH
8226d03226bSAlex Bennée                 && cpu_plugin_mem_cbs_enabled(env_cpu(env))) {
8236d03226bSAlex Bennée                 return TLB_MMIO;
8246d03226bSAlex Bennée             }
82572d2bbf9SRichard Henderson             return 0; /* success */
82672d2bbf9SRichard Henderson         }
82772d2bbf9SRichard Henderson         maperr = !(page_flags & PAGE_VALID);
82872d2bbf9SRichard Henderson     } else {
82972d2bbf9SRichard Henderson         maperr = true;
83072d2bbf9SRichard Henderson     }
83172d2bbf9SRichard Henderson 
832069cfe77SRichard Henderson     if (nonfault) {
833069cfe77SRichard Henderson         return TLB_INVALID_MASK;
83459e96ac6SDavid Hildenbrand     }
83572d2bbf9SRichard Henderson 
83672d2bbf9SRichard Henderson     cpu_loop_exit_sigsegv(env_cpu(env), addr, access_type, maperr, ra);
837069cfe77SRichard Henderson }
838069cfe77SRichard Henderson 
8394f8f4127SAnton Johansson int probe_access_flags(CPUArchState *env, vaddr addr, int size,
840069cfe77SRichard Henderson                        MMUAccessType access_type, int mmu_idx,
841069cfe77SRichard Henderson                        bool nonfault, void **phost, uintptr_t ra)
842069cfe77SRichard Henderson {
843069cfe77SRichard Henderson     int flags;
844069cfe77SRichard Henderson 
8451770b2f2SDaniel Henrique Barboza     g_assert(-(addr | TARGET_PAGE_MASK) >= size);
8461770b2f2SDaniel Henrique Barboza     flags = probe_access_internal(env, addr, size, access_type, nonfault, ra);
8476d03226bSAlex Bennée     *phost = (flags & TLB_INVALID_MASK) ? NULL : g2h(env_cpu(env), addr);
848069cfe77SRichard Henderson     return flags;
849069cfe77SRichard Henderson }
850069cfe77SRichard Henderson 
8514f8f4127SAnton Johansson void *probe_access(CPUArchState *env, vaddr addr, int size,
852069cfe77SRichard Henderson                    MMUAccessType access_type, int mmu_idx, uintptr_t ra)
853069cfe77SRichard Henderson {
854069cfe77SRichard Henderson     int flags;
855069cfe77SRichard Henderson 
856069cfe77SRichard Henderson     g_assert(-(addr | TARGET_PAGE_MASK) >= size);
857069cfe77SRichard Henderson     flags = probe_access_internal(env, addr, size, access_type, false, ra);
8586d03226bSAlex Bennée     g_assert((flags & ~TLB_MMIO) == 0);
859fef39ccdSDavid Hildenbrand 
8603e8f1628SRichard Henderson     return size ? g2h(env_cpu(env), addr) : NULL;
86159e96ac6SDavid Hildenbrand }
86259e96ac6SDavid Hildenbrand 
8639b74d403SRichard Henderson void *tlb_vaddr_to_host(CPUArchState *env, vaddr addr,
8649b74d403SRichard Henderson                         MMUAccessType access_type, int mmu_idx)
8659b74d403SRichard Henderson {
8669b74d403SRichard Henderson     return g2h(env_cpu(env), addr);
8679b74d403SRichard Henderson }
8689b74d403SRichard Henderson 
8694f8f4127SAnton Johansson tb_page_addr_t get_page_addr_code_hostp(CPUArchState *env, vaddr addr,
870cdf71308SRichard Henderson                                         void **hostp)
871cdf71308SRichard Henderson {
872cdf71308SRichard Henderson     int flags;
873cdf71308SRichard Henderson 
874cdf71308SRichard Henderson     flags = probe_access_internal(env, addr, 1, MMU_INST_FETCH, false, 0);
875cdf71308SRichard Henderson     g_assert(flags == 0);
876cdf71308SRichard Henderson 
877cdf71308SRichard Henderson     if (hostp) {
878cdf71308SRichard Henderson         *hostp = g2h_untagged(addr);
879cdf71308SRichard Henderson     }
880cdf71308SRichard Henderson     return addr;
881cdf71308SRichard Henderson }
882cdf71308SRichard Henderson 
883f88f3ac9SRichard Henderson /*
884f88f3ac9SRichard Henderson  * Allocate chunks of target data together.  For the only current user,
885f88f3ac9SRichard Henderson  * if we allocate one hunk per page, we have overhead of 40/128 or 40%.
886f88f3ac9SRichard Henderson  * Therefore, allocate memory for 64 pages at a time for overhead < 1%.
887f88f3ac9SRichard Henderson  */
888f88f3ac9SRichard Henderson #define TPD_PAGES  64
889f88f3ac9SRichard Henderson #define TBD_MASK   (TARGET_PAGE_MASK * TPD_PAGES)
890f88f3ac9SRichard Henderson 
891f88f3ac9SRichard Henderson typedef struct TargetPageDataNode {
892177a8cb8SRichard Henderson     struct rcu_head rcu;
893f88f3ac9SRichard Henderson     IntervalTreeNode itree;
89433402ceaSRichard Henderson     char data[] __attribute__((aligned));
895f88f3ac9SRichard Henderson } TargetPageDataNode;
896f88f3ac9SRichard Henderson 
897f88f3ac9SRichard Henderson static IntervalTreeRoot targetdata_root;
898964080d3SRichard Henderson static size_t target_page_data_size;
899f88f3ac9SRichard Henderson 
9005627d5c0SRichard Henderson void page_reset_target_data(vaddr start, vaddr last)
9010fe61084SRichard Henderson {
902f88f3ac9SRichard Henderson     IntervalTreeNode *n, *next;
903964080d3SRichard Henderson     size_t size = target_page_data_size;
904964080d3SRichard Henderson 
905964080d3SRichard Henderson     if (likely(size == 0)) {
906964080d3SRichard Henderson         return;
907964080d3SRichard Henderson     }
9080fe61084SRichard Henderson 
9090fe61084SRichard Henderson     assert_memory_lock();
9100fe61084SRichard Henderson 
91110310cbdSRichard Henderson     start &= TARGET_PAGE_MASK;
91210310cbdSRichard Henderson     last |= ~TARGET_PAGE_MASK;
9130fe61084SRichard Henderson 
914f88f3ac9SRichard Henderson     for (n = interval_tree_iter_first(&targetdata_root, start, last),
915f88f3ac9SRichard Henderson          next = n ? interval_tree_iter_next(n, start, last) : NULL;
916f88f3ac9SRichard Henderson          n != NULL;
917f88f3ac9SRichard Henderson          n = next,
918f88f3ac9SRichard Henderson          next = next ? interval_tree_iter_next(n, start, last) : NULL) {
9195627d5c0SRichard Henderson         vaddr n_start, n_last, p_ofs, p_len;
920177a8cb8SRichard Henderson         TargetPageDataNode *t = container_of(n, TargetPageDataNode, itree);
9210fe61084SRichard Henderson 
922f88f3ac9SRichard Henderson         if (n->start >= start && n->last <= last) {
923f88f3ac9SRichard Henderson             interval_tree_remove(n, &targetdata_root);
924177a8cb8SRichard Henderson             g_free_rcu(t, rcu);
925f88f3ac9SRichard Henderson             continue;
9260fe61084SRichard Henderson         }
9270fe61084SRichard Henderson 
928f88f3ac9SRichard Henderson         if (n->start < start) {
929f88f3ac9SRichard Henderson             n_start = start;
930f88f3ac9SRichard Henderson             p_ofs = (start - n->start) >> TARGET_PAGE_BITS;
931f88f3ac9SRichard Henderson         } else {
932f88f3ac9SRichard Henderson             n_start = n->start;
933f88f3ac9SRichard Henderson             p_ofs = 0;
934f88f3ac9SRichard Henderson         }
935f88f3ac9SRichard Henderson         n_last = MIN(last, n->last);
936f88f3ac9SRichard Henderson         p_len = (n_last + 1 - n_start) >> TARGET_PAGE_BITS;
937f88f3ac9SRichard Henderson 
938964080d3SRichard Henderson         memset(t->data + p_ofs * size, 0, p_len * size);
939f88f3ac9SRichard Henderson     }
940f88f3ac9SRichard Henderson }
941f88f3ac9SRichard Henderson 
942964080d3SRichard Henderson void *page_get_target_data(vaddr address, size_t size)
9430fe61084SRichard Henderson {
944f88f3ac9SRichard Henderson     IntervalTreeNode *n;
945f88f3ac9SRichard Henderson     TargetPageDataNode *t;
9465627d5c0SRichard Henderson     vaddr page, region, p_ofs;
9470fe61084SRichard Henderson 
948964080d3SRichard Henderson     /* Remember the size from the first call, and it should be constant. */
949964080d3SRichard Henderson     if (unlikely(target_page_data_size != size)) {
950964080d3SRichard Henderson         assert(target_page_data_size == 0);
951964080d3SRichard Henderson         target_page_data_size = size;
952964080d3SRichard Henderson     }
953964080d3SRichard Henderson 
954f88f3ac9SRichard Henderson     page = address & TARGET_PAGE_MASK;
955f88f3ac9SRichard Henderson     region = address & TBD_MASK;
956f88f3ac9SRichard Henderson 
957f88f3ac9SRichard Henderson     n = interval_tree_iter_first(&targetdata_root, page, page);
958f88f3ac9SRichard Henderson     if (!n) {
959f88f3ac9SRichard Henderson         /*
960f88f3ac9SRichard Henderson          * See util/interval-tree.c re lockless lookups: no false positives
961f88f3ac9SRichard Henderson          * but there are false negatives.  If we find nothing, retry with
962f88f3ac9SRichard Henderson          * the mmap lock acquired.  We also need the lock for the
963f88f3ac9SRichard Henderson          * allocation + insert.
964f88f3ac9SRichard Henderson          */
965f88f3ac9SRichard Henderson         mmap_lock();
966f88f3ac9SRichard Henderson         n = interval_tree_iter_first(&targetdata_root, page, page);
967f88f3ac9SRichard Henderson         if (!n) {
968964080d3SRichard Henderson             t = g_malloc0(sizeof(TargetPageDataNode) + TPD_PAGES * size);
969f88f3ac9SRichard Henderson             n = &t->itree;
970f88f3ac9SRichard Henderson             n->start = region;
971f88f3ac9SRichard Henderson             n->last = region | ~TBD_MASK;
972f88f3ac9SRichard Henderson             interval_tree_insert(n, &targetdata_root);
9730fe61084SRichard Henderson         }
974f88f3ac9SRichard Henderson         mmap_unlock();
9750fe61084SRichard Henderson     }
976f88f3ac9SRichard Henderson 
977f88f3ac9SRichard Henderson     t = container_of(n, TargetPageDataNode, itree);
97833402ceaSRichard Henderson     p_ofs = (page - region) >> TARGET_PAGE_BITS;
979964080d3SRichard Henderson     return t->data + p_ofs * size;
980f88f3ac9SRichard Henderson }
9810fe61084SRichard Henderson 
9827893e42dSPhilippe Mathieu-Daudé /* The system-mode versions of these helpers are in cputlb.c.  */
983a411d296SPhilippe Mathieu-Daudé 
984e20f73fbSAnton Johansson static void *cpu_mmu_lookup(CPUState *cpu, vaddr addr,
985de95016dSRichard Henderson                             MemOp mop, uintptr_t ra, MMUAccessType type)
986f83bcecbSRichard Henderson {
987c5809eeeSRichard Henderson     int a_bits = memop_alignment_bits(mop);
988f83bcecbSRichard Henderson     void *ret;
989f83bcecbSRichard Henderson 
9909395cd0aSRichard Henderson     /* Enforce guest required alignment.  */
9919395cd0aSRichard Henderson     if (unlikely(addr & ((1 << a_bits) - 1))) {
992e20f73fbSAnton Johansson         cpu_loop_exit_sigbus(cpu, addr, type, ra);
9939395cd0aSRichard Henderson     }
994f83bcecbSRichard Henderson 
995e20f73fbSAnton Johansson     ret = g2h(cpu, addr);
996f83bcecbSRichard Henderson     set_helper_retaddr(ra);
997ed4cfbcdSRichard Henderson     return ret;
998ed4cfbcdSRichard Henderson }
999ed4cfbcdSRichard Henderson 
1000585d4b12SPhilippe Mathieu-Daudé /* physical memory access (slow version, mainly for debug) */
1001585d4b12SPhilippe Mathieu-Daudé int cpu_memory_rw_debug(CPUState *cpu, vaddr addr,
1002585d4b12SPhilippe Mathieu-Daudé                         void *ptr, size_t len, bool is_write)
1003585d4b12SPhilippe Mathieu-Daudé {
1004585d4b12SPhilippe Mathieu-Daudé     int flags;
1005585d4b12SPhilippe Mathieu-Daudé     vaddr l, page;
1006585d4b12SPhilippe Mathieu-Daudé     uint8_t *buf = ptr;
1007585d4b12SPhilippe Mathieu-Daudé     ssize_t written;
1008585d4b12SPhilippe Mathieu-Daudé     int ret = -1;
1009585d4b12SPhilippe Mathieu-Daudé     int fd = -1;
1010585d4b12SPhilippe Mathieu-Daudé 
1011585d4b12SPhilippe Mathieu-Daudé     mmap_lock();
1012585d4b12SPhilippe Mathieu-Daudé 
1013585d4b12SPhilippe Mathieu-Daudé     while (len > 0) {
1014585d4b12SPhilippe Mathieu-Daudé         page = addr & TARGET_PAGE_MASK;
1015585d4b12SPhilippe Mathieu-Daudé         l = (page + TARGET_PAGE_SIZE) - addr;
1016585d4b12SPhilippe Mathieu-Daudé         if (l > len) {
1017585d4b12SPhilippe Mathieu-Daudé             l = len;
1018585d4b12SPhilippe Mathieu-Daudé         }
1019585d4b12SPhilippe Mathieu-Daudé         flags = page_get_flags(page);
1020585d4b12SPhilippe Mathieu-Daudé         if (!(flags & PAGE_VALID)) {
1021585d4b12SPhilippe Mathieu-Daudé             goto out_close;
1022585d4b12SPhilippe Mathieu-Daudé         }
1023585d4b12SPhilippe Mathieu-Daudé         if (is_write) {
1024585d4b12SPhilippe Mathieu-Daudé             if (flags & PAGE_WRITE) {
1025585d4b12SPhilippe Mathieu-Daudé                 memcpy(g2h(cpu, addr), buf, l);
1026585d4b12SPhilippe Mathieu-Daudé             } else {
1027585d4b12SPhilippe Mathieu-Daudé                 /* Bypass the host page protection using ptrace. */
1028585d4b12SPhilippe Mathieu-Daudé                 if (fd == -1) {
1029585d4b12SPhilippe Mathieu-Daudé                     fd = open("/proc/self/mem", O_WRONLY);
1030585d4b12SPhilippe Mathieu-Daudé                     if (fd == -1) {
1031585d4b12SPhilippe Mathieu-Daudé                         goto out;
1032585d4b12SPhilippe Mathieu-Daudé                     }
1033585d4b12SPhilippe Mathieu-Daudé                 }
1034585d4b12SPhilippe Mathieu-Daudé                 /*
1035585d4b12SPhilippe Mathieu-Daudé                  * If there is a TranslationBlock and we weren't bypassing the
1036585d4b12SPhilippe Mathieu-Daudé                  * host page protection, the memcpy() above would SEGV,
1037585d4b12SPhilippe Mathieu-Daudé                  * ultimately leading to page_unprotect(). So invalidate the
1038585d4b12SPhilippe Mathieu-Daudé                  * translations manually. Both invalidation and pwrite() must
1039585d4b12SPhilippe Mathieu-Daudé                  * be under mmap_lock() in order to prevent the creation of
1040585d4b12SPhilippe Mathieu-Daudé                  * another TranslationBlock in between.
1041585d4b12SPhilippe Mathieu-Daudé                  */
1042072e057eSRichard Henderson                 tb_invalidate_phys_range(NULL, addr, addr + l - 1);
1043585d4b12SPhilippe Mathieu-Daudé                 written = pwrite(fd, buf, l,
1044585d4b12SPhilippe Mathieu-Daudé                                  (off_t)(uintptr_t)g2h_untagged(addr));
1045585d4b12SPhilippe Mathieu-Daudé                 if (written != l) {
1046585d4b12SPhilippe Mathieu-Daudé                     goto out_close;
1047585d4b12SPhilippe Mathieu-Daudé                 }
1048585d4b12SPhilippe Mathieu-Daudé             }
1049585d4b12SPhilippe Mathieu-Daudé         } else if (flags & PAGE_READ) {
1050585d4b12SPhilippe Mathieu-Daudé             memcpy(buf, g2h(cpu, addr), l);
1051585d4b12SPhilippe Mathieu-Daudé         } else {
1052585d4b12SPhilippe Mathieu-Daudé             /* Bypass the host page protection using ptrace. */
1053585d4b12SPhilippe Mathieu-Daudé             if (fd == -1) {
1054585d4b12SPhilippe Mathieu-Daudé                 fd = open("/proc/self/mem", O_RDONLY);
1055585d4b12SPhilippe Mathieu-Daudé                 if (fd == -1) {
1056585d4b12SPhilippe Mathieu-Daudé                     goto out;
1057585d4b12SPhilippe Mathieu-Daudé                 }
1058585d4b12SPhilippe Mathieu-Daudé             }
1059585d4b12SPhilippe Mathieu-Daudé             if (pread(fd, buf, l,
1060585d4b12SPhilippe Mathieu-Daudé                       (off_t)(uintptr_t)g2h_untagged(addr)) != l) {
1061585d4b12SPhilippe Mathieu-Daudé                 goto out_close;
1062585d4b12SPhilippe Mathieu-Daudé             }
1063585d4b12SPhilippe Mathieu-Daudé         }
1064585d4b12SPhilippe Mathieu-Daudé         len -= l;
1065585d4b12SPhilippe Mathieu-Daudé         buf += l;
1066585d4b12SPhilippe Mathieu-Daudé         addr += l;
1067585d4b12SPhilippe Mathieu-Daudé     }
1068585d4b12SPhilippe Mathieu-Daudé     ret = 0;
1069585d4b12SPhilippe Mathieu-Daudé out_close:
1070585d4b12SPhilippe Mathieu-Daudé     if (fd != -1) {
1071585d4b12SPhilippe Mathieu-Daudé         close(fd);
1072585d4b12SPhilippe Mathieu-Daudé     }
1073585d4b12SPhilippe Mathieu-Daudé out:
1074585d4b12SPhilippe Mathieu-Daudé     mmap_unlock();
1075585d4b12SPhilippe Mathieu-Daudé 
1076585d4b12SPhilippe Mathieu-Daudé     return ret;
1077585d4b12SPhilippe Mathieu-Daudé }
1078585d4b12SPhilippe Mathieu-Daudé 
1079cdfac37bSRichard Henderson #include "ldst_atomicity.c.inc"
1080cdfac37bSRichard Henderson 
1081e20f73fbSAnton Johansson static uint8_t do_ld1_mmu(CPUState *cpu, vaddr addr, MemOpIdx oi,
1082e20f73fbSAnton Johansson                           uintptr_t ra, MMUAccessType access_type)
1083ed4cfbcdSRichard Henderson {
1084f83bcecbSRichard Henderson     void *haddr;
1085f83bcecbSRichard Henderson     uint8_t ret;
1086ed4cfbcdSRichard Henderson 
1087eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_LD | TCG_MO_ST_LD);
1088e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, get_memop(oi), ra, access_type);
1089f83bcecbSRichard Henderson     ret = ldub_p(haddr);
1090f83bcecbSRichard Henderson     clear_helper_retaddr();
1091de95016dSRichard Henderson     return ret;
1092de95016dSRichard Henderson }
1093de95016dSRichard Henderson 
1094e20f73fbSAnton Johansson static uint16_t do_ld2_mmu(CPUState *cpu, vaddr addr, MemOpIdx oi,
1095e20f73fbSAnton Johansson                            uintptr_t ra, MMUAccessType access_type)
1096de95016dSRichard Henderson {
1097de95016dSRichard Henderson     void *haddr;
1098de95016dSRichard Henderson     uint16_t ret;
1099e20f73fbSAnton Johansson     MemOp mop = get_memop(oi);
1100de95016dSRichard Henderson 
1101eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_LD | TCG_MO_ST_LD);
1102e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, mop, ra, access_type);
1103e20f73fbSAnton Johansson     ret = load_atom_2(cpu, ra, haddr, mop);
1104de95016dSRichard Henderson     clear_helper_retaddr();
1105fbea7a40SRichard Henderson 
1106fbea7a40SRichard Henderson     if (mop & MO_BSWAP) {
1107fbea7a40SRichard Henderson         ret = bswap16(ret);
1108fbea7a40SRichard Henderson     }
1109de95016dSRichard Henderson     return ret;
1110de95016dSRichard Henderson }
1111de95016dSRichard Henderson 
1112e20f73fbSAnton Johansson static uint32_t do_ld4_mmu(CPUState *cpu, vaddr addr, MemOpIdx oi,
1113e20f73fbSAnton Johansson                            uintptr_t ra, MMUAccessType access_type)
1114de95016dSRichard Henderson {
1115de95016dSRichard Henderson     void *haddr;
1116de95016dSRichard Henderson     uint32_t ret;
1117e20f73fbSAnton Johansson     MemOp mop = get_memop(oi);
1118de95016dSRichard Henderson 
1119eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_LD | TCG_MO_ST_LD);
1120e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, mop, ra, access_type);
1121e20f73fbSAnton Johansson     ret = load_atom_4(cpu, ra, haddr, mop);
1122de95016dSRichard Henderson     clear_helper_retaddr();
1123fbea7a40SRichard Henderson 
1124fbea7a40SRichard Henderson     if (mop & MO_BSWAP) {
1125fbea7a40SRichard Henderson         ret = bswap32(ret);
1126fbea7a40SRichard Henderson     }
1127de95016dSRichard Henderson     return ret;
1128de95016dSRichard Henderson }
1129de95016dSRichard Henderson 
1130e20f73fbSAnton Johansson static uint64_t do_ld8_mmu(CPUState *cpu, vaddr addr, MemOpIdx oi,
1131e20f73fbSAnton Johansson                            uintptr_t ra, MMUAccessType access_type)
1132de95016dSRichard Henderson {
1133de95016dSRichard Henderson     void *haddr;
1134de95016dSRichard Henderson     uint64_t ret;
1135e20f73fbSAnton Johansson     MemOp mop = get_memop(oi);
1136de95016dSRichard Henderson 
1137eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_LD | TCG_MO_ST_LD);
1138e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, mop, ra, access_type);
1139e20f73fbSAnton Johansson     ret = load_atom_8(cpu, ra, haddr, mop);
1140de95016dSRichard Henderson     clear_helper_retaddr();
1141de95016dSRichard Henderson 
1142de95016dSRichard Henderson     if (mop & MO_BSWAP) {
1143de95016dSRichard Henderson         ret = bswap64(ret);
1144de95016dSRichard Henderson     }
1145de95016dSRichard Henderson     return ret;
1146de95016dSRichard Henderson }
1147de95016dSRichard Henderson 
1148*03c981e7SRichard Henderson static Int128 do_ld16_mmu(CPUState *cpu, vaddr addr,
1149e20f73fbSAnton Johansson                           MemOpIdx oi, uintptr_t ra)
1150cb48f365SRichard Henderson {
1151cb48f365SRichard Henderson     void *haddr;
1152cb48f365SRichard Henderson     Int128 ret;
1153e20f73fbSAnton Johansson     MemOp mop = get_memop(oi);
1154cb48f365SRichard Henderson 
115535c653c4SRichard Henderson     tcg_debug_assert((mop & MO_SIZE) == MO_128);
1156eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_LD | TCG_MO_ST_LD);
1157e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, mop, ra, MMU_DATA_LOAD);
1158e20f73fbSAnton Johansson     ret = load_atom_16(cpu, ra, haddr, mop);
1159cb48f365SRichard Henderson     clear_helper_retaddr();
116035c653c4SRichard Henderson 
116135c653c4SRichard Henderson     if (mop & MO_BSWAP) {
116235c653c4SRichard Henderson         ret = bswap128(ret);
116335c653c4SRichard Henderson     }
116435c653c4SRichard Henderson     return ret;
116535c653c4SRichard Henderson }
116635c653c4SRichard Henderson 
1167e20f73fbSAnton Johansson static void do_st1_mmu(CPUState *cpu, vaddr addr, uint8_t val,
1168e20f73fbSAnton Johansson                        MemOpIdx oi, uintptr_t ra)
1169ed4cfbcdSRichard Henderson {
1170f83bcecbSRichard Henderson     void *haddr;
1171ed4cfbcdSRichard Henderson 
1172eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_ST | TCG_MO_ST_ST);
1173e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, get_memop(oi), ra, MMU_DATA_STORE);
1174f83bcecbSRichard Henderson     stb_p(haddr, val);
1175ed4cfbcdSRichard Henderson     clear_helper_retaddr();
1176de95016dSRichard Henderson }
1177de95016dSRichard Henderson 
1178e20f73fbSAnton Johansson static void do_st2_mmu(CPUState *cpu, vaddr addr, uint16_t val,
1179e20f73fbSAnton Johansson                        MemOpIdx oi, uintptr_t ra)
1180de95016dSRichard Henderson {
1181de95016dSRichard Henderson     void *haddr;
1182e20f73fbSAnton Johansson     MemOp mop = get_memop(oi);
1183de95016dSRichard Henderson 
1184eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_ST | TCG_MO_ST_ST);
1185e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, mop, ra, MMU_DATA_STORE);
1186fbea7a40SRichard Henderson 
1187fbea7a40SRichard Henderson     if (mop & MO_BSWAP) {
1188fbea7a40SRichard Henderson         val = bswap16(val);
1189fbea7a40SRichard Henderson     }
1190e20f73fbSAnton Johansson     store_atom_2(cpu, ra, haddr, mop, val);
1191de95016dSRichard Henderson     clear_helper_retaddr();
1192de95016dSRichard Henderson }
1193de95016dSRichard Henderson 
1194e20f73fbSAnton Johansson static void do_st4_mmu(CPUState *cpu, vaddr addr, uint32_t val,
1195e20f73fbSAnton Johansson                        MemOpIdx oi, uintptr_t ra)
1196de95016dSRichard Henderson {
1197f83bcecbSRichard Henderson     void *haddr;
1198e20f73fbSAnton Johansson     MemOp mop = get_memop(oi);
1199b9e60257SRichard Henderson 
1200eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_ST | TCG_MO_ST_ST);
1201e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, mop, ra, MMU_DATA_STORE);
1202fbea7a40SRichard Henderson 
1203fbea7a40SRichard Henderson     if (mop & MO_BSWAP) {
1204fbea7a40SRichard Henderson         val = bswap32(val);
1205fbea7a40SRichard Henderson     }
1206e20f73fbSAnton Johansson     store_atom_4(cpu, ra, haddr, mop, val);
1207b9e60257SRichard Henderson     clear_helper_retaddr();
1208de95016dSRichard Henderson }
1209de95016dSRichard Henderson 
1210e20f73fbSAnton Johansson static void do_st8_mmu(CPUState *cpu, vaddr addr, uint64_t val,
1211e20f73fbSAnton Johansson                        MemOpIdx oi, uintptr_t ra)
1212de95016dSRichard Henderson {
1213f83bcecbSRichard Henderson     void *haddr;
1214e20f73fbSAnton Johansson     MemOp mop = get_memop(oi);
1215b9e60257SRichard Henderson 
1216eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_ST | TCG_MO_ST_ST);
1217e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, mop, ra, MMU_DATA_STORE);
1218fbea7a40SRichard Henderson 
1219fbea7a40SRichard Henderson     if (mop & MO_BSWAP) {
1220fbea7a40SRichard Henderson         val = bswap64(val);
1221fbea7a40SRichard Henderson     }
1222e20f73fbSAnton Johansson     store_atom_8(cpu, ra, haddr, mop, val);
1223b9e60257SRichard Henderson     clear_helper_retaddr();
1224de95016dSRichard Henderson }
1225de95016dSRichard Henderson 
1226e20f73fbSAnton Johansson static void do_st16_mmu(CPUState *cpu, vaddr addr, Int128 val,
1227e20f73fbSAnton Johansson                         MemOpIdx oi, uintptr_t ra)
1228cb48f365SRichard Henderson {
1229cb48f365SRichard Henderson     void *haddr;
1230e20f73fbSAnton Johansson     MemOpIdx mop = get_memop(oi);
1231cb48f365SRichard Henderson 
1232eacd8c7cSPhilippe Mathieu-Daudé     cpu_req_mo(cpu, TCG_MO_LD_ST | TCG_MO_ST_ST);
1233e20f73fbSAnton Johansson     haddr = cpu_mmu_lookup(cpu, addr, mop, ra, MMU_DATA_STORE);
1234fbea7a40SRichard Henderson 
1235fbea7a40SRichard Henderson     if (mop & MO_BSWAP) {
1236fbea7a40SRichard Henderson         val = bswap128(val);
1237fbea7a40SRichard Henderson     }
1238e20f73fbSAnton Johansson     store_atom_16(cpu, ra, haddr, mop, val);
123935c653c4SRichard Henderson     clear_helper_retaddr();
124035c653c4SRichard Henderson }
124135c653c4SRichard Henderson 
1242446321b3SRichard Henderson uint8_t cpu_ldb_code_mmu(CPUArchState *env, vaddr addr,
124328990626SRichard Henderson                          MemOpIdx oi, uintptr_t ra)
124428990626SRichard Henderson {
124566269bb9SRichard Henderson     return do_ld1_mmu(env_cpu(env), addr, oi, ra ? ra : 1, MMU_INST_FETCH);
124628990626SRichard Henderson }
124728990626SRichard Henderson 
1248446321b3SRichard Henderson uint16_t cpu_ldw_code_mmu(CPUArchState *env, vaddr addr,
124928990626SRichard Henderson                           MemOpIdx oi, uintptr_t ra)
125028990626SRichard Henderson {
125166269bb9SRichard Henderson     return do_ld2_mmu(env_cpu(env), addr, oi, ra ? ra : 1, MMU_INST_FETCH);
125228990626SRichard Henderson }
125328990626SRichard Henderson 
1254446321b3SRichard Henderson uint32_t cpu_ldl_code_mmu(CPUArchState *env, vaddr addr,
125528990626SRichard Henderson                           MemOpIdx oi, uintptr_t ra)
125628990626SRichard Henderson {
125766269bb9SRichard Henderson     return do_ld4_mmu(env_cpu(env), addr, oi, ra ? ra : 1, MMU_INST_FETCH);
125828990626SRichard Henderson }
125928990626SRichard Henderson 
1260446321b3SRichard Henderson uint64_t cpu_ldq_code_mmu(CPUArchState *env, vaddr addr,
126128990626SRichard Henderson                           MemOpIdx oi, uintptr_t ra)
126228990626SRichard Henderson {
126366269bb9SRichard Henderson     return do_ld8_mmu(env_cpu(env), addr, oi, ra ? ra : 1, MMU_INST_FETCH);
126428990626SRichard Henderson }
126528990626SRichard Henderson 
1266f83bcecbSRichard Henderson #include "ldst_common.c.inc"
1267f83bcecbSRichard Henderson 
1268a754f7f3SRichard Henderson /*
1269a754f7f3SRichard Henderson  * Do not allow unaligned operations to proceed.  Return the host address.
1270a754f7f3SRichard Henderson  */
1271d560225fSAnton Johansson static void *atomic_mmu_lookup(CPUState *cpu, vaddr addr, MemOpIdx oi,
1272b0326eb9SAnton Johansson                                int size, uintptr_t retaddr)
1273a411d296SPhilippe Mathieu-Daudé {
1274fce3f474SRichard Henderson     MemOp mop = get_memop(oi);
1275c5809eeeSRichard Henderson     int a_bits = memop_alignment_bits(mop);
1276fce3f474SRichard Henderson     void *ret;
1277fce3f474SRichard Henderson 
1278fce3f474SRichard Henderson     /* Enforce guest required alignment.  */
1279fce3f474SRichard Henderson     if (unlikely(addr & ((1 << a_bits) - 1))) {
1280d560225fSAnton Johansson         cpu_loop_exit_sigbus(cpu, addr, MMU_DATA_STORE, retaddr);
1281fce3f474SRichard Henderson     }
1282fce3f474SRichard Henderson 
1283a411d296SPhilippe Mathieu-Daudé     /* Enforce qemu required alignment.  */
1284a411d296SPhilippe Mathieu-Daudé     if (unlikely(addr & (size - 1))) {
1285d560225fSAnton Johansson         cpu_loop_exit_atomic(cpu, retaddr);
1286a411d296SPhilippe Mathieu-Daudé     }
1287fce3f474SRichard Henderson 
1288d560225fSAnton Johansson     ret = g2h(cpu, addr);
128908b97f7fSRichard Henderson     set_helper_retaddr(retaddr);
129008b97f7fSRichard Henderson     return ret;
1291a411d296SPhilippe Mathieu-Daudé }
1292a411d296SPhilippe Mathieu-Daudé 
1293be9568b4SRichard Henderson #include "atomic_common.c.inc"
1294be9568b4SRichard Henderson 
1295be9568b4SRichard Henderson /*
1296be9568b4SRichard Henderson  * First set of functions passes in OI and RETADDR.
1297be9568b4SRichard Henderson  * This makes them callable from other helpers.
1298be9568b4SRichard Henderson  */
1299be9568b4SRichard Henderson 
1300be9568b4SRichard Henderson #define ATOMIC_NAME(X) \
1301be9568b4SRichard Henderson     glue(glue(glue(cpu_atomic_ ## X, SUFFIX), END), _mmu)
130208b97f7fSRichard Henderson #define ATOMIC_MMU_CLEANUP do { clear_helper_retaddr(); } while (0)
1303a411d296SPhilippe Mathieu-Daudé 
1304a411d296SPhilippe Mathieu-Daudé #define DATA_SIZE 1
1305a411d296SPhilippe Mathieu-Daudé #include "atomic_template.h"
1306a411d296SPhilippe Mathieu-Daudé 
1307a411d296SPhilippe Mathieu-Daudé #define DATA_SIZE 2
1308a411d296SPhilippe Mathieu-Daudé #include "atomic_template.h"
1309a411d296SPhilippe Mathieu-Daudé 
1310a411d296SPhilippe Mathieu-Daudé #define DATA_SIZE 4
1311a411d296SPhilippe Mathieu-Daudé #include "atomic_template.h"
1312a411d296SPhilippe Mathieu-Daudé 
1313a411d296SPhilippe Mathieu-Daudé #ifdef CONFIG_ATOMIC64
1314a411d296SPhilippe Mathieu-Daudé #define DATA_SIZE 8
1315a411d296SPhilippe Mathieu-Daudé #include "atomic_template.h"
1316a411d296SPhilippe Mathieu-Daudé #endif
1317a411d296SPhilippe Mathieu-Daudé 
131876f9d6adSRichard Henderson #if defined(CONFIG_ATOMIC128) || HAVE_CMPXCHG128
1319be9568b4SRichard Henderson #define DATA_SIZE 16
1320be9568b4SRichard Henderson #include "atomic_template.h"
1321be9568b4SRichard Henderson #endif
1322