[deliverable/linux.git] / arch / sparc / kernel / devices.c

/* devices.c: Initial scan of the prom device tree for important
 *	      Sparc device nodes which we need to find.
 *
 * This is based on the sparc64 version, but sun4m doesn't always use
 * the hardware MIDs, so be careful.
 *
 * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu)
 */

#include <linux/kernel.h>
#include <linux/threads.h>
#include <linux/string.h>
#include <linux/init.h>
#include <linux/errno.h>

#include <asm/page.h>
#include <asm/oplib.h>
#include <asm/prom.h>
#include <asm/smp.h>
#include <asm/cpudata.h>
#include <asm/cpu_type.h>

extern void clock_stop_probe(void); /* tadpole.c */

static char *cpu_mid_prop(void)
{
	if (sparc_cpu_model == sun4d)
		return "cpu-id";
	return "mid";
}

static int check_cpu_node(phandle nd, int *cur_inst,
		int (*compare)(phandle, int, void *), void *compare_arg,
		phandle *prom_node, int *mid)
{
	if (!compare(nd, *cur_inst, compare_arg)) {
		if (prom_node)
			*prom_node = nd;
		if (mid) {
			*mid = prom_getintdefault(nd, cpu_mid_prop(), 0);
			if (sparc_cpu_model == sun4m)
				*mid &= 3;
		}
		return 0;
	}

	(*cur_inst)++;

	return -ENODEV;
}

static int __cpu_find_by(int (*compare)(phandle, int, void *),
		void *compare_arg, phandle *prom_node, int *mid)
{
	struct device_node *dp;
	int cur_inst;

	cur_inst = 0;
	for_each_node_by_type(dp, "cpu") {
		int err = check_cpu_node(dp->phandle, &cur_inst,
					 compare, compare_arg,
					 prom_node, mid);
		if (!err) {
			of_node_put(dp);
			return 0;
		}
	}

	return -ENODEV;
}

static int cpu_instance_compare(phandle nd, int instance, void *_arg)
{
	int desired_instance = (int) _arg;

	if (instance == desired_instance)
		return 0;
	return -ENODEV;
}

int cpu_find_by_instance(int instance, phandle *prom_node, int *mid)
{
	return __cpu_find_by(cpu_instance_compare, (void *)instance,
			     prom_node, mid);
}

static int cpu_mid_compare(phandle nd, int instance, void *_arg)
{
	int desired_mid = (int) _arg;
	int this_mid;

	this_mid = prom_getintdefault(nd, cpu_mid_prop(), 0);
	if (this_mid == desired_mid
	    || (sparc_cpu_model == sun4m && (this_mid & 3) == desired_mid))
		return 0;
	return -ENODEV;
}

int cpu_find_by_mid(int mid, phandle *prom_node)
{
	return __cpu_find_by(cpu_mid_compare, (void *)mid,
			     prom_node, NULL);
}

/* sun4m uses truncated mids since we base the cpuid on the ttable/irqset
 * address (0-3).  This gives us the true hardware mid, which might have
 * some other bits set.  On 4d hardware and software mids are the same.
 */
int cpu_get_hwmid(phandle prom_node)
{
	return prom_getintdefault(prom_node, cpu_mid_prop(), -ENODEV);
}

void __init device_scan(void)
{
	printk(KERN_NOTICE "Booting Linux...\n");

#ifndef CONFIG_SMP
	{
		phandle cpu_node;
		int err;
		err = cpu_find_by_instance(0, &cpu_node, NULL);
		if (err) {
			/* Probably a sun4e, Sun is trying to trick us ;-) */
			prom_printf("No cpu nodes, cannot continue\n");
			prom_halt();
		}
		cpu_data(0).clock_tick = prom_getintdefault(cpu_node,
							    "clock-frequency",
							    0);
	}
#endif /* !CONFIG_SMP */

	{
		extern void auxio_probe(void);
		extern void auxio_power_probe(void);
		auxio_probe();
		auxio_power_probe();
	}
	clock_stop_probe();
}
Commit	Line	Data
1da177e4 LT	1	/* devices.c: Initial scan of the prom device tree for important
	2	* Sparc device nodes which we need to find.
	3	*
	4	* This is based on the sparc64 version, but sun4m doesn't always use
	5	* the hardware MIDs, so be careful.
	6	*
	7	* Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu)
	8	*/
	9
1da177e4 LT	10	#include <linux/kernel.h>
	11	#include <linux/threads.h>
	12	#include <linux/string.h>
	13	#include <linux/init.h>
	14	#include <linux/errno.h>
	15
	16	#include <asm/page.h>
	17	#include <asm/oplib.h>
