Changeset d347b53 in mainline for uspace/srv/devman/main.c

Timestamp:

2010-03-21T19:33:58Z (15 years ago)

Author:

Lenka Trochtova <trochtova.lenka@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

66babbd

Parents:

bda60d9

Message:

child device registration - parts of code

File:

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

uspace/srv/devman/main.c

@@ -51 +51 @@
 #include <ctype.h>
 #include <ipc/devman.h>
+#include <thread.h>
 
 #include "devman.h"
@@ -96 +97 @@
                 return NULL;
         }
-        printf(NAME ": registering the running instance of the %s driver.\n", driver->name);
         
         // Create connection to the driver
@@ -123 +123 @@
 {
         printf(NAME ": devman_add_child\n");
-        
-        // TODO
-        
+
+        device_handle_t parent_handle = IPC_GET_ARG1(*call);
+        node_t *parent =  find_dev_node(&device_tree, parent_handle);
+        
+        if (NULL == parent) {
+                ipc_answer_0(callid, ENOENT);
+                return;
+        }
+        
+        char *dev_name = NULL;
+        int rc = async_string_receive(&dev_name, DEVMAN_NAME_MAXLEN, NULL);     
+        if (rc != EOK) {
+                ipc_answer_0(callid, rc);
+                return;
+        }
+        printf(NAME ": newly added child device's name is '%s'.\n", dev_name);
+        
+        node_t *node = create_dev_node();
+        if (!insert_dev_node(&device_tree, node, dev_name, parent)) {
+                delete_dev_node(node);
+                ipc_answer_0(callid, ENOMEM);
+                return;
+        }       
+        
+        // TODO match ids
+        
+        // return device handle to parent's driver
+        ipc_answer_1(callid, EOK, node->handle);
+        
+        // try to find suitable driver and assign it to the device      
+        assign_driver(node, &drivers_list);
+}
+
+static int init_running_drv(void *drv)
+{
+        driver_t *driver = (driver_t *)drv;
+        initialize_running_driver(driver);      
+        printf(NAME ": the %s driver was successfully initialized. \n", driver->name);
+        return 0;
 }
 
@@ -137 +173 @@
         
         driver_t *driver = devman_driver_register();
-        if (driver == NULL)
-                return;
-                
-        initialize_running_driver(driver);
+        if (NULL == driver)
+                return;
+        
+        fid_t fid = fibril_create(init_running_drv, driver);
+        if (fid == 0) {
+                printf(NAME ": Error creating fibril for the initialization of the newly registered running driver.\n");
+                exit(1);
+        }
+        fibril_add_ready(fid);
+        
+        /*thread_id_t tid;
+        if (0 != thread_create(init_running_drv, driver, "init_running_drv", &tid)) {
+                printf(NAME ": failed to start the initialization of the newly registered running driver.\n");
+        }*/
         
         ipc_callid_t callid;