HelenOS sources
This source file includes following definitions.
- putuchar
- wake_cpus_in_node
- ofw_cpu
- ofw_get_physmem_start
#include <arch/arch.h>
#include <arch/ofw.h>
#include <genarch/ofw.h>
#include <stddef.h>
#include <stdint.h>
#include <printf.h>
#include <halt.h>
#include <putchar.h>
#include <str.h>
void putuchar(char32_t ch)
{
if (ch == '\n')
ofw_putchar('\r');
if (ascii_check(ch))
ofw_putchar(ch);
else
ofw_putchar('?');
}
static size_t wake_cpus_in_node(phandle child, uint64_t current_mid,
uintptr_t physmem_start)
{
size_t cpus;
for (cpus = 0; (child != 0) && (child != (phandle) -1);
child = ofw_get_peer_node(child), cpus++) {
char type_name[OFW_TREE_PROPERTY_MAX_VALUELEN];
if (ofw_get_property(child, "device_type", type_name,
OFW_TREE_PROPERTY_MAX_VALUELEN) > 0) {
type_name[OFW_TREE_PROPERTY_MAX_VALUELEN - 1] = 0;
if (str_cmp(type_name, "cpu") == 0) {
uint32_t mid;
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) {
(void) ofw_call("SUNW,start-cpu", 3, 1,
NULL, child, KERNEL_ADDRESS,
physmem_start | AP_PROCESSOR);
}
}
}
}
return cpus;
}
void ofw_cpu(uint16_t mid_mask, uintptr_t physmem_start)
{
uint64_t current_mid;
asm volatile (
"ldxa [%[zero]] %[asi], %[current_mid]\n"
: [current_mid] "=r" (current_mid)
: [zero] "r" (0),
[asi] "i" (ASI_ICBUS_CONFIG)
);
current_mid >>= ICBUS_CONFIG_MID_SHIFT;
current_mid &= mid_mask;
phandle cpus_parent = ofw_find_device("/ssm@0,0");
if ((cpus_parent == 0) || (cpus_parent == (phandle) -1))
cpus_parent = ofw_find_device("/");
phandle node = ofw_get_child_node(cpus_parent);
size_t cpus = wake_cpus_in_node(node, current_mid, physmem_start);
while ((node != 0) && (node != (phandle) -1)) {
char name[OFW_TREE_PROPERTY_MAX_VALUELEN];
if (ofw_get_property(node, "name", name,
OFW_TREE_PROPERTY_MAX_VALUELEN) > 0) {
name[OFW_TREE_PROPERTY_MAX_VALUELEN - 1] = 0;
if (str_cmp(name, "cmp") == 0) {
phandle subnode = ofw_get_child_node(node);
cpus += wake_cpus_in_node(subnode,
current_mid, physmem_start);
}
}
node = ofw_get_peer_node(node);
}
if (cpus == 0)
printf("Warning: Unable to get CPU properties.\n");
}
uintptr_t ofw_get_physmem_start(void)
{
uint32_t memreg[4];
if ((ofw_ret_t) ofw_get_property(ofw_memory, "reg", &memreg,
sizeof(memreg)) <= 0) {
printf("Error: Unable to get physical memory starting address, halting.\n");
halt();
}
return ((((uintptr_t) memreg[0]) << 32) | memreg[1]);
}
HelenOS homepage, sources at GitHub