WebSVN – HelenOS – Diff – /branches/network/uspace/srv/fs/devfs/devfs_ops.c


/*
 * Copyright (c) 2009 Martin Decky
 * 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 fs
 * @{
 */
 
/**
 * @file devfs_ops.c
 * @brief Implementation of VFS operations for the devfs file system server.
 */
 
#include <ipc/ipc.h>
#include <bool.h>
#include <errno.h>
#include <malloc.h>
#include <string.h>
#include <libfs.h>
#include <fibril_sync.h>
#include <adt/hash_table.h>
#include <sys/stat.h>
#include "devfs.h"
#include "devfs_ops.h"
 
#define PLB_GET_CHAR(pos)  (devfs_reg.plb_ro[pos % PLB_SIZE])
 
/** Opened devices structure */
typedef struct {
    dev_handle_t handle;
    int phone;
    size_t refcount;
    link_t link;
} device_t;
 
/** Hash table of opened devices */
static hash_table_t devices;
 
/** Hash table mutex */
static FIBRIL_MUTEX_INITIALIZE(devices_mutex);
 
#define DEVICES_KEYS        1
#define DEVICES_KEY_HANDLE  0
#define DEVICES_BUCKETS     256
 
/* Implementation of hash table interface for the nodes hash table. */
static hash_index_t devices_hash(unsigned long key[])
{
    return key[DEVICES_KEY_HANDLE] % DEVICES_BUCKETS;
}
 
static int devices_compare(unsigned long key[], hash_count_t keys, link_t *item)
{
    device_t *dev = hash_table_get_instance(item, device_t, link);
    return (dev->handle == (dev_handle_t) key[DEVICES_KEY_HANDLE]);
}
 
static void devices_remove_callback(link_t *item)
{
    free(hash_table_get_instance(item, device_t, link));
}
 
static hash_table_operations_t devices_ops = {
    .hash = devices_hash,
    .compare = devices_compare,
    .remove_callback = devices_remove_callback
};
 
bool devfs_init(void)
{
    if (!hash_table_create(&devices, DEVICES_BUCKETS,
        DEVICES_KEYS, &devices_ops))
        return false;
   
    if (devmap_get_phone(DEVMAP_CLIENT, IPC_FLAG_BLOCKING) < 0)
        return false;
   
    return true;
}
 
void devfs_mounted(ipc_callid_t rid, ipc_call_t *request)
{
    /* Accept the mount options */
    ipc_callid_t callid;
    size_t size;
    if (!ipc_data_write_receive(&callid, &size)) {
        ipc_answer_0(callid, EINVAL);
        ipc_answer_0(rid, EINVAL);
        return;
    }
   
    char *opts = malloc(size + 1);
    if (!opts) {
        ipc_answer_0(callid, ENOMEM);
        ipc_answer_0(rid, ENOMEM);
        return;
    }
   
    ipcarg_t retval = ipc_data_write_finalize(callid, opts, size);
    if (retval != EOK) {
        ipc_answer_0(rid, retval);
        free(opts);
        return;
    }
   
    free(opts);
   
    ipc_answer_3(rid, EOK, 0, 0, 0);
}
 
void devfs_mount(ipc_callid_t rid, ipc_call_t *request)
{
    ipc_answer_0(rid, ENOTSUP);
}
 
void devfs_lookup(ipc_callid_t rid, ipc_call_t *request)
{
    ipcarg_t first = IPC_GET_ARG1(*request);
    ipcarg_t last = IPC_GET_ARG2(*request);
    dev_handle_t dev_handle = IPC_GET_ARG3(*request);
    ipcarg_t lflag = IPC_GET_ARG4(*request);
    fs_index_t index = IPC_GET_ARG5(*request);
   
    /* Hierarchy is flat, no altroot is supported */
    if (index != 0) {
        ipc_answer_0(rid, ENOENT);
        return;
    }
   
    if ((lflag & L_LINK) || (lflag & L_UNLINK)) {
        ipc_answer_0(rid, ENOTSUP);
        return;
    }
   
    /* Eat slash */
    if (PLB_GET_CHAR(first) == '/') {
        first++;
        first %= PLB_SIZE;
    }
   
    if (first >= last) {
        /* Root entry */
        if (!(lflag & L_FILE))
            ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, 0, 0, 0);
        else
            ipc_answer_0(rid, ENOENT);
    } else {
        if (!(lflag & L_DIRECTORY)) {
            size_t len;
            if (last >= first)
                len = last - first + 1;
            else
                len = first + PLB_SIZE - last + 1;
           
            char *name = (char *) malloc(len + 1);
            if (name == NULL) {
                ipc_answer_0(rid, ENOMEM);
                return;
            }
           
            size_t i;
            for (i = 0; i < len; i++)
                name[i] = PLB_GET_CHAR(first + i);
           
            name[len] = 0;
           
            dev_handle_t handle;
            if (devmap_device_get_handle(name, &handle, 0) != EOK) {
                free(name);
                ipc_answer_0(rid, ENOENT);
                return;
            }
           
            if (lflag & L_OPEN) {
                unsigned long key[] = {
                    [DEVICES_KEY_HANDLE] = (unsigned long) handle
                };
               
                fibril_mutex_lock(&devices_mutex);
                link_t *lnk = hash_table_find(&devices, key);
                if (lnk == NULL) {
                    int phone = devmap_device_connect(handle, 0);
                    if (phone < 0) {
                        fibril_mutex_unlock(&devices_mutex);
                        free(name);
                        ipc_answer_0(rid, ENOENT);
                        return;
                    }
                   
                    device_t *dev = (device_t *) malloc(sizeof(device_t));
                    if (dev == NULL) {
                        fibril_mutex_unlock(&devices_mutex);
                        free(name);
                        ipc_answer_0(rid, ENOMEM);
                        return;
                    }
                   
                    dev->handle = handle;
                    dev->phone = phone;
                    dev->refcount = 1;
                   
                    hash_table_insert(&devices, key, &dev->link);
                } else {
                    device_t *dev = hash_table_get_instance(lnk, device_t, link);
                    dev->refcount++;
                }
                fibril_mutex_unlock(&devices_mutex);
            }
           
            free(name);
           
            ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, handle, 0, 1);
        } else
            ipc_answer_0(rid, ENOENT);
    }
}
 
