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.
 */
 
#include <arch.h>
#include <proc/task.h>
 
#include <errno.h>
#include <mm/page.h>
#include <memstr.h>
#include <debug.h>
#include <ipc/ipc.h>
#include <ipc/sysipc.h>
#include <ipc/ipcrsc.h>
 
 
#include <print.h>
#include <arch.h>
#include <proc/thread.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(__native 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(__native method)
{
    if (method == IPC_M_PHONE_HUNGUP)
        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;
    return 0;
}
 
/** Interpret process answer as control information */
static inline void 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->callee) {
            list_remove(&answer->data.phone->list);
            answer->data.phone->callee = 0;
        }
        spinlock_unlock(&TASK->answerbox.lock);
        spinlock_unlock(&answer->data.phone->lock);
    }
 
    if (!olddata)
        return;
 
    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, (__native)&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);
        }
    }
}
 
/** Called before the request is sent
 *
 * @return 0 - no error, -1 - report error to user
 */
static int request_preprocess(call_t *call)
{
    int newphid;
 
    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, (__native)&TASK->phones[newphid]);
        call->flags |= IPC_CALL_CONN_ME_TO;
        call->private = newphid;
        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
 */
__native sys_ipc_call_sync_fast(__native phoneid, __native method,
                __native 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 */
__native sys_ipc_call_sync(__native phoneid, ipc_data_t *question,
               ipc_data_t *reply)
{
    call_t call;
    phone_t *phone;
    int res;
 
    ipc_call_static_init(&call);
    copy_from_uspace(&call.data.args, &question->args, sizeof(call.data.args));
 
    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);
 
    STRUCT_TO_USPACE(&reply->args, &call.data.args);
 
    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
 */
__native sys_ipc_call_async_fast(__native phoneid, __native method,
                 __native arg1, __native 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();
    IPC_SET_METHOD(call->data, method);
    IPC_SET_ARG1(call->data, arg1);
    IPC_SET_ARG2(call->data, arg2);
 
    if (!(res=request_preprocess(call)))
        ipc_call(phone, call);
    else
        ipc_backsend_err(phone, call, res);
 
    return (__native) call;
}
 
/** Synchronous IPC call allowing to send whole message
 *
 * @return The same as sys_ipc_call_async
 */
__native sys_ipc_call_async(__native phoneid, ipc_data_t *data)
{
    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();
    copy_from_uspace(&call->data.args, &data->args, sizeof(call->data.args));
    if (!(res=request_preprocess(call)))
        ipc_call(phone, call);
    else
        ipc_backsend_err(phone, call, res);
 
    return (__native) 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
 */
__native sys_ipc_forward_fast(__native callid, __native phoneid,
                  __native method, __native 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 */
__native sys_ipc_answer_fast(__native callid, __native retval,
                 __native arg1, __native arg2)
{
    call_t *call;
    ipc_data_t saved_data;
    int saveddata = 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);
    answer_preprocess(call, saveddata ? &saved_data : NULL);
 
    ipc_answer(&TASK->answerbox, call);
    return 0;
}
 
/** Send IPC answer */
__native sys_ipc_answer(__native callid, ipc_data_t *data)
{
    call_t *call;
    ipc_data_t saved_data;
    int saveddata = 0;
 
    call = get_call(callid);
    if (!call)
        return ENOENT;
 
    if (answer_need_old(call)) {
        memcpy(&saved_data, &call->data, sizeof(call->data));
        saveddata = 1;
    }
    copy_from_uspace(&call->data.args, &data->args,
             sizeof(call->data.args));
 
    answer_preprocess(call, saveddata ? &saved_data : NULL);
   
    ipc_answer(&TASK->answerbox, call);
 
    return 0;
}
 
/** Hang up the phone
 *
 */
__native 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 flags
 * @return Callid, if callid & 1, then the call is answer
 */
__native sys_ipc_wait_for_call(ipc_data_t *calldata, __native flags)
{
    call_t *call;
 
restart:   
    call = ipc_wait_for_call(&TASK->answerbox, flags);
    if (!call)
        return 0;
 
    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 ((__native)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 */
    STRUCT_TO_USPACE(calldata, &call->data);
    return (__native)call;
}
 

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

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/generic/src/ipc/sysipc.c @ 1141 – Rev 1141 → 1248