WebSVN – HelenOS – Diff – /trunk/uspace/srv/devmap/devmap.c

 #include <ipc/ns.h>
 #include <async.h>
 #include <stdio.h>
 #include <errno.h>
 #include <bool.h>
+#include <fibril_sync.h>
 #include <stdlib.h>
 #include <string.h>
 #include <ipc/devmap.h>
 #define NAME  "devmap"
     link_t devices;
     /** Phone asociated with this driver */
     ipcarg_t phone;
     /** Device driver name */
     char *name;
+    /** Fibril mutex for list of devices owned by this driver */
+    fibril_mutex_t devices_mutex;
 } devmap_driver_t;
 /** Info about registered device
+ *
  */
 LIST_INITIALIZE(devices_list);
 LIST_INITIALIZE(drivers_list);
 LIST_INITIALIZE(pending_req);
+/* Locking order:
+ *  drivers_list_mutex
+ *  devices_list_mutex
+ *  (devmap_driver_t *)->devices_mutex
+ *  create_handle_mutex
+ **/
+static FIBRIL_MUTEX_INITIALIZE(devices_list_mutex);
+static FIBRIL_MUTEX_INITIALIZE(drivers_list_mutex);
+static FIBRIL_MUTEX_INITIALIZE(create_handle_mutex);
 static dev_handle_t last_handle = 0;
 static dev_handle_t devmap_create_handle(void)
+{
     /* TODO: allow reusing old handles after their unregistration
      * and implement some version of LRU algorithm, avoid overflow
      */
+    fibril_mutex_lock(&create_handle_mutex);
     last_handle++;
+    fibril_mutex_unlock(&create_handle_mutex);
     return last_handle;
+}
 /** Find device with given name.
  * @todo: use hash table
+ *
  */
 static devmap_device_t *devmap_device_find_handle(dev_handle_t handle)
+{
+    fibril_mutex_lock(&devices_list_mutex);
     link_t *item = (&devices_list)->next;
     devmap_device_t *device = NULL;
     while (item != &devices_list) {
         device = list_get_instance(item, devmap_device_t, devices);
         if (device->handle == handle)
             break;
         item = item->next;
+    }
-    if (item == &devices_list)
+    if (item == &devices_list) {
+        fibril_mutex_unlock(&devices_list_mutex);
         return NULL;
+    }
     device = list_get_instance(item, devmap_device_t, devices);
+    fibril_mutex_unlock(&devices_list_mutex);
     return device;
+}
 /**
+ *
         return;
+    }
     driver->name[name_size] = 0;
+    /* Initialize mutex for list of devices owned by this driver */
+    fibril_mutex_initialize(&driver->devices_mutex);
     /*
      * Initialize list of asociated devices
      */
-    list_initialize(&(driver->devices));
+    list_initialize(&driver->devices);
     /*
      * Create connection to the driver
      */
     ipc_call_t call;
     ipc_answer_0(callid, EOK);
     list_initialize(&(driver->drivers));
+    fibril_mutex_lock(&drivers_list_mutex);
     /* TODO:
      * check that no driver with name equal to driver->name is registered
      */
     /*
      * Insert new driver into list of registered drivers
      */
     list_append(&(driver->drivers), &drivers_list);
+    fibril_mutex_unlock(&drivers_list_mutex);
     ipc_answer_0(iid, EOK);
     *odriver = driver;
+}
 static int devmap_driver_unregister(devmap_driver_t *driver)
