xref: /OK3568_Linux_fs/kernel/arch/arm/mach-orion5x/common.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * arch/arm/mach-orion5x/common.c
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * Core functions for Marvell Orion 5x SoCs
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  * Maintainer: Tzachi Perelstein <tzachi@marvell.com>
7*4882a593Smuzhiyun  *
8*4882a593Smuzhiyun  * This file is licensed under the terms of the GNU General Public
9*4882a593Smuzhiyun  * License version 2.  This program is licensed "as is" without any
10*4882a593Smuzhiyun  * warranty of any kind, whether express or implied.
11*4882a593Smuzhiyun  */
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun #include <linux/kernel.h>
14*4882a593Smuzhiyun #include <linux/init.h>
15*4882a593Smuzhiyun #include <linux/io.h>
16*4882a593Smuzhiyun #include <linux/platform_device.h>
17*4882a593Smuzhiyun #include <linux/dma-mapping.h>
18*4882a593Smuzhiyun #include <linux/serial_8250.h>
19*4882a593Smuzhiyun #include <linux/mv643xx_i2c.h>
20*4882a593Smuzhiyun #include <linux/ata_platform.h>
21*4882a593Smuzhiyun #include <linux/delay.h>
22*4882a593Smuzhiyun #include <linux/clk-provider.h>
23*4882a593Smuzhiyun #include <linux/cpu.h>
24*4882a593Smuzhiyun #include <linux/platform_data/dsa.h>
25*4882a593Smuzhiyun #include <asm/page.h>
26*4882a593Smuzhiyun #include <asm/setup.h>
27*4882a593Smuzhiyun #include <asm/system_misc.h>
28*4882a593Smuzhiyun #include <asm/mach/arch.h>
29*4882a593Smuzhiyun #include <asm/mach/map.h>
30*4882a593Smuzhiyun #include <asm/mach/time.h>
31*4882a593Smuzhiyun #include <linux/platform_data/mtd-orion_nand.h>
32*4882a593Smuzhiyun #include <linux/platform_data/usb-ehci-orion.h>
33*4882a593Smuzhiyun #include <plat/time.h>
34*4882a593Smuzhiyun #include <plat/common.h>
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #include "bridge-regs.h"
37*4882a593Smuzhiyun #include "common.h"
38*4882a593Smuzhiyun #include "orion5x.h"
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun /*****************************************************************************
41*4882a593Smuzhiyun  * I/O Address Mapping
42*4882a593Smuzhiyun  ****************************************************************************/
43*4882a593Smuzhiyun static struct map_desc orion5x_io_desc[] __initdata = {
44*4882a593Smuzhiyun 	{
45*4882a593Smuzhiyun 		.virtual	= (unsigned long) ORION5X_REGS_VIRT_BASE,
46*4882a593Smuzhiyun 		.pfn		= __phys_to_pfn(ORION5X_REGS_PHYS_BASE),
47*4882a593Smuzhiyun 		.length		= ORION5X_REGS_SIZE,
48*4882a593Smuzhiyun 		.type		= MT_DEVICE,
49*4882a593Smuzhiyun 	}, {
50*4882a593Smuzhiyun 		.virtual	= (unsigned long) ORION5X_PCIE_WA_VIRT_BASE,
51*4882a593Smuzhiyun 		.pfn		= __phys_to_pfn(ORION5X_PCIE_WA_PHYS_BASE),
52*4882a593Smuzhiyun 		.length		= ORION5X_PCIE_WA_SIZE,
53*4882a593Smuzhiyun 		.type		= MT_DEVICE,
54*4882a593Smuzhiyun 	},
55*4882a593Smuzhiyun };
56*4882a593Smuzhiyun 
orion5x_map_io(void)57*4882a593Smuzhiyun void __init orion5x_map_io(void)
58*4882a593Smuzhiyun {
59*4882a593Smuzhiyun 	iotable_init(orion5x_io_desc, ARRAY_SIZE(orion5x_io_desc));
60*4882a593Smuzhiyun }
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun /*****************************************************************************
64*4882a593Smuzhiyun  * CLK tree
65*4882a593Smuzhiyun  ****************************************************************************/
66*4882a593Smuzhiyun static struct clk *tclk;
67*4882a593Smuzhiyun 
clk_init(void)68*4882a593Smuzhiyun void __init clk_init(void)
69*4882a593Smuzhiyun {
70*4882a593Smuzhiyun 	tclk = clk_register_fixed_rate(NULL, "tclk", NULL, 0, orion5x_tclk);
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun 	orion_clkdev_init(tclk);
73*4882a593Smuzhiyun }
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun /*****************************************************************************
76*4882a593Smuzhiyun  * EHCI0
77*4882a593Smuzhiyun  ****************************************************************************/
orion5x_ehci0_init(void)78*4882a593Smuzhiyun void __init orion5x_ehci0_init(void)
79*4882a593Smuzhiyun {
80*4882a593Smuzhiyun 	orion_ehci_init(ORION5X_USB0_PHYS_BASE, IRQ_ORION5X_USB0_CTRL,
81*4882a593Smuzhiyun 			EHCI_PHY_ORION);
82*4882a593Smuzhiyun }
83*4882a593Smuzhiyun 
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun /*****************************************************************************
86*4882a593Smuzhiyun  * EHCI1
87*4882a593Smuzhiyun  ****************************************************************************/
orion5x_ehci1_init(void)88*4882a593Smuzhiyun void __init orion5x_ehci1_init(void)
89*4882a593Smuzhiyun {
90*4882a593Smuzhiyun 	orion_ehci_1_init(ORION5X_USB1_PHYS_BASE, IRQ_ORION5X_USB1_CTRL);
91*4882a593Smuzhiyun }
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun /*****************************************************************************
95*4882a593Smuzhiyun  * GE00
96*4882a593Smuzhiyun  ****************************************************************************/
orion5x_eth_init(struct mv643xx_eth_platform_data * eth_data)97*4882a593Smuzhiyun void __init orion5x_eth_init(struct mv643xx_eth_platform_data *eth_data)
98*4882a593Smuzhiyun {
99*4882a593Smuzhiyun 	orion_ge00_init(eth_data,
100*4882a593Smuzhiyun 			ORION5X_ETH_PHYS_BASE, IRQ_ORION5X_ETH_SUM,
101*4882a593Smuzhiyun 			IRQ_ORION5X_ETH_ERR,
102*4882a593Smuzhiyun 			MV643XX_TX_CSUM_DEFAULT_LIMIT);
103*4882a593Smuzhiyun }
104*4882a593Smuzhiyun 
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun /*****************************************************************************
107*4882a593Smuzhiyun  * Ethernet switch
108*4882a593Smuzhiyun  ****************************************************************************/
orion5x_eth_switch_init(struct dsa_chip_data * d)109*4882a593Smuzhiyun void __init orion5x_eth_switch_init(struct dsa_chip_data *d)
110*4882a593Smuzhiyun {
111*4882a593Smuzhiyun 	orion_ge00_switch_init(d);
112*4882a593Smuzhiyun }
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun /*****************************************************************************
116*4882a593Smuzhiyun  * I2C
117*4882a593Smuzhiyun  ****************************************************************************/
orion5x_i2c_init(void)118*4882a593Smuzhiyun void __init orion5x_i2c_init(void)
119*4882a593Smuzhiyun {
120*4882a593Smuzhiyun 	orion_i2c_init(I2C_PHYS_BASE, IRQ_ORION5X_I2C, 8);
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun }
123*4882a593Smuzhiyun 
124*4882a593Smuzhiyun 
125*4882a593Smuzhiyun /*****************************************************************************
126*4882a593Smuzhiyun  * SATA
127*4882a593Smuzhiyun  ****************************************************************************/
orion5x_sata_init(struct mv_sata_platform_data * sata_data)128*4882a593Smuzhiyun void __init orion5x_sata_init(struct mv_sata_platform_data *sata_data)
129*4882a593Smuzhiyun {
130*4882a593Smuzhiyun 	orion_sata_init(sata_data, ORION5X_SATA_PHYS_BASE, IRQ_ORION5X_SATA);
131*4882a593Smuzhiyun }
132*4882a593Smuzhiyun 
133*4882a593Smuzhiyun 
134*4882a593Smuzhiyun /*****************************************************************************
135*4882a593Smuzhiyun  * SPI
136*4882a593Smuzhiyun  ****************************************************************************/
orion5x_spi_init(void)137*4882a593Smuzhiyun void __init orion5x_spi_init(void)
138*4882a593Smuzhiyun {
139*4882a593Smuzhiyun 	orion_spi_init(SPI_PHYS_BASE);
140*4882a593Smuzhiyun }
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun /*****************************************************************************
144*4882a593Smuzhiyun  * UART0
145*4882a593Smuzhiyun  ****************************************************************************/
orion5x_uart0_init(void)146*4882a593Smuzhiyun void __init orion5x_uart0_init(void)
147*4882a593Smuzhiyun {
148*4882a593Smuzhiyun 	orion_uart0_init(UART0_VIRT_BASE, UART0_PHYS_BASE,
149*4882a593Smuzhiyun 			 IRQ_ORION5X_UART0, tclk);
150*4882a593Smuzhiyun }
151*4882a593Smuzhiyun 
152*4882a593Smuzhiyun /*****************************************************************************
153*4882a593Smuzhiyun  * UART1
154*4882a593Smuzhiyun  ****************************************************************************/
orion5x_uart1_init(void)155*4882a593Smuzhiyun void __init orion5x_uart1_init(void)
156*4882a593Smuzhiyun {
157*4882a593Smuzhiyun 	orion_uart1_init(UART1_VIRT_BASE, UART1_PHYS_BASE,
158*4882a593Smuzhiyun 			 IRQ_ORION5X_UART1, tclk);
159*4882a593Smuzhiyun }
160*4882a593Smuzhiyun 
161*4882a593Smuzhiyun /*****************************************************************************
162*4882a593Smuzhiyun  * XOR engine
163*4882a593Smuzhiyun  ****************************************************************************/
orion5x_xor_init(void)164*4882a593Smuzhiyun void __init orion5x_xor_init(void)
165*4882a593Smuzhiyun {
166*4882a593Smuzhiyun 	orion_xor0_init(ORION5X_XOR_PHYS_BASE,
167*4882a593Smuzhiyun 			ORION5X_XOR_PHYS_BASE + 0x200,
168*4882a593Smuzhiyun 			IRQ_ORION5X_XOR0, IRQ_ORION5X_XOR1);
169*4882a593Smuzhiyun }
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun /*****************************************************************************
172*4882a593Smuzhiyun  * Cryptographic Engines and Security Accelerator (CESA)
173*4882a593Smuzhiyun  ****************************************************************************/
orion5x_crypto_init(void)174*4882a593Smuzhiyun static void __init orion5x_crypto_init(void)
175*4882a593Smuzhiyun {
176*4882a593Smuzhiyun 	mvebu_mbus_add_window_by_id(ORION_MBUS_SRAM_TARGET,
177*4882a593Smuzhiyun 				    ORION_MBUS_SRAM_ATTR,
178*4882a593Smuzhiyun 				    ORION5X_SRAM_PHYS_BASE,
179*4882a593Smuzhiyun 				    ORION5X_SRAM_SIZE);
180*4882a593Smuzhiyun 	orion_crypto_init(ORION5X_CRYPTO_PHYS_BASE, ORION5X_SRAM_PHYS_BASE,
181*4882a593Smuzhiyun 			  SZ_8K, IRQ_ORION5X_CESA);
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun 
184*4882a593Smuzhiyun /*****************************************************************************
185*4882a593Smuzhiyun  * Watchdog
186*4882a593Smuzhiyun  ****************************************************************************/
187*4882a593Smuzhiyun static struct resource orion_wdt_resource[] = {
188*4882a593Smuzhiyun 		DEFINE_RES_MEM(TIMER_PHYS_BASE, 0x04),
189*4882a593Smuzhiyun 		DEFINE_RES_MEM(RSTOUTn_MASK_PHYS, 0x04),
190*4882a593Smuzhiyun };
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun static struct platform_device orion_wdt_device = {
193*4882a593Smuzhiyun 	.name		= "orion_wdt",
194*4882a593Smuzhiyun 	.id		= -1,
195*4882a593Smuzhiyun 	.num_resources	= ARRAY_SIZE(orion_wdt_resource),
196*4882a593Smuzhiyun 	.resource	= orion_wdt_resource,
197*4882a593Smuzhiyun };
198*4882a593Smuzhiyun 
orion5x_wdt_init(void)199*4882a593Smuzhiyun static void __init orion5x_wdt_init(void)
200*4882a593Smuzhiyun {
201*4882a593Smuzhiyun 	platform_device_register(&orion_wdt_device);
202*4882a593Smuzhiyun }
203*4882a593Smuzhiyun 
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun /*****************************************************************************
206*4882a593Smuzhiyun  * Time handling
207*4882a593Smuzhiyun  ****************************************************************************/
orion5x_init_early(void)208*4882a593Smuzhiyun void __init orion5x_init_early(void)
209*4882a593Smuzhiyun {
210*4882a593Smuzhiyun 	u32 rev, dev;
211*4882a593Smuzhiyun 	const char *mbus_soc_name;
212*4882a593Smuzhiyun 
213*4882a593Smuzhiyun 	orion_time_set_base(TIMER_VIRT_BASE);
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun 	/* Initialize the MBUS driver */
216*4882a593Smuzhiyun 	orion5x_pcie_id(&dev, &rev);
217*4882a593Smuzhiyun 	if (dev == MV88F5281_DEV_ID)
218*4882a593Smuzhiyun 		mbus_soc_name = "marvell,orion5x-88f5281-mbus";
219*4882a593Smuzhiyun 	else if (dev == MV88F5182_DEV_ID)
220*4882a593Smuzhiyun 		mbus_soc_name = "marvell,orion5x-88f5182-mbus";
221*4882a593Smuzhiyun 	else if (dev == MV88F5181_DEV_ID)
222*4882a593Smuzhiyun 		mbus_soc_name = "marvell,orion5x-88f5181-mbus";
223*4882a593Smuzhiyun 	else if (dev == MV88F6183_DEV_ID)
224*4882a593Smuzhiyun 		mbus_soc_name = "marvell,orion5x-88f6183-mbus";
225*4882a593Smuzhiyun 	else
226*4882a593Smuzhiyun 		mbus_soc_name = NULL;
227*4882a593Smuzhiyun 	mvebu_mbus_init(mbus_soc_name, ORION5X_BRIDGE_WINS_BASE,
228*4882a593Smuzhiyun 			ORION5X_BRIDGE_WINS_SZ,
229*4882a593Smuzhiyun 			ORION5X_DDR_WINS_BASE, ORION5X_DDR_WINS_SZ);
230*4882a593Smuzhiyun }
231*4882a593Smuzhiyun 
orion5x_setup_wins(void)232*4882a593Smuzhiyun void orion5x_setup_wins(void)
233*4882a593Smuzhiyun {
234*4882a593Smuzhiyun 	/*
235*4882a593Smuzhiyun 	 * The PCIe windows will no longer be statically allocated
236*4882a593Smuzhiyun 	 * here once Orion5x is migrated to the pci-mvebu driver.
237*4882a593Smuzhiyun 	 */
238*4882a593Smuzhiyun 	mvebu_mbus_add_window_remap_by_id(ORION_MBUS_PCIE_IO_TARGET,
239*4882a593Smuzhiyun 					  ORION_MBUS_PCIE_IO_ATTR,
240*4882a593Smuzhiyun 					  ORION5X_PCIE_IO_PHYS_BASE,
241*4882a593Smuzhiyun 					  ORION5X_PCIE_IO_SIZE,
242*4882a593Smuzhiyun 					  ORION5X_PCIE_IO_BUS_BASE);
243*4882a593Smuzhiyun 	mvebu_mbus_add_window_by_id(ORION_MBUS_PCIE_MEM_TARGET,
244*4882a593Smuzhiyun 				    ORION_MBUS_PCIE_MEM_ATTR,
245*4882a593Smuzhiyun 				    ORION5X_PCIE_MEM_PHYS_BASE,
246*4882a593Smuzhiyun 				    ORION5X_PCIE_MEM_SIZE);
247*4882a593Smuzhiyun 	mvebu_mbus_add_window_remap_by_id(ORION_MBUS_PCI_IO_TARGET,
248*4882a593Smuzhiyun 					  ORION_MBUS_PCI_IO_ATTR,
249*4882a593Smuzhiyun 					  ORION5X_PCI_IO_PHYS_BASE,
250*4882a593Smuzhiyun 					  ORION5X_PCI_IO_SIZE,
251*4882a593Smuzhiyun 					  ORION5X_PCI_IO_BUS_BASE);
252*4882a593Smuzhiyun 	mvebu_mbus_add_window_by_id(ORION_MBUS_PCI_MEM_TARGET,
253*4882a593Smuzhiyun 				    ORION_MBUS_PCI_MEM_ATTR,
254*4882a593Smuzhiyun 				    ORION5X_PCI_MEM_PHYS_BASE,
255*4882a593Smuzhiyun 				    ORION5X_PCI_MEM_SIZE);
256*4882a593Smuzhiyun }
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun int orion5x_tclk;
259*4882a593Smuzhiyun 
orion5x_find_tclk(void)260*4882a593Smuzhiyun static int __init orion5x_find_tclk(void)
261*4882a593Smuzhiyun {
262*4882a593Smuzhiyun 	u32 dev, rev;
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	orion5x_pcie_id(&dev, &rev);
265*4882a593Smuzhiyun 	if (dev == MV88F6183_DEV_ID &&
266*4882a593Smuzhiyun 	    (readl(MPP_RESET_SAMPLE) & 0x00000200) == 0)
267*4882a593Smuzhiyun 		return 133333333;
268*4882a593Smuzhiyun 
269*4882a593Smuzhiyun 	return 166666667;
270*4882a593Smuzhiyun }
271*4882a593Smuzhiyun 
orion5x_timer_init(void)272*4882a593Smuzhiyun void __init orion5x_timer_init(void)
273*4882a593Smuzhiyun {
274*4882a593Smuzhiyun 	orion5x_tclk = orion5x_find_tclk();
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	orion_time_init(ORION5X_BRIDGE_VIRT_BASE, BRIDGE_INT_TIMER1_CLR,
277*4882a593Smuzhiyun 			IRQ_ORION5X_BRIDGE, orion5x_tclk);
278*4882a593Smuzhiyun }
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun 
281*4882a593Smuzhiyun /*****************************************************************************
282*4882a593Smuzhiyun  * General
283*4882a593Smuzhiyun  ****************************************************************************/
284*4882a593Smuzhiyun /*
285*4882a593Smuzhiyun  * Identify device ID and rev from PCIe configuration header space '0'.
286*4882a593Smuzhiyun  */
orion5x_id(u32 * dev,u32 * rev,char ** dev_name)287*4882a593Smuzhiyun void __init orion5x_id(u32 *dev, u32 *rev, char **dev_name)
288*4882a593Smuzhiyun {
289*4882a593Smuzhiyun 	orion5x_pcie_id(dev, rev);
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun 	if (*dev == MV88F5281_DEV_ID) {
292*4882a593Smuzhiyun 		if (*rev == MV88F5281_REV_D2) {
293*4882a593Smuzhiyun 			*dev_name = "MV88F5281-D2";
294*4882a593Smuzhiyun 		} else if (*rev == MV88F5281_REV_D1) {
295*4882a593Smuzhiyun 			*dev_name = "MV88F5281-D1";
296*4882a593Smuzhiyun 		} else if (*rev == MV88F5281_REV_D0) {
297*4882a593Smuzhiyun 			*dev_name = "MV88F5281-D0";
298*4882a593Smuzhiyun 		} else {
299*4882a593Smuzhiyun 			*dev_name = "MV88F5281-Rev-Unsupported";
300*4882a593Smuzhiyun 		}
301*4882a593Smuzhiyun 	} else if (*dev == MV88F5182_DEV_ID) {
302*4882a593Smuzhiyun 		if (*rev == MV88F5182_REV_A2) {
303*4882a593Smuzhiyun 			*dev_name = "MV88F5182-A2";
304*4882a593Smuzhiyun 		} else {
305*4882a593Smuzhiyun 			*dev_name = "MV88F5182-Rev-Unsupported";
306*4882a593Smuzhiyun 		}
307*4882a593Smuzhiyun 	} else if (*dev == MV88F5181_DEV_ID) {
308*4882a593Smuzhiyun 		if (*rev == MV88F5181_REV_B1) {
309*4882a593Smuzhiyun 			*dev_name = "MV88F5181-Rev-B1";
310*4882a593Smuzhiyun 		} else if (*rev == MV88F5181L_REV_A1) {
311*4882a593Smuzhiyun 			*dev_name = "MV88F5181L-Rev-A1";
312*4882a593Smuzhiyun 		} else {
313*4882a593Smuzhiyun 			*dev_name = "MV88F5181(L)-Rev-Unsupported";
314*4882a593Smuzhiyun 		}
315*4882a593Smuzhiyun 	} else if (*dev == MV88F6183_DEV_ID) {
316*4882a593Smuzhiyun 		if (*rev == MV88F6183_REV_B0) {
317*4882a593Smuzhiyun 			*dev_name = "MV88F6183-Rev-B0";
318*4882a593Smuzhiyun 		} else {
319*4882a593Smuzhiyun 			*dev_name = "MV88F6183-Rev-Unsupported";
320*4882a593Smuzhiyun 		}
321*4882a593Smuzhiyun 	} else {
322*4882a593Smuzhiyun 		*dev_name = "Device-Unknown";
323*4882a593Smuzhiyun 	}
324*4882a593Smuzhiyun }
325*4882a593Smuzhiyun 
orion5x_init(void)326*4882a593Smuzhiyun void __init orion5x_init(void)
327*4882a593Smuzhiyun {
328*4882a593Smuzhiyun 	char *dev_name;
329*4882a593Smuzhiyun 	u32 dev, rev;
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun 	orion5x_id(&dev, &rev, &dev_name);
332*4882a593Smuzhiyun 	printk(KERN_INFO "Orion ID: %s. TCLK=%d.\n", dev_name, orion5x_tclk);
333*4882a593Smuzhiyun 
334*4882a593Smuzhiyun 	/*
335*4882a593Smuzhiyun 	 * Setup Orion address map
336*4882a593Smuzhiyun 	 */
337*4882a593Smuzhiyun 	orion5x_setup_wins();
338*4882a593Smuzhiyun 
339*4882a593Smuzhiyun 	/* Setup root of clk tree */
340*4882a593Smuzhiyun 	clk_init();
341*4882a593Smuzhiyun 
342*4882a593Smuzhiyun 	/*
343*4882a593Smuzhiyun 	 * Don't issue "Wait for Interrupt" instruction if we are
344*4882a593Smuzhiyun 	 * running on D0 5281 silicon.
345*4882a593Smuzhiyun 	 */
346*4882a593Smuzhiyun 	if (dev == MV88F5281_DEV_ID && rev == MV88F5281_REV_D0) {
347*4882a593Smuzhiyun 		printk(KERN_INFO "Orion: Applying 5281 D0 WFI workaround.\n");
348*4882a593Smuzhiyun 		cpu_idle_poll_ctrl(true);
349*4882a593Smuzhiyun 	}
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 	/*
352*4882a593Smuzhiyun 	 * The 5082/5181l/5182/6082/6082l/6183 have crypto
353*4882a593Smuzhiyun 	 * while 5180n/5181/5281 don't have crypto.
354*4882a593Smuzhiyun 	 */
355*4882a593Smuzhiyun 	if ((dev == MV88F5181_DEV_ID && rev >= MV88F5181L_REV_A0) ||
356*4882a593Smuzhiyun 	    dev == MV88F5182_DEV_ID || dev == MV88F6183_DEV_ID)
357*4882a593Smuzhiyun 		orion5x_crypto_init();
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	/*
360*4882a593Smuzhiyun 	 * Register watchdog driver
361*4882a593Smuzhiyun 	 */
362*4882a593Smuzhiyun 	orion5x_wdt_init();
363*4882a593Smuzhiyun }
364*4882a593Smuzhiyun 
orion5x_restart(enum reboot_mode mode,const char * cmd)365*4882a593Smuzhiyun void orion5x_restart(enum reboot_mode mode, const char *cmd)
366*4882a593Smuzhiyun {
367*4882a593Smuzhiyun 	/*
368*4882a593Smuzhiyun 	 * Enable and issue soft reset
369*4882a593Smuzhiyun 	 */
370*4882a593Smuzhiyun 	orion5x_setbits(RSTOUTn_MASK, (1 << 2));
371*4882a593Smuzhiyun 	orion5x_setbits(CPU_SOFT_RESET, 1);
372*4882a593Smuzhiyun 	mdelay(200);
373*4882a593Smuzhiyun 	orion5x_clrbits(CPU_SOFT_RESET, 1);
374*4882a593Smuzhiyun }
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun /*
377*4882a593Smuzhiyun  * Many orion-based systems have buggy bootloader implementations.
378*4882a593Smuzhiyun  * This is a common fixup for bogus memory tags.
379*4882a593Smuzhiyun  */
tag_fixup_mem32(struct tag * t,char ** from)380*4882a593Smuzhiyun void __init tag_fixup_mem32(struct tag *t, char **from)
381*4882a593Smuzhiyun {
382*4882a593Smuzhiyun 	for (; t->hdr.size; t = tag_next(t))
383*4882a593Smuzhiyun 		if (t->hdr.tag == ATAG_MEM &&
384*4882a593Smuzhiyun 		    (!t->u.mem.size || t->u.mem.size & ~PAGE_MASK ||
385*4882a593Smuzhiyun 		     t->u.mem.start & ~PAGE_MASK)) {
386*4882a593Smuzhiyun 			printk(KERN_WARNING
387*4882a593Smuzhiyun 			       "Clearing invalid memory bank %dKB@0x%08x\n",
388*4882a593Smuzhiyun 			       t->u.mem.size / 1024, t->u.mem.start);
389*4882a593Smuzhiyun 			t->hdr.tag = 0;
390*4882a593Smuzhiyun 		}
391*4882a593Smuzhiyun }
392