WebSVN – HelenOS – Diff – /branches/sparc/boot/arch/sparc64/loader/ofwarch.c


/*
 * Copyright (c) 2005 Martin Decky
 * Copyright (c) 2006 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/**
 * @file
 * @brief   Architecture dependent parts of OpenFirmware interface.
 */
 
#include <ofwarch.h>  
#include <ofw.h>
#include <printf.h>
#include <string.h>
#include <register.h>
#include "main.h"
#include "asm.h"
 
extern uint8_t subarchitecture;
 
void write(const char *str, const int len)
{
    int i;
   
    for (i = 0; i < len; i++) {
        if (str[i] == '\n')
            ofw_write("\r", 1);
        ofw_write(&str[i], 1);
    }
}
 
int ofw_translate_failed(ofw_arg_t flag)
{
    return flag != -1;
}
 
/**
 * Starts all CPUs represented by following siblings of the given node,
 * except for the current CPU.
 *
 * @param child the first child of the OFW tree node whose children represent
 *      CPUs to be woken up
 * @param current_mid   MID of the current CPU, the current CPU will
 *          (of course) not be woken up
 * @return  number of CPUs which have the same parent node as "child"
 */
static int wake_cpus_in_node(phandle child, uint64_t current_mid)
{
    int cpus;
    char type_name[BUF_SIZE];
   
    for (cpus = 0; child != 0 && child != -1;
        child = ofw_get_peer_node(child), cpus++) {
        if (ofw_get_property(child, "device_type", type_name,
            sizeof(type_name)) > 0) {
            if (strcmp(type_name, "cpu") == 0) {
                uint32_t mid;
               
                /*
                 * "upa-portid" for US, "portid" for US-III,
                 * "cpuid" for US-IV
                 */
                if (ofw_get_property(
                    child, "upa-portid",
                    &mid, sizeof(mid)) <= 0
                    && ofw_get_property(child, "portid",
                    &mid, sizeof(mid)) <= 0
                    && ofw_get_property(child, "cpuid",
                    &mid, sizeof(mid)) <= 0)
                    continue;
                   
                if (current_mid != mid) {
                    /*
                     * Start secondary processor.
                     */
                    (void) ofw_call("SUNW,start-cpu", 3, 1,
                        NULL, child, KERNEL_VIRTUAL_ADDRESS,
                        bootinfo.physmem_start |
                        AP_PROCESSOR);
                }
            }
        }
    }
 
    return cpus;
}
 
/**
 * Finds out the current CPU's MID and wakes up all AP processors.
 */
int ofw_cpu(void)
{
    int cpus;
    phandle node;
    phandle subnode;
    phandle cpus_parent;
    phandle cmp;
    char name[BUF_SIZE];
 
    /* get the current CPU MID */
    uint64_t current_mid;
   
    asm volatile ("ldxa [%1] %2, %0\n"
        : "=r" (current_mid)
        : "r" (0), "i" (ASI_ICBUS_CONFIG));
    current_mid >>= ICBUS_CONFIG_MID_SHIFT;
 
    if (subarchitecture == SUBARCH_US) {
        current_mid &= ICBUS_CONFIG_MID_MASK_US;
    } else if (subarchitecture == SUBARCH_US3) {
        current_mid &= ICBUS_CONFIG_MID_MASK_US3;
    } else {
        printf("MID format unknown for this subarchitecture.");
        return 0;
    }
 
    /* wake up CPUs */
   
    cpus_parent = ofw_find_device("/ssm@0,0");
    if (cpus_parent == 0 || cpus_parent == -1) {
        cpus_parent = ofw_find_device("/");
    }
 
    node = ofw_get_child_node(cpus_parent);
    cpus = wake_cpus_in_node(node, current_mid);
    while (node != 0 && node != -1) {
        if (ofw_get_property(node, "name", name,
            sizeof(name)) > 0) {
            if (strcmp(name, "cmp") == 0) {
                subnode = ofw_get_child_node(node);
                cpus += wake_cpus_in_node(subnode,
                    current_mid);
            }
        }
        node = ofw_get_peer_node(node);
    }
   
    return cpus;
   
}
 
