WebSVN – HelenOS-historic – Diff – /kernel/trunk/generic/src/ipc/sysipc.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
 */
 
#include <arch.h>
#include <proc/task.h>
#include <proc/thread.h>
#include <errno.h>
#include <memstr.h>
#include <debug.h>
#include <ipc/ipc.h>
#include <ipc/sysipc.h>
#include <ipc/irq.h>
#include <ipc/ipcrsc.h>
#include <arch/interrupt.h>
#include <print.h>
#include <syscall/copy.h>
#include <security/cap.h>
#include <mm/as.h>
 
#define GET_CHECK_PHONE(phone,phoneid,err) { \
      if (phoneid > IPC_MAX_PHONES) { err; } \
      phone = &TASK->phones[phoneid]; \
}
 
#define STRUCT_TO_USPACE(dst,src) copy_to_uspace(dst,src,sizeof(*(src)))
 
/** Return true if the method is a system method */
static inline int is_system_method(unative_t method)
{
    if (method <= IPC_M_LAST_SYSTEM)
        return 1;
    return 0;
}
 
/** Return true if the message with this method is forwardable
 *
 * - some system messages may be forwarded, for some of them
 *   it is useless
 */
static inline int is_forwardable(unative_t method)
{
    if (method == IPC_M_PHONE_HUNGUP || method == IPC_M_AS_AREA_SEND \
        || method == IPC_M_AS_AREA_RECV)
        return 0; /* This message is meant only for the receiver */
    return 1;
}
 
/****************************************************/
/* Functions that preprocess answer before sending
 * it to the recepient
 */
 
/** Return true if the caller (ipc_answer) should save
 * the old call contents for answer_preprocess
 */
static inline int answer_need_old(call_t *call)
{
    if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)
        return 1;
    if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_ME_TO)
        return 1;
    if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_SEND)
        return 1;
    if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_RECV)
        return 1;
    return 0;
}
 
/** Interpret process answer as control information
 *
 * This function is called directly after sys_ipc_answer
 */
static inline int answer_preprocess(call_t *answer, ipc_data_t *olddata)
{
    int phoneid;
 
    if (IPC_GET_RETVAL(answer->data) == EHANGUP) {
        /* In case of forward, hangup the forwared phone,
         * not the originator
         */
        spinlock_lock(&answer->data.phone->lock);
        spinlock_lock(&TASK->answerbox.lock);
        if (answer->data.phone->state == IPC_PHONE_CONNECTED) {
            list_remove(&answer->data.phone->link);
            answer->data.phone->state = IPC_PHONE_SLAMMED;
        }
        spinlock_unlock(&TASK->answerbox.lock);
        spinlock_unlock(&answer->data.phone->lock);
    }
 
    if (!olddata)
        return 0;
 
    if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) {
        phoneid = IPC_GET_ARG3(*olddata);
        if (IPC_GET_RETVAL(answer->data)) {
            /* The connection was not accepted */
            phone_dealloc(phoneid);
        } else {
            /* The connection was accepted */
            phone_connect(phoneid,&answer->sender->answerbox);
            /* Set 'phone identification' as arg3 of response */
            IPC_SET_ARG3(answer->data, (unative_t)&TASK->phones[phoneid]);
        }
    } else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) {
        /* If the users accepted call, connect */
        if (!IPC_GET_RETVAL(answer->data)) {
            ipc_phone_connect((phone_t *)IPC_GET_ARG3(*olddata),
                      &TASK->answerbox);
        }
    } else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_SEND) {
        if (!IPC_GET_RETVAL(answer->data)) { /* Accepted, handle as_area receipt */
            ipl_t ipl;
            int rc;
            as_t *as;
           
            ipl = interrupts_disable();
            spinlock_lock(&answer->sender->lock);
            as = answer->sender->as;
            spinlock_unlock(&answer->sender->lock);
            interrupts_restore(ipl);
           
            rc = as_area_share(as, IPC_GET_ARG1(*olddata), IPC_GET_ARG2(*olddata),
                       AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata));
            IPC_SET_RETVAL(answer->data, rc);
            return rc;
        }
    } else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_RECV) {
        if (!IPC_GET_RETVAL(answer->data)) {
            ipl_t ipl;
            as_t *as;
            int rc;
           
            ipl = interrupts_disable();
            spinlock_lock(&answer->sender->lock);
            as = answer->sender->as;
            spinlock_unlock(&answer->sender->lock);
            interrupts_restore(ipl);
           
            rc = as_area_share(AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG2(*olddata),
                       as, IPC_GET_ARG1(*olddata), IPC_GET_ARG2(answer->data));
            IPC_SET_RETVAL(answer->data, rc);
        }
    }
    return 0;
}
 
/** Called before the request is sent
 *
 * @return 0 - no error, -1 - report error to user
 */
static int request_preprocess(call_t *call)
{
    int newphid;
    size_t size;
 
    switch (IPC_GET_METHOD(call->data)) {
    case IPC_M_CONNECT_ME_TO:
        newphid = phone_alloc();
        if (newphid < 0)
            return ELIMIT;
        /* Set arg3 for server */
        IPC_SET_ARG3(call->data, (unative_t)&TASK->phones[newphid]);
        call->flags |= IPC_CALL_CONN_ME_TO;
        call->private = newphid;
        break;
    case IPC_M_AS_AREA_SEND:
        size = as_get_size(IPC_GET_ARG1(call->data));
        if (!size) {
            return EPERM;
        }
        IPC_SET_ARG2(call->data, size);
        break;
    default:
        break;
    }
    return 0;
}
 
/****************************************************/
/* Functions called to process received call/answer
 * before passing to uspace
 */
 
