gdb/gdbserver/spu-low.c

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