gdb/gdbserver/spu-low.c

   1 /* Low level interface to SPUs, for the remote server for GDB.
   2    Copyright (C) 2006, 2007, 2008 Free Software Foundation, Inc.
   3
   4    Contributed by Ulrich Weigand <uweigand@de.ibm.com>.
   5
   6    This file is part of GDB.
   7
   8    This program is free software; you can redistribute it and/or modify
   9    it under the terms of the GNU General Public License as published by
  10    the Free Software Foundation; either version 3 of the License, or
  11    (at your option) any later version.
  12
  13    This program is distributed in the hope that it will be useful,
  14    but WITHOUT ANY WARRANTY; without even the implied warranty of
  15    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16    GNU General Public License for more details.
  17
  18    You should have received a copy of the GNU General Public License
  19    along with this program.  If not, see <http://www.gnu.org/licenses/>.  */
  20
  21 #include "server.h"
  22
  23 #include <sys/wait.h>
  24 #include <stdio.h>
  25 #include <sys/ptrace.h>
  26 #include <fcntl.h>
  27 #include <string.h>
  28 #include <stdlib.h>
  29 #include <unistd.h>
  30 #include <errno.h>
  31 #include <sys/syscall.h>
  32
  33 /* Some older glibc versions do not define this.  */
  34 #ifndef __WNOTHREAD
  35 #define __WNOTHREAD     0x20000000      /* Don't wait on children of other
  36                                            threads in this group */
  37 #endif
  38
  39 #define PTRACE_TYPE_RET long
  40 #define PTRACE_TYPE_ARG3 long
  41
  42 /* Number of registers.  */
  43 #define SPU_NUM_REGS         130
  44 #define SPU_NUM_CORE_REGS    128
  45
  46 /* Special registers.  */
  47 #define SPU_ID_REGNUM        128
  48 #define SPU_PC_REGNUM        129
  49
  50 /* PPU side system calls.  */
  51 #define INSTR_SC        0x44000002
  52 #define NR_spu_run      0x0116
  53
  54 /* Get current thread ID (Linux task ID).  */
  55 #define current_tid ((struct inferior_list_entry *)current_inferior)->id
  56
  57 /* These are used in remote-utils.c.  */
  58 int using_threads = 0;
  59
  60
  61 /* Fetch PPU register REGNO.  */
  62 static CORE_ADDR
  63 fetch_ppc_register (int regno)
  64 {
  65   PTRACE_TYPE_RET res;
  66
  67   int tid = current_tid;
  68
  69 #ifndef __powerpc64__
  70   /* If running as a 32-bit process on a 64-bit system, we attempt
  71      to get the full 64-bit register content of the target process.
  72      If the PPC special ptrace call fails, we're on a 32-bit system;
  73      just fall through to the regular ptrace call in that case.  */
  74   {
  75     char buf[8];
  76
  77     errno = 0;
  78     ptrace (PPC_PTRACE_PEEKUSR_3264, tid,
  79             (PTRACE_TYPE_ARG3) (regno * 8), buf);
  80     if (errno == 0)
  81       ptrace (PPC_PTRACE_PEEKUSR_3264, tid,
  82               (PTRACE_TYPE_ARG3) (regno * 8 + 4), buf + 4);
  83     if (errno == 0)
  84       return (CORE_ADDR) *(unsigned long long *)buf;
  85   }
  86 #endif
  87
  88   errno = 0;
  89   res = ptrace (PT_READ_U, tid,
  90                 (PTRACE_TYPE_ARG3) (regno * sizeof (PTRACE_TYPE_RET)), 0);
  91   if (errno != 0)
  92     {
  93       char mess[128];
  94       sprintf (mess, "reading PPC register #%d", regno);
  95       perror_with_name (mess);
  96     }
  97
  98   return (CORE_ADDR) (unsigned long) res;
  99 }
 100
 101 /* Fetch WORD from PPU memory at (aligned) MEMADDR in thread TID.  */
 102 static int
 103 fetch_ppc_memory_1 (int tid, CORE_ADDR memaddr, PTRACE_TYPE_RET *word)
 104 {
 105   errno = 0;
 106
 107 #ifndef __powerpc64__
 108   if (memaddr >> 32)
 109     {
 110       unsigned long long addr_8 = (unsigned long long) memaddr;
 111       ptrace (PPC_PTRACE_PEEKTEXT_3264, tid, (PTRACE_TYPE_ARG3) &addr_8, word);
 112     }
 113   else
 114 #endif
 115     *word = ptrace (PT_READ_I, tid, (PTRACE_TYPE_ARG3) (size_t) memaddr, 0);
 116
 117   return errno;
 118 }
 119
 120 /* Store WORD into PPU memory at (aligned) MEMADDR in thread TID.  */
 121 static int
 122 store_ppc_memory_1 (int tid, CORE_ADDR memaddr, PTRACE_TYPE_RET word)
 123 {
 124   errno = 0;
 125
 126 #ifndef __powerpc64__
 127   if (memaddr >> 32)
 128     {
 129       unsigned long long addr_8 = (unsigned long long) memaddr;
 130       ptrace (PPC_PTRACE_POKEDATA_3264, tid, (PTRACE_TYPE_ARG3) &addr_8, word);
 131     }
 132   else
 133 #endif
 134     ptrace (PT_WRITE_D, tid, (PTRACE_TYPE_ARG3) (size_t) memaddr, word);
 135
 136   return errno;
 137 }
 138
 139 /* Fetch LEN bytes of PPU memory at MEMADDR to MYADDR.  */
 140 static int
 141 fetch_ppc_memory (CORE_ADDR memaddr, char *myaddr, int len)
 142 {
 143   int i, ret;
 144
 145   CORE_ADDR addr = memaddr & -(CORE_ADDR) sizeof (PTRACE_TYPE_RET);
 146   int count = ((((memaddr + len) - addr) + sizeof (PTRACE_TYPE_RET) - 1)
 147                / sizeof (PTRACE_TYPE_RET));
 148   PTRACE_TYPE_RET *buffer;
 149
 150   int tid = current_tid;
 151
 152   buffer = (PTRACE_TYPE_RET *) alloca (count * sizeof (PTRACE_TYPE_RET));
 153   for (i = 0; i < count; i++, addr += sizeof (PTRACE_TYPE_RET))
 154     if ((ret = fetch_ppc_memory_1 (tid, addr, &buffer[i])) != 0)
 155       return ret;
 156
 157   memcpy (myaddr,
 158           (char *) buffer + (memaddr & (sizeof (PTRACE_TYPE_RET) - 1)),
 159           len);
 160
 161   return 0;
 162 }
 163
 164 /* Store LEN bytes from MYADDR to PPU memory at MEMADDR.  */
 165 static int
 166 store_ppc_memory (CORE_ADDR memaddr, char *myaddr, int len)
 167 {
 168   int i, ret;
 169
 170   CORE_ADDR addr = memaddr & -(CORE_ADDR) sizeof (PTRACE_TYPE_RET);
 171   int count = ((((memaddr + len) - addr) + sizeof (PTRACE_TYPE_RET) - 1)
 172                / sizeof (PTRACE_TYPE_RET));
 173   PTRACE_TYPE_RET *buffer;
 174
 175   int tid = current_tid;
 176
 177   buffer = (PTRACE_TYPE_RET *) alloca (count * sizeof (PTRACE_TYPE_RET));
 178
 179   if (addr != memaddr || len < (int) sizeof (PTRACE_TYPE_RET))
 180     if ((ret = fetch_ppc_memory_1 (tid, addr, &buffer[0])) != 0)
 181       return ret;
 182
 183   if (count > 1)
 184     if ((ret = fetch_ppc_memory_1 (tid, addr + (count - 1)
 185                                                * sizeof (PTRACE_TYPE_RET),
 186                                    &buffer[count - 1])) != 0)
 187       return ret;
 188
 189   memcpy ((char *) buffer + (memaddr & (sizeof (PTRACE_TYPE_RET) - 1)),
 190           myaddr, len);
 191
 192   for (i = 0; i < count; i++, addr += sizeof (PTRACE_TYPE_RET))
 193     if ((ret = store_ppc_memory_1 (tid, addr, buffer[i])) != 0)
 194       return ret;
 195
 196   return 0;
 197 }
 198
 199
 200 /* If the PPU thread is currently stopped on a spu_run system call,
 201    return to FD and ADDR the file handle and NPC parameter address
 202    used with the system call.  Return non-zero if successful.  */
 203 static int
 204 parse_spufs_run (int *fd, CORE_ADDR *addr)
 205 {
 206   char buf[4];
 207   CORE_ADDR pc = fetch_ppc_register (32);  /* nip */
 208
 209   /* Fetch instruction preceding current NIP.  */
 210   if (fetch_ppc_memory (pc-4, buf, 4) != 0)
 211     return 0;
 212   /* It should be a "sc" instruction.  */
 213   if (*(unsigned int *)buf != INSTR_SC)
 214     return 0;
 215   /* System call number should be NR_spu_run.  */
 216   if (fetch_ppc_register (0) != NR_spu_run)
 217     return 0;
 218
 219   /* Register 3 contains fd, register 4 the NPC param pointer.  */
 220   *fd = fetch_ppc_register (34);  /* orig_gpr3 */
 221   *addr = fetch_ppc_register (4);
 222   return 1;
 223 }
 224
 225
 226 /* Copy LEN bytes at OFFSET in spufs file ANNEX into/from READBUF or WRITEBUF,
 227    using the /proc file system.  */
 228 static int
 229 spu_proc_xfer_spu (const char *annex, unsigned char *readbuf,
 230                    const unsigned char *writebuf,
 231                    CORE_ADDR offset, int len)
 232 {
 233   char buf[128];
 234   int fd = 0;
 235   int ret = -1;
 236
 237   if (!annex)
 238     return 0;
 239
 240   sprintf (buf, "/proc/%ld/fd/%s", current_tid, annex);
 241   fd = open (buf, writebuf? O_WRONLY : O_RDONLY);
 242   if (fd <= 0)
 243     return -1;
 244
 245   if (offset != 0
 246       && lseek (fd, (off_t) offset, SEEK_SET) != (off_t) offset)
 247     {
 248       close (fd);
 249       return 0;
 250     }
 251
 252   if (writebuf)
 253     ret = write (fd, writebuf, (size_t) len);
 254   else if (readbuf)
 255     ret = read (fd, readbuf, (size_t) len);
 256
 257   close (fd);
 258   return ret;
 259 }
 260
 261
 262 /* Start an inferior process and returns its pid.
 263    ALLARGS is a vector of program-name and args. */
 264 static int
 265 spu_create_inferior (char *program, char **allargs)
 266 {
 267   int pid;
 268
 269   pid = fork ();
 270   if (pid < 0)
 271     perror_with_name ("fork");
 272
 273   if (pid == 0)
 274     {
 275       ptrace (PTRACE_TRACEME, 0, 0, 0);
 276
 277       setpgid (0, 0);
 278
 279       execv (program, allargs);
 280       if (errno == ENOENT)
 281         execvp (program, allargs);
 282
 283       fprintf (stderr, "Cannot exec %s: %s.\n", program,
 284                strerror (errno));
 285       fflush (stderr);
 286       _exit (0177);
 287     }
 288
 289   add_thread (pid, NULL, pid);
 290   return pid;
 291 }
 292
 293 /* Attach to an inferior process.  */
 294 int
 295 spu_attach (unsigned long  pid)
 296 {
 297   if (ptrace (PTRACE_ATTACH, pid, 0, 0) != 0)
 298     {
 299       fprintf (stderr, "Cannot attach to process %ld: %s (%d)\n", pid,
 300                strerror (errno), errno);
 301       fflush (stderr);
 302       _exit (0177);
 303     }
 304
 305   add_thread (pid, NULL, pid);
 306   return 0;
 307 }
 308
 309 /* Kill the inferior process.  */
 310 static void
 311 spu_kill (void)
 312 {
 313   ptrace (PTRACE_KILL, current_tid, 0, 0);
 314 }
 315
 316 /* Detach from inferior process.  */
 317 static int
 318 spu_detach (void)
 319 {
 320   ptrace (PTRACE_DETACH, current_tid, 0, 0);
 321   return 0;
 322 }
 323
 324 static void
 325 spu_join (void)
 326 {
 327   int status, ret;
 328
 329   do {
 330     ret = waitpid (current_tid, &status, 0);
 331     if (WIFEXITED (status) || WIFSIGNALED (status))
 332       break;
 333   } while (ret != -1 || errno != ECHILD);
 334 }
 335
 336 /* Return nonzero if the given thread is still alive.  */
 337 static int
 338 spu_thread_alive (unsigned long tid)
 339 {
 340   return tid == current_tid;
 341 }
 342
 343 /* Resume process.  */
 344 static void
 345 spu_resume (struct thread_resume *resume_info)
 346 {
 347   while (resume_info->thread != -1
 348          && resume_info->thread != current_tid)
 349     resume_info++;
 350
 351   if (resume_info->leave_stopped)
 352     return;
 353
 354   /* We don't support hardware single-stepping right now, assume
 355      GDB knows to use software single-stepping.  */
 356   if (resume_info->step)
 357     fprintf (stderr, "Hardware single-step not supported.\n");
 358
 359   regcache_invalidate ();
 360
 361   errno = 0;
 362   ptrace (PTRACE_CONT, current_tid, 0, resume_info->sig);
 363   if (errno)
 364     perror_with_name ("ptrace");
 365 }
 366
 367 /* Wait for process, returns status.  */
 368 static unsigned char
 369 spu_wait (char *status)
 370 {
 371   int tid = current_tid;
 372   int w;
 373   int ret;
 374
 375   while (1)
 376     {
 377       ret = waitpid (tid, &w, WNOHANG | __WALL | __WNOTHREAD);
 378
 379       if (ret == -1)
 380         {
 381           if (errno != ECHILD)
 382             perror_with_name ("waitpid");
 383         }
 384       else if (ret > 0)
 385         break;
 386
 387       usleep (1000);
 388     }
 389
 390   /* On the first wait, continue running the inferior until we are
 391      blocked inside an spu_run system call.  */
 392   if (!server_waiting)
 393     {
 394       int fd;
 395       CORE_ADDR addr;
 396
 397       while (!parse_spufs_run (&fd, &addr))
 398         {
 399           ptrace (PT_SYSCALL, tid, (PTRACE_TYPE_ARG3) 0, 0);
 400           waitpid (tid, NULL, __WALL | __WNOTHREAD);
 401         }
 402     }
 403
 404   if (WIFEXITED (w))
 405     {
 406       fprintf (stderr, "\nChild exited with retcode = %x \n", WEXITSTATUS (w));
 407       *status = 'W';
 408       clear_inferiors ();
 409       return ((unsigned char) WEXITSTATUS (w));
 410     }
 411   else if (!WIFSTOPPED (w))
 412     {
 413       fprintf (stderr, "\nChild terminated with signal = %x \n", WTERMSIG (w));
 414       *status = 'X';
 415       clear_inferiors ();
 416       return ((unsigned char) WTERMSIG (w));
 417     }
 418
 419   /* After attach, we may have received a SIGSTOP.  Do not return this
 420      as signal to GDB, or else it will try to continue with SIGSTOP ...  */
 421   if (!server_waiting)
 422     {
 423       *status = 'T';
 424       return 0;
 425     }
 426
 427   *status = 'T';
 428   return ((unsigned char) WSTOPSIG (w));
 429 }
 430
 431 /* Fetch inferior registers.  */
 432 static void
 433 spu_fetch_registers (int regno)
 434 {
 435   int fd;
 436   CORE_ADDR addr;
 437
 438   /* ??? Some callers use 0 to mean all registers.  */
 439   if (regno == 0)
 440     regno = -1;
 441
 442   /* We must be stopped on a spu_run system call.  */
 443   if (!parse_spufs_run (&fd, &addr))
 444     return;
 445
 446   /* The ID register holds the spufs file handle.  */
 447   if (regno == -1 || regno == SPU_ID_REGNUM)
 448     supply_register (SPU_ID_REGNUM, (char *)&fd);
 449
 450   /* The NPC register is found at ADDR.  */
 451   if (regno == -1 || regno == SPU_PC_REGNUM)
 452     {
 453       char buf[4];
 454       if (fetch_ppc_memory (addr, buf, 4) == 0)
 455         supply_register (SPU_PC_REGNUM, buf);
 456     }
 457
 458   /* The GPRs are found in the "regs" spufs file.  */
 459   if (regno == -1 || (regno >= 0 && regno < SPU_NUM_CORE_REGS))
 460     {
 461       unsigned char buf[16*SPU_NUM_CORE_REGS];
 462       char annex[32];
 463       int i;
 464
 465       sprintf (annex, "%d/regs", fd);
 466       if (spu_proc_xfer_spu (annex, buf, NULL, 0, sizeof buf) == sizeof buf)
 467         for (i = 0; i < SPU_NUM_CORE_REGS; i++)
 468           supply_register (i, buf + i*16);
 469     }
 470 }
 471
 472 /* Store inferior registers.  */
 473 static void
 474 spu_store_registers (int regno)
 475 {
 476   int fd;
 477   CORE_ADDR addr;
 478
 479   /* ??? Some callers use 0 to mean all registers.  */
 480   if (regno == 0)
 481     regno = -1;
 482
 483   /* We must be stopped on a spu_run system call.  */
 484   if (!parse_spufs_run (&fd, &addr))
 485     return;
 486
 487   /* The NPC register is found at ADDR.  */
 488   if (regno == -1 || regno == SPU_PC_REGNUM)
 489     {
 490       char buf[4];
 491       collect_register (SPU_PC_REGNUM, buf);
 492       store_ppc_memory (addr, buf, 4);
 493     }
 494
 495   /* The GPRs are found in the "regs" spufs file.  */
 496   if (regno == -1 || (regno >= 0 && regno < SPU_NUM_CORE_REGS))
 497     {
 498       unsigned char buf[16*SPU_NUM_CORE_REGS];
 499       char annex[32];
 500       int i;
 501
 502       for (i = 0; i < SPU_NUM_CORE_REGS; i++)
 503         collect_register (i, buf + i*16);
 504
 505       sprintf (annex, "%d/regs", fd);
 506       spu_proc_xfer_spu (annex, NULL, buf, 0, sizeof buf);
 507     }
 508 }
 509
 510 /* Copy LEN bytes from inferior's memory starting at MEMADDR
 511    to debugger memory starting at MYADDR.  */
 512 static int
 513 spu_read_memory (CORE_ADDR memaddr, unsigned char *myaddr, int len)
 514 {
 515   int fd, ret;
 516   CORE_ADDR addr;
 517   char annex[32];
 518
 519   /* We must be stopped on a spu_run system call.  */
 520   if (!parse_spufs_run (&fd, &addr))
 521     return 0;
 522
 523   /* Use the "mem" spufs file to access SPU local store.  */
 524   sprintf (annex, "%d/mem", fd);
 525   ret = spu_proc_xfer_spu (annex, myaddr, NULL, memaddr, len);
 526   return ret == len ? 0 : EIO;
 527 }
 528
 529 /* Copy LEN bytes of data from debugger memory at MYADDR
 530    to inferior's memory at MEMADDR.
 531    On failure (cannot write the inferior)
 532    returns the value of errno.  */
 533 static int
 534 spu_write_memory (CORE_ADDR memaddr, const unsigned char *myaddr, int len)
 535 {
 536   int fd, ret;
 537   CORE_ADDR addr;
 538   char annex[32];
 539
 540   /* We must be stopped on a spu_run system call.  */
 541   if (!parse_spufs_run (&fd, &addr))
 542     return 0;
 543
 544   /* Use the "mem" spufs file to access SPU local store.  */
 545   sprintf (annex, "%d/mem", fd);
 546   ret = spu_proc_xfer_spu (annex, NULL, myaddr, memaddr, len);
 547   return ret == len ? 0 : EIO;
 548 }
 549
 550 /* Look up special symbols -- unneded here.  */
 551 static void
 552 spu_look_up_symbols (void)
 553 {
 554 }
 555
 556 /* Send signal to inferior.  */
 557 static void
 558 spu_request_interrupt (void)
 559 {
 560   syscall (SYS_tkill, current_tid, SIGINT);
 561 }
 562
 563 static const char *
 564 spu_arch_string (void)
 565 {
 566   return "spu";
 567 }
 568
 569 static struct target_ops spu_target_ops = {
 570   spu_create_inferior,
 571   spu_attach,
 572   spu_kill,
 573   spu_detach,
 574   spu_join,
 575   spu_thread_alive,
 576   spu_resume,
 577   spu_wait,
 578   spu_fetch_registers,
 579   spu_store_registers,
 580   spu_read_memory,
 581   spu_write_memory,
 582   spu_look_up_symbols,
 583   spu_request_interrupt,
 584   NULL,
 585   NULL,
 586   NULL,
 587   NULL,
 588   NULL,
 589   NULL,
 590   NULL,
 591   spu_arch_string,
 592   spu_proc_xfer_spu,
 593 };
 594
 595 void
 596 initialize_low (void)
 597 {
 598   static const unsigned char breakpoint[] = { 0x00, 0x00, 0x3f, 0xff };
 599
 600   set_target_ops (&spu_target_ops);
 601   set_breakpoint_data (breakpoint, sizeof breakpoint);
 602   init_registers ();
 603 }