c2d3bffe	18	#include <asm/prom.h>
1da177e4	19	#include <asm/smp.h>
1da177e4	20	#include <asm/cpudata.h>
d550bbd4	21	#include <asm/cpu_type.h>
1da177e4	22
1da177e4	23	extern void clock_stop_probe(void); /* tadpole.c */
1da177e4 LT	24
	25	static char *cpu_mid_prop(void)
	26	{
	27	if (sparc_cpu_model == sun4d)
	28	return "cpu-id";
	29	return "mid";
	30	}
	31
8d125562 AS	32	static int check_cpu_node(phandle nd, int *cur_inst,
	33	int (compare)(phandle, int, void ), void *compare_arg,
	34	phandle prom_node, int mid)
1da177e4	35	{
1da177e4 LT	36	if (!compare(nd, *cur_inst, compare_arg)) {
	37	if (prom_node)
	38	*prom_node = nd;
	39	if (mid) {
	40	*mid = prom_getintdefault(nd, cpu_mid_prop(), 0);
	41	if (sparc_cpu_model == sun4m)
	42	*mid &= 3;
	43	}
	44	return 0;
	45	}
	46
	47	(*cur_inst)++;
	48
	49	return -ENODEV;
	50	}
	51
8d125562 AS	52	static int __cpu_find_by(int (compare)(phandle, int, void ),
8d125562 AS	53	void compare_arg, phandle prom_node, int *mid)
1da177e4	54	{
c2d3bffe DM	55	struct device_node *dp;
c2d3bffe DM	56	int cur_inst;
1da177e4	57
1da177e4	58	cur_inst = 0;
c2d3bffe	59	for_each_node_by_type(dp, "cpu") {
6016a363	60	int err = check_cpu_node(dp->phandle, &cur_inst,
c2d3bffe DM	61	compare, compare_arg,
c2d3bffe DM	62	prom_node, mid);
b127aa8b JL	63	if (!err) {
b127aa8b JL	64	of_node_put(dp);
1da177e4	65	return 0;
b127aa8b	66	}
1da177e4 LT	67	}
	68
	69	return -ENODEV;
	70	}
	71
8d125562	72	static int cpu_instance_compare(phandle nd, int instance, void *_arg)
1da177e4 LT	73	{
	74	int desired_instance = (int) _arg;
	75
	76	if (instance == desired_instance)
	77	return 0;
	78	return -ENODEV;
	79	}
	80
8d125562	81	int cpu_find_by_instance(int instance, phandle prom_node, int mid)
1da177e4 LT	82	{
	83	return __cpu_find_by(cpu_instance_compare, (void *)instance,
	84	prom_node, mid);
	85	}
	86
8d125562	87	static int cpu_mid_compare(phandle nd, int instance, void *_arg)
1da177e4 LT	88	{
	89	int desired_mid = (int) _arg;
	90	int this_mid;
	91
	92	this_mid = prom_getintdefault(nd, cpu_mid_prop(), 0);
	93	if (this_mid == desired_mid
	94	\|\| (sparc_cpu_model == sun4m && (this_mid & 3) == desired_mid))
	95	return 0;
	96	return -ENODEV;
	97	}
	98
8d125562	99	int cpu_find_by_mid(int mid, phandle *prom_node)
1da177e4 LT	100	{
	101	return __cpu_find_by(cpu_mid_compare, (void *)mid,
	102	prom_node, NULL);
	103	}
	104
	105	/* sun4m uses truncated mids since we base the cpuid on the ttable/irqset
	106	* address (0-3). This gives us the true hardware mid, which might have
	107	* some other bits set. On 4d hardware and software mids are the same.
	108	*/
8d125562	109	int cpu_get_hwmid(phandle prom_node)
1da177e4 LT	110	{
	111	return prom_getintdefault(prom_node, cpu_mid_prop(), -ENODEV);
	112	}
	113
	114	void __init device_scan(void)
	115	{
7671fa22	116	printk(KERN_NOTICE "Booting Linux...\n");
1da177e4 LT	117
	118	#ifndef CONFIG_SMP
	119	{
8d125562 AS	120	phandle cpu_node;
8d125562 AS	121	int err;
1da177e4 LT	122	err = cpu_find_by_instance(0, &cpu_node, NULL);
	123	if (err) {
	124	/* Probably a sun4e, Sun is trying to trick us ;-) */
	125	prom_printf("No cpu nodes, cannot continue\n");
	126	prom_halt();
	127	}
	128	cpu_data(0).clock_tick = prom_getintdefault(cpu_node,
	129	"clock-frequency",
	130	0);
	131	}
	132	#endif /* !CONFIG_SMP */
	133
1da177e4 LT	134	{
	135	extern void auxio_probe(void);
	136	extern void auxio_power_probe(void);
	137	auxio_probe();
	138	auxio_power_probe();
	139	}
1da177e4	140	clock_stop_probe();
1da177e4	141	}