void devfs_open_node(ipc_callid_t rid, ipc_call_t *request)
{
    dev_handle_t handle = IPC_GET_ARG2(*request);
   
    unsigned long key[] = {
        [DEVICES_KEY_HANDLE] = (unsigned long) handle
    };
   
    fibril_mutex_lock(&devices_mutex);
    link_t *lnk = hash_table_find(&devices, key);
    if (lnk == NULL) {
        int phone = devmap_device_connect(handle, 0);
        if (phone < 0) {
            fibril_mutex_unlock(&devices_mutex);
            ipc_answer_0(rid, ENOENT);
            return;
        }
       
        device_t *dev = (device_t *) malloc(sizeof(device_t));
        if (dev == NULL) {
            fibril_mutex_unlock(&devices_mutex);
            ipc_answer_0(rid, ENOMEM);
            return;
        }
       
        dev->handle = handle;
        dev->phone = phone;
        dev->refcount = 1;
       
        hash_table_insert(&devices, key, &dev->link);
    } else {
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
        dev->refcount++;
    }
    fibril_mutex_unlock(&devices_mutex);
   
    ipc_answer_3(rid, EOK, 0, 1, L_FILE);
}
 
void devfs_stat(ipc_callid_t rid, ipc_call_t *request)
{
    dev_handle_t dev_handle = (dev_handle_t) IPC_GET_ARG1(*request);
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
   
    ipc_callid_t callid;
    size_t size;
    if (!ipc_data_read_receive(&callid, &size) ||
        size != sizeof(struct stat)) {
        ipc_answer_0(callid, EINVAL);
        ipc_answer_0(rid, EINVAL);
        return;
    }
 
    struct stat stat;
    memset(&stat, 0, sizeof(struct stat));
 
    stat.fs_handle = devfs_reg.fs_handle;
    stat.dev_handle = dev_handle;
    stat.index = index;
    stat.lnkcnt = 1;
    stat.is_file = (index != 0);
    stat.size = 0;
   
    if (index != 0) {
        unsigned long key[] = {
            [DEVICES_KEY_HANDLE] = (unsigned long) index
        };
       
        fibril_mutex_lock(&devices_mutex);
        link_t *lnk = hash_table_find(&devices, key);
        if (lnk != NULL)
            stat.devfs_stat.device = (dev_handle_t)index;
 
 
 
        fibril_mutex_unlock(&devices_mutex);
    }
 
    ipc_data_read_finalize(callid, &stat, sizeof(struct stat));
 
    ipc_answer_0(rid, EOK);
}
 
void devfs_read(ipc_callid_t rid, ipc_call_t *request)
{
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
    off_t pos = (off_t) IPC_GET_ARG3(*request);
   
    if (index != 0) {
        unsigned long key[] = {
            [DEVICES_KEY_HANDLE] = (unsigned long) index
        };
       
        fibril_mutex_lock(&devices_mutex);
        link_t *lnk = hash_table_find(&devices, key);
        if (lnk == NULL) {
            fibril_mutex_unlock(&devices_mutex);
            ipc_answer_0(rid, ENOENT);
            return;
        }
       
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
       
        ipc_callid_t callid;
        if (!ipc_data_read_receive(&callid, NULL)) {
            fibril_mutex_unlock(&devices_mutex);
            ipc_answer_0(callid, EINVAL);
            ipc_answer_0(rid, EINVAL);
            return;
        }
       
        /* Make a request at the driver */
        ipc_call_t answer;
        aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request),
            IPC_GET_ARG3(*request), &answer);
       
        /* Forward the IPC_M_DATA_READ request to the driver */
        ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);
        fibril_mutex_unlock(&devices_mutex);
       
        /* Wait for reply from the driver. */
        ipcarg_t rc;
        async_wait_for(msg, &rc);
        size_t bytes = IPC_GET_ARG1(answer);
       
        /* Driver reply is the final result of the whole operation */
        ipc_answer_1(rid, rc, bytes);
    } else {
        ipc_callid_t callid;
        size_t size;
        if (!ipc_data_read_receive(&callid, &size)) {
            ipc_answer_0(callid, EINVAL);
            ipc_answer_0(rid, EINVAL);
            return;
        }
       
        size_t count = devmap_device_get_count();
        dev_desc_t *desc = malloc(count * sizeof(dev_desc_t));
        if (desc == NULL) {
            ipc_answer_0(callid, ENOMEM);
            ipc_answer_1(rid, ENOMEM, 0);
            return;
        }
       
        size_t max = devmap_device_get_devices(count, desc);
       
        if (pos < max) {
            ipc_data_read_finalize(callid, desc[pos].name, str_size(desc[pos].name) + 1);
        } else {
            ipc_answer_0(callid, ENOENT);
            ipc_answer_1(rid, ENOENT, 0);
            return;
        }
       
        free(desc);
       
        ipc_answer_1(rid, EOK, 1);
    }
}
 
