source: mainline/boot/arch/sparc64/loader/ofwarch.c@ 86018c1

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 86018c1 was ed5ad30, checked in by Martin Decky <martin@…>, 16 years ago

reflect the change of the names of the macro

  • Property mode set to 100644
File size: 4.9 KB
Line 
1/*
2 * Copyright (c) 2005 Martin Decky
3 * Copyright (c) 2006 Jakub Jermar
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * - Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * - Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
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
16 * derived from this software without specific prior written permission.
17 *
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
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
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
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
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30/**
31 * @file
32 * @brief Architecture dependent parts of OpenFirmware interface.
33 */
34
35#include <ofwarch.h>
36#include <ofw.h>
37#include <printf.h>
38#include <string.h>
39#include <register.h>
40#include "main.h"
41#include "asm.h"
42
43void write(const char *str, const int len)
44{
45 int i;
46
47 for (i = 0; i < len; i++) {
48 if (str[i] == '\n')
49 ofw_write("\r", 1);
50 ofw_write(&str[i], 1);
51 }
52}
53
54int ofw_translate_failed(ofw_arg_t flag)
55{
56 return flag != -1;
57}
58
59/**
60 * Starts all CPUs represented by following siblings of the given node,
61 * except for the current CPU.
62 *
63 * @param child The first child of the OFW tree node whose children
64 * represent CPUs to be woken up.
65 * @param current_mid MID of the current CPU, the current CPU will
66 * (of course) not be woken up.
67 * @param physmem_start Starting address of the physical memory.
68 *
69 * @return Number of CPUs which have the same parent node as
70 * "child".
71 *
72 */
73static int wake_cpus_in_node(phandle child, uint64_t current_mid,
74 uintptr_t physmem_start)
75{
76 int cpus;
77
78 for (cpus = 0; (child != 0) && (child != -1);
79 child = ofw_get_peer_node(child), cpus++) {
80 char type_name[OFW_TREE_PROPERTY_MAX_VALUELEN];
81
82 if (ofw_get_property(child, "device_type", type_name,
83 OFW_TREE_PROPERTY_MAX_VALUELEN) > 0) {
84 type_name[OFW_TREE_PROPERTY_MAX_VALUELEN - 1] = 0;
85 if (strcmp(type_name, "cpu") == 0) {
86 uint32_t mid;
87
88 /*
89 * "upa-portid" for US, "portid" for US-III,
90 * "cpuid" for US-IV
91 */
92 if ((ofw_get_property(child, "upa-portid", &mid, sizeof(mid)) <= 0)
93 && (ofw_get_property(child, "portid", &mid, sizeof(mid)) <= 0)
94 && (ofw_get_property(child, "cpuid", &mid, sizeof(mid)) <= 0))
95 continue;
96
97 if (current_mid != mid) {
98 /*
99 * Start secondary processor.
100 */
101 (void) ofw_call("SUNW,start-cpu", 3, 1,
102 NULL, child, KERNEL_VIRTUAL_ADDRESS,
103 physmem_start | AP_PROCESSOR);
104 }
105 }
106 }
107 }
108
109 return cpus;
110}
111
112/**
113 * Finds out the current CPU's MID and wakes up all AP processors.
114 */
115int ofw_cpu(uint16_t mid_mask, uintptr_t physmem_start)
116{
117 /* Get the current CPU MID */
118 uint64_t current_mid;
119
120 asm volatile (
121 "ldxa [%1] %2, %0\n"
122 : "=r" (current_mid)
123 : "r" (0), "i" (ASI_ICBUS_CONFIG)
124 );
125
126 current_mid >>= ICBUS_CONFIG_MID_SHIFT;
127 current_mid &= mid_mask;
128
129 /* Wake up the CPUs */
130
131 phandle cpus_parent = ofw_find_device("/ssm@0,0");
132 if ((cpus_parent == 0) || (cpus_parent == -1))
133 cpus_parent = ofw_find_device("/");
134
135 phandle node = ofw_get_child_node(cpus_parent);
136 int cpus = wake_cpus_in_node(node, current_mid, physmem_start);
137 while ((node != 0) && (node != -1)) {
138 char name[OFW_TREE_PROPERTY_MAX_VALUELEN];
139
140 if (ofw_get_property(node, "name", name,
141 OFW_TREE_PROPERTY_MAX_VALUELEN) > 0) {
142 name[OFW_TREE_PROPERTY_MAX_VALUELEN - 1] = 0;
143 if (strcmp(name, "cmp") == 0) {
144 phandle subnode = ofw_get_child_node(node);
145 cpus += wake_cpus_in_node(subnode,
146 current_mid, physmem_start);
147 }
148 }
149 node = ofw_get_peer_node(node);
150 }
151
152 return cpus;
153}
154
155/** Get physical memory starting address.
156 *
157 * @param start Pointer to variable where the physical memory starting
158 * address will be stored.
159 *
160 * @return Non-zero on succes, zero on failure.
161 *
162 */
163int ofw_get_physmem_start(uintptr_t *start)
164{
165 uint32_t memreg[4];
166 if (ofw_get_property(ofw_memory, "reg", &memreg, sizeof(memreg)) <= 0)
167 return 0;
168
169 *start = (((uint64_t) memreg[0]) << 32) | memreg[1];
170 return 1;
171}
Note: See TracBrowser for help on using the repository browser.