18c2ecf20Sopenharmony_ci/*
28c2ecf20Sopenharmony_ci * arch/arm/mach-orion5x/common.c
38c2ecf20Sopenharmony_ci *
48c2ecf20Sopenharmony_ci * Core functions for Marvell Orion 5x SoCs
58c2ecf20Sopenharmony_ci *
68c2ecf20Sopenharmony_ci * Maintainer: Tzachi Perelstein <tzachi@marvell.com>
78c2ecf20Sopenharmony_ci *
88c2ecf20Sopenharmony_ci * This file is licensed under the terms of the GNU General Public
98c2ecf20Sopenharmony_ci * License version 2.  This program is licensed "as is" without any
108c2ecf20Sopenharmony_ci * warranty of any kind, whether express or implied.
118c2ecf20Sopenharmony_ci */
128c2ecf20Sopenharmony_ci
138c2ecf20Sopenharmony_ci#include <linux/kernel.h>
148c2ecf20Sopenharmony_ci#include <linux/init.h>
158c2ecf20Sopenharmony_ci#include <linux/io.h>
168c2ecf20Sopenharmony_ci#include <linux/platform_device.h>
178c2ecf20Sopenharmony_ci#include <linux/dma-mapping.h>
188c2ecf20Sopenharmony_ci#include <linux/serial_8250.h>
198c2ecf20Sopenharmony_ci#include <linux/mv643xx_i2c.h>
208c2ecf20Sopenharmony_ci#include <linux/ata_platform.h>
218c2ecf20Sopenharmony_ci#include <linux/delay.h>
228c2ecf20Sopenharmony_ci#include <linux/clk-provider.h>
238c2ecf20Sopenharmony_ci#include <linux/cpu.h>
248c2ecf20Sopenharmony_ci#include <linux/platform_data/dsa.h>
258c2ecf20Sopenharmony_ci#include <asm/page.h>
268c2ecf20Sopenharmony_ci#include <asm/setup.h>
278c2ecf20Sopenharmony_ci#include <asm/system_misc.h>
288c2ecf20Sopenharmony_ci#include <asm/mach/arch.h>
298c2ecf20Sopenharmony_ci#include <asm/mach/map.h>
308c2ecf20Sopenharmony_ci#include <asm/mach/time.h>
318c2ecf20Sopenharmony_ci#include <linux/platform_data/mtd-orion_nand.h>
328c2ecf20Sopenharmony_ci#include <linux/platform_data/usb-ehci-orion.h>
338c2ecf20Sopenharmony_ci#include <plat/time.h>
348c2ecf20Sopenharmony_ci#include <plat/common.h>
358c2ecf20Sopenharmony_ci
368c2ecf20Sopenharmony_ci#include "bridge-regs.h"
378c2ecf20Sopenharmony_ci#include "common.h"
388c2ecf20Sopenharmony_ci#include "orion5x.h"
398c2ecf20Sopenharmony_ci
408c2ecf20Sopenharmony_ci/*****************************************************************************
418c2ecf20Sopenharmony_ci * I/O Address Mapping
428c2ecf20Sopenharmony_ci ****************************************************************************/
438c2ecf20Sopenharmony_cistatic struct map_desc orion5x_io_desc[] __initdata = {
448c2ecf20Sopenharmony_ci	{
458c2ecf20Sopenharmony_ci		.virtual	= (unsigned long) ORION5X_REGS_VIRT_BASE,
468c2ecf20Sopenharmony_ci		.pfn		= __phys_to_pfn(ORION5X_REGS_PHYS_BASE),
478c2ecf20Sopenharmony_ci		.length		= ORION5X_REGS_SIZE,
488c2ecf20Sopenharmony_ci		.type		= MT_DEVICE,
498c2ecf20Sopenharmony_ci	}, {
508c2ecf20Sopenharmony_ci		.virtual	= (unsigned long) ORION5X_PCIE_WA_VIRT_BASE,
518c2ecf20Sopenharmony_ci		.pfn		= __phys_to_pfn(ORION5X_PCIE_WA_PHYS_BASE),
528c2ecf20Sopenharmony_ci		.length		= ORION5X_PCIE_WA_SIZE,
538c2ecf20Sopenharmony_ci		.type		= MT_DEVICE,
548c2ecf20Sopenharmony_ci	},
558c2ecf20Sopenharmony_ci};
568c2ecf20Sopenharmony_ci
578c2ecf20Sopenharmony_civoid __init orion5x_map_io(void)
588c2ecf20Sopenharmony_ci{
598c2ecf20Sopenharmony_ci	iotable_init(orion5x_io_desc, ARRAY_SIZE(orion5x_io_desc));
608c2ecf20Sopenharmony_ci}
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_ci/*****************************************************************************
648c2ecf20Sopenharmony_ci * CLK tree
658c2ecf20Sopenharmony_ci ****************************************************************************/
668c2ecf20Sopenharmony_cistatic struct clk *tclk;
678c2ecf20Sopenharmony_ci
688c2ecf20Sopenharmony_civoid __init clk_init(void)
698c2ecf20Sopenharmony_ci{
708c2ecf20Sopenharmony_ci	tclk = clk_register_fixed_rate(NULL, "tclk", NULL, 0, orion5x_tclk);
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ci	orion_clkdev_init(tclk);
738c2ecf20Sopenharmony_ci}
748c2ecf20Sopenharmony_ci
758c2ecf20Sopenharmony_ci/*****************************************************************************
768c2ecf20Sopenharmony_ci * EHCI0
778c2ecf20Sopenharmony_ci ****************************************************************************/
788c2ecf20Sopenharmony_civoid __init orion5x_ehci0_init(void)
798c2ecf20Sopenharmony_ci{
808c2ecf20Sopenharmony_ci	orion_ehci_init(ORION5X_USB0_PHYS_BASE, IRQ_ORION5X_USB0_CTRL,
818c2ecf20Sopenharmony_ci			EHCI_PHY_ORION);
828c2ecf20Sopenharmony_ci}
838c2ecf20Sopenharmony_ci
848c2ecf20Sopenharmony_ci
858c2ecf20Sopenharmony_ci/*****************************************************************************
868c2ecf20Sopenharmony_ci * EHCI1
878c2ecf20Sopenharmony_ci ****************************************************************************/
888c2ecf20Sopenharmony_civoid __init orion5x_ehci1_init(void)
898c2ecf20Sopenharmony_ci{
908c2ecf20Sopenharmony_ci	orion_ehci_1_init(ORION5X_USB1_PHYS_BASE, IRQ_ORION5X_USB1_CTRL);
918c2ecf20Sopenharmony_ci}
928c2ecf20Sopenharmony_ci
938c2ecf20Sopenharmony_ci
948c2ecf20Sopenharmony_ci/*****************************************************************************
958c2ecf20Sopenharmony_ci * GE00
968c2ecf20Sopenharmony_ci ****************************************************************************/
978c2ecf20Sopenharmony_civoid __init orion5x_eth_init(struct mv643xx_eth_platform_data *eth_data)
988c2ecf20Sopenharmony_ci{
998c2ecf20Sopenharmony_ci	orion_ge00_init(eth_data,
1008c2ecf20Sopenharmony_ci			ORION5X_ETH_PHYS_BASE, IRQ_ORION5X_ETH_SUM,
1018c2ecf20Sopenharmony_ci			IRQ_ORION5X_ETH_ERR,
1028c2ecf20Sopenharmony_ci			MV643XX_TX_CSUM_DEFAULT_LIMIT);
1038c2ecf20Sopenharmony_ci}
1048c2ecf20Sopenharmony_ci
1058c2ecf20Sopenharmony_ci
1068c2ecf20Sopenharmony_ci/*****************************************************************************
1078c2ecf20Sopenharmony_ci * Ethernet switch
1088c2ecf20Sopenharmony_ci ****************************************************************************/
1098c2ecf20Sopenharmony_civoid __init orion5x_eth_switch_init(struct dsa_chip_data *d)
1108c2ecf20Sopenharmony_ci{
1118c2ecf20Sopenharmony_ci	orion_ge00_switch_init(d);
1128c2ecf20Sopenharmony_ci}
1138c2ecf20Sopenharmony_ci
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci/*****************************************************************************
1168c2ecf20Sopenharmony_ci * I2C
1178c2ecf20Sopenharmony_ci ****************************************************************************/
1188c2ecf20Sopenharmony_civoid __init orion5x_i2c_init(void)
1198c2ecf20Sopenharmony_ci{
1208c2ecf20Sopenharmony_ci	orion_i2c_init(I2C_PHYS_BASE, IRQ_ORION5X_I2C, 8);
1218c2ecf20Sopenharmony_ci
1228c2ecf20Sopenharmony_ci}
1238c2ecf20Sopenharmony_ci
1248c2ecf20Sopenharmony_ci
1258c2ecf20Sopenharmony_ci/*****************************************************************************
1268c2ecf20Sopenharmony_ci * SATA
1278c2ecf20Sopenharmony_ci ****************************************************************************/
1288c2ecf20Sopenharmony_civoid __init orion5x_sata_init(struct mv_sata_platform_data *sata_data)
1298c2ecf20Sopenharmony_ci{
1308c2ecf20Sopenharmony_ci	orion_sata_init(sata_data, ORION5X_SATA_PHYS_BASE, IRQ_ORION5X_SATA);
1318c2ecf20Sopenharmony_ci}
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci/*****************************************************************************
1358c2ecf20Sopenharmony_ci * SPI
1368c2ecf20Sopenharmony_ci ****************************************************************************/
1378c2ecf20Sopenharmony_civoid __init orion5x_spi_init(void)
1388c2ecf20Sopenharmony_ci{
1398c2ecf20Sopenharmony_ci	orion_spi_init(SPI_PHYS_BASE);
1408c2ecf20Sopenharmony_ci}
1418c2ecf20Sopenharmony_ci
1428c2ecf20Sopenharmony_ci
1438c2ecf20Sopenharmony_ci/*****************************************************************************
1448c2ecf20Sopenharmony_ci * UART0
1458c2ecf20Sopenharmony_ci ****************************************************************************/
1468c2ecf20Sopenharmony_civoid __init orion5x_uart0_init(void)
1478c2ecf20Sopenharmony_ci{
1488c2ecf20Sopenharmony_ci	orion_uart0_init(UART0_VIRT_BASE, UART0_PHYS_BASE,
1498c2ecf20Sopenharmony_ci			 IRQ_ORION5X_UART0, tclk);
1508c2ecf20Sopenharmony_ci}
1518c2ecf20Sopenharmony_ci
1528c2ecf20Sopenharmony_ci/*****************************************************************************
1538c2ecf20Sopenharmony_ci * UART1
1548c2ecf20Sopenharmony_ci ****************************************************************************/
1558c2ecf20Sopenharmony_civoid __init orion5x_uart1_init(void)
1568c2ecf20Sopenharmony_ci{
1578c2ecf20Sopenharmony_ci	orion_uart1_init(UART1_VIRT_BASE, UART1_PHYS_BASE,
1588c2ecf20Sopenharmony_ci			 IRQ_ORION5X_UART1, tclk);
1598c2ecf20Sopenharmony_ci}
1608c2ecf20Sopenharmony_ci
1618c2ecf20Sopenharmony_ci/*****************************************************************************
1628c2ecf20Sopenharmony_ci * XOR engine
1638c2ecf20Sopenharmony_ci ****************************************************************************/
1648c2ecf20Sopenharmony_civoid __init orion5x_xor_init(void)
1658c2ecf20Sopenharmony_ci{
1668c2ecf20Sopenharmony_ci	orion_xor0_init(ORION5X_XOR_PHYS_BASE,
1678c2ecf20Sopenharmony_ci			ORION5X_XOR_PHYS_BASE + 0x200,
1688c2ecf20Sopenharmony_ci			IRQ_ORION5X_XOR0, IRQ_ORION5X_XOR1);
1698c2ecf20Sopenharmony_ci}
1708c2ecf20Sopenharmony_ci
1718c2ecf20Sopenharmony_ci/*****************************************************************************
1728c2ecf20Sopenharmony_ci * Cryptographic Engines and Security Accelerator (CESA)
1738c2ecf20Sopenharmony_ci ****************************************************************************/
1748c2ecf20Sopenharmony_cistatic void __init orion5x_crypto_init(void)
1758c2ecf20Sopenharmony_ci{
1768c2ecf20Sopenharmony_ci	mvebu_mbus_add_window_by_id(ORION_MBUS_SRAM_TARGET,
1778c2ecf20Sopenharmony_ci				    ORION_MBUS_SRAM_ATTR,
1788c2ecf20Sopenharmony_ci				    ORION5X_SRAM_PHYS_BASE,
1798c2ecf20Sopenharmony_ci				    ORION5X_SRAM_SIZE);
1808c2ecf20Sopenharmony_ci	orion_crypto_init(ORION5X_CRYPTO_PHYS_BASE, ORION5X_SRAM_PHYS_BASE,
1818c2ecf20Sopenharmony_ci			  SZ_8K, IRQ_ORION5X_CESA);
1828c2ecf20Sopenharmony_ci}
1838c2ecf20Sopenharmony_ci
1848c2ecf20Sopenharmony_ci/*****************************************************************************
1858c2ecf20Sopenharmony_ci * Watchdog
1868c2ecf20Sopenharmony_ci ****************************************************************************/
1878c2ecf20Sopenharmony_cistatic struct resource orion_wdt_resource[] = {
1888c2ecf20Sopenharmony_ci		DEFINE_RES_MEM(TIMER_PHYS_BASE, 0x04),
1898c2ecf20Sopenharmony_ci		DEFINE_RES_MEM(RSTOUTn_MASK_PHYS, 0x04),
1908c2ecf20Sopenharmony_ci};
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_cistatic struct platform_device orion_wdt_device = {
1938c2ecf20Sopenharmony_ci	.name		= "orion_wdt",
1948c2ecf20Sopenharmony_ci	.id		= -1,
1958c2ecf20Sopenharmony_ci	.num_resources	= ARRAY_SIZE(orion_wdt_resource),
1968c2ecf20Sopenharmony_ci	.resource	= orion_wdt_resource,
1978c2ecf20Sopenharmony_ci};
1988c2ecf20Sopenharmony_ci
1998c2ecf20Sopenharmony_cistatic void __init orion5x_wdt_init(void)
2008c2ecf20Sopenharmony_ci{
2018c2ecf20Sopenharmony_ci	platform_device_register(&orion_wdt_device);
2028c2ecf20Sopenharmony_ci}
2038c2ecf20Sopenharmony_ci
2048c2ecf20Sopenharmony_ci
2058c2ecf20Sopenharmony_ci/*****************************************************************************
2068c2ecf20Sopenharmony_ci * Time handling
2078c2ecf20Sopenharmony_ci ****************************************************************************/
2088c2ecf20Sopenharmony_civoid __init orion5x_init_early(void)
2098c2ecf20Sopenharmony_ci{
2108c2ecf20Sopenharmony_ci	u32 rev, dev;
2118c2ecf20Sopenharmony_ci	const char *mbus_soc_name;
2128c2ecf20Sopenharmony_ci
2138c2ecf20Sopenharmony_ci	orion_time_set_base(TIMER_VIRT_BASE);
2148c2ecf20Sopenharmony_ci
2158c2ecf20Sopenharmony_ci	/* Initialize the MBUS driver */
2168c2ecf20Sopenharmony_ci	orion5x_pcie_id(&dev, &rev);
2178c2ecf20Sopenharmony_ci	if (dev == MV88F5281_DEV_ID)
2188c2ecf20Sopenharmony_ci		mbus_soc_name = "marvell,orion5x-88f5281-mbus";
2198c2ecf20Sopenharmony_ci	else if (dev == MV88F5182_DEV_ID)
2208c2ecf20Sopenharmony_ci		mbus_soc_name = "marvell,orion5x-88f5182-mbus";
2218c2ecf20Sopenharmony_ci	else if (dev == MV88F5181_DEV_ID)
2228c2ecf20Sopenharmony_ci		mbus_soc_name = "marvell,orion5x-88f5181-mbus";
2238c2ecf20Sopenharmony_ci	else if (dev == MV88F6183_DEV_ID)
2248c2ecf20Sopenharmony_ci		mbus_soc_name = "marvell,orion5x-88f6183-mbus";
2258c2ecf20Sopenharmony_ci	else
2268c2ecf20Sopenharmony_ci		mbus_soc_name = NULL;
2278c2ecf20Sopenharmony_ci	mvebu_mbus_init(mbus_soc_name, ORION5X_BRIDGE_WINS_BASE,
2288c2ecf20Sopenharmony_ci			ORION5X_BRIDGE_WINS_SZ,
2298c2ecf20Sopenharmony_ci			ORION5X_DDR_WINS_BASE, ORION5X_DDR_WINS_SZ);
2308c2ecf20Sopenharmony_ci}
2318c2ecf20Sopenharmony_ci
2328c2ecf20Sopenharmony_civoid orion5x_setup_wins(void)
2338c2ecf20Sopenharmony_ci{
2348c2ecf20Sopenharmony_ci	/*
2358c2ecf20Sopenharmony_ci	 * The PCIe windows will no longer be statically allocated
2368c2ecf20Sopenharmony_ci	 * here once Orion5x is migrated to the pci-mvebu driver.
2378c2ecf20Sopenharmony_ci	 */
2388c2ecf20Sopenharmony_ci	mvebu_mbus_add_window_remap_by_id(ORION_MBUS_PCIE_IO_TARGET,
2398c2ecf20Sopenharmony_ci					  ORION_MBUS_PCIE_IO_ATTR,
2408c2ecf20Sopenharmony_ci					  ORION5X_PCIE_IO_PHYS_BASE,
2418c2ecf20Sopenharmony_ci					  ORION5X_PCIE_IO_SIZE,
2428c2ecf20Sopenharmony_ci					  ORION5X_PCIE_IO_BUS_BASE);
2438c2ecf20Sopenharmony_ci	mvebu_mbus_add_window_by_id(ORION_MBUS_PCIE_MEM_TARGET,
2448c2ecf20Sopenharmony_ci				    ORION_MBUS_PCIE_MEM_ATTR,
2458c2ecf20Sopenharmony_ci				    ORION5X_PCIE_MEM_PHYS_BASE,
2468c2ecf20Sopenharmony_ci				    ORION5X_PCIE_MEM_SIZE);
2478c2ecf20Sopenharmony_ci	mvebu_mbus_add_window_remap_by_id(ORION_MBUS_PCI_IO_TARGET,
2488c2ecf20Sopenharmony_ci					  ORION_MBUS_PCI_IO_ATTR,
2498c2ecf20Sopenharmony_ci					  ORION5X_PCI_IO_PHYS_BASE,
2508c2ecf20Sopenharmony_ci					  ORION5X_PCI_IO_SIZE,
2518c2ecf20Sopenharmony_ci					  ORION5X_PCI_IO_BUS_BASE);
2528c2ecf20Sopenharmony_ci	mvebu_mbus_add_window_by_id(ORION_MBUS_PCI_MEM_TARGET,
2538c2ecf20Sopenharmony_ci				    ORION_MBUS_PCI_MEM_ATTR,
2548c2ecf20Sopenharmony_ci				    ORION5X_PCI_MEM_PHYS_BASE,
2558c2ecf20Sopenharmony_ci				    ORION5X_PCI_MEM_SIZE);
2568c2ecf20Sopenharmony_ci}
2578c2ecf20Sopenharmony_ci
2588c2ecf20Sopenharmony_ciint orion5x_tclk;
2598c2ecf20Sopenharmony_ci
2608c2ecf20Sopenharmony_cistatic int __init orion5x_find_tclk(void)
2618c2ecf20Sopenharmony_ci{
2628c2ecf20Sopenharmony_ci	u32 dev, rev;
2638c2ecf20Sopenharmony_ci
2648c2ecf20Sopenharmony_ci	orion5x_pcie_id(&dev, &rev);
2658c2ecf20Sopenharmony_ci	if (dev == MV88F6183_DEV_ID &&
2668c2ecf20Sopenharmony_ci	    (readl(MPP_RESET_SAMPLE) & 0x00000200) == 0)
2678c2ecf20Sopenharmony_ci		return 133333333;
2688c2ecf20Sopenharmony_ci
2698c2ecf20Sopenharmony_ci	return 166666667;
2708c2ecf20Sopenharmony_ci}
2718c2ecf20Sopenharmony_ci
2728c2ecf20Sopenharmony_civoid __init orion5x_timer_init(void)
2738c2ecf20Sopenharmony_ci{
2748c2ecf20Sopenharmony_ci	orion5x_tclk = orion5x_find_tclk();
2758c2ecf20Sopenharmony_ci
2768c2ecf20Sopenharmony_ci	orion_time_init(ORION5X_BRIDGE_VIRT_BASE, BRIDGE_INT_TIMER1_CLR,
2778c2ecf20Sopenharmony_ci			IRQ_ORION5X_BRIDGE, orion5x_tclk);
2788c2ecf20Sopenharmony_ci}
2798c2ecf20Sopenharmony_ci
2808c2ecf20Sopenharmony_ci
2818c2ecf20Sopenharmony_ci/*****************************************************************************
2828c2ecf20Sopenharmony_ci * General
2838c2ecf20Sopenharmony_ci ****************************************************************************/
2848c2ecf20Sopenharmony_ci/*
2858c2ecf20Sopenharmony_ci * Identify device ID and rev from PCIe configuration header space '0'.
2868c2ecf20Sopenharmony_ci */
2878c2ecf20Sopenharmony_civoid __init orion5x_id(u32 *dev, u32 *rev, char **dev_name)
2888c2ecf20Sopenharmony_ci{
2898c2ecf20Sopenharmony_ci	orion5x_pcie_id(dev, rev);
2908c2ecf20Sopenharmony_ci
2918c2ecf20Sopenharmony_ci	if (*dev == MV88F5281_DEV_ID) {
2928c2ecf20Sopenharmony_ci		if (*rev == MV88F5281_REV_D2) {
2938c2ecf20Sopenharmony_ci			*dev_name = "MV88F5281-D2";
2948c2ecf20Sopenharmony_ci		} else if (*rev == MV88F5281_REV_D1) {
2958c2ecf20Sopenharmony_ci			*dev_name = "MV88F5281-D1";
2968c2ecf20Sopenharmony_ci		} else if (*rev == MV88F5281_REV_D0) {
2978c2ecf20Sopenharmony_ci			*dev_name = "MV88F5281-D0";
2988c2ecf20Sopenharmony_ci		} else {
2998c2ecf20Sopenharmony_ci			*dev_name = "MV88F5281-Rev-Unsupported";
3008c2ecf20Sopenharmony_ci		}
3018c2ecf20Sopenharmony_ci	} else if (*dev == MV88F5182_DEV_ID) {
3028c2ecf20Sopenharmony_ci		if (*rev == MV88F5182_REV_A2) {
3038c2ecf20Sopenharmony_ci			*dev_name = "MV88F5182-A2";
3048c2ecf20Sopenharmony_ci		} else {
3058c2ecf20Sopenharmony_ci			*dev_name = "MV88F5182-Rev-Unsupported";
3068c2ecf20Sopenharmony_ci		}
3078c2ecf20Sopenharmony_ci	} else if (*dev == MV88F5181_DEV_ID) {
3088c2ecf20Sopenharmony_ci		if (*rev == MV88F5181_REV_B1) {
3098c2ecf20Sopenharmony_ci			*dev_name = "MV88F5181-Rev-B1";
3108c2ecf20Sopenharmony_ci		} else if (*rev == MV88F5181L_REV_A1) {
3118c2ecf20Sopenharmony_ci			*dev_name = "MV88F5181L-Rev-A1";
3128c2ecf20Sopenharmony_ci		} else {
3138c2ecf20Sopenharmony_ci			*dev_name = "MV88F5181(L)-Rev-Unsupported";
3148c2ecf20Sopenharmony_ci		}
3158c2ecf20Sopenharmony_ci	} else if (*dev == MV88F6183_DEV_ID) {
3168c2ecf20Sopenharmony_ci		if (*rev == MV88F6183_REV_B0) {
3178c2ecf20Sopenharmony_ci			*dev_name = "MV88F6183-Rev-B0";
3188c2ecf20Sopenharmony_ci		} else {
3198c2ecf20Sopenharmony_ci			*dev_name = "MV88F6183-Rev-Unsupported";
3208c2ecf20Sopenharmony_ci		}
3218c2ecf20Sopenharmony_ci	} else {
3228c2ecf20Sopenharmony_ci		*dev_name = "Device-Unknown";
3238c2ecf20Sopenharmony_ci	}
3248c2ecf20Sopenharmony_ci}
3258c2ecf20Sopenharmony_ci
3268c2ecf20Sopenharmony_civoid __init orion5x_init(void)
3278c2ecf20Sopenharmony_ci{
3288c2ecf20Sopenharmony_ci	char *dev_name;
3298c2ecf20Sopenharmony_ci	u32 dev, rev;
3308c2ecf20Sopenharmony_ci
3318c2ecf20Sopenharmony_ci	orion5x_id(&dev, &rev, &dev_name);
3328c2ecf20Sopenharmony_ci	printk(KERN_INFO "Orion ID: %s. TCLK=%d.\n", dev_name, orion5x_tclk);
3338c2ecf20Sopenharmony_ci
3348c2ecf20Sopenharmony_ci	/*
3358c2ecf20Sopenharmony_ci	 * Setup Orion address map
3368c2ecf20Sopenharmony_ci	 */
3378c2ecf20Sopenharmony_ci	orion5x_setup_wins();
3388c2ecf20Sopenharmony_ci
3398c2ecf20Sopenharmony_ci	/* Setup root of clk tree */
3408c2ecf20Sopenharmony_ci	clk_init();
3418c2ecf20Sopenharmony_ci
3428c2ecf20Sopenharmony_ci	/*
3438c2ecf20Sopenharmony_ci	 * Don't issue "Wait for Interrupt" instruction if we are
3448c2ecf20Sopenharmony_ci	 * running on D0 5281 silicon.
3458c2ecf20Sopenharmony_ci	 */
3468c2ecf20Sopenharmony_ci	if (dev == MV88F5281_DEV_ID && rev == MV88F5281_REV_D0) {
3478c2ecf20Sopenharmony_ci		printk(KERN_INFO "Orion: Applying 5281 D0 WFI workaround.\n");
3488c2ecf20Sopenharmony_ci		cpu_idle_poll_ctrl(true);
3498c2ecf20Sopenharmony_ci	}
3508c2ecf20Sopenharmony_ci
3518c2ecf20Sopenharmony_ci	/*
3528c2ecf20Sopenharmony_ci	 * The 5082/5181l/5182/6082/6082l/6183 have crypto
3538c2ecf20Sopenharmony_ci	 * while 5180n/5181/5281 don't have crypto.
3548c2ecf20Sopenharmony_ci	 */
3558c2ecf20Sopenharmony_ci	if ((dev == MV88F5181_DEV_ID && rev >= MV88F5181L_REV_A0) ||
3568c2ecf20Sopenharmony_ci	    dev == MV88F5182_DEV_ID || dev == MV88F6183_DEV_ID)
3578c2ecf20Sopenharmony_ci		orion5x_crypto_init();
3588c2ecf20Sopenharmony_ci
3598c2ecf20Sopenharmony_ci	/*
3608c2ecf20Sopenharmony_ci	 * Register watchdog driver
3618c2ecf20Sopenharmony_ci	 */
3628c2ecf20Sopenharmony_ci	orion5x_wdt_init();
3638c2ecf20Sopenharmony_ci}
3648c2ecf20Sopenharmony_ci
3658c2ecf20Sopenharmony_civoid orion5x_restart(enum reboot_mode mode, const char *cmd)
3668c2ecf20Sopenharmony_ci{
3678c2ecf20Sopenharmony_ci	/*
3688c2ecf20Sopenharmony_ci	 * Enable and issue soft reset
3698c2ecf20Sopenharmony_ci	 */
3708c2ecf20Sopenharmony_ci	orion5x_setbits(RSTOUTn_MASK, (1 << 2));
3718c2ecf20Sopenharmony_ci	orion5x_setbits(CPU_SOFT_RESET, 1);
3728c2ecf20Sopenharmony_ci	mdelay(200);
3738c2ecf20Sopenharmony_ci	orion5x_clrbits(CPU_SOFT_RESET, 1);
3748c2ecf20Sopenharmony_ci}
3758c2ecf20Sopenharmony_ci
3768c2ecf20Sopenharmony_ci/*
3778c2ecf20Sopenharmony_ci * Many orion-based systems have buggy bootloader implementations.
3788c2ecf20Sopenharmony_ci * This is a common fixup for bogus memory tags.
3798c2ecf20Sopenharmony_ci */
3808c2ecf20Sopenharmony_civoid __init tag_fixup_mem32(struct tag *t, char **from)
3818c2ecf20Sopenharmony_ci{
3828c2ecf20Sopenharmony_ci	for (; t->hdr.size; t = tag_next(t))
3838c2ecf20Sopenharmony_ci		if (t->hdr.tag == ATAG_MEM &&
3848c2ecf20Sopenharmony_ci		    (!t->u.mem.size || t->u.mem.size & ~PAGE_MASK ||
3858c2ecf20Sopenharmony_ci		     t->u.mem.start & ~PAGE_MASK)) {
3868c2ecf20Sopenharmony_ci			printk(KERN_WARNING
3878c2ecf20Sopenharmony_ci			       "Clearing invalid memory bank %dKB@0x%08x\n",
3888c2ecf20Sopenharmony_ci			       t->u.mem.size / 1024, t->u.mem.start);
3898c2ecf20Sopenharmony_ci			t->hdr.tag = 0;
3908c2ecf20Sopenharmony_ci		}
3918c2ecf20Sopenharmony_ci}
392