Rev 2807 | Rev 2809 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2807 | Rev 2808 | ||
---|---|---|---|
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_ARG1(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_ARG1(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_ARG2(call->data); |
399 | to_copy = IPC_GET_ARG3(call->data); |
399 | to_copy = IPC_GET_ARG3(call->data); |
400 | if (to_copy > 6) to_copy = 6; |
400 | if (to_copy > 6) to_copy = 6; |
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_ARG1(call->data); |
436 | buf_size = IPC_GET_ARG2(call->data); |
436 | buf_size = IPC_GET_ARG2(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 */ |
|
- | 443 | if ((t->flags & THREAD_FLAG_USPACE) == 0) |
|
- | 444 | continue; |
|
- | 445 | ||
442 | //FIXME: id cropped!! |
446 | //FIXME: id cropped!! |
443 | tid = (unative_t) t->tid; |
447 | tid = (unative_t) t->tid; |
444 | 448 | ||
445 | to_copy = sizeof(unative_t); |
449 | to_copy = sizeof(unative_t); |
446 | if (copied + to_copy >= buf_size) |
450 | if (copied + to_copy >= buf_size) |
447 | to_copy = buf_size - copied; |
451 | to_copy = buf_size - copied; |
448 | 452 | ||
449 | if (to_copy > 0) { |
453 | if (to_copy > 0) { |
450 | rc = copy_to_uspace(uspace_buffer, &tid, to_copy); |
454 | rc = copy_to_uspace(uspace_buffer, &tid, to_copy); |
451 | if (rc != 0) { |
455 | if (rc != 0) { |
452 | spinlock_unlock(&ta->lock); |
456 | spinlock_unlock(&ta->lock); |
453 | klog_printf("debug_thread_read() - copy failed"); |
457 | klog_printf("debug_thread_read() - copy failed"); |
454 | return rc; |
458 | return rc; |
455 | } |
459 | } |
456 | } |
460 | } |
457 | 461 | ||
458 | ++uspace_buffer; |
462 | ++uspace_buffer; |
459 | total += sizeof(unative_t); |
463 | total += sizeof(unative_t); |
460 | copied += to_copy; |
464 | copied += to_copy; |
461 | } |
465 | } |
462 | 466 | ||
463 | spinlock_unlock(&ta->lock); |
467 | spinlock_unlock(&ta->lock); |
464 | 468 | ||
465 | IPC_SET_ARG1(call->data, copied); |
469 | IPC_SET_ARG1(call->data, copied); |
466 | IPC_SET_ARG2(call->data, total); |
470 | IPC_SET_ARG2(call->data, total); |
467 | 471 | ||
468 | klog_printf("debug_thread_read() done"); |
472 | klog_printf("debug_thread_read() done"); |
469 | return 1; /* actually need becksend with retval 0 */ |
473 | return 1; /* actually need becksend with retval 0 */ |
470 | } |
474 | } |
471 | 475 | ||
472 | 476 | ||
473 | /** Called before the request is sent. |
477 | /** Called before the request is sent. |
474 | * |
478 | * |
475 | * @param call Call structure with the request. |
479 | * @param call Call structure with the request. |
476 | * @param phone Phone that the call will be sent through. |
480 | * @param phone Phone that the call will be sent through. |
477 | * |
481 | * |
478 | * @return Return 0 on success, ELIMIT or EPERM on error. |
482 | * @return Return 0 on success, ELIMIT or EPERM on error. |
479 | */ |
483 | */ |
480 | static int request_preprocess(call_t *call, phone_t *phone) |
484 | static int request_preprocess(call_t *call, phone_t *phone) |
481 | { |
485 | { |
482 | int newphid; |
486 | int newphid; |
483 | size_t size; |
487 | size_t size; |
484 | uintptr_t src; |
488 | uintptr_t src; |
485 | int rc; |
489 | int rc; |
486 | 490 | ||
487 | switch (IPC_GET_METHOD(call->data)) { |
491 | switch (IPC_GET_METHOD(call->data)) { |
488 | case IPC_M_CONNECT_ME_TO: |
492 | case IPC_M_CONNECT_ME_TO: |
489 | newphid = phone_alloc(); |
493 | newphid = phone_alloc(); |
490 | if (newphid < 0) |
494 | if (newphid < 0) |
491 | return ELIMIT; |
495 | return ELIMIT; |
492 | /* Set arg5 for server */ |
496 | /* Set arg5 for server */ |
493 | IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]); |
497 | IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]); |
494 | call->flags |= IPC_CALL_CONN_ME_TO; |
498 | call->flags |= IPC_CALL_CONN_ME_TO; |
495 | call->priv = newphid; |
499 | call->priv = newphid; |
496 | break; |
500 | break; |
497 | case IPC_M_SHARE_OUT: |
501 | case IPC_M_SHARE_OUT: |
498 | size = as_area_get_size(IPC_GET_ARG1(call->data)); |
502 | size = as_area_get_size(IPC_GET_ARG1(call->data)); |
499 | if (!size) |
503 | if (!size) |
500 | return EPERM; |
504 | return EPERM; |
501 | IPC_SET_ARG2(call->data, size); |
505 | IPC_SET_ARG2(call->data, size); |
502 | break; |
506 | break; |
503 | case IPC_M_DATA_READ: |
507 | case IPC_M_DATA_READ: |
504 | size = IPC_GET_ARG2(call->data); |
508 | size = IPC_GET_ARG2(call->data); |
505 | if ((size <= 0 || (size > DATA_XFER_LIMIT))) |
509 | if ((size <= 0 || (size > DATA_XFER_LIMIT))) |
506 | return ELIMIT; |
510 | return ELIMIT; |
507 | break; |
511 | break; |
508 | case IPC_M_DATA_WRITE: |
512 | case IPC_M_DATA_WRITE: |
509 | src = IPC_GET_ARG1(call->data); |
513 | src = IPC_GET_ARG1(call->data); |
510 | size = IPC_GET_ARG2(call->data); |
514 | size = IPC_GET_ARG2(call->data); |
511 | 515 | ||
512 | if ((size <= 0) || (size > DATA_XFER_LIMIT)) |
516 | if ((size <= 0) || (size > DATA_XFER_LIMIT)) |
513 | return ELIMIT; |
517 | return ELIMIT; |
514 | 518 | ||
515 | call->buffer = (uint8_t *) malloc(size, 0); |
519 | call->buffer = (uint8_t *) malloc(size, 0); |
516 | rc = copy_from_uspace(call->buffer, (void *) src, size); |
520 | rc = copy_from_uspace(call->buffer, (void *) src, size); |
517 | if (rc != 0) { |
521 | if (rc != 0) { |
518 | free(call->buffer); |
522 | free(call->buffer); |
519 | return rc; |
523 | return rc; |
520 | } |
524 | } |
521 | break; |
525 | break; |
522 | case IPC_M_DEBUG_BEGIN: |
526 | case IPC_M_DEBUG_BEGIN: |
523 | /* actually need possibility of backsend with 0 result code */ |
527 | /* actually need possibility of backsend with 0 result code */ |
524 | rc = debug_begin(call, phone); |
528 | rc = debug_begin(call, phone); |
525 | return rc; |
529 | return rc; |
526 | case IPC_M_DEBUG_GO: |
530 | case IPC_M_DEBUG_GO: |
527 | rc = debug_go(call, phone); |
531 | rc = debug_go(call, phone); |
528 | return rc; |
532 | return rc; |
529 | case IPC_M_DEBUG_ARGS_READ: |
533 | case IPC_M_DEBUG_ARGS_READ: |
530 | rc = debug_args_read(call, phone); |
534 | rc = debug_args_read(call, phone); |
531 | return rc; |
535 | return rc; |
532 | case IPC_M_DEBUG_THREAD_READ: |
536 | case IPC_M_DEBUG_THREAD_READ: |
533 | rc = debug_thread_read(call, phone); |
537 | rc = debug_thread_read(call, phone); |
534 | return rc; |
538 | return rc; |
535 | default: |
539 | default: |
536 | break; |
540 | break; |
537 | } |
541 | } |
538 | return 0; |
542 | return 0; |
539 | } |
543 | } |
540 | 544 | ||
541 | /******************************************************************************* |
545 | /******************************************************************************* |
542 | * Functions called to process received call/answer before passing it to uspace. |
546 | * Functions called to process received call/answer before passing it to uspace. |
543 | *******************************************************************************/ |
547 | *******************************************************************************/ |
544 | 548 | ||
545 | /** Do basic kernel processing of received call answer. |
549 | /** Do basic kernel processing of received call answer. |
546 | * |
550 | * |
547 | * @param call Call structure with the answer. |
551 | * @param call Call structure with the answer. |
548 | */ |
552 | */ |
549 | static void process_answer(call_t *call) |
553 | static void process_answer(call_t *call) |
550 | { |
554 | { |
551 | if (((native_t) IPC_GET_RETVAL(call->data) == EHANGUP) && |
555 | if (((native_t) IPC_GET_RETVAL(call->data) == EHANGUP) && |
552 | (call->flags & IPC_CALL_FORWARDED)) |
556 | (call->flags & IPC_CALL_FORWARDED)) |
553 | IPC_SET_RETVAL(call->data, EFORWARD); |
557 | IPC_SET_RETVAL(call->data, EFORWARD); |
554 | 558 | ||
555 | if (call->flags & IPC_CALL_CONN_ME_TO) { |
559 | if (call->flags & IPC_CALL_CONN_ME_TO) { |
556 | if (IPC_GET_RETVAL(call->data)) |
560 | if (IPC_GET_RETVAL(call->data)) |
557 | phone_dealloc(call->priv); |
561 | phone_dealloc(call->priv); |
558 | else |
562 | else |
559 | IPC_SET_ARG5(call->data, call->priv); |
563 | IPC_SET_ARG5(call->data, call->priv); |
560 | } |
564 | } |
561 | 565 | ||
562 | if (call->buffer) { |
566 | if (call->buffer) { |
563 | /* This must be an affirmative answer to IPC_M_DATA_READ. */ |
567 | /* This must be an affirmative answer to IPC_M_DATA_READ. */ |
564 | uintptr_t dst = IPC_GET_ARG1(call->data); |
568 | uintptr_t dst = IPC_GET_ARG1(call->data); |
565 | size_t size = IPC_GET_ARG2(call->data); |
569 | size_t size = IPC_GET_ARG2(call->data); |
566 | int rc = copy_to_uspace((void *) dst, call->buffer, size); |
570 | int rc = copy_to_uspace((void *) dst, call->buffer, size); |
567 | if (rc) |
571 | if (rc) |
568 | IPC_SET_RETVAL(call->data, rc); |
572 | IPC_SET_RETVAL(call->data, rc); |
569 | free(call->buffer); |
573 | free(call->buffer); |
570 | call->buffer = NULL; |
574 | call->buffer = NULL; |
571 | } |
575 | } |
572 | } |
576 | } |
573 | 577 | ||
574 | /** Do basic kernel processing of received call request. |
578 | /** Do basic kernel processing of received call request. |
575 | * |
579 | * |
576 | * @param box Destination answerbox structure. |
580 | * @param box Destination answerbox structure. |
577 | * @param call Call structure with the request. |
581 | * @param call Call structure with the request. |
578 | * |
582 | * |
579 | * @return Return 0 if the call should be passed to userspace. |
583 | * @return Return 0 if the call should be passed to userspace. |
580 | * Return -1 if the call should be ignored. |
584 | * Return -1 if the call should be ignored. |
581 | */ |
585 | */ |
582 | static int process_request(answerbox_t *box, call_t *call) |
586 | static int process_request(answerbox_t *box, call_t *call) |
583 | { |
587 | { |
584 | int phoneid; |
588 | int phoneid; |
585 | 589 | ||
586 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) { |
590 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) { |
587 | phoneid = phone_alloc(); |
591 | phoneid = phone_alloc(); |
588 | if (phoneid < 0) { /* Failed to allocate phone */ |
592 | if (phoneid < 0) { /* Failed to allocate phone */ |
589 | IPC_SET_RETVAL(call->data, ELIMIT); |
593 | IPC_SET_RETVAL(call->data, ELIMIT); |
590 | ipc_answer(box, call); |
594 | ipc_answer(box, call); |
591 | return -1; |
595 | return -1; |
592 | } |
596 | } |
593 | IPC_SET_ARG5(call->data, phoneid); |
597 | IPC_SET_ARG5(call->data, phoneid); |
594 | } |
598 | } |
595 | switch (IPC_GET_METHOD(call->data)) { |
599 | switch (IPC_GET_METHOD(call->data)) { |
596 | case IPC_M_DEBUG_BEGIN: |
600 | case IPC_M_DEBUG_BEGIN: |
597 | case IPC_M_DEBUG_END: |
601 | case IPC_M_DEBUG_END: |
598 | case IPC_M_DEBUG_GO: |
602 | case IPC_M_DEBUG_GO: |
599 | case IPC_M_DEBUG_STOP: |
603 | case IPC_M_DEBUG_STOP: |
600 | case IPC_M_DEBUG_GUARD: |
604 | case IPC_M_DEBUG_GUARD: |
601 | return -1; |
605 | return -1; |
602 | default: |
606 | default: |
603 | break; |
607 | break; |
604 | } |
608 | } |
605 | return 0; |
609 | return 0; |
606 | } |
610 | } |
607 | 611 | ||
608 | /** Make a fast call over IPC, wait for reply and return to user. |
612 | /** Make a fast call over IPC, wait for reply and return to user. |
609 | * |
613 | * |
610 | * This function can handle only three arguments of payload, but is faster than |
614 | * This function can handle only three arguments of payload, but is faster than |
611 | * the generic function (i.e. sys_ipc_call_sync_slow()). |
615 | * the generic function (i.e. sys_ipc_call_sync_slow()). |
612 | * |
616 | * |
613 | * @param phoneid Phone handle for the call. |
617 | * @param phoneid Phone handle for the call. |
614 | * @param method Method of the call. |
618 | * @param method Method of the call. |
615 | * @param arg1 Service-defined payload argument. |
619 | * @param arg1 Service-defined payload argument. |
616 | * @param arg2 Service-defined payload argument. |
620 | * @param arg2 Service-defined payload argument. |
617 | * @param arg3 Service-defined payload argument. |
621 | * @param arg3 Service-defined payload argument. |
618 | * @param data Address of userspace structure where the reply call will |
622 | * @param data Address of userspace structure where the reply call will |
619 | * be stored. |
623 | * be stored. |
620 | * |
624 | * |
621 | * @return Returns 0 on success. |
625 | * @return Returns 0 on success. |
622 | * Return ENOENT if there is no such phone handle. |
626 | * Return ENOENT if there is no such phone handle. |
623 | */ |
627 | */ |
624 | unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method, |
628 | unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method, |
625 | unative_t arg1, unative_t arg2, unative_t arg3, ipc_data_t *data) |
629 | unative_t arg1, unative_t arg2, unative_t arg3, ipc_data_t *data) |
626 | { |
630 | { |
627 | call_t call; |
631 | call_t call; |
628 | phone_t *phone; |
632 | phone_t *phone; |
629 | int res; |
633 | int res; |
630 | int rc; |
634 | int rc; |
631 | 635 | ||
632 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
636 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
633 | 637 | ||
634 | ipc_call_static_init(&call); |
638 | ipc_call_static_init(&call); |
635 | IPC_SET_METHOD(call.data, method); |
639 | IPC_SET_METHOD(call.data, method); |
636 | IPC_SET_ARG1(call.data, arg1); |
640 | IPC_SET_ARG1(call.data, arg1); |
637 | IPC_SET_ARG2(call.data, arg2); |
641 | IPC_SET_ARG2(call.data, arg2); |
638 | IPC_SET_ARG3(call.data, arg3); |
642 | IPC_SET_ARG3(call.data, arg3); |
639 | /* |
643 | /* |
640 | * To achieve deterministic behavior, zero out arguments that are beyond |
644 | * To achieve deterministic behavior, zero out arguments that are beyond |
641 | * the limits of the fast version. |
645 | * the limits of the fast version. |
642 | */ |
646 | */ |
643 | IPC_SET_ARG4(call.data, 0); |
647 | IPC_SET_ARG4(call.data, 0); |
644 | IPC_SET_ARG5(call.data, 0); |
648 | IPC_SET_ARG5(call.data, 0); |
645 | 649 | ||
646 | if (!(res = request_preprocess(&call, phone))) { |
650 | if (!(res = request_preprocess(&call, phone))) { |
647 | ipc_call_sync(phone, &call); |
651 | ipc_call_sync(phone, &call); |
648 | process_answer(&call); |
652 | process_answer(&call); |
649 | } else { |
653 | } else { |
650 | IPC_SET_RETVAL(call.data, res); |
654 | IPC_SET_RETVAL(call.data, res); |
651 | } |
655 | } |
652 | rc = STRUCT_TO_USPACE(&data->args, &call.data.args); |
656 | rc = STRUCT_TO_USPACE(&data->args, &call.data.args); |
653 | if (rc != 0) |
657 | if (rc != 0) |
654 | return rc; |
658 | return rc; |
655 | 659 | ||
656 | return 0; |
660 | return 0; |
657 | } |
661 | } |
658 | 662 | ||
659 | /** Make a synchronous IPC call allowing to transmit the entire payload. |
663 | /** Make a synchronous IPC call allowing to transmit the entire payload. |
660 | * |
664 | * |
661 | * @param phoneid Phone handle for the call. |
665 | * @param phoneid Phone handle for the call. |
662 | * @param question Userspace address of call data with the request. |
666 | * @param question Userspace address of call data with the request. |
663 | * @param reply Userspace address of call data where to store the |
667 | * @param reply Userspace address of call data where to store the |
664 | * answer. |
668 | * answer. |
665 | * |
669 | * |
666 | * @return Zero on success or an error code. |
670 | * @return Zero on success or an error code. |
667 | */ |
671 | */ |
668 | unative_t sys_ipc_call_sync_slow(unative_t phoneid, ipc_data_t *question, |
672 | unative_t sys_ipc_call_sync_slow(unative_t phoneid, ipc_data_t *question, |
669 | ipc_data_t *reply) |
673 | ipc_data_t *reply) |
670 | { |
674 | { |
671 | call_t call; |
675 | call_t call; |
672 | phone_t *phone; |
676 | phone_t *phone; |
673 | int res; |
677 | int res; |
674 | int rc; |
678 | int rc; |
675 | 679 | ||
676 | ipc_call_static_init(&call); |
680 | ipc_call_static_init(&call); |
677 | rc = copy_from_uspace(&call.data.args, &question->args, |
681 | rc = copy_from_uspace(&call.data.args, &question->args, |
678 | sizeof(call.data.args)); |
682 | sizeof(call.data.args)); |
679 | if (rc != 0) |
683 | if (rc != 0) |
680 | return (unative_t) rc; |
684 | return (unative_t) rc; |
681 | 685 | ||
682 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
686 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
683 | 687 | ||
684 | if (!(res = request_preprocess(&call, phone))) { |
688 | if (!(res = request_preprocess(&call, phone))) { |
685 | ipc_call_sync(phone, &call); |
689 | ipc_call_sync(phone, &call); |
686 | process_answer(&call); |
690 | process_answer(&call); |
687 | } else |
691 | } else |
688 | IPC_SET_RETVAL(call.data, res); |
692 | IPC_SET_RETVAL(call.data, res); |
689 | 693 | ||
690 | rc = STRUCT_TO_USPACE(&reply->args, &call.data.args); |
694 | rc = STRUCT_TO_USPACE(&reply->args, &call.data.args); |
691 | if (rc != 0) |
695 | if (rc != 0) |
692 | return rc; |
696 | return rc; |
693 | 697 | ||
694 | return 0; |
698 | return 0; |
695 | } |
699 | } |
696 | 700 | ||
697 | /** Check that the task did not exceed the allowed limit of asynchronous calls. |
701 | /** Check that the task did not exceed the allowed limit of asynchronous calls. |
698 | * |
702 | * |
699 | * @return Return 0 if limit not reached or -1 if limit exceeded. |
703 | * @return Return 0 if limit not reached or -1 if limit exceeded. |
700 | */ |
704 | */ |
701 | static int check_call_limit(void) |
705 | static int check_call_limit(void) |
702 | { |
706 | { |
703 | if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) { |
707 | if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) { |
704 | atomic_dec(&TASK->active_calls); |
708 | atomic_dec(&TASK->active_calls); |
705 | return -1; |
709 | return -1; |
706 | } |
710 | } |
707 | return 0; |
711 | return 0; |
708 | } |
712 | } |
709 | 713 | ||
710 | /** Make a fast asynchronous call over IPC. |
714 | /** Make a fast asynchronous call over IPC. |
711 | * |
715 | * |
712 | * This function can only handle four arguments of payload, but is faster than |
716 | * This function can only handle four arguments of payload, but is faster than |
713 | * the generic function sys_ipc_call_async_slow(). |
717 | * the generic function sys_ipc_call_async_slow(). |
714 | * |
718 | * |
715 | * @param phoneid Phone handle for the call. |
719 | * @param phoneid Phone handle for the call. |
716 | * @param method Method of the call. |
720 | * @param method Method of the call. |
717 | * @param arg1 Service-defined payload argument. |
721 | * @param arg1 Service-defined payload argument. |
718 | * @param arg2 Service-defined payload argument. |
722 | * @param arg2 Service-defined payload argument. |
719 | * @param arg3 Service-defined payload argument. |
723 | * @param arg3 Service-defined payload argument. |
720 | * @param arg4 Service-defined payload argument. |
724 | * @param arg4 Service-defined payload argument. |
721 | * |
725 | * |
722 | * @return Return call hash on success. |
726 | * @return Return call hash on success. |
723 | * Return IPC_CALLRET_FATAL in case of a fatal error and |
727 | * Return IPC_CALLRET_FATAL in case of a fatal error and |
724 | * IPC_CALLRET_TEMPORARY if there are too many pending |
728 | * IPC_CALLRET_TEMPORARY if there are too many pending |
725 | * asynchronous requests; answers should be handled first. |
729 | * asynchronous requests; answers should be handled first. |
726 | */ |
730 | */ |
727 | unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method, |
731 | unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method, |
728 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
732 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
729 | { |
733 | { |
730 | call_t *call; |
734 | call_t *call; |
731 | phone_t *phone; |
735 | phone_t *phone; |
732 | int res; |
736 | int res; |
733 | 737 | ||
734 | if (check_call_limit()) |
738 | if (check_call_limit()) |
735 | return IPC_CALLRET_TEMPORARY; |
739 | return IPC_CALLRET_TEMPORARY; |
736 | 740 | ||
737 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
741 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
738 | 742 | ||
739 | call = ipc_call_alloc(0); |
743 | call = ipc_call_alloc(0); |
740 | IPC_SET_METHOD(call->data, method); |
744 | IPC_SET_METHOD(call->data, method); |
741 | IPC_SET_ARG1(call->data, arg1); |
745 | IPC_SET_ARG1(call->data, arg1); |
742 | IPC_SET_ARG2(call->data, arg2); |
746 | IPC_SET_ARG2(call->data, arg2); |
743 | IPC_SET_ARG3(call->data, arg3); |
747 | IPC_SET_ARG3(call->data, arg3); |
744 | IPC_SET_ARG4(call->data, arg4); |
748 | IPC_SET_ARG4(call->data, arg4); |
745 | /* |
749 | /* |
746 | * To achieve deterministic behavior, zero out arguments that are beyond |
750 | * To achieve deterministic behavior, zero out arguments that are beyond |
747 | * the limits of the fast version. |
751 | * the limits of the fast version. |
748 | */ |
752 | */ |
749 | IPC_SET_ARG5(call->data, 0); |
753 | IPC_SET_ARG5(call->data, 0); |
750 | 754 | ||
751 | if (!(res = request_preprocess(call, phone))) |
755 | if (!(res = request_preprocess(call, phone))) |
752 | ipc_call(phone, call); |
756 | ipc_call(phone, call); |
753 | else |
757 | else |
754 | ipc_backsend_err(phone, call, res); |
758 | ipc_backsend_err(phone, call, res); |
755 | 759 | ||
756 | return (unative_t) call; |
760 | return (unative_t) call; |
757 | } |
761 | } |
758 | 762 | ||
759 | /** Make an asynchronous IPC call allowing to transmit the entire payload. |
763 | /** Make an asynchronous IPC call allowing to transmit the entire payload. |
760 | * |
764 | * |
761 | * @param phoneid Phone handle for the call. |
765 | * @param phoneid Phone handle for the call. |
762 | * @param data Userspace address of call data with the request. |
766 | * @param data Userspace address of call data with the request. |
763 | * |
767 | * |
764 | * @return See sys_ipc_call_async_fast(). |
768 | * @return See sys_ipc_call_async_fast(). |
765 | */ |
769 | */ |
766 | unative_t sys_ipc_call_async_slow(unative_t phoneid, ipc_data_t *data) |
770 | unative_t sys_ipc_call_async_slow(unative_t phoneid, ipc_data_t *data) |
767 | { |
771 | { |
768 | call_t *call; |
772 | call_t *call; |
769 | phone_t *phone; |
773 | phone_t *phone; |
770 | int res; |
774 | int res; |
771 | int rc; |
775 | int rc; |
772 | 776 | ||
773 | if (check_call_limit()) |
777 | if (check_call_limit()) |
774 | return IPC_CALLRET_TEMPORARY; |
778 | return IPC_CALLRET_TEMPORARY; |
775 | 779 | ||
776 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
780 | GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL); |
777 | 781 | ||
778 | call = ipc_call_alloc(0); |
782 | call = ipc_call_alloc(0); |
779 | rc = copy_from_uspace(&call->data.args, &data->args, |
783 | rc = copy_from_uspace(&call->data.args, &data->args, |
780 | sizeof(call->data.args)); |
784 | sizeof(call->data.args)); |
781 | if (rc != 0) { |
785 | if (rc != 0) { |
782 | ipc_call_free(call); |
786 | ipc_call_free(call); |
783 | return (unative_t) rc; |
787 | return (unative_t) rc; |
784 | } |
788 | } |
785 | if (!(res = request_preprocess(call, phone))) |
789 | if (!(res = request_preprocess(call, phone))) |
786 | ipc_call(phone, call); |
790 | ipc_call(phone, call); |
787 | else |
791 | else |
788 | ipc_backsend_err(phone, call, res); |
792 | ipc_backsend_err(phone, call, res); |
789 | 793 | ||
790 | return (unative_t) call; |
794 | return (unative_t) call; |
791 | } |
795 | } |
792 | 796 | ||
793 | /** Forward a received call to another destination. |
797 | /** Forward a received call to another destination. |
794 | * |
798 | * |
795 | * @param callid Hash of the call to forward. |
799 | * @param callid Hash of the call to forward. |
796 | * @param phoneid Phone handle to use for forwarding. |
800 | * @param phoneid Phone handle to use for forwarding. |
797 | * @param method New method to use for the forwarded call. |
801 | * @param method New method to use for the forwarded call. |
798 | * @param arg1 New value of the first argument for the forwarded call. |
802 | * @param arg1 New value of the first argument for the forwarded call. |
799 | * @param arg2 New value of the second argument for the forwarded call. |
803 | * @param arg2 New value of the second argument for the forwarded call. |
800 | * @param mode Flags that specify mode of the forward operation. |
804 | * @param mode Flags that specify mode of the forward operation. |
801 | * |
805 | * |
802 | * @return Return 0 on succes, otherwise return an error code. |
806 | * @return Return 0 on succes, otherwise return an error code. |
803 | * |
807 | * |
804 | * In case the original method is a system method, ARG1, ARG2 and ARG3 are |
808 | * In case the original method is a system method, ARG1, ARG2 and ARG3 are |
805 | * overwritten in the forwarded message with the new method and the new arg1 and |
809 | * overwritten in the forwarded message with the new method and the new arg1 and |
806 | * arg2, respectively. Otherwise the METHOD, ARG1 and ARG2 are rewritten with |
810 | * arg2, respectively. Otherwise the METHOD, ARG1 and ARG2 are rewritten with |
807 | * the new method, arg1 and arg2, respectively. Also note there is a set of |
811 | * the new method, arg1 and arg2, respectively. Also note there is a set of |
808 | * immutable methods, for which the new method and argument is not set and |
812 | * immutable methods, for which the new method and argument is not set and |
809 | * these values are ignored. |
813 | * these values are ignored. |
810 | * |
814 | * |
811 | * Warning: When implementing support for changing additional payload |
815 | * Warning: When implementing support for changing additional payload |
812 | * arguments, make sure that ARG5 is not rewritten for certain |
816 | * arguments, make sure that ARG5 is not rewritten for certain |
813 | * system IPC |
817 | * system IPC |
814 | */ |
818 | */ |
815 | unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid, |
819 | unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid, |
816 | unative_t method, unative_t arg1, unative_t arg2, int mode) |
820 | unative_t method, unative_t arg1, unative_t arg2, int mode) |
817 | { |
821 | { |
818 | call_t *call; |
822 | call_t *call; |
819 | phone_t *phone; |
823 | phone_t *phone; |
820 | 824 | ||
821 | call = get_call(callid); |
825 | call = get_call(callid); |
822 | if (!call) |
826 | if (!call) |
823 | return ENOENT; |
827 | return ENOENT; |
824 | 828 | ||
825 | call->flags |= IPC_CALL_FORWARDED; |
829 | call->flags |= IPC_CALL_FORWARDED; |
826 | 830 | ||
827 | GET_CHECK_PHONE(phone, phoneid, { |
831 | GET_CHECK_PHONE(phone, phoneid, { |
828 | IPC_SET_RETVAL(call->data, EFORWARD); |
832 | IPC_SET_RETVAL(call->data, EFORWARD); |
829 | ipc_answer(&TASK->answerbox, call); |
833 | ipc_answer(&TASK->answerbox, call); |
830 | return ENOENT; |
834 | return ENOENT; |
831 | }); |
835 | }); |
832 | 836 | ||
833 | if (!method_is_forwardable(IPC_GET_METHOD(call->data))) { |
837 | if (!method_is_forwardable(IPC_GET_METHOD(call->data))) { |
834 | IPC_SET_RETVAL(call->data, EFORWARD); |
838 | IPC_SET_RETVAL(call->data, EFORWARD); |
835 | ipc_answer(&TASK->answerbox, call); |
839 | ipc_answer(&TASK->answerbox, call); |
836 | return EPERM; |
840 | return EPERM; |
837 | } |
841 | } |
838 | 842 | ||
839 | /* |
843 | /* |
840 | * Userspace is not allowed to change method of system methods on |
844 | * Userspace is not allowed to change method of system methods on |
841 | * forward, allow changing ARG1, ARG2 and ARG3 by means of method, |
845 | * forward, allow changing ARG1, ARG2 and ARG3 by means of method, |
842 | * arg1 and arg2. |
846 | * arg1 and arg2. |
843 | * If the method is immutable, don't change anything. |
847 | * If the method is immutable, don't change anything. |
844 | */ |
848 | */ |
845 | if (!method_is_immutable(IPC_GET_METHOD(call->data))) { |
849 | if (!method_is_immutable(IPC_GET_METHOD(call->data))) { |
846 | if (method_is_system(IPC_GET_METHOD(call->data))) { |
850 | if (method_is_system(IPC_GET_METHOD(call->data))) { |
847 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) |
851 | if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) |
848 | phone_dealloc(IPC_GET_ARG5(call->data)); |
852 | phone_dealloc(IPC_GET_ARG5(call->data)); |
849 | 853 | ||
850 | IPC_SET_ARG1(call->data, method); |
854 | IPC_SET_ARG1(call->data, method); |
851 | IPC_SET_ARG2(call->data, arg1); |
855 | IPC_SET_ARG2(call->data, arg1); |
852 | IPC_SET_ARG3(call->data, arg2); |
856 | IPC_SET_ARG3(call->data, arg2); |
853 | } else { |
857 | } else { |
854 | IPC_SET_METHOD(call->data, method); |
858 | IPC_SET_METHOD(call->data, method); |
855 | IPC_SET_ARG1(call->data, arg1); |
859 | IPC_SET_ARG1(call->data, arg1); |
856 | IPC_SET_ARG2(call->data, arg2); |
860 | IPC_SET_ARG2(call->data, arg2); |
857 | } |
861 | } |
858 | } |
862 | } |
859 | 863 | ||
860 | return ipc_forward(call, phone, &TASK->answerbox, mode); |
864 | return ipc_forward(call, phone, &TASK->answerbox, mode); |
861 | } |
865 | } |
862 | 866 | ||
863 | /** Answer an IPC call - fast version. |
867 | /** Answer an IPC call - fast version. |
864 | * |
868 | * |
865 | * This function can handle only two return arguments of payload, but is faster |
869 | * This function can handle only two return arguments of payload, but is faster |
866 | * than the generic sys_ipc_answer(). |
870 | * than the generic sys_ipc_answer(). |
867 | * |
871 | * |
868 | * @param callid Hash of the call to be answered. |
872 | * @param callid Hash of the call to be answered. |
869 | * @param retval Return value of the answer. |
873 | * @param retval Return value of the answer. |
870 | * @param arg1 Service-defined return value. |
874 | * @param arg1 Service-defined return value. |
871 | * @param arg2 Service-defined return value. |
875 | * @param arg2 Service-defined return value. |
872 | * @param arg3 Service-defined return value. |
876 | * @param arg3 Service-defined return value. |
873 | * @param arg4 Service-defined return value. |
877 | * @param arg4 Service-defined return value. |
874 | * |
878 | * |
875 | * @return Return 0 on success, otherwise return an error code. |
879 | * @return Return 0 on success, otherwise return an error code. |
876 | */ |
880 | */ |
877 | unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval, |
881 | unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval, |
878 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
882 | unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4) |
879 | { |
883 | { |
880 | call_t *call; |
884 | call_t *call; |
881 | ipc_data_t saved_data; |
885 | ipc_data_t saved_data; |
882 | int saveddata = 0; |
886 | int saveddata = 0; |
883 | int rc; |
887 | int rc; |
884 | 888 | ||
885 | /* Do not answer notification callids */ |
889 | /* Do not answer notification callids */ |
886 | if (callid & IPC_CALLID_NOTIFICATION) |
890 | if (callid & IPC_CALLID_NOTIFICATION) |
887 | return 0; |
891 | return 0; |
888 | 892 | ||
889 | call = get_call(callid); |
893 | call = get_call(callid); |
890 | if (!call) |
894 | if (!call) |
891 | return ENOENT; |
895 | return ENOENT; |
892 | 896 | ||
893 | if (answer_need_old(call)) { |
897 | if (answer_need_old(call)) { |
894 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
898 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
895 | saveddata = 1; |
899 | saveddata = 1; |
896 | } |
900 | } |
897 | 901 | ||
898 | IPC_SET_RETVAL(call->data, retval); |
902 | IPC_SET_RETVAL(call->data, retval); |
899 | IPC_SET_ARG1(call->data, arg1); |
903 | IPC_SET_ARG1(call->data, arg1); |
900 | IPC_SET_ARG2(call->data, arg2); |
904 | IPC_SET_ARG2(call->data, arg2); |
901 | IPC_SET_ARG3(call->data, arg3); |
905 | IPC_SET_ARG3(call->data, arg3); |
902 | IPC_SET_ARG4(call->data, arg4); |
906 | IPC_SET_ARG4(call->data, arg4); |
903 | /* |
907 | /* |
904 | * To achieve deterministic behavior, zero out arguments that are beyond |
908 | * To achieve deterministic behavior, zero out arguments that are beyond |
905 | * the limits of the fast version. |
909 | * the limits of the fast version. |
906 | */ |
910 | */ |
907 | IPC_SET_ARG5(call->data, 0); |
911 | IPC_SET_ARG5(call->data, 0); |
908 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
912 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
909 | 913 | ||
910 | ipc_answer(&TASK->answerbox, call); |
914 | ipc_answer(&TASK->answerbox, call); |
911 | return rc; |
915 | return rc; |
912 | } |
916 | } |
913 | 917 | ||
914 | /** Answer an IPC call. |
918 | /** Answer an IPC call. |
915 | * |
919 | * |
916 | * @param callid Hash of the call to be answered. |
920 | * @param callid Hash of the call to be answered. |
917 | * @param data Userspace address of call data with the answer. |
921 | * @param data Userspace address of call data with the answer. |
918 | * |
922 | * |
919 | * @return Return 0 on success, otherwise return an error code. |
923 | * @return Return 0 on success, otherwise return an error code. |
920 | */ |
924 | */ |
921 | unative_t sys_ipc_answer_slow(unative_t callid, ipc_data_t *data) |
925 | unative_t sys_ipc_answer_slow(unative_t callid, ipc_data_t *data) |
922 | { |
926 | { |
923 | call_t *call; |
927 | call_t *call; |
924 | ipc_data_t saved_data; |
928 | ipc_data_t saved_data; |
925 | int saveddata = 0; |
929 | int saveddata = 0; |
926 | int rc; |
930 | int rc; |
927 | 931 | ||
928 | /* Do not answer notification callids */ |
932 | /* Do not answer notification callids */ |
929 | if (callid & IPC_CALLID_NOTIFICATION) |
933 | if (callid & IPC_CALLID_NOTIFICATION) |
930 | return 0; |
934 | return 0; |
931 | 935 | ||
932 | call = get_call(callid); |
936 | call = get_call(callid); |
933 | if (!call) |
937 | if (!call) |
934 | return ENOENT; |
938 | return ENOENT; |
935 | 939 | ||
936 | if (answer_need_old(call)) { |
940 | if (answer_need_old(call)) { |
937 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
941 | memcpy(&saved_data, &call->data, sizeof(call->data)); |
938 | saveddata = 1; |
942 | saveddata = 1; |
939 | } |
943 | } |
940 | rc = copy_from_uspace(&call->data.args, &data->args, |
944 | rc = copy_from_uspace(&call->data.args, &data->args, |
941 | sizeof(call->data.args)); |
945 | sizeof(call->data.args)); |
942 | if (rc != 0) |
946 | if (rc != 0) |
943 | return rc; |
947 | return rc; |
944 | 948 | ||
945 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
949 | rc = answer_preprocess(call, saveddata ? &saved_data : NULL); |
946 | 950 | ||
947 | ipc_answer(&TASK->answerbox, call); |
951 | ipc_answer(&TASK->answerbox, call); |
948 | 952 | ||
949 | return rc; |
953 | return rc; |
950 | } |
954 | } |
951 | 955 | ||
952 | /** Hang up a phone. |
956 | /** Hang up a phone. |
953 | * |
957 | * |
954 | * @param Phone handle of the phone to be hung up. |
958 | * @param Phone handle of the phone to be hung up. |
955 | * |
959 | * |
956 | * @return Return 0 on success or an error code. |
960 | * @return Return 0 on success or an error code. |
957 | */ |
961 | */ |
958 | unative_t sys_ipc_hangup(int phoneid) |
962 | unative_t sys_ipc_hangup(int phoneid) |
959 | { |
963 | { |
960 | phone_t *phone; |
964 | phone_t *phone; |
961 | 965 | ||
962 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
966 | GET_CHECK_PHONE(phone, phoneid, return ENOENT); |
963 | 967 | ||
964 | if (ipc_phone_hangup(phone)) |
968 | if (ipc_phone_hangup(phone)) |
965 | return -1; |
969 | return -1; |
966 | 970 | ||
967 | return 0; |
971 | return 0; |
968 | } |
972 | } |
969 | 973 | ||
970 | /** Wait for an incoming IPC call or an answer. |
974 | /** Wait for an incoming IPC call or an answer. |
971 | * |
975 | * |
972 | * @param calldata Pointer to buffer where the call/answer data is stored. |
976 | * @param calldata Pointer to buffer where the call/answer data is stored. |
973 | * @param usec Timeout. See waitq_sleep_timeout() for explanation. |
977 | * @param usec Timeout. See waitq_sleep_timeout() for explanation. |
974 | * @param flags Select mode of sleep operation. See waitq_sleep_timeout() |
978 | * @param flags Select mode of sleep operation. See waitq_sleep_timeout() |
975 | * for explanation. |
979 | * for explanation. |
976 | * |
980 | * |
977 | * @return Hash of the call. |
981 | * @return Hash of the call. |
978 | * If IPC_CALLID_NOTIFICATION bit is set in the hash, the |
982 | * If IPC_CALLID_NOTIFICATION bit is set in the hash, the |
979 | * call is a notification. IPC_CALLID_ANSWERED denotes an |
983 | * call is a notification. IPC_CALLID_ANSWERED denotes an |
980 | * answer. |
984 | * answer. |
981 | */ |
985 | */ |
982 | unative_t sys_ipc_wait_for_call(ipc_data_t *calldata, uint32_t usec, int flags) |
986 | unative_t sys_ipc_wait_for_call(ipc_data_t *calldata, uint32_t usec, int flags) |
983 | { |
987 | { |
984 | call_t *call; |
988 | call_t *call; |
985 | 989 | ||
986 | restart: |
990 | restart: |
987 | call = ipc_wait_for_call(&TASK->answerbox, usec, |
991 | call = ipc_wait_for_call(&TASK->answerbox, usec, |
988 | flags | SYNCH_FLAGS_INTERRUPTIBLE); |
992 | flags | SYNCH_FLAGS_INTERRUPTIBLE); |
989 | if (!call) |
993 | if (!call) |
990 | return 0; |
994 | return 0; |
991 | 995 | ||
992 | if (call->flags & IPC_CALL_NOTIF) { |
996 | if (call->flags & IPC_CALL_NOTIF) { |
993 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
997 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
994 | 998 | ||
995 | /* Set in_phone_hash to the interrupt counter */ |
999 | /* Set in_phone_hash to the interrupt counter */ |
996 | call->data.phone = (void *) call->priv; |
1000 | call->data.phone = (void *) call->priv; |
997 | 1001 | ||
998 | STRUCT_TO_USPACE(calldata, &call->data); |
1002 | STRUCT_TO_USPACE(calldata, &call->data); |
999 | 1003 | ||
1000 | ipc_call_free(call); |
1004 | ipc_call_free(call); |
1001 | 1005 | ||
1002 | return ((unative_t) call) | IPC_CALLID_NOTIFICATION; |
1006 | return ((unative_t) call) | IPC_CALLID_NOTIFICATION; |
1003 | } |
1007 | } |
1004 | 1008 | ||
1005 | if (call->flags & IPC_CALL_ANSWERED) { |
1009 | if (call->flags & IPC_CALL_ANSWERED) { |
1006 | process_answer(call); |
1010 | process_answer(call); |
1007 | 1011 | ||
1008 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
1012 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
1009 | 1013 | ||
1010 | atomic_dec(&TASK->active_calls); |
1014 | atomic_dec(&TASK->active_calls); |
1011 | 1015 | ||
1012 | if (call->flags & IPC_CALL_DISCARD_ANSWER) { |
1016 | if (call->flags & IPC_CALL_DISCARD_ANSWER) { |
1013 | ipc_call_free(call); |
1017 | ipc_call_free(call); |
1014 | goto restart; |
1018 | goto restart; |
1015 | } |
1019 | } |
1016 | 1020 | ||
1017 | STRUCT_TO_USPACE(&calldata->args, &call->data.args); |
1021 | STRUCT_TO_USPACE(&calldata->args, &call->data.args); |
1018 | ipc_call_free(call); |
1022 | ipc_call_free(call); |
1019 | 1023 | ||
1020 | return ((unative_t) call) | IPC_CALLID_ANSWERED; |
1024 | return ((unative_t) call) | IPC_CALLID_ANSWERED; |
1021 | } |
1025 | } |
1022 | 1026 | ||
1023 | if (process_request(&TASK->answerbox, call)) |
1027 | if (process_request(&TASK->answerbox, call)) |
1024 | goto restart; |
1028 | goto restart; |
1025 | 1029 | ||
1026 | /* Include phone address('id') of the caller in the request, |
1030 | /* Include phone address('id') of the caller in the request, |
1027 | * copy whole call->data, not only call->data.args */ |
1031 | * copy whole call->data, not only call->data.args */ |
1028 | if (STRUCT_TO_USPACE(calldata, &call->data)) { |
1032 | if (STRUCT_TO_USPACE(calldata, &call->data)) { |
1029 | return 0; |
1033 | return 0; |
1030 | } |
1034 | } |
1031 | return (unative_t)call; |
1035 | return (unative_t)call; |
1032 | } |
1036 | } |
1033 | 1037 | ||
1034 | /** Connect an IRQ handler to a task. |
1038 | /** Connect an IRQ handler to a task. |
1035 | * |
1039 | * |
1036 | * @param inr IRQ number. |
1040 | * @param inr IRQ number. |
1037 | * @param devno Device number. |
1041 | * @param devno Device number. |
1038 | * @param method Method to be associated with the notification. |
1042 | * @param method Method to be associated with the notification. |
1039 | * @param ucode Uspace pointer to the top-half pseudocode. |
1043 | * @param ucode Uspace pointer to the top-half pseudocode. |
1040 | * |
1044 | * |
1041 | * @return EPERM or a return code returned by ipc_irq_register(). |
1045 | * @return EPERM or a return code returned by ipc_irq_register(). |
1042 | */ |
1046 | */ |
1043 | unative_t sys_ipc_register_irq(inr_t inr, devno_t devno, unative_t method, |
1047 | unative_t sys_ipc_register_irq(inr_t inr, devno_t devno, unative_t method, |
1044 | irq_code_t *ucode) |
1048 | irq_code_t *ucode) |
1045 | { |
1049 | { |
1046 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
1050 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
1047 | return EPERM; |
1051 | return EPERM; |
1048 | 1052 | ||
1049 | return ipc_irq_register(&TASK->answerbox, inr, devno, method, ucode); |
1053 | return ipc_irq_register(&TASK->answerbox, inr, devno, method, ucode); |
1050 | } |
1054 | } |
1051 | 1055 | ||
1052 | /** Disconnect an IRQ handler from a task. |
1056 | /** Disconnect an IRQ handler from a task. |
1053 | * |
1057 | * |
1054 | * @param inr IRQ number. |
1058 | * @param inr IRQ number. |
1055 | * @param devno Device number. |
1059 | * @param devno Device number. |
1056 | * |
1060 | * |
1057 | * @return Zero on success or EPERM on error.. |
1061 | * @return Zero on success or EPERM on error.. |
1058 | */ |
1062 | */ |
1059 | unative_t sys_ipc_unregister_irq(inr_t inr, devno_t devno) |
1063 | unative_t sys_ipc_unregister_irq(inr_t inr, devno_t devno) |
1060 | { |
1064 | { |
1061 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
1065 | if (!(cap_get(TASK) & CAP_IRQ_REG)) |
1062 | return EPERM; |
1066 | return EPERM; |
1063 | 1067 | ||
1064 | ipc_irq_unregister(&TASK->answerbox, inr, devno); |
1068 | ipc_irq_unregister(&TASK->answerbox, inr, devno); |
1065 | 1069 | ||
1066 | return 0; |
1070 | return 0; |
1067 | } |
1071 | } |
1068 | 1072 | ||
1069 | #include <console/klog.h> |
1073 | #include <console/klog.h> |
1070 | 1074 | ||
1071 | /** |
1075 | /** |
1072 | * Syscall connect to a task by id. |
1076 | * Syscall connect to a task by id. |
1073 | * |
1077 | * |
1074 | * @return Phone id on success, or negative error code. |
1078 | * @return Phone id on success, or negative error code. |
1075 | */ |
1079 | */ |
1076 | unative_t sys_ipc_connect_task(sysarg64_t *uspace_taskid_arg) |
1080 | unative_t sys_ipc_connect_kbox(sysarg64_t *uspace_taskid_arg) |
1077 | { |
1081 | { |
1078 | sysarg64_t taskid_arg; |
1082 | sysarg64_t taskid_arg; |
1079 | int rc; |
1083 | int rc; |
1080 | 1084 | ||
1081 | rc = copy_from_uspace(&taskid_arg, uspace_taskid_arg, sizeof(sysarg64_t)); |
1085 | rc = copy_from_uspace(&taskid_arg, uspace_taskid_arg, sizeof(sysarg64_t)); |
1082 | if (rc != 0) |
1086 | if (rc != 0) |
1083 | return (unative_t) rc; |
1087 | return (unative_t) rc; |
1084 | 1088 | ||
1085 | klog_printf("sys_ipc_connect_kbox(%lld, %d)", taskid_arg.value); |
1089 | klog_printf("sys_ipc_connect_kbox(%lld, %d)", taskid_arg.value); |
1086 | 1090 | ||
1087 | return ipc_connect_task(taskid_arg.value); |
1091 | return ipc_connect_kbox(taskid_arg.value); |
1088 | } |
1092 | } |
1089 | 1093 | ||
1090 | /** @} |
1094 | /** @} |
1091 | */ |
1095 | */ |
1092 | 1096 |