WebSVN – HelenOS – Diff – /branches/tracing/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>
 
/**
 * Maximum buffer size allowed for IPC_M_DATA_WRITE and IPC_M_DATA_READ
 * requests.
 */
#define DATA_XFER_LIMIT     (64 * 1024)
 
#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)))
 
/** Decide if the method is a system method.
 *
 * @param method    Method to be decided.
 *
 * @return      Return 1 if the method is a system method.
 *          Otherwise return 0.
 */
static inline int method_is_system(unative_t method)
{
    if (method <= IPC_M_LAST_SYSTEM)
        return 1;
    return 0;
}
 
/** Decide if the message with this method is forwardable.
 *
 * - some system messages may be forwarded, for some of them
 *   it is useless
 *
 * @param method    Method to be decided.
 *
 * @return      Return 1 if the method is forwardable.
 *          Otherwise return 0.
 */
static inline int method_is_forwardable(unative_t method)
{
    switch (method) {
    case IPC_M_PHONE_HUNGUP:
        /* This message is meant only for the original recipient. */
        return 0;
    default:
        return 1;
    }
}
 
/** Decide if the message with this method is immutable on forward.
 *
 * - some system messages may be forwarded but their content cannot be altered
 *
 * @param method    Method to be decided.
 *
 * @return      Return 1 if the method is immutable on forward.
 *          Otherwise return 0.
 */
static inline int method_is_immutable(unative_t method)
{
    switch (method) {
    case IPC_M_SHARE_OUT:
    case IPC_M_SHARE_IN:
    case IPC_M_DATA_WRITE:
    case IPC_M_DATA_READ:
        return 1;
        break;
    default:
        return 0;
    }
}
 
 
/***********************************************************************
 * Functions that preprocess answer before sending it to the recepient.
 ***********************************************************************/
 
/** Decide if the caller (e.g. ipc_answer()) should save the old call contents
 * for answer_preprocess().
 *
 * @param call      Call structure to be decided.
 *
 * @return      Return 1 if the old call contents should be saved.
 *          Return 0 otherwise.
 */
static inline int answer_need_old(call_t *call)
{
    switch (IPC_GET_METHOD(call->data)) {
    case IPC_M_CONNECT_TO_ME:
    case IPC_M_CONNECT_ME_TO:
    case IPC_M_SHARE_OUT:
    case IPC_M_SHARE_IN:
    case IPC_M_DATA_WRITE:
    case IPC_M_DATA_READ:
        return 1;
    default:
        return 0;
    }
}
 
/** Interpret process answer as control information.
 *
 * This function is called directly after sys_ipc_answer().
 *
 * @param answer    Call structure with the answer.
 * @param olddata   Saved data of the request.
 *
 * @return      Return 0 on success or an error code.
 */
static inline int answer_preprocess(call_t *answer, ipc_data_t *olddata)
{
    int phoneid;
 
    if ((native_t) 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_ARG5(*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 hash' as arg5 of response */
            IPC_SET_ARG5(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_ARG5(*olddata),
                &TASK->answerbox);
        }
    } else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_OUT) {
        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_SHARE_IN) {
        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);
        }
    } else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_READ) {
        ASSERT(!answer->buffer);
        if (!IPC_GET_RETVAL(answer->data)) {
            /* The recipient agreed to send data. */
            uintptr_t src = IPC_GET_ARG1(answer->data);
            uintptr_t dst = IPC_GET_ARG1(*olddata);
            size_t max_size = IPC_GET_ARG2(*olddata);
            size_t size = IPC_GET_ARG2(answer->data);
            if (size <= max_size) {
                /*
                 * Copy the destination VA so that this piece of
                 * information is not lost.
                 */
                IPC_SET_ARG1(answer->data, dst);
 
                answer->buffer = malloc(size, 0);
                int rc = copy_from_uspace(answer->buffer,
                    (void *) src, size);
                if (rc) {
                    IPC_SET_RETVAL(answer->data, rc);
                    free(answer->buffer);
                    answer->buffer = NULL;
                }
            } else {
                IPC_SET_RETVAL(answer->data, ELIMIT);
            }
        }
    } else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_WRITE) {
        ASSERT(answer->buffer);
        if (!IPC_GET_RETVAL(answer->data)) {
            /* The recipient agreed to receive data. */
            int rc;
            uintptr_t dst;
            uintptr_t size;
            uintptr_t max_size;
 
            dst = IPC_GET_ARG1(answer->data);
            size = IPC_GET_ARG2(answer->data);
            max_size = IPC_GET_ARG2(*olddata);
 
            if (size <= max_size) {
                rc = copy_to_uspace((void *) dst,
                    answer->buffer, size);
                if (rc)
                    IPC_SET_RETVAL(answer->data, rc);
            } else {
                IPC_SET_RETVAL(answer->data, ELIMIT);
            }
        }
        free(answer->buffer);
        answer->buffer = NULL;
    }
    return 0;
}
 
static task_t *get_lock_callee_task(phone_t *phone)
{
    answerbox_t *answerbox;
    task_t *ta;
 
    // FIXME: locking!!!
 
    answerbox = phone->callee;
    ta = answerbox->task;
 
    spinlock_lock(&ta->lock);
 
    return ta;
}
 
static thread_t *get_task_thread_by_id(task_t *ta, thread_id_t tid)
{
    thread_t *t;
    link_t *cur;
 
    for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) {
        t = list_get_instance(cur, thread_t, th_link);     
        if (tid == t->tid) return t;
    }
 
    return NULL;
}
 
#include <console/klog.h>
 
static int debug_begin(call_t *call, phone_t *phone)
{
    task_t *ta;
 
    klog_printf("debug_begin()");
 
    ta = get_lock_callee_task(phone);
    klog_printf("debugging task %llu", ta->taskid);
 
    if (ta->being_debugged != false) {
        spinlock_unlock(&ta->lock);
        klog_printf("debug_begin(): busy error");
        return EBUSY;
    }
 
    ta->being_debugged = true;
    ta->stop_request = true;
    ta->debug_begin_call = call;
 
    if (ta->not_stoppable_count == 0) {
        ta->debug_begin_call = NULL;
        ta->stop_request = false;
        spinlock_unlock(&ta->lock);
        klog_printf("debug_begin(): immediate backsend");
        return 1; /* actually we need backsend with 0 retval */
    }
 
    spinlock_unlock(&ta->lock);
 
    klog_printf("debug_begin() done (wait for stoppability)");
    return 0;
}
 
