Rev 2946 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2946 | Rev 3100 | ||
---|---|---|---|
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 | arch_dthread_initialize(dt); |
|
- | 65 | ||
64 | if (!cwt) cwt = dt; |
66 | if (!cwt) cwt = dt; |
65 | 67 | ||
66 | list_append(&dt->link, &dthreads); |
68 | list_append(&dt->link, &dthreads); |
67 | 69 | ||
68 | return dt; |
70 | return dt; |
69 | } |
71 | } |
70 | 72 | ||
71 | void dthread_delete(dthread_t *dt) |
73 | void dthread_delete(dthread_t *dt) |
72 | { |
74 | { |
73 | list_remove(&dt->link); |
75 | list_remove(&dt->link); |
74 | free(dt); |
76 | free(dt); |
75 | } |
77 | } |
76 | 78 | ||
77 | /* |
79 | /* |
78 | * Get dthread struct serviced by fibril fid. |
80 | * Get dthread struct serviced by fibril fid. |
79 | */ |
81 | */ |
80 | dthread_t *dthread_get_by_fid(fid_t fid) |
82 | dthread_t *dthread_get_by_fid(fid_t fid) |
81 | { |
83 | { |
82 | link_t *cur; |
84 | link_t *cur; |
83 | dthread_t *dt; |
85 | dthread_t *dt; |
84 | 86 | ||
85 | dt = NULL; |
87 | dt = NULL; |
86 | for (cur = dthreads.next; cur != &dthreads; cur = cur->next) { |
88 | for (cur = dthreads.next; cur != &dthreads; cur = cur->next) { |
87 | dt = list_get_instance(cur, dthread_t, link); |
89 | dt = list_get_instance(cur, dthread_t, link); |
88 | if (dt->fid == fid) return dt; |
90 | if (dt->fid == fid) return dt; |
89 | } |
91 | } |
90 | 92 | ||
91 | return NULL; |
93 | return NULL; |
92 | } |
94 | } |
93 | 95 | ||
94 | /* |
96 | /* |
95 | * Get dthread struct for dthread serviced by the current fibril. |
97 | * Get dthread struct for dthread serviced by the current fibril. |
96 | */ |
98 | */ |
97 | dthread_t *dthread_get(void) |
99 | dthread_t *dthread_get(void) |
98 | { |
100 | { |
99 | return dthread_get_by_fid(fibril_get_id()); |
101 | return dthread_get_by_fid(fibril_get_id()); |
100 | } |
102 | } |
101 | 103 | ||
102 | void dthread_stop_me(void) |
104 | void dthread_stop_me(void) |
103 | { |
105 | { |
104 | dthread_t *dt; |
106 | dthread_t *dt; |
105 | 107 | ||
106 | dt = dthread_get(); |
108 | dt = dthread_get(); |
107 | assert(dt); |
109 | assert(dt); |
108 | 110 | ||
109 | futex_down(&async_futex); |
111 | futex_down(&async_futex); |
110 | 112 | ||
111 | dt->stopped = 1; |
113 | dt->stopped = 1; |
112 | fibril_switch(FIBRIL_TO_MANAGER); |
114 | fibril_switch(FIBRIL_TO_MANAGER); |
113 | 115 | ||
114 | futex_up(&async_futex); |
116 | futex_up(&async_futex); |
115 | } |
117 | } |
116 | 118 | ||
117 | void dthread_resume(dthread_t *dt) |
119 | void dthread_resume(dthread_t *dt) |
118 | { |
120 | { |
119 | if (!dt->stopped) return; |
121 | if (!dt->stopped) return; |
120 | 122 | ||
121 | futex_down(&async_futex); |
123 | futex_down(&async_futex); |
122 | 124 | ||
123 | fibril_add_ready(dt->fid); |
125 | fibril_add_ready(dt->fid); |
124 | dt->stopped = 0; |
126 | dt->stopped = 0; |
125 | 127 | ||
126 | futex_up(&async_futex); |
128 | futex_up(&async_futex); |
127 | } |
129 | } |
128 | 130 | ||
129 | unsigned dthread_get_pc(dthread_t *dt) |
131 | unsigned dthread_get_pc(dthread_t *dt) |
130 | { |
132 | { |
131 | static istate_t istate; |
133 | static istate_t istate; |
132 | int rc; |
134 | int rc; |
133 | 135 | ||
134 | rc = udebug_regs_read(app_phone, dt->hash, &istate); |
136 | rc = udebug_regs_read(app_phone, dt->hash, &istate); |
135 | if (rc < 0) { |
137 | if (rc < 0) { |
136 | printf("failed reading registers (%d)\n", rc); |
138 | printf("failed reading registers (%d)\n", rc); |
137 | return 0; |
139 | return 0; |
138 | } |
140 | } |
139 | 141 | ||
140 | return istate_get_pc(&istate); |
142 | return istate_get_pc(&istate); |
141 | } |
143 | } |
142 | 144 | ||
143 | /** @} |
145 | /** @} |
144 | */ |
146 | */ |
145 | 147 |