sd: convert sd_normal_command() ffs(3) call to ctz32()
[qemu/ar7.git] / target-cris / gdbstub.c
blob5db3683ab699590186734096418d630362058f11
1 /*
2 * CRIS gdb server stub
4 * Copyright (c) 2003-2005 Fabrice Bellard
5 * Copyright (c) 2013 SUSE LINUX Products GmbH
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.
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.
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/>.
20 #include "config.h"
21 #include "qemu-common.h"
22 #include "exec/gdbstub.h"
24 int crisv10_cpu_gdb_read_register(CPUState *cs, uint8_t *mem_buf, int n)
26 CRISCPU *cpu = CRIS_CPU(cs);
27 CPUCRISState *env = &cpu->env;
29 if (n < 15) {
30 return gdb_get_reg32(mem_buf, env->regs[n]);
33 if (n == 15) {
34 return gdb_get_reg32(mem_buf, env->pc);
37 if (n < 32) {
38 switch (n) {
39 case 16:
40 return gdb_get_reg8(mem_buf, env->pregs[n - 16]);
41 case 17:
42 return gdb_get_reg8(mem_buf, env->pregs[n - 16]);
43 case 20:
44 case 21:
45 return gdb_get_reg16(mem_buf, env->pregs[n - 16]);
46 default:
47 if (n >= 23) {
48 return gdb_get_reg32(mem_buf, env->pregs[n - 16]);
50 break;
53 return 0;
56 int cris_cpu_gdb_read_register(CPUState *cs, uint8_t *mem_buf, int n)
58 CRISCPU *cpu = CRIS_CPU(cs);
59 CPUCRISState *env = &cpu->env;
60 uint8_t srs;
62 srs = env->pregs[PR_SRS];
63 if (n < 16) {
64 return gdb_get_reg32(mem_buf, env->regs[n]);
67 if (n >= 21 && n < 32) {
68 return gdb_get_reg32(mem_buf, env->pregs[n - 16]);
70 if (n >= 33 && n < 49) {
71 return gdb_get_reg32(mem_buf, env->sregs[srs][n - 33]);
73 switch (n) {
74 case 16:
75 return gdb_get_reg8(mem_buf, env->pregs[0]);
76 case 17:
77 return gdb_get_reg8(mem_buf, env->pregs[1]);
78 case 18:
79 return gdb_get_reg32(mem_buf, env->pregs[2]);
80 case 19:
81 return gdb_get_reg8(mem_buf, srs);
82 case 20:
83 return gdb_get_reg16(mem_buf, env->pregs[4]);
84 case 32:
85 return gdb_get_reg32(mem_buf, env->pc);
88 return 0;
91 int cris_cpu_gdb_write_register(CPUState *cs, uint8_t *mem_buf, int n)
93 CRISCPU *cpu = CRIS_CPU(cs);
94 CPUCRISState *env = &cpu->env;
95 uint32_t tmp;
97 if (n > 49) {
98 return 0;
101 tmp = ldl_p(mem_buf);
103 if (n < 16) {
104 env->regs[n] = tmp;
107 if (n >= 21 && n < 32) {
108 env->pregs[n - 16] = tmp;
111 /* FIXME: Should support function regs be writable? */
112 switch (n) {
113 case 16:
114 return 1;
115 case 17:
116 return 1;
117 case 18:
118 env->pregs[PR_PID] = tmp;
119 break;
120 case 19:
121 return 1;
122 case 20:
123 return 2;
124 case 32:
125 env->pc = tmp;
126 break;
129 return 4;