Subversion Repositories HelenOS

Rev

Rev 3386 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 3386 Rev 4153
Line 33... Line 33...
33
 */
33
 */
34
 
34
 
35
#include <smp/smp.h>
35
#include <smp/smp.h>
36
#include <genarch/ofw/ofw_tree.h>
36
#include <genarch/ofw/ofw_tree.h>
37
#include <cpu.h>
37
#include <cpu.h>
-
 
38
#include <arch/cpu_family.h>
38
#include <arch/cpu.h>
39
#include <arch/cpu.h>
39
#include <arch.h>
40
#include <arch.h>
40
#include <config.h>
41
#include <config.h>
41
#include <macros.h>
42
#include <macros.h>
42
#include <arch/types.h>
43
#include <arch/types.h>
43
#include <synch/synch.h>
44
#include <synch/synch.h>
44
#include <synch/waitq.h>
45
#include <synch/waitq.h>
45
#include <print.h>
46
#include <print.h>
-
 
47
#include <arch/cpu_node.h>
46
 
48
 
47
/**
49
/**
48
 * This global variable is used to pick-up application processors
50
 * This global variable is used to pick-up application processors
49
 * from their active loop in start.S. When a processor looping in
51
 * from their active loop in start.S. When a processor looping in
50
 * start.S sees that this variable contains its MID, it can
52
 * start.S sees that this variable contains its MID, it can
Line 59... Line 61...
59
void smp_init(void)
61
void smp_init(void)
60
{
62
{
61
    ofw_tree_node_t *node;
63
    ofw_tree_node_t *node;
62
    count_t cnt = 0;
64
    count_t cnt = 0;
63
   
65
   
-
 
66
    if (is_us() || is_us_iii()) {
64
    node = ofw_tree_find_child_by_device_type(ofw_tree_lookup("/"), "cpu");
67
        node = ofw_tree_find_child_by_device_type(cpus_parent(), "cpu");
65
    while (node) {
68
        while (node) {
66
        cnt++;
69
            cnt++;
67
        node = ofw_tree_find_peer_by_device_type(node, "cpu");
70
            node = ofw_tree_find_peer_by_device_type(node, "cpu");
-
 
71
        }
-
 
72
    } else if (is_us_iv()) {
-
 
73
        node = ofw_tree_find_child(cpus_parent(), "cmp");
-
 
74
        while (node) {
-
 
75
            cnt += 2;
-
 
76
            node = ofw_tree_find_peer_by_name(node, "cmp");
-
 
77
        }
68
    }
78
    }
69
   
79
   
70
    config.cpu_count = max(1, cnt);
80
    config.cpu_count = max(1, cnt);
71
}
81
}
72
 
82
 
-
 
83
/**
-
 
84
 * Wakes up the CPU which is represented by the "node" OFW tree node.
-
 
85
 * If "node" represents the current CPU, calling the function has
-
 
86
 * no effect.
-
 
87
 */
-
 
88
static void wakeup_cpu(ofw_tree_node_t *node)
-
 
89
{
-
 
90
    uint32_t mid;
-
 
91
    ofw_tree_property_t *prop;
-
 
92
       
-
 
93
    /* 'upa-portid' for US, 'portid' for US-III, 'cpuid' for US-IV */
-
 
94
    prop = ofw_tree_getprop(node, "upa-portid");
-
 
95
    if ((!prop) || (!prop->value))
-
 
96
        prop = ofw_tree_getprop(node, "portid");
-
 
97
    if ((!prop) || (!prop->value))
-
 
98
        prop = ofw_tree_getprop(node, "cpuid");
-
 
99
       
-
 
100
    if (!prop || prop->value == NULL)
-
 
101
        return;
-
 
102
       
-
 
103
    mid = *((uint32_t *) prop->value);
-
 
104
    if (CPU->arch.mid == mid)
-
 
105
        return;
-
 
106
 
-
 
107
    waking_up_mid = mid;
-
 
108
       
-
 
109
    if (waitq_sleep_timeout(&ap_completion_wq, 1000000, SYNCH_FLAGS_NONE) ==
-
 
110
        ESYNCH_TIMEOUT)
-
 
111
        printf("%s: waiting for processor (mid = %" PRIu32
-
 
112
            ") timed out\n", __func__, mid);
-
 
113
}
-
 
114
 
73
/** Wake application processors up. */
115
/** Wake application processors up. */
74
void kmp(void *arg)
116
void kmp(void *arg)
75
{
117
{
76
    ofw_tree_node_t *node;
118
    ofw_tree_node_t *node;
77
    int i;
119
    int i;
78
   
120
   
-
 
121
    if (is_us() || is_us_iii()) {
79
    node = ofw_tree_find_child_by_device_type(ofw_tree_lookup("/"), "cpu");
122
        node = ofw_tree_find_child_by_device_type(cpus_parent(), "cpu");
-
 
123
        for (i = 0; node;
80
    for (i = 0; node; node = ofw_tree_find_peer_by_device_type(node, "cpu"), i++) {
124
                     node = ofw_tree_find_peer_by_device_type(node, "cpu"), i++)
81
        uint32_t mid;
125
            wakeup_cpu(node);
82
        ofw_tree_property_t *prop;
126
    } else if (is_us_iv()) {
83
       
-
 
84
        prop = ofw_tree_getprop(node, "upa-portid");
127
        node = ofw_tree_find_child(cpus_parent(), "cmp");
85
        if (!prop || !prop->value)
-
 
86
            continue;
128
        while (node) {
87
       
-
 
88
        mid = *((uint32_t *) prop->value);
129
            wakeup_cpu(ofw_tree_find_child(node, "cpu@0"));
89
        if (CPU->arch.mid == mid) {
130
            wakeup_cpu(ofw_tree_find_child(node, "cpu@1"));
90
            /*
-
 
91
             * Skip the current CPU.
131
            node = ofw_tree_find_peer_by_name(node, "cmp");
92
             */
-
 
93
            continue;
-
 
94
        }
132
        }
95
 
-
 
96
        /*
-
 
97
         * Processor with ID == mid can proceed with its initialization.
-
 
98
         */
-
 
99
        waking_up_mid = mid;
-
 
100
       
-
 
101
        if (waitq_sleep_timeout(&ap_completion_wq, 1000000, SYNCH_FLAGS_NONE) == ESYNCH_TIMEOUT)
-
 
102
            printf("%s: waiting for processor (mid = %" PRIu32 ") timed out\n",
-
 
103
                __func__, mid);
-
 
104
    }
133
    }
105
}
134
}
106
 
135
 
107
/** @}
136
/** @}
108
 */
137
 */