2004-07-21 Andrew Cagney <cagney@gnu.org>
[external/binutils.git] / gdb / armnbsd-nat.c
1 /* Native-dependent code for BSD Unix running on ARM's, for GDB.
2    Copyright 1988, 1989, 1991, 1992, 1994, 1996, 1999, 2002
3    Free Software Foundation, Inc.
4
5    This file is part of GDB.
6
7    This program is free software; you can redistribute it and/or modify
8    it under the terms of the GNU General Public License as published by
9    the Free Software Foundation; either version 2 of the License, or
10    (at your option) any later version.
11
12    This program 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
15    GNU General Public License for more details.
16
17    You should have received a copy of the GNU General Public License
18    along with this program; if not, write to the Free Software
19    Foundation, Inc., 59 Temple Place - Suite 330,
20    Boston, MA 02111-1307, USA.  */
21
22 #include "defs.h"
23
24 #ifndef FETCH_INFERIOR_REGISTERS
25 #error Not FETCH_INFERIOR_REGISTERS 
26 #endif /* !FETCH_INFERIOR_REGISTERS */
27
28 #include "arm-tdep.h"
29
30 #include <sys/types.h>
31 #include <sys/ptrace.h>
32 #include <machine/reg.h>
33 #include <machine/frame.h>
34 #include "inferior.h"
35 #include "regcache.h"
36 #include "gdbcore.h"
37
38 extern int arm_apcs_32;
39
40 static void
41 supply_gregset (struct reg *gregset)
42 {
43   int regno;
44   CORE_ADDR r_pc;
45
46   /* Integer registers.  */
47   for (regno = ARM_A1_REGNUM; regno < ARM_SP_REGNUM; regno++)
48     regcache_raw_supply (current_regcache, regno, (char *) &gregset->r[regno]);
49
50   regcache_raw_supply (current_regcache, ARM_SP_REGNUM,
51                        (char *) &gregset->r_sp);
52   regcache_raw_supply (current_regcache, ARM_LR_REGNUM,
53                        (char *) &gregset->r_lr);
54   /* This is ok: we're running native...  */
55   r_pc = ADDR_BITS_REMOVE (gregset->r_pc);
56   regcache_raw_supply (current_regcache, ARM_PC_REGNUM, (char *) &r_pc);
57
58   if (arm_apcs_32)
59     regcache_raw_supply (current_regcache, ARM_PS_REGNUM,
60                          (char *) &gregset->r_cpsr);
61   else
62     regcache_raw_supply (current_regcache, ARM_PS_REGNUM,
63                          (char *) &gregset->r_pc);
64 }
65
66 static void
67 supply_fparegset (struct fpreg *fparegset)
68 {
69   int regno;
70
71   for (regno = ARM_F0_REGNUM; regno <= ARM_F7_REGNUM; regno++)
72     regcache_raw_supply (current_regcache, regno,
73                          (char *) &fparegset->fpr[regno - ARM_F0_REGNUM]);
74
75   regcache_raw_supply (current_regcache, ARM_FPS_REGNUM,
76                        (char *) &fparegset->fpr_fpsr);
77 }
78
79 static void
80 fetch_register (int regno)
81 {
82   struct reg inferior_registers;
83   int ret;
84
85   ret = ptrace (PT_GETREGS, PIDGET (inferior_ptid),
86                 (PTRACE_ARG3_TYPE) &inferior_registers, 0);
87
88   if (ret < 0)
89     {
90       warning ("unable to fetch general register");
91       return;
92     }
93
94   switch (regno)
95     {
96     case ARM_SP_REGNUM:
97       regcache_raw_supply (current_regcache, ARM_SP_REGNUM,
98                            (char *) &inferior_registers.r_sp);
99       break;
100
101     case ARM_LR_REGNUM:
102       regcache_raw_supply (current_regcache, ARM_LR_REGNUM,
103                            (char *) &inferior_registers.r_lr);
104       break;
105
106     case ARM_PC_REGNUM:
107       /* This is ok: we're running native... */
108       inferior_registers.r_pc = ADDR_BITS_REMOVE (inferior_registers.r_pc);
109       regcache_raw_supply (current_regcache, ARM_PC_REGNUM,
110                            (char *) &inferior_registers.r_pc);
111       break;
112
113     case ARM_PS_REGNUM:
114       if (arm_apcs_32)
115         regcache_raw_supply (current_regcache, ARM_PS_REGNUM,
116                              (char *) &inferior_registers.r_cpsr);
117       else
118         regcache_raw_supply (current_regcache, ARM_PS_REGNUM,
119                              (char *) &inferior_registers.r_pc);
120       break;
121
122     default:
123       regcache_raw_supply (current_regcache, regno,
124                            (char *) &inferior_registers.r[regno]);
125       break;
126     }
127 }
128
129 static void
130 fetch_regs (void)
131 {
132   struct reg inferior_registers;
133   int ret;
134   int regno;
135
136   ret = ptrace (PT_GETREGS, PIDGET (inferior_ptid),
137                 (PTRACE_ARG3_TYPE) &inferior_registers, 0);
138
139   if (ret < 0)
140     {
141       warning ("unable to fetch general registers");
142       return;
143     }
144
145   supply_gregset (&inferior_registers);
146 }
147
148 static void
149 fetch_fp_register (int regno)
150 {
151   struct fpreg inferior_fp_registers;
152   int ret;
153
154   ret = ptrace (PT_GETFPREGS, PIDGET (inferior_ptid),
155                 (PTRACE_ARG3_TYPE) &inferior_fp_registers, 0);
156
157   if (ret < 0)
158     {
159       warning ("unable to fetch floating-point register");
160       return;
161     }
162
163   switch (regno)
164     {
165     case ARM_FPS_REGNUM:
166       regcache_raw_supply (current_regcache, ARM_FPS_REGNUM,
167                            (char *) &inferior_fp_registers.fpr_fpsr);
168       break;
169
170     default:
171       regcache_raw_supply (current_regcache, regno,
172                            (char *) &inferior_fp_registers.fpr[regno - ARM_F0_REGNUM]);
173       break;
174     }
175 }
176
177 static void
178 fetch_fp_regs (void)
179 {
180   struct fpreg inferior_fp_registers;
181   int ret;
182   int regno;
183
184   ret = ptrace (PT_GETFPREGS, PIDGET (inferior_ptid),
185                 (PTRACE_ARG3_TYPE) &inferior_fp_registers, 0);
186
187   if (ret < 0)
188     {
189       warning ("unable to fetch general registers");
190       return;
191     }
192
193   supply_fparegset (&inferior_fp_registers);
194 }
195
196 void
197 fetch_inferior_registers (int regno)
198 {
199   if (regno >= 0)
200     {
201       if (regno < ARM_F0_REGNUM || regno > ARM_FPS_REGNUM)
202         fetch_register (regno);
203       else
204         fetch_fp_register (regno);
205     }
206   else
207     {
208       fetch_regs ();
209       fetch_fp_regs ();
210     }
211 }
212
213
214 static void
215 store_register (int regno)
216 {
217   struct reg inferior_registers;
218   int ret;
219
220   ret = ptrace (PT_GETREGS, PIDGET (inferior_ptid),
221                 (PTRACE_ARG3_TYPE) &inferior_registers, 0);
222
223   if (ret < 0)
224     {
225       warning ("unable to fetch general registers");
226       return;
227     }
228
229   switch (regno)
230     {
231     case ARM_SP_REGNUM:
232       regcache_collect (ARM_SP_REGNUM, (char *) &inferior_registers.r_sp);
233       break;
234
235     case ARM_LR_REGNUM:
236       regcache_collect (ARM_LR_REGNUM, (char *) &inferior_registers.r_lr);
237       break;
238
239     case ARM_PC_REGNUM:
240       if (arm_apcs_32)
241         regcache_collect (ARM_PC_REGNUM, (char *) &inferior_registers.r_pc);
242       else
243         {
244           unsigned pc_val;
245
246           regcache_collect (ARM_PC_REGNUM, (char *) &pc_val);
247           
248           pc_val = ADDR_BITS_REMOVE (pc_val);
249           inferior_registers.r_pc
250             ^= ADDR_BITS_REMOVE (inferior_registers.r_pc);
251           inferior_registers.r_pc |= pc_val;
252         }
253       break;
254
255     case ARM_PS_REGNUM:
256       if (arm_apcs_32)
257         regcache_collect (ARM_PS_REGNUM, (char *) &inferior_registers.r_cpsr);
258       else
259         {
260           unsigned psr_val;
261
262           regcache_collect (ARM_PS_REGNUM, (char *) &psr_val);
263
264           psr_val ^= ADDR_BITS_REMOVE (psr_val);
265           inferior_registers.r_pc = ADDR_BITS_REMOVE (inferior_registers.r_pc);
266           inferior_registers.r_pc |= psr_val;
267         }
268       break;
269
270     default:
271       regcache_collect (regno, (char *) &inferior_registers.r[regno]);
272       break;
273     }
274
275   ret = ptrace (PT_SETREGS, PIDGET (inferior_ptid),
276                 (PTRACE_ARG3_TYPE) &inferior_registers, 0);
277
278   if (ret < 0)
279     warning ("unable to write register %d to inferior", regno);
280 }
281
282 static void
283 store_regs (void)
284 {
285   struct reg inferior_registers;
286   int ret;
287   int regno;
288
289
290   for (regno = ARM_A1_REGNUM; regno < ARM_SP_REGNUM; regno++)
291     regcache_collect (regno, (char *) &inferior_registers.r[regno]);
292
293   regcache_collect (ARM_SP_REGNUM, (char *) &inferior_registers.r_sp);
294   regcache_collect (ARM_LR_REGNUM, (char *) &inferior_registers.r_lr);
295
296   if (arm_apcs_32)
297     {
298       regcache_collect (ARM_PC_REGNUM, (char *) &inferior_registers.r_pc);
299       regcache_collect (ARM_PS_REGNUM, (char *) &inferior_registers.r_cpsr);
300     }
301   else
302     {
303       unsigned pc_val;
304       unsigned psr_val;
305
306       regcache_collect (ARM_PC_REGNUM, (char *) &pc_val);
307       regcache_collect (ARM_PS_REGNUM, (char *) &psr_val);
308           
309       pc_val = ADDR_BITS_REMOVE (pc_val);
310       psr_val ^= ADDR_BITS_REMOVE (psr_val);
311
312       inferior_registers.r_pc = pc_val | psr_val;
313     }
314
315   ret = ptrace (PT_SETREGS, PIDGET (inferior_ptid),
316                 (PTRACE_ARG3_TYPE) &inferior_registers, 0);
317
318   if (ret < 0)
319     warning ("unable to store general registers");
320 }
321
322 static void
323 store_fp_register (int regno)
324 {
325   struct fpreg inferior_fp_registers;
326   int ret;
327
328   ret = ptrace (PT_GETFPREGS, PIDGET (inferior_ptid),
329                 (PTRACE_ARG3_TYPE) &inferior_fp_registers, 0);
330
331   if (ret < 0)
332     {
333       warning ("unable to fetch floating-point registers");
334       return;
335     }
336
337   switch (regno)
338     {
339     case ARM_FPS_REGNUM:
340       regcache_collect (ARM_FPS_REGNUM,
341                         (char *) &inferior_fp_registers.fpr_fpsr);
342       break;
343
344     default:
345       regcache_collect
346         (regno, (char *) &inferior_fp_registers.fpr[regno - ARM_F0_REGNUM]);
347       break;
348     }
349
350   ret = ptrace (PT_SETFPREGS, PIDGET (inferior_ptid),
351                 (PTRACE_ARG3_TYPE) &inferior_fp_registers, 0);
352
353   if (ret < 0)
354     warning ("unable to write register %d to inferior", regno);
355 }
356
357 static void
358 store_fp_regs (void)
359 {
360   struct fpreg inferior_fp_registers;
361   int ret;
362   int regno;
363
364
365   for (regno = ARM_F0_REGNUM; regno <= ARM_F7_REGNUM; regno++)
366     regcache_collect
367       (regno, (char *) &inferior_fp_registers.fpr[regno - ARM_F0_REGNUM]);
368
369   regcache_collect (ARM_FPS_REGNUM, (char *) &inferior_fp_registers.fpr_fpsr);
370
371   ret = ptrace (PT_SETFPREGS, PIDGET (inferior_ptid),
372                 (PTRACE_ARG3_TYPE) &inferior_fp_registers, 0);
373
374   if (ret < 0)
375     warning ("unable to store floating-point registers");
376 }
377
378 void
379 store_inferior_registers (int regno)
380 {
381   if (regno >= 0)
382     {
383       if (regno < ARM_F0_REGNUM || regno > ARM_FPS_REGNUM)
384         store_register (regno);
385       else
386         store_fp_register (regno);
387     }
388   else
389     {
390       store_regs ();
391       store_fp_regs ();
392     }
393 }
394
395 struct md_core
396 {
397   struct reg intreg;
398   struct fpreg freg;
399 };
400
401 static void
402 fetch_core_registers (char *core_reg_sect, unsigned core_reg_size,
403                       int which, CORE_ADDR ignore)
404 {
405   struct md_core *core_reg = (struct md_core *) core_reg_sect;
406   int regno;
407   CORE_ADDR r_pc;
408
409   supply_gregset (&core_reg->intreg);
410   supply_fparegset (&core_reg->freg);
411 }
412
413 static void
414 fetch_elfcore_registers (char *core_reg_sect, unsigned core_reg_size,
415                          int which, CORE_ADDR ignore)
416 {
417   struct reg gregset;
418   struct fpreg fparegset;
419
420   switch (which)
421     {
422     case 0:     /* Integer registers.  */
423       if (core_reg_size != sizeof (struct reg))
424         warning ("wrong size of register set in core file");
425       else
426         {
427           /* The memcpy may be unnecessary, but we can't really be sure
428              of the alignment of the data in the core file.  */
429           memcpy (&gregset, core_reg_sect, sizeof (gregset));
430           supply_gregset (&gregset);
431         }
432       break;
433
434     case 2:
435       if (core_reg_size != sizeof (struct fpreg))
436         warning ("wrong size of FPA register set in core file");
437       else
438         {
439           /* The memcpy may be unnecessary, but we can't really be sure
440              of the alignment of the data in the core file.  */
441           memcpy (&fparegset, core_reg_sect, sizeof (fparegset));
442           supply_fparegset (&fparegset);
443         }
444       break;
445
446     default:
447       /* Don't know what kind of register request this is; just ignore it.  */
448       break;
449     }
450 }
451
452 static struct core_fns arm_netbsd_core_fns =
453 {
454   bfd_target_unknown_flavour,           /* core_flovour.  */
455   default_check_format,                 /* check_format.  */
456   default_core_sniffer,                 /* core_sniffer.  */
457   fetch_core_registers,                 /* core_read_registers.  */
458   NULL
459 };
460
461 static struct core_fns arm_netbsd_elfcore_fns =
462 {
463   bfd_target_elf_flavour,               /* core_flovour.  */
464   default_check_format,                 /* check_format.  */
465   default_core_sniffer,                 /* core_sniffer.  */
466   fetch_elfcore_registers,              /* core_read_registers.  */
467   NULL
468 };
469
470 void
471 _initialize_arm_netbsd_nat (void)
472 {
473   deprecated_add_core_fns (&arm_netbsd_core_fns);
474   deprecated_add_core_fns (&arm_netbsd_elfcore_fns);
475 }