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

Rev	Author	Line No.	Line
885	decky	1	/*
2071	jermar	2	* Copyright (c) 2005 Martin Decky
		3	* Copyright (c) 2006 Jakub Jermar
885	decky	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	*/
1789	jermar	29
		30	/**
		31	* @file
		32	* @brief Architecture dependent parts of OpenFirmware interface.
		33	*/
		34
		35	#include <ofwarch.h>
1764	jermar	36	#include <ofw.h>
		37	#include <printf.h>
1881	jermar	38	#include <string.h>
1903	jermar	39	#include <register.h>
1881	jermar	40	#include "main.h"
1978	jermar	41	#include "asm.h"
885	decky	42
3582	rimsky	43	extern uint8_t subarchitecture;
		44
1764	jermar	45	void write(const char *str, const int len)
885	decky	46	{
1773	jermar	47	int i;
		48
		49	for (i = 0; i < len; i++) {
		50	if (str[i] == '\n')
		51	ofw_write("\r", 1);
		52	ofw_write(&str[i], 1);
		53	}
885	decky	54	}
1783	jermar	55
		56	int ofw_translate_failed(ofw_arg_t flag)
		57	{
		58	return flag != -1;
		59	}
1789	jermar	60
3582	rimsky	61	static int wake_cpus_in_node(phandle child, uint64_t current_mid)
1881	jermar	62	{
3582	rimsky	63	int cpus;
1881	jermar	64	char type_name[BUF_SIZE];
		65
3582	rimsky	66	for (cpus = 0; child != 0 && child != -1;
		67	child = ofw_get_peer_node(child), cpus++) {
		68	if (ofw_get_property(child, "device_type", type_name,
3146	jermar	69	sizeof(type_name)) > 0) {
1896	jermar	70	if (strcmp(type_name, "cpu") == 0) {
1899	jermar	71	uint32_t mid;
1881	jermar	72
3582	rimsky	73	/*
		74	* "upa-portid" for US, "portid" for US-III,
		75	* "cpuid" for US-IV*
		76	*/
3467	rimsky	77	if (ofw_get_property(
3582	rimsky	78	child, "upa-portid",
3467	rimsky	79	&mid, sizeof(mid)) <= 0
3582	rimsky	80	&& ofw_get_property(child, "portid",
		81	&mid, sizeof(mid)) <= 0
		82	&& ofw_get_property(child, "cpuid",
3467	rimsky	83	&mid, sizeof(mid)) <= 0)
1881	jermar	84	continue;
		85
1899	jermar	86	if (current_mid != mid) {
		87	/*
		88	* Start secondary processor.
		89	*/
3582	rimsky	90	printf("Starting CPU: %d.\n", mid);
3146	jermar	91	(void) ofw_call("SUNW,start-cpu", 3, 1,
3582	rimsky	92	NULL, child, KERNEL_VIRTUAL_ADDRESS,
3146	jermar	93	bootinfo.physmem_start \|
		94	AP_PROCESSOR);
1899	jermar	95	}
1881	jermar	96	}
		97	}
1899	jermar	98	}
1881	jermar	99
1903	jermar	100	return cpus;
1881	jermar	101	}
1978	jermar	102
3582	rimsky	103	int ofw_cpu(void)
		104	{
		105	int cpus;
		106	phandle node;
		107	phandle subnode;
		108	phandle ssm;
		109	phandle cmp;
		110	char name[BUF_SIZE];
		111
		112	/* get the current CPU MID */
		113	uint64_t current_mid;
		114
		115	asm volatile ("ldxa [%1] %2, %0\n"
		116	: "=r" (current_mid)
		117	: "r" (0), "i" (ASI_ICBUS_CONFIG));
		118	current_mid >>= ICBUS_CONFIG_MID_SHIFT;
		119
		120	if (subarchitecture == SUBARCH_US) {
		121	current_mid &= ICBUS_CONFIG_MID_MASK_US;
		122	} else if (subarchitecture == SUBARCH_US3) {
		123	current_mid &= ICBUS_CONFIG_MID_MASK_US3;
		124	} else {
		125	printf("MID format unknown for this subarchitecture.");
		126	return 0;
		127	}
		128
		129	/* wake up CPUs */
		130	ssm = ofw_find_device("/ssm@0,0");
		131	if (ssm == -1) {
		132	node = ofw_get_child_node(ofw_root);
		133	cpus = wake_cpus_in_node(node, current_mid);
		134	} else {
		135	node = ofw_get_child_node(ssm);
		136	cpus = wake_cpus_in_node(node, current_mid);
		137	while (node != 0 && node != -1) {
		138	if (ofw_get_property(node, "name", name,
		139	sizeof(name)) > 0) {
		140	if (strcmp(name, "cmp") == 0) {
		141	printf("nasel jsem dalsi CPU");
		142	subnode = ofw_get_child_node(node);
		143	cpus += wake_cpus_in_node(subnode,
		144	current_mid);
		145	}
		146	}
		147	node = ofw_get_peer_node(node);
		148	}
		149	}
		150
		151	return cpus;
		152
		153	}
		154
1978	jermar	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	int ofw_get_physmem_start(uintptr_t *start)
		163	{
		164	uint32_t memreg[4];
		165
		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	}
		172

Subversion Repositories HelenOS

(root)//branches/sparc/boot/arch/sparc64/loader/ofwarch.c – Rev 3582