Subversion Repositories HelenOS

Rev

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

Rev 3582 Rev 3591
Line 56... Line 56...
56
int ofw_translate_failed(ofw_arg_t flag)
56
int ofw_translate_failed(ofw_arg_t flag)
57
{
57
{
58
    return flag != -1;
58
    return flag != -1;
59
}
59
}
60
 
60
 
-
 
61
/**
-
 
62
 * Starts all CPUs represented by following siblings of the given node,
-
 
63
 * except for the current CPU.
-
 
64
 *
-
 
65
 * @param child the first child of the OFW tree node whose children represent
-
 
66
 *      CPUs to be woken up
-
 
67
 * @param current_mid   MID of the current CPU, the current CPU will
-
 
68
 *          (of course) not be woken up
-
 
69
 * @return  number of CPUs which have the same parent node as "child"
-
 
70
 */
61
static int wake_cpus_in_node(phandle child, uint64_t current_mid)
71
static int wake_cpus_in_node(phandle child, uint64_t current_mid)
62
{
72
{
63
    int cpus;
73
    int cpus;
64
    char type_name[BUF_SIZE];
74
    char type_name[BUF_SIZE];
65
   
75
   
Line 85... Line 95...
85
                   
95
                   
86
                if (current_mid != mid) {
96
                if (current_mid != mid) {
87
                    /*
97
                    /*
88
                     * Start secondary processor.
98
                     * Start secondary processor.
89
                     */
99
                     */
90
                    printf("Starting CPU: %d.\n", mid);
-
 
91
                    (void) ofw_call("SUNW,start-cpu", 3, 1,
100
                    (void) ofw_call("SUNW,start-cpu", 3, 1,
92
                        NULL, child, KERNEL_VIRTUAL_ADDRESS,
101
                        NULL, child, KERNEL_VIRTUAL_ADDRESS,
93
                        bootinfo.physmem_start |
102
                        bootinfo.physmem_start |
94
                        AP_PROCESSOR);
103
                        AP_PROCESSOR);
95
                }
104
                }
Line 98... Line 107...
98
    }
107
    }
99
 
108
 
100
    return cpus;
109
    return cpus;
101
}
110
}
102
 
111
 
-
 
112
/**
-
 
113
 * Finds out the current CPU's MID and wakes up all AP processors.
-
 
114
 */
103
int ofw_cpu(void)
115
int ofw_cpu(void)
104
{
116
{
105
    int cpus;
117
    int cpus;
106
    phandle node;
118
    phandle node;
107
    phandle subnode;
119
    phandle subnode;
108
    phandle ssm;
120
    phandle cpus_parent;
109
    phandle cmp;
121
    phandle cmp;
110
    char name[BUF_SIZE];
122
    char name[BUF_SIZE];
111
 
123
 
112
    /* get the current CPU MID */
124
    /* get the current CPU MID */
113
    uint64_t current_mid;
125
    uint64_t current_mid;
Line 125... Line 137...
125
        printf("MID format unknown for this subarchitecture.");
137
        printf("MID format unknown for this subarchitecture.");
126
        return 0;
138
        return 0;
127
    }
139
    }
128
 
140
 
129
    /* wake up CPUs */
141
    /* wake up CPUs */
-
 
142
   
130
    ssm = ofw_find_device("/ssm@0,0");
143
    cpus_parent = ofw_find_device("/ssm@0,0");
131
    if (ssm == -1) {
144
    if (cpus_parent == 0 || cpus_parent == -1) {
132
        node = ofw_get_child_node(ofw_root);
145
        cpus_parent = ofw_find_device("/");
133
        cpus = wake_cpus_in_node(node, current_mid);
-
 
134
    } else {
146
    }
-
 
147
 
135
        node = ofw_get_child_node(ssm);
148
    node = ofw_get_child_node(cpus_parent);
136
        cpus = wake_cpus_in_node(node, current_mid);
149
    cpus = wake_cpus_in_node(node, current_mid);
137
        while (node != 0 && node != -1) {
150
    while (node != 0 && node != -1) {
138
            if (ofw_get_property(node, "name", name,
151
        if (ofw_get_property(node, "name", name,
139
                sizeof(name)) > 0) {
152
            sizeof(name)) > 0) {
140
                if (strcmp(name, "cmp") == 0) {
153
            if (strcmp(name, "cmp") == 0) {
141
                    printf("nasel jsem dalsi CPU");
-
 
142
                    subnode = ofw_get_child_node(node);
154
                subnode = ofw_get_child_node(node);
143
                    cpus += wake_cpus_in_node(subnode,
155
                cpus += wake_cpus_in_node(subnode,
144
                        current_mid);
156
                    current_mid);
145
                }
-
 
146
            }
157
            }
-
 
158
        }
147
            node = ofw_get_peer_node(node);
159
        node = ofw_get_peer_node(node);
148
        }    
-
 
149
    }
160
    }
150
   
161
   
151
    return cpus;
162
    return cpus;
152
   
163
   
153
}
164
}