Subversion Repositories HelenOS

Rev

Rev 2924 | Rev 2936 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (c) 2008 Jiri Svoboda
  3.  * All rights reserved.
  4.  *
  5.  * Redistribution and use in source and binary forms, with or without
  6.  * modification, are permitted provided that the following conditions
  7.  * are met:
  8.  *
  9.  * - Redistributions of source code must retain the above copyright
  10.  *   notice, this list of conditions and the following disclaimer.
  11.  * - Redistributions in binary form must reproduce the above copyright
  12.  *   notice, this list of conditions and the following disclaimer in the
  13.  *   documentation and/or other materials provided with the distribution.
  14.  * - The name of the author may not be used to endorse or promote products
  15.  *   derived from this software without specific prior written permission.
  16.  *
  17.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27.  */
  28.  
  29. /** @addtogroup debug
  30.  * @{
  31.  */
  32. /** @file
  33.  */
  34.  
  35. #include <stdio.h>
  36. #include <stdlib.h>
  37. #include <sys/types.h>
  38. #include <udebug.h>
  39.  
  40. #include "../../../main.h"
  41. #include "../../../include/arch.h"
  42.  
  43. #define OPCODE_INT3     0xCC
  44.  
  45. #define ISTATE_OFF_EIP      12
  46. #define ISTATE_OFF_EFLAGS   14
  47.  
  48. void arch_breakpoint_add(uintptr_t addr)
  49. {
  50.     char brkp[1];
  51.     int rc;
  52.     breakpoint_t *brk;
  53.     int i;
  54.  
  55.     brk = NULL;
  56.     for (i = 0; i < MAX_BRKPTS; i++)
  57.         if (brk_list[i].set == 0) brk = brk_list+i;
  58.  
  59.     if (!brk) {
  60.         printf("too many breakpoints\n");
  61.         return;
  62.     }
  63.  
  64.     rc = udebug_mem_read(app_phone, &brk->arch.back, addr, 1);
  65.     printf("udebug_mem_read() -> %d\n", rc);
  66.     brkp[0] = OPCODE_INT3;
  67.     rc = udebug_mem_write(app_phone, brkp, addr, 1);
  68.     printf("udebug_mem_write() -> %d\n", rc);
  69.  
  70.     brk->addr = addr;
  71.     brk->set = 1;
  72. }
  73.  
  74. static unsigned buffer[1024];
  75. static breakpoint_t *lifted_brkpt;
  76.  
  77. void arch_event_breakpoint(thash_t thread_hash)
  78. {
  79.     int rc;
  80.  
  81.     rc = udebug_regs_read(app_phone, thread_hash, buffer);
  82.     printf("udebug_regs_read -> %d\n", rc);
  83.     printf("EIP was 0x%08x\n", buffer[ISTATE_OFF_EIP]);
  84.     int brk_addr = buffer[ISTATE_OFF_EIP] - 1;
  85.     int bi;
  86.     for (bi = 0; bi < MAX_BRKPTS; bi++) {
  87.         if (brk_list[bi].set && brk_list[bi].addr == brk_addr)
  88.             break;
  89.     }
  90.  
  91.     if (bi < MAX_BRKPTS) {
  92.         printf("breakpoint %d hit\n", bi);
  93.         breakpoint_hit();
  94.  
  95.         buffer[ISTATE_OFF_EIP] = brk_addr;
  96.         buffer[ISTATE_OFF_EFLAGS] |= 0x0100; /* trap flag */
  97.         printf("setting EIP to 0x%08x\n", buffer[ISTATE_OFF_EIP]);
  98.         rc = udebug_regs_write(app_phone, thread_hash, buffer);
  99.             rc = udebug_mem_write(app_phone, &brk_list[bi].arch.back, brk_addr, 1);
  100.         printf("udebug_mem_write(phone, 0x%x, 0x%02x, 1) -> %d\n", brk_addr, brk_list[bi].arch.back, rc);
  101.         lifted_brkpt = &brk_list[bi];
  102.     } else {
  103.         printf("unrecognized breakpoint at 0x%x\n", brk_addr);
  104.     }
  105. }
  106.  
  107. void arch_event_trap(thash_t thread_hash)
  108. {
  109.     unsigned char brkinstr[1];
  110.     int rc;
  111.  
  112.     printf("trap event\n");
  113.  
  114.     breakpoint_t *lb = lifted_brkpt;
  115.     brkinstr[0] = OPCODE_INT3;
  116.     rc = udebug_mem_write(app_phone, brkinstr, lb->addr, 1);
  117.     printf("restore breakpoint -> %d\n", rc);
  118.  
  119.     rc = udebug_regs_read(app_phone, thread_hash, buffer);
  120.     printf("udebug_regs_read -> %d\n", rc);
  121.     buffer[ISTATE_OFF_EFLAGS] &= ~0x0100; /* trap flag */
  122.     rc = udebug_regs_write(app_phone, thread_hash, buffer);
  123. }
  124.  
  125. /** @}
  126.  */
  127.