/* * 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 #include #include #include #include #include #include #include #include #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); } /** * @} */