Rev 2812 | Rev 2892 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2812 | Rev 2813 | ||
---|---|---|---|
1 | /* |
1 | /* |
2 | * Copyright (c) 2006 Ondrej Palkovsky |
2 | * Copyright (c) 2006 Ondrej Palkovsky |
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 genericipc |
29 | /** @addtogroup genericipc |
30 | * @{ |
30 | * @{ |
31 | */ |
31 | */ |
32 | /** @file |
32 | /** @file |
33 | */ |
33 | */ |
34 | 34 | ||
35 | #include <arch.h> |
35 | #include <arch.h> |
36 | #include <proc/task.h> |
36 | #include <proc/task.h> |
37 | #include <proc/thread.h> |
37 | #include <proc/thread.h> |
38 | #include <errno.h> |
38 | #include <errno.h> |
39 | #include <memstr.h> |
39 | #include <memstr.h> |
40 | #include <debug.h> |
40 | #include <debug.h> |
41 | #include <ipc/ipc.h> |
41 | #include <ipc/ipc.h> |
42 | #include <ipc/sysipc.h> |
42 | #include <ipc/sysipc.h> |
43 | #include <ipc/irq.h> |
43 | #include <ipc/irq.h> |
44 | #include <ipc/ipcrsc.h> |
44 | #include <ipc/ipcrsc.h> |
- | 45 | #include <udebug/udebug_ipc.h> |
|
45 | #include <arch/interrupt.h> |
46 | #include <arch/interrupt.h> |
46 | #include <print.h> |
47 | #include <print.h> |
47 | #include <syscall/copy.h> |
48 | #include <syscall/copy.h> |
48 | #include <security/cap.h> |
49 | #include <security/cap.h> |
49 | #include <mm/as.h> |
50 | #include <mm/as.h> |
50 | #include <print.h> |
51 | #include <print.h> |
51 | 52 | ||
52 | /** |
53 | /** |
53 | * Maximum buffer size allowed for IPC_M_DATA_WRITE and IPC_M_DATA_READ |
54 | * Maximum buffer size allowed for IPC_M_DATA_WRITE and IPC_M_DATA_READ |
54 | * requests. |
55 | * requests. |
55 | */ |
56 | */ |
56 | #define DATA_XFER_LIMIT (64 * 1024) |
57 | #define DATA_XFER_LIMIT (64 * 1024) |
57 | 58 | ||
58 | #define GET_CHECK_PHONE(phone, phoneid, err) \ |
59 | #define GET_CHECK_PHONE(phone, phoneid, err) \ |
59 | { \ |
60 | { \ |
60 | if (phoneid > IPC_MAX_PHONES) { \ |
61 | if (phoneid > IPC_MAX_PHONES) { \ |
61 | err; \ |
62 | err; \ |
62 | } \ |
63 | } \ |
63 | phone = &TASK->phones[phoneid]; \ |
64 | phone = &TASK->phones[phoneid]; \ |
64 | } |
65 | } |
65 | 66 | ||
66 | #define STRUCT_TO_USPACE(dst, src) copy_to_uspace(dst, src, sizeof(*(src))) |
67 | #define STRUCT_TO_USPACE(dst, src) copy_to_uspace(dst, src, sizeof(*(src))) |
67 | 68 | ||
68 | /** Decide if the method is a system method. |
69 | /** Decide if the method is a system method. |
69 | * |
70 | * |
70 | * @param method Method to be decided. |
71 | * @param method Method to be decided. |
71 | * |
72 | * |
72 | * @return Return 1 if the method is a system method. |
73 | * @return Return 1 if the method is a system method. |
73 | * Otherwise return 0. |
74 | * Otherwise return 0. |
74 | */ |
75 | */ |
75 | static inline int method_is_system(unative_t method) |
76 | static inline int method_is_system(unative_t method) |
76 | { |
77 | { |
77 | if (method <= IPC_M_LAST_SYSTEM) |
78 | if (method <= IPC_M_LAST_SYSTEM) |
78 | return 1; |
79 | return 1; |
79 | return 0; |
80 | return 0; |
80 | } |
81 | } |
81 | 82 | ||
82 | /** Decide if the message with this method is forwardable. |
83 | /** Decide if the message with this method is forwardable. |
83 | * |
84 | * |
84 | * - some system messages may be forwarded, for some of them |
85 | * - some system messages may be forwarded, for some of them |
85 | * it is useless |
86 | * it is useless |
86 | * |
87 | * |
87 | * @param method Method to be decided. |
88 | * @param method Method to be decided. |
88 | * |
89 | * |
89 | * @return Return 1 if the method is forwardable. |
90 | * @return Return 1 if the method is forwardable. |
90 | * Otherwise return 0. |
91 | * Otherwise return 0. |
91 | */ |
92 | */ |
92 | static inline int method_is_forwardable(unative_t method) |
93 | static inline int method_is_forwardable(unative_t method) |
93 | { |
94 | { |
94 | switch (method) { |
95 | switch (method) { |
95 | case IPC_M_PHONE_HUNGUP: |
96 | case IPC_M_PHONE_HUNGUP: |
96 | /* This message is meant only for the original recipient. */ |
97 | /* This message is meant only for the original recipient. */ |
97 | return 0; |
98 | return 0; |
98 | default: |
99 | default: |
99 | return 1; |
100 | return 1; |
100 | } |
101 | } |
101 | } |
102 | } |
102 | 103 | ||
103 | /** Decide if the message with this method is immutable on forward. |
104 | /** Decide if the message with this method is immutable on forward. |
104 | * |
105 | * |
105 | * - some system messages may be forwarded but their content cannot be altered |
106 | * - some system messages may be forwarded but their content cannot be altered |
106 | * |
107 | * |
107 | * @param method Method to be decided. |
108 | * @param method Method to be decided. |
108 | * |
109 | * |
109 | * @return Return 1 if the method is immutable on forward. |
110 | * @return Return 1 if the method is immutable on forward. |
110 | * Otherwise return 0. |
111 | * Otherwise return 0. |
111 | */ |
112 | */ |
112 | static inline int method_is_immutable(unative_t method) |
113 | static inline int method_is_immutable(unative_t method) |
113 | { |
114 | { |
114 | switch (method) { |
115 | switch (method) { |
115 | case IPC_M_SHARE_OUT: |
116 | case IPC_M_SHARE_OUT: |
116 | case IPC_M_SHARE_IN: |
117 | case IPC_M_SHARE_IN: |
117 | case IPC_M_DATA_WRITE: |
118 | case IPC_M_DATA_WRITE: |
118 | case IPC_M_DATA_READ: |
119 | case IPC_M_DATA_READ: |
119 | return 1; |
120 | return 1; |
120 | break; |
121 | break; |
121 | default: |
122 | default: |
122 | return 0; |
123 | return 0; |
123 | } |
124 | } |
124 | } |
125 | } |
125 | 126 | ||
126 | 127 | ||
127 | /*********************************************************************** |
128 | /*********************************************************************** |
128 | * Functions that preprocess answer before sending it to the recepient. |
129 | * Functions that preprocess answer before sending it to the recepient. |
129 | ***********************************************************************/ |
130 | ***********************************************************************/ |
130 | 131 | ||
131 | /** Decide if the caller (e.g. ipc_answer()) should save the old call contents |
132 | /** Decide if the caller (e.g. ipc_answer()) should save the old call contents |
132 | * for answer_preprocess(). |
133 | * for answer_preprocess(). |
133 | * |
134 | * |
134 | * @param call Call structure to be decided. |
135 | * @param call Call structure to be decided. |
135 | * |
136 | * |
136 | * @return Return 1 if the old call contents should be saved. |
137 | * @return Return 1 if the old call contents should be saved. |
137 | * Return 0 otherwise. |
138 | * Return 0 otherwise. |
138 | */ |
139 | */ |
139 | static inline int answer_need_old(call_t *call) |
140 | static inline int answer_need_old(call_t *call) |
140 | { |
141 | { |
141 | switch (IPC_GET_METHOD(call->data)) { |
142 | switch (IPC_GET_METHOD(call->data)) { |
142 | case IPC_M_CONNECT_TO_ME: |
143 | case IPC_M_CONNECT_TO_ME: |
143 | case IPC_M_CONNECT_ME_TO: |
144 | case IPC_M_CONNECT_ME_TO: |
144 | case IPC_M_SHARE_OUT: |
145 | case IPC_M_SHARE_OUT: |
145 | case IPC_M_SHARE_IN: |
146 | case IPC_M_SHARE_IN: |
146 | case IPC_M_DATA_WRITE: |
147 | case IPC_M_DATA_WRITE: |
147 | case IPC_M_DATA_READ: |
148 | case IPC_M_DATA_READ: |
148 | return 1; |
149 | return 1; |
149 | default: |
150 | default: |
150 | return 0; |
151 | return 0; |
151 | } |
152 | } |
152 | } |
153 | } |
153 | 154 | ||
154 | /** Interpret process answer as control information. |
155 | /** Interpret process answer as control information. |
155 | * |
156 | * |
156 | * This function is called directly after sys_ipc_answer(). |
157 | * This function is called directly after sys_ipc_answer(). |
157 | * |
158 | * |
158 | * @param answer Call structure with the answer. |
159 | * @param answer Call structure with the answer. |
159 | * @param olddata Saved data of the request. |
160 | * @param olddata Saved data of the request. |
160 | * |
161 | * |
161 | * @return Return 0 on success or an error code. |
162 | * @return Return 0 on success or an error code. |
162 | */ |
163 | */ |
163 | static inline int answer_preprocess(call_t *answer, ipc_data_t *olddata) |
164 | static inline int answer_preprocess(call_t *answer, ipc_data_t *olddata) |
164 | { |
165 | { |
165 | int phoneid; |
166 | int phoneid; |
166 | 167 | ||
167 | if ((native_t) IPC_GET_RETVAL(answer->data) == EHANGUP) { |
168 | if ((native_t) IPC_GET_RETVAL(answer->data) == EHANGUP) { |
168 | /* In case of forward, hangup the forwared phone, |
169 | /* In case of forward, hangup the forwared phone, |
169 | * not the originator |
170 | * not the originator |
170 | */ |
171 | */ |
171 | spinlock_lock(&answer->data.phone->lock); |
172 | spinlock_lock(&answer->data.phone->lock); |
172 | spinlock_lock(&TASK->answerbox.lock); |
173 | spinlock_lock(&TASK->answerbox.lock); |
173 | if (answer->data.phone->state == IPC_PHONE_CONNECTED) { |
174 | if (answer->data.phone->state == IPC_PHONE_CONNECTED) { |
174 | list_remove(&answer->data.phone->link); |
175 | list_remove(&answer->data.phone->link); |
175 | answer->data.phone->state = IPC_PHONE_SLAMMED; |
176 | answer->data.phone->state = IPC_PHONE_SLAMMED; |
176 | } |
177 | } |
177 | spinlock_unlock(&TASK->answerbox.lock); |
178 | spinlock_unlock(&TASK->answerbox.lock); |
178 | spinlock_unlock(&answer->data.phone->lock); |
179 | spinlock_unlock(&answer->data.phone->lock); |
179 | } |
180 | } |
180 | 181 | ||
181 | if (!olddata) |
182 | if (!olddata) |
182 | return 0; |
183 | return 0; |
183 | 184 | ||
184 | if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) { |
185 | if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) { |
185 | phoneid = IPC_GET_ARG5(*olddata); |
186 | phoneid = IPC_GET_ARG5(*olddata); |
186 | if (IPC_GET_RETVAL(answer->data)) { |
187 | if (IPC_GET_RETVAL(answer->data)) { |
187 | /* The connection was not accepted */ |
188 | /* The connection was not accepted */ |
188 | phone_dealloc(phoneid); |
189 | phone_dealloc(phoneid); |
189 | } else { |
190 | } else { |
190 | /* The connection was accepted */ |
191 | /* The connection was accepted */ |
191 | phone_connect(phoneid, &answer->sender->answerbox); |
192 | phone_connect(phoneid, &answer->sender->answerbox); |
192 | /* Set 'phone hash' as arg5 of response */ |
193 | /* Set 'phone hash' as arg5 of response */ |
193 | IPC_SET_ARG5(answer->data, |
194 | IPC_SET_ARG5(answer->data, |
194 | (unative_t) &TASK->phones[phoneid]); |
195 | (unative_t) &TASK->phones[phoneid]); |
195 | } |
196 | } |
196 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) { |
197 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) { |
197 | /* If the users accepted call, connect */ |
198 | /* If the users accepted call, connect */ |
198 | if (!IPC_GET_RETVAL(answer->data)) { |
199 | if (!IPC_GET_RETVAL(answer->data)) { |
199 | ipc_phone_connect((phone_t *) IPC_GET_ARG5(*olddata), |
200 | ipc_phone_connect((phone_t *) IPC_GET_ARG5(*olddata), |
200 | &TASK->answerbox); |
201 | &TASK->answerbox); |
201 | } |
202 | } |
202 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_OUT) { |
203 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_OUT) { |
203 | if (!IPC_GET_RETVAL(answer->data)) { |
204 | if (!IPC_GET_RETVAL(answer->data)) { |
204 | /* Accepted, handle as_area receipt */ |
205 | /* Accepted, handle as_area receipt */ |
205 | ipl_t ipl; |
206 | ipl_t ipl; |
206 | int rc; |
207 | int rc; |
207 | as_t *as; |
208 | as_t *as; |
208 | 209 | ||
209 | ipl = interrupts_disable(); |
210 | ipl = interrupts_disable(); |
210 | spinlock_lock(&answer->sender->lock); |
211 | spinlock_lock(&answer->sender->lock); |
211 | as = answer->sender->as; |
212 | as = answer->sender->as; |
212 | spinlock_unlock(&answer->sender->lock); |
213 | spinlock_unlock(&answer->sender->lock); |
213 | interrupts_restore(ipl); |
214 | interrupts_restore(ipl); |
214 | 215 | ||
215 | rc = as_area_share(as, IPC_GET_ARG1(*olddata), |
216 | rc = as_area_share(as, IPC_GET_ARG1(*olddata), |
216 | IPC_GET_ARG2(*olddata), AS, |
217 | IPC_GET_ARG2(*olddata), AS, |
217 | IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata)); |
218 | IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata)); |
218 | IPC_SET_RETVAL(answer->data, rc); |
219 | IPC_SET_RETVAL(answer->data, rc); |
219 | return rc; |
220 | return rc; |
220 | } |
221 | } |
221 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_IN) { |
222 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_IN) { |
222 | if (!IPC_GET_RETVAL(answer->data)) { |
223 | if (!IPC_GET_RETVAL(answer->data)) { |
223 | ipl_t ipl; |
224 | ipl_t ipl; |
224 | as_t *as; |
225 | as_t *as; |
225 | int rc; |
226 | int rc; |
226 | 227 | ||
227 | ipl = interrupts_disable(); |
228 | ipl = interrupts_disable(); |
228 | spinlock_lock(&answer->sender->lock); |
229 | spinlock_lock(&answer->sender->lock); |
229 | as = answer->sender->as; |
230 | as = answer->sender->as; |
230 | spinlock_unlock(&answer->sender->lock); |
231 | spinlock_unlock(&answer->sender->lock); |
231 | interrupts_restore(ipl); |
232 | interrupts_restore(ipl); |
232 | 233 | ||
233 | rc = as_area_share(AS, IPC_GET_ARG1(answer->data), |
234 | rc = as_area_share(AS, IPC_GET_ARG1(answer->data), |
234 | IPC_GET_ARG2(*olddata), as, IPC_GET_ARG1(*olddata), |
235 | IPC_GET_ARG2(*olddata), as, IPC_GET_ARG1(*olddata), |
235 | IPC_GET_ARG2(answer->data)); |
236 | IPC_GET_ARG2(answer->data)); |
236 | IPC_SET_RETVAL(answer->data, rc); |
237 | IPC_SET_RETVAL(answer->data, rc); |
237 | } |
238 | } |
238 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_READ) { |
239 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_READ) { |
239 | ASSERT(!answer->buffer); |
240 | ASSERT(!answer->buffer); |
240 | if (!IPC_GET_RETVAL(answer->data)) { |
241 | if (!IPC_GET_RETVAL(answer->data)) { |
241 | /* The recipient agreed to send data. */ |
242 | /* The recipient agreed to send data. */ |
242 | uintptr_t src = IPC_GET_ARG1(answer->data); |
243 | uintptr_t src = IPC_GET_ARG1(answer->data); |
243 | uintptr_t dst = IPC_GET_ARG1(*olddata); |
244 | uintptr_t dst = IPC_GET_ARG1(*olddata); |
244 | size_t max_size = IPC_GET_ARG2(*olddata); |
245 | size_t max_size = IPC_GET_ARG2(*olddata); |
245 | size_t size = IPC_GET_ARG2(answer->data); |
246 | size_t size = IPC_GET_ARG2(answer->data); |
246 | if (size <= max_size) { |
247 | if (size <= max_size) { |
247 | /* |
248 | /* |
248 | * Copy the destination VA so that this piece of |
249 | * Copy the destination VA so that this piece of |
249 | * information is not lost. |
250 | * information is not lost. |
250 | */ |
251 | */ |
251 | IPC_SET_ARG1(answer->data, dst); |
252 | IPC_SET_ARG1(answer->data, dst); |
252 | 253 | ||
253 | answer->buffer = malloc(size, 0); |
254 | answer->buffer = malloc(size, 0); |
254 | int rc = copy_from_uspace(answer->buffer, |
255 | int rc = copy_from_uspace(answer->buffer, |
255 | (void *) src, size); |
256 | (void *) src, size); |
256 | if (rc) { |
257 | if (rc) { |
257 | IPC_SET_RETVAL(answer->data, rc); |
258 | IPC_SET_RETVAL(answer->data, rc); |
258 | free(answer->buffer); |
259 | free(answer->buffer); |
259 | answer->buffer = NULL; |
260 | answer->buffer = NULL; |
260 | } |
261 | } |
261 | } else { |
262 | } else { |
262 | IPC_SET_RETVAL(answer->data, ELIMIT); |
263 | IPC_SET_RETVAL(answer->data, ELIMIT); |
263 | } |
264 | } |
264 | } |
265 | } |
265 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_WRITE) { |
266 | } else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_WRITE) { |
266 | ASSERT(answer->buffer); |
267 | ASSERT(answer->buffer); |
267 | if (!IPC_GET_RETVAL(answer->data)) { |
268 | if (!IPC_GET_RETVAL(answer->data)) { |
268 | /* The recipient agreed to receive data. */ |
269 | /* The recipient agreed to receive data. */ |
269 | int rc; |
270 | int rc; |
270 | uintptr_t dst; |
271 | uintptr_t dst; |
271 | uintptr_t size; |
272 | uintptr_t size; |
272 | uintptr_t max_size; |
273 | uintptr_t max_size; |
273 | 274 | ||
274 | dst = IPC_GET_ARG1(answer->data); |
275 | dst = IPC_GET_ARG1(answer->data); |
275 | size = IPC_GET_ARG2(answer->data); |
276 | size = IPC_GET_ARG2(answer->data); |
276 | max_size = IPC_GET_ARG2(*olddata); |
277 | max_size = IPC_GET_ARG2(*olddata); |
277 | 278 | ||
278 | if (size <= max_size) { |
279 | if (size <= max_size) { |
279 | rc = copy_to_uspace((void *) dst, |
280 | rc = copy_to_uspace((void *) dst, |
280 | answer->buffer, size); |
281 | answer->buffer, size); |
281 | if (rc) |
282 | if (rc) |
282 | IPC_SET_RETVAL(answer->data, rc); |
283 | IPC_SET_RETVAL(answer->data, rc); |
283 | } else { |
284 | } else { |
284 | IPC_SET_RETVAL(answer->data, ELIMIT); |
285 | IPC_SET_RETVAL(answer->data, ELIMIT); |
285 | } |
286 | } |
286 | } |
287 | } |
287 | free(answer->buffer); |
288 | free(answer->buffer); |
288 | answer->buffer = NULL; |
289 | answer->buffer = NULL; |
289 | } |
290 | } |
290 | return 0; |
291 | return 0; |
291 | } |
292 | } |
292 | 293 | ||
293 | static task_t *get_lock_callee_task(phone_t *phone) |
- | |
294 | { |
- | |
295 | answerbox_t *answerbox; |
- | |
296 | task_t *ta; |
- | |
297 | - | ||
298 | // FIXME: locking!!! |
- | |
299 | - | ||
300 | answerbox = phone->callee; |
- | |
301 | ta = answerbox->task; |
- | |
302 | - | ||
303 | spinlock_lock(&ta->lock); |
- | |
304 | - | ||
305 | return ta; |
- | |
306 | } |
- | |
307 | - | ||
308 | static thread_t *get_task_thread_by_id(task_t *ta, thread_id_t tid) |
- | |
309 | { |
- | |
310 | thread_t *t; |
- | |
311 | link_t *cur; |
- | |
312 | - | ||
313 | for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) { |
- | |
314 | t = list_get_instance(cur, thread_t, th_link); |
- | |
315 | if (tid == t->tid) return t; |
- | |
316 | } |
- | |
317 | - | ||
318 | return NULL; |
- | |
319 | } |
- | |
320 | - | ||
321 | #include <console/klog.h> |
- | |
322 | - | ||
323 | static int debug_begin(call_t *call, phone_t *phone) |
- | |
324 | { |
- | |
325 | task_t *ta; |
- | |
326 | - | ||
327 | klog_printf("debug_begin()"); |
- | |
328 | - | ||
329 | ta = get_lock_callee_task(phone); |
- | |
330 | klog_printf("debugging task %llu", ta->taskid); |
- | |
331 | - | ||
332 | if (ta->being_debugged != false) { |
- | |
333 | spinlock_unlock(&ta->lock); |
- | |
334 | klog_printf("debug_begin(): busy error"); |
- | |
335 | return EBUSY; |
- | |
336 | } |
- | |
337 | - | ||
338 | ta->being_debugged = true; |
- | |
339 | ta->stop_request = true; |
- | |
340 | ta->debug_begin_call = call; |
- | |
341 | - | ||
342 | if (ta->not_stoppable_count == 0) { |
- | |
343 | ta->debug_begin_call = NULL; |
- | |
344 | ta->stop_request = false; |
- | |
345 | spinlock_unlock(&ta->lock); |
- | |
346 | klog_printf("debug_begin(): immediate backsend"); |
- | |
347 | return 1; /* actually we need backsend with 0 retval */ |
- | |
348 | } |
- | |
349 | - | ||
350 | spinlock_unlock(&ta->lock); |
- | |
351 | - | ||
352 | klog_printf("debug_begin() done (wait for stoppability)"); |
- | |
353 | return 0; |
- | |
354 | } |
- | |
355 | - | ||
356 | static int debug_go(call_t *call, phone_t *phone) |
- | |
357 | { |
- | |
358 | thread_t *t; |
- | |
359 | task_t *ta; |
- | |
360 | - | ||
361 | klog_printf("debug_go()"); |
- | |
362 | ta = get_lock_callee_task(phone); |
- | |
363 | - | ||
364 | ta->debug_go_call = call; |
- | |
365 | t = get_task_thread_by_id(ta, IPC_GET_ARG2(call->data)); |
- | |
366 | if (t == NULL) { |
- | |
367 | spinlock_unlock(&ta->lock); |
- | |
368 | return ENOENT; |
- | |
369 | } |
- | |
370 | - | ||
371 | klog_printf("debug_go(): waitq_wakeup"); |
- | |
372 | waitq_wakeup(&t->go_wq, WAKEUP_FIRST); |
- | |
373 | - | ||
374 | spinlock_unlock(&ta->lock); |
- | |
375 | - | ||
376 | return 0; /* no backsend */ |
- | |
377 | } |
- | |
378 | - | ||
379 | static int debug_args_read(call_t *call, phone_t *phone) |
- | |
380 | { |
- | |
381 | thread_t *t; |
- | |
382 | task_t *ta; |
- | |
383 | void *uspace_buffer; |
- | |
384 | unative_t to_copy; |
- | |
385 | int rc; |
- | |
386 | - | ||
387 | klog_printf("debug_args_read()"); |
- | |
388 | // FIXME: verify task/thread state |
- | |
389 | - | ||
390 | ta = get_lock_callee_task(phone); |
- | |
391 | klog_printf("task %llu", ta->taskid); |
- | |
392 | t = get_task_thread_by_id(ta, IPC_GET_ARG2(call->data)); |
- | |
393 | if (t == NULL) { |
- | |
394 | spinlock_unlock(&ta->lock); |
- | |
395 | return ENOENT; |
- | |
396 | } |
- | |
397 | - | ||
398 | uspace_buffer = (void *)IPC_GET_ARG3(call->data); |
- | |
399 | to_copy = IPC_GET_ARG4(call->data); |
- | |
400 | if (to_copy > 6 * sizeof(unative_t)) to_copy = 6 * sizeof(unative_t); |
- | |
401 | - | ||
402 | rc = copy_to_uspace(uspace_buffer, t->syscall_args, to_copy); |
- | |
403 | if (rc != 0) { |
- | |
404 | spinlock_unlock(&ta->lock); |
- | |
405 | klog_printf("debug_args_read() - copy failed"); |
- | |
406 | return rc; |
- | |
407 | } |
- | |
408 | - | ||
409 | spinlock_unlock(&ta->lock); |
- | |
410 | - | ||
411 | IPC_SET_ARG1(call->data, to_copy); |
- | |
412 | - | ||
413 | klog_printf("debug_args_read() done"); |
- | |
414 | return 1; /* actually need becksend with retval 0 */ |
- | |
415 | } |
- | |
416 | - | ||
417 | static int debug_thread_read(call_t *call, phone_t *phone) |
- | |
418 | { |
- | |
419 | thread_t *t; |
- | |
420 | link_t *cur; |
- | |
421 | task_t *ta; |
- | |
422 | unative_t *uspace_buffer; |
- | |
423 | unative_t to_copy; |
- | |
424 | int rc; |
- | |
425 | unsigned copied, total; |
- | |
426 | unsigned buf_size; |
- | |
427 | unative_t tid; |
- | |
428 | - | ||
429 | klog_printf("debug_thread_read()"); |
- | |
430 | // FIXME: verify task/thread state |
- | |
431 | - | ||
432 | ta = get_lock_callee_task(phone); |
- | |
433 | klog_printf("task %llu", ta->taskid); |
- | |
434 | - | ||
435 | uspace_buffer = (void *)IPC_GET_ARG2(call->data); |
- | |
436 | buf_size = IPC_GET_ARG3(call->data); |
- | |
437 | - | ||
438 | copied = total = 0; |
- | |
439 | for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) { |
- | |
440 | t = list_get_instance(cur, thread_t, th_link); |
- | |
441 | - | ||
442 | /* Not interested in kernel threads */ |
- | |
443 | if ((t->flags & THREAD_FLAG_USPACE) == 0) |
- | |
444 | continue; |
- | |
445 | - | ||
446 | //FIXME: id cropped!! |
- | |
447 | tid = (unative_t) t->tid; |
- | |
448 | - | ||
449 | to_copy = sizeof(unative_t); |
- | |
450 | if (copied + to_copy >= buf_size) |
- | |
451 | to_copy = buf_size - copied; |
- | |
452 | - | ||
453 | if (to_copy > 0) { |
- | |
454 | rc = copy_to_uspace(uspace_buffer, &tid, to_copy); |
- | |
455 | if (rc != 0) { |
- | |
456 | spinlock_unlock(&ta->lock); |
- | |
457 | klog_printf("debug_thread_read() - copy failed"); |
- | |
458 | return rc; |
- | |
459 | } |
- | |
460 | } |
- | |
461 | - | ||
462 | ++uspace_buffer; |
- | |
463 | total += sizeof(unative_t); |
- | |
464 | copied += to_copy; |
- | |
465 | } |
- | |
466 | - | ||
467 | spinlock_unlock(&ta->lock); |
- | |
468 | - | ||
469 | IPC_SET_ARG1(call->data, copied); |
- | |
470 | IPC_SET_ARG2(call->data, total); |
- | |
471 | - | ||
472 | klog_printf("debug_thread_read() done"); |
- | |
473 | return 1; /* actually need becksend with retval 0 */ |
- | |
474 | } |
- | |
475 | - | ||
476 | #include <udebug.h> |
- | |
477 | - | ||
478 | static int debug_request_preprocess(call_t *call, phone_t *phone) |
- | |
479 | { |
- | |
480 | int rc; |
- | |
481 | - | ||
482 | switch (IPC_GET_ARG1(call->data)) { |
- | |
483 | case UDEBUG_M_BEGIN: |
- | |
484 | rc = debug_begin(call, phone); |
- | |
485 | return rc; |
- | |
486 | case UDEBUG_M_GO: |
- | |
487 | rc = debug_go(call, phone); |
- | |
488 | return rc; |
- | |
489 | case UDEBUG_M_ARGS_READ: |
- | |
490 | rc = debug_args_read(call, phone); |
- | |
491 | return rc; |
- | |
492 | case UDEBUG_M_THREAD_READ: |
- | |
493 | rc = debug_thread_read(call, phone); |
- | |
494 | return rc; |
- | |
495 | default: |
- | |
496 | break; |
- | |
497 | } |
- | |
498 | - | ||
499 | return 0; |
- | |
500 | } |
- | |
501 | - | ||
502 | /** Called before the request is sent. |
294 | /** Called before the request is sent. |
503 | * |
295 | * |
504 | * @param call Call structure with the request. |
296 | * @param call Call structure with the request. |
505 | * @param phone Phone that the call will be sent through. |
297 | * @param phone Phone that the call will be sent through. |
506 | * |
298 | * |
507 | * @return Return 0 on success, ELIMIT or EPERM on error. |
299 | * @return Return 0 on success, ELIMIT or EPERM on error. |
508 | */ |
300 | */ |
509 | static int request_preprocess(call_t *call, phone_t *phone) |
301 | static int request_preprocess(call_t *call, phone_t *phone) |
510 | { |
302 | { |
511 | int newphid; |
303 | int newphid; |
512 | size_t size; |
304 | size_t size; |
513 | uintptr_t src; |
305 | uintptr_t src; |
514 | int rc; |
306 | int rc; |
515 | 307 | ||
516 | switch (IPC_GET_METHOD(call->data)) { |
308 | switch (IPC_GET_METHOD(call->data)) { |
517 | case IPC_M_CONNECT_ME_TO: |
309 | case IPC_M_CONNECT_ME_TO: |
518 | newphid = phone_alloc(); |
310 | newphid = phone_alloc(); |
519 | if (newphid < 0) |
311 | if (newphid < 0) |
520 | return ELIMIT; |
312 | return ELIMIT; |
521 | /* Set arg5 for server */ |
313 | /* Set arg5 for server */ |
522 | IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]); |
314 | IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]); |
523 | call->flags |= IPC_CALL_CONN_ME_TO; |
315 | call->flags |= IPC_CALL_CONN_ME_TO; |
524 | call->priv = newphid; |
316 | call->priv = newphid; |
525 | break; |
317 | break; |
526 | case IPC_M_SHARE_OUT: |
318 | case IPC_M_SHARE_OUT: |
527 | size = as_area_get_size(IPC_GET_ARG1(call->data)); |
319 | size = as_area_get_size(IPC_GET_ARG1(call->data)); |
528 | if (!size) |
320 | if (!size) |
529 | return EPERM; |
321 | return EPERM; |
530 | IPC_SET_ARG2(call->data, size); |
322 | IPC_SET_ARG2(call->data, size); |
531 | break; |
323 | break; |
532 | case IPC_M_DATA_READ: |
324 | case IPC_M_DATA_READ: |
533 | size = IPC_GET_ARG2(call->data); |
325 | size = IPC_GET_ARG2(call->data); |
534 | if ((size <= 0 || (size > DATA_XFER_LIMIT))) |
326 | if ((size <= 0 || (size > DATA_XFER_LIMIT))) |
535 | return ELIMIT; |
327 | return ELIMIT; |
536 | break; |
328 | break; |
537 | case IPC_M_DATA_WRITE: |
329 | case IPC_M_DATA_WRITE: |
538 | src = IPC_GET_ARG1(call->data); |
330 | src = IPC_GET_ARG1(call->data); |
539 | size = IPC_GET_ARG2(call->data); |
331 | size = IPC_GET_ARG2(call->data); |
540 | 332 | ||
541 | if ((size <= 0) || (size > DATA_XFER_LIMIT)) |
333 | if ((size <= 0) || (size > DATA_XFER_LIMIT)) |
542 | return ELIMIT; |
334 | return ELIMIT; |
543 | 335 | ||
544 | call->buffer = (uint8_t *) malloc(size, 0); |
336 | call->buffer = (uint8_t *) malloc(size, 0); |
545 | rc = copy_from_uspace(call->buffer, (void *) src, size); |
337 | rc = copy_from_uspace(call->buffer, (void *) src, size); |
546 | if (rc != 0) { |
338 | if (rc != 0) { |
547 | free(call->buffer); |
339 | free(call->buffer); |
548 | return rc; |
340 | return rc; |
549 | } |
341 | } |
550 | break; |
342 | break; |
551 | case IPC_M_DEBUG_ALL: |
343 | case IPC_M_DEBUG_ALL: |
552 | /* actually need possibility of backsend with 0 result code */ |
344 | /* actually need possibility of backsend with 0 result code */ |
553 | rc = debug_request_preprocess(call, phone); |
345 | rc = udebug_request_preprocess(call, phone); |
554 | return rc; |
346 | return rc; |
555 | default: |
347 | default: |
556 | break; |
348 | break; |
557 | } |
349 | } |
558 | return 0; |
350 | return 0; |
559 | } |
351 | } |
560 | 352 | ||
561 | /******************************************************************************* |
353 | /******************************************************************************* |
562 | * Functions called to process received call/answer before passing it to uspace. |
354 | * Functions called to process received call/answer before passing it to uspace. |
563 | *******************************************************************************/ |
355 | *******************************************************************************/ |
564 | 356 | ||
565 | /** Do basic kernel processing of received call answer. |
357 | /** Do basic kernel processing of received call answer. |
566 | * |
358 | * |
567 | * @param call Call structure with the answer. |
359 | * @param call Call structure with the answer. |
568 | */ |
360 | */ |
569 | static void process_answer(call_t *call) |
361 | static void process_answer(call_t *call) |
570 | { |
362 | { |
571 | if (((native_t) IPC_GET_RETVAL(call->data) == EHANGUP) && |
363 | if (((native_t) IPC_GET_RETVAL(call->data) == EHANGUP) && |
572 | (call->flags & IPC_CALL_FORWARDED)) |
364 | (call->flags & IPC_CALL_FORWARDED)) |
573 | IPC_SET_RETVAL(call->data, EFORWARD); |
365 | IPC_SET_RETVAL(call->data, EFORWARD); |
574 | 366 | ||
575 | if (call->flags & IPC_CALL_CONN_ME_TO) { |
367 | if (call->flags & IPC_CALL_CONN_ME_TO) { |
576 | if (IPC_GET_RETVAL(call->data)) |
368 | if (IPC_GET_RETVAL(call->data)) |
577 | phone_dealloc(call->priv); |
369 | phone_dealloc(call->priv); |
578 | else |
370 | else |
579 | IPC_SET_ARG5(call->data, call->priv); |
371 | IPC_SET_ARG5(call->data, call->priv); |
580 | } |
372 | } |
581 | 373 | ||
582 | if (call->buffer) { |
374 | if (call->buffer) { |
583 | /* This must be an affirmative answer to IPC_M_DATA_READ. */ |
375 | /* This must be an affirmative answer to IPC_M_DATA_READ. */ |
584 | /* or IPC_M_DEBUG_ALL/UDEBUG_M_MEM_READ... */ |
376 | /* or IPC_M_DEBUG_ALL/UDEBUG_M_MEM_READ... */ |
585 | uintptr_t dst = IPC_GET_ARG1(call->data); |
377 | uintptr_t dst = IPC_GET_ARG1(call->data); |
586 | size_t size = IPC_GET_ARG2(call->data); |
378 | size_t size = IPC_GET_ARG2(call->data); |
587 | int rc = copy_to_uspace((void *) dst, call->buffer, size); |
379 | int rc = copy_to_uspace((void *) dst, call->buffer, size); |
588 | if (rc) |
380 | if (rc) |
589 | IPC_SET_RETVAL(call->data, rc); |
381 | IPC_SET_RETVAL(call->data, rc); |
590 | free(call->buffer); |
382 | free(call->buffer); |
591 | call->buffer = NULL; |
383 | call->buffer = NULL; |
592 | } |
384 | } |
593 | } |
385 | } |
594 | 386 | ||
595 | /** Do basic kernel processing of received call request. |
387 | /** Do basic kernel processing of received call request. |
596 | * |
388 | * |
597 | * @param box Destination answerbox structure. |
389 | * @param box Destination answerbox structure. |
598 | * @param call Call structure with the request. |
390 | * @param call Call structure with the request. |
599 | * |
391 | * |
600 | * @return Return 0 if the call should be passed to userspace. |
392 | * @return Return 0 if the call should be passed to userspace. |
601 | * Return -1 if the call should be ignored. |
393 | * Return -1 if the call should be ignored. |
602 | */ |
394 | */ |
603 | static int process_request(answerbox_t *box, call_t *call) |
395 | static int process_request(answerbox_t *box, call_t *call) |
604 | { |
396 | { |
605 | int phoneid; |
397 | int phoneid; |
606 | 398 | ||
607 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) { |
399 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) { |
608 | phoneid = phone_alloc(); |
400 | phoneid = phone_alloc(); |
609 | if (phoneid < 0) { /* Failed to allocate phone */ |
401 | if (phoneid < 0) { /* Failed to allocate phone */ |
610 | IPC_SET_RETVAL(call->data, ELIMIT); |
402 | IPC_SET_RETVAL(call->data, ELIMIT); |
611 | ipc_answer(box, call); |
403 | ipc_answer(box, call); |
612 | return -1; |
404 | return -1; |
613 | } |
405 | } |
614 | IPC_SET_ARG5(call->data, phoneid); |
406 | IPC_SET_ARG5(call->data, phoneid); |
615 | } |
407 | } |
616 | switch (IPC_GET_METHOD(call->data)) { |
408 | switch (IPC_GET_METHOD(call->data)) { |
617 | case IPC_M_DEBUG_ALL: |
409 | case IPC_M_DEBUG_ALL: |
618 | return -1; |
410 | return -1; |
619 | default: |
411 | default: |
620 | break; |
412 | break; |
621 | } |
413 | } |
622 | return 0; |
414 | return 0; |
623 | } |
415 | } |
624 | 416 | ||
625 | /** Make a fast call over IPC, wait for reply and return to user. |
417 | /** Make a fast call over IPC, wait for reply and return to user. |
626 | * |
418 | * |
627 | * This function can handle only three arguments of payload, but is faster than |
419 | * This function can handle only three arguments of payload, but is faster than |
628 | * the generic function (i.e. sys_ipc_call_sync_slow()). |
420 | * the generic function (i.e. sys_ipc_call_sync_slow()). |
629 | * |
421 | * |
630 | * @param phoneid Phone handle for the call. |
422 | * @param phoneid Phone handle for the call. |
631 | * @param method Method of the call. |
423 | * @param method Method of the call. |
632 | * @param arg1 Service-defined payload argument. |
424 | * @param arg1 Service-defined payload argument. |
633 | * @param arg2 Service-defined payload argument. |
425 | * @param arg2 Service-defined payload argument. |
634 | * @param arg3 Service-defined payload argument. |
426 | * @param arg3 Service-defined payload argument. |
635 | * @param data Address of userspace structure where the reply call will |
427 | * @param data Address of userspace structure where the reply call will |
636 | * be stored. |
428 | * be stored. |
637 | * |
429 | * |
638 | * @return Returns 0 on success. |
430 | * @return Returns 0 on success. |
639 | * Return ENOENT if there is no such phone handle. |
431 | * Return ENOENT if there is no such phone handle. |
640 | */ |
432 | */ |
641 | unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method, |
433 | unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method, |
642 | unative_t arg1, unative_t arg2, unative_t arg3, ipc_data_t *data) |
434 | unative_t arg1, unative_t arg2, unative_t arg3, ipc_data_t *data) |
643 | { |
435 | { |
644 | call_t call; |
436 | call_t call; |
645 | phone_t *phone; |
437 | phone_t *phone; |
646 | int res; |
438 | int res; |
647 | int rc; |
439 | int rc; |
648 | 440 | ||
649 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
441 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
650 | 442 | ||
651 | ipc_call_static_init(&call); |
443 | ipc_call_static_init(&call); |
652 | IPC_SET_METHOD(call.data, method); |
444 | IPC_SET_METHOD(call.data, method); |
653 | IPC_SET_ARG1(call.data, arg1); |
445 | IPC_SET_ARG1(call.data, arg1); |
654 | IPC_SET_ARG2(call.data, arg2); |
446 | IPC_SET_ARG2(call.data, arg2); |
655 | IPC_SET_ARG3(call.data, arg3); |
447 | IPC_SET_ARG3(call.data, arg3); |
656 | /* |
448 | /* |
657 | * To achieve deterministic behavior, zero out arguments that are beyond |
449 | * To achieve deterministic behavior, zero out arguments that are beyond |
658 | * the limits of the fast version. |
450 | * the limits of the fast version. |
659 | */ |
451 | */ |
660 | IPC_SET_ARG4(call.data, 0); |
452 | IPC_SET_ARG4(call.data, 0); |
661 | IPC_SET_ARG5(call.data, 0); |
453 | IPC_SET_ARG5(call.data, 0); |
662 | 454 | ||
663 | if (!(res = request_preprocess(&call, phone))) { |
455 | if (!(res = request_preprocess(&call, phone))) { |
664 | ipc_call_sync(phone, &call); |
456 | ipc_call_sync(phone, &call); |
665 | process_answer(&call); |
457 | process_answer(&call); |
666 | } else { |
458 | } else { |
667 | IPC_SET_RETVAL(call.data, res); |
459 | IPC_SET_RETVAL(call.data, res); |
668 | } |
460 | } |
669 | rc = STRUCT_TO_USPACE(&data->args, &call.data.args); |
461 | rc = STRUCT_TO_USPACE(&data->args, &call.data.args); |
670 | if (rc != 0) |
462 | if (rc != 0) |
671 | return rc; |
463 | return rc; |
672 | 464 | ||
673 | return 0; |
465 | return 0; |
674 | } |
466 | } |
675 | 467 | ||
676 | /** Make a synchronous IPC call allowing to transmit the entire payload. |
468 | /** Make a synchronous IPC call allowing to transmit the entire payload. |
677 | * |
469 | * |
678 | * @param phoneid Phone handle for the call. |
470 | * @param phoneid Phone handle for the call. |
679 | * @param question Userspace address of call data with the request. |
471 | * @param question Userspace address of call data with the request. |
680 | * @param reply Userspace address of call data where to store the |
472 | * @param reply Userspace address of call data where to store the |
681 | * answer. |
473 | * answer. |
682 | * |
474 | * |
683 | * @return Zero on success or an error code. |
475 | * @return Zero on success or an error code. |
684 | */ |
476 | */ |
685 | unative_t sys_ipc_call_sync_slow(unative_t phoneid, ipc_data_t *question, |
477 | unative_t sys_ipc_call_sync_slow(unative_t phoneid, ipc_data_t *question, |
686 | ipc_data_t *reply) |
478 | ipc_data_t *reply) |
687 | { |
479 | { |
688 | call_t call; |
480 | call_t call; |
689 | phone_t *phone; |
481 | phone_t *phone; |
690 | int res; |
482 | int res; |
691 | int rc; |
483 | int rc; |
692 | 484 | ||
693 | ipc_call_static_init(&call); |
485 | ipc_call_static_init(&call); |
694 | rc = copy_from_uspace(&call.data.args, &question->args, |
486 | rc = copy_from_uspace(&call.data.args, &question->args, |
695 | sizeof(call.data.args)); |
487 | sizeof(call.data.args)); |
696 | if (rc != 0) |
488 | if (rc != 0) |
697 | return (unative_t) rc; |
489 | return (unative_t) rc; |
698 | 490 | ||
699 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
491 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
700 | 492 | ||
701 | if (!(res = request_preprocess(&call, phone))) { |
493 | if (!(res = request_preprocess(&call, phone))) { |
702 | ipc_call_sync(phone, &call); |
494 | ipc_call_sync(phone, &call); |
703 | process_answer(&call); |
495 | process_answer(&call); |
704 | } else |
496 | } else |
705 | IPC_SET_RETVAL(call.data, res); |
497 | IPC_SET_RETVAL(call.data, res); |
706 | 498 | ||
707 | rc = STRUCT_TO_USPACE(&reply->args, &call.data.args); |
499 | rc = STRUCT_TO_USPACE(&reply->args, &call.data.args); |
708 | if (rc != 0) |
500 | if (rc != 0) |
709 | return rc; |
501 | return rc; |
710 | 502 | ||
711 | return 0; |
503 | return 0; |
712 | } |
504 | } |
713 | 505 | ||
714 | /** Check that the task did not exceed the allowed limit of asynchronous calls. |
506 | /** Check that the task did not exceed the allowed limit of asynchronous calls. |
715 | * |
507 | * |
716 | * @return Return 0 if limit not reached or -1 if limit exceeded. |
508 | * @return Return 0 if limit not reached or -1 if limit exceeded. |
717 | */ |
509 | */ |
718 | static int check_call_limit(void) |
510 | static int check_call_limit(void) |
719 | { |
511 | { |
720 | if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) { |
512 | if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) { |
721 | atomic_dec(&TASK->active_calls); |
513 | atomic_dec(&TASK->active_calls); |
722 | return -1; |
514 | return -1; |
723 | } |
515 | } |
724 | return 0; |
516 | return 0; |
725 | } |
517 | } |
726 | 518 | ||
727 | /** Make a fast asynchronous call over IPC. |
519 | /** Make a fast asynchronous call over IPC. |
728 | * |
520 | * |
729 | * This function can only handle four arguments of payload, but is faster than |
521 | * This function can only handle four arguments of payload, but is faster than |
730 | * the generic function sys_ipc_call_async_slow(). |
522 | * the generic function sys_ipc_call_async_slow(). |
731 | * |
523 | * |
732 | * @param phoneid Phone handle for the call. |
524 | * @param phoneid Phone handle for the call. |
733 | * @param method Method of the call. |
525 | * @param method Method of the call. |
734 | * @param arg1 Service-defined payload argument. |
526 | * @param arg1 Service-defined payload argument. |
735 | * @param arg2 Service-defined payload argument. |
527 | * @param arg2 Service-defined payload argument. |
736 | * @param arg3 Service-defined payload argument. |
528 | * @param arg3 Service-defined payload argument. |
737 | * @param arg4 Service-defined payload argument. |
529 | * @param arg4 Service-defined payload argument. |
738 | * |
530 | * |
739 | * @return Return call hash on success. |
531 | * @return Return call hash on success. |
740 | * Return IPC_CALLRET_FATAL in case of a fatal error and |
532 | * Return IPC_CALLRET_FATAL in case of a fatal error and |
741 | * IPC_CALLRET_TEMPORARY if there are too many pending |
533 | * IPC_CALLRET_TEMPORARY if there are too many pending |
742 | * asynchronous requests; answers should be handled first. |
534 | * asynchronous requests; answers should be handled first. |
743 | */ |
535 | */ |
744 | unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method, |
536 | unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method, |
745 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
537 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
746 | { |
538 | { |
747 | call_t *call; |
539 | call_t *call; |
748 | phone_t *phone; |
540 | phone_t *phone; |
749 | int res; |
541 | int res; |
750 | 542 | ||
751 | if (check_call_limit()) |
543 | if (check_call_limit()) |
752 | return IPC_CALLRET_TEMPORARY; |
544 | return IPC_CALLRET_TEMPORARY; |
753 | 545 | ||
754 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
546 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
755 | 547 | ||
756 | call = ipc_call_alloc(0); |
548 | call = ipc_call_alloc(0); |
757 | IPC_SET_METHOD(call->data, method); |
549 | IPC_SET_METHOD(call->data, method); |
758 | IPC_SET_ARG1(call->data, arg1); |
550 | IPC_SET_ARG1(call->data, arg1); |
759 | IPC_SET_ARG2(call->data, arg2); |
551 | IPC_SET_ARG2(call->data, arg2); |
760 | IPC_SET_ARG3(call->data, arg3); |
552 | IPC_SET_ARG3(call->data, arg3); |
761 | IPC_SET_ARG4(call->data, arg4); |
553 | IPC_SET_ARG4(call->data, arg4); |
762 | /* |
554 | /* |
763 | * To achieve deterministic behavior, zero out arguments that are beyond |
555 | * To achieve deterministic behavior, zero out arguments that are beyond |
764 | * the limits of the fast version. |
556 | * the limits of the fast version. |
765 | */ |
557 | */ |
766 | IPC_SET_ARG5(call->data, 0); |
558 | IPC_SET_ARG5(call->data, 0); |
767 | 559 | ||
768 | if (!(res = request_preprocess(call, phone))) |
560 | if (!(res = request_preprocess(call, phone))) |
769 | ipc_call(phone, call); |
561 | ipc_call(phone, call); |
770 | else |
562 | else |
771 | ipc_backsend_err(phone, call, res); |
563 | ipc_backsend_err(phone, call, res); |
772 | 564 | ||
773 | return (unative_t) call; |
565 | return (unative_t) call; |
774 | } |
566 | } |
775 | 567 | ||
776 | /** Make an asynchronous IPC call allowing to transmit the entire payload. |
568 | /** Make an asynchronous IPC call allowing to transmit the entire payload. |
777 | * |
569 | * |
778 | * @param phoneid Phone handle for the call. |
570 | * @param phoneid Phone handle for the call. |
779 | * @param data Userspace address of call data with the request. |
571 | * @param data Userspace address of call data with the request. |
780 | * |
572 | * |
781 | * @return See sys_ipc_call_async_fast(). |
573 | * @return See sys_ipc_call_async_fast(). |
782 | */ |
574 | */ |
783 | unative_t sys_ipc_call_async_slow(unative_t phoneid, ipc_data_t *data) |
575 | unative_t sys_ipc_call_async_slow(unative_t phoneid, ipc_data_t *data) |
784 | { |
576 | { |
785 | call_t *call; |
577 | call_t *call; |
786 | phone_t *phone; |
578 | phone_t *phone; |
787 | int res; |
579 | int res; |
788 | int rc; |
580 | int rc; |
789 | 581 | ||
790 | if (check_call_limit()) |
582 | if (check_call_limit()) |
791 | return IPC_CALLRET_TEMPORARY; |
583 | return IPC_CALLRET_TEMPORARY; |
792 | 584 | ||
793 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
585 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
794 | 586 | ||
795 | call = ipc_call_alloc(0); |
587 | call = ipc_call_alloc(0); |
796 | rc = copy_from_uspace(&call->data.args, &data->args, |
588 | rc = copy_from_uspace(&call->data.args, &data->args, |
797 | sizeof(call->data.args)); |
589 | sizeof(call->data.args)); |
798 | if (rc != 0) { |
590 | if (rc != 0) { |
799 | ipc_call_free(call); |
591 | ipc_call_free(call); |
800 | return (unative_t) rc; |
592 | return (unative_t) rc; |
801 | } |
593 | } |
802 | if (TASK->being_debugged) |
- | |
803 | klog_printf("call_async_slow: phone=%u, uspace_ptr=%u, arg0=%u", |
- | |
804 | phoneid, (unsigned)data, call->data.args[0]); |
- | |
805 | if (!(res = request_preprocess(call, phone))) |
594 | if (!(res = request_preprocess(call, phone))) |
806 | ipc_call(phone, call); |
595 | ipc_call(phone, call); |
807 | else |
596 | else |
808 | ipc_backsend_err(phone, call, res); |
597 | ipc_backsend_err(phone, call, res); |
809 | 598 | ||
810 | return (unative_t) call; |
599 | return (unative_t) call; |
811 | } |
600 | } |
812 | 601 | ||
813 | /** Forward a received call to another destination. |
602 | /** Forward a received call to another destination. |
814 | * |
603 | * |
815 | * @param callid Hash of the call to forward. |
604 | * @param callid Hash of the call to forward. |
816 | * @param phoneid Phone handle to use for forwarding. |
605 | * @param phoneid Phone handle to use for forwarding. |
817 | * @param method New method to use for the forwarded call. |
606 | * @param method New method to use for the forwarded call. |
818 | * @param arg1 New value of the first argument for the forwarded call. |
607 | * @param arg1 New value of the first argument for the forwarded call. |
819 | * @param arg2 New value of the second argument for the forwarded call. |
608 | * @param arg2 New value of the second argument for the forwarded call. |
820 | * @param mode Flags that specify mode of the forward operation. |
609 | * @param mode Flags that specify mode of the forward operation. |
821 | * |
610 | * |
822 | * @return Return 0 on succes, otherwise return an error code. |
611 | * @return Return 0 on succes, otherwise return an error code. |
823 | * |
612 | * |
824 | * In case the original method is a system method, ARG1, ARG2 and ARG3 are |
613 | * In case the original method is a system method, ARG1, ARG2 and ARG3 are |
825 | * overwritten in the forwarded message with the new method and the new arg1 and |
614 | * overwritten in the forwarded message with the new method and the new arg1 and |
826 | * arg2, respectively. Otherwise the METHOD, ARG1 and ARG2 are rewritten with |
615 | * arg2, respectively. Otherwise the METHOD, ARG1 and ARG2 are rewritten with |
827 | * the new method, arg1 and arg2, respectively. Also note there is a set of |
616 | * the new method, arg1 and arg2, respectively. Also note there is a set of |
828 | * immutable methods, for which the new method and argument is not set and |
617 | * immutable methods, for which the new method and argument is not set and |
829 | * these values are ignored. |
618 | * these values are ignored. |
830 | * |
619 | * |
831 | * Warning: When implementing support for changing additional payload |
620 | * Warning: When implementing support for changing additional payload |
832 | * arguments, make sure that ARG5 is not rewritten for certain |
621 | * arguments, make sure that ARG5 is not rewritten for certain |
833 | * system IPC |
622 | * system IPC |
834 | */ |
623 | */ |
835 | unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid, |
624 | unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid, |
836 | unative_t method, unative_t arg1, unative_t arg2, int mode) |
625 | unative_t method, unative_t arg1, unative_t arg2, int mode) |
837 | { |
626 | { |
838 | call_t *call; |
627 | call_t *call; |
839 | phone_t *phone; |
628 | phone_t *phone; |
840 | 629 | ||
841 | call = get_call(callid); |
630 | call = get_call(callid); |
842 | if (!call) |
631 | if (!call) |
843 | return ENOENT; |
632 | return ENOENT; |
844 | 633 | ||
845 | call->flags |= IPC_CALL_FORWARDED; |
634 | call->flags |= IPC_CALL_FORWARDED; |
846 | 635 | ||
847 | GET_CHECK_PHONE(phone, phoneid, { |
636 | GET_CHECK_PHONE(phone, phoneid, { |
848 | IPC_SET_RETVAL(call->data, EFORWARD); |
637 | IPC_SET_RETVAL(call->data, EFORWARD); |
849 | ipc_answer(&TASK->answerbox, call); |
638 | ipc_answer(&TASK->answerbox, call); |
850 | return ENOENT; |
639 | return ENOENT; |
851 | }); |
640 | }); |
852 | 641 | ||
853 | if (!method_is_forwardable(IPC_GET_METHOD(call->data))) { |
642 | if (!method_is_forwardable(IPC_GET_METHOD(call->data))) { |
854 | IPC_SET_RETVAL(call->data, EFORWARD); |
643 | IPC_SET_RETVAL(call->data, EFORWARD); |
855 | ipc_answer(&TASK->answerbox, call); |
644 | ipc_answer(&TASK->answerbox, call); |
856 | return EPERM; |
645 | return EPERM; |
857 | } |
646 | } |
858 | 647 | ||
859 | /* |
648 | /* |
860 | * Userspace is not allowed to change method of system methods on |
649 | * Userspace is not allowed to change method of system methods on |
861 | * forward, allow changing ARG1, ARG2 and ARG3 by means of method, |
650 | * forward, allow changing ARG1, ARG2 and ARG3 by means of method, |
862 | * arg1 and arg2. |
651 | * arg1 and arg2. |
863 | * If the method is immutable, don't change anything. |
652 | * If the method is immutable, don't change anything. |
864 | */ |
653 | */ |
865 | if (!method_is_immutable(IPC_GET_METHOD(call->data))) { |
654 | if (!method_is_immutable(IPC_GET_METHOD(call->data))) { |
866 | if (method_is_system(IPC_GET_METHOD(call->data))) { |
655 | if (method_is_system(IPC_GET_METHOD(call->data))) { |
867 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) |
656 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) |
868 | phone_dealloc(IPC_GET_ARG5(call->data)); |
657 | phone_dealloc(IPC_GET_ARG5(call->data)); |
869 | 658 | ||
870 | IPC_SET_ARG1(call->data, method); |
659 | IPC_SET_ARG1(call->data, method); |
871 | IPC_SET_ARG2(call->data, arg1); |
660 | IPC_SET_ARG2(call->data, arg1); |
872 | IPC_SET_ARG3(call->data, arg2); |
661 | IPC_SET_ARG3(call->data, arg2); |
873 | } else { |
662 | } else { |
874 | IPC_SET_METHOD(call->data, method); |
663 | IPC_SET_METHOD(call->data, method); |
875 | IPC_SET_ARG1(call->data, arg1); |
664 | IPC_SET_ARG1(call->data, arg1); |
876 | IPC_SET_ARG2(call->data, arg2); |
665 | IPC_SET_ARG2(call->data, arg2); |
877 | } |
666 | } |
878 | } |
667 | } |
879 | 668 | ||
880 | return ipc_forward(call, phone, &TASK->answerbox, mode); |
669 | return ipc_forward(call, phone, &TASK->answerbox, mode); |
881 | } |
670 | } |
882 | 671 | ||
883 | /** Answer an IPC call - fast version. |
672 | /** Answer an IPC call - fast version. |
884 | * |
673 | * |
885 | * This function can handle only two return arguments of payload, but is faster |
674 | * This function can handle only two return arguments of payload, but is faster |
886 | * than the generic sys_ipc_answer(). |
675 | * than the generic sys_ipc_answer(). |
887 | * |
676 | * |
888 | * @param callid Hash of the call to be answered. |
677 | * @param callid Hash of the call to be answered. |
889 | * @param retval Return value of the answer. |
678 | * @param retval Return value of the answer. |
890 | * @param arg1 Service-defined return value. |
679 | * @param arg1 Service-defined return value. |
891 | * @param arg2 Service-defined return value. |
680 | * @param arg2 Service-defined return value. |
892 | * @param arg3 Service-defined return value. |
681 | * @param arg3 Service-defined return value. |
893 | * @param arg4 Service-defined return value. |
682 | * @param arg4 Service-defined return value. |
894 | * |
683 | * |
895 | * @return Return 0 on success, otherwise return an error code. |
684 | * @return Return 0 on success, otherwise return an error code. |
896 | */ |
685 | */ |
897 | unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval, |
686 | unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval, |
898 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
687 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
899 | { |
688 | { |
900 | call_t *call; |
689 | call_t *call; |
901 | ipc_data_t saved_data; |
690 | ipc_data_t saved_data; |
902 | int saveddata = 0; |
691 | int saveddata = 0; |
903 | int rc; |
692 | int rc; |
904 | 693 | ||
905 | /* Do not answer notification callids */ |
694 | /* Do not answer notification callids */ |
906 | if (callid & IPC_CALLID_NOTIFICATION) |
695 | if (callid & IPC_CALLID_NOTIFICATION) |
907 | return 0; |
696 | return 0; |
908 | 697 | ||
909 | call = get_call(callid); |
698 | call = get_call(callid); |
910 | if (!call) |
699 | if (!call) |
911 | return ENOENT; |
700 | return ENOENT; |
912 | 701 | ||
913 | if (answer_need_old(call)) { |
702 | if (answer_need_old(call)) { |
914 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
703 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
915 | saveddata = 1; |
704 | saveddata = 1; |
916 | } |
705 | } |
917 | 706 | ||
918 | IPC_SET_RETVAL(call->data, retval); |
707 | IPC_SET_RETVAL(call->data, retval); |
919 | IPC_SET_ARG1(call->data, arg1); |
708 | IPC_SET_ARG1(call->data, arg1); |
920 | IPC_SET_ARG2(call->data, arg2); |
709 | IPC_SET_ARG2(call->data, arg2); |
921 | IPC_SET_ARG3(call->data, arg3); |
710 | IPC_SET_ARG3(call->data, arg3); |
922 | IPC_SET_ARG4(call->data, arg4); |
711 | IPC_SET_ARG4(call->data, arg4); |
923 | /* |
712 | /* |
924 | * To achieve deterministic behavior, zero out arguments that are beyond |
713 | * To achieve deterministic behavior, zero out arguments that are beyond |
925 | * the limits of the fast version. |
714 | * the limits of the fast version. |
926 | */ |
715 | */ |
927 | IPC_SET_ARG5(call->data, 0); |
716 | IPC_SET_ARG5(call->data, 0); |
928 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
717 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
929 | 718 | ||
930 | ipc_answer(&TASK->answerbox, call); |
719 | ipc_answer(&TASK->answerbox, call); |
931 | return rc; |
720 | return rc; |
932 | } |
721 | } |
933 | 722 | ||
934 | /** Answer an IPC call. |
723 | /** Answer an IPC call. |
935 | * |
724 | * |
936 | * @param callid Hash of the call to be answered. |
725 | * @param callid Hash of the call to be answered. |
937 | * @param data Userspace address of call data with the answer. |
726 | * @param data Userspace address of call data with the answer. |
938 | * |
727 | * |
939 | * @return Return 0 on success, otherwise return an error code. |
728 | * @return Return 0 on success, otherwise return an error code. |
940 | */ |
729 | */ |
941 | unative_t sys_ipc_answer_slow(unative_t callid, ipc_data_t *data) |
730 | unative_t sys_ipc_answer_slow(unative_t callid, ipc_data_t *data) |
942 | { |
731 | { |
943 | call_t *call; |
732 | call_t *call; |
944 | ipc_data_t saved_data; |
733 | ipc_data_t saved_data; |
945 | int saveddata = 0; |
734 | int saveddata = 0; |
946 | int rc; |
735 | int rc; |
947 | 736 | ||
948 | /* Do not answer notification callids */ |
737 | /* Do not answer notification callids */ |
949 | if (callid & IPC_CALLID_NOTIFICATION) |
738 | if (callid & IPC_CALLID_NOTIFICATION) |
950 | return 0; |
739 | return 0; |
951 | 740 | ||
952 | call = get_call(callid); |
741 | call = get_call(callid); |
953 | if (!call) |
742 | if (!call) |
954 | return ENOENT; |
743 | return ENOENT; |
955 | 744 | ||
956 | if (answer_need_old(call)) { |
745 | if (answer_need_old(call)) { |
957 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
746 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
958 | saveddata = 1; |
747 | saveddata = 1; |
959 | } |
748 | } |
960 | rc = copy_from_uspace(&call->data.args, &data->args, |
749 | rc = copy_from_uspace(&call->data.args, &data->args, |
961 | sizeof(call->data.args)); |
750 | sizeof(call->data.args)); |
962 | if (rc != 0) |
751 | if (rc != 0) |
963 | return rc; |
752 | return rc; |
964 | 753 | ||
965 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
754 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
966 | 755 | ||
967 | ipc_answer(&TASK->answerbox, call); |
756 | ipc_answer(&TASK->answerbox, call); |
968 | 757 | ||
969 | return rc; |
758 | return rc; |
970 | } |
759 | } |
971 | 760 | ||
972 | /** Hang up a phone. |
761 | /** Hang up a phone. |
973 | * |
762 | * |
974 | * @param Phone handle of the phone to be hung up. |
763 | * @param Phone handle of the phone to be hung up. |
975 | * |
764 | * |
976 | * @return Return 0 on success or an error code. |
765 | * @return Return 0 on success or an error code. |
977 | */ |
766 | */ |
978 | unative_t sys_ipc_hangup(int phoneid) |
767 | unative_t sys_ipc_hangup(int phoneid) |
979 | { |
768 | { |
980 | phone_t *phone; |
769 | phone_t *phone; |
981 | 770 | ||
982 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
771 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
983 | 772 | ||
984 | if (ipc_phone_hangup(phone)) |
773 | if (ipc_phone_hangup(phone)) |
985 | return -1; |
774 | return -1; |
986 | 775 | ||
987 | return 0; |
776 | return 0; |
988 | } |
777 | } |
989 | 778 | ||
990 | /** Wait for an incoming IPC call or an answer. |
779 | /** Wait for an incoming IPC call or an answer. |
991 | * |
780 | * |
992 | * @param calldata Pointer to buffer where the call/answer data is stored. |
781 | * @param calldata Pointer to buffer where the call/answer data is stored. |
993 | * @param usec Timeout. See waitq_sleep_timeout() for explanation. |
782 | * @param usec Timeout. See waitq_sleep_timeout() for explanation. |
994 | * @param flags Select mode of sleep operation. See waitq_sleep_timeout() |
783 | * @param flags Select mode of sleep operation. See waitq_sleep_timeout() |
995 | * for explanation. |
784 | * for explanation. |
996 | * |
785 | * |
997 | * @return Hash of the call. |
786 | * @return Hash of the call. |
998 | * If IPC_CALLID_NOTIFICATION bit is set in the hash, the |
787 | * If IPC_CALLID_NOTIFICATION bit is set in the hash, the |
999 | * call is a notification. IPC_CALLID_ANSWERED denotes an |
788 | * call is a notification. IPC_CALLID_ANSWERED denotes an |
1000 | * answer. |
789 | * answer. |
1001 | */ |
790 | */ |
1002 | unative_t sys_ipc_wait_for_call(ipc_data_t *calldata, uint32_t usec, int flags) |
791 | unative_t sys_ipc_wait_for_call(ipc_data_t *calldata, uint32_t usec, int flags) |
1003 | { |
792 | { |
1004 | call_t *call; |
793 | call_t *call; |
1005 | 794 | ||
1006 | restart: |
795 | restart: |
1007 | call = ipc_wait_for_call(&TASK->answerbox, usec, |
796 | call = ipc_wait_for_call(&TASK->answerbox, usec, |
1008 | flags | SYNCH_FLAGS_INTERRUPTIBLE); |
797 | flags | SYNCH_FLAGS_INTERRUPTIBLE); |
1009 | if (!call) |
798 | if (!call) |
1010 | return 0; |
799 | return 0; |
1011 | 800 | ||
1012 | if (call->flags & IPC_CALL_NOTIF) { |
801 | if (call->flags & IPC_CALL_NOTIF) { |
1013 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
802 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
1014 | 803 | ||
1015 | /* Set in_phone_hash to the interrupt counter */ |
804 | /* Set in_phone_hash to the interrupt counter */ |
1016 | call->data.phone = (void *) call->priv; |
805 | call->data.phone = (void *) call->priv; |
1017 | 806 | ||
1018 | STRUCT_TO_USPACE(calldata, &call->data); |
807 | STRUCT_TO_USPACE(calldata, &call->data); |
1019 | 808 | ||
1020 | ipc_call_free(call); |
809 | ipc_call_free(call); |
1021 | 810 | ||
1022 | return ((unative_t) call) | IPC_CALLID_NOTIFICATION; |
811 | return ((unative_t) call) | IPC_CALLID_NOTIFICATION; |
1023 | } |
812 | } |
1024 | 813 | ||
1025 | if (call->flags & IPC_CALL_ANSWERED) { |
814 | if (call->flags & IPC_CALL_ANSWERED) { |
1026 | process_answer(call); |
815 | process_answer(call); |
1027 | 816 | ||
1028 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
817 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
1029 | 818 | ||
1030 | atomic_dec(&TASK->active_calls); |
819 | atomic_dec(&TASK->active_calls); |
1031 | 820 | ||
1032 | if (call->flags & IPC_CALL_DISCARD_ANSWER) { |
821 | if (call->flags & IPC_CALL_DISCARD_ANSWER) { |
1033 | ipc_call_free(call); |
822 | ipc_call_free(call); |
1034 | goto restart; |
823 | goto restart; |
1035 | } |
824 | } |
1036 | 825 | ||
1037 | STRUCT_TO_USPACE(&calldata->args, &call->data.args); |
826 | STRUCT_TO_USPACE(&calldata->args, &call->data.args); |
1038 | ipc_call_free(call); |
827 | ipc_call_free(call); |
1039 | 828 | ||
1040 | return ((unative_t) call) | IPC_CALLID_ANSWERED; |
829 | return ((unative_t) call) | IPC_CALLID_ANSWERED; |
1041 | } |
830 | } |
1042 | 831 | ||
1043 | if (process_request(&TASK->answerbox, call)) |
832 | if (process_request(&TASK->answerbox, call)) |
1044 | goto restart; |
833 | goto restart; |
1045 | 834 | ||
1046 | /* Include phone address('id') of the caller in the request, |
835 | /* Include phone address('id') of the caller in the request, |
1047 | * copy whole call->data, not only call->data.args */ |
836 | * copy whole call->data, not only call->data.args */ |
1048 | if (STRUCT_TO_USPACE(calldata, &call->data)) { |
837 | if (STRUCT_TO_USPACE(calldata, &call->data)) { |
1049 | return 0; |
838 | return 0; |
1050 | } |
839 | } |
1051 | return (unative_t)call; |
840 | return (unative_t)call; |
1052 | } |
841 | } |
1053 | 842 | ||
1054 | /** Connect an IRQ handler to a task. |
843 | /** Connect an IRQ handler to a task. |
1055 | * |
844 | * |
1056 | * @param inr IRQ number. |
845 | * @param inr IRQ number. |
1057 | * @param devno Device number. |
846 | * @param devno Device number. |
1058 | * @param method Method to be associated with the notification. |
847 | * @param method Method to be associated with the notification. |
1059 | * @param ucode Uspace pointer to the top-half pseudocode. |
848 | * @param ucode Uspace pointer to the top-half pseudocode. |
1060 | * |
849 | * |
1061 | * @return EPERM or a return code returned by ipc_irq_register(). |
850 | * @return EPERM or a return code returned by ipc_irq_register(). |
1062 | */ |
851 | */ |
1063 | unative_t sys_ipc_register_irq(inr_t inr, devno_t devno, unative_t method, |
852 | unative_t sys_ipc_register_irq(inr_t inr, devno_t devno, unative_t method, |
1064 | irq_code_t *ucode) |
853 | irq_code_t *ucode) |
1065 | { |
854 | { |
1066 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
855 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
1067 | return EPERM; |
856 | return EPERM; |
1068 | 857 | ||
1069 | return ipc_irq_register(&TASK->answerbox, inr, devno, method, ucode); |
858 | return ipc_irq_register(&TASK->answerbox, inr, devno, method, ucode); |
1070 | } |
859 | } |
1071 | 860 | ||
1072 | /** Disconnect an IRQ handler from a task. |
861 | /** Disconnect an IRQ handler from a task. |
1073 | * |
862 | * |
1074 | * @param inr IRQ number. |
863 | * @param inr IRQ number. |
1075 | * @param devno Device number. |
864 | * @param devno Device number. |
1076 | * |
865 | * |
1077 | * @return Zero on success or EPERM on error.. |
866 | * @return Zero on success or EPERM on error.. |
1078 | */ |
867 | */ |
1079 | unative_t sys_ipc_unregister_irq(inr_t inr, devno_t devno) |
868 | unative_t sys_ipc_unregister_irq(inr_t inr, devno_t devno) |
1080 | { |
869 | { |
1081 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
870 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
1082 | return EPERM; |
871 | return EPERM; |
1083 | 872 | ||
1084 | ipc_irq_unregister(&TASK->answerbox, inr, devno); |
873 | ipc_irq_unregister(&TASK->answerbox, inr, devno); |
1085 | 874 | ||
1086 | return 0; |
875 | return 0; |
1087 | } |
876 | } |
1088 | 877 | ||
1089 | #include <console/klog.h> |
878 | #include <console/klog.h> |
1090 | 879 | ||
1091 | /** |
880 | /** |
1092 | * Syscall connect to a task by id. |
881 | * Syscall connect to a task by id. |
1093 | * |
882 | * |
1094 | * @return Phone id on success, or negative error code. |
883 | * @return Phone id on success, or negative error code. |
1095 | */ |
884 | */ |
1096 | unative_t sys_ipc_connect_kbox(sysarg64_t *uspace_taskid_arg) |
885 | unative_t sys_ipc_connect_kbox(sysarg64_t *uspace_taskid_arg) |
1097 | { |
886 | { |
1098 | sysarg64_t taskid_arg; |
887 | sysarg64_t taskid_arg; |
1099 | int rc; |
888 | int rc; |
1100 | 889 | ||
1101 | rc = copy_from_uspace(&taskid_arg, uspace_taskid_arg, sizeof(sysarg64_t)); |
890 | rc = copy_from_uspace(&taskid_arg, uspace_taskid_arg, sizeof(sysarg64_t)); |
1102 | if (rc != 0) |
891 | if (rc != 0) |
1103 | return (unative_t) rc; |
892 | return (unative_t) rc; |
1104 | 893 | ||
1105 | klog_printf("sys_ipc_connect_kbox(%lld, %d)", taskid_arg.value); |
894 | klog_printf("sys_ipc_connect_kbox(%lld, %d)", taskid_arg.value); |
1106 | 895 | ||
1107 | return ipc_connect_kbox(taskid_arg.value); |
896 | return ipc_connect_kbox(taskid_arg.value); |
1108 | } |
897 | } |
1109 | 898 | ||
1110 | /** @} |
899 | /** @} |
1111 | */ |
900 | */ |
1112 | 901 |