Subversion Repositories HelenOS

Rev

Rev 3093 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
2923 svoboda 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>
3093 svoboda 38
#include <bool.h>
2923 svoboda 39
#include <udebug.h>
40
 
2941 svoboda 41
#include <kernel/arch/context_offset.h>
42
 
2936 svoboda 43
#include "../../../cons.h"
2923 svoboda 44
#include "../../../main.h"
45
#include "../../../include/arch.h"
46
 
47
#define OPCODE_INT3     0xCC
48
 
3108 svoboda 49
void arch_dthread_initialize(dthread_t *dt)
50
{
51
    dt->arch.singlestep = false;
52
}
53
 
3093 svoboda 54
static int _set_trap_flag(dthread_t *dt, bool enable)
55
{
56
    static istate_t istate;
57
    int rc;
58
 
59
    rc = udebug_regs_read(app_phone, dt->hash, &istate);
3108 svoboda 60
    if (rc < 0) { printf("regs read failed\n"); return -1; }
3093 svoboda 61
 
62
    if (enable) istate.eflags |= 0x0100; /* trap flag */
63
    else if (!active_bkpt) istate.eflags &= ~0x0100; /* trap flag */
64
 
65
    rc = udebug_regs_write(app_phone, dt->hash, &istate);  
3108 svoboda 66
    if (rc < 0) { printf("regs write failed\n"); return -1; }
3093 svoboda 67
 
68
    return 0;
69
}
70
 
3005 svoboda 71
int arch_breakpoint_set(breakpoint_t *b)
2923 svoboda 72
{
73
    char brkp[1];
74
    int rc;
75
 
3005 svoboda 76
    rc = udebug_mem_read(app_phone, &b->arch.back, b->addr, 1);
77
    cons_printf("udebug_mem_read() -> %d\n", rc);
78
    if (rc < 0) return rc;
2923 svoboda 79
 
3005 svoboda 80
    brkp[0] = OPCODE_INT3;
81
    rc = udebug_mem_write(app_phone, brkp, b->addr, 1);
82
    if (rc < 0) return rc;
2923 svoboda 83
 
2936 svoboda 84
    cons_printf("udebug_mem_write() -> %d\n", rc);
3005 svoboda 85
    return 0;
2923 svoboda 86
}
87
 
3005 svoboda 88
int arch_breakpoint_remove(breakpoint_t *b)
2943 svoboda 89
{
90
    int rc;
2923 svoboda 91
 
3005 svoboda 92
    if (b->active) {
93
        active_bkpt = NULL;
2943 svoboda 94
    } else {
3005 svoboda 95
            rc = udebug_mem_write(app_phone, &b->arch.back, b->addr, 1);
96
        if (rc < 0) {
97
            cons_printf("error writing mem\n");
98
            return rc;
99
        }
2943 svoboda 100
    }
101
 
3005 svoboda 102
    return 0;
2943 svoboda 103
}
104
 
2923 svoboda 105
void arch_event_breakpoint(thash_t thread_hash)
106
{
2942 svoboda 107
    static istate_t istate;
3005 svoboda 108
    breakpoint_t *b;
2923 svoboda 109
    int rc;
110
 
2941 svoboda 111
    rc = udebug_regs_read(app_phone, thread_hash, &istate);
2942 svoboda 112
//  cons_printf("udebug_regs_read -> %d\n", rc);
113
//  cons_printf("EIP was 0x%08x\n", istate.eip);
2941 svoboda 114
    int brk_addr = istate.eip - 1;
3005 svoboda 115
 
116
    b = breakpoint_find_by_addr(brk_addr);
117
    if (!b) {
118
        cons_printf("unrecognized breakpoint at 0x%x\n", brk_addr);
119
        return;
2923 svoboda 120
    }
2924 svoboda 121
 
3005 svoboda 122
    istate.eip = brk_addr;
123
    istate.eflags |= 0x0100; /* trap flag */
2924 svoboda 124
 
3005 svoboda 125
    rc = udebug_regs_write(app_phone, thread_hash, &istate);
126
    if (rc < 0) { cons_printf("error writing regs\n"); return; }
127
        rc = udebug_mem_write(app_phone, &b->arch.back, brk_addr, 1);
128
    if (rc < 0) { cons_printf("error writing mem\n"); return; }
2942 svoboda 129
//      cons_printf("udebug_mem_write(phone, 0x%x, 0x%02x, 1) -> %d\n", brk_addr, brk_list[bi].arch.back, rc);
130
 
3005 svoboda 131
    b->active = true;
132
    active_bkpt = b;
133
 
134
    breakpoint_hit(b);
2923 svoboda 135
}
136
 
2942 svoboda 137
void arch_event_trap(dthread_t *dt)
2923 svoboda 138
{
3005 svoboda 139
    breakpoint_t *b;
2942 svoboda 140
    static istate_t istate;
2923 svoboda 141
    unsigned char brkinstr[1];
142
    int rc;
143
 
2942 svoboda 144
//  cons_printf("trap event\n");
3005 svoboda 145
    b = active_bkpt;
146
 
147
    if (b) {
2942 svoboda 148
        brkinstr[0] = OPCODE_INT3;
3005 svoboda 149
        rc = udebug_mem_write(app_phone, brkinstr, b->addr, 1);
2942 svoboda 150
//      cons_printf("restore breakpoint -> %d\n", rc);
3005 svoboda 151
        active_bkpt = NULL;
2942 svoboda 152
    }
2923 svoboda 153
 
3093 svoboda 154
    rc = _set_trap_flag(dt, false);
155
    dt->arch.singlestep = false;
156
 
157
    singlestep_hit();
2923 svoboda 158
}
159
 
2941 svoboda 160
void arch_dump_regs(thash_t thash)
161
{
2942 svoboda 162
    static istate_t istate;
2941 svoboda 163
    int rc;
164
 
165
    rc = udebug_regs_read(app_phone, thash, &istate);
166
    if (rc < 0) { cons_printf("Error reading regs\n"); return; }
167
 
168
    cons_printf(
169
        "eip:%08x eflags:%08x eax:%08x ebx:%08x ecx:%08x edx:%08x\n"
170
        "esi:%08x edi:%08x cs:%04x ds:%04x es:%04x fs:%04x gs:%04x\n",
171
        istate.eip, istate.eflags, istate.eax, istate.ebx,
172
        istate.ecx, istate.edx, istate.esi, istate.edi, istate.cs,
173
        istate.ds, istate.es, istate.fs, istate.gs);
174
}
175
 
3093 svoboda 176
void arch_singlestep(dthread_t *dt)
2942 svoboda 177
{
178
    int rc;
179
 
3093 svoboda 180
    rc = _set_trap_flag(dt, true);
181
    if (rc != 0) return;
2942 svoboda 182
 
3093 svoboda 183
    dthread_resume(dt);
2942 svoboda 184
}
185
 
2923 svoboda 186
/** @}
187
 */