static int debug_go(call_t *call, phone_t *phone)
{
    thread_t *t;
    task_t *ta;
 
    klog_printf("debug_go()");
    ta = get_lock_callee_task(phone);
 
    ta->debug_go_call = call;
    t = get_task_thread_by_id(ta, IPC_GET_ARG1(call->data));
    if (t == NULL) {
        spinlock_unlock(&ta->lock);
        return ENOENT;
    }
 
    klog_printf("debug_go(): waitq_wakeup");
    waitq_wakeup(&t->go_wq, WAKEUP_FIRST);
 
    spinlock_unlock(&ta->lock);
 
    return 0; /* no backsend */
}
 
static int debug_args_read(call_t *call, phone_t *phone)
{
    thread_t *t;
    task_t *ta;
    void *uspace_buffer;
    unative_t to_copy;
    int rc;
 
    klog_printf("debug_args_read()");
    // FIXME: verify task/thread state
 
    ta = get_lock_callee_task(phone);
    klog_printf("task %llu", ta->taskid);
    t = get_task_thread_by_id(ta, IPC_GET_ARG1(call->data));
    if (t == NULL) {
        spinlock_unlock(&ta->lock);
        return ENOENT;
    }
 
    uspace_buffer = (void *)IPC_GET_ARG2(call->data);
    to_copy = IPC_GET_ARG3(call->data);
    if (to_copy > 6) to_copy = 6;
 
    rc = copy_to_uspace(uspace_buffer, t->syscall_args, to_copy);
    if (rc != 0) {
        spinlock_unlock(&ta->lock);
        klog_printf("debug_args_read() - copy failed");
        return rc;
    }
 
    spinlock_unlock(&ta->lock);
 
    IPC_SET_ARG1(call->data, to_copy);
 
    klog_printf("debug_args_read() done");
    return 1; /* actually need becksend with retval 0 */
}
 
static int debug_thread_read(call_t *call, phone_t *phone)
{
    thread_t *t;
    link_t *cur;
    task_t *ta;
    unative_t *uspace_buffer;
    unative_t to_copy;
    int rc;
    unsigned copied, total;
    unsigned buf_size;
    unative_t tid;
 
    klog_printf("debug_thread_read()");
    // FIXME: verify task/thread state
 
    ta = get_lock_callee_task(phone);
    klog_printf("task %llu", ta->taskid);
   
    uspace_buffer = (void *)IPC_GET_ARG1(call->data);
    buf_size = IPC_GET_ARG2(call->data);
 
    copied = total = 0;
    for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) {
        t = list_get_instance(cur, thread_t, th_link);
 
        /* Not interested in kernel threads */
        if ((t->flags & THREAD_FLAG_USPACE) == 0)
            continue;
 
        //FIXME: id cropped!!
        tid = (unative_t) t->tid;
 
        to_copy = sizeof(unative_t);
        if (copied + to_copy >= buf_size)
            to_copy = buf_size - copied;
 
        if (to_copy > 0) {
            rc = copy_to_uspace(uspace_buffer, &tid, to_copy);
            if (rc != 0) {
                spinlock_unlock(&ta->lock);
                klog_printf("debug_thread_read() - copy failed");
                return rc;
            }
        }
 
        ++uspace_buffer;
        total += sizeof(unative_t);
        copied += to_copy;
    }
 
    spinlock_unlock(&ta->lock);
 
    IPC_SET_ARG1(call->data, copied);
    IPC_SET_ARG2(call->data, total);
 
    klog_printf("debug_thread_read() done");
    return 1; /* actually need becksend with retval 0 */
}
 
 
/** Called before the request is sent.
 *
 * @param call      Call structure with the request.
 * @param phone     Phone that the call will be sent through.
 *
 * @return      Return 0 on success, ELIMIT or EPERM on error.
 */
static int request_preprocess(call_t *call, phone_t *phone)
{
    int newphid;
    size_t size;
    uintptr_t src;
    int rc;
 
    switch (IPC_GET_METHOD(call->data)) {
    case IPC_M_CONNECT_ME_TO:
        newphid = phone_alloc();
        if (newphid < 0)
            return ELIMIT;
        /* Set arg5 for server */
        IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]);
        call->flags |= IPC_CALL_CONN_ME_TO;
        call->priv = newphid;
        break;
    case IPC_M_SHARE_OUT:
        size = as_area_get_size(IPC_GET_ARG1(call->data));
        if (!size)
            return EPERM;
        IPC_SET_ARG2(call->data, size);
        break;
    case IPC_M_DATA_READ:
        size = IPC_GET_ARG2(call->data);
        if ((size <= 0 || (size > DATA_XFER_LIMIT)))
            return ELIMIT;
        break;
    case IPC_M_DATA_WRITE:
        src = IPC_GET_ARG1(call->data);
        size = IPC_GET_ARG2(call->data);
       
        if ((size <= 0) || (size > DATA_XFER_LIMIT))
            return ELIMIT;
       
        call->buffer = (uint8_t *) malloc(size, 0);
        rc = copy_from_uspace(call->buffer, (void *) src, size);
        if (rc != 0) {
            free(call->buffer);
            return rc;
        }
        break;
    case IPC_M_DEBUG_BEGIN:
        /* actually need possibility of backsend with 0 result code */
        rc = debug_begin(call, phone);
        return rc;
    case IPC_M_DEBUG_GO:
        rc = debug_go(call, phone);
        return rc;
    case IPC_M_DEBUG_ARGS_READ:
        rc = debug_args_read(call, phone);
        return rc;
    case IPC_M_DEBUG_THREAD_READ:
        rc = debug_thread_read(call, phone);
        return rc;
    default:
        break;
    }
    return 0;
}
 
/*******************************************************************************
 * Functions called to process received call/answer before passing it to uspace.
 *******************************************************************************/
 
/** Do basic kernel processing of received call answer.
 *
 * @param call      Call structure with the answer.
 */
static void process_answer(call_t *call)
{
    if (((native_t) 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->priv);
        else
            IPC_SET_ARG5(call->data, call->priv);
    }
 
    if (call->buffer) {
        /* This must be an affirmative answer to IPC_M_DATA_READ. */
        uintptr_t dst = IPC_GET_ARG1(call->data);
        size_t size = IPC_GET_ARG2(call->data);
        int rc = copy_to_uspace((void *) dst, call->buffer, size);
        if (rc)
            IPC_SET_RETVAL(call->data, rc);
        free(call->buffer);
        call->buffer = NULL;
    }
}
 