/** Do basic kernel processing of received call answer */
static void process_answer(call_t *call)
{
    if (IPC_GET_RETVAL(call->data) == EHANGUP && \
        call->flags & IPC_CALL_FORWARDED)
        IPC_SET_RETVAL(call->data, EFORWARD);
 
    if (call->flags & IPC_CALL_CONN_ME_TO) {
        if (IPC_GET_RETVAL(call->data))
            phone_dealloc(call->private);
        else
            IPC_SET_ARG3(call->data, call->private);
    }
}
 
/** Do basic kernel processing of received call request
 *
 * @return 0 - the call should be passed to userspace, 1 - ignore call
 */
static int process_request(answerbox_t *box,call_t *call)
{
    int phoneid;
 
    if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) {
        phoneid = phone_alloc();
        if (phoneid < 0) { /* Failed to allocate phone */
            IPC_SET_RETVAL(call->data, ELIMIT);
            ipc_answer(box,call);
            return -1;
        }
        IPC_SET_ARG3(call->data, phoneid);
    }
    return 0;
}
 
/** Send a call over IPC, wait for reply, return to user
 *
 * @return Call identification, returns -1 on fatal error,
           -2 on 'Too many async request, handle answers first
 */
unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method,
                unative_t arg1, ipc_data_t *data)
{
    call_t call;
    phone_t *phone;
    int res;
 
    GET_CHECK_PHONE(phone, phoneid, return ENOENT);
 
    ipc_call_static_init(&call);
    IPC_SET_METHOD(call.data, method);
    IPC_SET_ARG1(call.data, arg1);
 
    if (!(res=request_preprocess(&call))) {
        ipc_call_sync(phone, &call);
        process_answer(&call);
    } else
        IPC_SET_RETVAL(call.data, res);
    STRUCT_TO_USPACE(&data->args, &call.data.args);
 
    return 0;
}
 
/** Synchronous IPC call allowing to send whole message */
unative_t sys_ipc_call_sync(unative_t phoneid, ipc_data_t *question,
               ipc_data_t *reply)
{
    call_t call;
    phone_t *phone;
    int res;
    int rc;
 
    ipc_call_static_init(&call);
    rc = copy_from_uspace(&call.data.args, &question->args, sizeof(call.data.args));
    if (rc != 0)
        return (unative_t) rc;
 
    GET_CHECK_PHONE(phone, phoneid, return ENOENT);
 
    if (!(res=request_preprocess(&call))) {
        ipc_call_sync(phone, &call);
        process_answer(&call);
    } else
        IPC_SET_RETVAL(call.data, res);
 
    rc = STRUCT_TO_USPACE(&reply->args, &call.data.args);
    if (rc != 0)
        return rc;
 
    return 0;
}
 
/** Check that the task did not exceed allowed limit
 *
 * @return 0 - Limit OK,   -1 - limit exceeded
 */
static int check_call_limit(void)
{
    if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) {
        atomic_dec(&TASK->active_calls);
        return -1;
    }
    return 0;
}
 
/** Send an asynchronous call over ipc
 *
 * @return Call identification, returns -1 on fatal error,
           -2 on 'Too many async request, handle answers first
 */
unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method,
                 unative_t arg1, unative_t arg2)
{
    call_t *call;
    phone_t *phone;
    int res;
 
    if (check_call_limit())
        return IPC_CALLRET_TEMPORARY;
 
    GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);
 
    call = ipc_call_alloc(0);
    IPC_SET_METHOD(call->data, method);
    IPC_SET_ARG1(call->data, arg1);
    IPC_SET_ARG2(call->data, arg2);
    IPC_SET_ARG3(call->data, 0);
 
    if (!(res=request_preprocess(call)))
        ipc_call(phone, call);
    else
        ipc_backsend_err(phone, call, res);
 
    return (unative_t) call;
}
 
/** Synchronous IPC call allowing to send whole message
 *
 * @return The same as sys_ipc_call_async
 */
unative_t sys_ipc_call_async(unative_t phoneid, ipc_data_t *data)
{
    call_t *call;
    phone_t *phone;
    int res;
    int rc;
 
    if (check_call_limit())
        return IPC_CALLRET_TEMPORARY;
 
    GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);
 
    call = ipc_call_alloc(0);
    rc = copy_from_uspace(&call->data.args, &data->args, sizeof(call->data.args));
    if (rc != 0) {
        ipc_call_free(call);
        return (unative_t) rc;
    }
    if (!(res=request_preprocess(call)))
        ipc_call(phone, call);
    else
        ipc_backsend_err(phone, call, res);
 
    return (unative_t) call;
}
 
/** Forward received call to another destination
 *
 * The arg1 and arg2 are changed in the forwarded message
 *
 * Warning: If implementing non-fast version, make sure that
 *          arg3 is not rewritten for certain system IPC
 */
unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid,
                  unative_t method, unative_t arg1)
{
    call_t *call;
    phone_t *phone;
 
    call = get_call(callid);
    if (!call)
        return ENOENT;
 
    call->flags |= IPC_CALL_FORWARDED;
 
    GET_CHECK_PHONE(phone, phoneid, {
        IPC_SET_RETVAL(call->data, EFORWARD);
        ipc_answer(&TASK->answerbox, call);
        return ENOENT;
    });    
 
    if (!is_forwardable(IPC_GET_METHOD(call->data))) {
        IPC_SET_RETVAL(call->data, EFORWARD);
        ipc_answer(&TASK->answerbox, call);
        return EPERM;
    }
 
    /* Userspace is not allowed to change method of system methods
     * on forward, allow changing ARG1 and ARG2 by means of method and arg1
     */
    if (is_system_method(IPC_GET_METHOD(call->data))) {
        if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)
            phone_dealloc(IPC_GET_ARG3(call->data));
 
        IPC_SET_ARG1(call->data, method);
        IPC_SET_ARG2(call->data, arg1);
    } else {
        IPC_SET_METHOD(call->data, method);
        IPC_SET_ARG1(call->data, arg1);
    }
 
    return ipc_forward(call, phone, &TASK->answerbox);
}
 