+{
     if (driver == NULL)
         return EEXISTS;
+    fibril_mutex_lock(&drivers_list_mutex);
     if (driver->phone != 0)
         ipc_hangup(driver->phone);
     /* Remove it from list of drivers */
     list_remove(&(driver->drivers));
+    /* Unregister all its devices */
+    fibril_mutex_lock(&devices_list_mutex);
+    fibril_mutex_lock(&driver->devices_mutex);
     while (!list_empty(&(driver->devices))) {
         devmap_device_t *device = list_get_instance(driver->devices.next,
             devmap_device_t, driver_devices);
         devmap_device_unregister_core(device);
+    }
+    fibril_mutex_unlock(&driver->devices_mutex);
+    fibril_mutex_unlock(&devices_list_mutex);
+    fibril_mutex_unlock(&drivers_list_mutex);
     /* free name and driver */
     if (driver->name != NULL)
         free(driver->name);
     free(driver);
 /** Process pending lookup requests */
 static void process_pending_lookup(void)
+{
-    async_serialize_start();
     link_t *cur;
 loop:
     for (cur = pending_req.next; cur != &pending_req; cur = cur->next) {
         pending_req_t *pr = list_get_instance(cur, pending_req_t, link);
         list_remove(cur);
         free(pr);
         goto loop;
+    }
-    async_serialize_end();
+}
 /** Register instance of device
+ *
     device->name[size] = 0;
     list_initialize(&(device->devices));
     list_initialize(&(device->driver_devices));
+    fibril_mutex_lock(&devices_list_mutex);
     /* Check that device with such name is not already registered */
     if (NULL != devmap_device_find_name(device->name)) {
         printf(NAME ": Device '%s' already registered\n", device->name);
+        fibril_mutex_unlock(&devices_list_mutex);
         free(device->name);
         free(device);
         ipc_answer_0(iid, EEXISTS);
         return;
+    }
     device->driver = driver;
     /* Insert device into list of all devices  */
     list_append(&device->devices, &devices_list);
+    /* Insert device into list of devices that belog to one driver */
+    fibril_mutex_lock(&device->driver->devices_mutex);
     list_append(&device->driver_devices, &device->driver->devices);
+    fibril_mutex_unlock(&device->driver->devices_mutex);
+    fibril_mutex_unlock(&devices_list_mutex);
     ipc_answer_1(iid, EOK, device->handle);
+}
 /**
+ *
     /* TODO: send name in response */
+}
 static void devmap_get_count(ipc_callid_t iid, ipc_call_t *icall)
+{
+    fibril_mutex_lock(&devices_list_mutex);
     ipc_answer_1(iid, EOK, list_count(&devices_list));
+    fibril_mutex_unlock(&devices_list_mutex);
+}
 static void devmap_get_devices(ipc_callid_t iid, ipc_call_t *icall)
+{
+    fibril_mutex_lock(&devices_list_mutex);
     ipc_callid_t callid;
     size_t size;
     if (!ipc_data_read_receive(&callid, &size)) {
         ipc_answer_0(callid, EREFUSED);
         ipc_answer_0(iid, EREFUSED);
         return;
+    }
     free(desc);
+    fibril_mutex_unlock(&devices_list_mutex);
     ipc_answer_1(iid, EOK, pos);
+}
 /** Initialize device mapper.
+ *
+    }
     list_initialize(&(device->devices));
     list_initialize(&(device->driver_devices));
+    fibril_mutex_lock(&devices_list_mutex);
     /* Get unique device handle */
     device->handle = devmap_create_handle();
     device->driver = NULL;
     /* Insert device into list of all devices  */
     list_append(&device->devices, &devices_list);
+    fibril_mutex_unlock(&devices_list_mutex);
     return true;
+}
 /** Handle connection with device driver.
+ *
     bool cont = true;
     while (cont) {
         ipc_call_t call;
         ipc_callid_t callid = async_get_call(&call);
-        async_serialize_start();
         switch (IPC_GET_METHOD(call)) {
         case IPC_M_PHONE_HUNGUP:
             cont = false;
-            async_serialize_end();
             continue;
         case DEVMAP_DRIVER_UNREGISTER:
             if (NULL == driver)
                 ipc_answer_0(callid, ENOENT);
             else
             break;
         default:
             if (!(callid & IPC_CALLID_NOTIFICATION))
                 ipc_answer_0(callid, ENOENT);
+        }
-        async_serialize_end();
+    }
     if (NULL != driver) {
         /*
          * Unregister the device driver and all its devices.
          */
-        async_serialize_start();
         devmap_driver_unregister(driver);
         driver = NULL;
-        async_serialize_end();
+    }
+}
 /** Handle connection with device client.
+ *
     bool cont = true;
     while (cont) {
         ipc_call_t call;
         ipc_callid_t callid = async_get_call(&call);
-        async_serialize_start();
         switch (IPC_GET_METHOD(call)) {
         case IPC_M_PHONE_HUNGUP:
             cont = false;
-            async_serialize_end();
             continue;
         case DEVMAP_DEVICE_GET_HANDLE:
             devmap_get_handle(callid, &call);
             break;
         case DEVMAP_DEVICE_GET_NAME:
             break;
         default:
             if (!(callid & IPC_CALLID_NOTIFICATION))
                 ipc_answer_0(callid, ENOENT);
+        }
-        async_serialize_end();
+    }
+}
 /** Function for handling connections to devmap
+ *

Subversion Repositories HelenOS

(root)/trunk/uspace/srv/devmap/devmap.c – Rev 4458 → 4524