WebSVN – HelenOS – Diff – /trunk/kernel/generic/src/ipc/ipc.c


/*
 * Copyright (c) 2006 Ondrej Palkovsky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/** @addtogroup genericipc
 * @{
 */
/** @file
 */
 
/* Lock ordering
 *
 * First the answerbox, then the phone
 */
 
#include <synch/spinlock.h>
#include <synch/waitq.h>
#include <synch/synch.h>
#include <ipc/ipc.h>
#include <errno.h>
#include <mm/slab.h>
#include <arch.h>
#include <proc/task.h>
#include <memstr.h>
#include <debug.h>
 
#include <print.h>
#include <proc/thread.h>
#include <arch/interrupt.h>
#include <ipc/irq.h>
 
/* Open channel that is assigned automatically to new tasks */
answerbox_t *ipc_phone_0 = NULL;
 
static slab_cache_t *ipc_call_slab;
 
/* Initialize new call */
static void _ipc_call_init(call_t *call)
{
    memsetb((uintptr_t)call, sizeof(*call), 0);
    call->callerbox = &TASK->answerbox;
    call->sender = TASK;
}
 
/** Allocate & initialize call structure
 *
 * The call is initialized, so that the reply will be directed
 * to TASK->answerbox
 *
 * @param flags Parameters for slab_alloc (ATOMIC, etc.)
 */
call_t * ipc_call_alloc(int flags)
{
    call_t *call;
 
    call = slab_alloc(ipc_call_slab, flags);
    _ipc_call_init(call);
 
    return call;
}
 
/** Initialize allocated call */
void ipc_call_static_init(call_t *call)
{
    _ipc_call_init(call);
    call->flags |= IPC_CALL_STATIC_ALLOC;
}
 
/** Deallocate call stracuture */
void ipc_call_free(call_t *call)
{
    slab_free(ipc_call_slab, call);
}
 
/** Initialize answerbox structure
 */
void ipc_answerbox_init(answerbox_t *box)
{
    spinlock_initialize(&box->lock, "ipc_box_lock");
    spinlock_initialize(&box->irq_lock, "ipc_box_irqlock");
    waitq_initialize(&box->wq);
    list_initialize(&box->connected_phones);
    list_initialize(&box->calls);
    list_initialize(&box->dispatched_calls);
    list_initialize(&box->answers);
    list_initialize(&box->irq_notifs);
    list_initialize(&box->irq_head);
    box->task = TASK;
}
 
/** Connect phone to answerbox */
void ipc_phone_connect(phone_t *phone, answerbox_t *box)
{
    spinlock_lock(&phone->lock);
 
    phone->state = IPC_PHONE_CONNECTED;
    phone->callee = box;
 
    spinlock_lock(&box->lock);
    list_append(&phone->link, &box->connected_phones);
    spinlock_unlock(&box->lock);
 
    spinlock_unlock(&phone->lock);
}
 
/** Initialize phone structure and connect phone to answerbox
 */
void ipc_phone_init(phone_t *phone)
{
    spinlock_initialize(&phone->lock, "phone_lock");
    phone->callee = NULL;
    phone->state = IPC_PHONE_FREE;
    atomic_set(&phone->active_calls, 0);
}
 
/** Helper function to facilitate synchronous calls */
void ipc_call_sync(phone_t *phone, call_t *request)
{
    answerbox_t sync_box;
 
    ipc_answerbox_init(&sync_box);
 
    /* We will receive data on special box */
    request->callerbox = &sync_box;
 
    ipc_call(phone, request);
    ipc_wait_for_call(&sync_box, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);
}
 
/** Answer message that was not dispatched and is not entered in
 * any queue
 */
static void _ipc_answer_free_call(call_t *call)
{
    answerbox_t *callerbox = call->callerbox;
 
    call->flags |= IPC_CALL_ANSWERED;
 
    spinlock_lock(&callerbox->lock);
    list_append(&call->link, &callerbox->answers);
    spinlock_unlock(&callerbox->lock);
    waitq_wakeup(&callerbox->wq, WAKEUP_FIRST);
}
 
/** Answer message, that is in callee queue
 *
 * @param box Answerbox that is answering the message
 * @param call Modified request that is being sent back
 */
void ipc_answer(answerbox_t *box, call_t *call)
{
    /* Remove from active box */
    spinlock_lock(&box->lock);
    list_remove(&call->link);
    spinlock_unlock(&box->lock);
    /* Send back answer */
    _ipc_answer_free_call(call);
}
 
/** Simulate sending back a message
 *
 * Most errors are better handled by forming a normal backward
 * message and sending it as a normal answer.
 */
void ipc_backsend_err(phone_t *phone, call_t *call, unative_t err)
{
    call->data.phone = phone;
    atomic_inc(&phone->active_calls);
    IPC_SET_RETVAL(call->data, err);
    _ipc_answer_free_call(call);
}
 
/* Unsafe unchecking ipc_call */
static void _ipc_call(phone_t *phone, answerbox_t *box, call_t *call)
{
    if (! (call->flags & IPC_CALL_FORWARDED)) {
        atomic_inc(&phone->active_calls);
        call->data.phone = phone;
    }
 
    spinlock_lock(&box->lock);
    list_append(&call->link, &box->calls);
    spinlock_unlock(&box->lock);
    waitq_wakeup(&box->wq, WAKEUP_FIRST);
}
 
/** Send a asynchronous request using phone to answerbox
 *
 * @param phone Phone connected to answerbox.
 * @param call Structure representing the call.
 */
int ipc_call(phone_t *phone, call_t *call)
{
    answerbox_t *box;
 
    spinlock_lock(&phone->lock);
    if (phone->state != IPC_PHONE_CONNECTED) {
        spinlock_unlock(&phone->lock);
        if (call->flags & IPC_CALL_FORWARDED) {
            IPC_SET_RETVAL(call->data, EFORWARD);
            _ipc_answer_free_call(call);
        } else {
            if (phone->state == IPC_PHONE_HUNGUP)
                ipc_backsend_err(phone, call, EHANGUP);
            else
                ipc_backsend_err(phone, call, ENOENT);
        }
        return ENOENT;
    }
    box = phone->callee;
    _ipc_call(phone, box, call);
   
    spinlock_unlock(&phone->lock);
    return 0;
}
 