void devfs_write(ipc_callid_t rid, ipc_call_t *request)
{
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
    off_t pos = (off_t) IPC_GET_ARG3(*request);
   
    if (index != 0) {
        unsigned long key[] = {
            [DEVICES_KEY_HANDLE] = (unsigned long) index
        };
       
        fibril_mutex_lock(&devices_mutex);
        link_t *lnk = hash_table_find(&devices, key);
        if (lnk == NULL) {
            fibril_mutex_unlock(&devices_mutex);
            ipc_answer_0(rid, ENOENT);
            return;
        }
       
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
       
        ipc_callid_t callid;
        if (!ipc_data_write_receive(&callid, NULL)) {
            fibril_mutex_unlock(&devices_mutex);
            ipc_answer_0(callid, EINVAL);
            ipc_answer_0(rid, EINVAL);
            return;
        }
       
        /* Make a request at the driver */
        ipc_call_t answer;
        aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request),
            IPC_GET_ARG3(*request), &answer);
       
        /* Forward the IPC_M_DATA_WRITE request to the driver */
        ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);
       
        fibril_mutex_unlock(&devices_mutex);
       
        /* Wait for reply from the driver. */
        ipcarg_t rc;
        async_wait_for(msg, &rc);
        size_t bytes = IPC_GET_ARG1(answer);
       
        /* Driver reply is the final result of the whole operation */
        ipc_answer_1(rid, rc, bytes);
    } else {
        /* Read-only filesystem */
        ipc_answer_0(rid, ENOTSUP);
    }
}
 
void devfs_truncate(ipc_callid_t rid, ipc_call_t *request)
{
    ipc_answer_0(rid, ENOTSUP);
}
 
void devfs_close(ipc_callid_t rid, ipc_call_t *request)
{
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
   
    if (index != 0) {
        unsigned long key[] = {
            [DEVICES_KEY_HANDLE] = (unsigned long) index
        };
       
        fibril_mutex_lock(&devices_mutex);
        link_t *lnk = hash_table_find(&devices, key);
        if (lnk == NULL) {
            fibril_mutex_unlock(&devices_mutex);
            ipc_answer_0(rid, ENOENT);
            return;
        }
       
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
        dev->refcount--;
       
        if (dev->refcount == 0) {
            ipc_hangup(dev->phone);
            hash_table_remove(&devices, key, DEVICES_KEYS);
        }
       
        fibril_mutex_unlock(&devices_mutex);
       
        ipc_answer_0(rid, EOK);
    } else
        ipc_answer_0(rid, ENOTSUP);
}
 
void devfs_sync(ipc_callid_t rid, ipc_call_t *request)
{
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
   
    if (index != 0) {
        unsigned long key[] = {
            [DEVICES_KEY_HANDLE] = (unsigned long) index
        };
       
        fibril_mutex_lock(&devices_mutex);
        link_t *lnk = hash_table_find(&devices, key);
        if (lnk == NULL) {
            fibril_mutex_unlock(&devices_mutex);
            ipc_answer_0(rid, ENOENT);
            return;
        }
       
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
       
        /* Make a request at the driver */
        ipc_call_t answer;
        aid_t msg = async_send_2(dev->phone, IPC_GET_METHOD(*request),
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request), &answer);
       
        fibril_mutex_unlock(&devices_mutex);
       
        /* Wait for reply from the driver */
        ipcarg_t rc;
        async_wait_for(msg, &rc);
       
        /* Driver reply is the final result of the whole operation */
        ipc_answer_0(rid, rc);
    } else
        ipc_answer_0(rid, ENOTSUP);
}
 
void devfs_destroy(ipc_callid_t rid, ipc_call_t *request)
{
    ipc_answer_0(rid, ENOTSUP);
}
 
/**
 * @}
 */
 

