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 | |
25 | void bcm63xx_machine_halt(void) |
26 | { |
27 | pr_info("System halted\n" ); |
28 | while (1) |
29 | ; |
30 | } |
31 | |
32 | static 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 | |
65 | void 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 | |
125 | static void __bcm63xx_machine_reboot(char *p) |
126 | { |
127 | bcm63xx_machine_reboot(); |
128 | } |
129 | |
130 | /* |
131 | * return system type in /proc/cpuinfo |
132 | */ |
133 | const char *get_system_type(void) |
134 | { |
135 | static char buf[128]; |
136 | snprintf(buf, size: sizeof(buf), fmt: "bcm63xx/%s (0x%04x/0x%02X)" , |
137 | board_get_name(), |
138 | bcm63xx_get_cpu_id(), bcm63xx_get_cpu_rev()); |
139 | return buf; |
140 | } |
141 | |
142 | void __init plat_time_init(void) |
143 | { |
144 | mips_hpt_frequency = bcm63xx_get_cpu_freq() / 2; |
145 | } |
146 | |
147 | void __init plat_mem_setup(void) |
148 | { |
149 | memblock_add(base: 0, size: bcm63xx_get_memory_size()); |
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 | |
162 | static int __init bcm63xx_register_devices(void) |
163 | { |
164 | /* register gpiochip */ |
165 | bcm63xx_gpio_init(); |
166 | |
167 | return board_register_devices(); |
168 | } |
169 | |
170 | arch_initcall(bcm63xx_register_devices); |
171 | |