1/*
  2 * The generic setup file for PMC-Sierra MSP processors
  3 *
  4 * Copyright 2005-2007 PMC-Sierra, Inc,
  5 * Author: Jun Sun, jsun@mvista.com or jsun@junsun.net
  6 *
  7 * This program is free software; you can redistribute	it and/or modify it
  8 * under  the terms of	the GNU General	 Public License as published by the
  9 * Free Software Foundation;  either version 2 of the  License, or (at your
 10 * option) any later version.
 11 */
 12
 13#include <asm/bootinfo.h>
 14#include <asm/cacheflush.h>
 15#include <asm/idle.h>
 16#include <asm/r4kcache.h>
 17#include <asm/reboot.h>
 18#include <asm/smp-ops.h>
 19#include <asm/time.h>
 20
 21#include <msp_prom.h>
 22#include <msp_regs.h>
 23
 24#if defined(CONFIG_PMC_MSP7120_GW)
 25#include <msp_regops.h>
 26#define MSP_BOARD_RESET_GPIO	9
 27#endif
 28
 29extern void msp_serial_setup(void);
 30extern void pmctwiled_setup(void);
 31
 32#if defined(CONFIG_PMC_MSP7120_EVAL) || \
 33    defined(CONFIG_PMC_MSP7120_GW) || \
 34    defined(CONFIG_PMC_MSP7120_FPGA)
 35/*
 36 * Performs the reset for MSP7120-based boards
 37 */
 38void msp7120_reset(void)
 39{
 40	void *start, *end, *iptr;
 41	register int i;
 42
 43	/* Diasble all interrupts */
 44	local_irq_disable();
 45#ifdef CONFIG_SYS_SUPPORTS_MULTITHREADING
 46	dvpe();
 47#endif
 48
 49	/* Cache the reset code of this function */
 50	__asm__ __volatile__ (
 51		"	.set	push				\n"
 52		"	.set	arch=r4000			\n"
 53		"	la	%0,startpoint			\n"
 54		"	la	%1,endpoint			\n"
 55		"	.set	pop				\n"
 56		: "=r" (start), "=r" (end)
 57		:
 58	);
 59
 60	for (iptr = (void *)((unsigned int)start & ~(L1_CACHE_BYTES - 1));
 61	     iptr < end; iptr += L1_CACHE_BYTES)
 62		cache_op(Fill, iptr);
 63
 64	__asm__ __volatile__ (
 65		"startpoint:					\n"
 66	);
 67
 68	/* Put the DDRC into self-refresh mode */
 69	DDRC_INDIRECT_WRITE(DDRC_CTL(10), 0xb, 1 << 16);
 70
 71	/*
 72	 * IMPORTANT!
 73	 * DO NOT do anything from here on out that might even
 74	 * think about fetching from RAM - i.e., don't call any
 75	 * non-inlined functions, and be VERY sure that any inline
 76	 * functions you do call do NOT access any sort of RAM
 77	 * anywhere!
 78	 */
 79
 80	/* Wait a bit for the DDRC to settle */
 81	for (i = 0; i < 100000000; i++);
 82
 83#if defined(CONFIG_PMC_MSP7120_GW)
 84	/*
 85	 * Set GPIO 9 HI, (tied to board reset logic)
 86	 * GPIO 9 is the 4th GPIO of register 3
 87	 *
 88	 * NOTE: We cannot use the higher-level msp_gpio_mode()/out()
 89	 * as GPIO char driver may not be enabled and it would look up
 90	 * data inRAM!
 91	 */
 92	set_value_reg32(GPIO_CFG3_REG, 0xf000, 0x8000);
 93	set_reg32(GPIO_DATA3_REG, 8);
 94
 95	/*
 96	 * In case GPIO9 doesn't reset the board (jumper configurable!)
 97	 * fallback to device reset below.
 98	 */
 99#endif
100	/* Set bit 1 of the MSP7120 reset register */
101	*RST_SET_REG = 0x00000001;
102
103	__asm__ __volatile__ (
104		"endpoint:					\n"
105	);
106}
107#endif
108
109void msp_restart(char *command)
110{
111	printk(KERN_WARNING "Now rebooting .......\n");
112
113#if defined(CONFIG_PMC_MSP7120_EVAL) || \
114    defined(CONFIG_PMC_MSP7120_GW) || \
115    defined(CONFIG_PMC_MSP7120_FPGA)
116	msp7120_reset();
117#else
118	/* No chip-specific reset code, just jump to the ROM reset vector */
119	set_c0_status(ST0_BEV | ST0_ERL);
120	change_c0_config(CONF_CM_CMASK, CONF_CM_UNCACHED);
121	flush_cache_all();
122	write_c0_wired(0);
123
124	__asm__ __volatile__("jr\t%0"::"r"(0xbfc00000));
125#endif
126}
127
128void msp_halt(void)
129{
130	printk(KERN_WARNING "\n** You can safely turn off the power\n");
131	while (1)
132		/* If possible call official function to get CPU WARs */
133		if (cpu_wait)
134			(*cpu_wait)();
135		else
136			__asm__(".set\tmips3\n\t" "wait\n\t" ".set\tmips0");
137}
138
139void msp_power_off(void)
140{
141	msp_halt();
142}
143
144void __init plat_mem_setup(void)
145{
146	_machine_restart = msp_restart;
147	_machine_halt = msp_halt;
148	pm_power_off = msp_power_off;
149}
150
151extern struct plat_smp_ops msp_smtc_smp_ops;
152
153void __init prom_init(void)
154{
155	unsigned long family;
156	unsigned long revision;
157
158	prom_argc = fw_arg0;
159	prom_argv = (char **)fw_arg1;
160	prom_envp = (char **)fw_arg2;
161
162	/*
163	 * Someday we can use this with PMON2000 to get a
164	 * platform call prom routines for output etc. without
165	 * having to use grody hacks.  For now it's unused.
166	 *
167	 * struct callvectors *cv = (struct callvectors *) fw_arg3;
168	 */
169	family = identify_family();
170	revision = identify_revision();
171
172	switch (family) {
173	case FAMILY_FPGA:
174		if (FPGA_IS_MSP4200(revision)) {
175			/* Old-style revision ID */
176			mips_machtype = MACH_MSP4200_FPGA;
177		} else {
178			mips_machtype = MACH_MSP_OTHER;
179		}
180		break;
181
182	case FAMILY_MSP4200:
183#if defined(CONFIG_PMC_MSP4200_EVAL)
184		mips_machtype  = MACH_MSP4200_EVAL;
185#elif defined(CONFIG_PMC_MSP4200_GW)
186		mips_machtype  = MACH_MSP4200_GW;
187#else
188		mips_machtype = MACH_MSP_OTHER;
189#endif
190		break;
191
192	case FAMILY_MSP4200_FPGA:
193		mips_machtype  = MACH_MSP4200_FPGA;
194		break;
195
196	case FAMILY_MSP7100:
197#if defined(CONFIG_PMC_MSP7120_EVAL)
198		mips_machtype = MACH_MSP7120_EVAL;
199#elif defined(CONFIG_PMC_MSP7120_GW)
200		mips_machtype = MACH_MSP7120_GW;
201#else
202		mips_machtype = MACH_MSP_OTHER;
203#endif
204		break;
205
206	case FAMILY_MSP7100_FPGA:
207		mips_machtype  = MACH_MSP7120_FPGA;
208		break;
209
210	default:
211		/* we don't recognize the machine */
212		mips_machtype  = MACH_UNKNOWN;
213		panic("***Bogosity factor five***, exiting");
214		break;
215	}
216
217	prom_init_cmdline();
218
219	prom_meminit();
220
221	/*
222	 * Sub-system setup follows.
223	 * Setup functions can	either be called here or using the
224	 * subsys_initcall mechanism (i.e. see msp_pci_setup). The
225	 * order in which they are called can be changed by using the
226	 * link order in arch/mips/pmc-sierra/msp71xx/Makefile.
227	 *
228	 * NOTE: Please keep sub-system specific initialization code
229	 * in separate specific files.
230	 */
231	msp_serial_setup();
232
233	if (register_vsmp_smp_ops()) {
234#ifdef CONFIG_MIPS_MT_SMTC
235		register_smp_ops(&msp_smtc_smp_ops);
236#endif
237	}
238
239#ifdef CONFIG_PMCTWILED
240	/*
241	 * Setup LED states before the subsys_initcall loads other
242	 * dependent drivers/modules.
243	 */
244	pmctwiled_setup();
245#endif
246}