WebSVN – HelenOS – Diff – /trunk/kernel/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>
#include <print.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.
 *
 * @param inr IRQ number.
 * @param devno Device number.
 * @param method Method to be associated with the notification.
 * @param ucode Uspace pointer to the top-half pseudocode.
 *
 * @return EPERM or a return code returned by ipc_irq_register().
 */
unative_t sys_ipc_register_irq(inr_t inr, devno_t devno, unative_t method, irq_code_t *ucode)
{
    if (!(cap_get(TASK) & CAP_IRQ_REG))
        return EPERM;
 
    return ipc_irq_register(&TASK->answerbox, inr, devno, method, ucode);
}
 
/** Disconnect irq handler from task.
 *
 * @param inr IRQ number.
 * @param devno Device number.
 */
unative_t sys_ipc_unregister_irq(inr_t inr, devno_t devno)
{
    if (!(cap_get(TASK) & CAP_IRQ_REG))
        return EPERM;
 
    ipc_irq_unregister(&TASK->answerbox, inr, devno);
 
    return 0;
}
 
/** @}
 */
 

Rev 1923	Rev 2071
1	/*	1	/*
2	* Copyright (C) 2006 Ondrej Palkovsky	2	* Copyright (c) 2006 Ondrej Palkovsky
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup genericipc	29	/** @addtogroup genericipc
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	*/	33	*/
34		34
35	#include <arch.h>	35	#include <arch.h>
36	#include <proc/task.h>	36	#include <proc/task.h>
37	#include <proc/thread.h>	37	#include <proc/thread.h>
38	#include <errno.h>	38	#include <errno.h>
39	#include <memstr.h>	39	#include <memstr.h>
40	#include <debug.h>	40	#include <debug.h>
41	#include <ipc/ipc.h>	41	#include <ipc/ipc.h>
42	#include <ipc/sysipc.h>	42	#include <ipc/sysipc.h>
43	#include <ipc/irq.h>	43	#include <ipc/irq.h>
44	#include <ipc/ipcrsc.h>	44	#include <ipc/ipcrsc.h>
45	#include <arch/interrupt.h>	45	#include <arch/interrupt.h>
46	#include <print.h>	46	#include <print.h>
47	#include <syscall/copy.h>	47	#include <syscall/copy.h>
48	#include <security/cap.h>	48	#include <security/cap.h>
49	#include <mm/as.h>	49	#include <mm/as.h>
50	#include <print.h>	50	#include <print.h>
51		51
52	#define GET_CHECK_PHONE(phone,phoneid,err) { \	52	#define GET_CHECK_PHONE(phone,phoneid,err) { \
53	if (phoneid > IPC_MAX_PHONES) { err; } \	53	if (phoneid > IPC_MAX_PHONES) { err; } \
54	phone = &TASK->phones[phoneid]; \	54	phone = &TASK->phones[phoneid]; \
55	}	55	}
56		56
57	#define STRUCT_TO_USPACE(dst,src) copy_to_uspace(dst,src,sizeof(*(src)))	57	#define STRUCT_TO_USPACE(dst,src) copy_to_uspace(dst,src,sizeof(*(src)))
58		58
59	/** Return true if the method is a system method */	59	/** Return true if the method is a system method */
60	static inline int is_system_method(unative_t method)	60	static inline int is_system_method(unative_t method)
61	{	61	{
62	if (method <= IPC_M_LAST_SYSTEM)	62	if (method <= IPC_M_LAST_SYSTEM)
63	return 1;	63	return 1;
64	return 0;	64	return 0;
65	}	65	}
66		66
67	/** Return true if the message with this method is forwardable	67	/** Return true if the message with this method is forwardable
68	*	68	*
69	* - some system messages may be forwarded, for some of them	69	* - some system messages may be forwarded, for some of them
70	* it is useless	70	* it is useless
71	*/	71	*/
72	static inline int is_forwardable(unative_t method)	72	static inline int is_forwardable(unative_t method)
73	{	73	{
74	if (method == IPC_M_PHONE_HUNGUP \|\| method == IPC_M_AS_AREA_SEND \	74	if (method == IPC_M_PHONE_HUNGUP \|\| method == IPC_M_AS_AREA_SEND \
75	\|\| method == IPC_M_AS_AREA_RECV)	75	\|\| method == IPC_M_AS_AREA_RECV)
76	return 0; /* This message is meant only for the receiver */	76	return 0; /* This message is meant only for the receiver */
77	return 1;	77	return 1;
78	}	78	}
79		79
80	/****************************************************/	80	/****************************************************/
81	/* Functions that preprocess answer before sending	81	/* Functions that preprocess answer before sending
82	* it to the recepient	82	* it to the recepient
83	*/	83	*/
84		84
85	/** Return true if the caller (ipc_answer) should save	85	/** Return true if the caller (ipc_answer) should save
86	* the old call contents for answer_preprocess	86	* the old call contents for answer_preprocess
87	*/	87	*/
88	static inline int answer_need_old(call_t *call)	88	static inline int answer_need_old(call_t *call)
89	{	89	{
90	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)	90	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)
91	return 1;	91	return 1;
92	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_ME_TO)	92	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_ME_TO)
93	return 1;	93	return 1;
94	if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_SEND)	94	if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_SEND)
95	return 1;	95	return 1;
96	if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_RECV)	96	if (IPC_GET_METHOD(call->data) == IPC_M_AS_AREA_RECV)
97	return 1;	97	return 1;
98	return 0;	98	return 0;
99	}	99	}
100		100
101	/** Interpret process answer as control information	101	/** Interpret process answer as control information
102	*	102	*
103	* This function is called directly after sys_ipc_answer	103	* This function is called directly after sys_ipc_answer
104	*/	104	*/
105	static inline int answer_preprocess(call_t answer, ipc_data_t olddata)	105	static inline int answer_preprocess(call_t answer, ipc_data_t olddata)
106	{	106	{
107	int phoneid;	107	int phoneid;
108		108
109	if (IPC_GET_RETVAL(answer->data) == EHANGUP) {	109	if (IPC_GET_RETVAL(answer->data) == EHANGUP) {
110	/* In case of forward, hangup the forwared phone,	110	/* In case of forward, hangup the forwared phone,
111	* not the originator	111	* not the originator
112	*/	112	*/
113	spinlock_lock(&answer->data.phone->lock);	113	spinlock_lock(&answer->data.phone->lock);
114	spinlock_lock(&TASK->answerbox.lock);	114	spinlock_lock(&TASK->answerbox.lock);
115	if (answer->data.phone->state == IPC_PHONE_CONNECTED) {	115	if (answer->data.phone->state == IPC_PHONE_CONNECTED) {
116	list_remove(&answer->data.phone->link);	116	list_remove(&answer->data.phone->link);
117	answer->data.phone->state = IPC_PHONE_SLAMMED;	117	answer->data.phone->state = IPC_PHONE_SLAMMED;
118	}	118	}
119	spinlock_unlock(&TASK->answerbox.lock);	119	spinlock_unlock(&TASK->answerbox.lock);
120	spinlock_unlock(&answer->data.phone->lock);	120	spinlock_unlock(&answer->data.phone->lock);
121	}	121	}
122		122
123	if (!olddata)	123	if (!olddata)
124	return 0;	124	return 0;
125		125
126	if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) {	126	if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) {
127	phoneid = IPC_GET_ARG3(*olddata);	127	phoneid = IPC_GET_ARG3(*olddata);
128	if (IPC_GET_RETVAL(answer->data)) {	128	if (IPC_GET_RETVAL(answer->data)) {
129	/* The connection was not accepted */	129	/* The connection was not accepted */
130	phone_dealloc(phoneid);	130	phone_dealloc(phoneid);
131	} else {	131	} else {
132	/* The connection was accepted */	132	/* The connection was accepted */
133	phone_connect(phoneid,&answer->sender->answerbox);	133	phone_connect(phoneid,&answer->sender->answerbox);
134	/* Set 'phone identification' as arg3 of response */	134	/* Set 'phone identification' as arg3 of response */
135	IPC_SET_ARG3(answer->data, (unative_t)&TASK->phones[phoneid]);	135	IPC_SET_ARG3(answer->data, (unative_t)&TASK->phones[phoneid]);
136	}	136	}
137	} else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) {	137	} else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) {
138	/* If the users accepted call, connect */	138	/* If the users accepted call, connect */
139	if (!IPC_GET_RETVAL(answer->data)) {	139	if (!IPC_GET_RETVAL(answer->data)) {
140	ipc_phone_connect((phone_t )IPC_GET_ARG3(olddata),	140	ipc_phone_connect((phone_t )IPC_GET_ARG3(olddata),
141	&TASK->answerbox);	141	&TASK->answerbox);
142	}	142	}
143	} else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_SEND) {	143	} else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_SEND) {
144	if (!IPC_GET_RETVAL(answer->data)) { /* Accepted, handle as_area receipt */	144	if (!IPC_GET_RETVAL(answer->data)) { /* Accepted, handle as_area receipt */
145	ipl_t ipl;	145	ipl_t ipl;
146	int rc;	146	int rc;
147	as_t *as;	147	as_t *as;
148		148
149	ipl = interrupts_disable();	149	ipl = interrupts_disable();
150	spinlock_lock(&answer->sender->lock);	150	spinlock_lock(&answer->sender->lock);
151	as = answer->sender->as;	151	as = answer->sender->as;
152	spinlock_unlock(&answer->sender->lock);	152	spinlock_unlock(&answer->sender->lock);
153	interrupts_restore(ipl);	153	interrupts_restore(ipl);
154		154
155	rc = as_area_share(as, IPC_GET_ARG1(olddata), IPC_GET_ARG2(olddata),	155	rc = as_area_share(as, IPC_GET_ARG1(olddata), IPC_GET_ARG2(olddata),
156	AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata));	156	AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata));
157	IPC_SET_RETVAL(answer->data, rc);	157	IPC_SET_RETVAL(answer->data, rc);
158	return rc;	158	return rc;
159	}	159	}
160	} else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_RECV) {	160	} else if (IPC_GET_METHOD(*olddata) == IPC_M_AS_AREA_RECV) {
161	if (!IPC_GET_RETVAL(answer->data)) {	161	if (!IPC_GET_RETVAL(answer->data)) {
162	ipl_t ipl;	162	ipl_t ipl;
163	as_t *as;	163	as_t *as;
164	int rc;	164	int rc;
165		165
166	ipl = interrupts_disable();	166	ipl = interrupts_disable();
167	spinlock_lock(&answer->sender->lock);	167	spinlock_lock(&answer->sender->lock);
168	as = answer->sender->as;	168	as = answer->sender->as;
169	spinlock_unlock(&answer->sender->lock);	169	spinlock_unlock(&answer->sender->lock);
170	interrupts_restore(ipl);	170	interrupts_restore(ipl);
171		171
172	rc = as_area_share(AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG2(*olddata),	172	rc = as_area_share(AS, IPC_GET_ARG1(answer->data), IPC_GET_ARG2(*olddata),
173	as, IPC_GET_ARG1(*olddata), IPC_GET_ARG2(answer->data));	173	as, IPC_GET_ARG1(*olddata), IPC_GET_ARG2(answer->data));
174	IPC_SET_RETVAL(answer->data, rc);	174	IPC_SET_RETVAL(answer->data, rc);
175	}	175	}
176	}	176	}
177	return 0;	177	return 0;
178	}	178	}
179		179
180	/** Called before the request is sent	180	/** Called before the request is sent
181	*	181	*
182	* @return 0 - no error, -1 - report error to user	182	* @return 0 - no error, -1 - report error to user
183	*/	183	*/
184	static int request_preprocess(call_t *call)	184	static int request_preprocess(call_t *call)
185	{	185	{
186	int newphid;	186	int newphid;
187	size_t size;	187	size_t size;
188		188
189	switch (IPC_GET_METHOD(call->data)) {	189	switch (IPC_GET_METHOD(call->data)) {
190	case IPC_M_CONNECT_ME_TO:	190	case IPC_M_CONNECT_ME_TO:
191	newphid = phone_alloc();	191	newphid = phone_alloc();
192	if (newphid < 0)	192	if (newphid < 0)
193	return ELIMIT;	193	return ELIMIT;
194	/* Set arg3 for server */	194	/* Set arg3 for server */
195	IPC_SET_ARG3(call->data, (unative_t)&TASK->phones[newphid]);	195	IPC_SET_ARG3(call->data, (unative_t)&TASK->phones[newphid]);
196	call->flags \|= IPC_CALL_CONN_ME_TO;	196	call->flags \|= IPC_CALL_CONN_ME_TO;
197	call->private = newphid;	197	call->private = newphid;
198	break;	198	break;
199	case IPC_M_AS_AREA_SEND:	199	case IPC_M_AS_AREA_SEND:
200	size = as_get_size(IPC_GET_ARG1(call->data));	200	size = as_get_size(IPC_GET_ARG1(call->data));
201	if (!size) {	201	if (!size) {
202	return EPERM;	202	return EPERM;
203	}	203	}
204	IPC_SET_ARG2(call->data, size);	204	IPC_SET_ARG2(call->data, size);
205	break;	205	break;
206	default:	206	default:
207	break;	207	break;
208	}	208	}
209	return 0;	209	return 0;
210	}	210	}
211		211
212	/****************************************************/	212	/****************************************************/
213	/* Functions called to process received call/answer	213	/* Functions called to process received call/answer
214	* before passing to uspace	214	* before passing to uspace
215	*/	215	*/
216		216
217	/** Do basic kernel processing of received call answer */	217	/** Do basic kernel processing of received call answer */
218	static void process_answer(call_t *call)	218	static void process_answer(call_t *call)
219	{	219	{
220	if (IPC_GET_RETVAL(call->data) == EHANGUP && \	220	if (IPC_GET_RETVAL(call->data) == EHANGUP && \
221	call->flags & IPC_CALL_FORWARDED)	221	call->flags & IPC_CALL_FORWARDED)
222	IPC_SET_RETVAL(call->data, EFORWARD);	222	IPC_SET_RETVAL(call->data, EFORWARD);
223		223
224	if (call->flags & IPC_CALL_CONN_ME_TO) {	224	if (call->flags & IPC_CALL_CONN_ME_TO) {
225	if (IPC_GET_RETVAL(call->data))	225	if (IPC_GET_RETVAL(call->data))
226	phone_dealloc(call->private);	226	phone_dealloc(call->private);
227	else	227	else
228	IPC_SET_ARG3(call->data, call->private);	228	IPC_SET_ARG3(call->data, call->private);
229	}	229	}
230	}	230	}
231		231
232	/** Do basic kernel processing of received call request	232	/** Do basic kernel processing of received call request
233	*	233	*
234	* @return 0 - the call should be passed to userspace, 1 - ignore call	234	* @return 0 - the call should be passed to userspace, 1 - ignore call
235	*/	235	*/
236	static int process_request(answerbox_t box,call_t call)	236	static int process_request(answerbox_t box,call_t call)
237	{	237	{
238	int phoneid;	238	int phoneid;
239		239
240	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) {	240	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME) {
241	phoneid = phone_alloc();	241	phoneid = phone_alloc();
242	if (phoneid < 0) { /* Failed to allocate phone */	242	if (phoneid < 0) { /* Failed to allocate phone */
243	IPC_SET_RETVAL(call->data, ELIMIT);	243	IPC_SET_RETVAL(call->data, ELIMIT);
244	ipc_answer(box,call);	244	ipc_answer(box,call);
245	return -1;	245	return -1;
246	}	246	}
247	IPC_SET_ARG3(call->data, phoneid);	247	IPC_SET_ARG3(call->data, phoneid);
248	}	248	}
249	return 0;	249	return 0;
250	}	250	}
251		251
252	/** Send a call over IPC, wait for reply, return to user	252	/** Send a call over IPC, wait for reply, return to user
253	*	253	*
254	* @return Call identification, returns -1 on fatal error,	254	* @return Call identification, returns -1 on fatal error,
255	-2 on 'Too many async request, handle answers first	255	-2 on 'Too many async request, handle answers first
256	*/	256	*/
257	unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method,	257	unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method,
258	unative_t arg1, ipc_data_t *data)	258	unative_t arg1, ipc_data_t *data)
259	{	259	{
260	call_t call;	260	call_t call;
261	phone_t *phone;	261	phone_t *phone;
262	int res;	262	int res;
263		263
264	GET_CHECK_PHONE(phone, phoneid, return ENOENT);	264	GET_CHECK_PHONE(phone, phoneid, return ENOENT);
265		265
266	ipc_call_static_init(&call);	266	ipc_call_static_init(&call);
267	IPC_SET_METHOD(call.data, method);	267	IPC_SET_METHOD(call.data, method);
268	IPC_SET_ARG1(call.data, arg1);	268	IPC_SET_ARG1(call.data, arg1);
269		269
270	if (!(res=request_preprocess(&call))) {	270	if (!(res=request_preprocess(&call))) {
271	ipc_call_sync(phone, &call);	271	ipc_call_sync(phone, &call);
272	process_answer(&call);	272	process_answer(&call);
273	} else	273	} else
274	IPC_SET_RETVAL(call.data, res);	274	IPC_SET_RETVAL(call.data, res);
275	STRUCT_TO_USPACE(&data->args, &call.data.args);	275	STRUCT_TO_USPACE(&data->args, &call.data.args);
276		276
277	return 0;	277	return 0;
278	}	278	}
279		279
280	/** Synchronous IPC call allowing to send whole message */	280	/** Synchronous IPC call allowing to send whole message */
281	unative_t sys_ipc_call_sync(unative_t phoneid, ipc_data_t *question,	281	unative_t sys_ipc_call_sync(unative_t phoneid, ipc_data_t *question,
282	ipc_data_t *reply)	282	ipc_data_t *reply)
283	{	283	{
284	call_t call;	284	call_t call;
285	phone_t *phone;	285	phone_t *phone;
286	int res;	286	int res;
287	int rc;	287	int rc;
288		288
289	ipc_call_static_init(&call);	289	ipc_call_static_init(&call);
290	rc = copy_from_uspace(&call.data.args, &question->args, sizeof(call.data.args));	290	rc = copy_from_uspace(&call.data.args, &question->args, sizeof(call.data.args));
291	if (rc != 0)	291	if (rc != 0)
292	return (unative_t) rc;	292	return (unative_t) rc;
293		293
294	GET_CHECK_PHONE(phone, phoneid, return ENOENT);	294	GET_CHECK_PHONE(phone, phoneid, return ENOENT);
295		295
296	if (!(res=request_preprocess(&call))) {	296	if (!(res=request_preprocess(&call))) {
297	ipc_call_sync(phone, &call);	297	ipc_call_sync(phone, &call);
298	process_answer(&call);	298	process_answer(&call);
299	} else	299	} else
300	IPC_SET_RETVAL(call.data, res);	300	IPC_SET_RETVAL(call.data, res);
301		301
302	rc = STRUCT_TO_USPACE(&reply->args, &call.data.args);	302	rc = STRUCT_TO_USPACE(&reply->args, &call.data.args);
303	if (rc != 0)	303	if (rc != 0)
304	return rc;	304	return rc;
305		305
306	return 0;	306	return 0;
307	}	307	}
308		308
309	/** Check that the task did not exceed allowed limit	309	/** Check that the task did not exceed allowed limit
310	*	310	*
311	* @return 0 - Limit OK, -1 - limit exceeded	311	* @return 0 - Limit OK, -1 - limit exceeded
312	*/	312	*/
313	static int check_call_limit(void)	313	static int check_call_limit(void)
314	{	314	{
315	if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) {	315	if (atomic_preinc(&TASK->active_calls) > IPC_MAX_ASYNC_CALLS) {
316	atomic_dec(&TASK->active_calls);	316	atomic_dec(&TASK->active_calls);
317	return -1;	317	return -1;
318	}	318	}
319	return 0;	319	return 0;
320	}	320	}
321		321
322	/** Send an asynchronous call over ipc	322	/** Send an asynchronous call over ipc
323	*	323	*
324	* @return Call identification, returns -1 on fatal error,	324	* @return Call identification, returns -1 on fatal error,
325	-2 on 'Too many async request, handle answers first	325	-2 on 'Too many async request, handle answers first
326	*/	326	*/
327	unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method,	327	unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method,
328	unative_t arg1, unative_t arg2)	328	unative_t arg1, unative_t arg2)
329	{	329	{
330	call_t *call;	330	call_t *call;
331	phone_t *phone;	331	phone_t *phone;
332	int res;	332	int res;
333		333
334	if (check_call_limit())	334	if (check_call_limit())
335	return IPC_CALLRET_TEMPORARY;	335	return IPC_CALLRET_TEMPORARY;
336		336
337	GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);	337	GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);
338		338
339	call = ipc_call_alloc(0);	339	call = ipc_call_alloc(0);
340	IPC_SET_METHOD(call->data, method);	340	IPC_SET_METHOD(call->data, method);
341	IPC_SET_ARG1(call->data, arg1);	341	IPC_SET_ARG1(call->data, arg1);
342	IPC_SET_ARG2(call->data, arg2);	342	IPC_SET_ARG2(call->data, arg2);
343	IPC_SET_ARG3(call->data, 0);	343	IPC_SET_ARG3(call->data, 0);
344		344
345	if (!(res=request_preprocess(call)))	345	if (!(res=request_preprocess(call)))
346	ipc_call(phone, call);	346	ipc_call(phone, call);
347	else	347	else
348	ipc_backsend_err(phone, call, res);	348	ipc_backsend_err(phone, call, res);
349		349
350	return (unative_t) call;	350	return (unative_t) call;
351	}	351	}
352		352
353	/** Synchronous IPC call allowing to send whole message	353	/** Synchronous IPC call allowing to send whole message
354	*	354	*
355	* @return The same as sys_ipc_call_async	355	* @return The same as sys_ipc_call_async
356	*/	356	*/
357	unative_t sys_ipc_call_async(unative_t phoneid, ipc_data_t *data)	357	unative_t sys_ipc_call_async(unative_t phoneid, ipc_data_t *data)
358	{	358	{
359	call_t *call;	359	call_t *call;
360	phone_t *phone;	360	phone_t *phone;
361	int res;	361	int res;
362	int rc;	362	int rc;
363		363
364	if (check_call_limit())	364	if (check_call_limit())
365	return IPC_CALLRET_TEMPORARY;	365	return IPC_CALLRET_TEMPORARY;
366		366
367	GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);	367	GET_CHECK_PHONE(phone, phoneid, return IPC_CALLRET_FATAL);
368		368
369	call = ipc_call_alloc(0);	369	call = ipc_call_alloc(0);
370	rc = copy_from_uspace(&call->data.args, &data->args, sizeof(call->data.args));	370	rc = copy_from_uspace(&call->data.args, &data->args, sizeof(call->data.args));
371	if (rc != 0) {	371	if (rc != 0) {
372	ipc_call_free(call);	372	ipc_call_free(call);
373	return (unative_t) rc;	373	return (unative_t) rc;
374	}	374	}
375	if (!(res=request_preprocess(call)))	375	if (!(res=request_preprocess(call)))
376	ipc_call(phone, call);	376	ipc_call(phone, call);
377	else	377	else
378	ipc_backsend_err(phone, call, res);	378	ipc_backsend_err(phone, call, res);
379		379
380	return (unative_t) call;	380	return (unative_t) call;
381	}	381	}
382		382
383	/** Forward received call to another destination	383	/** Forward received call to another destination
384	*	384	*
385	* The arg1 and arg2 are changed in the forwarded message	385	* The arg1 and arg2 are changed in the forwarded message
386	*	386	*
387	* Warning: If implementing non-fast version, make sure that	387	* Warning: If implementing non-fast version, make sure that
388	* arg3 is not rewritten for certain system IPC	388	* arg3 is not rewritten for certain system IPC
389	*/	389	*/
390	unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid,	390	unative_t sys_ipc_forward_fast(unative_t callid, unative_t phoneid,
391	unative_t method, unative_t arg1)	391	unative_t method, unative_t arg1)
392	{	392	{
393	call_t *call;	393	call_t *call;
394	phone_t *phone;	394	phone_t *phone;
395		395
396	call = get_call(callid);	396	call = get_call(callid);
397	if (!call)	397	if (!call)
398	return ENOENT;	398	return ENOENT;
399		399
400	call->flags \|= IPC_CALL_FORWARDED;	400	call->flags \|= IPC_CALL_FORWARDED;
401		401
402	GET_CHECK_PHONE(phone, phoneid, {	402	GET_CHECK_PHONE(phone, phoneid, {
403	IPC_SET_RETVAL(call->data, EFORWARD);	403	IPC_SET_RETVAL(call->data, EFORWARD);
404	ipc_answer(&TASK->answerbox, call);	404	ipc_answer(&TASK->answerbox, call);
405	return ENOENT;	405	return ENOENT;
406	});	406	});
407		407
408	if (!is_forwardable(IPC_GET_METHOD(call->data))) {	408	if (!is_forwardable(IPC_GET_METHOD(call->data))) {
409	IPC_SET_RETVAL(call->data, EFORWARD);	409	IPC_SET_RETVAL(call->data, EFORWARD);
410	ipc_answer(&TASK->answerbox, call);	410	ipc_answer(&TASK->answerbox, call);
411	return EPERM;	411	return EPERM;
412	}	412	}
413		413
414	/* Userspace is not allowed to change method of system methods	414	/* Userspace is not allowed to change method of system methods
415	* on forward, allow changing ARG1 and ARG2 by means of method and arg1	415	* on forward, allow changing ARG1 and ARG2 by means of method and arg1
416	*/	416	*/
417	if (is_system_method(IPC_GET_METHOD(call->data))) {	417	if (is_system_method(IPC_GET_METHOD(call->data))) {
418	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)	418	if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)
419	phone_dealloc(IPC_GET_ARG3(call->data));	419	phone_dealloc(IPC_GET_ARG3(call->data));
420		420
421	IPC_SET_ARG1(call->data, method);	421	IPC_SET_ARG1(call->data, method);
422	IPC_SET_ARG2(call->data, arg1);	422	IPC_SET_ARG2(call->data, arg1);
423	} else {	423	} else {
424	IPC_SET_METHOD(call->data, method);	424	IPC_SET_METHOD(call->data, method);
425	IPC_SET_ARG1(call->data, arg1);	425	IPC_SET_ARG1(call->data, arg1);
426	}	426	}
427		427
428	return ipc_forward(call, phone, &TASK->answerbox);	428	return ipc_forward(call, phone, &TASK->answerbox);
429	}	429	}
430		430
431	/** Send IPC answer */	431	/** Send IPC answer */
432	unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval,	432	unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval,
433	unative_t arg1, unative_t arg2)	433	unative_t arg1, unative_t arg2)
434	{	434	{
435	call_t *call;	435	call_t *call;
436	ipc_data_t saved_data;	436	ipc_data_t saved_data;
437	int saveddata = 0;	437	int saveddata = 0;
438	int rc;	438	int rc;
439		439
440	/* Do not answer notification callids */	440	/* Do not answer notification callids */
441	if (callid & IPC_CALLID_NOTIFICATION)	441	if (callid & IPC_CALLID_NOTIFICATION)
442	return 0;	442	return 0;
443		443
444	call = get_call(callid);	444	call = get_call(callid);
445	if (!call)	445	if (!call)
446	return ENOENT;	446	return ENOENT;
447		447
448	if (answer_need_old(call)) {	448	if (answer_need_old(call)) {
449	memcpy(&saved_data, &call->data, sizeof(call->data));	449	memcpy(&saved_data, &call->data, sizeof(call->data));
450	saveddata = 1;	450	saveddata = 1;
451	}	451	}
452		452
453	IPC_SET_RETVAL(call->data, retval);	453	IPC_SET_RETVAL(call->data, retval);
454	IPC_SET_ARG1(call->data, arg1);	454	IPC_SET_ARG1(call->data, arg1);
455	IPC_SET_ARG2(call->data, arg2);	455	IPC_SET_ARG2(call->data, arg2);
456	rc = answer_preprocess(call, saveddata ? &saved_data : NULL);	456	rc = answer_preprocess(call, saveddata ? &saved_data : NULL);
457		457
458	ipc_answer(&TASK->answerbox, call);	458	ipc_answer(&TASK->answerbox, call);
459	return rc;	459	return rc;
460	}	460	}
461		461
462	/** Send IPC answer */	462	/** Send IPC answer */
463	unative_t sys_ipc_answer(unative_t callid, ipc_data_t *data)	463	unative_t sys_ipc_answer(unative_t callid, ipc_data_t *data)
464	{	464	{
465	call_t *call;	465	call_t *call;
466	ipc_data_t saved_data;	466	ipc_data_t saved_data;
467	int saveddata = 0;	467	int saveddata = 0;
468	int rc;	468	int rc;
469		469
470	/* Do not answer notification callids */	470	/* Do not answer notification callids */
471	if (callid & IPC_CALLID_NOTIFICATION)	471	if (callid & IPC_CALLID_NOTIFICATION)
472	return 0;	472	return 0;
473		473
474	call = get_call(callid);	474	call = get_call(callid);
475	if (!call)	475	if (!call)
476	return ENOENT;	476	return ENOENT;
477		477
478	if (answer_need_old(call)) {	478	if (answer_need_old(call)) {
479	memcpy(&saved_data, &call->data, sizeof(call->data));	479	memcpy(&saved_data, &call->data, sizeof(call->data));
480	saveddata = 1;	480	saveddata = 1;
481	}	481	}
482	rc = copy_from_uspace(&call->data.args, &data->args,	482	rc = copy_from_uspace(&call->data.args, &data->args,
483	sizeof(call->data.args));	483	sizeof(call->data.args));
484	if (rc != 0)	484	if (rc != 0)
485	return rc;	485	return rc;
486		486
487	rc = answer_preprocess(call, saveddata ? &saved_data : NULL);	487	rc = answer_preprocess(call, saveddata ? &saved_data : NULL);
488		488
489	ipc_answer(&TASK->answerbox, call);	489	ipc_answer(&TASK->answerbox, call);
490		490
491	return rc;	491	return rc;
492	}	492	}
493		493
494	/** Hang up the phone	494	/** Hang up the phone
495	*	495	*
496	*/	496	*/
497	unative_t sys_ipc_hangup(int phoneid)	497	unative_t sys_ipc_hangup(int phoneid)
498	{	498	{
499	phone_t *phone;	499	phone_t *phone;
500		500

Subversion Repositories HelenOS

(root)/trunk/kernel/generic/src/ipc/sysipc.c – Rev 1923 → 2071