/** Send IPC answer */
unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval,
                 unative_t arg1, unative_t arg2)
{
    call_t *call;
    ipc_data_t saved_data;
    int saveddata = 0;
    int rc;
 
    /* Do not answer notification callids */
    if (callid & IPC_CALLID_NOTIFICATION)
        return 0;
 
    call = get_call(callid);
    if (!call)
        return ENOENT;
 
    if (answer_need_old(call)) {
        memcpy(&saved_data, &call->data, sizeof(call->data));
        saveddata = 1;
    }
 
    IPC_SET_RETVAL(call->data, retval);
    IPC_SET_ARG1(call->data, arg1);
    IPC_SET_ARG2(call->data, arg2);
    rc = answer_preprocess(call, saveddata ? &saved_data : NULL);
 
    ipc_answer(&TASK->answerbox, call);
    return rc;
}
 
/** Send IPC answer */
unative_t sys_ipc_answer(unative_t callid, ipc_data_t *data)
{
    call_t *call;
    ipc_data_t saved_data;
    int saveddata = 0;
    int rc;
 
    /* Do not answer notification callids */
    if (callid & IPC_CALLID_NOTIFICATION)
        return 0;
 
    call = get_call(callid);
    if (!call)
        return ENOENT;
 
    if (answer_need_old(call)) {
        memcpy(&saved_data, &call->data, sizeof(call->data));
        saveddata = 1;
    }
    rc = copy_from_uspace(&call->data.args, &data->args,
             sizeof(call->data.args));
    if (rc != 0)
        return rc;
 
    rc = answer_preprocess(call, saveddata ? &saved_data : NULL);
   
    ipc_answer(&TASK->answerbox, call);
 
    return rc;
}
 
/** Hang up the phone
 *
 */
unative_t sys_ipc_hangup(int phoneid)
{
    phone_t *phone;
 
    GET_CHECK_PHONE(phone, phoneid, return ENOENT);
 
    if (ipc_phone_hangup(phone))
        return -1;
 
    return 0;
}
 
/** Wait for incoming ipc call or answer
 *
 * @param calldata Pointer to buffer where the call/answer data is stored
 * @param usec Timeout. See waitq_sleep_timeout() for explanation.
 * @param flags Select mode of sleep operation. See waitq_sleep_timeout() for explanation.
 *
 * @return Callid, if callid & 1, then the call is answer
 */
unative_t sys_ipc_wait_for_call(ipc_data_t *calldata, uint32_t usec, int flags)
{
    call_t *call;
 
restart:   
    call = ipc_wait_for_call(&TASK->answerbox, usec, flags | SYNCH_FLAGS_INTERRUPTIBLE);
    if (!call)
        return 0;
 
    if (call->flags & IPC_CALL_NOTIF) {
        ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC));
 
        /* Set in_phone_hash to the interrupt counter */
        call->data.phone = (void *)call->private;
       
        STRUCT_TO_USPACE(calldata, &call->data);
 
        ipc_call_free(call);
       
        return ((unative_t)call) | IPC_CALLID_NOTIFICATION;
    }
 
    if (call->flags & IPC_CALL_ANSWERED) {
        process_answer(call);
 
        ASSERT(! (call->flags & IPC_CALL_STATIC_ALLOC));
 
        atomic_dec(&TASK->active_calls);
 
        if (call->flags & IPC_CALL_DISCARD_ANSWER) {
            ipc_call_free(call);
            goto restart;
        }
 
        STRUCT_TO_USPACE(&calldata->args, &call->data.args);
        ipc_call_free(call);
 
        return ((unative_t)call) | IPC_CALLID_ANSWERED;
    }
 
    if (process_request(&TASK->answerbox, call))
        goto restart;
 
    /* Include phone address('id') of the caller in the request,
     * copy whole call->data, not only call->data.args */
    if (STRUCT_TO_USPACE(calldata, &call->data)) {
        return 0;
    }
    return (unative_t)call;
}
 
/** Connect irq handler to task */
unative_t sys_ipc_register_irq(int irq, irq_code_t *ucode)
{
    if (!(cap_get(TASK) & CAP_IRQ_REG))
        return EPERM;
 
    if (irq >= IRQ_COUNT || irq <= -IPC_IRQ_RESERVED_VIRTUAL)
        return (unative_t) ELIMIT;
   
    irq_ipc_bind_arch(irq);
 
    return ipc_irq_register(&TASK->answerbox, irq, ucode);
}
 
/* Disconnect irq handler from task */
unative_t sys_ipc_unregister_irq(int irq)
{
    if (!(cap_get(TASK) & CAP_IRQ_REG))
        return EPERM;
 
    if (irq >= IRQ_COUNT || irq <= -IPC_IRQ_RESERVED_VIRTUAL)
        return (unative_t) ELIMIT;
 
    ipc_irq_unregister(&TASK->answerbox, irq);
 
    return 0;
}
 
/** @}
 */
 