/** Disconnect phone from answerbox
 *
 * This call leaves the phone in HUNGUP state. The change to 'free' is done
 * lazily later.
 *
 * @param phone Phone to be hung up
 *              
 * @return 0 - phone disconnected, -1 - the phone was already disconnected
 */
int ipc_phone_hangup(phone_t *phone)
{
    answerbox_t *box;
    call_t *call;
   
    spinlock_lock(&phone->lock);
    if (phone->state == IPC_PHONE_FREE || phone->state ==IPC_PHONE_HUNGUP \
        || phone->state == IPC_PHONE_CONNECTING) {
        spinlock_unlock(&phone->lock);
        return -1;
    }
    box = phone->callee;
    if (phone->state != IPC_PHONE_SLAMMED) {
        /* Remove myself from answerbox */
        spinlock_lock(&box->lock);
        list_remove(&phone->link);
        spinlock_unlock(&box->lock);
 
        if (phone->state != IPC_PHONE_SLAMMED) {
            call = ipc_call_alloc(0);
            IPC_SET_METHOD(call->data, IPC_M_PHONE_HUNGUP);
            call->flags |= IPC_CALL_DISCARD_ANSWER;
            _ipc_call(phone, box, call);
        }
    }
 
    phone->state = IPC_PHONE_HUNGUP;
    spinlock_unlock(&phone->lock);
 
    return 0;
}
 
/** Forwards call from one answerbox to a new one
 *
 * @param call Call to be redirected.
 * @param newphone Phone to target answerbox.
 * @param oldbox Old answerbox
 * @return 0 on forward ok, error code, if there was error
 *
 * - the return value serves only as an information for the forwarder,
 *   the original caller is notified automatically with EFORWARD
 */
int ipc_forward(call_t *call, phone_t *newphone, answerbox_t *oldbox)
{
    spinlock_lock(&oldbox->lock);
    list_remove(&call->link);
    spinlock_unlock(&oldbox->lock);
 
    return ipc_call(newphone, call);
}
 
 
/** Wait for phone call
 *
 * @param box Answerbox expecting the call.
 * @param usec Timeout in microseconds. See documentation for waitq_sleep_timeout() for
 *         decription of its special meaning.
 * @param flags Select mode of sleep operation. See documentation for waitq_sleep_timeout()i
 *      for description of its special meaning.
 * @return Recived message address
 * - to distinguish between call and answer, look at call->flags
 */
call_t * ipc_wait_for_call(answerbox_t *box, uint32_t usec, int flags)
{
    call_t *request;
    ipl_t ipl;
    int rc;
 
restart:
    rc = waitq_sleep_timeout(&box->wq, usec, flags);
    if (SYNCH_FAILED(rc))
        return NULL;
   
    spinlock_lock(&box->lock);
    if (!list_empty(&box->irq_notifs)) {
        ipl = interrupts_disable();
        spinlock_lock(&box->irq_lock);
 
        request = list_get_instance(box->irq_notifs.next, call_t, link);
        list_remove(&request->link);
 
        spinlock_unlock(&box->irq_lock);
        interrupts_restore(ipl);
    } else if (!list_empty(&box->answers)) {
        /* Handle asynchronous answers */
        request = list_get_instance(box->answers.next, call_t, link);
        list_remove(&request->link);
        atomic_dec(&request->data.phone->active_calls);
    } else if (!list_empty(&box->calls)) {
        /* Handle requests */
        request = list_get_instance(box->calls.next, call_t, link);
        list_remove(&request->link);
        /* Append request to dispatch queue */
        list_append(&request->link, &box->dispatched_calls);
    } else {
        /* This can happen regularly after ipc_cleanup */
        spinlock_unlock(&box->lock);
        goto restart;
    }
    spinlock_unlock(&box->lock);
    return request;
}
 
/** Answer all calls from list with EHANGUP msg */
static void ipc_cleanup_call_list(link_t *lst)
{
    call_t *call;
 
    while (!list_empty(lst)) {
        call = list_get_instance(lst->next, call_t, link);
        list_remove(&call->link);
 
        IPC_SET_RETVAL(call->data, EHANGUP);
        _ipc_answer_free_call(call);
    }
}
 
/** Cleans up all IPC communication of the current task
 *
 * Note: ipc_hangup sets returning answerbox to TASK->answerbox, you
 * have to change it as well if you want to cleanup other current then current.
 */
