Changeset 965dc18 in mainline for kernel/arch/sparc64/src/smp/smp.c

Timestamp:

2008-12-05T19:59:03Z (15 years ago)

Author:

Jakub Jermar <jakub@…>

Branches:

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

Children:

49093a4

Parents:

0258e67

Message:

Merge sparc branch to trunk.

File:

• kernel/arch/sparc64/src/smp/smp.c (modified) (4 diffs)

kernel/arch/sparc64/src/smp/smp.c

@@ -36 +36 @@
 #include <genarch/ofw/ofw_tree.h>
 #include <cpu.h>
+#include <arch/cpu_family.h>
 #include <arch/cpu.h>
 #include <arch.h>
@@ -44 +45 @@
 #include <synch/waitq.h>
 #include <print.h>
+#include <arch/cpu_node.h>
 
 /**
@@ -62 +64 @@
         count_t cnt = 0;
         
-        node = ofw_tree_find_child_by_device_type(ofw_tree_lookup("/"), "cpu");
-        while (node) {
-                cnt++;
-                node = ofw_tree_find_peer_by_device_type(node, "cpu");
+        if (is_us() || is_us_iii()) {
+                node = ofw_tree_find_child_by_device_type(cpus_parent(), "cpu");
+                while (node) {
+                        cnt++;
+                        node = ofw_tree_find_peer_by_device_type(node, "cpu");
+                }
+        } else if (is_us_iv()) {
+                node = ofw_tree_find_child(cpus_parent(), "cmp");
+                while (node) {
+                        cnt += 2;
+                        node = ofw_tree_find_peer_by_name(node, "cmp");
+                }
         }
         
         config.cpu_count = max(1, cnt);
+}
+
+/**
+ * Wakes up the CPU which is represented by the "node" OFW tree node.
+ * If "node" represents the current CPU, calling the function has
+ * no effect. 
+ */
+static void wakeup_cpu(ofw_tree_node_t *node)
+{
+        uint32_t mid;
+        ofw_tree_property_t *prop;
+                
+        /* 'upa-portid' for US, 'portid' for US-III, 'cpuid' for US-IV */
+        prop = ofw_tree_getprop(node, "upa-portid");
+        if ((!prop) || (!prop->value))
+                prop = ofw_tree_getprop(node, "portid");
+        if ((!prop) || (!prop->value))
+                prop = ofw_tree_getprop(node, "cpuid");
+                
+        if (!prop || prop->value == NULL)
+                return;
+                
+        mid = *((uint32_t *) prop->value);
+        if (CPU->arch.mid == mid)
+                return;
+
+        waking_up_mid = mid;
+                
+        if (waitq_sleep_timeout(&ap_completion_wq, 1000000, SYNCH_FLAGS_NONE) ==
+            ESYNCH_TIMEOUT)
+                printf("%s: waiting for processor (mid = %" PRIu32
+                    ") timed out\n", __func__, mid);
 }
 
@@ -77 +119 @@
         int i;
         
-        node = ofw_tree_find_child_by_device_type(ofw_tree_lookup("/"), "cpu");
-        for (i = 0; node; node = ofw_tree_find_peer_by_device_type(node, "cpu"), i++) {
-                uint32_t mid;
-                ofw_tree_property_t *prop;
-                
-                prop = ofw_tree_getprop(node, "upa-portid");
-                if (!prop || !prop->value)
-                        continue;
-                
-                mid = *((uint32_t *) prop->value);
-                if (CPU->arch.mid == mid) {
-                        /*
-                         * Skip the current CPU.
-                         */
-                        continue;
+        if (is_us() || is_us_iii()) {
+                node = ofw_tree_find_child_by_device_type(cpus_parent(), "cpu");
+                for (i = 0; node;
+                     node = ofw_tree_find_peer_by_device_type(node, "cpu"), i++)
+                        wakeup_cpu(node);
+        } else if (is_us_iv()) {
+                node = ofw_tree_find_child(cpus_parent(), "cmp");
+                while (node) {
+                        wakeup_cpu(ofw_tree_find_child(node, "cpu@0"));
+                        wakeup_cpu(ofw_tree_find_child(node, "cpu@1"));
+                        node = ofw_tree_find_peer_by_name(node, "cmp");
                 }
-
-                /*
-                 * Processor with ID == mid can proceed with its initialization.
-                 */
-                waking_up_mid = mid;
-                
-                if (waitq_sleep_timeout(&ap_completion_wq, 1000000, SYNCH_FLAGS_NONE) == ESYNCH_TIMEOUT)
-                        printf("%s: waiting for processor (mid = %" PRIu32 ") timed out\n",
-                            __func__, mid);
         }
 }