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 } 130