Rev 4581	Rev 4718
1	/*	1	/*
2	* Copyright (c) 2009 Martin Decky	2	* Copyright (c) 2009 Martin Decky
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 fs	29	/** @addtogroup fs
30	* @{	30	* @{
31	*/	31	*/
32		32
33	/**	33	/**
34	* @file devfs_ops.c	34	* @file devfs_ops.c
35	* @brief Implementation of VFS operations for the devfs file system server.	35	* @brief Implementation of VFS operations for the devfs file system server.
36	*/	36	*/
37		37
38	#include <ipc/ipc.h>	38	#include <ipc/ipc.h>
39	#include <bool.h>	39	#include <bool.h>
40	#include <errno.h>	40	#include <errno.h>
41	#include <malloc.h>	41	#include <malloc.h>
42	#include <string.h>	42	#include <string.h>
43	#include <libfs.h>	43	#include <libfs.h>
44	#include <fibril_sync.h>	44	#include <fibril_sync.h>
45	#include <adt/hash_table.h>	45	#include <adt/hash_table.h>
-		46	#include <sys/stat.h>
46	#include "devfs.h"	47	#include "devfs.h"
47	#include "devfs_ops.h"	48	#include "devfs_ops.h"
48		49
49	#define PLB_GET_CHAR(pos) (devfs_reg.plb_ro[pos % PLB_SIZE])	50	#define PLB_GET_CHAR(pos) (devfs_reg.plb_ro[pos % PLB_SIZE])
50		51
51	/** Opened devices structure */	52	/** Opened devices structure */
52	typedef struct {	53	typedef struct {
53	dev_handle_t handle;	54	dev_handle_t handle;
54	int phone;	55	int phone;
55	size_t refcount;	56	size_t refcount;
56	link_t link;	57	link_t link;
57	} device_t;	58	} device_t;
58		59
59	/** Hash table of opened devices */	60	/** Hash table of opened devices */
60	static hash_table_t devices;	61	static hash_table_t devices;
61		62
62	/** Hash table mutex */	63	/** Hash table mutex */
63	static FIBRIL_MUTEX_INITIALIZE(devices_mutex);	64	static FIBRIL_MUTEX_INITIALIZE(devices_mutex);
64		65
65	#define DEVICES_KEYS 1	66	#define DEVICES_KEYS 1
66	#define DEVICES_KEY_HANDLE 0	67	#define DEVICES_KEY_HANDLE 0
67	#define DEVICES_BUCKETS 256	68	#define DEVICES_BUCKETS 256
68		69
69	/* Implementation of hash table interface for the nodes hash table. */	70	/* Implementation of hash table interface for the nodes hash table. */
70	static hash_index_t devices_hash(unsigned long key[])	71	static hash_index_t devices_hash(unsigned long key[])
71	{	72	{
72	return key[DEVICES_KEY_HANDLE] % DEVICES_BUCKETS;	73	return key[DEVICES_KEY_HANDLE] % DEVICES_BUCKETS;
73	}	74	}
74		75
75	static int devices_compare(unsigned long key[], hash_count_t keys, link_t *item)	76	static int devices_compare(unsigned long key[], hash_count_t keys, link_t *item)
76	{	77	{
77	device_t *dev = hash_table_get_instance(item, device_t, link);	78	device_t *dev = hash_table_get_instance(item, device_t, link);
78	return (dev->handle == (dev_handle_t) key[DEVICES_KEY_HANDLE]);	79	return (dev->handle == (dev_handle_t) key[DEVICES_KEY_HANDLE]);
79	}	80	}
80		81
81	static void devices_remove_callback(link_t *item)	82	static void devices_remove_callback(link_t *item)
82	{	83	{
83	free(hash_table_get_instance(item, device_t, link));	84	free(hash_table_get_instance(item, device_t, link));
84	}	85	}
85		86
86	static hash_table_operations_t devices_ops = {	87	static hash_table_operations_t devices_ops = {
87	.hash = devices_hash,	88	.hash = devices_hash,
88	.compare = devices_compare,	89	.compare = devices_compare,
89	.remove_callback = devices_remove_callback	90	.remove_callback = devices_remove_callback
90	};	91	};
91		92
92	bool devfs_init(void)	93	bool devfs_init(void)
93	{	94	{
94	if (!hash_table_create(&devices, DEVICES_BUCKETS,	95	if (!hash_table_create(&devices, DEVICES_BUCKETS,
95	DEVICES_KEYS, &devices_ops))	96	DEVICES_KEYS, &devices_ops))
96	return false;	97	return false;
97		98
98	if (devmap_get_phone(DEVMAP_CLIENT, IPC_FLAG_BLOCKING) < 0)	99	if (devmap_get_phone(DEVMAP_CLIENT, IPC_FLAG_BLOCKING) < 0)
99	return false;	100	return false;
100		101
101	return true;	102	return true;
102	}	103	}
103		104
104	void devfs_mounted(ipc_callid_t rid, ipc_call_t *request)	105	void devfs_mounted(ipc_callid_t rid, ipc_call_t *request)
105	{	106	{
106	/* Accept the mount options */	107	/* Accept the mount options */
107	ipc_callid_t callid;	108	ipc_callid_t callid;
108	size_t size;	109	size_t size;
109	if (!ipc_data_write_receive(&callid, &size)) {	110	if (!ipc_data_write_receive(&callid, &size)) {
110	ipc_answer_0(callid, EINVAL);	111	ipc_answer_0(callid, EINVAL);
111	ipc_answer_0(rid, EINVAL);	112	ipc_answer_0(rid, EINVAL);
112	return;	113	return;
113	}	114	}
114		115
115	char *opts = malloc(size + 1);	116	char *opts = malloc(size + 1);
116	if (!opts) {	117	if (!opts) {
117	ipc_answer_0(callid, ENOMEM);	118	ipc_answer_0(callid, ENOMEM);
118	ipc_answer_0(rid, ENOMEM);	119	ipc_answer_0(rid, ENOMEM);
119	return;	120	return;
120	}	121	}
121		122
122	ipcarg_t retval = ipc_data_write_finalize(callid, opts, size);	123	ipcarg_t retval = ipc_data_write_finalize(callid, opts, size);
123	if (retval != EOK) {	124	if (retval != EOK) {
124	ipc_answer_0(rid, retval);	125	ipc_answer_0(rid, retval);
125	free(opts);	126	free(opts);
126	return;	127	return;
127	}	128	}
128		129
129	free(opts);	130	free(opts);
130		131
131	ipc_answer_3(rid, EOK, 0, 0, 0);	132	ipc_answer_3(rid, EOK, 0, 0, 0);
132	}	133	}
133		134
134	void devfs_mount(ipc_callid_t rid, ipc_call_t *request)	135	void devfs_mount(ipc_callid_t rid, ipc_call_t *request)
135	{	136	{
136	ipc_answer_0(rid, ENOTSUP);	137	ipc_answer_0(rid, ENOTSUP);
137	}	138	}
138		139
139	void devfs_lookup(ipc_callid_t rid, ipc_call_t *request)	140	void devfs_lookup(ipc_callid_t rid, ipc_call_t *request)
140	{	141	{
141	ipcarg_t first = IPC_GET_ARG1(*request);	142	ipcarg_t first = IPC_GET_ARG1(*request);
142	ipcarg_t last = IPC_GET_ARG2(*request);	143	ipcarg_t last = IPC_GET_ARG2(*request);
143	dev_handle_t dev_handle = IPC_GET_ARG3(*request);	144	dev_handle_t dev_handle = IPC_GET_ARG3(*request);
144	ipcarg_t lflag = IPC_GET_ARG4(*request);	145	ipcarg_t lflag = IPC_GET_ARG4(*request);
145	fs_index_t index = IPC_GET_ARG5(*request);	146	fs_index_t index = IPC_GET_ARG5(*request);
146		147
147	/* Hierarchy is flat, no altroot is supported */	148	/* Hierarchy is flat, no altroot is supported */
148	if (index != 0) {	149	if (index != 0) {
149	ipc_answer_0(rid, ENOENT);	150	ipc_answer_0(rid, ENOENT);
150	return;	151	return;
151	}	152	}
152		153
153	if ((lflag & L_LINK) \|\| (lflag & L_UNLINK)) {	154	if ((lflag & L_LINK) \|\| (lflag & L_UNLINK)) {
154	ipc_answer_0(rid, ENOTSUP);	155	ipc_answer_0(rid, ENOTSUP);
155	return;	156	return;
156	}	157	}
157		158
158	/* Eat slash */	159	/* Eat slash */
159	if (PLB_GET_CHAR(first) == '/') {	160	if (PLB_GET_CHAR(first) == '/') {
160	first++;	161	first++;
161	first %= PLB_SIZE;	162	first %= PLB_SIZE;
162	}	163	}
163		164
164	if (first >= last) {	165	if (first >= last) {
165	/* Root entry */	166	/* Root entry */
166	if (lflag & L_DIRECTORY)	167	if (!(lflag & L_FILE))
167	ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, 0, 0, 0);	168	ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, 0, 0, 0);
168	else	169	else
169	ipc_answer_0(rid, ENOENT);	170	ipc_answer_0(rid, ENOENT);
170	} else {	171	} else {
171	if (lflag & L_FILE) {	172	if (!(lflag & L_DIRECTORY)) {
172	size_t len;	173	size_t len;
173	if (last >= first)	174	if (last >= first)
174	len = last - first + 1;	175	len = last - first + 1;
175	else	176	else
176	len = first + PLB_SIZE - last + 1;	177	len = first + PLB_SIZE - last + 1;
177		178
178	char name = (char ) malloc(len + 1);	179	char name = (char ) malloc(len + 1);
179	if (name == NULL) {	180	if (name == NULL) {
180	ipc_answer_0(rid, ENOMEM);	181	ipc_answer_0(rid, ENOMEM);
181	return;	182	return;
182	}	183	}
183		184
184	size_t i;	185	size_t i;
185	for (i = 0; i < len; i++)	186	for (i = 0; i < len; i++)
186	name[i] = PLB_GET_CHAR(first + i);	187	name[i] = PLB_GET_CHAR(first + i);
187		188
188	name[len] = 0;	189	name[len] = 0;
189		190
190	dev_handle_t handle;	191	dev_handle_t handle;
191	if (devmap_device_get_handle(name, &handle, 0) != EOK) {	192	if (devmap_device_get_handle(name, &handle, 0) != EOK) {
192	free(name);	193	free(name);
193	ipc_answer_0(rid, ENOENT);	194	ipc_answer_0(rid, ENOENT);
194	return;	195	return;
195	}	196	}
196		197
197	if (lflag & L_OPEN) {	198	if (lflag & L_OPEN) {
198	unsigned long key[] = {	199	unsigned long key[] = {
199	[DEVICES_KEY_HANDLE] = (unsigned long) handle	200	[DEVICES_KEY_HANDLE] = (unsigned long) handle
200	};	201	};
201		202
202	fibril_mutex_lock(&devices_mutex);	203	fibril_mutex_lock(&devices_mutex);
203	link_t *lnk = hash_table_find(&devices, key);	204	link_t *lnk = hash_table_find(&devices, key);
204	if (lnk == NULL) {	205	if (lnk == NULL) {
205	int phone = devmap_device_connect(handle, 0);	206	int phone = devmap_device_connect(handle, 0);
206	if (phone < 0) {	207	if (phone < 0) {
207	fibril_mutex_unlock(&devices_mutex);	208	fibril_mutex_unlock(&devices_mutex);
208	free(name);	209	free(name);
209	ipc_answer_0(rid, ENOENT);	210	ipc_answer_0(rid, ENOENT);
210	return;	211	return;
211	}	212	}
212		213
213	device_t dev = (device_t ) malloc(sizeof(device_t));	214	device_t dev = (device_t ) malloc(sizeof(device_t));
214	if (dev == NULL) {	215	if (dev == NULL) {
215	fibril_mutex_unlock(&devices_mutex);	216	fibril_mutex_unlock(&devices_mutex);
216	free(name);	217	free(name);
217	ipc_answer_0(rid, ENOMEM);	218	ipc_answer_0(rid, ENOMEM);
218	return;	219	return;
219	}	220	}
220		221
221	dev->handle = handle;	222	dev->handle = handle;
222	dev->phone = phone;	223	dev->phone = phone;
223	dev->refcount = 1;	224	dev->refcount = 1;
224		225
225	hash_table_insert(&devices, key, &dev->link);	226	hash_table_insert(&devices, key, &dev->link);
226	} else {	227	} else {
227	device_t *dev = hash_table_get_instance(lnk, device_t, link);	228	device_t *dev = hash_table_get_instance(lnk, device_t, link);
228	dev->refcount++;	229	dev->refcount++;
229	}	230	}
230	fibril_mutex_unlock(&devices_mutex);	231	fibril_mutex_unlock(&devices_mutex);
231	}	232	}
232		233
233	free(name);	234	free(name);
234		235
235	ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, handle, 0, 1);	236	ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, handle, 0, 1);
236	} else	237	} else
237	ipc_answer_0(rid, ENOENT);	238	ipc_answer_0(rid, ENOENT);
238	}	239	}
239	}	240	}
240		241
241	void devfs_open_node(ipc_callid_t rid, ipc_call_t *request)	242	void devfs_open_node(ipc_callid_t rid, ipc_call_t *request)
242	{	243	{
243	dev_handle_t handle = IPC_GET_ARG2(*request);	244	dev_handle_t handle = IPC_GET_ARG2(*request);
244		245
245	unsigned long key[] = {	246	unsigned long key[] = {
246	[DEVICES_KEY_HANDLE] = (unsigned long) handle	247	[DEVICES_KEY_HANDLE] = (unsigned long) handle
247	};	248	};
248		249
249	fibril_mutex_lock(&devices_mutex);	250	fibril_mutex_lock(&devices_mutex);
250	link_t *lnk = hash_table_find(&devices, key);	251	link_t *lnk = hash_table_find(&devices, key);
251	if (lnk == NULL) {	252	if (lnk == NULL) {
252	int phone = devmap_device_connect(handle, 0);	253	int phone = devmap_device_connect(handle, 0);
253	if (phone < 0) {	254	if (phone < 0) {
254	fibril_mutex_unlock(&devices_mutex);	255	fibril_mutex_unlock(&devices_mutex);
255	ipc_answer_0(rid, ENOENT);	256	ipc_answer_0(rid, ENOENT);
256	return;	257	return;
257	}	258	}
258		259
259	device_t dev = (device_t ) malloc(sizeof(device_t));	260	device_t dev = (device_t ) malloc(sizeof(device_t));
260	if (dev == NULL) {	261	if (dev == NULL) {
261	fibril_mutex_unlock(&devices_mutex);	262	fibril_mutex_unlock(&devices_mutex);
262	ipc_answer_0(rid, ENOMEM);	263	ipc_answer_0(rid, ENOMEM);
263	return;	264	return;
264	}	265	}
265		266
266	dev->handle = handle;	267	dev->handle = handle;
267	dev->phone = phone;	268	dev->phone = phone;
268	dev->refcount = 1;	269	dev->refcount = 1;
269		270
270	hash_table_insert(&devices, key, &dev->link);	271	hash_table_insert(&devices, key, &dev->link);
271	} else {	272	} else {
272	device_t *dev = hash_table_get_instance(lnk, device_t, link);	273	device_t *dev = hash_table_get_instance(lnk, device_t, link);
273	dev->refcount++;	274	dev->refcount++;
274	}	275	}
275	fibril_mutex_unlock(&devices_mutex);	276	fibril_mutex_unlock(&devices_mutex);
276		277
277	ipc_answer_3(rid, EOK, 0, 1, L_FILE);	278	ipc_answer_3(rid, EOK, 0, 1, L_FILE);
278	}	279	}
279		280
280	void devfs_device(ipc_callid_t rid, ipc_call_t *request)	281	void devfs_stat(ipc_callid_t rid, ipc_call_t *request)
281	{	282	{
-		283	dev_handle_t dev_handle = (dev_handle_t) IPC_GET_ARG1(*request);
282	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);	284	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
283		285
-		286	ipc_callid_t callid;
-		287	size_t size;
-		288	if (!ipc_data_read_receive(&callid, &size) \|\|
-		289	size != sizeof(struct stat)) {
-		290	ipc_answer_0(callid, EINVAL);
-		291	ipc_answer_0(rid, EINVAL);
-		292	return;
-		293	}
-		294
-		295	struct stat stat;
-		296	memset(&stat, 0, sizeof(struct stat));
-		297
-		298	stat.fs_handle = devfs_reg.fs_handle;
-		299	stat.dev_handle = dev_handle;
-		300	stat.index = index;
-		301	stat.lnkcnt = 1;
-		302	stat.is_file = (index != 0);
-		303	stat.size = 0;
-		304
284	if (index != 0) {	305	if (index != 0) {
285	unsigned long key[] = {	306	unsigned long key[] = {
286	[DEVICES_KEY_HANDLE] = (unsigned long) index	307	[DEVICES_KEY_HANDLE] = (unsigned long) index
287	};	308	};
288		309
289	fibril_mutex_lock(&devices_mutex);	310	fibril_mutex_lock(&devices_mutex);
290	link_t *lnk = hash_table_find(&devices, key);	311	link_t *lnk = hash_table_find(&devices, key);
291	if (lnk == NULL) {	312	if (lnk != NULL)
292	fibril_mutex_unlock(&devices_mutex);	313	stat.devfs_stat.device = (dev_handle_t)index;
293	ipc_answer_0(rid, ENOENT);	-
294	return;	-
295	}	-
296	fibril_mutex_unlock(&devices_mutex);	314	fibril_mutex_unlock(&devices_mutex);
297		315	}
-		316
298	ipc_answer_1(rid, EOK, (ipcarg_t) index);	317	ipc_data_read_finalize(callid, &stat, sizeof(struct stat));
299	} else	-
300	ipc_answer_0(rid, ENOTSUP);	318	ipc_answer_0(rid, EOK);
301	}	319	}
302		320
303	void devfs_read(ipc_callid_t rid, ipc_call_t *request)	321	void devfs_read(ipc_callid_t rid, ipc_call_t *request)
304	{	322	{
305	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);	323	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
306	off_t pos = (off_t) IPC_GET_ARG3(*request);	324	off_t pos = (off_t) IPC_GET_ARG3(*request);
307		325
308	if (index != 0) {	326	if (index != 0) {
309	unsigned long key[] = {	327	unsigned long key[] = {
310	[DEVICES_KEY_HANDLE] = (unsigned long) index	328	[DEVICES_KEY_HANDLE] = (unsigned long) index
311	};	329	};
312		330
313	fibril_mutex_lock(&devices_mutex);	331	fibril_mutex_lock(&devices_mutex);
314	link_t *lnk = hash_table_find(&devices, key);	332	link_t *lnk = hash_table_find(&devices, key);
315	if (lnk == NULL) {	333	if (lnk == NULL) {
316	fibril_mutex_unlock(&devices_mutex);	334	fibril_mutex_unlock(&devices_mutex);
317	ipc_answer_0(rid, ENOENT);	335	ipc_answer_0(rid, ENOENT);
318	return;	336	return;
319	}	337	}
320		338
321	device_t *dev = hash_table_get_instance(lnk, device_t, link);	339	device_t *dev = hash_table_get_instance(lnk, device_t, link);
322		340
323	ipc_callid_t callid;	341	ipc_callid_t callid;
324	if (!ipc_data_read_receive(&callid, NULL)) {	342	if (!ipc_data_read_receive(&callid, NULL)) {
325	fibril_mutex_unlock(&devices_mutex);	343	fibril_mutex_unlock(&devices_mutex);
326	ipc_answer_0(callid, EINVAL);	344	ipc_answer_0(callid, EINVAL);
327	ipc_answer_0(rid, EINVAL);	345	ipc_answer_0(rid, EINVAL);
328	return;	346	return;
329	}	347	}
330		348
331	/* Make a request at the driver */	349	/* Make a request at the driver */
332	ipc_call_t answer;	350	ipc_call_t answer;
333	aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),	351	aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),
334	IPC_GET_ARG1(request), IPC_GET_ARG2(request),	352	IPC_GET_ARG1(request), IPC_GET_ARG2(request),
335	IPC_GET_ARG3(*request), &answer);	353	IPC_GET_ARG3(*request), &answer);
336		354
337	/* Forward the IPC_M_DATA_READ request to the driver */	355	/* Forward the IPC_M_DATA_READ request to the driver */
338	ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);	356	ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);
339	fibril_mutex_unlock(&devices_mutex);	357	fibril_mutex_unlock(&devices_mutex);
340		358
341	/* Wait for reply from the driver. */	359	/* Wait for reply from the driver. */
342	ipcarg_t rc;	360	ipcarg_t rc;
343	async_wait_for(msg, &rc);	361	async_wait_for(msg, &rc);
344	size_t bytes = IPC_GET_ARG1(answer);	362	size_t bytes = IPC_GET_ARG1(answer);
345		363
346	/* Driver reply is the final result of the whole operation */	364	/* Driver reply is the final result of the whole operation */
347	ipc_answer_1(rid, rc, bytes);	365	ipc_answer_1(rid, rc, bytes);
348	} else {	366	} else {
349	ipc_callid_t callid;	367	ipc_callid_t callid;
350	size_t size;	368	size_t size;
351	if (!ipc_data_read_receive(&callid, &size)) {	369	if (!ipc_data_read_receive(&callid, &size)) {
352	ipc_answer_0(callid, EINVAL);	370	ipc_answer_0(callid, EINVAL);
353	ipc_answer_0(rid, EINVAL);	371	ipc_answer_0(rid, EINVAL);
354	return;	372	return;
355	}	373	}
356		374
357	size_t count = devmap_device_get_count();	375	size_t count = devmap_device_get_count();
358	dev_desc_t desc = malloc(count sizeof(dev_desc_t));	376	dev_desc_t desc = malloc(count sizeof(dev_desc_t));
359	if (desc == NULL) {	377	if (desc == NULL) {
360	ipc_answer_0(callid, ENOMEM);	378	ipc_answer_0(callid, ENOMEM);
361	ipc_answer_1(rid, ENOMEM, 0);	379	ipc_answer_1(rid, ENOMEM, 0);
362	return;	380	return;
363	}	381	}
364		382
365	size_t max = devmap_device_get_devices(count, desc);	383	size_t max = devmap_device_get_devices(count, desc);
366		384
367	if (pos < max) {	385	if (pos < max) {
368	ipc_data_read_finalize(callid, desc[pos].name, str_size(desc[pos].name) + 1);	386	ipc_data_read_finalize(callid, desc[pos].name, str_size(desc[pos].name) + 1);
369	} else {	387	} else {
370	ipc_answer_0(callid, ENOENT);	388	ipc_answer_0(callid, ENOENT);
371	ipc_answer_1(rid, ENOENT, 0);	389	ipc_answer_1(rid, ENOENT, 0);
372	return;	390	return;
373	}	391	}
374		392
375	free(desc);	393	free(desc);
376		394
377	ipc_answer_1(rid, EOK, 1);	395	ipc_answer_1(rid, EOK, 1);
378	}	396	}
379	}	397	}
380		398
381	void devfs_write(ipc_callid_t rid, ipc_call_t *request)	399	void devfs_write(ipc_callid_t rid, ipc_call_t *request)
382	{	400	{
383	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);	401	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
384	off_t pos = (off_t) IPC_GET_ARG3(*request);	402	off_t pos = (off_t) IPC_GET_ARG3(*request);
385		403
386	if (index != 0) {	404	if (index != 0) {
387	unsigned long key[] = {	405	unsigned long key[] = {
388	[DEVICES_KEY_HANDLE] = (unsigned long) index	406	[DEVICES_KEY_HANDLE] = (unsigned long) index
389	};	407	};
390		408
391	fibril_mutex_lock(&devices_mutex);	409	fibril_mutex_lock(&devices_mutex);
392	link_t *lnk = hash_table_find(&devices, key);	410	link_t *lnk = hash_table_find(&devices, key);
393	if (lnk == NULL) {	411	if (lnk == NULL) {
394	fibril_mutex_unlock(&devices_mutex);	412	fibril_mutex_unlock(&devices_mutex);
395	ipc_answer_0(rid, ENOENT);	413	ipc_answer_0(rid, ENOENT);
396	return;	414	return;
397	}	415	}
398		416
399	device_t *dev = hash_table_get_instance(lnk, device_t, link);	417	device_t *dev = hash_table_get_instance(lnk, device_t, link);
400		418
401	ipc_callid_t callid;	419	ipc_callid_t callid;
402	if (!ipc_data_write_receive(&callid, NULL)) {	420	if (!ipc_data_write_receive(&callid, NULL)) {
403	fibril_mutex_unlock(&devices_mutex);	421	fibril_mutex_unlock(&devices_mutex);
404	ipc_answer_0(callid, EINVAL);	422	ipc_answer_0(callid, EINVAL);
405	ipc_answer_0(rid, EINVAL);	423	ipc_answer_0(rid, EINVAL);
406	return;	424	return;
407	}	425	}
408		426
409	/* Make a request at the driver */	427	/* Make a request at the driver */
410	ipc_call_t answer;	428	ipc_call_t answer;
411	aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),	429	aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),
412	IPC_GET_ARG1(request), IPC_GET_ARG2(request),	430	IPC_GET_ARG1(request), IPC_GET_ARG2(request),
413	IPC_GET_ARG3(*request), &answer);	431	IPC_GET_ARG3(*request), &answer);
414		432
415	/* Forward the IPC_M_DATA_WRITE request to the driver */	433	/* Forward the IPC_M_DATA_WRITE request to the driver */
416	ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);	434	ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);
417		435
418	fibril_mutex_unlock(&devices_mutex);	436	fibril_mutex_unlock(&devices_mutex);
419		437
420	/* Wait for reply from the driver. */	438	/* Wait for reply from the driver. */
421	ipcarg_t rc;	439	ipcarg_t rc;
422	async_wait_for(msg, &rc);	440	async_wait_for(msg, &rc);
423	size_t bytes = IPC_GET_ARG1(answer);	441	size_t bytes = IPC_GET_ARG1(answer);
424		442
425	/* Driver reply is the final result of the whole operation */	443	/* Driver reply is the final result of the whole operation */
426	ipc_answer_1(rid, rc, bytes);	444	ipc_answer_1(rid, rc, bytes);
427	} else {	445	} else {
428	/* Read-only filesystem */	446	/* Read-only filesystem */
429	ipc_answer_0(rid, ENOTSUP);	447	ipc_answer_0(rid, ENOTSUP);
430	}	448	}
431	}	449	}
432		450
433	void devfs_truncate(ipc_callid_t rid, ipc_call_t *request)	451	void devfs_truncate(ipc_callid_t rid, ipc_call_t *request)
434	{	452	{
435	ipc_answer_0(rid, ENOTSUP);	453	ipc_answer_0(rid, ENOTSUP);
436	}	454	}
437		455
438	void devfs_close(ipc_callid_t rid, ipc_call_t *request)	456	void devfs_close(ipc_callid_t rid, ipc_call_t *request)
439	{	457	{
440	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);	458	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
441		459
442	if (index != 0) {	460	if (index != 0) {
443	unsigned long key[] = {	461	unsigned long key[] = {
444	[DEVICES_KEY_HANDLE] = (unsigned long) index	462	[DEVICES_KEY_HANDLE] = (unsigned long) index
445	};	463	};
446		464
447	fibril_mutex_lock(&devices_mutex);	465	fibril_mutex_lock(&devices_mutex);
448	link_t *lnk = hash_table_find(&devices, key);	466	link_t *lnk = hash_table_find(&devices, key);
449	if (lnk == NULL) {	467	if (lnk == NULL) {
450	fibril_mutex_unlock(&devices_mutex);	468	fibril_mutex_unlock(&devices_mutex);
451	ipc_answer_0(rid, ENOENT);	469	ipc_answer_0(rid, ENOENT);
452	return;	470	return;
453	}	471	}
454		472
455	device_t *dev = hash_table_get_instance(lnk, device_t, link);	473	device_t *dev = hash_table_get_instance(lnk, device_t, link);
456	dev->refcount--;	474	dev->refcount--;
457		475
458	if (dev->refcount == 0) {	476	if (dev->refcount == 0) {
459	ipc_hangup(dev->phone);	477	ipc_hangup(dev->phone);
460	hash_table_remove(&devices, key, DEVICES_KEYS);	478	hash_table_remove(&devices, key, DEVICES_KEYS);
461	}	479	}
462		480
463	fibril_mutex_unlock(&devices_mutex);	481	fibril_mutex_unlock(&devices_mutex);
464		482
465	ipc_answer_0(rid, EOK);	483	ipc_answer_0(rid, EOK);
466	} else	484	} else
467	ipc_answer_0(rid, ENOTSUP);	485	ipc_answer_0(rid, ENOTSUP);
468	}	486	}
469		487
470	void devfs_sync(ipc_callid_t rid, ipc_call_t *request)	488	void devfs_sync(ipc_callid_t rid, ipc_call_t *request)
471	{	489	{
472	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);	490	fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
473		491
474	if (index != 0) {	492	if (index != 0) {
475	unsigned long key[] = {	493	unsigned long key[] = {
476	[DEVICES_KEY_HANDLE] = (unsigned long) index	494	[DEVICES_KEY_HANDLE] = (unsigned long) index
477	};	495	};
478		496

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/fs/devfs/devfs_ops.c – Rev 4581 → 4718