/** Get physical memory starting address.
 *
 * @param start Pointer to variable where the physical memory starting
 *      address will be stored.
 *
 * @return Non-zero on succes, zero on failure.
 */
int ofw_get_physmem_start(uintptr_t *start)
{
    uint32_t memreg[4];
 
    if (ofw_get_property(ofw_memory, "reg", &memreg, sizeof(memreg)) <= 0)
        return 0;
 
    *start = (((uint64_t) memreg[0]) << 32) | memreg[1];
    return 1;
}
 
 

Rev 3591	Rev 3607
1	/*	1	/*
2	* Copyright (c) 2005 Martin Decky	2	* Copyright (c) 2005 Martin Decky
3	* Copyright (c) 2006 Jakub Jermar	3	* Copyright (c) 2006 Jakub Jermar
4	* All rights reserved.	4	* All rights reserved.
5	*	5	*
6	* Redistribution and use in source and binary forms, with or without	6	* Redistribution and use in source and binary forms, with or without
7	* modification, are permitted provided that the following conditions	7	* modification, are permitted provided that the following conditions
8	* are met:	8	* are met:
9	*	9	*
10	* - Redistributions of source code must retain the above copyright	10	* - Redistributions of source code must retain the above copyright
11	* notice, this list of conditions and the following disclaimer.	11	* notice, this list of conditions and the following disclaimer.
12	* - Redistributions in binary form must reproduce the above copyright	12	* - Redistributions in binary form must reproduce the above copyright
13	* notice, this list of conditions and the following disclaimer in the	13	* notice, this list of conditions and the following disclaimer in the
14	* documentation and/or other materials provided with the distribution.	14	* documentation and/or other materials provided with the distribution.
15	* - The name of the author may not be used to endorse or promote products	15	* - The name of the author may not be used to endorse or promote products
16	* derived from this software without specific prior written permission.	16	* derived from this software without specific prior written permission.
17	*	17	*
18	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	18	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	19	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	23	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	24	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	25	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28	*/	28	*/
29		29
30	/**	30	/**
31	* @file	31	* @file
32	* @brief Architecture dependent parts of OpenFirmware interface.	32	* @brief Architecture dependent parts of OpenFirmware interface.
33	*/	33	*/
34		34
35	#include <ofwarch.h>	35	#include <ofwarch.h>
36	#include <ofw.h>	36	#include <ofw.h>
37	#include <printf.h>	37	#include <printf.h>
38	#include <string.h>	38	#include <string.h>
39	#include <register.h>	39	#include <register.h>
40	#include "main.h"	40	#include "main.h"
41	#include "asm.h"	41	#include "asm.h"
42		42
43	extern uint8_t subarchitecture;	43	extern uint8_t subarchitecture;
44		44
45	void write(const char *str, const int len)	45	void write(const char *str, const int len)
46	{	46	{
47	int i;	47	int i;
48		48
49	for (i = 0; i < len; i++) {	49	for (i = 0; i < len; i++) {
50	if (str[i] == '\n')	50	if (str[i] == '\n')
51	ofw_write("\r", 1);	51	ofw_write("\r", 1);
52	ofw_write(&str[i], 1);	52	ofw_write(&str[i], 1);
53	}	53	}
54	}	54	}
55		55
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	/**	61	/**
62	* Starts all CPUs represented by following siblings of the given node,	62	* Starts all CPUs represented by following siblings of the given node,
63	* except for the current CPU.	63	* except for the current CPU.
64	*	64	*
65	* @param child the first child of the OFW tree node whose children represent	65	* @param child the first child of the OFW tree node whose children represent
66	* CPUs to be woken up	66	* CPUs to be woken up
67	* @param current_mid MID of the current CPU, the current CPU will	67	* @param current_mid MID of the current CPU, the current CPU will
68	* (of course) not be woken up	68	* (of course) not be woken up
69	* @return number of CPUs which have the same parent node as "child"	69	* @return number of CPUs which have the same parent node as "child"
70	*/	70	*/
71	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)
72	{	72	{
73	int cpus;	73	int cpus;
74	char type_name[BUF_SIZE];	74	char type_name[BUF_SIZE];
75		75
76	for (cpus = 0; child != 0 && child != -1;	76	for (cpus = 0; child != 0 && child != -1;
77	child = ofw_get_peer_node(child), cpus++) {	77	child = ofw_get_peer_node(child), cpus++) {
78	if (ofw_get_property(child, "device_type", type_name,	78	if (ofw_get_property(child, "device_type", type_name,
79	sizeof(type_name)) > 0) {	79	sizeof(type_name)) > 0) {
80	if (strcmp(type_name, "cpu") == 0) {	80	if (strcmp(type_name, "cpu") == 0) {
81	uint32_t mid;	81	uint32_t mid;
82		82
83	/*	83	/*
84	* "upa-portid" for US, "portid" for US-III,	84	* "upa-portid" for US, "portid" for US-III,
85	* "cpuid" for US-IV*	85	* "cpuid" for US-IV
86	*/	86	*/
87	if (ofw_get_property(	87	if (ofw_get_property(
88	child, "upa-portid",	88	child, "upa-portid",
89	&mid, sizeof(mid)) <= 0	89	&mid, sizeof(mid)) <= 0
90	&& ofw_get_property(child, "portid",	90	&& ofw_get_property(child, "portid",
91	&mid, sizeof(mid)) <= 0	91	&mid, sizeof(mid)) <= 0
92	&& ofw_get_property(child, "cpuid",	92	&& ofw_get_property(child, "cpuid",
93	&mid, sizeof(mid)) <= 0)	93	&mid, sizeof(mid)) <= 0)
94	continue;	94	continue;
95		95
96	if (current_mid != mid) {	96	if (current_mid != mid) {
97	/*	97	/*
98	* Start secondary processor.	98	* Start secondary processor.
99	*/	99	*/
100	(void) ofw_call("SUNW,start-cpu", 3, 1,	100	(void) ofw_call("SUNW,start-cpu", 3, 1,
101	NULL, child, KERNEL_VIRTUAL_ADDRESS,	101	NULL, child, KERNEL_VIRTUAL_ADDRESS,
102	bootinfo.physmem_start \|	102	bootinfo.physmem_start \|
103	AP_PROCESSOR);	103	AP_PROCESSOR);
104	}	104	}
105	}	105	}
106	}	106	}
107	}	107	}
108		108
109	return cpus;	109	return cpus;
110	}	110	}
111		111
112	/**	112	/**
113	* Finds out the current CPU's MID and wakes up all AP processors.	113	* Finds out the current CPU's MID and wakes up all AP processors.
114	*/	114	*/
115	int ofw_cpu(void)	115	int ofw_cpu(void)
116	{	116	{
117	int cpus;	117	int cpus;
118	phandle node;	118	phandle node;
119	phandle subnode;	119	phandle subnode;
120	phandle cpus_parent;	120	phandle cpus_parent;
121	phandle cmp;	121	phandle cmp;
122	char name[BUF_SIZE];	122	char name[BUF_SIZE];
123		123
124	/* get the current CPU MID */	124	/* get the current CPU MID */
125	uint64_t current_mid;	125	uint64_t current_mid;
126		126
127	asm volatile ("ldxa [%1] %2, %0\n"	127	asm volatile ("ldxa [%1] %2, %0\n"
128	: "=r" (current_mid)	128	: "=r" (current_mid)
129	: "r" (0), "i" (ASI_ICBUS_CONFIG));	129	: "r" (0), "i" (ASI_ICBUS_CONFIG));
130	current_mid >>= ICBUS_CONFIG_MID_SHIFT;	130	current_mid >>= ICBUS_CONFIG_MID_SHIFT;
131		131
132	if (subarchitecture == SUBARCH_US) {	132	if (subarchitecture == SUBARCH_US) {
133	current_mid &= ICBUS_CONFIG_MID_MASK_US;	133	current_mid &= ICBUS_CONFIG_MID_MASK_US;
134	} else if (subarchitecture == SUBARCH_US3) {	134	} else if (subarchitecture == SUBARCH_US3) {
135	current_mid &= ICBUS_CONFIG_MID_MASK_US3;	135	current_mid &= ICBUS_CONFIG_MID_MASK_US3;
136	} else {	136	} else {
137	printf("MID format unknown for this subarchitecture.");	137	printf("MID format unknown for this subarchitecture.");
138	return 0;	138	return 0;
139	}	139	}
140		140
141	/* wake up CPUs */	141	/* wake up CPUs */
142		142
143	cpus_parent = ofw_find_device("/ssm@0,0");	143	cpus_parent = ofw_find_device("/ssm@0,0");
144	if (cpus_parent == 0 \|\| cpus_parent == -1) {	144	if (cpus_parent == 0 \|\| cpus_parent == -1) {
145	cpus_parent = ofw_find_device("/");	145	cpus_parent = ofw_find_device("/");
146	}	146	}
147		147
148	node = ofw_get_child_node(cpus_parent);	148	node = ofw_get_child_node(cpus_parent);
149	cpus = wake_cpus_in_node(node, current_mid);	149	cpus = wake_cpus_in_node(node, current_mid);
150	while (node != 0 && node != -1) {	150	while (node != 0 && node != -1) {
151	if (ofw_get_property(node, "name", name,	151	if (ofw_get_property(node, "name", name,
152	sizeof(name)) > 0) {	152	sizeof(name)) > 0) {
153	if (strcmp(name, "cmp") == 0) {	153	if (strcmp(name, "cmp") == 0) {
154	subnode = ofw_get_child_node(node);	154	subnode = ofw_get_child_node(node);
155	cpus += wake_cpus_in_node(subnode,	155	cpus += wake_cpus_in_node(subnode,
156	current_mid);	156	current_mid);
157	}	157	}
158	}	158	}
159	node = ofw_get_peer_node(node);	159	node = ofw_get_peer_node(node);
160	}	160	}
161		161
162	return cpus;	162	return cpus;
163		163
164	}	164	}
165		165
166	/** Get physical memory starting address.	166	/** Get physical memory starting address.
167	*	167	*
168	* @param start Pointer to variable where the physical memory starting	168	* @param start Pointer to variable where the physical memory starting
169	* address will be stored.	169	* address will be stored.
170	*	170	*
171	* @return Non-zero on succes, zero on failure.	171	* @return Non-zero on succes, zero on failure.
172	*/	172	*/
173	int ofw_get_physmem_start(uintptr_t *start)	173	int ofw_get_physmem_start(uintptr_t *start)
174	{	174	{
175	uint32_t memreg[4];	175	uint32_t memreg[4];
176		176
177	if (ofw_get_property(ofw_memory, "reg", &memreg, sizeof(memreg)) <= 0)	177	if (ofw_get_property(ofw_memory, "reg", &memreg, sizeof(memreg)) <= 0)
178	return 0;	178	return 0;
179		179
180	*start = (((uint64_t) memreg[0]) << 32) \| memreg[1];	180	*start = (((uint64_t) memreg[0]) << 32) \| memreg[1];
181	return 1;	181	return 1;
182	}	182	}
183		183
184		184

Subversion Repositories HelenOS

(root)/branches/sparc/boot/arch/sparc64/loader/ofwarch.c @ 3664 – Rev 3591 → 3607