Rev 1757	Rev 1780
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		50
51	#define GET_CHECK_PHONE(phone,phoneid,err) { \	51	#define GET_CHECK_PHONE(phone,phoneid,err) { \
52	if (phoneid > IPC_MAX_PHONES) { err; } \	52	if (phoneid > IPC_MAX_PHONES) { err; } \
53	phone = &TASK->phones[phoneid]; \	53	phone = &TASK->phones[phoneid]; \
54	}	54	}
55		55
56	#define STRUCT_TO_USPACE(dst,src) copy_to_uspace(dst,src,sizeof(*(src)))	56	#define STRUCT_TO_USPACE(dst,src) copy_to_uspace(dst,src,sizeof(*(src)))
57		57
58	/** Return true if the method is a system method */	58	/** Return true if the method is a system method */
59	static inline int is_system_method(__native method)	59	static inline int is_system_method(unative_t method)
60	{	60	{
61	if (method <= IPC_M_LAST_SYSTEM)	61	if (method <= IPC_M_LAST_SYSTEM)
62	return 1;	62	return 1;
63	return 0;	63	return 0;
64	}	64	}
65		65
66	/** Return true if the message with this method is forwardable	66	/** Return true if the message with this method is forwardable
67	*	67	*
68	* - some system messages may be forwarded, for some of them	68	* - some system messages may be forwarded, for some of them
69	* it is useless	69	* it is useless
70	*/	70	*/
71	static inline int is_forwardable(__native method)	71	static inline int is_forwardable(unative_t method)
72	{	72	{
73	if (method == IPC_M_PHONE_HUNGUP \|\| method == IPC_M_AS_AREA_SEND \	73	if (method == IPC_M_PHONE_HUNGUP \|\| method == IPC_M_AS_AREA_SEND \
74	\|\| method == IPC_M_AS_AREA_RECV)	74	\|\| method == IPC_M_AS_AREA_RECV)
75	return 0; /* This message is meant only for the receiver */	75	return 0; /* This message is meant only for the receiver */
76	return 1;	76	return 1;
77	}	77	}
78		78
79	/****************************************************/	79	/****************************************************/
80	/* Functions that preprocess answer before sending	80	/* Functions that preprocess answer before sending
81	* it to the recepient	81	* it to the recepient
82	*/	82	*/
83		83
84	/** Return true if the caller (ipc_answer) should save	84	/** Return true if the caller (ipc_answer) should save
85	* the old call contents for answer_preprocess	85	* the old call contents for answer_preprocess
86	*/	86	*/
87	static inline int answer_need_old(call_t *call)	87	static inline int answer_need_old(call_t *call)
88	{	88	{
89	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)	89	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)
90	return 1;	90	return 1;
91	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_ME_TO)	91	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_ME_TO)
92	return 1;	92	return 1;
93	if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_SEND)	93	if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_SEND)
94	return 1;	94	return 1;
95	if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_RECV)	95	if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_RECV)
96	return 1;	96	return 1;
97	return 0;	97	return 0;
98	}	98	}
99		99
100	/** Interpret process answer as control information	100	/** Interpret process answer as control information
101	*	101	*
102	* This function is called directly after sys_ipc_answer	102	* This function is called directly after sys_ipc_answer
103	*/	103	*/
104	static inline int answer_preprocess(call_t answer, ipc_data_t olddata)	104	static inline int answer_preprocess(call_t answer, ipc_data_t olddata)
105	{	105	{
106	int phoneid;	106	int phoneid;
107		107
108	if (IPC_GET_RETVAL(answer->data) == EHANGUP) {	108	if (IPC_GET_RETVAL(answer->data) == EHANGUP) {
109	/* In case of forward, hangup the forwared phone,	109	/* In case of forward, hangup the forwared phone,
110	* not the originator	110	* not the originator
111	*/	111	*/
112	spinlock_lock(&answer->data.phone->lock);	112	spinlock_lock(&answer->data.phone->lock);
113	spinlock_lock(&TASK->answerbox.lock);	113	spinlock_lock(&TASK->answerbox.lock);
114	if (answer->data.phone->state == IPC_PHONE_CONNECTED) {	114	if (answer->data.phone->state == IPC_PHONE_CONNECTED) {
115	list_remove(&answer->data.phone->link);	115	list_remove(&answer->data.phone->link);
116	answer->data.phone->state = IPC_PHONE_SLAMMED;	116	answer->data.phone->state = IPC_PHONE_SLAMMED;
117	}	117	}
118	spinlock_unlock(&TASK->answerbox.lock);	118	spinlock_unlock(&TASK->answerbox.lock);
119	spinlock_unlock(&answer->data.phone->lock);	119	spinlock_unlock(&answer->data.phone->lock);
120	}	120	}
121		121
122	if (!olddata)	122	if (!olddata)
123	return 0;	123	return 0;
124		124
125	if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) {	125	if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) {
126	phoneid = IPC_GET_ARG3(*olddata);	126	phoneid = IPC_GET_ARG3(*olddata);
127	if (IPC_GET_RETVAL(answer->data)) {	127	if (IPC_GET_RETVAL(answer->data)) {
128	/* The connection was not accepted */	128	/* The connection was not accepted */
129	phone_dealloc(phoneid);	129	phone_dealloc(phoneid);
130	} else {	130	} else {
131	/* The connection was accepted */	131	/* The connection was accepted */
132	phone_connect(phoneid,&answer->sender->answerbox);	132	phone_connect(phoneid,&answer->sender->answerbox);
133	/* Set 'phone identification' as arg3 of response */	133	/* Set 'phone identification' as arg3 of response */
134	IPC_SET_ARG3(answer->data, (__native)&TASK->phones[phoneid]);	134	IPC_SET_ARG3(answer->data, (unative_t)&TASK->phones[phoneid]);
135	}	135	}
136	} else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) {	136	} else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) {
137	/* If the users accepted call, connect */	137	/* If the users accepted call, connect */
138	if (!IPC_GET_RETVAL(answer->data)) {	138	if (!IPC_GET_RETVAL(answer->data)) {
139	ipc_phone_connect((phone_t )IPC_GET_ARG3(olddata),	139	ipc_phone_connect((phone_t )IPC_GET_ARG3(olddata),
140	&TASK->answerbox);	140	&TASK->answerbox);
141	}	141	}
142	} else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_SEND) {	142	} else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_SEND) {
143	if (!IPC_GET_RETVAL(answer->data)) { /* Accepted, handle as_area receipt */	143	if (!IPC_GET_RETVAL(answer->data)) { /* Accepted, handle as_area receipt */
144	ipl_t ipl;	144	ipl_t ipl;
145	int rc;	145	int rc;
146	as_t *as;	146	as_t *as;
147		147
148	ipl = interrupts_disable();	148	ipl = interrupts_disable();
149	spinlock_lock(&answer->sender->lock);	149	spinlock_lock(&answer->sender->lock);
150	as = answer->sender->as;	150	as = answer->sender->as;
151	spinlock_unlock(&answer->sender->lock);	151	spinlock_unlock(&answer->sender->lock);
152	interrupts_restore(ipl);	152	interrupts_restore(ipl);
153		153
154	rc = as_area_share(as, IPC_GET_ARG1(olddata), IPC_GET_ARG2(olddata),	154	rc = as_area_share(as, IPC_GET_ARG1(olddata), IPC_GET_ARG2(olddata),
155	AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata));	155	AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata));
156	IPC_SET_RETVAL(answer->data, rc);	156	IPC_SET_RETVAL(answer->data, rc);
157	return rc;	157	return rc;
158	}	158	}
159	} else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_RECV) {	159	} else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_RECV) {
160	if (!IPC_GET_RETVAL(answer->data)) {	160	if (!IPC_GET_RETVAL(answer->data)) {
161	ipl_t ipl;	161	ipl_t ipl;
162	as_t *as;	162	as_t *as;
163	int rc;	163	int rc;
164		164
165	ipl = interrupts_disable();	165	ipl = interrupts_disable();
166	spinlock_lock(&answer->sender->lock);	166	spinlock_lock(&answer->sender->lock);
167	as = answer->sender->as;	167	as = answer->sender->as;
168	spinlock_unlock(&answer->sender->lock);	168	spinlock_unlock(&answer->sender->lock);
169	interrupts_restore(ipl);	169	interrupts_restore(ipl);
170		170
171	rc = as_area_share(AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG2(*olddata),	171	rc = as_area_share(AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG2(*olddata),
172	as, IPC_GET_ARG1(*olddata), IPC_GET_ARG2(answer->data));	172	as, IPC_GET_ARG1(*olddata), IPC_GET_ARG2(answer->data));
173	IPC_SET_RETVAL(answer->data, rc);	173	IPC_SET_RETVAL(answer->data, rc);
174	}	174	}
175	}	175	}
176	return 0;	176	return 0;
177	}	177	}
178		178
179	/** Called before the request is sent	179	/** Called before the request is sent
180	*	180	*
181	* @return 0 - no error, -1 - report error to user	181	* @return 0 - no error, -1 - report error to user
182	*/	182	*/
183	static int request_preprocess(call_t *call)	183	static int request_preprocess(call_t *call)
184	{	184	{
185	int newphid;	185	int newphid;
186	size_t size;	186	size_t size;
187		187
188	switch (IPC_GET_METHOD(call->data)) {	188	switch (IPC_GET_METHOD(call->data)) {
189	case IPC_M_CONNECT_ME_TO:	189	case IPC_M_CONNECT_ME_TO:
190	newphid = phone_alloc();	190	newphid = phone_alloc();
191	if (newphid < 0)	191	if (newphid < 0)
192	return ELIMIT;	192	return ELIMIT;
193	/* Set arg3 for server */	193	/* Set arg3 for server */
194	IPC_SET_ARG3(call->data, (__native)&TASK->phones[newphid]);	194	IPC_SET_ARG3(call->data, (unative_t)&TASK->phones[newphid]);
195	call->flags \|= IPC_CALL_CONN_ME_TO;	195	call->flags \|= IPC_CALL_CONN_ME_TO;
196	call->private = newphid;	196	call->private = newphid;
197	break;	197	break;
198	case IPC_M_AS_AREA_SEND:	198	case IPC_M_AS_AREA_SEND:
199	size = as_get_size(IPC_GET_ARG1(call->data));	199	size = as_get_size(IPC_GET_ARG1(call->data));
200	if (!size) {	200	if (!size) {
201	return EPERM;	201	return EPERM;
202	}	202	}
203	IPC_SET_ARG2(call->data, size);	203	IPC_SET_ARG2(call->data, size);
204	break;	204	break;
205	default:	205	default:
206	break;	206	break;
207	}	207	}
208	return 0;	208	return 0;
209	}	209	}
210		210
211	/****************************************************/	211	/****************************************************/
212	/* Functions called to process received call/answer	212	/* Functions called to process received call/answer
213	* before passing to uspace	213	* before passing to uspace
214	*/	214	*/
215		215
216	/** Do basic kernel processing of received call answer */	216	/** Do basic kernel processing of received call answer */
217	static void process_answer(call_t *call)	217	static void process_answer(call_t *call)
218	{	218	{
219	if (IPC_GET_RETVAL(call->data) == EHANGUP && \	219	if (IPC_GET_RETVAL(call->data) == EHANGUP && \
220	call->flags & IPC_CALL_FORWARDED)	220	call->flags & IPC_CALL_FORWARDED)
221	IPC_SET_RETVAL(call->data, EFORWARD);	221	IPC_SET_RETVAL(call->data, EFORWARD);
222		222
223	if (call->flags & IPC_CALL_CONN_ME_TO) {	223	if (call->flags & IPC_CALL_CONN_ME_TO) {
224	if (IPC_GET_RETVAL(call->data))	224	if (IPC_GET_RETVAL(call->data))
225	phone_dealloc(call->private);	225	phone_dealloc(call->private);
226	else	226	else
227	IPC_SET_ARG3(call->data, call->private);	227	IPC_SET_ARG3(call->data, call->private);
228	}	228	}
229	}	229	}
230		230
231	/** Do basic kernel processing of received call request	231	/** Do basic kernel processing of received call request
232	*	232	*
233	* @return 0 - the call should be passed to userspace, 1 - ignore call	233	* @return 0 - the call should be passed to userspace, 1 - ignore call
234	*/	234	*/
235	static int process_request(answerbox_t box,call_t call)	235	static int process_request(answerbox_t box,call_t call)
236	{	236	{
237	int phoneid;	237	int phoneid;
238		238
239	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) {	239	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) {
240	phoneid = phone_alloc();	240	phoneid = phone_alloc();
241	if (phoneid < 0) { /* Failed to allocate phone */	241	if (phoneid < 0) { /* Failed to allocate phone */
242	IPC_SET_RETVAL(call->data, ELIMIT);	242	IPC_SET_RETVAL(call->data, ELIMIT);
243	ipc_answer(box,call);	243	ipc_answer(box,call);
244	return -1;	244	return -1;
245	}	245	}
246	IPC_SET_ARG3(call->data, phoneid);	246	IPC_SET_ARG3(call->data, phoneid);
247	}	247	}
248	return 0;	248	return 0;
249	}	249	}
250		250
251	/** Send a call over IPC, wait for reply, return to user	251	/** Send a call over IPC, wait for reply, return to user
252	*	252	*
253	* @return Call identification, returns -1 on fatal error,	253	* @return Call identification, returns -1 on fatal error,
254	-2 on 'Too many async request, handle answers first	254	-2 on 'Too many async request, handle answers first
255	*/	255	*/
256	__native sys_ipc_call_sync_fast(__native phoneid, __native method,	256	unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method,
257	__native arg1, ipc_data_t *data)	257	unative_t arg1, ipc_data_t *data)
258	{	258	{
259	call_t call;	259	call_t call;
260	phone_t *phone;	260	phone_t *phone;
261	int res;	261	int res;
262		262
263	GET_CHECK_PHONE(phone, phoneid, return ENOENT);	263	GET_CHECK_PHONE(phone, phoneid, return ENOENT);
264		264
265	ipc_call_static_init(&call);	265	ipc_call_static_init(&call);
266	IPC_SET_METHOD(call.data, method);	266	IPC_SET_METHOD(call.data, method);
267	IPC_SET_ARG1(call.data, arg1);	267	IPC_SET_ARG1(call.data, arg1);
268		268
269	if (!(res=request_preprocess(&call))) {	269	if (!(res=request_preprocess(&call))) {
270	ipc_call_sync(phone, &call);	270	ipc_call_sync(phone, &call);
271	process_answer(&call);	271	process_answer(&call);
272	} else	272	} else
273	IPC_SET_RETVAL(call.data, res);	273	IPC_SET_RETVAL(call.data, res);
274	STRUCT_TO_USPACE(&data->args, &call.data.args);	274	STRUCT_TO_USPACE(&data->args, &call.data.args);
275		275
276	return 0;	276	return 0;
277	}	277	}
278		278
279	/** Synchronous IPC call allowing to send whole message */	279	/** Synchronous IPC call allowing to send whole message */
280	__native sys_ipc_call_sync(__native phoneid, ipc_data_t *question,	280	unative_t sys_ipc_call_sync(unative_t phoneid, ipc_data_t *question,
281	ipc_data_t *reply)	281	ipc_data_t *reply)
282	{	282	{
283	call_t call;	283	call_t call;
284	phone_t *phone;	284	phone_t *phone;
285	int res;	285	int res;
286	int rc;	286	int rc;
287		287
288	ipc_call_static_init(&call);	288	ipc_call_static_init(&call);
289	rc = copy_from_uspace(&call.data.args, &question->args, sizeof(call.data.args));	289	rc = copy_from_uspace(&call.data.args, &question->args, sizeof(call.data.args));
290	if (rc != 0)	290	if (rc != 0)
291	return (__native) rc;	291	return (unative_t) rc;
292		292
293	GET_CHECK_PHONE(phone, phoneid, return ENOENT);	293	GET_CHECK_PHONE(phone, phoneid, return ENOENT);
294		294
295	if (!(res=request_preprocess(&call))) {	295	if (!(res=request_preprocess(&call))) {
296	ipc_call_sync(phone, &call);	296	ipc_call_sync(phone, &call);
297	process_answer(&call);	297	process_answer(&call);
298	} else	298	} else
299	IPC_SET_RETVAL(call.data, res);	299	IPC_SET_RETVAL(call.data, res);
300		300
301	rc = STRUCT_TO_USPACE(&reply->args, &call.data.args);	301	rc = STRUCT_TO_USPACE(&reply->args, &call.data.args);
302	if (rc != 0)	302	if (rc != 0)
303	return rc;	303	return rc;
304		304
305	return 0;	305	return 0;
306	}	306	}
307		307
308	/** Check that the task did not exceed allowed limit	308	/** Check that the task did not exceed allowed limit
309	*	309	*
310	* @return 0 - Limit OK, -1 - limit exceeded	310	* @return 0 - Limit OK, -1 - limit exceeded
311	*/	311	*/
312	static int check_call_limit(void)	312	static int check_call_limit(void)
313	{	313	{
314	if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) {	314	if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) {
315	atomic_dec(&TASK->active_calls);	315	atomic_dec(&TASK->active_calls);
316	return -1;	316	return -1;
317	}	317	}
318	return 0;	318	return 0;
319	}	319	}
320		320
321	/** Send an asynchronous call over ipc	321	/** Send an asynchronous call over ipc
322	*	322	*
323	* @return Call identification, returns -1 on fatal error,	323	* @return Call identification, returns -1 on fatal error,
324	-2 on 'Too many async request, handle answers first	324	-2 on 'Too many async request, handle answers first
325	*/	325	*/
326	__native sys_ipc_call_async_fast(__native phoneid, __native method,	326	unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method,
327	__native arg1, __native arg2)	327	unative_t arg1, unative_t arg2)
328	{	328	{
329	call_t *call;	329	call_t *call;
330	phone_t *phone;	330	phone_t *phone;
331	int res;	331	int res;
332		332
333	if (check_call_limit())	333	if (check_call_limit())
334	return IPC_CALLRET_TEMPORARY;	334	return IPC_CALLRET_TEMPORARY;
335		335
336	GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);	336	GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);
337		337
338	call = ipc_call_alloc(0);	338	call = ipc_call_alloc(0);
339	IPC_SET_METHOD(call->data, method);	339	IPC_SET_METHOD(call->data, method);
340	IPC_SET_ARG1(call->data, arg1);	340	IPC_SET_ARG1(call->data, arg1);
341	IPC_SET_ARG2(call->data, arg2);	341	IPC_SET_ARG2(call->data, arg2);
342	IPC_SET_ARG3(call->data, 0);	342	IPC_SET_ARG3(call->data, 0);
343		343
344	if (!(res=request_preprocess(call)))	344	if (!(res=request_preprocess(call)))
345	ipc_call(phone, call);	345	ipc_call(phone, call);
346	else	346	else
347	ipc_backsend_err(phone, call, res);	347	ipc_backsend_err(phone, call, res);
348		348
349	return (__native) call;	349	return (unative_t) call;
350	}	350	}
351		351
352	/** Synchronous IPC call allowing to send whole message	352	/** Synchronous IPC call allowing to send whole message
353	*	353	*
354	* @return The same as sys_ipc_call_async	354	* @return The same as sys_ipc_call_async
355	*/	355	*/
356	__native sys_ipc_call_async(__native phoneid, ipc_data_t *data)	356	unative_t sys_ipc_call_async(unative_t phoneid, ipc_data_t *data)
357	{	357	{
358	call_t *call;	358	call_t *call;
359	phone_t *phone;	359	phone_t *phone;
360	int res;	360	int res;
361	int rc;	361	int rc;
362		362
363	if (check_call_limit())	363	if (check_call_limit())
364	return IPC_CALLRET_TEMPORARY;	364	return IPC_CALLRET_TEMPORARY;
365		365
366	GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);	366	GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);
367		367
368	call = ipc_call_alloc(0);	368	call = ipc_call_alloc(0);
369	rc = copy_from_uspace(&call->data.args, &data->args, sizeof(call->data.args));	369	rc = copy_from_uspace(&call->data.args, &data->args, sizeof(call->data.args));
370	if (rc != 0) {	370	if (rc != 0) {
371	ipc_call_free(call);	371	ipc_call_free(call);
372	return (__native) rc;	372	return (unative_t) rc;
373	}	373	}
374	if (!(res=request_preprocess(call)))	374	if (!(res=request_preprocess(call)))
375	ipc_call(phone, call);	375	ipc_call(phone, call);
376	else	376	else
377	ipc_backsend_err(phone, call, res);	377	ipc_backsend_err(phone, call, res);
378		378
379	return (__native) call;	379	return (unative_t) call;
380	}	380	}
381		381
382	/** Forward received call to another destination	382	/** Forward received call to another destination
383	*	383	*
384	* The arg1 and arg2 are changed in the forwarded message	384	* The arg1 and arg2 are changed in the forwarded message
385	*	385	*
386	* Warning: If implementing non-fast version, make sure that	386	* Warning: If implementing non-fast version, make sure that
387	* arg3 is not rewritten for certain system IPC	387	* arg3 is not rewritten for certain system IPC
388	*/	388	*/
389	__native sys_ipc_forward_fast(__native callid, __native phoneid,	389	unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid,
390	__native method, __native arg1)	390	unative_t method, unative_t arg1)
391	{	391	{
392	call_t *call;	392	call_t *call;
393	phone_t *phone;	393	phone_t *phone;
394		394
395	call = get_call(callid);	395	call = get_call(callid);
396	if (!call)	396	if (!call)
397	return ENOENT;	397	return ENOENT;
398		398
399	call->flags \|= IPC_CALL_FORWARDED;	399	call->flags \|= IPC_CALL_FORWARDED;
400		400
401	GET_CHECK_PHONE(phone, phoneid, {	401	GET_CHECK_PHONE(phone, phoneid, {
402	IPC_SET_RETVAL(call->data, EFORWARD);	402	IPC_SET_RETVAL(call->data, EFORWARD);
403	ipc_answer(&TASK->answerbox, call);	403	ipc_answer(&TASK->answerbox, call);
404	return ENOENT;	404	return ENOENT;
405	});	405	});
406		406
407	if (!is_forwardable(IPC_GET_METHOD(call->data))) {	407	if (!is_forwardable(IPC_GET_METHOD(call->data))) {
408	IPC_SET_RETVAL(call->data, EFORWARD);	408	IPC_SET_RETVAL(call->data, EFORWARD);
409	ipc_answer(&TASK->answerbox, call);	409	ipc_answer(&TASK->answerbox, call);
410	return EPERM;	410	return EPERM;
411	}	411	}
412		412
413	/* Userspace is not allowed to change method of system methods	413	/* Userspace is not allowed to change method of system methods
414	* on forward, allow changing ARG1 and ARG2 by means of method and arg1	414	* on forward, allow changing ARG1 and ARG2 by means of method and arg1
415	*/	415	*/
416	if (is_system_method(IPC_GET_METHOD(call->data))) {	416	if (is_system_method(IPC_GET_METHOD(call->data))) {
417	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)	417	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)
418	phone_dealloc(IPC_GET_ARG3(call->data));	418	phone_dealloc(IPC_GET_ARG3(call->data));
419		419
420	IPC_SET_ARG1(call->data, method);	420	IPC_SET_ARG1(call->data, method);
421	IPC_SET_ARG2(call->data, arg1);	421	IPC_SET_ARG2(call->data, arg1);
422	} else {	422	} else {
423	IPC_SET_METHOD(call->data, method);	423	IPC_SET_METHOD(call->data, method);
424	IPC_SET_ARG1(call->data, arg1);	424	IPC_SET_ARG1(call->data, arg1);
425	}	425	}
426		426
427	return ipc_forward(call, phone, &TASK->answerbox);	427	return ipc_forward(call, phone, &TASK->answerbox);
428	}	428	}
429		429
430	/** Send IPC answer */	430	/** Send IPC answer */
431	__native sys_ipc_answer_fast(__native callid, __native retval,	431	unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval,
432	__native arg1, __native arg2)	432	unative_t arg1, unative_t arg2)
433	{	433	{
434	call_t *call;	434	call_t *call;
435	ipc_data_t saved_data;	435	ipc_data_t saved_data;
436	int saveddata = 0;	436	int saveddata = 0;
437	int rc;	437	int rc;
438		438
439	/* Do not answer notification callids */	439	/* Do not answer notification callids */
440	if (callid & IPC_CALLID_NOTIFICATION)	440	if (callid & IPC_CALLID_NOTIFICATION)
441	return 0;	441	return 0;
442		442
443	call = get_call(callid);	443	call = get_call(callid);
444	if (!call)	444	if (!call)
445	return ENOENT;	445	return ENOENT;
446		446
447	if (answer_need_old(call)) {	447	if (answer_need_old(call)) {
448	memcpy(&saved_data, &call->data, sizeof(call->data));	448	memcpy(&saved_data, &call->data, sizeof(call->data));
449	saveddata = 1;	449	saveddata = 1;
450	}	450	}
451		451
452	IPC_SET_RETVAL(call->data, retval);	452	IPC_SET_RETVAL(call->data, retval);
453	IPC_SET_ARG1(call->data, arg1);	453	IPC_SET_ARG1(call->data, arg1);
454	IPC_SET_ARG2(call->data, arg2);	454	IPC_SET_ARG2(call->data, arg2);
455	rc = answer_preprocess(call, saveddata ? &saved_data : NULL);	455	rc = answer_preprocess(call, saveddata ? &saved_data : NULL);
456		456
457	ipc_answer(&TASK->answerbox, call);	457	ipc_answer(&TASK->answerbox, call);
458	return rc;	458	return rc;
459	}	459	}
460		460
461	/** Send IPC answer */	461	/** Send IPC answer */
462	__native sys_ipc_answer(__native callid, ipc_data_t *data)	462	unative_t sys_ipc_answer(unative_t callid, ipc_data_t *data)
463	{	463	{
464	call_t *call;	464	call_t *call;
465	ipc_data_t saved_data;	465	ipc_data_t saved_data;
466	int saveddata = 0;	466	int saveddata = 0;
467	int rc;	467	int rc;
468		468
469	/* Do not answer notification callids */	469	/* Do not answer notification callids */
470	if (callid & IPC_CALLID_NOTIFICATION)	470	if (callid & IPC_CALLID_NOTIFICATION)
471	return 0;	471	return 0;
472		472
473	call = get_call(callid);	473	call = get_call(callid);
474	if (!call)	474	if (!call)
475	return ENOENT;	475	return ENOENT;
476		476
477	if (answer_need_old(call)) {	477	if (answer_need_old(call)) {
478	memcpy(&saved_data, &call->data, sizeof(call->data));	478	memcpy(&saved_data, &call->data, sizeof(call->data));
479	saveddata = 1;	479	saveddata = 1;
480	}	480	}
481	rc = copy_from_uspace(&call->data.args, &data->args,	481	rc = copy_from_uspace(&call->data.args, &data->args,
482	sizeof(call->data.args));	482	sizeof(call->data.args));
483	if (rc != 0)	483	if (rc != 0)
484	return rc;	484	return rc;
485		485
486	rc = answer_preprocess(call, saveddata ? &saved_data : NULL);	486	rc = answer_preprocess(call, saveddata ? &saved_data : NULL);
487		487
488	ipc_answer(&TASK->answerbox, call);	488	ipc_answer(&TASK->answerbox, call);
489		489
490	return rc;	490	return rc;
491	}	491	}
492		492
493	/** Hang up the phone	493	/** Hang up the phone
494	*	494	*
495	*/	495	*/
496	__native sys_ipc_hangup(int phoneid)	496	unative_t sys_ipc_hangup(int phoneid)
497	{	497	{
498	phone_t *phone;	498	phone_t *phone;
499		499
500	GET_CHECK_PHONE(phone, phoneid, return ENOENT);	500	GET_CHECK_PHONE(phone, phoneid, return ENOENT);

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/generic/src/ipc/sysipc.c – Rev 1757 → 1780