target-s390x/gdbstub.c

   1 /*
   2  * s390x gdb server stub
   3  *
   4  * Copyright (c) 2003-2005 Fabrice Bellard
   5  * Copyright (c) 2013 SUSE LINUX Products GmbH
   6  *
   7  * This library is free software; you can redistribute it and/or
   8  * modify it under the terms of the GNU Lesser General Public
   9  * License as published by the Free Software Foundation; either
  10  * version 2 of the License, or (at your option) any later version.
  11  *
  12  * This library is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  15  * Lesser General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU Lesser General Public
  18  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
  19  */
  20 #include "config.h"
  21 #include "qemu-common.h"
  22 #include "exec/gdbstub.h"
  23 #include "qemu/bitops.h"
  24
  25 int s390_cpu_gdb_read_register(CPUState *cs, uint8_t *mem_buf, int n)
  26 {
  27     S390CPU *cpu = S390_CPU(cs);
  28     CPUS390XState *env = &cpu->env;
  29     uint64_t val;
  30     int cc_op;
  31
  32     switch (n) {
  33     case S390_PSWM_REGNUM:
  34         if (tcg_enabled()) {
  35             cc_op = calc_cc(env, env->cc_op, env->cc_src, env->cc_dst,
  36                             env->cc_vr);
  37             val = deposit64(env->psw.mask, 44, 2, cc_op);
  38             return gdb_get_regl(mem_buf, val);
  39         }
  40         return gdb_get_regl(mem_buf, env->psw.mask);
  41     case S390_PSWA_REGNUM:
  42         return gdb_get_regl(mem_buf, env->psw.addr);
  43     case S390_R0_REGNUM ... S390_R15_REGNUM:
  44         return gdb_get_regl(mem_buf, env->regs[n - S390_R0_REGNUM]);
  45     }
  46     return 0;
  47 }
  48
  49 int s390_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n)
  50 {
  51     S390CPU *cpu = S390_CPU(cs);
  52     CPUS390XState *env = &cpu->env;
  53     target_ulong tmpl = ldtul_p(mem_buf);
  54
  55     switch (n) {
  56     case S390_PSWM_REGNUM:
  57         env->psw.mask = tmpl;
  58         if (tcg_enabled()) {
  59             env->cc_op = extract64(tmpl, 44, 2);
  60         }
  61         break;
  62     case S390_PSWA_REGNUM:
  63         env->psw.addr = tmpl;
  64         break;
  65     case S390_R0_REGNUM ... S390_R15_REGNUM:
  66         env->regs[n - S390_R0_REGNUM] = tmpl;
  67         break;
  68     default:
  69         return 0;
  70     }
  71     return 8;
  72 }
  73
  74 /* the values represent the positions in s390-acr.xml */
  75 #define S390_A0_REGNUM 0
  76 #define S390_A15_REGNUM 15
  77 /* total number of registers in s390-acr.xml */
  78 #define S390_NUM_AC_REGS 16
  79
  80 static int cpu_read_ac_reg(CPUS390XState *env, uint8_t *mem_buf, int n)
  81 {
  82     switch (n) {
  83     case S390_A0_REGNUM ... S390_A15_REGNUM:
  84         return gdb_get_reg32(mem_buf, env->aregs[n]);
  85     default:
  86         return 0;
  87     }
  88 }
  89
  90 static int cpu_write_ac_reg(CPUS390XState *env, uint8_t *mem_buf, int n)
  91 {
  92     switch (n) {
  93     case S390_A0_REGNUM ... S390_A15_REGNUM:
  94         env->aregs[n] = ldl_p(mem_buf);
  95         return 4;
  96     default:
  97         return 0;
  98     }
  99 }
 100
 101 /* the values represent the positions in s390-fpr.xml */
 102 #define S390_FPC_REGNUM 0
 103 #define S390_F0_REGNUM 1
 104 #define S390_F15_REGNUM 16
 105 /* total number of registers in s390-fpr.xml */
 106 #define S390_NUM_FP_REGS 17
 107
 108 static int cpu_read_fp_reg(CPUS390XState *env, uint8_t *mem_buf, int n)
 109 {
 110     switch (n) {
 111     case S390_FPC_REGNUM:
 112         return gdb_get_reg32(mem_buf, env->fpc);
 113     case S390_F0_REGNUM ... S390_F15_REGNUM:
 114         return gdb_get_reg64(mem_buf, get_freg(env, n - S390_F0_REGNUM)->ll);
 115     default:
 116         return 0;
 117     }
 118 }
 119
 120 static int cpu_write_fp_reg(CPUS390XState *env, uint8_t *mem_buf, int n)
 121 {
 122     switch (n) {
 123     case S390_FPC_REGNUM:
 124         env->fpc = ldl_p(mem_buf);
 125         return 4;
 126     case S390_F0_REGNUM ... S390_F15_REGNUM:
 127         get_freg(env, n - S390_F0_REGNUM)->ll = ldtul_p(mem_buf);
 128         return 8;
 129     default:
 130         return 0;
 131     }
 132 }
 133
 134 /* the values represent the positions in s390-vx.xml */
 135 #define S390_V0L_REGNUM 0
 136 #define S390_V15L_REGNUM 15
 137 #define S390_V16_REGNUM 16
 138 #define S390_V31_REGNUM 31
 139 /* total number of registers in s390-vx.xml */
 140 #define S390_NUM_VREGS 32
 141
 142 static int cpu_read_vreg(CPUS390XState *env, uint8_t *mem_buf, int n)
 143 {
 144     int ret;
 145
 146     switch (n) {
 147     case S390_V0L_REGNUM ... S390_V15L_REGNUM:
 148         ret = gdb_get_reg64(mem_buf, env->vregs[n][1].ll);
 149         break;
 150     case S390_V16_REGNUM ... S390_V31_REGNUM:
 151         ret = gdb_get_reg64(mem_buf, env->vregs[n][0].ll);
 152         ret += gdb_get_reg64(mem_buf + 8, env->vregs[n][1].ll);
 153         break;
 154     default:
 155         ret = 0;
 156     }
 157
 158     return ret;
 159 }
 160
 161 static int cpu_write_vreg(CPUS390XState *env, uint8_t *mem_buf, int n)
 162 {
 163     switch (n) {
 164     case S390_V0L_REGNUM ... S390_V15L_REGNUM:
 165         env->vregs[n][1].ll = ldtul_p(mem_buf + 8);
 166         return 8;
 167     case S390_V16_REGNUM ... S390_V31_REGNUM:
 168         env->vregs[n][0].ll = ldtul_p(mem_buf);
 169         env->vregs[n][1].ll = ldtul_p(mem_buf + 8);
 170         return 16;
 171     default:
 172         return 0;
 173     }
 174 }
 175
 176 void s390_cpu_gdb_init(CPUState *cs)
 177 {
 178     gdb_register_coprocessor(cs, cpu_read_ac_reg,
 179                              cpu_write_ac_reg,
 180                              S390_NUM_AC_REGS, "s390-acr.xml", 0);
 181
 182     gdb_register_coprocessor(cs, cpu_read_fp_reg,
 183                              cpu_write_fp_reg,
 184                              S390_NUM_FP_REGS, "s390-fpr.xml", 0);
 185
 186     gdb_register_coprocessor(cs, cpu_read_vreg,
 187                              cpu_write_vreg,
 188                              S390_NUM_VREGS, "s390-vx.xml", 0);
 189 }