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

 #include <fibril_sync.h>
 #include <stdlib.h>
 #include <string.h>
 #include <ipc/devmap.h>
-#define NAME  "devmap"
+#define NAME          "devmap"
+#define NULL_DEVICES  256
 /** Representation of device driver.
+ *
  * Each driver is responsible for a set of devices.
+ *
 static FIBRIL_MUTEX_INITIALIZE(devices_list_mutex);
 static FIBRIL_CONDVAR_INITIALIZE(devices_list_cv);
 static FIBRIL_MUTEX_INITIALIZE(drivers_list_mutex);
 static FIBRIL_MUTEX_INITIALIZE(create_handle_mutex);
+static FIBRIL_MUTEX_INITIALIZE(null_devices_mutex);
 static dev_handle_t last_handle = 0;
+static devmap_device_t *null_devices[NULL_DEVICES];
 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_unlock(&devices_list_mutex);
     ipc_answer_1(iid, EOK, pos);
+}
-/** Initialize device mapper.
- *
- *
- */
-static bool devmap_init(void)
+static void devmap_null_create(ipc_callid_t iid, ipc_call_t *icall)
+{
+    fibril_mutex_lock(&null_devices_mutex);
+    unsigned int i;
+    bool fnd = false;
+    for (i = 0; i < NULL_DEVICES; i++) {
+        if (null_devices[i] == NULL) {
+            fnd = true;
+            break;
+        }
+    }
+    if (!fnd) {
+        fibril_mutex_unlock(&null_devices_mutex);
+        ipc_answer_0(iid, ENOMEM);
+        return;
+    }
     /* Create NULL device entry */
     devmap_device_t *device = (devmap_device_t *) malloc(sizeof(devmap_device_t));
-    if (device == NULL)
+    if (device == NULL) {
+        fibril_mutex_unlock(&null_devices_mutex);
+        ipc_answer_0(iid, ENOMEM);
-        return false;
+        return;
+    }
+    char null[DEVMAP_NAME_MAXLEN];
+    snprintf(null, DEVMAP_NAME_MAXLEN, "null%u", i);
-    device->name = str_dup("null");
+    device->name = str_dup(null);
     if (device->name == NULL) {
+        fibril_mutex_unlock(&null_devices_mutex);
         free(device);
+        ipc_answer_0(iid, ENOMEM);
-        return false;
+        return;
+    }
     list_initialize(&(device->devices));
     list_initialize(&(device->driver_devices));
     /* Get unique device handle */
     device->handle = devmap_create_handle();
     device->driver = NULL;
-    /* Insert device into list of all devices  */
+    /* Insert device into list of all devices
+       and into null devices array */
     list_append(&device->devices, &devices_list);
+    null_devices[i] = device;
     fibril_mutex_unlock(&devices_list_mutex);
+    fibril_mutex_unlock(&null_devices_mutex);
+    ipc_answer_1(iid, EOK, (ipcarg_t) i);
+}
+static void devmap_null_destroy(ipc_callid_t iid, ipc_call_t *icall)
+{
+    fibril_mutex_lock(&null_devices_mutex);
+    ipcarg_t i = IPC_GET_ARG1(*icall);
+    if (null_devices[i] == NULL) {
+        ipc_answer_0(iid, ENOENT);
+        return;
+    }
+    devmap_device_unregister_core(null_devices[i]);
+    null_devices[i] = NULL;
+    fibril_mutex_unlock(&null_devices_mutex);
+    ipc_answer_0(iid, EOK);
+}
+/** Initialize device mapper.
+ *
+ *
+ */
+static bool devmap_init(void)
+{
+    fibril_mutex_lock(&null_devices_mutex);
+    unsigned int i;
+    for (i = 0; i < NULL_DEVICES; i++)
+        null_devices[i] = NULL;
+    fibril_mutex_unlock(&null_devices_mutex);
     return true;
+}
 /** Handle connection with device driver.
             if (!(callid & IPC_CALLID_NOTIFICATION))
                 ipc_answer_0(callid, ENOENT);
+        }
+    }
-    if (NULL != driver) {
+    if (driver != NULL) {
         /*
          * Unregister the device driver and all its devices.
          */
         devmap_driver_unregister(driver);
         driver = NULL;
             devmap_get_handle(callid, &call);
             break;
         case DEVMAP_DEVICE_GET_NAME:
             devmap_get_name(callid, &call);
             break;
+        case DEVMAP_DEVICE_NULL_CREATE:
+            devmap_null_create(callid, &call);
+            break;
+        case DEVMAP_DEVICE_NULL_DESTROY:
+            devmap_null_destroy(callid, &call);
+            break;
         case DEVMAP_DEVICE_GET_COUNT:
             devmap_get_count(callid, &call);
             break;
         case DEVMAP_DEVICE_GET_DEVICES:
             devmap_get_devices(callid, &call);
         return -1;
+    }
     /* Set a handler of incomming connections */
     async_set_client_connection(devmap_connection);
     /* Register device mapper at naming service */
     ipcarg_t phonead;
     if (ipc_connect_to_me(PHONE_NS, SERVICE_DEVMAP, 0, 0, &phonead) != 0)
         return -1;

Subversion Repositories HelenOS

(root)//trunk/uspace/srv/devmap/devmap.c – Rev 4570 → 4591