Rev 1502 | Rev 1573 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1502 | Rev 1568 | ||
---|---|---|---|
Line 109... | Line 109... | ||
109 | void ipc_phone_connect(phone_t *phone, answerbox_t *box) |
109 | void ipc_phone_connect(phone_t *phone, answerbox_t *box) |
110 | { |
110 | { |
111 | spinlock_lock(&phone->lock); |
111 | spinlock_lock(&phone->lock); |
112 | 112 | ||
113 | ASSERT(!phone->callee); |
113 | ASSERT(!phone->callee); |
114 | phone->busy = IPC_BUSY_CONNECTED; |
114 | phone->state = IPC_PHONE_CONNECTED; |
115 | phone->callee = box; |
115 | phone->callee = box; |
116 | 116 | ||
117 | spinlock_lock(&box->lock); |
117 | spinlock_lock(&box->lock); |
118 | list_append(&phone->list, &box->connected_phones); |
118 | list_append(&phone->list, &box->connected_phones); |
119 | spinlock_unlock(&box->lock); |
119 | spinlock_unlock(&box->lock); |
Line 125... | Line 125... | ||
125 | */ |
125 | */ |
126 | void ipc_phone_init(phone_t *phone) |
126 | void ipc_phone_init(phone_t *phone) |
127 | { |
127 | { |
128 | spinlock_initialize(&phone->lock, "phone_lock"); |
128 | spinlock_initialize(&phone->lock, "phone_lock"); |
129 | phone->callee = NULL; |
129 | phone->callee = NULL; |
130 | phone->busy = IPC_BUSY_FREE; |
130 | phone->state = IPC_PHONE_FREE; |
131 | atomic_set(&phone->active_calls, 0); |
131 | atomic_set(&phone->active_calls, 0); |
132 | } |
132 | } |
133 | 133 | ||
134 | /** Helper function to facilitate synchronous calls */ |
134 | /** Helper function to facilitate synchronous calls */ |
135 | void ipc_call_sync(phone_t *phone, call_t *request) |
135 | void ipc_call_sync(phone_t *phone, call_t *request) |
Line 182... | Line 182... | ||
182 | */ |
182 | */ |
183 | void ipc_backsend_err(phone_t *phone, call_t *call, __native err) |
183 | void ipc_backsend_err(phone_t *phone, call_t *call, __native err) |
184 | { |
184 | { |
185 | call->data.phone = phone; |
185 | call->data.phone = phone; |
186 | atomic_inc(&phone->active_calls); |
186 | atomic_inc(&phone->active_calls); |
187 | if (phone->busy == IPC_BUSY_CONNECTED) |
- | |
188 | IPC_SET_RETVAL(call->data, EHANGUP); |
- | |
189 | else |
- | |
190 | IPC_SET_RETVAL(call->data, ENOENT); |
187 | IPC_SET_RETVAL(call->data, err); |
191 | - | ||
192 | _ipc_answer_free_call(call); |
188 | _ipc_answer_free_call(call); |
193 | } |
189 | } |
194 | 190 | ||
195 | /* Unsafe unchecking ipc_call */ |
191 | /* Unsafe unchecking ipc_call */ |
196 | static void _ipc_call(phone_t *phone, answerbox_t *box, call_t *call) |
192 | static void _ipc_call(phone_t *phone, answerbox_t *box, call_t *call) |
Line 214... | Line 210... | ||
214 | int ipc_call(phone_t *phone, call_t *call) |
210 | int ipc_call(phone_t *phone, call_t *call) |
215 | { |
211 | { |
216 | answerbox_t *box; |
212 | answerbox_t *box; |
217 | 213 | ||
218 | spinlock_lock(&phone->lock); |
214 | spinlock_lock(&phone->lock); |
219 | - | ||
220 | box = phone->callee; |
- | |
221 | if (!box) { |
- | |
222 | /* Trying to send over disconnected phone */ |
215 | if (phone->state != IPC_PHONE_CONNECTED) { |
223 | spinlock_unlock(&phone->lock); |
216 | spinlock_unlock(&phone->lock); |
224 | if (call->flags & IPC_CALL_FORWARDED) { |
217 | if (call->flags & IPC_CALL_FORWARDED) { |
225 | IPC_SET_RETVAL(call->data, EFORWARD); |
218 | IPC_SET_RETVAL(call->data, EFORWARD); |
226 | _ipc_answer_free_call(call); |
219 | _ipc_answer_free_call(call); |
227 | } else { /* Simulate sending back a message */ |
220 | } else { |
228 | if (phone->busy == IPC_BUSY_CONNECTED) |
221 | if (phone->state == IPC_PHONE_HUNGUP) |
229 | ipc_backsend_err(phone, call, EHANGUP); |
222 | ipc_backsend_err(phone, call, EHANGUP); |
230 | else |
223 | else |
231 | ipc_backsend_err(phone, call, ENOENT); |
224 | ipc_backsend_err(phone, call, ENOENT); |
232 | } |
225 | } |
233 | - | ||
234 | return ENOENT; |
226 | return ENOENT; |
235 | } |
227 | } |
- | 228 | box = phone->callee; |
|
236 | _ipc_call(phone, box, call); |
229 | _ipc_call(phone, box, call); |
237 | 230 | ||
238 | spinlock_unlock(&phone->lock); |
231 | spinlock_unlock(&phone->lock); |
239 | return 0; |
232 | return 0; |
240 | } |
233 | } |
241 | 234 | ||
242 | /** Disconnect phone from answerbox |
235 | /** Disconnect phone from answerbox |
243 | * |
236 | * |
244 | * It is allowed to call disconnect on already disconnected phone |
237 | * This call leaves the phone in HUNGUP state. The change to 'free' is done |
- | 238 | * lazily later. |
|
245 | * |
239 | * |
- | 240 | * @param phone Phone to be hung up |
|
- | 241 | * @param aggressive If false, the phone is only marked hungup, and all |
|
- | 242 | * messages are allowed to complete. |
|
- | 243 | * If true, all messages in all queues are discarded. There |
|
- | 244 | * may still be some messages that will be 'in-transit' on |
|
- | 245 | * other CPU. |
|
- | 246 | * |
|
246 | * @return 0 - phone disconnected, -1 - the phone was already disconnected |
247 | * @return 0 - phone disconnected, -1 - the phone was already disconnected |
247 | */ |
248 | */ |
248 | int ipc_phone_hangup(phone_t *phone) |
249 | int ipc_phone_hangup(phone_t *phone, int aggressive) |
249 | { |
250 | { |
250 | answerbox_t *box; |
251 | answerbox_t *box; |
251 | call_t *call; |
252 | call_t *call; |
252 | 253 | ||
253 | spinlock_lock(&phone->lock); |
254 | spinlock_lock(&phone->lock); |
254 | box = phone->callee; |
- | |
255 | if (!box) { |
- | |
256 | if (phone->busy == IPC_BUSY_CONNECTING) { |
255 | if (phone->state == IPC_PHONE_FREE || phone->state ==IPC_PHONE_HUNGUP \ |
257 | spinlock_unlock(&phone->lock); |
- | |
258 | return -1; |
- | |
259 | } |
- | |
260 | /* Already disconnected phone */ |
- | |
261 | phone->busy = IPC_BUSY_FREE; |
256 | || phone->state == IPC_PHONE_CONNECTING) { |
262 | spinlock_unlock(&phone->lock); |
257 | spinlock_unlock(&phone->lock); |
263 | return 0; |
258 | return -1; |
264 | } |
259 | } |
- | 260 | box = phone->callee; |
|
- | 261 | if (phone->state != IPC_PHONE_SLAMMED) { |
|
- | 262 | /* Remove myself from answerbox */ |
|
- | 263 | spinlock_lock(&box->lock); |
|
- | 264 | list_remove(&phone->list); |
|
- | 265 | spinlock_unlock(&box->lock); |
|
265 | 266 | ||
266 | spinlock_lock(&box->lock); |
- | |
267 | list_remove(&phone->list); |
- | |
268 | phone->callee = NULL; |
267 | if (phone->state != IPC_PHONE_SLAMMED) { |
269 | spinlock_unlock(&box->lock); |
- | |
270 | - | ||
271 | call = ipc_call_alloc(0); |
268 | call = ipc_call_alloc(0); |
272 | IPC_SET_METHOD(call->data, IPC_M_PHONE_HUNGUP); |
269 | IPC_SET_METHOD(call->data, IPC_M_PHONE_HUNGUP); |
273 | call->flags |= IPC_CALL_DISCARD_ANSWER; |
270 | call->flags |= IPC_CALL_DISCARD_ANSWER; |
274 | _ipc_call(phone, box, call); |
271 | _ipc_call(phone, box, call); |
- | 272 | } |
|
- | 273 | } |
|
275 | 274 | ||
- | 275 | if (aggressive && atomic_get(&phone->active_calls) > 0) { |
|
276 | phone->busy = IPC_BUSY_FREE; |
276 | /* TODO: Do some stuff be VERY aggressive */ |
- | 277 | } |
|
277 | 278 | ||
- | 279 | phone->callee = 0; |
|
- | 280 | ||
- | 281 | phone->state = IPC_PHONE_HUNGUP; |
|
278 | spinlock_unlock(&phone->lock); |
282 | spinlock_unlock(&phone->lock); |
279 | 283 | ||
280 | return 0; |
284 | return 0; |
281 | } |
285 | } |
282 | 286 | ||
Line 378... | Line 382... | ||
378 | call_t *call; |
382 | call_t *call; |
379 | phone_t *phone; |
383 | phone_t *phone; |
380 | 384 | ||
381 | /* Disconnect all our phones ('ipc_phone_hangup') */ |
385 | /* Disconnect all our phones ('ipc_phone_hangup') */ |
382 | for (i=0;i < IPC_MAX_PHONES; i++) |
386 | for (i=0;i < IPC_MAX_PHONES; i++) |
383 | ipc_phone_hangup(&task->phones[i]); |
387 | ipc_phone_hangup(&task->phones[i], 1); |
384 | 388 | ||
385 | /* Disconnect all connected irqs */ |
389 | /* Disconnect all connected irqs */ |
386 | ipc_irq_cleanup(&task->answerbox); |
390 | ipc_irq_cleanup(&task->answerbox); |
387 | 391 | ||
388 | /* Disconnect all phones connected to our answerbox */ |
392 | /* Disconnect all phones connected to our answerbox */ |
Line 396... | Line 400... | ||
396 | spinlock_unlock(&task->answerbox.lock); |
400 | spinlock_unlock(&task->answerbox.lock); |
397 | goto restart_phones; |
401 | goto restart_phones; |
398 | } |
402 | } |
399 | 403 | ||
400 | /* Disconnect phone */ |
404 | /* Disconnect phone */ |
- | 405 | ASSERT(phone->state == IPC_PHONE_CONNECTED); |
|
401 | phone->callee = NULL; |
406 | phone->state = IPC_PHONE_SLAMMED; |
402 | list_remove(&phone->list); |
407 | list_remove(&phone->list); |
403 | 408 | ||
404 | spinlock_unlock(&phone->lock); |
409 | spinlock_unlock(&phone->lock); |
405 | } |
410 | } |
406 | 411 | ||
Line 409... | Line 414... | ||
409 | ipc_cleanup_call_list(&task->answerbox.dispatched_calls); |
414 | ipc_cleanup_call_list(&task->answerbox.dispatched_calls); |
410 | ipc_cleanup_call_list(&task->answerbox.calls); |
415 | ipc_cleanup_call_list(&task->answerbox.calls); |
411 | spinlock_unlock(&task->answerbox.lock); |
416 | spinlock_unlock(&task->answerbox.lock); |
412 | 417 | ||
413 | /* Wait for all async answers to arrive */ |
418 | /* Wait for all async answers to arrive */ |
- | 419 | while (1) { |
|
- | 420 | /* Go through all phones, until all are FREE... */ |
|
- | 421 | /* Locking not needed, no one else should modify |
|
- | 422 | * it, when we are in cleanup */ |
|
- | 423 | for (i=0;i < IPC_MAX_PHONES; i++) { |
|
- | 424 | if (task->phones[i].state == IPC_PHONE_HUNGUP && \ |
|
414 | while (atomic_get(&task->active_calls)) { |
425 | atomic_get(&task->phones[i].active_calls) == 0) |
- | 426 | task->phones[i].state = IPC_PHONE_FREE; |
|
- | 427 | if (task->phones[i].state != IPC_PHONE_FREE) |
|
- | 428 | break; |
|
- | 429 | } |
|
- | 430 | /* Voila, got into cleanup */ |
|
- | 431 | if (i == IPC_MAX_PHONES) |
|
- | 432 | break; |
|
- | 433 | ||
415 | call = ipc_wait_for_call(&task->answerbox, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE); |
434 | call = ipc_wait_for_call(&task->answerbox, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE); |
416 | ASSERT((call->flags & IPC_CALL_ANSWERED) || (call->flags & IPC_CALL_NOTIF)); |
435 | ASSERT((call->flags & IPC_CALL_ANSWERED) || (call->flags & IPC_CALL_NOTIF)); |
417 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
436 | ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC)); |
418 | 437 | ||
419 | atomic_dec(&task->active_calls); |
438 | atomic_dec(&task->active_calls); |