Changes in uspace/srv/devman/drv_conn.c [fafb8e5:8300c72] in mainline

File:

• uspace/srv/devman/drv_conn.c (modified) (4 diffs)

uspace/srv/devman/drv_conn.c

@@ -1 +1 @@
 /*
+ * Copyright (c) 2025 Jiri Svoboda
  * Copyright (c) 2010 Lenka Trochtova
  * All rights reserved.
@@ -360 +361 @@
         rc = loc_category_get_id(cat_name, &cat_id, IPC_FLAG_BLOCKING);
         if (rc == EOK)
-                rc = loc_service_add_to_cat(fun->service_id, cat_id);
+                rc = loc_service_add_to_cat(devman_srv, fun->service_id, cat_id);
         if (rc == EOK) {
                 log_msg(LOG_DEFAULT, LVL_NOTE, "Function `%s' added to category `%s'.",
@@ -452 +453 @@
         fun_busy_unlock(fun);
         fun_del_ref(fun);
+        async_answer_0(icall, EOK);
+}
+
+/** Quiesce function by driver request.
+ *
+ */
+static void devman_drv_fun_quiesce(ipc_call_t *icall, driver_t *drv)
+{
+        fun_node_t *fun;
+        errno_t rc;
+
+        fun = find_fun_node(&device_tree, ipc_get_arg1(icall));
+        if (fun == NULL) {
+                async_answer_0(icall, ENOENT);
+                return;
+        }
+
+        fun_busy_lock(fun);
+
+        fibril_rwlock_write_lock(&device_tree.rwlock);
+        if (fun->dev == NULL || fun->dev->drv != drv) {
+                fun_busy_unlock(fun);
+                fun_del_ref(fun);
+                async_answer_0(icall, ENOENT);
+                return;
+        }
+        fibril_rwlock_write_unlock(&device_tree.rwlock);
+
+        rc = fun_quiesce(fun);
+        if (rc != EOK) {
+                fun_busy_unlock(fun);
+                fun_del_ref(fun);
+                async_answer_0(icall, rc);
+                return;
+        }
+
+        fun_busy_unlock(fun);
+        fun_del_ref(fun);
+        async_answer_0(icall, EOK);
+}
+
+/** Wait for function to become stable.
+ *
+ */
+static void devman_drv_fun_wait_stable(ipc_call_t *icall, driver_t *drv)
+{
+        fun_node_t *fun;
+        dev_node_t *dev;
+
+        fibril_rwlock_read_lock(&device_tree.rwlock);
+
+        fun = find_fun_node(&device_tree, ipc_get_arg1(icall));
+        if (fun == NULL) {
+                fibril_rwlock_read_unlock(&device_tree.rwlock);
+                async_answer_0(icall, ENOENT);
+                return;
+        }
+
+        if (fun->child == NULL) {
+                fibril_rwlock_read_unlock(&device_tree.rwlock);
+                fun_del_ref(fun);
+                async_answer_0(icall, EOK);
+                return;
+        }
+
+        dev = fun->child;
+        dev_add_ref(dev);
+
+        fibril_rwlock_read_unlock(&device_tree.rwlock);
+
+        dev_wait_stable(dev);
+        dev_del_ref(dev);
+
         async_answer_0(icall, EOK);
 }
@@ -641 +715 @@
                         devman_drv_fun_offline(&call, driver);
                         break;
+                case DEVMAN_DRV_FUN_QUIESCE:
+                        devman_drv_fun_quiesce(&call, driver);
+                        break;
+                case DEVMAN_DRV_FUN_WAIT_STABLE:
+                        devman_drv_fun_wait_stable(&call, driver);
+                        break;
                 case DEVMAN_REMOVE_FUNCTION:
                         devman_remove_function(&call);