Changeset b25970f in mainline for uspace/drv

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.

Location:

uspace/drv

Files:

• bus/isa/isa.c (modified) (3 diffs)
• bus/isa/isa.ma (modified) (1 diff)
• platform/pc/pc.c (modified) (5 diffs)

uspace/drv/bus/isa/isa.c

@@ -1 +1 @@
 /*
+ * Copyright (c) 2018 Jiri Svoboda
  * Copyright (c) 2010 Lenka Trochtova
- * Copyright (c) 2011 Jiri Svoboda
  * Copyright (c) 2011 Jan Vesely
  * All rights reserved.
@@ -697 +697 @@
 }
 
-static errno_t isa_dev_add(ddf_dev_t *dev)
-{
-        async_sess_t *sess;
+static errno_t isa_read_pci_cfg(isa_bus_t *isa, async_sess_t *sess)
+{
         errno_t rc;
-
-        ddf_msg(LVL_DEBUG, "isa_dev_add, device handle = %d",
-            (int) ddf_dev_get_handle(dev));
-
-        isa_bus_t *isa = ddf_dev_data_alloc(dev, sizeof(isa_bus_t));
-        if (isa == NULL)
-                return ENOMEM;
-
-        fibril_mutex_initialize(&isa->mutex);
-        isa->dev = dev;
-        list_initialize(&isa->functions);
-
-        sess = ddf_dev_parent_sess_get(dev);
-        if (sess == NULL) {
-                ddf_msg(LVL_ERROR, "isa_dev_add failed to connect to the "
-                    "parent driver.");
-                return ENOENT;
-        }
 
         rc = pci_config_space_read_16(sess, PCI_VENDOR_ID, &isa->pci_vendor_id);
@@ -733 +714 @@
                 return rc;
 
+        return EOK;
+}
+
+static errno_t isa_dev_add(ddf_dev_t *dev)
+{
+        async_sess_t *sess;
+        errno_t rc;
+
+        ddf_msg(LVL_DEBUG, "isa_dev_add, device handle = %d",
+            (int) ddf_dev_get_handle(dev));
+
+        isa_bus_t *isa = ddf_dev_data_alloc(dev, sizeof(isa_bus_t));
+        if (isa == NULL)
+                return ENOMEM;
+
+        fibril_mutex_initialize(&isa->mutex);
+        isa->dev = dev;
+        list_initialize(&isa->functions);
+
+        sess = ddf_dev_parent_sess_get(dev);
+        if (sess == NULL) {
+                ddf_msg(LVL_ERROR, "isa_dev_add failed to connect to the "
+                    "parent driver.");
+                return ENOENT;
+        }
+
+        rc = isa_read_pci_cfg(isa, sess);
+        if (rc != EOK) {
+                ddf_msg(LVL_NOTE, "Cannot read PCI config. Assuming ISA classic.");
+                isa->pci_vendor_id = 0;
+                isa->pci_device_id = 0;
+                isa->pci_class = BASE_CLASS_BRIDGE;
+                isa->pci_subclass = SUB_CLASS_BRIDGE_ISA;
+        }
+
         rc = pio_window_get(sess, &isa->pio_win);
         if (rc != EOK) {

uspace/drv/bus/isa/isa.ma

@@ +1 @@
+# Classic ISA
+10 isa
+
 # ISA bridge
 10 pci/class=06&subclass=01

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;
         }