Changes in uspace/lib/c/generic/devman.c [8b1e15ac:45059d6b] in mainline

File:

• uspace/lib/c/generic/devman.c (modified) (5 diffs)

uspace/lib/c/generic/devman.c

@@ -1 +1 @@
 /*
  * Copyright (c) 2007 Josef Cejka
- * Copyright (c) 2009 Jiri Svoboda
+ * Copyright (c) 2011 Jiri Svoboda
  * Copyright (c) 2010 Lenka Trochtova
  * All rights reserved.
@@ -35 +35 @@
  */
 
+#include <adt/list.h>
 #include <str.h>
-#include <stdio.h>
 #include <ipc/services.h>
+#include <ns.h>
 #include <ipc/devman.h>
 #include <devman.h>
+#include <fibril_synch.h>
 #include <async.h>
-#include <fibril_synch.h>
 #include <errno.h>
 #include <malloc.h>
 #include <bool.h>
-#include <adt/list.h>
-
-static int devman_phone_driver = -1;
-static int devman_phone_client = -1;
-
-static FIBRIL_MUTEX_INITIALIZE(devman_phone_mutex);
-
-int devman_get_phone(devman_interface_t iface, unsigned int flags)
+
+static FIBRIL_MUTEX_INITIALIZE(devman_driver_block_mutex);
+static FIBRIL_MUTEX_INITIALIZE(devman_client_block_mutex);
+
+static FIBRIL_MUTEX_INITIALIZE(devman_driver_mutex);
+static FIBRIL_MUTEX_INITIALIZE(devman_client_mutex);
+
+static async_sess_t *devman_driver_block_sess = NULL;
+static async_sess_t *devman_client_block_sess = NULL;
+
+static async_sess_t *devman_driver_sess = NULL;
+static async_sess_t *devman_client_sess = NULL;
+
+static void clone_session(fibril_mutex_t *mtx, async_sess_t *src,
+    async_sess_t **dst)
+{
+        fibril_mutex_lock(mtx);
+        
+        if ((*dst == NULL) && (src != NULL))
+                *dst = src;
+        
+        fibril_mutex_unlock(mtx);
+}
+
+/** Start an async exchange on the devman session (blocking).
+ *
+ * @param iface Device manager interface to choose
+ *
+ * @return New exchange.
+ *
+ */
+async_exch_t *devman_exchange_begin_blocking(devman_interface_t iface)
 {
         switch (iface) {
         case DEVMAN_DRIVER:
-                fibril_mutex_lock(&devman_phone_mutex);
-                if (devman_phone_driver >= 0) {
-                        fibril_mutex_unlock(&devman_phone_mutex);
-                        return devman_phone_driver;
+                fibril_mutex_lock(&devman_driver_block_mutex);
+                
+                while (devman_driver_block_sess == NULL) {
+                        clone_session(&devman_driver_mutex, devman_driver_sess,
+                            &devman_driver_block_sess);
+                        
+                        if (devman_driver_block_sess == NULL)
+                                devman_driver_block_sess =
+                                    service_connect_blocking(EXCHANGE_SERIALIZE,
+                                    SERVICE_DEVMAN, DEVMAN_DRIVER, 0);
                 }
                 
-                if (flags & IPC_FLAG_BLOCKING)
-                        devman_phone_driver = async_connect_me_to_blocking(
-                            PHONE_NS, SERVICE_DEVMAN, DEVMAN_DRIVER, 0);
-                else
-                        devman_phone_driver = async_connect_me_to(PHONE_NS,
-                            SERVICE_DEVMAN, DEVMAN_DRIVER, 0);
-                
-                fibril_mutex_unlock(&devman_phone_mutex);
-                return devman_phone_driver;
+                fibril_mutex_unlock(&devman_driver_block_mutex);
+                
+                clone_session(&devman_driver_mutex, devman_driver_block_sess,
+                    &devman_driver_sess);
+                
+                return async_exchange_begin(devman_driver_block_sess);
         case DEVMAN_CLIENT:
-                fibril_mutex_lock(&devman_phone_mutex);
-                if (devman_phone_client >= 0) {
-                        fibril_mutex_unlock(&devman_phone_mutex);
-                        return devman_phone_client;
+                fibril_mutex_lock(&devman_client_block_mutex);
+                
+                while (devman_client_block_sess == NULL) {
+                        clone_session(&devman_client_mutex, devman_client_sess,
+                            &devman_client_block_sess);
+                        
+                        if (devman_client_block_sess == NULL)
+                                devman_client_block_sess =
+                                    service_connect_blocking(EXCHANGE_SERIALIZE,
+                                    SERVICE_DEVMAN, DEVMAN_CLIENT, 0);
                 }
                 
-                if (flags & IPC_FLAG_BLOCKING) {
-                        devman_phone_client = async_connect_me_to_blocking(
-                            PHONE_NS, SERVICE_DEVMAN, DEVMAN_CLIENT, 0);
-                } else {
-                        devman_phone_client = async_connect_me_to(PHONE_NS,
-                            SERVICE_DEVMAN, DEVMAN_CLIENT, 0);
-                }
-                
-                fibril_mutex_unlock(&devman_phone_mutex);
-                return devman_phone_client;
+                fibril_mutex_unlock(&devman_client_block_mutex);
+                
+                clone_session(&devman_client_mutex, devman_client_block_sess,
+                    &devman_client_sess);
+                
+                return async_exchange_begin(devman_client_block_sess);
         default:
-                return -1;
-        }
+                return NULL;
+        }
+}
+
+/** Start an async exchange on the devman session.
+ *
+ * @param iface Device manager interface to choose
+ *
+ * @return New exchange.
+ *
+ */
+async_exch_t *devman_exchange_begin(devman_interface_t iface)
+{
+        switch (iface) {
+        case DEVMAN_DRIVER:
+                fibril_mutex_lock(&devman_driver_mutex);
+                
+                if (devman_driver_sess == NULL)
+                        devman_driver_sess =
+                            service_connect(EXCHANGE_SERIALIZE, SERVICE_DEVMAN,
+                            DEVMAN_DRIVER, 0);
+                
+                fibril_mutex_unlock(&devman_driver_mutex);
+                
+                if (devman_driver_sess == NULL)
+                        return NULL;
+                
+                return async_exchange_begin(devman_driver_sess);
+        case DEVMAN_CLIENT:
+                fibril_mutex_lock(&devman_client_mutex);
+                
+                if (devman_client_sess == NULL)
+                        devman_client_sess =
+                            service_connect(EXCHANGE_SERIALIZE, SERVICE_DEVMAN,
+                            DEVMAN_CLIENT, 0);
+                
+                fibril_mutex_unlock(&devman_client_mutex);
+                
+                if (devman_client_sess == NULL)
+                        return NULL;
+                
+                return async_exchange_begin(devman_client_sess);
+        default:
+                return NULL;
+        }
+}
+
+/** Finish an async exchange on the devman session.
+ *
+ * @param exch Exchange to be finished.
+ *
+ */
+void devman_exchange_end(async_exch_t *exch)
+{
+        async_exchange_end(exch);
 }
 
@@ -96 +179 @@
 int devman_driver_register(const char *name, async_client_conn_t conn)
 {
-        int phone = devman_get_phone(DEVMAN_DRIVER, IPC_FLAG_BLOCKING);
-        
-        if (phone < 0)
-                return phone;
-        
-        async_serialize_start();
+        async_exch_t *exch = devman_exchange_begin_blocking(DEVMAN_DRIVER);
         
         ipc_call_t answer;
-        aid_t req = async_send_2(phone, DEVMAN_DRIVER_REGISTER, 0, 0, &answer);
-        
-        sysarg_t retval = async_data_write_start(phone, name, str_size(name));
+        aid_t req = async_send_2(exch, DEVMAN_DRIVER_REGISTER, 0, 0, &answer);
+        sysarg_t retval = async_data_write_start(exch, name, str_size(name));
+        
+        devman_exchange_end(exch);
+        
         if (retval != EOK) {
                 async_wait_for(req, NULL);
-                async_serialize_end();
-                return -1;
+                return retval;
         }
         
         async_set_client_connection(conn);
         
-        async_connect_to_me(phone, 0, 0, 0, NULL);
+        exch = devman_exchange_begin(DEVMAN_DRIVER);
+        async_connect_to_me(exch, 0, 0, 0, conn, NULL);
+        devman_exchange_end(exch);
+        
         async_wait_for(req, &retval);
-        
-        async_serialize_end();
-        
         return retval;
-}
-
-static int devman_send_match_id(int phone, match_id_t *match_id)
-{
-        ipc_call_t answer;
-
-        aid_t req = async_send_1(phone, DEVMAN_ADD_MATCH_ID, match_id->score,
-            &answer);
-        int retval = async_data_write_start(phone, match_id->id,
-            str_size(match_id->id));
-
-        async_wait_for(req, NULL);
-        return retval;
-}
-
-
-static int devman_send_match_ids(int phone, match_id_list_t *match_ids)
-{
-        link_t *link = match_ids->ids.next;
-        match_id_t *match_id = NULL;
-        int ret = EOK;
-
-        while (link != &match_ids->ids) {
-                match_id = list_get_instance(link, match_id_t, link); 
-                ret = devman_send_match_id(phone, match_id);
-                if (ret != EOK) {
-                        printf("Driver failed to send match id, error %d\n",
-                            ret);
-                        return ret;
-                }
-
-                link = link->next;
-        }
-
-        return ret;
 }
 
@@ -163 +207 @@
  * this driver task.
  *
- * @param name          Name of the new function
- * @param ftype         Function type, fun_inner or fun_exposed
- * @param match_ids     Match IDs (should be empty for fun_exposed)
- * @param devh          Devman handle of the device
- * @param funh          Place to store handle of the new function
- *
- * @return              EOK on success or negative error code.
+ * @param name      Name of the new function
+ * @param ftype     Function type, fun_inner or fun_exposed
+ * @param match_ids Match IDs (should be empty for fun_exposed)
+ * @param devh      Devman handle of the device
+ * @param funh      Place to store handle of the new function
+ *
+ * @return EOK on success or negative error code.
+ *
  */
 int devman_add_function(const char *name, fun_type_t ftype,
     match_id_list_t *match_ids, devman_handle_t devh, devman_handle_t *funh)
 {
-        int phone = devman_get_phone(DEVMAN_DRIVER, IPC_FLAG_BLOCKING);
-        int fun_handle;
-        
-        if (phone < 0)
-                return phone;
-        
-        async_serialize_start();
-        
         int match_count = list_count(&match_ids->ids);
+        async_exch_t *exch = devman_exchange_begin_blocking(DEVMAN_DRIVER);
+        
         ipc_call_t answer;
-
-        aid_t req = async_send_3(phone, DEVMAN_ADD_FUNCTION, (sysarg_t) ftype,
+        aid_t req = async_send_3(exch, DEVMAN_ADD_FUNCTION, (sysarg_t) ftype,
             devh, match_count, &answer);
-
-        sysarg_t retval = async_data_write_start(phone, name, str_size(name));
+        sysarg_t retval = async_data_write_start(exch, name, str_size(name));
+        if (retval != EOK) {
+                devman_exchange_end(exch);
+                async_wait_for(req, NULL);
+                return retval;
+        }
+        
+        match_id_t *match_id = NULL;
+        
+        list_foreach(match_ids->ids, link) {
+                match_id = list_get_instance(link, match_id_t, link);
+                
+                ipc_call_t answer2;
+                aid_t req2 = async_send_1(exch, DEVMAN_ADD_MATCH_ID,
+                    match_id->score, &answer2);
+                retval = async_data_write_start(exch, match_id->id,
+                    str_size(match_id->id));
+                if (retval != EOK) {
+                        devman_exchange_end(exch);
+                        async_wait_for(req2, NULL);
+                        async_wait_for(req, NULL);
+                        return retval;
+                }
+                
+                async_wait_for(req2, &retval);
+                if (retval != EOK) {
+                        devman_exchange_end(exch);
+                        async_wait_for(req, NULL);
+                        return retval;
+                }
+        }
+        
+        devman_exchange_end(exch);
+        
+        async_wait_for(req, &retval);
+        if (retval == EOK) {
+                if (funh != NULL)
+                        *funh = (int) IPC_GET_ARG1(answer);
+        } else {
+                if (funh != NULL)
+                        *funh = -1;
+        }
+        
+        return retval;
+}
+
+int devman_add_device_to_category(devman_handle_t devman_handle,
+    const char *cat_name)
+{
+        async_exch_t *exch = devman_exchange_begin_blocking(DEVMAN_DRIVER);
+        
+        ipc_call_t answer;
+        aid_t req = async_send_1(exch, DEVMAN_ADD_DEVICE_TO_CATEGORY,
+            devman_handle, &answer);
+        sysarg_t retval = async_data_write_start(exch, cat_name,
+            str_size(cat_name));
+        
+        devman_exchange_end(exch);
+        
         if (retval != EOK) {
                 async_wait_for(req, NULL);
-                async_serialize_end();
-                return retval;
-        }
-        
-        devman_send_match_ids(phone, match_ids);
+                return retval;
+        }
         
         async_wait_for(req, &retval);
-        
-        async_serialize_end();
-        
-        if (retval == EOK)
-                fun_handle = (int) IPC_GET_ARG1(answer);
+        return retval;
+}
+
+async_sess_t *devman_device_connect(exch_mgmt_t mgmt, devman_handle_t handle,
+    unsigned int flags)
+{
+        async_sess_t *sess;
+        
+        if (flags & IPC_FLAG_BLOCKING)
+                sess = service_connect_blocking(mgmt, SERVICE_DEVMAN,
+                            DEVMAN_CONNECT_TO_DEVICE, handle);
         else
-                fun_handle = -1;
-        
-        *funh = fun_handle;
-
-        return retval;
-}
-
-int devman_add_device_to_class(devman_handle_t devman_handle,
-    const char *class_name)
-{
-        int phone = devman_get_phone(DEVMAN_DRIVER, IPC_FLAG_BLOCKING);
-        
-        if (phone < 0)
-                return phone;
-        
-        async_serialize_start();
+                sess = service_connect(mgmt, SERVICE_DEVMAN,
+                            DEVMAN_CONNECT_TO_DEVICE, handle);
+        
+        return sess;
+}
+
+/** Remove function from device.
+ *
+ * Request devman to remove function owned by this driver task.
+ * @param funh      Devman handle of the function
+ *
+ * @return EOK on success or negative error code.
+ */
+int devman_remove_function(devman_handle_t funh)
+{
+        async_exch_t *exch;
+        sysarg_t retval;
+        
+        exch = devman_exchange_begin_blocking(DEVMAN_DRIVER);
+        retval = async_req_1_0(exch, DEVMAN_REMOVE_FUNCTION, (sysarg_t) funh);
+        devman_exchange_end(exch);
+        
+        return (int) retval;
+}
+
+async_sess_t *devman_parent_device_connect(exch_mgmt_t mgmt,
+    devman_handle_t handle, unsigned int flags)
+{
+        async_sess_t *sess;
+        
+        if (flags & IPC_FLAG_BLOCKING)
+                sess = service_connect_blocking(mgmt, SERVICE_DEVMAN,
+                            DEVMAN_CONNECT_TO_PARENTS_DEVICE, handle);
+        else
+                sess = service_connect(mgmt, SERVICE_DEVMAN,
+                            DEVMAN_CONNECT_TO_PARENTS_DEVICE, handle);
+        
+        return sess;
+}
+
+int devman_fun_get_handle(const char *pathname, devman_handle_t *handle,
+    unsigned int flags)
+{
+        async_exch_t *exch;
+        
+        if (flags & IPC_FLAG_BLOCKING)
+                exch = devman_exchange_begin_blocking(DEVMAN_CLIENT);
+        else {
+                exch = devman_exchange_begin(DEVMAN_CLIENT);
+                if (exch == NULL)
+                        return ENOMEM;
+        }
+        
         ipc_call_t answer;
-        aid_t req = async_send_1(phone, DEVMAN_ADD_DEVICE_TO_CLASS,
-            devman_handle, &answer);
-        
-        sysarg_t retval = async_data_write_start(phone, class_name,
-            str_size(class_name));
+        aid_t req = async_send_2(exch, DEVMAN_DEVICE_GET_HANDLE, flags, 0,
+            &answer);
+        sysarg_t retval = async_data_write_start(exch, pathname,
+            str_size(pathname));
+        
+        devman_exchange_end(exch);
+        
         if (retval != EOK) {
                 async_wait_for(req, NULL);
-                async_serialize_end();
                 return retval;
         }
         
         async_wait_for(req, &retval);
-        async_serialize_end();
-        
-        return retval;
-}
-
-void devman_hangup_phone(devman_interface_t iface)
-{
-        switch (iface) {
-        case DEVMAN_DRIVER:
-                if (devman_phone_driver >= 0) {
-                        async_hangup(devman_phone_driver);
-                        devman_phone_driver = -1;
-                }
-                break;
-        case DEVMAN_CLIENT:
-                if (devman_phone_client >= 0) {
-                        async_hangup(devman_phone_client);
-                        devman_phone_client = -1;
-                }
-                break;
-        default:
-                break;
-        }
-}
-
-int devman_device_connect(devman_handle_t handle, unsigned int flags)
-{
-        int phone;
-        
-        if (flags & IPC_FLAG_BLOCKING) {
-                phone = async_connect_me_to_blocking(PHONE_NS, SERVICE_DEVMAN,
-                    DEVMAN_CONNECT_TO_DEVICE, handle);
-        } else {
-                phone = async_connect_me_to(PHONE_NS, SERVICE_DEVMAN,
-                    DEVMAN_CONNECT_TO_DEVICE, handle);
-        }
-        
-        return phone;
-}
-
-int devman_parent_device_connect(devman_handle_t handle, unsigned int flags)
-{
-        int phone;
-        
-        if (flags & IPC_FLAG_BLOCKING) {
-                phone = async_connect_me_to_blocking(PHONE_NS, SERVICE_DEVMAN,
-                    DEVMAN_CONNECT_TO_PARENTS_DEVICE, handle);
-        } else {
-                phone = async_connect_me_to(PHONE_NS, SERVICE_DEVMAN,
-                    DEVMAN_CONNECT_TO_PARENTS_DEVICE, handle);
-        }
-        
-        return phone;
-}
-
-int devman_device_get_handle(const char *pathname, devman_handle_t *handle,
-    unsigned int flags)
-{
-        int phone = devman_get_phone(DEVMAN_CLIENT, flags);
-        
-        if (phone < 0)
-                return phone;
-        
-        async_serialize_start();
-        
-        ipc_call_t answer;
-        aid_t req = async_send_2(phone, DEVMAN_DEVICE_GET_HANDLE, flags, 0,
-            &answer);
-        
-        sysarg_t retval = async_data_write_start(phone, pathname,
-            str_size(pathname));
-        if (retval != EOK) {
-                async_wait_for(req, NULL);
-                async_serialize_end();
-                return retval;
-        }
-        
-        async_wait_for(req, &retval);
-        
-        async_serialize_end();
         
         if (retval != EOK) {
                 if (handle != NULL)
                         *handle = (devman_handle_t) -1;
+                
                 return retval;
         }
@@ -326 +383 @@
 }
 
+static int devman_get_str_internal(sysarg_t method, sysarg_t arg1, char *buf,
+    size_t buf_size)
+{
+        async_exch_t *exch;
+        ipc_call_t dreply;
+        size_t act_size;
+        sysarg_t dretval;
+        
+        exch = devman_exchange_begin_blocking(LOC_PORT_CONSUMER);
+        
+        ipc_call_t answer;
+        aid_t req = async_send_1(exch, method, arg1, &answer);
+        aid_t dreq = async_data_read(exch, buf, buf_size - 1, &dreply);
+        async_wait_for(dreq, &dretval);
+        
+        devman_exchange_end(exch);
+        
+        if (dretval != EOK) {
+                async_wait_for(req, NULL);
+                return dretval;
+        }
+        
+        sysarg_t retval;
+        async_wait_for(req, &retval);
+        
+        if (retval != EOK)
+                return retval;
+        
+        act_size = IPC_GET_ARG2(dreply);
+        assert(act_size <= buf_size - 1);
+        buf[act_size] = '\0';
+        
+        return EOK;
+}
+
+int devman_fun_get_path(devman_handle_t handle, char *buf, size_t buf_size)
+{
+        return devman_get_str_internal(DEVMAN_FUN_GET_PATH, handle, buf,
+            buf_size);
+}
+
+int devman_fun_get_name(devman_handle_t handle, char *buf, size_t buf_size)
+{
+        return devman_get_str_internal(DEVMAN_FUN_GET_NAME, handle, buf,
+            buf_size);
+}
+
+static int devman_get_handles_once(sysarg_t method, sysarg_t arg1,
+    devman_handle_t *handle_buf, size_t buf_size, size_t *act_size)
+{
+        async_exch_t *exch = devman_exchange_begin_blocking(DEVMAN_CLIENT);
+
+        ipc_call_t answer;
+        aid_t req = async_send_1(exch, method, arg1, &answer);
+        int rc = async_data_read_start(exch, handle_buf, buf_size);
+        
+        devman_exchange_end(exch);
+        
+        if (rc != EOK) {
+                async_wait_for(req, NULL);
+                return rc;
+        }
+        
+        sysarg_t retval;
+        async_wait_for(req, &retval);
+        
+        if (retval != EOK) {
+                return retval;
+        }
+        
+        *act_size = IPC_GET_ARG1(answer);
+        return EOK;
+}
+
+/** Get list of handles.
+ *
+ * Returns an allocated array of handles.
+ *
+ * @param method        IPC method
+ * @param arg1          IPC argument 1
+ * @param data          Place to store pointer to array of handles
+ * @param count         Place to store number of handles
+ * @return              EOK on success or negative error code
+ */
+static int devman_get_handles_internal(sysarg_t method, sysarg_t arg1,
+    devman_handle_t **data, size_t *count)
+{
+        devman_handle_t *handles;
+        size_t act_size;
+        size_t alloc_size;
+        int rc;
+
+        *data = NULL;
+        act_size = 0;   /* silence warning */
+
+        rc = devman_get_handles_once(method, arg1, NULL, 0,
+            &act_size);
+        if (rc != EOK)
+                return rc;
+
+        alloc_size = act_size;
+        handles = malloc(alloc_size);
+        if (handles == NULL)
+                return ENOMEM;
+
+        while (true) {
+                rc = devman_get_handles_once(method, arg1, handles, alloc_size,
+                    &act_size);
+                if (rc != EOK)
+                        return rc;
+
+                if (act_size <= alloc_size)
+                        break;
+
+                alloc_size *= 2;
+                free(handles);
+
+                handles = malloc(alloc_size);
+                if (handles == NULL)
+                        return ENOMEM;
+        }
+
+        *count = act_size / sizeof(devman_handle_t);
+        *data = handles;
+        return EOK;
+}
+
+int devman_fun_get_child(devman_handle_t funh, devman_handle_t *devh)
+{
+        async_exch_t *exch = devman_exchange_begin(DEVMAN_CLIENT);
+        if (exch == NULL)
+                return ENOMEM;
+        
+        sysarg_t retval = async_req_1_1(exch, DEVMAN_FUN_GET_CHILD,
+            funh, devh);
+        
+        devman_exchange_end(exch);
+        return (int) retval;
+}
+
+int devman_dev_get_functions(devman_handle_t devh, devman_handle_t **funcs,
+    size_t *count)
+{
+        return devman_get_handles_internal(DEVMAN_DEV_GET_FUNCTIONS,
+            devh, funcs, count);
+}
+
+int devman_fun_sid_to_handle(service_id_t sid, devman_handle_t *handle)
+{
+        async_exch_t *exch = devman_exchange_begin(DEVMAN_CLIENT);
+        if (exch == NULL)
+                return ENOMEM;
+        
+        sysarg_t retval = async_req_1_1(exch, DEVMAN_FUN_SID_TO_HANDLE,
+            sid, handle);
+        
+        devman_exchange_end(exch);
+        return (int) retval;
+}
 
 /** @}