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