/** Do basic kernel processing of received call request.
 *
 * @param box       Destination answerbox structure.
 * @param call      Call structure with the request.
 *
 * @return      Return 0 if the call should be passed to userspace.
 *          Return -1 if the call should be ignored.
 */
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_ARG5(call->data, phoneid);
    }
    switch (IPC_GET_METHOD(call->data)) {
    case IPC_M_DEBUG_BEGIN:
    case IPC_M_DEBUG_END:
    case IPC_M_DEBUG_GO:
    case IPC_M_DEBUG_STOP:
    case IPC_M_DEBUG_GUARD:
        return -1;
    default:
        break;
    }
    return 0;
}
 
/** Make a fast call over IPC, wait for reply and return to user.
 *
 * This function can handle only three arguments of payload, but is faster than
 * the generic function (i.e. sys_ipc_call_sync_slow()).
 *
 * @param phoneid   Phone handle for the call.
 * @param method    Method of the call.
 * @param arg1      Service-defined payload argument.
 * @param arg2      Service-defined payload argument.
 * @param arg3      Service-defined payload argument.
 * @param data      Address of userspace structure where the reply call will
 *          be stored.
 *
 * @return      Returns 0 on success.
 *          Return ENOENT if there is no such phone handle.
 */
unative_t sys_ipc_call_sync_fast(unative_t phoneid, unative_t method,
    unative_t arg1, unative_t arg2, unative_t arg3, ipc_data_t *data)
{
    call_t call;
    phone_t *phone;
    int res;
    int rc;
 
    GET_CHECK_PHONE(phone, phoneid, return ENOENT);
 
    ipc_call_static_init(&call);
    IPC_SET_METHOD(call.data, method);
    IPC_SET_ARG1(call.data, arg1);
    IPC_SET_ARG2(call.data, arg2);
    IPC_SET_ARG3(call.data, arg3);
    /*
     * To achieve deterministic behavior, zero out arguments that are beyond
     * the limits of the fast version.
     */
    IPC_SET_ARG4(call.data, 0);
    IPC_SET_ARG5(call.data, 0);
 
    if (!(res = request_preprocess(&call, phone))) {
        ipc_call_sync(phone, &call);
        process_answer(&call);
    } else {
        IPC_SET_RETVAL(call.data, res);
    }
    rc = STRUCT_TO_USPACE(&data->args, &call.data.args);
    if (rc != 0)
        return rc;
 
    return 0;
}
 
/** Make a synchronous IPC call allowing to transmit the entire payload.
 *
 * @param phoneid   Phone handle for the call.
 * @param question  Userspace address of call data with the request.
 * @param reply     Userspace address of call data where to store the
 *          answer.
 *
 * @return      Zero on success or an error code.
 */
unative_t sys_ipc_call_sync_slow(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, phone))) {
        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 the allowed limit of asynchronous calls.
 *
 * @return      Return 0 if limit not reached or -1 if 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;
}
 
/** Make a fast asynchronous call over IPC.
 *
 * This function can only handle four arguments of payload, but is faster than
 * the generic function sys_ipc_call_async_slow().
 *
 * @param phoneid   Phone handle for the call.
 * @param method    Method of the call.
 * @param arg1      Service-defined payload argument.
 * @param arg2      Service-defined payload argument.
 * @param arg3      Service-defined payload argument.
 * @param arg4      Service-defined payload argument.
 *
 * @return      Return call hash on success.
 *          Return IPC_CALLRET_FATAL in case of a fatal error and
 *          IPC_CALLRET_TEMPORARY if there are too many pending
 *          asynchronous requests; answers should be handled first.
 */
unative_t sys_ipc_call_async_fast(unative_t phoneid, unative_t method,
    unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4)
{
    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, arg3);
    IPC_SET_ARG4(call->data, arg4);
    /*
     * To achieve deterministic behavior, zero out arguments that are beyond
     * the limits of the fast version.
     */
    IPC_SET_ARG5(call->data, 0);
 
    if (!(res = request_preprocess(call, phone)))
        ipc_call(phone, call);
    else
        ipc_backsend_err(phone, call, res);
 
    return (unative_t) call;
}
 
/** Make an asynchronous IPC call allowing to transmit the entire payload.
 *
 * @param phoneid   Phone handle for the call.
 * @param data      Userspace address of call data with the request.
 *
 * @return      See sys_ipc_call_async_fast().
 */
unative_t sys_ipc_call_async_slow(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, phone)))
        ipc_call(phone, call);
    else
        ipc_backsend_err(phone, call, res);
 
    return (unative_t) call;
}
 
/** Forward a received call to another destination.
 *
 * @param callid    Hash of the call to forward.
 * @param phoneid   Phone handle to use for forwarding.
 * @param method    New method to use for the forwarded call.
 * @param arg1      New value of the first argument for the forwarded call.
 * @param arg2      New value of the second argument for the forwarded call.
 * @param mode      Flags that specify mode of the forward operation.
 *
 * @return      Return 0 on succes, otherwise return an error code.
 *
 * In case the original method is a system method, ARG1, ARG2 and ARG3 are
 * overwritten in the forwarded message with the new method and the new arg1 and
 * arg2, respectively. Otherwise the METHOD, ARG1 and ARG2 are rewritten with
 * the new method, arg1 and arg2, respectively. Also note there is a set of
 * immutable methods, for which the new method and argument is not set and
 * these values are ignored.
 *
 * Warning: When implementing support for changing additional payload
 *      arguments, make sure that ARG5 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, unative_t arg2, int mode)
{
    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 (!method_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, ARG2 and ARG3 by means of method,
     * arg1 and arg2.
     * If the method is immutable, don't change anything.
     */
    if (!method_is_immutable(IPC_GET_METHOD(call->data))) {
        if (method_is_system(IPC_GET_METHOD(call->data))) {
            if (IPC_GET_METHOD(call->data) == IPC_M_CONNECT_TO_ME)
                phone_dealloc(IPC_GET_ARG5(call->data));
 
            IPC_SET_ARG1(call->data, method);
            IPC_SET_ARG2(call->data, arg1);
            IPC_SET_ARG3(call->data, arg2);
        } else {
            IPC_SET_METHOD(call->data, method);
            IPC_SET_ARG1(call->data, arg1);
            IPC_SET_ARG2(call->data, arg2);
        }
    }
 
    return ipc_forward(call, phone, &TASK->answerbox, mode);
}
 