void ipc_cleanup(void)
{
    int i;
    call_t *call;
    phone_t *phone;
    DEADLOCK_PROBE_INIT(p_phonelck);
 
    /* Disconnect all our phones ('ipc_phone_hangup') */
    for (i=0;i < IPC_MAX_PHONES; i++)
        ipc_phone_hangup(&TASK->phones[i]);
 
    /* Disconnect all connected irqs */
    ipc_irq_cleanup(&TASK->answerbox);
 
    /* Disconnect all phones connected to our answerbox */
restart_phones:
    spinlock_lock(&TASK->answerbox.lock);
    while (!list_empty(&TASK->answerbox.connected_phones)) {
        phone = list_get_instance(TASK->answerbox.connected_phones.next,
            phone_t, link);
        if (! spinlock_trylock(&phone->lock)) {
            spinlock_unlock(&TASK->answerbox.lock);
            DEADLOCK_PROBE(p_phonelck, DEADLOCK_THRESHOLD);
            goto restart_phones;
        }
       
        /* Disconnect phone */
        ASSERT(phone->state == IPC_PHONE_CONNECTED);
        phone->state = IPC_PHONE_SLAMMED;
        list_remove(&phone->link);
 
        spinlock_unlock(&phone->lock);
    }
 
    /* Answer all messages in 'calls' and 'dispatched_calls' queues */
    ipc_cleanup_call_list(&TASK->answerbox.dispatched_calls);
    ipc_cleanup_call_list(&TASK->answerbox.calls);
    spinlock_unlock(&TASK->answerbox.lock);
   
    /* Wait for all async answers to arrive */
    while (1) {
        /* Go through all phones, until all are FREE... */
        /* Locking not needed, no one else should modify
         * it, when we are in cleanup */
        for (i=0;i < IPC_MAX_PHONES; i++) {
            if (TASK->phones[i].state == IPC_PHONE_HUNGUP && \
                atomic_get(&TASK->phones[i].active_calls) == 0)
                TASK->phones[i].state = IPC_PHONE_FREE;
           
            /* Just for sure, we might have had some
             * IPC_PHONE_CONNECTING phones */
            if (TASK->phones[i].state == IPC_PHONE_CONNECTED)
                ipc_phone_hangup(&TASK->phones[i]);
            /* If the hangup succeeded, it has sent a HANGUP
             * message, the IPC is now in HUNGUP state, we
             * wait for the reply to come */
           
            if (TASK->phones[i].state != IPC_PHONE_FREE)
                break;
        }
        /* Voila, got into cleanup */
        if (i == IPC_MAX_PHONES)
            break;
       
        call = ipc_wait_for_call(&TASK->answerbox, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);
        ASSERT((call->flags & IPC_CALL_ANSWERED) || (call->flags & IPC_CALL_NOTIF));
        ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC));
       
        atomic_dec(&TASK->active_calls);
        ipc_call_free(call);
    }
}
 
 
/** Initilize IPC subsystem */
void ipc_init(void)
{
    ipc_call_slab = slab_cache_create("ipc_call", sizeof(call_t), 0, NULL, NULL, 0);
}
 
 
/** Kconsole - list answerbox contents */
void ipc_print_task(task_id_t taskid)
{
    task_t *task;
    int i;
    call_t *call;
    link_t *tmp;
   
    spinlock_lock(&tasks_lock);
    task = task_find_by_id(taskid);
    if (task)
        spinlock_lock(&task->lock);
    spinlock_unlock(&tasks_lock);
    if (!task)
        return;
 
    /* Print opened phones & details */
    printf("PHONE:\n");
    for (i=0; i < IPC_MAX_PHONES;i++) {
        spinlock_lock(&task->phones[i].lock);
        if (task->phones[i].state != IPC_PHONE_FREE) {
            printf("%d: ",i);
            switch (task->phones[i].state) {
            case IPC_PHONE_CONNECTING:
                printf("connecting ");
                break;
            case IPC_PHONE_CONNECTED:
                printf("connected to: %p ",
                       task->phones[i].callee);
                break;
            case IPC_PHONE_SLAMMED:
                printf("slammed by: %p ",
                       task->phones[i].callee);
                break;
            case IPC_PHONE_HUNGUP:
                printf("hung up - was: %p ",
                       task->phones[i].callee);
                break;
            default:
                break;
            }
            printf("active: %d\n", atomic_get(&task->phones[i].active_calls));
        }
        spinlock_unlock(&task->phones[i].lock);
    }
 
 
    /* Print answerbox - calls */
    spinlock_lock(&task->answerbox.lock);
    printf("ABOX - CALLS:\n");
    for (tmp=task->answerbox.calls.next; tmp != &task->answerbox.calls;tmp = tmp->next) {
        call = list_get_instance(tmp, call_t, link);
        printf("Callid: %p Srctask:%llu M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
               call->sender->taskid, IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
    }
    /* Print answerbox - calls */
    printf("ABOX - DISPATCHED CALLS:\n");
    for (tmp=task->answerbox.dispatched_calls.next;
         tmp != &task->answerbox.dispatched_calls;
         tmp = tmp->next) {
        call = list_get_instance(tmp, call_t, link);
        printf("Callid: %p Srctask:%llu M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
               call->sender->taskid, IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
    }
    /* Print answerbox - calls */
    printf("ABOX - ANSWERS:\n");
    for (tmp=task->answerbox.answers.next; tmp != &task->answerbox.answers; tmp = tmp->next) {
        call = list_get_instance(tmp, call_t, link);
        printf("Callid:%p M:%d A1:%d A2:%d A3:%d Flags:%x\n",call,
               IPC_GET_METHOD(call->data), IPC_GET_ARG1(call->data),
               IPC_GET_ARG2(call->data), IPC_GET_ARG3(call->data), call->flags);
    }
 
    spinlock_unlock(&task->answerbox.lock);
    spinlock_unlock(&task->lock);
}
 
/** @}
 */
 

Rev 2216	Rev 2310
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	/* Lock ordering	35	/* Lock ordering
36	*	36	*
37	* First the answerbox, then the phone	37	* First the answerbox, then the phone
38	*/	38	*/
39		39
40	#include <synch/spinlock.h>	40	#include <synch/spinlock.h>
41	#include <synch/waitq.h>	41	#include <synch/waitq.h>
42	#include <synch/synch.h>	42	#include <synch/synch.h>
43	#include <ipc/ipc.h>	43	#include <ipc/ipc.h>
44	#include <errno.h>	44	#include <errno.h>
45	#include <mm/slab.h>	45	#include <mm/slab.h>
46	#include <arch.h>	46	#include <arch.h>
47	#include <proc/task.h>	47	#include <proc/task.h>
48	#include <memstr.h>	48	#include <memstr.h>
49	#include <debug.h>	49	#include <debug.h>
50		50
51	#include <print.h>	51	#include <print.h>
52	#include <proc/thread.h>	52	#include <proc/thread.h>
53	#include <arch/interrupt.h>	53	#include <arch/interrupt.h>
54	#include <ipc/irq.h>	54	#include <ipc/irq.h>
55		55
56	/* Open channel that is assigned automatically to new tasks */	56	/* Open channel that is assigned automatically to new tasks */
57	answerbox_t *ipc_phone_0 = NULL;	57	answerbox_t *ipc_phone_0 = NULL;
58		58
59	static slab_cache_t *ipc_call_slab;	59	static slab_cache_t *ipc_call_slab;
60		60
61	/* Initialize new call */	61	/* Initialize new call */
62	static void _ipc_call_init(call_t *call)	62	static void _ipc_call_init(call_t *call)
63	{	63	{
64	memsetb((uintptr_t)call, sizeof(*call), 0);	64	memsetb((uintptr_t)call, sizeof(*call), 0);
65	call->callerbox = &TASK->answerbox;	65	call->callerbox = &TASK->answerbox;
66	call->sender = TASK;	66	call->sender = TASK;
67	}	67	}
68		68
69	/** Allocate & initialize call structure	69	/** Allocate & initialize call structure
70	*	70	*
71	* The call is initialized, so that the reply will be directed	71	* The call is initialized, so that the reply will be directed
72	* to TASK->answerbox	72	* to TASK->answerbox
73	*	73	*
74	* @param flags Parameters for slab_alloc (ATOMIC, etc.)	74	* @param flags Parameters for slab_alloc (ATOMIC, etc.)
75	*/	75	*/
76	call_t * ipc_call_alloc(int flags)	76	call_t * ipc_call_alloc(int flags)
77	{	77	{
78	call_t *call;	78	call_t *call;
79		79
80	call = slab_alloc(ipc_call_slab, flags);	80	call = slab_alloc(ipc_call_slab, flags);
81	_ipc_call_init(call);	81	_ipc_call_init(call);
82		82
83	return call;	83	return call;
84	}	84	}
85		85
86	/** Initialize allocated call */	86	/** Initialize allocated call */
87	void ipc_call_static_init(call_t *call)	87	void ipc_call_static_init(call_t *call)
88	{	88	{
89	_ipc_call_init(call);	89	_ipc_call_init(call);
90	call->flags \|= IPC_CALL_STATIC_ALLOC;	90	call->flags \|= IPC_CALL_STATIC_ALLOC;
91	}	91	}
92		92
93	/** Deallocate call stracuture */	93	/** Deallocate call stracuture */
94	void ipc_call_free(call_t *call)	94	void ipc_call_free(call_t *call)
95	{	95	{
96	slab_free(ipc_call_slab, call);	96	slab_free(ipc_call_slab, call);
97	}	97	}
98		98
99	/** Initialize answerbox structure	99	/** Initialize answerbox structure
100	*/	100	*/
101	void ipc_answerbox_init(answerbox_t *box)	101	void ipc_answerbox_init(answerbox_t *box)
102	{	102	{
103	spinlock_initialize(&box->lock, "ipc_box_lock");	103	spinlock_initialize(&box->lock, "ipc_box_lock");
104	spinlock_initialize(&box->irq_lock, "ipc_box_irqlock");	104	spinlock_initialize(&box->irq_lock, "ipc_box_irqlock");
105	waitq_initialize(&box->wq);	105	waitq_initialize(&box->wq);
106	list_initialize(&box->connected_phones);	106	list_initialize(&box->connected_phones);
107	list_initialize(&box->calls);	107	list_initialize(&box->calls);
108	list_initialize(&box->dispatched_calls);	108	list_initialize(&box->dispatched_calls);
109	list_initialize(&box->answers);	109	list_initialize(&box->answers);
110	list_initialize(&box->irq_notifs);	110	list_initialize(&box->irq_notifs);
111	list_initialize(&box->irq_head);	111	list_initialize(&box->irq_head);
112	box->task = TASK;	112	box->task = TASK;
113	}	113	}
114		114
115	/** Connect phone to answerbox */	115	/** Connect phone to answerbox */
116	void ipc_phone_connect(phone_t phone, answerbox_t box)	116	void ipc_phone_connect(phone_t phone, answerbox_t box)
117	{	117	{
118	spinlock_lock(&phone->lock);	118	spinlock_lock(&phone->lock);
119		119
120	phone->state = IPC_PHONE_CONNECTED;	120	phone->state = IPC_PHONE_CONNECTED;
121	phone->callee = box;	121	phone->callee = box;
122		122
123	spinlock_lock(&box->lock);	123	spinlock_lock(&box->lock);
124	list_append(&phone->link, &box->connected_phones);	124	list_append(&phone->link, &box->connected_phones);
125	spinlock_unlock(&box->lock);	125	spinlock_unlock(&box->lock);
126		126
127	spinlock_unlock(&phone->lock);	127	spinlock_unlock(&phone->lock);
128	}	128	}
129		129
130	/** Initialize phone structure and connect phone to answerbox	130	/** Initialize phone structure and connect phone to answerbox
131	*/	131	*/
132	void ipc_phone_init(phone_t *phone)	132	void ipc_phone_init(phone_t *phone)
133	{	133	{
134	spinlock_initialize(&phone->lock, "phone_lock");	134	spinlock_initialize(&phone->lock, "phone_lock");
135	phone->callee = NULL;	135	phone->callee = NULL;
136	phone->state = IPC_PHONE_FREE;	136	phone->state = IPC_PHONE_FREE;
137	atomic_set(&phone->active_calls, 0);	137	atomic_set(&phone->active_calls, 0);
138	}	138	}
139		139
140	/** Helper function to facilitate synchronous calls */	140	/** Helper function to facilitate synchronous calls */
141	void ipc_call_sync(phone_t phone, call_t request)	141	void ipc_call_sync(phone_t phone, call_t request)
142	{	142	{
143	answerbox_t sync_box;	143	answerbox_t sync_box;
144		144
145	ipc_answerbox_init(&sync_box);	145	ipc_answerbox_init(&sync_box);
146		146
147	/* We will receive data on special box */	147	/* We will receive data on special box */
148	request->callerbox = &sync_box;	148	request->callerbox = &sync_box;
149		149
150	ipc_call(phone, request);	150	ipc_call(phone, request);
151	ipc_wait_for_call(&sync_box, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);	151	ipc_wait_for_call(&sync_box, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);
152	}	152	}
153		153
154	/** Answer message that was not dispatched and is not entered in	154	/** Answer message that was not dispatched and is not entered in
155	* any queue	155	* any queue
156	*/	156	*/
157	static void _ipc_answer_free_call(call_t *call)	157	static void _ipc_answer_free_call(call_t *call)
158	{	158	{
159	answerbox_t *callerbox = call->callerbox;	159	answerbox_t *callerbox = call->callerbox;
160		160
161	call->flags \|= IPC_CALL_ANSWERED;	161	call->flags \|= IPC_CALL_ANSWERED;
162		162
163	spinlock_lock(&callerbox->lock);	163	spinlock_lock(&callerbox->lock);
164	list_append(&call->link, &callerbox->answers);	164	list_append(&call->link, &callerbox->answers);
165	spinlock_unlock(&callerbox->lock);	165	spinlock_unlock(&callerbox->lock);
166	waitq_wakeup(&callerbox->wq, 0);	166	waitq_wakeup(&callerbox->wq, WAKEUP_FIRST);
167	}	167	}
168		168
169	/** Answer message, that is in callee queue	169	/** Answer message, that is in callee queue
170	*	170	*
171	* @param box Answerbox that is answering the message	171	* @param box Answerbox that is answering the message
172	* @param call Modified request that is being sent back	172	* @param call Modified request that is being sent back
173	*/	173	*/
174	void ipc_answer(answerbox_t box, call_t call)	174	void ipc_answer(answerbox_t box, call_t call)
175	{	175	{
176	/* Remove from active box */	176	/* Remove from active box */
177	spinlock_lock(&box->lock);	177	spinlock_lock(&box->lock);
178	list_remove(&call->link);	178	list_remove(&call->link);
179	spinlock_unlock(&box->lock);	179	spinlock_unlock(&box->lock);
180	/* Send back answer */	180	/* Send back answer */
181	_ipc_answer_free_call(call);	181	_ipc_answer_free_call(call);
182	}	182	}
183		183
184	/** Simulate sending back a message	184	/** Simulate sending back a message
185	*	185	*
186	* Most errors are better handled by forming a normal backward	186	* Most errors are better handled by forming a normal backward
187	* message and sending it as a normal answer.	187	* message and sending it as a normal answer.
188	*/	188	*/
189	void ipc_backsend_err(phone_t phone, call_t call, unative_t err)	189	void ipc_backsend_err(phone_t phone, call_t call, unative_t err)
190	{	190	{
191	call->data.phone = phone;	191	call->data.phone = phone;
192	atomic_inc(&phone->active_calls);	192	atomic_inc(&phone->active_calls);
193	IPC_SET_RETVAL(call->data, err);	193	IPC_SET_RETVAL(call->data, err);
194	_ipc_answer_free_call(call);	194	_ipc_answer_free_call(call);
195	}	195	}
196		196
197	/* Unsafe unchecking ipc_call */	197	/* Unsafe unchecking ipc_call */
198	static void _ipc_call(phone_t phone, answerbox_t box, call_t *call)	198	static void _ipc_call(phone_t phone, answerbox_t box, call_t *call)
199	{	199	{
200	if (! (call->flags & IPC_CALL_FORWARDED)) {	200	if (! (call->flags & IPC_CALL_FORWARDED)) {
201	atomic_inc(&phone->active_calls);	201	atomic_inc(&phone->active_calls);
202	call->data.phone = phone;	202	call->data.phone = phone;
203	}	203	}
204		204
205	spinlock_lock(&box->lock);	205	spinlock_lock(&box->lock);
206	list_append(&call->link, &box->calls);	206	list_append(&call->link, &box->calls);
207	spinlock_unlock(&box->lock);	207	spinlock_unlock(&box->lock);
208	waitq_wakeup(&box->wq, 0);	208	waitq_wakeup(&box->wq, WAKEUP_FIRST);
209	}	209	}
210		210
211	/** Send a asynchronous request using phone to answerbox	211	/** Send a asynchronous request using phone to answerbox
212	*	212	*
213	* @param phone Phone connected to answerbox.	213	* @param phone Phone connected to answerbox.
214	* @param call Structure representing the call.	214	* @param call Structure representing the call.
215	*/	215	*/
216	int ipc_call(phone_t phone, call_t call)	216	int ipc_call(phone_t phone, call_t call)
217	{	217	{
218	answerbox_t *box;	218	answerbox_t *box;
219		219
220	spinlock_lock(&phone->lock);	220	spinlock_lock(&phone->lock);
221	if (phone->state != IPC_PHONE_CONNECTED) {	221	if (phone->state != IPC_PHONE_CONNECTED) {
222	spinlock_unlock(&phone->lock);	222	spinlock_unlock(&phone->lock);
223	if (call->flags & IPC_CALL_FORWARDED) {	223	if (call->flags & IPC_CALL_FORWARDED) {
224	IPC_SET_RETVAL(call->data, EFORWARD);	224	IPC_SET_RETVAL(call->data, EFORWARD);
225	_ipc_answer_free_call(call);	225	_ipc_answer_free_call(call);
226	} else {	226	} else {
227	if (phone->state == IPC_PHONE_HUNGUP)	227	if (phone->state == IPC_PHONE_HUNGUP)
228	ipc_backsend_err(phone, call, EHANGUP);	228	ipc_backsend_err(phone, call, EHANGUP);
229	else	229	else
230	ipc_backsend_err(phone, call, ENOENT);	230	ipc_backsend_err(phone, call, ENOENT);
231	}	231	}
232	return ENOENT;	232	return ENOENT;
233	}	233	}
234	box = phone->callee;	234	box = phone->callee;
235	_ipc_call(phone, box, call);	235	_ipc_call(phone, box, call);
236		236
237	spinlock_unlock(&phone->lock);	237	spinlock_unlock(&phone->lock);
238	return 0;	238	return 0;
239	}	239	}
240		240
241	/** Disconnect phone from answerbox	241	/** Disconnect phone from answerbox
242	*	242	*
243	* This call leaves the phone in HUNGUP state. The change to 'free' is done	243	* This call leaves the phone in HUNGUP state. The change to 'free' is done
244	* lazily later.	244	* lazily later.
245	*	245	*
246	* @param phone Phone to be hung up	246	* @param phone Phone to be hung up
247	*	247	*
248	* @return 0 - phone disconnected, -1 - the phone was already disconnected	248	* @return 0 - phone disconnected, -1 - the phone was already disconnected
249	*/	249	*/
250	int ipc_phone_hangup(phone_t *phone)	250	int ipc_phone_hangup(phone_t *phone)
251	{	251	{
252	answerbox_t *box;	252	answerbox_t *box;
253	call_t *call;	253	call_t *call;
254		254
255	spinlock_lock(&phone->lock);	255	spinlock_lock(&phone->lock);
256	if (phone->state == IPC_PHONE_FREE \|\| phone->state ==IPC_PHONE_HUNGUP \	256	if (phone->state == IPC_PHONE_FREE \|\| phone->state ==IPC_PHONE_HUNGUP \
257	\|\| phone->state == IPC_PHONE_CONNECTING) {	257	\|\| phone->state == IPC_PHONE_CONNECTING) {
258	spinlock_unlock(&phone->lock);	258	spinlock_unlock(&phone->lock);
259	return -1;	259	return -1;
260	}	260	}
261	box = phone->callee;	261	box = phone->callee;
262	if (phone->state != IPC_PHONE_SLAMMED) {	262	if (phone->state != IPC_PHONE_SLAMMED) {
263	/* Remove myself from answerbox */	263	/* Remove myself from answerbox */
264	spinlock_lock(&box->lock);	264	spinlock_lock(&box->lock);
265	list_remove(&phone->link);	265	list_remove(&phone->link);
266	spinlock_unlock(&box->lock);	266	spinlock_unlock(&box->lock);
267		267
268	if (phone->state != IPC_PHONE_SLAMMED) {	268	if (phone->state != IPC_PHONE_SLAMMED) {
269	call = ipc_call_alloc(0);	269	call = ipc_call_alloc(0);
270	IPC_SET_METHOD(call->data, IPC_M_PHONE_HUNGUP);	270	IPC_SET_METHOD(call->data, IPC_M_PHONE_HUNGUP);
271	call->flags \|= IPC_CALL_DISCARD_ANSWER;	271	call->flags \|= IPC_CALL_DISCARD_ANSWER;
272	_ipc_call(phone, box, call);	272	_ipc_call(phone, box, call);
273	}	273	}
274	}	274	}
275		275
276	phone->state = IPC_PHONE_HUNGUP;	276	phone->state = IPC_PHONE_HUNGUP;
277	spinlock_unlock(&phone->lock);	277	spinlock_unlock(&phone->lock);
278		278
279	return 0;	279	return 0;
280	}	280	}
281		281
282	/** Forwards call from one answerbox to a new one	282	/** Forwards call from one answerbox to a new one
283	*	283	*
284	* @param call Call to be redirected.	284	* @param call Call to be redirected.
285	* @param newphone Phone to target answerbox.	285	* @param newphone Phone to target answerbox.
286	* @param oldbox Old answerbox	286	* @param oldbox Old answerbox
287	* @return 0 on forward ok, error code, if there was error	287	* @return 0 on forward ok, error code, if there was error
288	*	288	*
289	* - the return value serves only as an information for the forwarder,	289	* - the return value serves only as an information for the forwarder,
290	* the original caller is notified automatically with EFORWARD	290	* the original caller is notified automatically with EFORWARD
291	*/	291	*/
292	int ipc_forward(call_t call, phone_t newphone, answerbox_t *oldbox)	292	int ipc_forward(call_t call, phone_t newphone, answerbox_t *oldbox)
293	{	293	{
294	spinlock_lock(&oldbox->lock);	294	spinlock_lock(&oldbox->lock);
295	list_remove(&call->link);	295	list_remove(&call->link);
296	spinlock_unlock(&oldbox->lock);	296	spinlock_unlock(&oldbox->lock);
297		297
298	return ipc_call(newphone, call);	298	return ipc_call(newphone, call);
299	}	299	}
300		300
301		301
302	/** Wait for phone call	302	/** Wait for phone call
303	*	303	*
304	* @param box Answerbox expecting the call.	304	* @param box Answerbox expecting the call.
305	* @param usec Timeout in microseconds. See documentation for waitq_sleep_timeout() for	305	* @param usec Timeout in microseconds. See documentation for waitq_sleep_timeout() for
306	* decription of its special meaning.	306	* decription of its special meaning.
307	* @param flags Select mode of sleep operation. See documentation for waitq_sleep_timeout()i	307	* @param flags Select mode of sleep operation. See documentation for waitq_sleep_timeout()i
308	* for description of its special meaning.	308	* for description of its special meaning.
309	* @return Recived message address	309	* @return Recived message address
310	* - to distinguish between call and answer, look at call->flags	310	* - to distinguish between call and answer, look at call->flags
311	*/	311	*/
312	call_t * ipc_wait_for_call(answerbox_t *box, uint32_t usec, int flags)	312	call_t * ipc_wait_for_call(answerbox_t *box, uint32_t usec, int flags)
313	{	313	{
314	call_t *request;	314	call_t *request;
315	ipl_t ipl;	315	ipl_t ipl;
316	int rc;	316	int rc;
317		317
318	restart:	318	restart:
319	rc = waitq_sleep_timeout(&box->wq, usec, flags);	319	rc = waitq_sleep_timeout(&box->wq, usec, flags);
320	if (SYNCH_FAILED(rc))	320	if (SYNCH_FAILED(rc))
321	return NULL;	321	return NULL;
322		322
323	spinlock_lock(&box->lock);	323	spinlock_lock(&box->lock);
324	if (!list_empty(&box->irq_notifs)) {	324	if (!list_empty(&box->irq_notifs)) {
325	ipl = interrupts_disable();	325	ipl = interrupts_disable();
326	spinlock_lock(&box->irq_lock);	326	spinlock_lock(&box->irq_lock);
327		327
328	request = list_get_instance(box->irq_notifs.next, call_t, link);	328	request = list_get_instance(box->irq_notifs.next, call_t, link);
329	list_remove(&request->link);	329	list_remove(&request->link);
330		330
331	spinlock_unlock(&box->irq_lock);	331	spinlock_unlock(&box->irq_lock);
332	interrupts_restore(ipl);	332	interrupts_restore(ipl);
333	} else if (!list_empty(&box->answers)) {	333	} else if (!list_empty(&box->answers)) {
334	/* Handle asynchronous answers */	334	/* Handle asynchronous answers */
335	request = list_get_instance(box->answers.next, call_t, link);	335	request = list_get_instance(box->answers.next, call_t, link);
336	list_remove(&request->link);	336	list_remove(&request->link);
337	atomic_dec(&request->data.phone->active_calls);	337	atomic_dec(&request->data.phone->active_calls);
338	} else if (!list_empty(&box->calls)) {	338	} else if (!list_empty(&box->calls)) {
339	/* Handle requests */	339	/* Handle requests */
340	request = list_get_instance(box->calls.next, call_t, link);	340	request = list_get_instance(box->calls.next, call_t, link);
341	list_remove(&request->link);	341	list_remove(&request->link);
342	/* Append request to dispatch queue */	342	/* Append request to dispatch queue */
343	list_append(&request->link, &box->dispatched_calls);	343	list_append(&request->link, &box->dispatched_calls);
344	} else {	344	} else {
345	/* This can happen regularly after ipc_cleanup */	345	/* This can happen regularly after ipc_cleanup */
346	spinlock_unlock(&box->lock);	346	spinlock_unlock(&box->lock);
347	goto restart;	347	goto restart;
348	}	348	}
349	spinlock_unlock(&box->lock);	349	spinlock_unlock(&box->lock);
350	return request;	350	return request;
351	}	351	}
352		352
353	/** Answer all calls from list with EHANGUP msg */	353	/** Answer all calls from list with EHANGUP msg */
354	static void ipc_cleanup_call_list(link_t *lst)	354	static void ipc_cleanup_call_list(link_t *lst)
355	{	355	{
356	call_t *call;	356	call_t *call;
357		357
358	while (!list_empty(lst)) {	358	while (!list_empty(lst)) {
359	call = list_get_instance(lst->next, call_t, link);	359	call = list_get_instance(lst->next, call_t, link);
360	list_remove(&call->link);	360	list_remove(&call->link);
361		361
362	IPC_SET_RETVAL(call->data, EHANGUP);	362	IPC_SET_RETVAL(call->data, EHANGUP);
363	_ipc_answer_free_call(call);	363	_ipc_answer_free_call(call);
364	}	364	}
365	}	365	}
366		366
367	/** Cleans up all IPC communication of the current task	367	/** Cleans up all IPC communication of the current task
368	*	368	*
369	* Note: ipc_hangup sets returning answerbox to TASK->answerbox, you	369	* Note: ipc_hangup sets returning answerbox to TASK->answerbox, you
370	* have to change it as well if you want to cleanup other current then current.	370	* have to change it as well if you want to cleanup other current then current.
371	*/	371	*/
372	void ipc_cleanup(void)	372	void ipc_cleanup(void)
373	{	373	{
374	int i;	374	int i;
375	call_t *call;	375	call_t *call;
376	phone_t *phone;	376	phone_t *phone;
377	DEADLOCK_PROBE_INIT(p_phonelck);	377	DEADLOCK_PROBE_INIT(p_phonelck);
378		378
379	/* Disconnect all our phones ('ipc_phone_hangup') */	379	/* Disconnect all our phones ('ipc_phone_hangup') */
380	for (i=0;i < IPC_MAX_PHONES; i++)	380	for (i=0;i < IPC_MAX_PHONES; i++)
381	ipc_phone_hangup(&TASK->phones[i]);	381	ipc_phone_hangup(&TASK->phones[i]);
382		382
383	/* Disconnect all connected irqs */	383	/* Disconnect all connected irqs */
384	ipc_irq_cleanup(&TASK->answerbox);	384	ipc_irq_cleanup(&TASK->answerbox);
385		385
386	/* Disconnect all phones connected to our answerbox */	386	/* Disconnect all phones connected to our answerbox */
387	restart_phones:	387	restart_phones:
388	spinlock_lock(&TASK->answerbox.lock);	388	spinlock_lock(&TASK->answerbox.lock);
389	while (!list_empty(&TASK->answerbox.connected_phones)) {	389	while (!list_empty(&TASK->answerbox.connected_phones)) {
390	phone = list_get_instance(TASK->answerbox.connected_phones.next,	390	phone = list_get_instance(TASK->answerbox.connected_phones.next,
391	phone_t, link);	391	phone_t, link);
392	if (! spinlock_trylock(&phone->lock)) {	392	if (! spinlock_trylock(&phone->lock)) {
393	spinlock_unlock(&TASK->answerbox.lock);	393	spinlock_unlock(&TASK->answerbox.lock);
394	DEADLOCK_PROBE(p_phonelck, DEADLOCK_THRESHOLD);	394	DEADLOCK_PROBE(p_phonelck, DEADLOCK_THRESHOLD);
395	goto restart_phones;	395	goto restart_phones;
396	}	396	}
397		397
398	/* Disconnect phone */	398	/* Disconnect phone */
399	ASSERT(phone->state == IPC_PHONE_CONNECTED);	399	ASSERT(phone->state == IPC_PHONE_CONNECTED);
400	phone->state = IPC_PHONE_SLAMMED;	400	phone->state = IPC_PHONE_SLAMMED;
401	list_remove(&phone->link);	401	list_remove(&phone->link);
402		402
403	spinlock_unlock(&phone->lock);	403	spinlock_unlock(&phone->lock);
404	}	404	}
405		405
406	/* Answer all messages in 'calls' and 'dispatched_calls' queues */	406	/* Answer all messages in 'calls' and 'dispatched_calls' queues */
407	ipc_cleanup_call_list(&TASK->answerbox.dispatched_calls);	407	ipc_cleanup_call_list(&TASK->answerbox.dispatched_calls);
408	ipc_cleanup_call_list(&TASK->answerbox.calls);	408	ipc_cleanup_call_list(&TASK->answerbox.calls);
409	spinlock_unlock(&TASK->answerbox.lock);	409	spinlock_unlock(&TASK->answerbox.lock);
410		410
411	/* Wait for all async answers to arrive */	411	/* Wait for all async answers to arrive */
412	while (1) {	412	while (1) {
413	/* Go through all phones, until all are FREE... */	413	/* Go through all phones, until all are FREE... */
414	/* Locking not needed, no one else should modify	414	/* Locking not needed, no one else should modify
415	* it, when we are in cleanup */	415	* it, when we are in cleanup */
416	for (i=0;i < IPC_MAX_PHONES; i++) {	416	for (i=0;i < IPC_MAX_PHONES; i++) {
417	if (TASK->phones[i].state == IPC_PHONE_HUNGUP && \	417	if (TASK->phones[i].state == IPC_PHONE_HUNGUP && \
418	atomic_get(&TASK->phones[i].active_calls) == 0)	418	atomic_get(&TASK->phones[i].active_calls) == 0)
419	TASK->phones[i].state = IPC_PHONE_FREE;	419	TASK->phones[i].state = IPC_PHONE_FREE;
420		420
421	/* Just for sure, we might have had some	421	/* Just for sure, we might have had some
422	* IPC_PHONE_CONNECTING phones */	422	* IPC_PHONE_CONNECTING phones */
423	if (TASK->phones[i].state == IPC_PHONE_CONNECTED)	423	if (TASK->phones[i].state == IPC_PHONE_CONNECTED)
424	ipc_phone_hangup(&TASK->phones[i]);	424	ipc_phone_hangup(&TASK->phones[i]);
425	/* If the hangup succeeded, it has sent a HANGUP	425	/* If the hangup succeeded, it has sent a HANGUP
426	* message, the IPC is now in HUNGUP state, we	426	* message, the IPC is now in HUNGUP state, we
427	* wait for the reply to come */	427	* wait for the reply to come */
428		428
429	if (TASK->phones[i].state != IPC_PHONE_FREE)	429	if (TASK->phones[i].state != IPC_PHONE_FREE)
430	break;	430	break;
431	}	431	}
432	/* Voila, got into cleanup */	432	/* Voila, got into cleanup */
433	if (i == IPC_MAX_PHONES)	433	if (i == IPC_MAX_PHONES)
434	break;	434	break;
435		435
436	call = ipc_wait_for_call(&TASK->answerbox, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);	436	call = ipc_wait_for_call(&TASK->answerbox, SYNCH_NO_TIMEOUT, SYNCH_FLAGS_NONE);
437	ASSERT((call->flags & IPC_CALL_ANSWERED) \|\| (call->flags & IPC_CALL_NOTIF));	437	ASSERT((call->flags & IPC_CALL_ANSWERED) \|\| (call->flags & IPC_CALL_NOTIF));
438	ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC));	438	ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC));
439		439
440	atomic_dec(&TASK->active_calls);	440	atomic_dec(&TASK->active_calls);
441	ipc_call_free(call);	441	ipc_call_free(call);
442	}	442	}
443	}	443	}
444		444
445		445
446	/** Initilize IPC subsystem */	446	/** Initilize IPC subsystem */
447	void ipc_init(void)	447	void ipc_init(void)
448	{	448	{
449	ipc_call_slab = slab_cache_create("ipc_call", sizeof(call_t), 0, NULL, NULL, 0);	449	ipc_call_slab = slab_cache_create("ipc_call", sizeof(call_t), 0, NULL, NULL, 0);
450	}	450	}
451		451
452		452
453	/** Kconsole - list answerbox contents */	453	/** Kconsole - list answerbox contents */
454	void ipc_print_task(task_id_t taskid)	454	void ipc_print_task(task_id_t taskid)
455	{	455	{
456	task_t *task;	456	task_t *task;
457	int i;	457	int i;
458	call_t *call;	458	call_t *call;
459	link_t *tmp;	459	link_t *tmp;
460		460
461	spinlock_lock(&tasks_lock);	461	spinlock_lock(&tasks_lock);
462	task = task_find_by_id(taskid);	462	task = task_find_by_id(taskid);
463	if (task)	463	if (task)
464	spinlock_lock(&task->lock);	464	spinlock_lock(&task->lock);
465	spinlock_unlock(&tasks_lock);	465	spinlock_unlock(&tasks_lock);
466	if (!task)	466	if (!task)
467	return;	467	return;
468		468
469	/* Print opened phones & details */	469	/* Print opened phones & details */
470	printf("PHONE:\n");	470	printf("PHONE:\n");
471	for (i=0; i < IPC_MAX_PHONES;i++) {	471	for (i=0; i < IPC_MAX_PHONES;i++) {
472	spinlock_lock(&task->phones[i].lock);	472	spinlock_lock(&task->phones[i].lock);
473	if (task->phones[i].state != IPC_PHONE_FREE) {	473	if (task->phones[i].state != IPC_PHONE_FREE) {
474	printf("%d: ",i);	474	printf("%d: ",i);
475	switch (task->phones[i].state) {	475	switch (task->phones[i].state) {
476	case IPC_PHONE_CONNECTING:	476	case IPC_PHONE_CONNECTING:
477	printf("connecting ");	477	printf("connecting ");
478	break;	478	break;
479	case IPC_PHONE_CONNECTED:	479	case IPC_PHONE_CONNECTED:
480	printf("connected to: %p ",	480	printf("connected to: %p ",
481	task->phones[i].callee);	481	task->phones[i].callee);
482	break;	482	break;
483	case IPC_PHONE_SLAMMED:	483	case IPC_PHONE_SLAMMED:
484	printf("slammed by: %p ",	484	printf("slammed by: %p ",
485	task->phones[i].callee);	485	task->phones[i].callee);
486	break;	486	break;
487	case IPC_PHONE_HUNGUP:	487	case IPC_PHONE_HUNGUP:
488	printf("hung up - was: %p ",	488	printf("hung up - was: %p ",
489	task->phones[i].callee);	489	task->phones[i].callee);
490	break;	490	break;
491	default:	491	default:
492	break;	492	break;
493	}	493	}
494	printf("active: %d\n", atomic_get(&task->phones[i].active_calls));	494	printf("active: %d\n", atomic_get(&task->phones[i].active_calls));
495	}	495	}
496	spinlock_unlock(&task->phones[i].lock);	496	spinlock_unlock(&task->phones[i].lock);
497	}	497	}
498		498
499		499
500	/* Print answerbox - calls */	500	/* Print answerbox - calls */

Subversion Repositories HelenOS

(root)/trunk/kernel/generic/src/ipc/ipc.c – Rev 2216 → 2310