]>
Commit | Line | Data |
---|---|---|
8803bfea MF |
1 | /* |
2 | * Copyright (c) 2011 - 2019, Max Filippov, Open Source and Linux Lab. | |
3 | * All rights reserved. | |
4 | * | |
5 | * Redistribution and use in source and binary forms, with or without | |
6 | * modification, are permitted provided that the following conditions are met: | |
7 | * * Redistributions of source code must retain the above copyright | |
8 | * notice, this list of conditions and the following disclaimer. | |
9 | * * Redistributions in binary form must reproduce the above copyright | |
10 | * notice, this list of conditions and the following disclaimer in the | |
11 | * documentation and/or other materials provided with the distribution. | |
12 | * * Neither the name of the Open Source and Linux Lab nor the | |
13 | * names of its contributors may be used to endorse or promote products | |
14 | * derived from this software without specific prior written permission. | |
15 | * | |
16 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" | |
17 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | |
18 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | |
19 | * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY | |
20 | * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES | |
21 | * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; | |
22 | * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND | |
23 | * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |
24 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS | |
25 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
26 | */ | |
27 | ||
28 | #include "qemu/osdep.h" | |
29 | #include "qemu/main-loop.h" | |
30 | #include "cpu.h" | |
31 | #include "exec/helper-proto.h" | |
32 | #include "qemu/host-utils.h" | |
33 | #include "exec/exec-all.h" | |
34 | #include "exec/address-spaces.h" | |
35 | ||
36 | static void tb_invalidate_virtual_addr(CPUXtensaState *env, uint32_t vaddr) | |
37 | { | |
38 | uint32_t paddr; | |
39 | uint32_t page_size; | |
40 | unsigned access; | |
41 | int ret = xtensa_get_physical_addr(env, false, vaddr, 2, 0, | |
42 | &paddr, &page_size, &access); | |
43 | if (ret == 0) { | |
44 | tb_invalidate_phys_addr(&address_space_memory, paddr, | |
45 | MEMTXATTRS_UNSPECIFIED); | |
46 | } | |
47 | } | |
48 | ||
49 | void HELPER(wsr_ibreakenable)(CPUXtensaState *env, uint32_t v) | |
50 | { | |
51 | uint32_t change = v ^ env->sregs[IBREAKENABLE]; | |
52 | unsigned i; | |
53 | ||
54 | for (i = 0; i < env->config->nibreak; ++i) { | |
55 | if (change & (1 << i)) { | |
56 | tb_invalidate_virtual_addr(env, env->sregs[IBREAKA + i]); | |
57 | } | |
58 | } | |
59 | env->sregs[IBREAKENABLE] = v & ((1 << env->config->nibreak) - 1); | |
60 | } | |
61 | ||
62 | void HELPER(wsr_ibreaka)(CPUXtensaState *env, uint32_t i, uint32_t v) | |
63 | { | |
64 | if (env->sregs[IBREAKENABLE] & (1 << i) && env->sregs[IBREAKA + i] != v) { | |
65 | tb_invalidate_virtual_addr(env, env->sregs[IBREAKA + i]); | |
66 | tb_invalidate_virtual_addr(env, v); | |
67 | } | |
68 | env->sregs[IBREAKA + i] = v; | |
69 | } | |
70 | ||
71 | static void set_dbreak(CPUXtensaState *env, unsigned i, uint32_t dbreaka, | |
72 | uint32_t dbreakc) | |
73 | { | |
74 | CPUState *cs = CPU(xtensa_env_get_cpu(env)); | |
75 | int flags = BP_CPU | BP_STOP_BEFORE_ACCESS; | |
76 | uint32_t mask = dbreakc | ~DBREAKC_MASK; | |
77 | ||
78 | if (env->cpu_watchpoint[i]) { | |
79 | cpu_watchpoint_remove_by_ref(cs, env->cpu_watchpoint[i]); | |
80 | } | |
81 | if (dbreakc & DBREAKC_SB) { | |
82 | flags |= BP_MEM_WRITE; | |
83 | } | |
84 | if (dbreakc & DBREAKC_LB) { | |
85 | flags |= BP_MEM_READ; | |
86 | } | |
87 | /* contiguous mask after inversion is one less than some power of 2 */ | |
88 | if ((~mask + 1) & ~mask) { | |
89 | qemu_log_mask(LOG_GUEST_ERROR, | |
90 | "DBREAKC mask is not contiguous: 0x%08x\n", dbreakc); | |
91 | /* cut mask after the first zero bit */ | |
92 | mask = 0xffffffff << (32 - clo32(mask)); | |
93 | } | |
94 | if (cpu_watchpoint_insert(cs, dbreaka & mask, ~mask + 1, | |
95 | flags, &env->cpu_watchpoint[i])) { | |
96 | env->cpu_watchpoint[i] = NULL; | |
97 | qemu_log_mask(LOG_GUEST_ERROR, | |
98 | "Failed to set data breakpoint at 0x%08x/%d\n", | |
99 | dbreaka & mask, ~mask + 1); | |
100 | } | |
101 | } | |
102 | ||
103 | void HELPER(wsr_dbreaka)(CPUXtensaState *env, uint32_t i, uint32_t v) | |
104 | { | |
105 | uint32_t dbreakc = env->sregs[DBREAKC + i]; | |
106 | ||
107 | if ((dbreakc & DBREAKC_SB_LB) && | |
108 | env->sregs[DBREAKA + i] != v) { | |
109 | set_dbreak(env, i, v, dbreakc); | |
110 | } | |
111 | env->sregs[DBREAKA + i] = v; | |
112 | } | |
113 | ||
114 | void HELPER(wsr_dbreakc)(CPUXtensaState *env, uint32_t i, uint32_t v) | |
115 | { | |
116 | if ((env->sregs[DBREAKC + i] ^ v) & (DBREAKC_SB_LB | DBREAKC_MASK)) { | |
117 | if (v & DBREAKC_SB_LB) { | |
118 | set_dbreak(env, i, env->sregs[DBREAKA + i], v); | |
119 | } else { | |
120 | if (env->cpu_watchpoint[i]) { | |
121 | CPUState *cs = CPU(xtensa_env_get_cpu(env)); | |
122 | ||
123 | cpu_watchpoint_remove_by_ref(cs, env->cpu_watchpoint[i]); | |
124 | env->cpu_watchpoint[i] = NULL; | |
125 | } | |
126 | } | |
127 | } | |
128 | env->sregs[DBREAKC + i] = v; | |
129 | } |