| /* | 
 |  * PowerPC gdb server stub | 
 |  * | 
 |  * Copyright (c) 2003-2005 Fabrice Bellard | 
 |  * Copyright (c) 2013 SUSE LINUX Products GmbH | 
 |  * | 
 |  * This library is free software; you can redistribute it and/or | 
 |  * modify it under the terms of the GNU Lesser General Public | 
 |  * License as published by the Free Software Foundation; either | 
 |  * version 2 of the License, or (at your option) any later version. | 
 |  * | 
 |  * This library is distributed in the hope that it will be useful, | 
 |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU | 
 |  * Lesser General Public License for more details. | 
 |  * | 
 |  * You should have received a copy of the GNU Lesser General Public | 
 |  * License along with this library; if not, see <http://www.gnu.org/licenses/>. | 
 |  */ | 
 | #include "config.h" | 
 | #include "qemu-common.h" | 
 | #include "exec/gdbstub.h" | 
 |  | 
 | static int ppc_gdb_register_len_apple(int n) | 
 | { | 
 |     switch (n) { | 
 |     case 0 ... 31: | 
 |         /* gprs */ | 
 |         return 8; | 
 |     case 32 ... 63: | 
 |         /* fprs */ | 
 |         return 8; | 
 |     case 64 ... 95: | 
 |         return 16; | 
 |     case 64+32: /* nip */ | 
 |     case 65+32: /* msr */ | 
 |     case 67+32: /* lr */ | 
 |     case 68+32: /* ctr */ | 
 |     case 69+32: /* xer */ | 
 |     case 70+32: /* fpscr */ | 
 |         return 8; | 
 |     case 66+32: /* cr */ | 
 |         return 4; | 
 |     default: | 
 |         return 0; | 
 |     } | 
 | } | 
 |  | 
 | static int ppc_gdb_register_len(int n) | 
 | { | 
 |     switch (n) { | 
 |     case 0 ... 31: | 
 |         /* gprs */ | 
 |         return sizeof(target_ulong); | 
 |     case 32 ... 63: | 
 |         /* fprs */ | 
 |         if (gdb_has_xml) { | 
 |             return 0; | 
 |         } | 
 |         return 8; | 
 |     case 66: | 
 |         /* cr */ | 
 |         return 4; | 
 |     case 64: | 
 |         /* nip */ | 
 |     case 65: | 
 |         /* msr */ | 
 |     case 67: | 
 |         /* lr */ | 
 |     case 68: | 
 |         /* ctr */ | 
 |     case 69: | 
 |         /* xer */ | 
 |         return sizeof(target_ulong); | 
 |     case 70: | 
 |         /* fpscr */ | 
 |         if (gdb_has_xml) { | 
 |             return 0; | 
 |         } | 
 |         return sizeof(target_ulong); | 
 |     default: | 
 |         return 0; | 
 |     } | 
 | } | 
 |  | 
 | /* We need to present the registers to gdb in the "current" memory ordering. | 
 |    For user-only mode we get this for free; TARGET_WORDS_BIGENDIAN is set to | 
 |    the proper ordering for the binary, and cannot be changed. | 
 |    For system mode, TARGET_WORDS_BIGENDIAN is always set, and we must check | 
 |    the current mode of the chip to see if we're running in little-endian.  */ | 
 | static void maybe_bswap_register(CPUPPCState *env, uint8_t *mem_buf, int len) | 
 | { | 
 | #ifndef CONFIG_USER_ONLY | 
 |     if (!msr_le) { | 
 |         /* do nothing */ | 
 |     } else if (len == 4) { | 
 |         bswap32s((uint32_t *)mem_buf); | 
 |     } else if (len == 8) { | 
 |         bswap64s((uint64_t *)mem_buf); | 
 |     } else { | 
 |         g_assert_not_reached(); | 
 |     } | 
 | #endif | 
 | } | 
 |  | 
 | /* Old gdb always expects FP registers.  Newer (xml-aware) gdb only | 
 |  * expects whatever the target description contains.  Due to a | 
 |  * historical mishap the FP registers appear in between core integer | 
 |  * regs and PC, MSR, CR, and so forth.  We hack round this by giving the | 
 |  * FP regs zero size when talking to a newer gdb. | 
 |  */ | 
 |  | 
 | int ppc_cpu_gdb_read_register(CPUState *cs, uint8_t *mem_buf, int n) | 
 | { | 
 |     PowerPCCPU *cpu = POWERPC_CPU(cs); | 
 |     CPUPPCState *env = &cpu->env; | 
 |     int r = ppc_gdb_register_len(n); | 
 |  | 
 |     if (!r) { | 
 |         return r; | 
 |     } | 
 |  | 
 |     if (n < 32) { | 
 |         /* gprs */ | 
 |         gdb_get_regl(mem_buf, env->gpr[n]); | 
 |     } else if (n < 64) { | 
 |         /* fprs */ | 
 |         stfq_p(mem_buf, env->fpr[n-32]); | 
 |     } else { | 
 |         switch (n) { | 
 |         case 64: | 
 |             gdb_get_regl(mem_buf, env->nip); | 
 |             break; | 
 |         case 65: | 
 |             gdb_get_regl(mem_buf, env->msr); | 
 |             break; | 
 |         case 66: | 
 |             { | 
 |                 uint32_t cr = 0; | 
 |                 int i; | 
 |                 for (i = 0; i < 8; i++) { | 
 |                     cr |= env->crf[i] << (32 - ((i + 1) * 4)); | 
 |                 } | 
 |                 gdb_get_reg32(mem_buf, cr); | 
 |                 break; | 
 |             } | 
 |         case 67: | 
 |             gdb_get_regl(mem_buf, env->lr); | 
 |             break; | 
 |         case 68: | 
 |             gdb_get_regl(mem_buf, env->ctr); | 
 |             break; | 
 |         case 69: | 
 |             gdb_get_regl(mem_buf, env->xer); | 
 |             break; | 
 |         case 70: | 
 |             gdb_get_reg32(mem_buf, env->fpscr); | 
 |             break; | 
 |         } | 
 |     } | 
 |     maybe_bswap_register(env, mem_buf, r); | 
 |     return r; | 
 | } | 
 |  | 
 | int ppc_cpu_gdb_read_register_apple(CPUState *cs, uint8_t *mem_buf, int n) | 
 | { | 
 |     PowerPCCPU *cpu = POWERPC_CPU(cs); | 
 |     CPUPPCState *env = &cpu->env; | 
 |     int r = ppc_gdb_register_len_apple(n); | 
 |  | 
 |     if (!r) { | 
 |         return r; | 
 |     } | 
 |  | 
 |     if (n < 32) { | 
 |         /* gprs */ | 
 |         gdb_get_reg64(mem_buf, env->gpr[n]); | 
 |     } else if (n < 64) { | 
 |         /* fprs */ | 
 |         stfq_p(mem_buf, env->fpr[n-32]); | 
 |     } else if (n < 96) { | 
 |         /* Altivec */ | 
 |         stq_p(mem_buf, n - 64); | 
 |         stq_p(mem_buf + 8, 0); | 
 |     } else { | 
 |         switch (n) { | 
 |         case 64 + 32: | 
 |             gdb_get_reg64(mem_buf, env->nip); | 
 |             break; | 
 |         case 65 + 32: | 
 |             gdb_get_reg64(mem_buf, env->msr); | 
 |             break; | 
 |         case 66 + 32: | 
 |             { | 
 |                 uint32_t cr = 0; | 
 |                 int i; | 
 |                 for (i = 0; i < 8; i++) { | 
 |                     cr |= env->crf[i] << (32 - ((i + 1) * 4)); | 
 |                 } | 
 |                 gdb_get_reg32(mem_buf, cr); | 
 |                 break; | 
 |             } | 
 |         case 67 + 32: | 
 |             gdb_get_reg64(mem_buf, env->lr); | 
 |             break; | 
 |         case 68 + 32: | 
 |             gdb_get_reg64(mem_buf, env->ctr); | 
 |             break; | 
 |         case 69 + 32: | 
 |             gdb_get_reg64(mem_buf, env->xer); | 
 |             break; | 
 |         case 70 + 32: | 
 |             gdb_get_reg64(mem_buf, env->fpscr); | 
 |             break; | 
 |         } | 
 |     } | 
 |     maybe_bswap_register(env, mem_buf, r); | 
 |     return r; | 
 | } | 
 |  | 
 | int ppc_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n) | 
 | { | 
 |     PowerPCCPU *cpu = POWERPC_CPU(cs); | 
 |     CPUPPCState *env = &cpu->env; | 
 |     int r = ppc_gdb_register_len(n); | 
 |  | 
 |     if (!r) { | 
 |         return r; | 
 |     } | 
 |     maybe_bswap_register(env, mem_buf, r); | 
 |     if (n < 32) { | 
 |         /* gprs */ | 
 |         env->gpr[n] = ldtul_p(mem_buf); | 
 |     } else if (n < 64) { | 
 |         /* fprs */ | 
 |         env->fpr[n-32] = ldfq_p(mem_buf); | 
 |     } else { | 
 |         switch (n) { | 
 |         case 64: | 
 |             env->nip = ldtul_p(mem_buf); | 
 |             break; | 
 |         case 65: | 
 |             ppc_store_msr(env, ldtul_p(mem_buf)); | 
 |             break; | 
 |         case 66: | 
 |             { | 
 |                 uint32_t cr = ldl_p(mem_buf); | 
 |                 int i; | 
 |                 for (i = 0; i < 8; i++) { | 
 |                     env->crf[i] = (cr >> (32 - ((i + 1) * 4))) & 0xF; | 
 |                 } | 
 |                 break; | 
 |             } | 
 |         case 67: | 
 |             env->lr = ldtul_p(mem_buf); | 
 |             break; | 
 |         case 68: | 
 |             env->ctr = ldtul_p(mem_buf); | 
 |             break; | 
 |         case 69: | 
 |             env->xer = ldtul_p(mem_buf); | 
 |             break; | 
 |         case 70: | 
 |             /* fpscr */ | 
 |             store_fpscr(env, ldtul_p(mem_buf), 0xffffffff); | 
 |             break; | 
 |         } | 
 |     } | 
 |     return r; | 
 | } | 
 | int ppc_cpu_gdb_write_register_apple(CPUState *cs, uint8_t *mem_buf, int n) | 
 | { | 
 |     PowerPCCPU *cpu = POWERPC_CPU(cs); | 
 |     CPUPPCState *env = &cpu->env; | 
 |     int r = ppc_gdb_register_len_apple(n); | 
 |  | 
 |     if (!r) { | 
 |         return r; | 
 |     } | 
 |     maybe_bswap_register(env, mem_buf, r); | 
 |     if (n < 32) { | 
 |         /* gprs */ | 
 |         env->gpr[n] = ldq_p(mem_buf); | 
 |     } else if (n < 64) { | 
 |         /* fprs */ | 
 |         env->fpr[n-32] = ldfq_p(mem_buf); | 
 |     } else { | 
 |         switch (n) { | 
 |         case 64 + 32: | 
 |             env->nip = ldq_p(mem_buf); | 
 |             break; | 
 |         case 65 + 32: | 
 |             ppc_store_msr(env, ldq_p(mem_buf)); | 
 |             break; | 
 |         case 66 + 32: | 
 |             { | 
 |                 uint32_t cr = ldl_p(mem_buf); | 
 |                 int i; | 
 |                 for (i = 0; i < 8; i++) { | 
 |                     env->crf[i] = (cr >> (32 - ((i + 1) * 4))) & 0xF; | 
 |                 } | 
 |                 break; | 
 |             } | 
 |         case 67 + 32: | 
 |             env->lr = ldq_p(mem_buf); | 
 |             break; | 
 |         case 68 + 32: | 
 |             env->ctr = ldq_p(mem_buf); | 
 |             break; | 
 |         case 69 + 32: | 
 |             env->xer = ldq_p(mem_buf); | 
 |             break; | 
 |         case 70 + 32: | 
 |             /* fpscr */ | 
 |             store_fpscr(env, ldq_p(mem_buf), 0xffffffff); | 
 |             break; | 
 |         } | 
 |     } | 
 |     return r; | 
 | } |