/** Answer an IPC call - fast version.
 *
 * This function can handle only two return arguments of payload, but is faster
 * than the generic sys_ipc_answer().
 *
 * @param callid    Hash of the call to be answered.
 * @param retval    Return value of the answer.
 * @param arg1      Service-defined return value.
 * @param arg2      Service-defined return value.
 * @param arg3      Service-defined return value.
 * @param arg4      Service-defined return value.
 *
 * @return      Return 0 on success, otherwise return an error code.   
 */
unative_t sys_ipc_answer_fast(unative_t callid, unative_t retval,
    unative_t arg1, unative_t arg2, unative_t arg3, unative_t arg4)
{
    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);
    IPC_SET_ARG3(call->data, arg3);
    IPC_SET_ARG4(call->data, arg4);
    /*
     * To achieve deterministic behavior, zero out arguments that are beyond
     * the limits of the fast version.
     */
    IPC_SET_ARG5(call->data, 0);
    rc = answer_preprocess(call, saveddata ? &saved_data : NULL);
 
    ipc_answer(&TASK->answerbox, call);
    return rc;
}
 
/** Answer an IPC call.
 *
 * @param callid    Hash of the call to be answered.
 * @param data      Userspace address of call data with the answer.
 *
 * @return      Return 0 on success, otherwise return an error code.
 */
unative_t sys_ipc_answer_slow(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 a phone.
 *
 * @param       Phone handle of the phone to be hung up.
 *
 * @return      Return 0 on success or an error code.
 */
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 an incoming IPC call or an 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      Hash of the call.
 *          If IPC_CALLID_NOTIFICATION bit is set in the hash, the
 *          call is a notification. IPC_CALLID_ANSWERED denotes an
 *          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->priv;
       
        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 an IRQ handler to a 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 an IRQ handler from a task.
 *
 * @param inr       IRQ number.
 * @param devno     Device number.
 *
 * @return      Zero on success or EPERM on error..
 */
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;
}
 
#include <console/klog.h>
 
/**
 * Syscall connect to a task by id.
 *
 * @return      Phone id on success, or negative error code.
 */
unative_t sys_ipc_connect_kbox(sysarg64_t *uspace_taskid_arg)
{
    sysarg64_t taskid_arg;
    int rc;
   
    rc = copy_from_uspace(&taskid_arg, uspace_taskid_arg, sizeof(sysarg64_t));
    if (rc != 0)
        return (unative_t) rc;
 
    klog_printf("sys_ipc_connect_kbox(%lld, %d)", taskid_arg.value);
 
    return ipc_connect_kbox(taskid_arg.value);
}
 
/** @}
 */
 

