Changeset b25970f in mainline for uspace/drv/platform

Timestamp:

2018-10-29T14:11:39Z (7 years ago)

Author:

Jiri Svoboda <jiri@…>

Branches:

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

Children:

94ab1fee

Parents:

184f2f8a

git-author:

Jiri Svoboda <jiri@…> (2018-10-28 22:10:25)

git-committer:

Jiri Svoboda <jiri@…> (2018-10-29 14:11:39)

Message:

Fix ISA-only PC support.

File:

• uspace/drv/platform/pc/pc.c (modified) (5 diffs)

uspace/drv/platform/pc/pc.c

@@ -1 +1 @@
 /*
+ * Copyright (c) 2018 Jiri Svoboda
  * Copyright (c) 2010 Lenka Trochtova
  * All rights reserved.
@@ -93 +94 @@
 };
 
-static pc_fun_t pci_data = {
+static pc_fun_t sys_data = {
         .hw_resources = {
                 sizeof(pci_conf_regs) / sizeof(pci_conf_regs[0]),
@@ -151 +152 @@
 static ddf_dev_ops_t pc_fun_ops;
 
-static bool
-pc_add_fun(ddf_dev_t *dev, const char *name, const char *str_match_id,
-    pc_fun_t *fun_proto)
-{
-        ddf_msg(LVL_DEBUG, "Adding new function '%s'.", name);
-
+static errno_t pc_add_sysbus(ddf_dev_t *dev)
+{
         ddf_fun_t *fnode = NULL;
         errno_t rc;
 
+        ddf_msg(LVL_DEBUG, "Adding system bus.");
+
         /* Create new device. */
-        fnode = ddf_fun_create(dev, fun_inner, name);
-        if (fnode == NULL)
-                goto failure;
+        fnode = ddf_fun_create(dev, fun_inner, "sys");
+        if (fnode == NULL) {
+                rc = ENOMEM;
+                goto error;
+        }
 
         pc_fun_t *fun = ddf_fun_data_alloc(fnode, sizeof(pc_fun_t));
-        *fun = *fun_proto;
-
-        /* Add match ID */
-        rc = ddf_fun_add_match_id(fnode, str_match_id, 100);
+        *fun = sys_data;
+
+        /* Add match IDs */
+        rc = ddf_fun_add_match_id(fnode, "intel_pci", 100);
         if (rc != EOK)
-                goto failure;
+                goto error;
+
+        rc = ddf_fun_add_match_id(fnode, "isa", 10);
+        if (rc != EOK)
+                goto error;
 
         /* Set provided operations to the device. */
@@ -177 +182 @@
 
         /* Register function. */
-        if (ddf_fun_bind(fnode) != EOK) {
-                ddf_msg(LVL_ERROR, "Failed binding function %s.", name);
-                goto failure;
-        }
-
-        return true;
-
-failure:
+        rc = ddf_fun_bind(fnode);
+        if (rc != EOK) {
+                ddf_msg(LVL_ERROR, "Failed binding system bus function.");
+                goto error;
+        }
+
+        return EOK;
+
+error:
         if (fnode != NULL)
                 ddf_fun_destroy(fnode);
 
-        ddf_msg(LVL_ERROR, "Failed adding function '%s'.", name);
-
-        return false;
-}
-
-static bool pc_add_functions(ddf_dev_t *dev)
-{
-        return pc_add_fun(dev, "pci0", "intel_pci", &pci_data);
+        ddf_msg(LVL_ERROR, "Failed adding system bus.");
+        return rc;
+}
+
+static errno_t pc_add_functions(ddf_dev_t *dev)
+{
+        errno_t rc;
+
+        rc = pc_add_sysbus(dev);
+        if (rc != EOK)
+                return rc;
+
+        return EOK;
 }
 
@@ -206 +217 @@
 static errno_t pc_dev_add(ddf_dev_t *dev)
 {
+        errno_t rc;
+
         ddf_msg(LVL_DEBUG, "pc_dev_add, device handle = %d",
             (int)ddf_dev_get_handle(dev));
 
         /* Register functions. */
-        if (!pc_add_functions(dev)) {
+        rc = pc_add_functions(dev);
+        if (rc != EOK) {
                 ddf_msg(LVL_ERROR, "Failed to add functions for PC platform.");
+                return rc;
         }