PageRenderTime 24ms CodeModel.GetById 15ms app.highlight 6ms RepoModel.GetById 1ms app.codeStats 0ms

/arch/mips/bcm63xx/setup.c

http://github.com/mirrors/linux
C | 170 lines | 131 code | 22 blank | 17 comment | 13 complexity | 2df3d316f83a6898e26e5c089fdfce21 MD5 | raw file
  1/*
  2 * This file is subject to the terms and conditions of the GNU General Public
  3 * License.  See the file "COPYING" in the main directory of this archive
  4 * for more details.
  5 *
  6 * Copyright (C) 2008 Maxime Bizon <mbizon@freebox.fr>
  7 */
  8
  9#include <linux/init.h>
 10#include <linux/kernel.h>
 11#include <linux/delay.h>
 12#include <linux/memblock.h>
 13#include <linux/ioport.h>
 14#include <linux/pm.h>
 15#include <asm/bootinfo.h>
 16#include <asm/time.h>
 17#include <asm/reboot.h>
 18#include <asm/cacheflush.h>
 19#include <bcm63xx_board.h>
 20#include <bcm63xx_cpu.h>
 21#include <bcm63xx_regs.h>
 22#include <bcm63xx_io.h>
 23#include <bcm63xx_gpio.h>
 24
 25void bcm63xx_machine_halt(void)
 26{
 27	pr_info("System halted\n");
 28	while (1)
 29		;
 30}
 31
 32static void bcm6348_a1_reboot(void)
 33{
 34	u32 reg;
 35
 36	/* soft reset all blocks */
 37	pr_info("soft-resetting all blocks ...\n");
 38	reg = bcm_perf_readl(PERF_SOFTRESET_REG);
 39	reg &= ~SOFTRESET_6348_ALL;
 40	bcm_perf_writel(reg, PERF_SOFTRESET_REG);
 41	mdelay(10);
 42
 43	reg = bcm_perf_readl(PERF_SOFTRESET_REG);
 44	reg |= SOFTRESET_6348_ALL;
 45	bcm_perf_writel(reg, PERF_SOFTRESET_REG);
 46	mdelay(10);
 47
 48	/* Jump to the power on address. */
 49	pr_info("jumping to reset vector.\n");
 50	/* set high vectors (base at 0xbfc00000 */
 51	set_c0_status(ST0_BEV | ST0_ERL);
 52	/* run uncached in kseg0 */
 53	change_c0_config(CONF_CM_CMASK, CONF_CM_UNCACHED);
 54	__flush_cache_all();
 55	/* remove all wired TLB entries */
 56	write_c0_wired(0);
 57	__asm__ __volatile__(
 58		"jr\t%0"
 59		:
 60		: "r" (0xbfc00000));
 61	while (1)
 62		;
 63}
 64
 65void bcm63xx_machine_reboot(void)
 66{
 67	u32 reg, perf_regs[2] = { 0, 0 };
 68	unsigned int i;
 69
 70	/* mask and clear all external irq */
 71	switch (bcm63xx_get_cpu_id()) {
 72	case BCM3368_CPU_ID:
 73		perf_regs[0] = PERF_EXTIRQ_CFG_REG_3368;
 74		break;
 75	case BCM6328_CPU_ID:
 76		perf_regs[0] = PERF_EXTIRQ_CFG_REG_6328;
 77		break;
 78	case BCM6338_CPU_ID:
 79		perf_regs[0] = PERF_EXTIRQ_CFG_REG_6338;
 80		break;
 81	case BCM6345_CPU_ID:
 82		perf_regs[0] = PERF_EXTIRQ_CFG_REG_6345;
 83		break;
 84	case BCM6348_CPU_ID:
 85		perf_regs[0] = PERF_EXTIRQ_CFG_REG_6348;
 86		break;
 87	case BCM6358_CPU_ID:
 88		perf_regs[0] = PERF_EXTIRQ_CFG_REG_6358;
 89		break;
 90	case BCM6362_CPU_ID:
 91		perf_regs[0] = PERF_EXTIRQ_CFG_REG_6362;
 92		break;
 93	}
 94
 95	for (i = 0; i < 2; i++) {
 96		if (!perf_regs[i])
 97			break;
 98
 99		reg = bcm_perf_readl(perf_regs[i]);
100		if (BCMCPU_IS_6348()) {
101			reg &= ~EXTIRQ_CFG_MASK_ALL_6348;
102			reg |= EXTIRQ_CFG_CLEAR_ALL_6348;
103		} else {
104			reg &= ~EXTIRQ_CFG_MASK_ALL;
105			reg |= EXTIRQ_CFG_CLEAR_ALL;
106		}
107		bcm_perf_writel(reg, perf_regs[i]);
108	}
109
110	if (BCMCPU_IS_6348() && (bcm63xx_get_cpu_rev() == 0xa1))
111		bcm6348_a1_reboot();
112
113	pr_info("triggering watchdog soft-reset...\n");
114	if (BCMCPU_IS_6328()) {
115		bcm_wdt_writel(1, WDT_SOFTRESET_REG);
116	} else {
117		reg = bcm_perf_readl(PERF_SYS_PLL_CTL_REG);
118		reg |= SYS_PLL_SOFT_RESET;
119		bcm_perf_writel(reg, PERF_SYS_PLL_CTL_REG);
120	}
121	while (1)
122		;
123}
124
125static void __bcm63xx_machine_reboot(char *p)
126{
127	bcm63xx_machine_reboot();
128}
129
130/*
131 * return system type in /proc/cpuinfo
132 */
133const char *get_system_type(void)
134{
135	static char buf[128];
136	snprintf(buf, sizeof(buf), "bcm63xx/%s (0x%04x/0x%02X)",
137		 board_get_name(),
138		 bcm63xx_get_cpu_id(), bcm63xx_get_cpu_rev());
139	return buf;
140}
141
142void __init plat_time_init(void)
143{
144	mips_hpt_frequency = bcm63xx_get_cpu_freq() / 2;
145}
146
147void __init plat_mem_setup(void)
148{
149	add_memory_region(0, bcm63xx_get_memory_size(), BOOT_MEM_RAM);
150
151	_machine_halt = bcm63xx_machine_halt;
152	_machine_restart = __bcm63xx_machine_reboot;
153	pm_power_off = bcm63xx_machine_halt;
154
155	set_io_port_base(0);
156	ioport_resource.start = 0;
157	ioport_resource.end = ~0;
158
159	board_setup();
160}
161
162int __init bcm63xx_register_devices(void)
163{
164	/* register gpiochip */
165	bcm63xx_gpio_init();
166
167	return board_register_devices();
168}
169
170arch_initcall(bcm63xx_register_devices);