Rev 2807	Rev 2808
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	/**	52	/**
53	* Maximum buffer size allowed for IPC_M_DATA_WRITE and IPC_M_DATA_READ	53	* Maximum buffer size allowed for IPC_M_DATA_WRITE and IPC_M_DATA_READ
54	* requests.	54	* requests.
55	*/	55	*/
56	#define DATA_XFER_LIMIT (64 * 1024)	56	#define DATA_XFER_LIMIT (64 * 1024)
57		57
58	#define GET_CHECK_PHONE(phone, phoneid, err) \	58	#define GET_CHECK_PHONE(phone, phoneid, err) \
59	{ \	59	{ \
60	if (phoneid > IPC_MAX_PHONES) { \	60	if (phoneid > IPC_MAX_PHONES) { \
61	err; \	61	err; \
62	} \	62	} \
63	phone = &TASK->phones[phoneid]; \	63	phone = &TASK->phones[phoneid]; \
64	}	64	}
65		65
66	#define STRUCT_TO_USPACE(dst, src) copy_to_uspace(dst, src, sizeof(*(src)))	66	#define STRUCT_TO_USPACE(dst, src) copy_to_uspace(dst, src, sizeof(*(src)))
67		67
68	/** Decide if the method is a system method.	68	/** Decide if the method is a system method.
69	*	69	*
70	* @param method Method to be decided.	70	* @param method Method to be decided.
71	*	71	*
72	* @return Return 1 if the method is a system method.	72	* @return Return 1 if the method is a system method.
73	* Otherwise return 0.	73	* Otherwise return 0.
74	*/	74	*/
75	static inline int method_is_system(unative_t method)	75	static inline int method_is_system(unative_t method)
76	{	76	{
77	if (method <= IPC_M_LAST_SYSTEM)	77	if (method <= IPC_M_LAST_SYSTEM)
78	return 1;	78	return 1;
79	return 0;	79	return 0;
80	}	80	}
81		81
82	/** Decide if the message with this method is forwardable.	82	/** Decide if the message with this method is forwardable.
83	*	83	*
84	* - some system messages may be forwarded, for some of them	84	* - some system messages may be forwarded, for some of them
85	* it is useless	85	* it is useless
86	*	86	*
87	* @param method Method to be decided.	87	* @param method Method to be decided.
88	*	88	*
89	* @return Return 1 if the method is forwardable.	89	* @return Return 1 if the method is forwardable.
90	* Otherwise return 0.	90	* Otherwise return 0.
91	*/	91	*/
92	static inline int method_is_forwardable(unative_t method)	92	static inline int method_is_forwardable(unative_t method)
93	{	93	{
94	switch (method) {	94	switch (method) {
95	case IPC_M_PHONE_HUNGUP:	95	case IPC_M_PHONE_HUNGUP:
96	/* This message is meant only for the original recipient. */	96	/* This message is meant only for the original recipient. */
97	return 0;	97	return 0;
98	default:	98	default:
99	return 1;	99	return 1;
100	}	100	}
101	}	101	}
102		102
103	/** Decide if the message with this method is immutable on forward.	103	/** Decide if the message with this method is immutable on forward.
104	*	104	*
105	* - some system messages may be forwarded but their content cannot be altered	105	* - some system messages may be forwarded but their content cannot be altered
106	*	106	*
107	* @param method Method to be decided.	107	* @param method Method to be decided.
108	*	108	*
109	* @return Return 1 if the method is immutable on forward.	109	* @return Return 1 if the method is immutable on forward.
110	* Otherwise return 0.	110	* Otherwise return 0.
111	*/	111	*/
112	static inline int method_is_immutable(unative_t method)	112	static inline int method_is_immutable(unative_t method)
113	{	113	{
114	switch (method) {	114	switch (method) {
115	case IPC_M_SHARE_OUT:	115	case IPC_M_SHARE_OUT:
116	case IPC_M_SHARE_IN:	116	case IPC_M_SHARE_IN:
117	case IPC_M_DATA_WRITE:	117	case IPC_M_DATA_WRITE:
118	case IPC_M_DATA_READ:	118	case IPC_M_DATA_READ:
119	return 1;	119	return 1;
120	break;	120	break;
121	default:	121	default:
122	return 0;	122	return 0;
123	}	123	}
124	}	124	}
125		125
126		126
127	/***********************************************************************	127	/***********************************************************************
128	* Functions that preprocess answer before sending it to the recepient.	128	* Functions that preprocess answer before sending it to the recepient.
129	***********************************************************************/	129	***********************************************************************/
130		130
131	/** Decide if the caller (e.g. ipc_answer()) should save the old call contents	131	/** Decide if the caller (e.g. ipc_answer()) should save the old call contents
132	* for answer_preprocess().	132	* for answer_preprocess().
133	*	133	*
134	* @param call Call structure to be decided.	134	* @param call Call structure to be decided.
135	*	135	*
136	* @return Return 1 if the old call contents should be saved.	136	* @return Return 1 if the old call contents should be saved.
137	* Return 0 otherwise.	137	* Return 0 otherwise.
138	*/	138	*/
139	static inline int answer_need_old(call_t *call)	139	static inline int answer_need_old(call_t *call)
140	{	140	{
141	switch (IPC_GET_METHOD(call->data)) {	141	switch (IPC_GET_METHOD(call->data)) {
142	case IPC_M_CONNECT_TO_ME:	142	case IPC_M_CONNECT_TO_ME:
143	case IPC_M_CONNECT_ME_TO:	143	case IPC_M_CONNECT_ME_TO:
144	case IPC_M_SHARE_OUT:	144	case IPC_M_SHARE_OUT:
145	case IPC_M_SHARE_IN:	145	case IPC_M_SHARE_IN:
146	case IPC_M_DATA_WRITE:	146	case IPC_M_DATA_WRITE:
147	case IPC_M_DATA_READ:	147	case IPC_M_DATA_READ:
148	return 1;	148	return 1;
149	default:	149	default:
150	return 0;	150	return 0;
151	}	151	}
152	}	152	}
153		153
154	/** Interpret process answer as control information.	154	/** Interpret process answer as control information.
155	*	155	*
156	* This function is called directly after sys_ipc_answer().	156	* This function is called directly after sys_ipc_answer().
157	*	157	*
158	* @param answer Call structure with the answer.	158	* @param answer Call structure with the answer.
159	* @param olddata Saved data of the request.	159	* @param olddata Saved data of the request.
160	*	160	*
161	* @return Return 0 on success or an error code.	161	* @return Return 0 on success or an error code.
162	*/	162	*/
163	static inline int answer_preprocess(call_t answer, ipc_data_t olddata)	163	static inline int answer_preprocess(call_t answer, ipc_data_t olddata)
164	{	164	{
165	int phoneid;	165	int phoneid;
166		166
167	if ((native_t) IPC_GET_RETVAL(answer->data) == EHANGUP) {	167	if ((native_t) IPC_GET_RETVAL(answer->data) == EHANGUP) {
168	/* In case of forward, hangup the forwared phone,	168	/* In case of forward, hangup the forwared phone,
169	* not the originator	169	* not the originator
170	*/	170	*/
171	spinlock_lock(&answer->data.phone->lock);	171	spinlock_lock(&answer->data.phone->lock);
172	spinlock_lock(&TASK->answerbox.lock);	172	spinlock_lock(&TASK->answerbox.lock);
173	if (answer->data.phone->state == IPC_PHONE_CONNECTED) {	173	if (answer->data.phone->state == IPC_PHONE_CONNECTED) {
174	list_remove(&answer->data.phone->link);	174	list_remove(&answer->data.phone->link);
175	answer->data.phone->state = IPC_PHONE_SLAMMED;	175	answer->data.phone->state = IPC_PHONE_SLAMMED;
176	}	176	}
177	spinlock_unlock(&TASK->answerbox.lock);	177	spinlock_unlock(&TASK->answerbox.lock);
178	spinlock_unlock(&answer->data.phone->lock);	178	spinlock_unlock(&answer->data.phone->lock);
179	}	179	}
180		180
181	if (!olddata)	181	if (!olddata)
182	return 0;	182	return 0;
183		183
184	if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) {	184	if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_TO_ME) {
185	phoneid = IPC_GET_ARG5(*olddata);	185	phoneid = IPC_GET_ARG5(*olddata);
186	if (IPC_GET_RETVAL(answer->data)) {	186	if (IPC_GET_RETVAL(answer->data)) {
187	/* The connection was not accepted */	187	/* The connection was not accepted */
188	phone_dealloc(phoneid);	188	phone_dealloc(phoneid);
189	} else {	189	} else {
190	/* The connection was accepted */	190	/* The connection was accepted */
191	phone_connect(phoneid, &answer->sender->answerbox);	191	phone_connect(phoneid, &answer->sender->answerbox);
192	/* Set 'phone hash' as arg5 of response */	192	/* Set 'phone hash' as arg5 of response */
193	IPC_SET_ARG5(answer->data,	193	IPC_SET_ARG5(answer->data,
194	(unative_t) &TASK->phones[phoneid]);	194	(unative_t) &TASK->phones[phoneid]);
195	}	195	}
196	} else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) {	196	} else if (IPC_GET_METHOD(*olddata) == IPC_M_CONNECT_ME_TO) {
197	/* If the users accepted call, connect */	197	/* If the users accepted call, connect */
198	if (!IPC_GET_RETVAL(answer->data)) {	198	if (!IPC_GET_RETVAL(answer->data)) {
199	ipc_phone_connect((phone_t ) IPC_GET_ARG5(olddata),	199	ipc_phone_connect((phone_t ) IPC_GET_ARG5(olddata),
200	&TASK->answerbox);	200	&TASK->answerbox);
201	}	201	}
202	} else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_OUT) {	202	} else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_OUT) {
203	if (!IPC_GET_RETVAL(answer->data)) {	203	if (!IPC_GET_RETVAL(answer->data)) {
204	/* Accepted, handle as_area receipt */	204	/* Accepted, handle as_area receipt */
205	ipl_t ipl;	205	ipl_t ipl;
206	int rc;	206	int rc;
207	as_t *as;	207	as_t *as;
208		208
209	ipl = interrupts_disable();	209	ipl = interrupts_disable();
210	spinlock_lock(&answer->sender->lock);	210	spinlock_lock(&answer->sender->lock);
211	as = answer->sender->as;	211	as = answer->sender->as;
212	spinlock_unlock(&answer->sender->lock);	212	spinlock_unlock(&answer->sender->lock);
213	interrupts_restore(ipl);	213	interrupts_restore(ipl);
214		214
215	rc = as_area_share(as, IPC_GET_ARG1(*olddata),	215	rc = as_area_share(as, IPC_GET_ARG1(*olddata),
216	IPC_GET_ARG2(*olddata), AS,	216	IPC_GET_ARG2(*olddata), AS,
217	IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata));	217	IPC_GET_ARG1(answer->data), IPC_GET_ARG3(*olddata));
218	IPC_SET_RETVAL(answer->data, rc);	218	IPC_SET_RETVAL(answer->data, rc);
219	return rc;	219	return rc;
220	}	220	}
221	} else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_IN) {	221	} else if (IPC_GET_METHOD(*olddata) == IPC_M_SHARE_IN) {
222	if (!IPC_GET_RETVAL(answer->data)) {	222	if (!IPC_GET_RETVAL(answer->data)) {
223	ipl_t ipl;	223	ipl_t ipl;
224	as_t *as;	224	as_t *as;
225	int rc;	225	int rc;
226		226
227	ipl = interrupts_disable();	227	ipl = interrupts_disable();
228	spinlock_lock(&answer->sender->lock);	228	spinlock_lock(&answer->sender->lock);
229	as = answer->sender->as;	229	as = answer->sender->as;
230	spinlock_unlock(&answer->sender->lock);	230	spinlock_unlock(&answer->sender->lock);
231	interrupts_restore(ipl);	231	interrupts_restore(ipl);
232		232
233	rc = as_area_share(AS, IPC_GET_ARG1(answer->data),	233	rc = as_area_share(AS, IPC_GET_ARG1(answer->data),
234	IPC_GET_ARG2(olddata), as, IPC_GET_ARG1(olddata),	234	IPC_GET_ARG2(olddata), as, IPC_GET_ARG1(olddata),
235	IPC_GET_ARG2(answer->data));	235	IPC_GET_ARG2(answer->data));
236	IPC_SET_RETVAL(answer->data, rc);	236	IPC_SET_RETVAL(answer->data, rc);
237	}	237	}
238	} else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_READ) {	238	} else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_READ) {
239	ASSERT(!answer->buffer);	239	ASSERT(!answer->buffer);
240	if (!IPC_GET_RETVAL(answer->data)) {	240	if (!IPC_GET_RETVAL(answer->data)) {
241	/* The recipient agreed to send data. */	241	/* The recipient agreed to send data. */
242	uintptr_t src = IPC_GET_ARG1(answer->data);	242	uintptr_t src = IPC_GET_ARG1(answer->data);
243	uintptr_t dst = IPC_GET_ARG1(*olddata);	243	uintptr_t dst = IPC_GET_ARG1(*olddata);
244	size_t max_size = IPC_GET_ARG2(*olddata);	244	size_t max_size = IPC_GET_ARG2(*olddata);
245	size_t size = IPC_GET_ARG2(answer->data);	245	size_t size = IPC_GET_ARG2(answer->data);
246	if (size <= max_size) {	246	if (size <= max_size) {
247	/*	247	/*
248	* Copy the destination VA so that this piece of	248	* Copy the destination VA so that this piece of
249	* information is not lost.	249	* information is not lost.
250	*/	250	*/
251	IPC_SET_ARG1(answer->data, dst);	251	IPC_SET_ARG1(answer->data, dst);
252		252
253	answer->buffer = malloc(size, 0);	253	answer->buffer = malloc(size, 0);
254	int rc = copy_from_uspace(answer->buffer,	254	int rc = copy_from_uspace(answer->buffer,
255	(void *) src, size);	255	(void *) src, size);
256	if (rc) {	256	if (rc) {
257	IPC_SET_RETVAL(answer->data, rc);	257	IPC_SET_RETVAL(answer->data, rc);
258	free(answer->buffer);	258	free(answer->buffer);
259	answer->buffer = NULL;	259	answer->buffer = NULL;
260	}	260	}
261	} else {	261	} else {
262	IPC_SET_RETVAL(answer->data, ELIMIT);	262	IPC_SET_RETVAL(answer->data, ELIMIT);
263	}	263	}
264	}	264	}
265	} else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_WRITE) {	265	} else if (IPC_GET_METHOD(*olddata) == IPC_M_DATA_WRITE) {
266	ASSERT(answer->buffer);	266	ASSERT(answer->buffer);
267	if (!IPC_GET_RETVAL(answer->data)) {	267	if (!IPC_GET_RETVAL(answer->data)) {
268	/* The recipient agreed to receive data. */	268	/* The recipient agreed to receive data. */
269	int rc;	269	int rc;
270	uintptr_t dst;	270	uintptr_t dst;
271	uintptr_t size;	271	uintptr_t size;
272	uintptr_t max_size;	272	uintptr_t max_size;
273		273
274	dst = IPC_GET_ARG1(answer->data);	274	dst = IPC_GET_ARG1(answer->data);
275	size = IPC_GET_ARG2(answer->data);	275	size = IPC_GET_ARG2(answer->data);
276	max_size = IPC_GET_ARG2(*olddata);	276	max_size = IPC_GET_ARG2(*olddata);
277		277
278	if (size <= max_size) {	278	if (size <= max_size) {
279	rc = copy_to_uspace((void *) dst,	279	rc = copy_to_uspace((void *) dst,
280	answer->buffer, size);	280	answer->buffer, size);
281	if (rc)	281	if (rc)
282	IPC_SET_RETVAL(answer->data, rc);	282	IPC_SET_RETVAL(answer->data, rc);
283	} else {	283	} else {
284	IPC_SET_RETVAL(answer->data, ELIMIT);	284	IPC_SET_RETVAL(answer->data, ELIMIT);
285	}	285	}
286	}	286	}
287	free(answer->buffer);	287	free(answer->buffer);
288	answer->buffer = NULL;	288	answer->buffer = NULL;
289	}	289	}
290	return 0;	290	return 0;
291	}	291	}
292		292
293	static task_t get_lock_callee_task(phone_t phone)	293	static task_t get_lock_callee_task(phone_t phone)
294	{	294	{
295	answerbox_t *answerbox;	295	answerbox_t *answerbox;
296	task_t *ta;	296	task_t *ta;
297		297
298	// FIXME: locking!!!	298	// FIXME: locking!!!
299		299
300	answerbox = phone->callee;	300	answerbox = phone->callee;
301	ta = answerbox->task;	301	ta = answerbox->task;
302		302
303	spinlock_lock(&ta->lock);	303	spinlock_lock(&ta->lock);
304		304
305	return ta;	305	return ta;
306	}	306	}
307		307
308	static thread_t get_task_thread_by_id(task_t ta, thread_id_t tid)	308	static thread_t get_task_thread_by_id(task_t ta, thread_id_t tid)
309	{	309	{
310	thread_t *t;	310	thread_t *t;
311	link_t *cur;	311	link_t *cur;
312		312
313	for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) {	313	for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) {
314	t = list_get_instance(cur, thread_t, th_link);	314	t = list_get_instance(cur, thread_t, th_link);
315	if (tid == t->tid) return t;	315	if (tid == t->tid) return t;
316	}	316	}
317		317
318	return NULL;	318	return NULL;
319	}	319	}
320		320
321	#include <console/klog.h>	321	#include <console/klog.h>
322		322
323	static int debug_begin(call_t call, phone_t phone)	323	static int debug_begin(call_t call, phone_t phone)
324	{	324	{
325	task_t *ta;	325	task_t *ta;
326		326
327	klog_printf("debug_begin()");	327	klog_printf("debug_begin()");
328		328
329	ta = get_lock_callee_task(phone);	329	ta = get_lock_callee_task(phone);
330	klog_printf("debugging task %llu", ta->taskid);	330	klog_printf("debugging task %llu", ta->taskid);
331		331
332	if (ta->being_debugged != false) {	332	if (ta->being_debugged != false) {
333	spinlock_unlock(&ta->lock);	333	spinlock_unlock(&ta->lock);
334	klog_printf("debug_begin(): busy error");	334	klog_printf("debug_begin(): busy error");
335	return EBUSY;	335	return EBUSY;
336	}	336	}
337		337
338	ta->being_debugged = true;	338	ta->being_debugged = true;
339	ta->stop_request = true;	339	ta->stop_request = true;
340	ta->debug_begin_call = call;	340	ta->debug_begin_call = call;
341		341
342	if (ta->not_stoppable_count == 0) {	342	if (ta->not_stoppable_count == 0) {
343	ta->debug_begin_call = NULL;	343	ta->debug_begin_call = NULL;
344	ta->stop_request = false;	344	ta->stop_request = false;
345	spinlock_unlock(&ta->lock);	345	spinlock_unlock(&ta->lock);
346	klog_printf("debug_begin(): immediate backsend");	346	klog_printf("debug_begin(): immediate backsend");
347	return 1; /* actually we need backsend with 0 retval */	347	return 1; /* actually we need backsend with 0 retval */
348	}	348	}
349		349
350	spinlock_unlock(&ta->lock);	350	spinlock_unlock(&ta->lock);
351		351
352	klog_printf("debug_begin() done (wait for stoppability)");	352	klog_printf("debug_begin() done (wait for stoppability)");
353	return 0;	353	return 0;
354	}	354	}
355		355
356	static int debug_go(call_t call, phone_t phone)	356	static int debug_go(call_t call, phone_t phone)
357	{	357	{
358	thread_t *t;	358	thread_t *t;
359	task_t *ta;	359	task_t *ta;
360		360
361	klog_printf("debug_go()");	361	klog_printf("debug_go()");
362	ta = get_lock_callee_task(phone);	362	ta = get_lock_callee_task(phone);
363		363
364	ta->debug_go_call = call;	364	ta->debug_go_call = call;
365	t = get_task_thread_by_id(ta, IPC_GET_ARG1(call->data));	365	t = get_task_thread_by_id(ta, IPC_GET_ARG1(call->data));
366	if (t == NULL) {	366	if (t == NULL) {
367	spinlock_unlock(&ta->lock);	367	spinlock_unlock(&ta->lock);
368	return ENOENT;	368	return ENOENT;
369	}	369	}
370		370
371	klog_printf("debug_go(): waitq_wakeup");	371	klog_printf("debug_go(): waitq_wakeup");
372	waitq_wakeup(&t->go_wq, WAKEUP_FIRST);	372	waitq_wakeup(&t->go_wq, WAKEUP_FIRST);
373		373
374	spinlock_unlock(&ta->lock);	374	spinlock_unlock(&ta->lock);
375		375
376	return 0; /* no backsend */	376	return 0; /* no backsend */
377	}	377	}
378		378
379	static int debug_args_read(call_t call, phone_t phone)	379	static int debug_args_read(call_t call, phone_t phone)
380	{	380	{
381	thread_t *t;	381	thread_t *t;
382	task_t *ta;	382	task_t *ta;
383	void *uspace_buffer;	383	void *uspace_buffer;
384	unative_t to_copy;	384	unative_t to_copy;
385	int rc;	385	int rc;
386		386
387	klog_printf("debug_args_read()");	387	klog_printf("debug_args_read()");
388	// FIXME: verify task/thread state	388	// FIXME: verify task/thread state
389		389
390	ta = get_lock_callee_task(phone);	390	ta = get_lock_callee_task(phone);
391	klog_printf("task %llu", ta->taskid);	391	klog_printf("task %llu", ta->taskid);
392	t = get_task_thread_by_id(ta, IPC_GET_ARG1(call->data));	392	t = get_task_thread_by_id(ta, IPC_GET_ARG1(call->data));
393	if (t == NULL) {	393	if (t == NULL) {
394	spinlock_unlock(&ta->lock);	394	spinlock_unlock(&ta->lock);
395	return ENOENT;	395	return ENOENT;
396	}	396	}
397		397
398	uspace_buffer = (void *)IPC_GET_ARG2(call->data);	398	uspace_buffer = (void *)IPC_GET_ARG2(call->data);
399	to_copy = IPC_GET_ARG3(call->data);	399	to_copy = IPC_GET_ARG3(call->data);
400	if (to_copy > 6) to_copy = 6;	400	if (to_copy > 6) to_copy = 6;
401		401
402	rc = copy_to_uspace(uspace_buffer, t->syscall_args, to_copy);	402	rc = copy_to_uspace(uspace_buffer, t->syscall_args, to_copy);
403	if (rc != 0) {	403	if (rc != 0) {
404	spinlock_unlock(&ta->lock);	404	spinlock_unlock(&ta->lock);
405	klog_printf("debug_args_read() - copy failed");	405	klog_printf("debug_args_read() - copy failed");
406	return rc;	406	return rc;
407	}	407	}
408		408
409	spinlock_unlock(&ta->lock);	409	spinlock_unlock(&ta->lock);
410		410
411	IPC_SET_ARG1(call->data, to_copy);	411	IPC_SET_ARG1(call->data, to_copy);
412		412
413	klog_printf("debug_args_read() done");	413	klog_printf("debug_args_read() done");
414	return 1; /* actually need becksend with retval 0 */	414	return 1; /* actually need becksend with retval 0 */
415	}	415	}
416		416
417	static int debug_thread_read(call_t call, phone_t phone)	417	static int debug_thread_read(call_t call, phone_t phone)
418	{	418	{
419	thread_t *t;	419	thread_t *t;
420	link_t *cur;	420	link_t *cur;
421	task_t *ta;	421	task_t *ta;
422	unative_t *uspace_buffer;	422	unative_t *uspace_buffer;
423	unative_t to_copy;	423	unative_t to_copy;
424	int rc;	424	int rc;
425	unsigned copied, total;	425	unsigned copied, total;
426	unsigned buf_size;	426	unsigned buf_size;
427	unative_t tid;	427	unative_t tid;
428		428
429	klog_printf("debug_thread_read()");	429	klog_printf("debug_thread_read()");
430	// FIXME: verify task/thread state	430	// FIXME: verify task/thread state
431		431
432	ta = get_lock_callee_task(phone);	432	ta = get_lock_callee_task(phone);
433	klog_printf("task %llu", ta->taskid);	433	klog_printf("task %llu", ta->taskid);
434		434
435	uspace_buffer = (void *)IPC_GET_ARG1(call->data);	435	uspace_buffer = (void *)IPC_GET_ARG1(call->data);
436	buf_size = IPC_GET_ARG2(call->data);	436	buf_size = IPC_GET_ARG2(call->data);
437		437
438	copied = total = 0;	438	copied = total = 0;
439	for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) {	439	for (cur = ta->th_head.next; cur != &ta->th_head; cur = cur->next) {
440	t = list_get_instance(cur, thread_t, th_link);	440	t = list_get_instance(cur, thread_t, th_link);
441		441
-		442	/* Not interested in kernel threads */
-		443	if ((t->flags & THREAD_FLAG_USPACE) == 0)
-		444	continue;
-		445
442	//FIXME: id cropped!!	446	//FIXME: id cropped!!
443	tid = (unative_t) t->tid;	447	tid = (unative_t) t->tid;
444		448
445	to_copy = sizeof(unative_t);	449	to_copy = sizeof(unative_t);
446	if (copied + to_copy >= buf_size)	450	if (copied + to_copy >= buf_size)
447	to_copy = buf_size - copied;	451	to_copy = buf_size - copied;
448		452
449	if (to_copy > 0) {	453	if (to_copy > 0) {
450	rc = copy_to_uspace(uspace_buffer, &tid, to_copy);	454	rc = copy_to_uspace(uspace_buffer, &tid, to_copy);
451	if (rc != 0) {	455	if (rc != 0) {
452	spinlock_unlock(&ta->lock);	456	spinlock_unlock(&ta->lock);
453	klog_printf("debug_thread_read() - copy failed");	457	klog_printf("debug_thread_read() - copy failed");
454	return rc;	458	return rc;
455	}	459	}
456	}	460	}
457		461
458	++uspace_buffer;	462	++uspace_buffer;
459	total += sizeof(unative_t);	463	total += sizeof(unative_t);
460	copied += to_copy;	464	copied += to_copy;
461	}	465	}
462		466
463	spinlock_unlock(&ta->lock);	467	spinlock_unlock(&ta->lock);
464		468
465	IPC_SET_ARG1(call->data, copied);	469	IPC_SET_ARG1(call->data, copied);
466	IPC_SET_ARG2(call->data, total);	470	IPC_SET_ARG2(call->data, total);
467		471
468	klog_printf("debug_thread_read() done");	472	klog_printf("debug_thread_read() done");
469	return 1; /* actually need becksend with retval 0 */	473	return 1; /* actually need becksend with retval 0 */
470	}	474	}
471		475
472		476
473	/** Called before the request is sent.	477	/** Called before the request is sent.
474	*	478	*
475	* @param call Call structure with the request.	479	* @param call Call structure with the request.
476	* @param phone Phone that the call will be sent through.	480	* @param phone Phone that the call will be sent through.
477	*	481	*
478	* @return Return 0 on success, ELIMIT or EPERM on error.	482	* @return Return 0 on success, ELIMIT or EPERM on error.
479	*/	483	*/
480	static int request_preprocess(call_t call, phone_t phone)	484	static int request_preprocess(call_t call, phone_t phone)
481	{	485	{
482	int newphid;	486	int newphid;
483	size_t size;	487	size_t size;
484	uintptr_t src;	488	uintptr_t src;
485	int rc;	489	int rc;
486		490
487	switch (IPC_GET_METHOD(call->data)) {	491	switch (IPC_GET_METHOD(call->data)) {
488	case IPC_M_CONNECT_ME_TO:	492	case IPC_M_CONNECT_ME_TO:
489	newphid = phone_alloc();	493	newphid = phone_alloc();
490	if (newphid < 0)	494	if (newphid < 0)
491	return ELIMIT;	495	return ELIMIT;
492	/* Set arg5 for server */	496	/* Set arg5 for server */
493	IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]);	497	IPC_SET_ARG5(call->data, (unative_t) &TASK->phones[newphid]);
494	call->flags \|= IPC_CALL_CONN_ME_TO;	498	call->flags \|= IPC_CALL_CONN_ME_TO;
495	call->priv = newphid;	499	call->priv = newphid;
496	break;	500	break;

Subversion Repositories HelenOS

(root)/branches/tracing/kernel/generic/src/ipc/sysipc.c @ 3693 – Rev 2807 → 2808