Rev 2940 | Rev 2946 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2940 | Rev 2941 | ||
---|---|---|---|
1 | /* |
1 | /* |
2 | * Copyright (c) 2008 Jiri Svoboda |
2 | * Copyright (c) 2008 Jiri Svoboda |
3 | * All rights reserved. |
3 | * All rights reserved. |
4 | * |
4 | * |
5 | * Redistribution and use in source and binary forms, with or without |
5 | * Redistribution and use in source and binary forms, with or without |
6 | * modification, are permitted provided that the following conditions |
6 | * modification, are permitted provided that the following conditions |
7 | * are met: |
7 | * are met: |
8 | * |
8 | * |
9 | * - Redistributions of source code must retain the above copyright |
9 | * - Redistributions of source code must retain the above copyright |
10 | * notice, this list of conditions and the following disclaimer. |
10 | * notice, this list of conditions and the following disclaimer. |
11 | * - Redistributions in binary form must reproduce the above copyright |
11 | * - Redistributions in binary form must reproduce the above copyright |
12 | * notice, this list of conditions and the following disclaimer in the |
12 | * notice, this list of conditions and the following disclaimer in the |
13 | * documentation and/or other materials provided with the distribution. |
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 |
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. |
15 | * derived from this software without specific prior written permission. |
16 | * |
16 | * |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
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 |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
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 |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
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 |
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. |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
27 | */ |
27 | */ |
28 | 28 | ||
29 | /** @addtogroup debug |
29 | /** @addtogroup debug |
30 | * @{ |
30 | * @{ |
31 | */ |
31 | */ |
32 | /** @file |
32 | /** @file |
33 | */ |
33 | */ |
34 | 34 | ||
35 | #include <stdlib.h> |
35 | #include <stdlib.h> |
36 | #include <libadt/list.h> |
36 | #include <libadt/list.h> |
37 | #include <assert.h> |
37 | #include <assert.h> |
38 | #include <futex.h> |
38 | #include <futex.h> |
39 | #include <async.h> |
39 | #include <async.h> |
40 | 40 | ||
41 | #include "include/arch.h" |
41 | #include "include/arch.h" |
42 | #include "main.h" |
42 | #include "main.h" |
43 | #include "dthread.h" |
43 | #include "dthread.h" |
44 | 44 | ||
45 | static int last_thread_id = 0; |
45 | static int last_thread_id = 0; |
46 | 46 | ||
47 | link_t dthreads; /* List of application's threads */ |
47 | link_t dthreads; /* List of application's threads */ |
48 | dthread_t *cwt; /* Current working thread */ |
48 | dthread_t *cwt; /* Current working thread */ |
49 | 49 | ||
50 | dthread_t *dthread_new(thash_t hash) |
50 | dthread_t *dthread_new(thash_t hash) |
51 | { |
51 | { |
52 | dthread_t *dt; |
52 | dthread_t *dt; |
53 | 53 | ||
54 | dt = malloc(sizeof(dthread_t)); |
54 | dt = malloc(sizeof(dthread_t)); |
55 | if (!dt) { |
55 | if (!dt) { |
56 | exit(1); |
56 | exit(1); |
57 | } |
57 | } |
58 | 58 | ||
59 | dt->id = ++last_thread_id; |
59 | dt->id = ++last_thread_id; |
60 | dt->hash = hash; |
60 | dt->hash = hash; |
61 | dt->fid = 0; |
61 | dt->fid = 0; |
62 | dt->stopped = 0; |
62 | dt->stopped = 0; |
63 | 63 | ||
64 | if (!cwt) cwt = dt; |
64 | if (!cwt) cwt = dt; |
65 | 65 | ||
66 | list_append(&dt->link, &dthreads); |
66 | list_append(&dt->link, &dthreads); |
67 | 67 | ||
68 | return dt; |
68 | return dt; |
69 | } |
69 | } |
70 | 70 | ||
71 | void dthread_delete(dthread_t *dt) |
71 | void dthread_delete(dthread_t *dt) |
72 | { |
72 | { |
73 | list_remove(&dt->link); |
73 | list_remove(&dt->link); |
74 | free(dt); |
74 | free(dt); |
75 | } |
75 | } |
76 | 76 | ||
77 | /* |
77 | /* |
78 | * Get dthread struct serviced by fibril fid. |
78 | * Get dthread struct serviced by fibril fid. |
79 | */ |
79 | */ |
80 | dthread_t *dthread_get_by_fid(fid_t fid) |
80 | dthread_t *dthread_get_by_fid(fid_t fid) |
81 | { |
81 | { |
82 | link_t *cur; |
82 | link_t *cur; |
83 | dthread_t *dt; |
83 | dthread_t *dt; |
84 | 84 | ||
85 | dt = NULL; |
85 | dt = NULL; |
86 | for (cur = dthreads.next; cur != &dthreads; cur = cur->next) { |
86 | for (cur = dthreads.next; cur != &dthreads; cur = cur->next) { |
87 | dt = list_get_instance(cur, dthread_t, link); |
87 | dt = list_get_instance(cur, dthread_t, link); |
88 | if (dt->fid == fid) return dt; |
88 | if (dt->fid == fid) return dt; |
89 | } |
89 | } |
90 | 90 | ||
91 | return NULL; |
91 | return NULL; |
92 | } |
92 | } |
93 | 93 | ||
94 | /* |
94 | /* |
95 | * Get dthread struct for dthread serviced by the current fibril. |
95 | * Get dthread struct for dthread serviced by the current fibril. |
96 | */ |
96 | */ |
97 | dthread_t *dthread_get(void) |
97 | dthread_t *dthread_get(void) |
98 | { |
98 | { |
99 | return dthread_get_by_fid(fibril_get_id()); |
99 | return dthread_get_by_fid(fibril_get_id()); |
100 | } |
100 | } |
101 | 101 | ||
102 | void dthread_stop_me(void) |
102 | void dthread_stop_me(void) |
103 | { |
103 | { |
104 | dthread_t *dt; |
104 | dthread_t *dt; |
105 | int i; |
105 | int i; |
106 | 106 | ||
107 | dt = dthread_get(); |
107 | dt = dthread_get(); |
108 | assert(dt); |
108 | assert(dt); |
109 | 109 | ||
110 | futex_down(&async_futex); |
110 | futex_down(&async_futex); |
111 | 111 | ||
112 | dt->stopped = 1; |
112 | dt->stopped = 1; |
113 | fibril_switch(FIBRIL_TO_MANAGER); |
113 | fibril_switch(FIBRIL_TO_MANAGER); |
114 | 114 | ||
115 | futex_up(&async_futex); |
115 | futex_up(&async_futex); |
116 | } |
116 | } |
117 | 117 | ||
118 | void dthread_resume(dthread_t *dt) |
118 | void dthread_resume(dthread_t *dt) |
119 | { |
119 | { |
120 | if (!dt->stopped) return; |
120 | if (!dt->stopped) return; |
121 | 121 | ||
122 | futex_down(&async_futex); |
122 | futex_down(&async_futex); |
123 | 123 | ||
124 | fibril_add_ready(dt->fid); |
124 | fibril_add_ready(dt->fid); |
125 | dt->stopped = 0; |
125 | dt->stopped = 0; |
126 | 126 | ||
127 | futex_up(&async_futex); |
127 | futex_up(&async_futex); |
128 | } |
128 | } |
129 | 129 | ||
130 | unsigned dthread_get_pc(dthread_t *dt) |
130 | unsigned dthread_get_pc(dthread_t *dt) |
131 | { |
131 | { |
132 | static unsigned istate_buffer[1024]; |
132 | static istate_t istate; |
133 | int rc; |
133 | int rc; |
134 | 134 | ||
135 | rc = udebug_regs_read(app_phone, dt->hash, istate_buffer); |
135 | rc = udebug_regs_read(app_phone, dt->hash, &istate); |
136 | if (rc < 0) { |
136 | if (rc < 0) { |
137 | printf("failed reading registers (%d)\n", rc); |
137 | printf("failed reading registers (%d)\n", rc); |
138 | return 0; |
138 | return 0; |
139 | } |
139 | } |
140 | 140 | ||
141 | return istate_get_pc(istate_buffer); |
141 | return istate_get_pc(&istate); |
142 | } |
142 | } |
143 | 143 | ||
144 | /** @} |
144 | /** @} |
145 | */ |
145 | */ |
146 | 146 |