regsriscv.c 3.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133
  1. /*
  2. * Kernel Debug Core
  3. *
  4. * Maintainer: Jason Wessel <jason.wessel@windriver.com>
  5. *
  6. * Copyright (C) 2000-2001 VERITAS Software Corporation.
  7. * Copyright (C) 2002-2004 Timesys Corporation
  8. * Copyright (C) 2003-2004 Amit S. Kale <amitkale@linsyssoft.com>
  9. * Copyright (C) 2004 Pavel Machek <pavel@ucw.cz>
  10. * Copyright (C) 2004-2006 Tom Rini <trini@kernel.crashing.org>
  11. * Copyright (C) 2004-2006 LinSysSoft Technologies Pvt. Ltd.
  12. * Copyright (C) 2005-2009 Wind River Systems, Inc.
  13. * Copyright (C) 2007 MontaVista Software, Inc.
  14. * Copyright (C) 2008 Red Hat, Inc., Ingo Molnar <mingo@redhat.com>
  15. *
  16. * Contributors at various stages not listed above:
  17. * Jason Wessel ( jason.wessel@windriver.com )
  18. * George Anzinger <george@mvista.com>
  19. * Anurekh Saxena (anurekh.saxena@timesys.com)
  20. * Lake Stevens Instrument Division (Glenn Engel)
  21. * Jim Kingdon, Cygnus Support.
  22. *
  23. * Original KGDB stub: David Grothe <dave@gcom.com>,
  24. * Tigran Aivazian <tigran@sco.com>
  25. *
  26. * This file is licensed under the terms of the GNU General Public License
  27. * version 2. This program is licensed "as is" without any warranty of any
  28. * kind, whether express or implied.
  29. */
  30. #include <u.h>
  31. #include <libc.h>
  32. #include <ureg.h>
  33. #include <ctype.h>
  34. #include "debug_core.h"
  35. #include "gdb.h"
  36. /* all because gdb has stupid register layouts. Too bad. */
  37. static char *
  38. gdb_hex_reg_helper(uintptr_t *gdb_regs, int regnum, char *out)
  39. {
  40. int offset = 0;
  41. if (regnum <= GDB_PC)
  42. return mem2hex((void *)&gdb_regs[offset], out, sizeof(uintptr_t));
  43. if (regnum == GDB_PS)
  44. return mem2hex((void *)&gdb_regs[offset], out, sizeof(uint32_t));
  45. memset(out, 0, sizeof(uint32_t));
  46. return nil;
  47. }
  48. /* Handle the 'p' individual regster get */
  49. void
  50. gdb_cmd_reg_get(struct state *ks)
  51. {
  52. unsigned long regnum;
  53. char *ptr = (char *)&remcom_in_buffer[1];
  54. hex2long(&ptr, &regnum);
  55. syslog(0, "gdbserver", "Get reg %p: ", regnum);
  56. if (regnum >= DBG_MAX_REG_NUM) {
  57. syslog(0, "gdbserver", "fails\n");
  58. error_packet(remcom_out_buffer, Einval);
  59. return;
  60. }
  61. syslog(0, "gdbserver", "returns :%s:\n", ptr);
  62. gdb_hex_reg_helper(ks->gdbregs, regnum, (char *)ptr);
  63. }
  64. /* Handle the 'P' individual regster set */
  65. void
  66. gdb_cmd_reg_set(struct state *ks)
  67. {
  68. fprint(2, "%s: NOET YET\n", __func__);
  69. #if 0 // not yet.
  70. unsigned long regnum;
  71. char *ptr = &remcom_in_buffer[1];
  72. int i = 0;
  73. hex2long(&ptr, &regnum);
  74. if (*ptr++ != '=' ||
  75. !dbg_get_reg(regnum, gdb_regs, ks->linux_regs)) {
  76. error_packet(remcom_out_buffer, -EINVAL);
  77. return;
  78. }
  79. memset(gdb_regs, 0, sizeof(gdb_regs));
  80. while (i < sizeof(gdb_regs) * 2)
  81. if (hex_to_bin(ptr[i]) >= 0)
  82. i++;
  83. else
  84. break;
  85. i = i / 2;
  86. hex2mem(ptr, (char *)gdb_regs, i);
  87. dbg_set_reg(regnum, gdb_regs, ks->linux_regs);
  88. #endif
  89. strcpy((char *)remcom_out_buffer, "OK");
  90. }
  91. void arch_set_pc(uintptr_t *regs, unsigned long pc)
  92. {
  93. // not yet.
  94. }
  95. char *
  96. gpr(struct state *ks, int pid)
  97. {
  98. if (ks->gdbregs == nil)
  99. ks->gdbregs = malloc(NUMREGBYTES);
  100. if (pid <= 0) {
  101. syslog(0, "gdbserver", "%s: FUCK. pid <= 0", __func__);
  102. pid = 1;
  103. }
  104. char *cp = ks->gdbregs;
  105. char *regname = smprint("/proc/%d/gdbregs", pid);
  106. int fd = open(regname, 0);
  107. if (fd < 0) {
  108. syslog(0, "gdbserver", "open(%s, 0): %r\n", regname);
  109. return errstring(Enoent);
  110. }
  111. if (pread(fd, cp, NUMREGBYTES, 0) < NUMREGBYTES){
  112. close(fd);
  113. return errstring(Eio);
  114. }
  115. close(fd);
  116. return nil;
  117. }